include_v0.9/test/testsuite.h

Go to the documentation of this file.

#ifndef TEST_TESTSUITE_H
#define TEST_TESTSUITE_H

#ifdef __cplusplus
extern "C" {
#endif

#ifndef MAVLINK_TEST_ALL
#define MAVLINK_TEST_ALL

static void mavlink_test_test(uint8_t, uint8_t, mavlink_message_t *last_msg);

static void mavlink_test_all(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
{

        mavlink_test_test(system_id, component_id, last_msg);
}
#endif




static void mavlink_test_test_types(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_test_types_t packet_in = {
                'A',
        "BCDEFGHIJ",
        230,
        17859,
        963498192,
        93372036854776941ULL,
        211,
        18639,
        963498972,
        93372036854777886LL,
        304.0,
        438.0,
        { 228, 229, 230 },
        { 20147, 20148, 20149 },
        { 963500688, 963500689, 963500690 },
        { 93372036854780469, 93372036854780470, 93372036854780471 },
        { 171, 172, 173 },
        { 22487, 22488, 22489 },
        { 963503028, 963503029, 963503030 },
        { 93372036854783304, 93372036854783305, 93372036854783306 },
        { 1018.0, 1019.0, 1020.0 },
        { 1208.0, 1209.0, 1210.0 },
        };
        mavlink_test_types_t packet1, packet2;
        memset(&packet1, 0, sizeof(packet1));
                packet1.c = packet_in.c;
                packet1.u8 = packet_in.u8;
                packet1.u16 = packet_in.u16;
                packet1.u32 = packet_in.u32;
                packet1.u64 = packet_in.u64;
                packet1.s8 = packet_in.s8;
                packet1.s16 = packet_in.s16;
                packet1.s32 = packet_in.s32;
                packet1.s64 = packet_in.s64;
                packet1.f = packet_in.f;
                packet1.d = packet_in.d;
        
                mav_array_memcpy(packet1.s, packet_in.s, sizeof(char)*10);
                mav_array_memcpy(packet1.u8_array, packet_in.u8_array, sizeof(uint8_t)*3);
                mav_array_memcpy(packet1.u16_array, packet_in.u16_array, sizeof(uint16_t)*3);
                mav_array_memcpy(packet1.u32_array, packet_in.u32_array, sizeof(uint32_t)*3);
                mav_array_memcpy(packet1.u64_array, packet_in.u64_array, sizeof(uint64_t)*3);
                mav_array_memcpy(packet1.s8_array, packet_in.s8_array, sizeof(int8_t)*3);
                mav_array_memcpy(packet1.s16_array, packet_in.s16_array, sizeof(int16_t)*3);
                mav_array_memcpy(packet1.s32_array, packet_in.s32_array, sizeof(int32_t)*3);
                mav_array_memcpy(packet1.s64_array, packet_in.s64_array, sizeof(int64_t)*3);
                mav_array_memcpy(packet1.f_array, packet_in.f_array, sizeof(float)*3);
                mav_array_memcpy(packet1.d_array, packet_in.d_array, sizeof(double)*3);
        

        memset(&packet2, 0, sizeof(packet2));
        mavlink_msg_test_types_encode(system_id, component_id, &msg, &packet1);
        mavlink_msg_test_types_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
        mavlink_msg_test_types_pack(system_id, component_id, &msg , packet1.c , packet1.s , packet1.u8 , packet1.u16 , packet1.u32 , packet1.u64 , packet1.s8 , packet1.s16 , packet1.s32 , packet1.s64 , packet1.f , packet1.d , packet1.u8_array , packet1.u16_array , packet1.u32_array , packet1.u64_array , packet1.s8_array , packet1.s16_array , packet1.s32_array , packet1.s64_array , packet1.f_array , packet1.d_array );
        mavlink_msg_test_types_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
        mavlink_msg_test_types_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.c , packet1.s , packet1.u8 , packet1.u16 , packet1.u32 , packet1.u64 , packet1.s8 , packet1.s16 , packet1.s32 , packet1.s64 , packet1.f , packet1.d , packet1.u8_array , packet1.u16_array , packet1.u32_array , packet1.u64_array , packet1.s8_array , packet1.s16_array , packet1.s32_array , packet1.s64_array , packet1.f_array , packet1.d_array );
        mavlink_msg_test_types_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_test_types_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
        
        memset(&packet2, 0, sizeof(packet2));
        mavlink_msg_test_types_send(MAVLINK_COMM_1 , packet1.c , packet1.s , packet1.u8 , packet1.u16 , packet1.u32 , packet1.u64 , packet1.s8 , packet1.s16 , packet1.s32 , packet1.s64 , packet1.f , packet1.d , packet1.u8_array , packet1.u16_array , packet1.u32_array , packet1.u64_array , packet1.s8_array , packet1.s16_array , packet1.s32_array , packet1.s64_array , packet1.f_array , packet1.d_array );
        mavlink_msg_test_types_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
}

static void mavlink_test_test(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
{
        mavlink_test_test_types(system_id, component_id, last_msg);
}

#ifdef __cplusplus
}
#endif // __cplusplus
#endif // TEST_TESTSUITE_H