|
|
@ -1568,6 +1568,50 @@ static void mavlink_test_ahrs3(uint8_t system_id, uint8_t component_id, mavlink_ |
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static void mavlink_test_autopilot_version_request(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
mavlink_message_t msg; |
|
|
|
|
|
|
|
uint8_t buffer[MAVLINK_MAX_PACKET_LEN]; |
|
|
|
|
|
|
|
uint16_t i; |
|
|
|
|
|
|
|
mavlink_autopilot_version_request_t packet_in = { |
|
|
|
|
|
|
|
5,72 |
|
|
|
|
|
|
|
}; |
|
|
|
|
|
|
|
mavlink_autopilot_version_request_t packet1, packet2; |
|
|
|
|
|
|
|
memset(&packet1, 0, sizeof(packet1)); |
|
|
|
|
|
|
|
packet1.target_system = packet_in.target_system; |
|
|
|
|
|
|
|
packet1.target_component = packet_in.target_component; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
|
|
|
mavlink_msg_autopilot_version_request_encode(system_id, component_id, &msg, &packet1); |
|
|
|
|
|
|
|
mavlink_msg_autopilot_version_request_decode(&msg, &packet2); |
|
|
|
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
|
|
|
mavlink_msg_autopilot_version_request_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component ); |
|
|
|
|
|
|
|
mavlink_msg_autopilot_version_request_decode(&msg, &packet2); |
|
|
|
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
|
|
|
mavlink_msg_autopilot_version_request_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component ); |
|
|
|
|
|
|
|
mavlink_msg_autopilot_version_request_decode(&msg, &packet2); |
|
|
|
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
|
|
|
mavlink_msg_to_send_buffer(buffer, &msg); |
|
|
|
|
|
|
|
for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) { |
|
|
|
|
|
|
|
comm_send_ch(MAVLINK_COMM_0, buffer[i]); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
mavlink_msg_autopilot_version_request_decode(last_msg, &packet2); |
|
|
|
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
|
|
|
mavlink_msg_autopilot_version_request_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component ); |
|
|
|
|
|
|
|
mavlink_msg_autopilot_version_request_decode(last_msg, &packet2); |
|
|
|
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
static void mavlink_test_gimbal_report(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg) |
|
|
|
static void mavlink_test_gimbal_report(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg) |
|
|
|
{ |
|
|
|
{ |
|
|
|
mavlink_message_t msg; |
|
|
|
mavlink_message_t msg; |
|
|
@ -1706,6 +1750,7 @@ static void mavlink_test_ardupilotmega(uint8_t system_id, uint8_t component_id, |
|
|
|
mavlink_test_camera_feedback(system_id, component_id, last_msg); |
|
|
|
mavlink_test_camera_feedback(system_id, component_id, last_msg); |
|
|
|
mavlink_test_battery2(system_id, component_id, last_msg); |
|
|
|
mavlink_test_battery2(system_id, component_id, last_msg); |
|
|
|
mavlink_test_ahrs3(system_id, component_id, last_msg); |
|
|
|
mavlink_test_ahrs3(system_id, component_id, last_msg); |
|
|
|
|
|
|
|
mavlink_test_autopilot_version_request(system_id, component_id, last_msg); |
|
|
|
mavlink_test_gimbal_report(system_id, component_id, last_msg); |
|
|
|
mavlink_test_gimbal_report(system_id, component_id, last_msg); |
|
|
|
mavlink_test_gimbal_control(system_id, component_id, last_msg); |
|
|
|
mavlink_test_gimbal_control(system_id, component_id, last_msg); |
|
|
|
} |
|
|
|
} |
|
|
|