|
|
|
@ -528,8 +528,8 @@ bool Plane::verify_takeoff()
@@ -528,8 +528,8 @@ bool Plane::verify_takeoff()
|
|
|
|
|
float takeoff_course = wrap_PI(radians(gps.ground_course_cd()*0.01f)) - steer_state.locked_course_err; |
|
|
|
|
takeoff_course = wrap_PI(takeoff_course); |
|
|
|
|
steer_state.hold_course_cd = wrap_360_cd(degrees(takeoff_course)*100); |
|
|
|
|
gcs().send_text(MAV_SEVERITY_INFO, "Holding course %ld at %.1fm/s (%.1f)", |
|
|
|
|
steer_state.hold_course_cd, |
|
|
|
|
gcs().send_text(MAV_SEVERITY_INFO, "Holding course %d at %.1fm/s (%.1f)", |
|
|
|
|
(int)steer_state.hold_course_cd, |
|
|
|
|
(double)gps.ground_speed(), |
|
|
|
|
(double)degrees(steer_state.locked_course_err)); |
|
|
|
|
} |
|
|
|
@ -741,7 +741,7 @@ bool Plane::verify_loiter_to_alt(const AP_Mission::Mission_Command &cmd)
@@ -741,7 +741,7 @@ bool Plane::verify_loiter_to_alt(const AP_Mission::Mission_Command &cmd)
|
|
|
|
|
if (labs(loiter.sum_cd) > 1 && (loiter.reached_target_alt || loiter.unable_to_acheive_target_alt)) { |
|
|
|
|
// primary goal completed, initialize secondary heading goal
|
|
|
|
|
if (loiter.unable_to_acheive_target_alt) { |
|
|
|
|
gcs().send_text(MAV_SEVERITY_INFO,"Loiter to alt was stuck at %d", current_loc.alt/100); |
|
|
|
|
gcs().send_text(MAV_SEVERITY_INFO,"Loiter to alt was stuck at %d", int(current_loc.alt/100)); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
condition_value = 1; |
|
|
|
|