[Paparazzi-devel] Quat_int integrator error

[Michal Podhradsky]

Hi guys,

I am running a quadrotor with the default aiframe config file (quadrotor_lisa_m_2_pwm_spektrum.xml), master branch, stabilization = int_quat, ahrs=int_cmpl_quat, Lia 1.1 with Aspirin 2.2.

I did the test on a testbench, and the integrator doesn't seem to work properly. Instead of just saturating at the MAX_ERR limit, it jumps up and down even though the error between set point and actual attitude is constant.

Look at the logs, my guess is that the problem will most likely be on these lines:
https://github.com/paparazzi/paparazzi/blob/master/sw/airborne/firmwares/rotorcraft/stabilization/stabilization_attitude_quat_int.c#L153

and
https://github.com/paparazzi/paparazzi/blob/master/sw/airborne/firmwares/rotorcraft/stabilization/stabilization_attitude_quat_int.c#L154

What do you think?

M

QUAT_INT_psi.png
Description: PNG image

QUAT_INT_theta.png
Description: PNG image

QUAT_INT_phi.png
Description: PNG image