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()); }
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()); }