|
|
|
@ -51,9 +51,6 @@ Sub::Sub(void)
@@ -51,9 +51,6 @@ Sub::Sub(void)
|
|
|
|
|
pos_control(ahrs_view, inertial_nav, motors, attitude_control, |
|
|
|
|
g.p_alt_hold, g.p_vel_z, g.pid_accel_z, |
|
|
|
|
g.p_pos_xy, g.pi_vel_xy), |
|
|
|
|
#if AVOIDANCE_ENABLED == ENABLED |
|
|
|
|
avoid(ahrs, inertial_nav, fence, g2.proximity), |
|
|
|
|
#endif |
|
|
|
|
wp_nav(inertial_nav, ahrs_view, pos_control, attitude_control), |
|
|
|
|
circle_nav(inertial_nav, ahrs_view, pos_control), |
|
|
|
|
pmTest1(0), |
|
|
|
|