|
|
|
@ -1496,8 +1496,10 @@ void GCS_MAVLINK::send_local_position() const
@@ -1496,8 +1496,10 @@ void GCS_MAVLINK::send_local_position() const
|
|
|
|
|
/*
|
|
|
|
|
send VIBRATION message |
|
|
|
|
*/ |
|
|
|
|
void GCS_MAVLINK::send_vibration(const AP_InertialSensor &ins) const |
|
|
|
|
void GCS_MAVLINK::send_vibration() const |
|
|
|
|
{ |
|
|
|
|
const AP_InertialSensor &ins = AP::ins(); |
|
|
|
|
|
|
|
|
|
Vector3f vibration = ins.get_vibration_levels(); |
|
|
|
|
|
|
|
|
|
mavlink_msg_vibration_send( |
|
|
|
@ -2671,6 +2673,11 @@ bool GCS_MAVLINK::try_send_message(const enum ap_message id)
@@ -2671,6 +2673,11 @@ bool GCS_MAVLINK::try_send_message(const enum ap_message id)
|
|
|
|
|
send_ahrs(); |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case MSG_VIBRATION: |
|
|
|
|
CHECK_PAYLOAD_SIZE(VIBRATION); |
|
|
|
|
send_vibration(); |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
default: |
|
|
|
|
// try_send_message must always at some stage return true for
|
|
|
|
|
// a message, or we will attempt to infinitely retry the
|
|
|
|
|