Increased the damping factor of all joints to 0.4 to reduce oscillations.

Used the manager_servos structure instead of the manager_current_angles vector to take into account the balance offsets.
Added the gyroscope calibration value to the returned data of the simulated imu.