|
|
|
@ -4839,6 +4839,120 @@ static void mavlink_test_log_request_end(uint8_t system_id, uint8_t component_id
@@ -4839,6 +4839,120 @@ static void mavlink_test_log_request_end(uint8_t system_id, uint8_t component_id
|
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static void mavlink_test_gps_inject_data(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_gps_inject_data_t packet_in = { |
|
|
|
|
5, |
|
|
|
|
}72, |
|
|
|
|
}139, |
|
|
|
|
}{ 206, 207, 208, 209, 210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220, 221, 222, 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254, 255, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59 }, |
|
|
|
|
}; |
|
|
|
|
mavlink_gps_inject_data_t packet1, packet2; |
|
|
|
|
memset(&packet1, 0, sizeof(packet1)); |
|
|
|
|
packet1.target_system = packet_in.target_system; |
|
|
|
|
packet1.target_component = packet_in.target_component; |
|
|
|
|
packet1.len = packet_in.len; |
|
|
|
|
|
|
|
|
|
mav_array_memcpy(packet1.data, packet_in.data, sizeof(uint8_t)*110); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
mavlink_msg_gps_inject_data_encode(system_id, component_id, &msg, &packet1); |
|
|
|
|
mavlink_msg_gps_inject_data_decode(&msg, &packet2); |
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
mavlink_msg_gps_inject_data_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.len , packet1.data ); |
|
|
|
|
mavlink_msg_gps_inject_data_decode(&msg, &packet2); |
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
mavlink_msg_gps_inject_data_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.len , packet1.data ); |
|
|
|
|
mavlink_msg_gps_inject_data_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_gps_inject_data_decode(last_msg, &packet2); |
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
mavlink_msg_gps_inject_data_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.len , packet1.data ); |
|
|
|
|
mavlink_msg_gps_inject_data_decode(last_msg, &packet2); |
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static void mavlink_test_gps2_raw(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_gps2_raw_t packet_in = { |
|
|
|
|
93372036854775807ULL, |
|
|
|
|
}963497880, |
|
|
|
|
}963498088, |
|
|
|
|
}963498296, |
|
|
|
|
}963498504, |
|
|
|
|
}18483, |
|
|
|
|
}18587, |
|
|
|
|
}18691, |
|
|
|
|
}18795, |
|
|
|
|
}101, |
|
|
|
|
}168, |
|
|
|
|
}235, |
|
|
|
|
}; |
|
|
|
|
mavlink_gps2_raw_t packet1, packet2; |
|
|
|
|
memset(&packet1, 0, sizeof(packet1)); |
|
|
|
|
packet1.time_usec = packet_in.time_usec; |
|
|
|
|
packet1.lat = packet_in.lat; |
|
|
|
|
packet1.lon = packet_in.lon; |
|
|
|
|
packet1.alt = packet_in.alt; |
|
|
|
|
packet1.dgps_age = packet_in.dgps_age; |
|
|
|
|
packet1.eph = packet_in.eph; |
|
|
|
|
packet1.epv = packet_in.epv; |
|
|
|
|
packet1.vel = packet_in.vel; |
|
|
|
|
packet1.cog = packet_in.cog; |
|
|
|
|
packet1.fix_type = packet_in.fix_type; |
|
|
|
|
packet1.satellites_visible = packet_in.satellites_visible; |
|
|
|
|
packet1.dgps_numch = packet_in.dgps_numch; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
mavlink_msg_gps2_raw_encode(system_id, component_id, &msg, &packet1); |
|
|
|
|
mavlink_msg_gps2_raw_decode(&msg, &packet2); |
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
mavlink_msg_gps2_raw_pack(system_id, component_id, &msg , packet1.time_usec , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.eph , packet1.epv , packet1.vel , packet1.cog , packet1.satellites_visible , packet1.dgps_numch , packet1.dgps_age ); |
|
|
|
|
mavlink_msg_gps2_raw_decode(&msg, &packet2); |
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
mavlink_msg_gps2_raw_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.eph , packet1.epv , packet1.vel , packet1.cog , packet1.satellites_visible , packet1.dgps_numch , packet1.dgps_age ); |
|
|
|
|
mavlink_msg_gps2_raw_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_gps2_raw_decode(last_msg, &packet2); |
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
|
|
|
|
|
memset(&packet2, 0, sizeof(packet2)); |
|
|
|
|
mavlink_msg_gps2_raw_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.eph , packet1.epv , packet1.vel , packet1.cog , packet1.satellites_visible , packet1.dgps_numch , packet1.dgps_age ); |
|
|
|
|
mavlink_msg_gps2_raw_decode(last_msg, &packet2); |
|
|
|
|
MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static void mavlink_test_power_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg) |
|
|
|
|
{ |
|
|
|
|
mavlink_message_t msg; |
|
|
|
@ -5440,6 +5554,8 @@ static void mavlink_test_common(uint8_t system_id, uint8_t component_id, mavlink
@@ -5440,6 +5554,8 @@ static void mavlink_test_common(uint8_t system_id, uint8_t component_id, mavlink
|
|
|
|
|
mavlink_test_log_data(system_id, component_id, last_msg); |
|
|
|
|
mavlink_test_log_erase(system_id, component_id, last_msg); |
|
|
|
|
mavlink_test_log_request_end(system_id, component_id, last_msg); |
|
|
|
|
mavlink_test_gps_inject_data(system_id, component_id, last_msg); |
|
|
|
|
mavlink_test_gps2_raw(system_id, component_id, last_msg); |
|
|
|
|
mavlink_test_power_status(system_id, component_id, last_msg); |
|
|
|
|
mavlink_test_battery_status(system_id, component_id, last_msg); |
|
|
|
|
mavlink_test_setpoint_8dof(system_id, component_id, last_msg); |
|
|
|
|