mirror of https://github.com/ArduPilot/ardupilot
Copter: Handle NAV_CONTROLLER_OUTPUT.wp_dist overflowing
This commit is contained in:
parent
df15a82f88
commit
f0cb234228
|
@ -164,12 +164,12 @@ void NOINLINE Copter::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_bearing / 1.0e2f,
|
wp_bearing * 1.0e-2f,
|
||||||
wp_distance / 1.0e2f,
|
MIN(wp_distance * 1.0e-2f, UINT16_MAX),
|
||||||
pos_control->get_alt_error() / 1.0e2f,
|
pos_control->get_alt_error() * 1.0e-2f,
|
||||||
0,
|
0,
|
||||||
0);
|
0);
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue