static void NOINLINE send_ahrs(mavlink_channel_t chan)
{
    //Vector3f omega_I = ahrs.get_gyro_drift();
    mavlink_msg_ahrs_send(
        chan,
        ++buf[8],//omega_I.x,
        ++buf[9],//omega_I.y,
        ++buf[10],//omega_I.z,
        1,
        0,
        ++buf[11],//ahrs.get_error_rp(),
        ++buf[12]);//ahrs.get_error_yaw());
}
Exemple #2
0
void GCS_MAVLINK::send_ahrs(AP_AHRS &ahrs)
{
    const Vector3f &omega_I = ahrs.get_gyro_drift();
    mavlink_msg_ahrs_send(
        chan,
        omega_I.x,
        omega_I.y,
        omega_I.z,
        0,
        0,
        ahrs.get_error_rp(),
        ahrs.get_error_yaw());
}