Browse Source

remove bogus dt from att rate

sbg
Lorenz Meier 12 years ago
parent
commit
42c61271ea
  1. 2
      apps/multirotor_att_control/multirotor_attitude_control.c

2
apps/multirotor_att_control/multirotor_attitude_control.c

@ -249,7 +249,7 @@ void multirotor_control_attitude(const struct vehicle_attitude_setpoint_s *att_s @@ -249,7 +249,7 @@ void multirotor_control_attitude(const struct vehicle_attitude_setpoint_s *att_s
att->roll, att->rollspeed, deltaT);
/* control yaw rate */
rates_sp->yaw= deltaT * p.yaw_p * atan2f(sinf(att->yaw - att_sp->yaw_body), cosf(att->yaw - att_sp->yaw_body));
rates_sp->yaw = p.yaw_p * atan2f(sinf(att->yaw - att_sp->yaw_body), cosf(att->yaw - att_sp->yaw_body));

Loading…
Cancel
Save