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.