aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Plane: print to GCS the newly calculated glide slope angle

Browse Source
This commit is contained in:
Tom Pittenger 2016-05-13 23:04:38 -07:00
parent f048aafb76
commit a1c4103cef
1 changed files with 5 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
ArduPlane/landing.cpp
View File

@ -180,9 +180,12 @@ void Plane::adjust_landing_slope_for_rangefinder_bump(void)
float top_of_glide_slope_alt_m = total_distance_m * corrected_alt_m / auto_state.wp_distance;
prev_WP_loc.alt = top_of_glide_slope_alt_m*100 + next_WP_loc.alt;
// re-calculate with updated prev_WP_loc
// re-calculate auto_state.land_slope with updated prev_WP_loc
setup_landing_glide_slope();
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_CRITICAL, "Slope re-calculated");
float new_slope_deg = degrees(atan(auto_state.land_slope));
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, "Landing glide slope re-calculated as %.1f degrees", (double)new_slope_deg);
#endif
}