Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-24 01:28:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

Sub: Handle NAV_CONTROLLER_OUTPUT.wp_dist overflowing

Browse Source
This commit is contained in:
Michael du Breuil 2017-06-18 22:39:46 -07:00 committed by Francisco Ferreira
parent 8691eae679
commit df15a82f88
1 changed files with 6 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
ArduSub/GCS_Mavlink.cpp
View File

@ -272,12 +272,12 @@ void NOINLINE Sub::send_nav_controller_output(mavlink_channel_t chan)
const Vector3f &targets = attitude_control.get_att_target_euler_cd(); const Vector3f &targets = attitude_control.get_att_target_euler_cd();
mavlink_msg_nav_controller_output_send( mavlink_msg_nav_controller_output_send(
chan, chan,
targets.x / 1.0e2f, targets.x * 1.0e-2f,
targets.y / 1.0e2f, targets.y * 1.0e-2f,
targets.z / 1.0e2f, targets.z * 1.0e-2f,
wp_nav.get_wp_bearing_to_destination() / 1.0e2f, wp_nav.get_wp_bearing_to_destination() * 1.0e-2f,
wp_nav.get_wp_distance_to_destination() / 1.0e2f, MIN(wp_nav.get_wp_distance_to_destination() * 1.0e-2f, UINT16_MAX),
pos_control.get_alt_error() / 1.0e2f, pos_control.get_alt_error() * 1.0e-2f,
0, 0,
0); 0);
} }