diff --git a/conf/airframes/TUDELFT/tudelft_course2016_bebop_avoider.xml b/conf/airframes/TUDELFT/tudelft_course2016_bebop_avoider.xml index c68ca44cb8..e7d7f0724b 100644 --- a/conf/airframes/TUDELFT/tudelft_course2016_bebop_avoider.xml +++ b/conf/airframes/TUDELFT/tudelft_course2016_bebop_avoider.xml @@ -137,25 +137,6 @@ -
- - - - - - - - - - - - - - - - -
-
diff --git a/conf/airframes/TUDELFT/tudelft_heli450.xml b/conf/airframes/TUDELFT/tudelft_heli450.xml index 6bd9e20314..cb354d75f1 100644 --- a/conf/airframes/TUDELFT/tudelft_heli450.xml +++ b/conf/airframes/TUDELFT/tudelft_heli450.xml @@ -126,13 +126,13 @@ - - - + + + - - - + + +
diff --git a/conf/airframes/examples/course_bebop_colorfilter.xml b/conf/airframes/examples/course_bebop_colorfilter.xml index e0ba6ffc45..cededd7f9c 100644 --- a/conf/airframes/examples/course_bebop_colorfilter.xml +++ b/conf/airframes/examples/course_bebop_colorfilter.xml @@ -128,26 +128,6 @@ -
- - - - - - - - - - - - - - - - -
- -
diff --git a/conf/airframes/examples/quadrotor_lisa_mx.xml b/conf/airframes/examples/quadrotor_lisa_mx.xml index 09570f33dd..611a31449e 100644 --- a/conf/airframes/examples/quadrotor_lisa_mx.xml +++ b/conf/airframes/examples/quadrotor_lisa_mx.xml @@ -117,13 +117,13 @@ - - - + + + - - - + + +
diff --git a/sw/airborne/firmwares/rotorcraft/stabilization/stabilization_rate.c b/sw/airborne/firmwares/rotorcraft/stabilization/stabilization_rate.c index dfac8bbe7e..270d6e9c62 100644 --- a/sw/airborne/firmwares/rotorcraft/stabilization/stabilization_rate.c +++ b/sw/airborne/firmwares/rotorcraft/stabilization/stabilization_rate.c @@ -211,9 +211,9 @@ void stabilization_rate_run(bool in_flight) stabilization_rate_fb_cmd.r = stabilization_rate_gain.r * _error.r + OFFSET_AND_ROUND2((stabilization_rate_igain.r * stabilization_rate_sum_err.r), 6); - stabilization_cmd[COMMAND_ROLL] = stabilization_rate_fb_cmd.p >> 11; - stabilization_cmd[COMMAND_PITCH] = stabilization_rate_fb_cmd.q >> 11; - stabilization_cmd[COMMAND_YAW] = stabilization_rate_fb_cmd.r >> 11; + stabilization_cmd[COMMAND_ROLL] = stabilization_rate_fb_cmd.p >> 12; + stabilization_cmd[COMMAND_PITCH] = stabilization_rate_fb_cmd.q >> 12; + stabilization_cmd[COMMAND_YAW] = stabilization_rate_fb_cmd.r >> 12; /* bound the result */ BoundAbs(stabilization_cmd[COMMAND_ROLL], MAX_PPRZ);