Plane: call airspeed MAVLink logging function

This commit is contained in:
Andrew Tridgell 2013-08-28 22:36:59 +10:00
parent 5cec9b65c9
commit 8733391315

View File

@ -2221,3 +2221,19 @@ void gcs_send_text_fmt(const prog_char_t *fmt, ...)
}
}
/*
send airspeed calibration data
*/
static void gcs_send_airspeed_calibration(const Vector3f &vg)
{
if (comm_get_txspace(MAVLINK_COMM_0) - MAVLINK_NUM_NON_PAYLOAD_BYTES >=
MAVLINK_MSG_ID_AIRSPEED_AUTOCAL_LEN) {
airspeed.log_mavlink_send(MAVLINK_COMM_0, vg);
}
if (gcs3.initialised) {
if (comm_get_txspace(MAVLINK_COMM_1) - MAVLINK_NUM_NON_PAYLOAD_BYTES >=
MAVLINK_MSG_ID_AIRSPEED_AUTOCAL_LEN) {
airspeed.log_mavlink_send(MAVLINK_COMM_1, vg);
}
}
}