1、加速計狀態(tài)
使用命令MAV_CMD_PREFLIGHT_CALIBRATION_ACC
mavlink_msg_command_long_pack(1, 200, &message, system_id, component_id, MAV_CMD_PREFLIGHT_CALIBRATION_ACC, 0, 0, 0, 0, 0, 0, 0, 0);

然后，需要等待接收到MAVLink設(shè)備發(fā)送回來的加速計狀態(tài)信息。在接收到MAV_CMD_PREFLIGHT_CALIBRATION_ACC命令的響應(yīng)消息時，設(shè)備會發(fā)送一個MAV_CMD_PREFLIGHT_CALIBRATION_ACC消息。

// Handle responses to the calibration request
if (message.msgid == MAVLINK_MSG_ID_PREFLIGHT_CALIBRATION) {
mavlink_preflight_calibration_t calibration;
mavlink_msg_preflight_calibration_decode(&message, &calibration);
uint8_t acc_result = calibration.accel_calibration;
if (acc_result == 0) {
// Accelerometer calibration is not complete
} else if (acc_result == 3) {
// Accelerometer calibration is successful
} else {
// Accelerometer calibration failed
}
}

在上面的代碼示例中，我們接收到MAV_CMD_PREFLIGHT_CALIBRATION_ACC消息后，解碼消息并檢查其中accel_calibration字段的值，以確定加速計狀態(tài)是否正常。如果accel_calibration值為0，則說明加速計校準尚未完成。如果accel_calibration值為3，則說明加速計校準完成，并且狀態(tài)正常。如果accel_calibration的值為其他數(shù)字，則說明加速計校準失敗。
需要注意的是，上面的代碼示例僅提供了獲取加速計狀態(tài)信息的一個例子。你需要根據(jù)你的具體需求調(diào)整代碼來獲取其他MAVLink消息，或者發(fā)送不同的請求，以獲取不同的狀態(tài)信息。同時也需要了解你所連接的MAVLink設(shè)備所支持的命令和消息。

2、GPS狀態(tài)
需要向MAVLink設(shè)備發(fā)送一個請求消息，以獲取最近一次的GPS狀態(tài)信息。在MAVLink協(xié)議中，GPS狀態(tài)信息是使用GPS_STATUS消息獲取的。因此，我們可以發(fā)送一個GPS_STATUS消息以請求GPS狀態(tài)信息。
mavlink_msg_gps_status_pack(1, 200, &message, system_id, component_id, 0, 0);
然后，需要等待接收到MAVLink設(shè)備發(fā)送回來的GPS狀態(tài)信息。在接收到GPS_STATUS消息時，設(shè)備會發(fā)送一個GPS_STATUS消息。
// Handle GPS status messages
if (message.msgid == MAVLINK_MSG_ID_GPS_STATUS) {
mavlink_gps_status_t gps_status;
mavlink_msg_gps_status_decode(&message, &gps_status);
uint8_t fix_type = gps_status.fix_type; // 0: no fix, 2: 2D fix, 3: 3D fix
uint8_t num_sats = gps_status.satellites_visible;
if (fix_type > 1 && num_sats >= 5) {
// GPS is working with a fix
} else {
// GPS is not working properly
}
}
在上面的代碼示例中，我們接收到GPS_STATUS消息后，解碼消息并檢查其中的fix_type和satellites_visible字段的值，以確定GPS狀態(tài)是否正常。如果fix_type大于1并且satellites_visible大于等于5，則說明GPS有有效的定位狀態(tài)。否則說明GPS沒有有效的定位狀態(tài)，可能需要更好的天線或者更好的地理環(huán)境。

3、RTK狀態(tài)
需要向MAVLink設(shè)備發(fā)送一個請求消息，以獲取最近一次的RTK狀態(tài)信息。在MAVLink協(xié)議中，RTK狀態(tài)信息是使用GPS2_RTK消息獲取的。因此，我們可以發(fā)送一個GPS2_RTK消息以請求RTK狀態(tài)信息。
// Send a request message for the GPS2 RTK status
mavlink_msg_gps2_rtk_pack(1, 200, &message, system_id, component_id, 0, 0, 0);
然后，需要等待接收到MAVLink設(shè)備發(fā)送回來的RTK狀態(tài)信息。在接收到GPS2_RTK消息時，設(shè)備會發(fā)送一個GPS2_RTK消息。
// Handle the GPS2 RTK message
if (message.msgid == MAVLINK_MSG_ID_GPS2_RTK) {
mavlink_gps2_rtk_t gps2_rtk;
mavlink_msg_gps2_rtk_decode(&message, &gps2_rtk);
uint8_t fix_type = gps2_rtk.rtk_receiver_id; // 0: no fix, 1: float fix, 2: fixed fix
uint16_t num_sats = gps2_rtk.satellites_visible;
if (fix_type > 1 && num_sats >= 5) {
// RTK is working with a fixed solution
} else if (fix_type > 0 && num_sats >= 5) {
// RTK is working with a float solution
} else {
// RTK is not working properly
}
}
在上面的代碼示例中，我們接收到GPS2_RTK消息后，解碼消息并檢查其中的fix_type和satellites_visible字段的值，以確定RTK狀態(tài)是否正常。如果fix_type等于2（固定解），并且satellites_visible大于等于5，則說明RTK定位正常。如果fix_type等于1（浮點解），并且satellites_visible大于等于5，則說明RTK在轉(zhuǎn)動階段，此時無法獲得固定的解，但是可能會在稍后成功。否則說明RTK沒有解決問題，并且可能需要更好的天線或者更好的地理環(huán)境。

4、搖桿連接狀態(tài)
需要等待接收到MAVLink設(shè)備發(fā)送搖桿狀態(tài)信息。在接收到RC_CHANNELS消息時，設(shè)備會發(fā)送一個RC_CHANNLS消息。
// Handle the RC_CHANNELS message
if (message.msgid == MAVLINK_MSG_ID_RC_CHANNELS) {
mavlink_rc_channels_t rc_channels;
mavlink_msg_rc_channels_decode(&message, &rc_channels);
if (rc_channels.chancount > 0) {
// Joystick is connected and working properly
} else {
// Joystick is not connected or not working properly
}
}
在上面的代碼示例中，我們接收到RC_CHANNELS消息后，解碼消息并檢查其中的chancount字段的值，以確定搖桿狀態(tài)是否正常。如果chancount大于0，則說明搖桿連接正常，搖桿信號能被設(shè)備捕捉到，如果chancount等于0，則說明搖桿沒有連接，或者連接存在問題，設(shè)備沒能捕捉到搖桿信號。

5、羅盤狀態(tài)
需要等待接收到MAVLink設(shè)備發(fā)送羅盤狀態(tài)信息。在接收到COMPASS_STATUS消息時，設(shè)備會發(fā)送一個COMPASS_STATUS消息。
// Handle the COMPASS_STATUS message
if (message.msgid == MAVLINK_MSG_ID_COMPASS_STATUS) {
mavlink_compass_status_t compass_status;
mavlink_msg_compass_status_decode(&message, &compass_status);
uint8_t mag_status = compass_status.calibration_status; // 0: uncalibrated, 1: calibrating, 2: calibrated
if (mag_status == 2) {
// Compass is calibrated and working properly
} else {
// Compass is not calibrated or not working properly
}
}