Browse Source

Added limit to heading command

sbg
Lorenz Meier 12 years ago
parent
commit
81acd98997
  1. 9
      src/examples/fixedwing_control/main.c

9
src/examples/fixedwing_control/main.c

@ -154,7 +154,14 @@ void control_heading(const struct vehicle_global_position_s *pos, const struct v
/* calculate heading error */ /* calculate heading error */
float yaw_err = att->yaw - bearing; float yaw_err = att->yaw - bearing;
/* apply control gain */ /* apply control gain */
att_sp->roll_body = yaw_err * p.hdng_p; float roll_command = yaw_err * p.hdng_p;
/* limit output, this commonly is a tuning parameter, too */
if (att_sp->roll_body < -0.5f) {
att_sp->roll_body = -0.5f;
} else if (att_sp->roll_body > 0.5f) {
att_sp->roll_body = 0.5f;
}
} }
/* Main Thread */ /* Main Thread */

Loading…
Cancel
Save