Browse Source

Copter: control_stabilize - much renaming as xy pos controller moves

master
Randy Mackay 11 years ago committed by Andrew Tridgell
parent
commit
9843e93308
  1. 10
      ArduCopter/control_stabilize.pde

10
ArduCopter/control_stabilize.pde

@ -197,12 +197,8 @@ static void auto_run() @@ -197,12 +197,8 @@ static void auto_run()
// run way point controller
// copy latest output from nav controller to stabilize controller
control_roll = wp_nav.get_desired_roll();
control_pitch = wp_nav.get_desired_pitch();
// copy angle targets for reporting purposes
angle_target.x = control_roll;
angle_target.y = control_pitch;
angle_target.x = wp_nav.get_roll();
angle_target.y = wp_nav.get_pitch();
// To-Do: handle pilot input for yaw and different methods to update yaw (ROI, face next wp)
angle_target.z = control_yaw;
@ -297,7 +293,7 @@ static void loiter_run() @@ -297,7 +293,7 @@ static void loiter_run()
wp_nav.update_loiter();
// call attitude controller
attitude_control.angleef_rp_rateef_y(wp_nav.get_desired_roll(), wp_nav.get_desired_pitch(), target_yaw_rate);
attitude_control.angleef_rp_rateef_y(wp_nav.get_roll(), wp_nav.get_pitch(), target_yaw_rate);
// body-frame rate controller is run directly from 100hz loop

Loading…
Cancel
Save