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

Plane: use common send_ahrs2()

Browse Source
This commit is contained in:
Andrew Tridgell 2014-01-04 11:30:42 +11:00
parent 9aea781248
commit 4646682a31
1 changed files with 1 additions and 19 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

20
ArduPlane/GCS_Mavlink.pde
View File

@ -527,24 +527,6 @@ static void NOINLINE send_simstate(mavlink_channel_t chan)
#endif
}
// report NavEKF state
static void NOINLINE send_ekf(mavlink_channel_t chan)
{
#if AP_AHRS_NAVEKF_AVAILABLE
Vector3f euler;
struct Location loc;
if (ahrs.get_secondary_attitude(euler) && ahrs.get_secondary_position(loc)) {
mavlink_msg_ahrs2_send(chan,
euler.x,
euler.y,
euler.z,
loc.alt*1.0e-2f,
loc.lat,
loc.lng);
}
#endif
}
static void NOINLINE send_hwstatus(mavlink_channel_t chan)
{
mavlink_msg_hwstatus_send(
@ -745,7 +727,7 @@ static bool mavlink_try_send_message(mavlink_channel_t chan, enum ap_message id)
CHECK_PAYLOAD_SIZE(SIMSTATE);
send_simstate(chan);
CHECK_PAYLOAD_SIZE(AHRS2);
send_ekf(chan);
gcs[chan-MAVLINK_COMM_0].send_ahrs2(ahrs);
break;
case MSG_HWSTATUS: