testsuite.h 22.7 KB
Newer Older
lm's avatar
lm committed
1 2 3 4 5 6 7 8 9 10 11 12 13
/** @file
 *	@brief MAVLink comm protocol testsuite generated from slugs.xml
 *	@see http://qgroundcontrol.org/mavlink/
 */
#ifndef SLUGS_TESTSUITE_H
#define SLUGS_TESTSUITE_H

#ifdef __cplusplus
extern "C" {
#endif

#ifndef MAVLINK_TEST_ALL
#define MAVLINK_TEST_ALL
LM's avatar
LM committed
14 15
static void mavlink_test_common(uint8_t, uint8_t, mavlink_message_t *last_msg);
static void mavlink_test_slugs(uint8_t, uint8_t, mavlink_message_t *last_msg);
lm's avatar
lm committed
16

LM's avatar
LM committed
17
static void mavlink_test_all(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
lm's avatar
lm committed
18
{
LM's avatar
LM committed
19 20
	mavlink_test_common(system_id, component_id, last_msg);
	mavlink_test_slugs(system_id, component_id, last_msg);
lm's avatar
lm committed
21 22 23 24 25 26
}
#endif

#include "../common/testsuite.h"


LM's avatar
LM committed
27
static void mavlink_test_cpu_load(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
lm's avatar
lm committed
28 29 30 31
{
	mavlink_message_t msg;
        uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
        uint16_t i;
LM's avatar
LM committed
32
	mavlink_cpu_load_t packet_in = {
lm's avatar
lm committed
33 34 35 36
		17235,
	139,
	206,
	};
LM's avatar
LM committed
37 38 39 40 41 42 43 44 45
	mavlink_cpu_load_t packet1, packet2;
        memset(&packet1, 0, sizeof(packet1));
        	packet1.batVolt = packet_in.batVolt;
        	packet1.sensLoad = packet_in.sensLoad;
        	packet1.ctrlLoad = packet_in.ctrlLoad;
        
        

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
46 47 48
	mavlink_msg_cpu_load_encode(system_id, component_id, &msg, &packet1);
	mavlink_msg_cpu_load_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
LM's avatar
LM committed
49 50

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
51
	mavlink_msg_cpu_load_pack(system_id, component_id, &msg , packet1.sensLoad , packet1.ctrlLoad , packet1.batVolt );
LM's avatar
LM committed
52 53 54 55
	mavlink_msg_cpu_load_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
56
	mavlink_msg_cpu_load_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.sensLoad , packet1.ctrlLoad , packet1.batVolt );
LM's avatar
LM committed
57 58 59 60
	mavlink_msg_cpu_load_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
61 62 63 64
        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]);
        }
LM's avatar
LM committed
65 66 67 68
	mavlink_msg_cpu_load_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
        
        memset(&packet2, 0, sizeof(packet2));
LM's avatar
LM committed
69
	mavlink_msg_cpu_load_send(MAVLINK_COMM_1 , packet1.sensLoad , packet1.ctrlLoad , packet1.batVolt );
LM's avatar
LM committed
70 71
	mavlink_msg_cpu_load_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
lm's avatar
lm committed
72 73
}

LM's avatar
LM committed
74
static void mavlink_test_air_data(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
lm's avatar
lm committed
75 76 77 78
{
	mavlink_message_t msg;
        uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
        uint16_t i;
LM's avatar
LM committed
79
	mavlink_air_data_t packet_in = {
lm's avatar
lm committed
80 81 82 83
		17.0,
	45.0,
	17651,
	};
LM's avatar
LM committed
84 85 86 87 88 89 90 91 92
	mavlink_air_data_t packet1, packet2;
        memset(&packet1, 0, sizeof(packet1));
        	packet1.dynamicPressure = packet_in.dynamicPressure;
        	packet1.staticPressure = packet_in.staticPressure;
        	packet1.temperature = packet_in.temperature;
        
        

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
93 94 95
	mavlink_msg_air_data_encode(system_id, component_id, &msg, &packet1);
	mavlink_msg_air_data_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
LM's avatar
LM committed
96 97

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
98
	mavlink_msg_air_data_pack(system_id, component_id, &msg , packet1.dynamicPressure , packet1.staticPressure , packet1.temperature );
LM's avatar
LM committed
99 100 101 102
	mavlink_msg_air_data_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
103
	mavlink_msg_air_data_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.dynamicPressure , packet1.staticPressure , packet1.temperature );
LM's avatar
LM committed
104 105 106 107
	mavlink_msg_air_data_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
108 109 110 111
        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]);
        }
LM's avatar
LM committed
112 113 114 115
	mavlink_msg_air_data_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
        
        memset(&packet2, 0, sizeof(packet2));
LM's avatar
LM committed
116
	mavlink_msg_air_data_send(MAVLINK_COMM_1 , packet1.dynamicPressure , packet1.staticPressure , packet1.temperature );
LM's avatar
LM committed
117 118
	mavlink_msg_air_data_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
lm's avatar
lm committed
119 120
}

LM's avatar
LM committed
121
static void mavlink_test_sensor_bias(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
lm's avatar
lm committed
122 123 124 125
{
	mavlink_message_t msg;
        uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
        uint16_t i;
LM's avatar
LM committed
126
	mavlink_sensor_bias_t packet_in = {
lm's avatar
lm committed
127 128 129 130 131 132 133
		17.0,
	45.0,
	73.0,
	101.0,
	129.0,
	157.0,
	};
LM's avatar
LM committed
134 135 136 137 138 139 140 141 142 143 144 145
	mavlink_sensor_bias_t packet1, packet2;
        memset(&packet1, 0, sizeof(packet1));
        	packet1.axBias = packet_in.axBias;
        	packet1.ayBias = packet_in.ayBias;
        	packet1.azBias = packet_in.azBias;
        	packet1.gxBias = packet_in.gxBias;
        	packet1.gyBias = packet_in.gyBias;
        	packet1.gzBias = packet_in.gzBias;
        
        

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
146 147 148
	mavlink_msg_sensor_bias_encode(system_id, component_id, &msg, &packet1);
	mavlink_msg_sensor_bias_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
LM's avatar
LM committed
149 150

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
151
	mavlink_msg_sensor_bias_pack(system_id, component_id, &msg , packet1.axBias , packet1.ayBias , packet1.azBias , packet1.gxBias , packet1.gyBias , packet1.gzBias );
LM's avatar
LM committed
152 153 154 155
	mavlink_msg_sensor_bias_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
156
	mavlink_msg_sensor_bias_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.axBias , packet1.ayBias , packet1.azBias , packet1.gxBias , packet1.gyBias , packet1.gzBias );
LM's avatar
LM committed
157 158 159 160
	mavlink_msg_sensor_bias_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
161 162 163 164
        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]);
        }
LM's avatar
LM committed
165 166 167 168
	mavlink_msg_sensor_bias_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
        
        memset(&packet2, 0, sizeof(packet2));
LM's avatar
LM committed
169
	mavlink_msg_sensor_bias_send(MAVLINK_COMM_1 , packet1.axBias , packet1.ayBias , packet1.azBias , packet1.gxBias , packet1.gyBias , packet1.gzBias );
LM's avatar
LM committed
170 171
	mavlink_msg_sensor_bias_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
lm's avatar
lm committed
172 173
}

LM's avatar
LM committed
174
static void mavlink_test_diagnostic(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
lm's avatar
lm committed
175 176 177 178
{
	mavlink_message_t msg;
        uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
        uint16_t i;
LM's avatar
LM committed
179
	mavlink_diagnostic_t packet_in = {
lm's avatar
lm committed
180 181 182 183 184 185 186
		17.0,
	45.0,
	73.0,
	17859,
	17963,
	18067,
	};
LM's avatar
LM committed
187 188 189 190 191 192 193 194 195 196 197 198
	mavlink_diagnostic_t packet1, packet2;
        memset(&packet1, 0, sizeof(packet1));
        	packet1.diagFl1 = packet_in.diagFl1;
        	packet1.diagFl2 = packet_in.diagFl2;
        	packet1.diagFl3 = packet_in.diagFl3;
        	packet1.diagSh1 = packet_in.diagSh1;
        	packet1.diagSh2 = packet_in.diagSh2;
        	packet1.diagSh3 = packet_in.diagSh3;
        
        

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
199 200 201
	mavlink_msg_diagnostic_encode(system_id, component_id, &msg, &packet1);
	mavlink_msg_diagnostic_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
LM's avatar
LM committed
202 203

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
204
	mavlink_msg_diagnostic_pack(system_id, component_id, &msg , packet1.diagFl1 , packet1.diagFl2 , packet1.diagFl3 , packet1.diagSh1 , packet1.diagSh2 , packet1.diagSh3 );
LM's avatar
LM committed
205 206 207 208
	mavlink_msg_diagnostic_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
209
	mavlink_msg_diagnostic_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.diagFl1 , packet1.diagFl2 , packet1.diagFl3 , packet1.diagSh1 , packet1.diagSh2 , packet1.diagSh3 );
LM's avatar
LM committed
210 211 212 213
	mavlink_msg_diagnostic_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
214 215 216 217
        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]);
        }
LM's avatar
LM committed
218 219 220 221
	mavlink_msg_diagnostic_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
        
        memset(&packet2, 0, sizeof(packet2));
LM's avatar
LM committed
222
	mavlink_msg_diagnostic_send(MAVLINK_COMM_1 , packet1.diagFl1 , packet1.diagFl2 , packet1.diagFl3 , packet1.diagSh1 , packet1.diagSh2 , packet1.diagSh3 );
LM's avatar
LM committed
223 224
	mavlink_msg_diagnostic_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
lm's avatar
lm committed
225 226
}

LM's avatar
LM committed
227
static void mavlink_test_slugs_navigation(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
lm's avatar
lm committed
228 229 230 231
{
	mavlink_message_t msg;
        uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
        uint16_t i;
LM's avatar
LM committed
232
	mavlink_slugs_navigation_t packet_in = {
lm's avatar
lm committed
233 234 235 236 237 238 239 240 241 242
		17.0,
	45.0,
	73.0,
	101.0,
	129.0,
	157.0,
	185.0,
	89,
	156,
	};
LM's avatar
LM committed
243 244 245 246 247 248 249 250 251 252 253 254 255 256 257
	mavlink_slugs_navigation_t packet1, packet2;
        memset(&packet1, 0, sizeof(packet1));
        	packet1.u_m = packet_in.u_m;
        	packet1.phi_c = packet_in.phi_c;
        	packet1.theta_c = packet_in.theta_c;
        	packet1.psiDot_c = packet_in.psiDot_c;
        	packet1.ay_body = packet_in.ay_body;
        	packet1.totalDist = packet_in.totalDist;
        	packet1.dist2Go = packet_in.dist2Go;
        	packet1.fromWP = packet_in.fromWP;
        	packet1.toWP = packet_in.toWP;
        
        

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
258 259 260
	mavlink_msg_slugs_navigation_encode(system_id, component_id, &msg, &packet1);
	mavlink_msg_slugs_navigation_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
LM's avatar
LM committed
261 262

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
263
	mavlink_msg_slugs_navigation_pack(system_id, component_id, &msg , packet1.u_m , packet1.phi_c , packet1.theta_c , packet1.psiDot_c , packet1.ay_body , packet1.totalDist , packet1.dist2Go , packet1.fromWP , packet1.toWP );
LM's avatar
LM committed
264 265 266 267
	mavlink_msg_slugs_navigation_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
268
	mavlink_msg_slugs_navigation_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.u_m , packet1.phi_c , packet1.theta_c , packet1.psiDot_c , packet1.ay_body , packet1.totalDist , packet1.dist2Go , packet1.fromWP , packet1.toWP );
LM's avatar
LM committed
269 270 271 272
	mavlink_msg_slugs_navigation_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
273 274 275 276
        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]);
        }
LM's avatar
LM committed
277 278 279 280
	mavlink_msg_slugs_navigation_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
        
        memset(&packet2, 0, sizeof(packet2));
LM's avatar
LM committed
281
	mavlink_msg_slugs_navigation_send(MAVLINK_COMM_1 , packet1.u_m , packet1.phi_c , packet1.theta_c , packet1.psiDot_c , packet1.ay_body , packet1.totalDist , packet1.dist2Go , packet1.fromWP , packet1.toWP );
LM's avatar
LM committed
282 283
	mavlink_msg_slugs_navigation_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
lm's avatar
lm committed
284 285
}

LM's avatar
LM committed
286
static void mavlink_test_data_log(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
lm's avatar
lm committed
287 288 289 290
{
	mavlink_message_t msg;
        uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
        uint16_t i;
LM's avatar
LM committed
291
	mavlink_data_log_t packet_in = {
lm's avatar
lm committed
292 293 294 295 296 297 298
		17.0,
	45.0,
	73.0,
	101.0,
	129.0,
	157.0,
	};
LM's avatar
LM committed
299 300 301 302 303 304 305 306 307 308 309 310
	mavlink_data_log_t packet1, packet2;
        memset(&packet1, 0, sizeof(packet1));
        	packet1.fl_1 = packet_in.fl_1;
        	packet1.fl_2 = packet_in.fl_2;
        	packet1.fl_3 = packet_in.fl_3;
        	packet1.fl_4 = packet_in.fl_4;
        	packet1.fl_5 = packet_in.fl_5;
        	packet1.fl_6 = packet_in.fl_6;
        
        

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
311 312 313
	mavlink_msg_data_log_encode(system_id, component_id, &msg, &packet1);
	mavlink_msg_data_log_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
LM's avatar
LM committed
314 315

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
316
	mavlink_msg_data_log_pack(system_id, component_id, &msg , packet1.fl_1 , packet1.fl_2 , packet1.fl_3 , packet1.fl_4 , packet1.fl_5 , packet1.fl_6 );
LM's avatar
LM committed
317 318 319 320
	mavlink_msg_data_log_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
321
	mavlink_msg_data_log_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.fl_1 , packet1.fl_2 , packet1.fl_3 , packet1.fl_4 , packet1.fl_5 , packet1.fl_6 );
LM's avatar
LM committed
322 323 324 325
	mavlink_msg_data_log_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
326 327 328 329
        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]);
        }
LM's avatar
LM committed
330 331 332 333
	mavlink_msg_data_log_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
        
        memset(&packet2, 0, sizeof(packet2));
LM's avatar
LM committed
334
	mavlink_msg_data_log_send(MAVLINK_COMM_1 , packet1.fl_1 , packet1.fl_2 , packet1.fl_3 , packet1.fl_4 , packet1.fl_5 , packet1.fl_6 );
LM's avatar
LM committed
335 336
	mavlink_msg_data_log_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
lm's avatar
lm committed
337 338
}

LM's avatar
LM committed
339
static void mavlink_test_gps_date_time(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
lm's avatar
lm committed
340 341 342 343
{
	mavlink_message_t msg;
        uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
        uint16_t i;
LM's avatar
LM committed
344
	mavlink_gps_date_time_t packet_in = {
lm's avatar
lm committed
345 346 347 348 349 350 351 352
		5,
	72,
	139,
	206,
	17,
	84,
	151,
	};
LM's avatar
LM committed
353 354 355 356 357 358 359 360 361 362 363 364 365
	mavlink_gps_date_time_t packet1, packet2;
        memset(&packet1, 0, sizeof(packet1));
        	packet1.year = packet_in.year;
        	packet1.month = packet_in.month;
        	packet1.day = packet_in.day;
        	packet1.hour = packet_in.hour;
        	packet1.min = packet_in.min;
        	packet1.sec = packet_in.sec;
        	packet1.visSat = packet_in.visSat;
        
        

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
366 367 368
	mavlink_msg_gps_date_time_encode(system_id, component_id, &msg, &packet1);
	mavlink_msg_gps_date_time_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
LM's avatar
LM committed
369 370

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
371
	mavlink_msg_gps_date_time_pack(system_id, component_id, &msg , packet1.year , packet1.month , packet1.day , packet1.hour , packet1.min , packet1.sec , packet1.visSat );
LM's avatar
LM committed
372 373 374 375
	mavlink_msg_gps_date_time_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
376
	mavlink_msg_gps_date_time_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.year , packet1.month , packet1.day , packet1.hour , packet1.min , packet1.sec , packet1.visSat );
LM's avatar
LM committed
377 378 379 380
	mavlink_msg_gps_date_time_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
381 382 383 384
        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]);
        }
LM's avatar
LM committed
385 386 387 388
	mavlink_msg_gps_date_time_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
        
        memset(&packet2, 0, sizeof(packet2));
LM's avatar
LM committed
389
	mavlink_msg_gps_date_time_send(MAVLINK_COMM_1 , packet1.year , packet1.month , packet1.day , packet1.hour , packet1.min , packet1.sec , packet1.visSat );
LM's avatar
LM committed
390 391
	mavlink_msg_gps_date_time_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
lm's avatar
lm committed
392 393
}

LM's avatar
LM committed
394
static void mavlink_test_mid_lvl_cmds(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
lm's avatar
lm committed
395 396 397 398
{
	mavlink_message_t msg;
        uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
        uint16_t i;
LM's avatar
LM committed
399
	mavlink_mid_lvl_cmds_t packet_in = {
lm's avatar
lm committed
400 401 402 403 404
		17.0,
	45.0,
	73.0,
	41,
	};
LM's avatar
LM committed
405 406 407 408 409 410 411 412 413 414
	mavlink_mid_lvl_cmds_t packet1, packet2;
        memset(&packet1, 0, sizeof(packet1));
        	packet1.hCommand = packet_in.hCommand;
        	packet1.uCommand = packet_in.uCommand;
        	packet1.rCommand = packet_in.rCommand;
        	packet1.target = packet_in.target;
        
        

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
415 416 417
	mavlink_msg_mid_lvl_cmds_encode(system_id, component_id, &msg, &packet1);
	mavlink_msg_mid_lvl_cmds_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
LM's avatar
LM committed
418 419

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
420
	mavlink_msg_mid_lvl_cmds_pack(system_id, component_id, &msg , packet1.target , packet1.hCommand , packet1.uCommand , packet1.rCommand );
LM's avatar
LM committed
421 422 423 424
	mavlink_msg_mid_lvl_cmds_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
425
	mavlink_msg_mid_lvl_cmds_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target , packet1.hCommand , packet1.uCommand , packet1.rCommand );
LM's avatar
LM committed
426 427 428 429
	mavlink_msg_mid_lvl_cmds_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
430 431 432 433
        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]);
        }
LM's avatar
LM committed
434 435 436 437
	mavlink_msg_mid_lvl_cmds_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
        
        memset(&packet2, 0, sizeof(packet2));
LM's avatar
LM committed
438
	mavlink_msg_mid_lvl_cmds_send(MAVLINK_COMM_1 , packet1.target , packet1.hCommand , packet1.uCommand , packet1.rCommand );
LM's avatar
LM committed
439 440
	mavlink_msg_mid_lvl_cmds_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
lm's avatar
lm committed
441 442
}

LM's avatar
LM committed
443
static void mavlink_test_ctrl_srfc_pt(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
lm's avatar
lm committed
444 445 446 447
{
	mavlink_message_t msg;
        uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
        uint16_t i;
LM's avatar
LM committed
448
	mavlink_ctrl_srfc_pt_t packet_in = {
lm's avatar
lm committed
449 450 451
		17235,
	139,
	};
LM's avatar
LM committed
452 453 454 455 456 457 458 459
	mavlink_ctrl_srfc_pt_t packet1, packet2;
        memset(&packet1, 0, sizeof(packet1));
        	packet1.bitfieldPt = packet_in.bitfieldPt;
        	packet1.target = packet_in.target;
        
        

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
460 461 462
	mavlink_msg_ctrl_srfc_pt_encode(system_id, component_id, &msg, &packet1);
	mavlink_msg_ctrl_srfc_pt_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
LM's avatar
LM committed
463 464

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
465
	mavlink_msg_ctrl_srfc_pt_pack(system_id, component_id, &msg , packet1.target , packet1.bitfieldPt );
LM's avatar
LM committed
466 467 468 469
	mavlink_msg_ctrl_srfc_pt_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
470
	mavlink_msg_ctrl_srfc_pt_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target , packet1.bitfieldPt );
LM's avatar
LM committed
471 472 473 474
	mavlink_msg_ctrl_srfc_pt_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
475 476 477 478
        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]);
        }
LM's avatar
LM committed
479 480 481 482
	mavlink_msg_ctrl_srfc_pt_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
        
        memset(&packet2, 0, sizeof(packet2));
LM's avatar
LM committed
483
	mavlink_msg_ctrl_srfc_pt_send(MAVLINK_COMM_1 , packet1.target , packet1.bitfieldPt );
LM's avatar
LM committed
484 485
	mavlink_msg_ctrl_srfc_pt_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
lm's avatar
lm committed
486 487
}

LM's avatar
LM committed
488
static void mavlink_test_slugs_action(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
lm's avatar
lm committed
489 490 491 492
{
	mavlink_message_t msg;
        uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
        uint16_t i;
LM's avatar
LM committed
493
	mavlink_slugs_action_t packet_in = {
lm's avatar
lm committed
494 495 496 497
		17235,
	139,
	206,
	};
LM's avatar
LM committed
498 499 500 501 502 503 504 505 506
	mavlink_slugs_action_t packet1, packet2;
        memset(&packet1, 0, sizeof(packet1));
        	packet1.actionVal = packet_in.actionVal;
        	packet1.target = packet_in.target;
        	packet1.actionId = packet_in.actionId;
        
        

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
507 508 509
	mavlink_msg_slugs_action_encode(system_id, component_id, &msg, &packet1);
	mavlink_msg_slugs_action_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
LM's avatar
LM committed
510 511

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
512
	mavlink_msg_slugs_action_pack(system_id, component_id, &msg , packet1.target , packet1.actionId , packet1.actionVal );
LM's avatar
LM committed
513 514 515 516
	mavlink_msg_slugs_action_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
517
	mavlink_msg_slugs_action_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target , packet1.actionId , packet1.actionVal );
LM's avatar
LM committed
518 519 520 521
	mavlink_msg_slugs_action_decode(&msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);

        memset(&packet2, 0, sizeof(packet2));
lm's avatar
lm committed
522 523 524 525
        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]);
        }
LM's avatar
LM committed
526 527 528 529
	mavlink_msg_slugs_action_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
        
        memset(&packet2, 0, sizeof(packet2));
LM's avatar
LM committed
530
	mavlink_msg_slugs_action_send(MAVLINK_COMM_1 , packet1.target , packet1.actionId , packet1.actionVal );
LM's avatar
LM committed
531 532
	mavlink_msg_slugs_action_decode(last_msg, &packet2);
        MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
lm's avatar
lm committed
533 534
}

LM's avatar
LM committed
535
static void mavlink_test_slugs(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
lm's avatar
lm committed
536
{
LM's avatar
LM committed
537 538 539 540 541 542 543 544 545 546
	mavlink_test_cpu_load(system_id, component_id, last_msg);
	mavlink_test_air_data(system_id, component_id, last_msg);
	mavlink_test_sensor_bias(system_id, component_id, last_msg);
	mavlink_test_diagnostic(system_id, component_id, last_msg);
	mavlink_test_slugs_navigation(system_id, component_id, last_msg);
	mavlink_test_data_log(system_id, component_id, last_msg);
	mavlink_test_gps_date_time(system_id, component_id, last_msg);
	mavlink_test_mid_lvl_cmds(system_id, component_id, last_msg);
	mavlink_test_ctrl_srfc_pt(system_id, component_id, last_msg);
	mavlink_test_slugs_action(system_id, component_id, last_msg);
lm's avatar
lm committed
547 548 549 550 551 552
}

#ifdef __cplusplus
}
#endif // __cplusplus
#endif // SLUGS_TESTSUITE_H