Minor changes,
working PWM
Stable work of imu