|
|
|
@ -75,7 +75,7 @@ static void circle_run()
@@ -75,7 +75,7 @@ static void circle_run()
|
|
|
|
|
// run altitude controller |
|
|
|
|
if (sonar_alt_health >= SONAR_ALT_HEALTH_MAX) { |
|
|
|
|
// if sonar is ok, use surface tracking |
|
|
|
|
target_climb_rate = get_throttle_surface_tracking(target_climb_rate, pos_control.get_alt_target(), G_Dt); |
|
|
|
|
target_climb_rate = get_surface_tracking_climb_rate(target_climb_rate, pos_control.get_alt_target(), G_Dt); |
|
|
|
|
} |
|
|
|
|
// update altitude target and call position controller |
|
|
|
|
pos_control.set_alt_target_from_climb_rate(target_climb_rate, G_Dt); |
|
|
|
|