MAV'RIC
testsuite.h
Go to the documentation of this file.
1 
5 #ifndef MAVRIC_TESTSUITE_H
6 #define MAVRIC_TESTSUITE_H
7 
8 #ifdef __cplusplus
9 extern "C" {
10 #endif
11 
12 #ifndef MAVLINK_TEST_ALL
13 #define MAVLINK_TEST_ALL
14 static void mavlink_test_common(uint8_t, uint8_t, mavlink_message_t *last_msg);
15 static void mavlink_test_mavric(uint8_t, uint8_t, mavlink_message_t *last_msg);
16 
17 static void mavlink_test_all(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
18 {
19  mavlink_test_common(system_id, component_id, last_msg);
20  mavlink_test_mavric(system_id, component_id, last_msg);
21 }
22 #endif
23 
24 #include "../common/testsuite.h"
25 
26 
27 static void mavlink_test_radar_tracked_target(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
28 {
29  mavlink_message_t msg;
30  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
31  uint16_t i;
32  mavlink_radar_tracked_target_t packet_in = {
33  963497464,45.0,73.0,101.0,53,120
34  };
35  mavlink_radar_tracked_target_t packet1, packet2;
36  memset(&packet1, 0, sizeof(packet1));
37  packet1.time_boot_ms = packet_in.time_boot_ms;
38  packet1.velocity = packet_in.velocity;
39  packet1.amplitude = packet_in.amplitude;
40  packet1.distance = packet_in.distance;
41  packet1.sensor_id = packet_in.sensor_id;
42  packet1.target_id = packet_in.target_id;
43 
44 
45 
46  memset(&packet2, 0, sizeof(packet2));
47  mavlink_msg_radar_tracked_target_encode(system_id, component_id, &msg, &packet1);
48  mavlink_msg_radar_tracked_target_decode(&msg, &packet2);
49  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
50 
51  memset(&packet2, 0, sizeof(packet2));
52  mavlink_msg_radar_tracked_target_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.sensor_id , packet1.target_id , packet1.velocity , packet1.amplitude , packet1.distance );
53  mavlink_msg_radar_tracked_target_decode(&msg, &packet2);
54  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
55 
56  memset(&packet2, 0, sizeof(packet2));
57  mavlink_msg_radar_tracked_target_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.sensor_id , packet1.target_id , packet1.velocity , packet1.amplitude , packet1.distance );
58  mavlink_msg_radar_tracked_target_decode(&msg, &packet2);
59  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
60 
61  memset(&packet2, 0, sizeof(packet2));
62  mavlink_msg_to_send_buffer(buffer, &msg);
63  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
64  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
65  }
66  mavlink_msg_radar_tracked_target_decode(last_msg, &packet2);
67  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
68 
69  memset(&packet2, 0, sizeof(packet2));
70  mavlink_msg_radar_tracked_target_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.sensor_id , packet1.target_id , packet1.velocity , packet1.amplitude , packet1.distance );
71  mavlink_msg_radar_tracked_target_decode(last_msg, &packet2);
72  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
73 }
74 
75 static void mavlink_test_radar_velocity_hist(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
76 {
77  mavlink_message_t msg;
78  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
79  uint16_t i;
80  mavlink_radar_velocity_hist_t packet_in = {
81  963497464,17,{ 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138, 139, 140, 141, 142, 143, 144, 145, 146, 147 }
82  };
83  mavlink_radar_velocity_hist_t packet1, packet2;
84  memset(&packet1, 0, sizeof(packet1));
85  packet1.time_boot_ms = packet_in.time_boot_ms;
86  packet1.sensor_id = packet_in.sensor_id;
87 
88  mav_array_memcpy(packet1.velocity, packet_in.velocity, sizeof(uint8_t)*64);
89 
90 
91  memset(&packet2, 0, sizeof(packet2));
92  mavlink_msg_radar_velocity_hist_encode(system_id, component_id, &msg, &packet1);
93  mavlink_msg_radar_velocity_hist_decode(&msg, &packet2);
94  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
95 
96  memset(&packet2, 0, sizeof(packet2));
97  mavlink_msg_radar_velocity_hist_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.sensor_id , packet1.velocity );
98  mavlink_msg_radar_velocity_hist_decode(&msg, &packet2);
99  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
100 
101  memset(&packet2, 0, sizeof(packet2));
102  mavlink_msg_radar_velocity_hist_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.sensor_id , packet1.velocity );
103  mavlink_msg_radar_velocity_hist_decode(&msg, &packet2);
104  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
105 
106  memset(&packet2, 0, sizeof(packet2));
107  mavlink_msg_to_send_buffer(buffer, &msg);
108  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
109  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
110  }
111  mavlink_msg_radar_velocity_hist_decode(last_msg, &packet2);
112  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
113 
114  memset(&packet2, 0, sizeof(packet2));
115  mavlink_msg_radar_velocity_hist_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.sensor_id , packet1.velocity );
116  mavlink_msg_radar_velocity_hist_decode(last_msg, &packet2);
117  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
118 }
119 
120 static void mavlink_test_radar_raw_data(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
121 {
122  mavlink_message_t msg;
123  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
124  uint16_t i;
125  mavlink_radar_raw_data_t packet_in = {
126  963497464,{ 17443, 17444, 17445, 17446, 17447, 17448, 17449, 17450, 17451, 17452, 17453, 17454, 17455, 17456, 17457, 17458, 17459, 17460, 17461, 17462, 17463, 17464, 17465, 17466, 17467, 17468, 17469, 17470, 17471, 17472, 17473, 17474, 17475, 17476, 17477, 17478, 17479, 17480, 17481, 17482, 17483, 17484, 17485, 17486, 17487, 17488, 17489, 17490, 17491, 17492, 17493, 17494, 17495, 17496, 17497, 17498, 17499, 17500, 17501, 17502, 17503, 17504, 17505, 17506 },145
127  };
128  mavlink_radar_raw_data_t packet1, packet2;
129  memset(&packet1, 0, sizeof(packet1));
130  packet1.time_boot_ms = packet_in.time_boot_ms;
131  packet1.sensor_id = packet_in.sensor_id;
132 
133  mav_array_memcpy(packet1.values, packet_in.values, sizeof(int16_t)*64);
134 
135 
136  memset(&packet2, 0, sizeof(packet2));
137  mavlink_msg_radar_raw_data_encode(system_id, component_id, &msg, &packet1);
138  mavlink_msg_radar_raw_data_decode(&msg, &packet2);
139  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
140 
141  memset(&packet2, 0, sizeof(packet2));
142  mavlink_msg_radar_raw_data_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.sensor_id , packet1.values );
143  mavlink_msg_radar_raw_data_decode(&msg, &packet2);
144  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
145 
146  memset(&packet2, 0, sizeof(packet2));
147  mavlink_msg_radar_raw_data_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.sensor_id , packet1.values );
148  mavlink_msg_radar_raw_data_decode(&msg, &packet2);
149  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
150 
151  memset(&packet2, 0, sizeof(packet2));
152  mavlink_msg_to_send_buffer(buffer, &msg);
153  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
154  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
155  }
156  mavlink_msg_radar_raw_data_decode(last_msg, &packet2);
157  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
158 
159  memset(&packet2, 0, sizeof(packet2));
160  mavlink_msg_radar_raw_data_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.sensor_id , packet1.values );
161  mavlink_msg_radar_raw_data_decode(last_msg, &packet2);
162  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
163 }
164 
165 static void mavlink_test_set_local_position_setpoint(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
166 {
167  mavlink_message_t msg;
168  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
169  uint16_t i;
171  17.0,45.0,73.0,101.0,53,120,187
172  };
173  mavlink_set_local_position_setpoint_t packet1, packet2;
174  memset(&packet1, 0, sizeof(packet1));
175  packet1.x = packet_in.x;
176  packet1.y = packet_in.y;
177  packet1.z = packet_in.z;
178  packet1.yaw = packet_in.yaw;
179  packet1.target_system = packet_in.target_system;
180  packet1.target_component = packet_in.target_component;
181  packet1.coordinate_frame = packet_in.coordinate_frame;
182 
183 
184 
185  memset(&packet2, 0, sizeof(packet2));
186  mavlink_msg_set_local_position_setpoint_encode(system_id, component_id, &msg, &packet1);
187  mavlink_msg_set_local_position_setpoint_decode(&msg, &packet2);
188  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
189 
190  memset(&packet2, 0, sizeof(packet2));
191  mavlink_msg_set_local_position_setpoint_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.coordinate_frame , packet1.x , packet1.y , packet1.z , packet1.yaw );
192  mavlink_msg_set_local_position_setpoint_decode(&msg, &packet2);
193  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
194 
195  memset(&packet2, 0, sizeof(packet2));
196  mavlink_msg_set_local_position_setpoint_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.coordinate_frame , packet1.x , packet1.y , packet1.z , packet1.yaw );
197  mavlink_msg_set_local_position_setpoint_decode(&msg, &packet2);
198  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
199 
200  memset(&packet2, 0, sizeof(packet2));
201  mavlink_msg_to_send_buffer(buffer, &msg);
202  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
203  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
204  }
205  mavlink_msg_set_local_position_setpoint_decode(last_msg, &packet2);
206  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
207 
208  memset(&packet2, 0, sizeof(packet2));
209  mavlink_msg_set_local_position_setpoint_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.coordinate_frame , packet1.x , packet1.y , packet1.z , packet1.yaw );
210  mavlink_msg_set_local_position_setpoint_decode(last_msg, &packet2);
211  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
212 }
213 
214 static void mavlink_test_local_position_setpoint(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
215 {
216  mavlink_message_t msg;
217  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
218  uint16_t i;
220  17.0,45.0,73.0,101.0,53
221  };
222  mavlink_local_position_setpoint_t packet1, packet2;
223  memset(&packet1, 0, sizeof(packet1));
224  packet1.x = packet_in.x;
225  packet1.y = packet_in.y;
226  packet1.z = packet_in.z;
227  packet1.yaw = packet_in.yaw;
228  packet1.coordinate_frame = packet_in.coordinate_frame;
229 
230 
231 
232  memset(&packet2, 0, sizeof(packet2));
233  mavlink_msg_local_position_setpoint_encode(system_id, component_id, &msg, &packet1);
234  mavlink_msg_local_position_setpoint_decode(&msg, &packet2);
235  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
236 
237  memset(&packet2, 0, sizeof(packet2));
238  mavlink_msg_local_position_setpoint_pack(system_id, component_id, &msg , packet1.coordinate_frame , packet1.x , packet1.y , packet1.z , packet1.yaw );
239  mavlink_msg_local_position_setpoint_decode(&msg, &packet2);
240  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
241 
242  memset(&packet2, 0, sizeof(packet2));
243  mavlink_msg_local_position_setpoint_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.coordinate_frame , packet1.x , packet1.y , packet1.z , packet1.yaw );
244  mavlink_msg_local_position_setpoint_decode(&msg, &packet2);
245  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
246 
247  memset(&packet2, 0, sizeof(packet2));
248  mavlink_msg_to_send_buffer(buffer, &msg);
249  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
250  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
251  }
252  mavlink_msg_local_position_setpoint_decode(last_msg, &packet2);
253  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
254 
255  memset(&packet2, 0, sizeof(packet2));
256  mavlink_msg_local_position_setpoint_send(MAVLINK_COMM_1 , packet1.coordinate_frame , packet1.x , packet1.y , packet1.z , packet1.yaw );
257  mavlink_msg_local_position_setpoint_decode(last_msg, &packet2);
258  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
259 }
260 
261 static void mavlink_test_global_position_setpoint_int(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
262 {
263  mavlink_message_t msg;
264  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
265  uint16_t i;
267  963497464,963497672,963497880,17859,175
268  };
270  memset(&packet1, 0, sizeof(packet1));
271  packet1.latitude = packet_in.latitude;
272  packet1.longitude = packet_in.longitude;
273  packet1.altitude = packet_in.altitude;
274  packet1.yaw = packet_in.yaw;
275  packet1.coordinate_frame = packet_in.coordinate_frame;
276 
277 
278 
279  memset(&packet2, 0, sizeof(packet2));
280  mavlink_msg_global_position_setpoint_int_encode(system_id, component_id, &msg, &packet1);
281  mavlink_msg_global_position_setpoint_int_decode(&msg, &packet2);
282  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
283 
284  memset(&packet2, 0, sizeof(packet2));
285  mavlink_msg_global_position_setpoint_int_pack(system_id, component_id, &msg , packet1.coordinate_frame , packet1.latitude , packet1.longitude , packet1.altitude , packet1.yaw );
286  mavlink_msg_global_position_setpoint_int_decode(&msg, &packet2);
287  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
288 
289  memset(&packet2, 0, sizeof(packet2));
290  mavlink_msg_global_position_setpoint_int_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.coordinate_frame , packet1.latitude , packet1.longitude , packet1.altitude , packet1.yaw );
291  mavlink_msg_global_position_setpoint_int_decode(&msg, &packet2);
292  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
293 
294  memset(&packet2, 0, sizeof(packet2));
295  mavlink_msg_to_send_buffer(buffer, &msg);
296  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
297  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
298  }
299  mavlink_msg_global_position_setpoint_int_decode(last_msg, &packet2);
300  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
301 
302  memset(&packet2, 0, sizeof(packet2));
303  mavlink_msg_global_position_setpoint_int_send(MAVLINK_COMM_1 , packet1.coordinate_frame , packet1.latitude , packet1.longitude , packet1.altitude , packet1.yaw );
304  mavlink_msg_global_position_setpoint_int_decode(last_msg, &packet2);
305  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
306 }
307 
308 static void mavlink_test_set_global_position_setpoint_int(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
309 {
310  mavlink_message_t msg;
311  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
312  uint16_t i;
314  963497464,963497672,963497880,17859,175
315  };
317  memset(&packet1, 0, sizeof(packet1));
318  packet1.latitude = packet_in.latitude;
319  packet1.longitude = packet_in.longitude;
320  packet1.altitude = packet_in.altitude;
321  packet1.yaw = packet_in.yaw;
322  packet1.coordinate_frame = packet_in.coordinate_frame;
323 
324 
325 
326  memset(&packet2, 0, sizeof(packet2));
327  mavlink_msg_set_global_position_setpoint_int_encode(system_id, component_id, &msg, &packet1);
328  mavlink_msg_set_global_position_setpoint_int_decode(&msg, &packet2);
329  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
330 
331  memset(&packet2, 0, sizeof(packet2));
332  mavlink_msg_set_global_position_setpoint_int_pack(system_id, component_id, &msg , packet1.coordinate_frame , packet1.latitude , packet1.longitude , packet1.altitude , packet1.yaw );
333  mavlink_msg_set_global_position_setpoint_int_decode(&msg, &packet2);
334  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
335 
336  memset(&packet2, 0, sizeof(packet2));
337  mavlink_msg_set_global_position_setpoint_int_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.coordinate_frame , packet1.latitude , packet1.longitude , packet1.altitude , packet1.yaw );
338  mavlink_msg_set_global_position_setpoint_int_decode(&msg, &packet2);
339  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
340 
341  memset(&packet2, 0, sizeof(packet2));
342  mavlink_msg_to_send_buffer(buffer, &msg);
343  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
344  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
345  }
346  mavlink_msg_set_global_position_setpoint_int_decode(last_msg, &packet2);
347  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
348 
349  memset(&packet2, 0, sizeof(packet2));
350  mavlink_msg_set_global_position_setpoint_int_send(MAVLINK_COMM_1 , packet1.coordinate_frame , packet1.latitude , packet1.longitude , packet1.altitude , packet1.yaw );
351  mavlink_msg_set_global_position_setpoint_int_decode(last_msg, &packet2);
352  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
353 }
354 
355 static void mavlink_test_set_roll_pitch_yaw_thrust(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
356 {
357  mavlink_message_t msg;
358  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
359  uint16_t i;
361  17.0,45.0,73.0,101.0,53,120
362  };
363  mavlink_set_roll_pitch_yaw_thrust_t packet1, packet2;
364  memset(&packet1, 0, sizeof(packet1));
365  packet1.roll = packet_in.roll;
366  packet1.pitch = packet_in.pitch;
367  packet1.yaw = packet_in.yaw;
368  packet1.thrust = packet_in.thrust;
369  packet1.target_system = packet_in.target_system;
370  packet1.target_component = packet_in.target_component;
371 
372 
373 
374  memset(&packet2, 0, sizeof(packet2));
375  mavlink_msg_set_roll_pitch_yaw_thrust_encode(system_id, component_id, &msg, &packet1);
376  mavlink_msg_set_roll_pitch_yaw_thrust_decode(&msg, &packet2);
377  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
378 
379  memset(&packet2, 0, sizeof(packet2));
380  mavlink_msg_set_roll_pitch_yaw_thrust_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust );
381  mavlink_msg_set_roll_pitch_yaw_thrust_decode(&msg, &packet2);
382  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
383 
384  memset(&packet2, 0, sizeof(packet2));
385  mavlink_msg_set_roll_pitch_yaw_thrust_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust );
386  mavlink_msg_set_roll_pitch_yaw_thrust_decode(&msg, &packet2);
387  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
388 
389  memset(&packet2, 0, sizeof(packet2));
390  mavlink_msg_to_send_buffer(buffer, &msg);
391  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
392  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
393  }
394  mavlink_msg_set_roll_pitch_yaw_thrust_decode(last_msg, &packet2);
395  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
396 
397  memset(&packet2, 0, sizeof(packet2));
398  mavlink_msg_set_roll_pitch_yaw_thrust_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust );
399  mavlink_msg_set_roll_pitch_yaw_thrust_decode(last_msg, &packet2);
400  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
401 }
402 
403 static void mavlink_test_set_roll_pitch_yaw_speed_thrust(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
404 {
405  mavlink_message_t msg;
406  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
407  uint16_t i;
409  17.0,45.0,73.0,101.0,53,120
410  };
412  memset(&packet1, 0, sizeof(packet1));
413  packet1.roll_speed = packet_in.roll_speed;
414  packet1.pitch_speed = packet_in.pitch_speed;
415  packet1.yaw_speed = packet_in.yaw_speed;
416  packet1.thrust = packet_in.thrust;
417  packet1.target_system = packet_in.target_system;
418  packet1.target_component = packet_in.target_component;
419 
420 
421 
422  memset(&packet2, 0, sizeof(packet2));
423  mavlink_msg_set_roll_pitch_yaw_speed_thrust_encode(system_id, component_id, &msg, &packet1);
424  mavlink_msg_set_roll_pitch_yaw_speed_thrust_decode(&msg, &packet2);
425  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
426 
427  memset(&packet2, 0, sizeof(packet2));
428  mavlink_msg_set_roll_pitch_yaw_speed_thrust_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.roll_speed , packet1.pitch_speed , packet1.yaw_speed , packet1.thrust );
429  mavlink_msg_set_roll_pitch_yaw_speed_thrust_decode(&msg, &packet2);
430  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
431 
432  memset(&packet2, 0, sizeof(packet2));
433  mavlink_msg_set_roll_pitch_yaw_speed_thrust_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.roll_speed , packet1.pitch_speed , packet1.yaw_speed , packet1.thrust );
434  mavlink_msg_set_roll_pitch_yaw_speed_thrust_decode(&msg, &packet2);
435  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
436 
437  memset(&packet2, 0, sizeof(packet2));
438  mavlink_msg_to_send_buffer(buffer, &msg);
439  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
440  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
441  }
442  mavlink_msg_set_roll_pitch_yaw_speed_thrust_decode(last_msg, &packet2);
443  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
444 
445  memset(&packet2, 0, sizeof(packet2));
446  mavlink_msg_set_roll_pitch_yaw_speed_thrust_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.roll_speed , packet1.pitch_speed , packet1.yaw_speed , packet1.thrust );
447  mavlink_msg_set_roll_pitch_yaw_speed_thrust_decode(last_msg, &packet2);
448  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
449 }
450 
451 static void mavlink_test_roll_pitch_yaw_thrust_setpoint(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
452 {
453  mavlink_message_t msg;
454  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
455  uint16_t i;
457  963497464,45.0,73.0,101.0,129.0
458  };
460  memset(&packet1, 0, sizeof(packet1));
461  packet1.time_boot_ms = packet_in.time_boot_ms;
462  packet1.roll = packet_in.roll;
463  packet1.pitch = packet_in.pitch;
464  packet1.yaw = packet_in.yaw;
465  packet1.thrust = packet_in.thrust;
466 
467 
468 
469  memset(&packet2, 0, sizeof(packet2));
470  mavlink_msg_roll_pitch_yaw_thrust_setpoint_encode(system_id, component_id, &msg, &packet1);
471  mavlink_msg_roll_pitch_yaw_thrust_setpoint_decode(&msg, &packet2);
472  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
473 
474  memset(&packet2, 0, sizeof(packet2));
475  mavlink_msg_roll_pitch_yaw_thrust_setpoint_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust );
476  mavlink_msg_roll_pitch_yaw_thrust_setpoint_decode(&msg, &packet2);
477  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
478 
479  memset(&packet2, 0, sizeof(packet2));
480  mavlink_msg_roll_pitch_yaw_thrust_setpoint_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust );
481  mavlink_msg_roll_pitch_yaw_thrust_setpoint_decode(&msg, &packet2);
482  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
483 
484  memset(&packet2, 0, sizeof(packet2));
485  mavlink_msg_to_send_buffer(buffer, &msg);
486  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
487  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
488  }
489  mavlink_msg_roll_pitch_yaw_thrust_setpoint_decode(last_msg, &packet2);
490  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
491 
492  memset(&packet2, 0, sizeof(packet2));
493  mavlink_msg_roll_pitch_yaw_thrust_setpoint_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust );
494  mavlink_msg_roll_pitch_yaw_thrust_setpoint_decode(last_msg, &packet2);
495  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
496 }
497 
498 static void mavlink_test_roll_pitch_yaw_speed_thrust_setpoint(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
499 {
500  mavlink_message_t msg;
501  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
502  uint16_t i;
504  963497464,45.0,73.0,101.0,129.0
505  };
507  memset(&packet1, 0, sizeof(packet1));
508  packet1.time_boot_ms = packet_in.time_boot_ms;
509  packet1.roll_speed = packet_in.roll_speed;
510  packet1.pitch_speed = packet_in.pitch_speed;
511  packet1.yaw_speed = packet_in.yaw_speed;
512  packet1.thrust = packet_in.thrust;
513 
514 
515 
516  memset(&packet2, 0, sizeof(packet2));
517  mavlink_msg_roll_pitch_yaw_speed_thrust_setpoint_encode(system_id, component_id, &msg, &packet1);
518  mavlink_msg_roll_pitch_yaw_speed_thrust_setpoint_decode(&msg, &packet2);
519  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
520 
521  memset(&packet2, 0, sizeof(packet2));
522  mavlink_msg_roll_pitch_yaw_speed_thrust_setpoint_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.roll_speed , packet1.pitch_speed , packet1.yaw_speed , packet1.thrust );
523  mavlink_msg_roll_pitch_yaw_speed_thrust_setpoint_decode(&msg, &packet2);
524  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
525 
526  memset(&packet2, 0, sizeof(packet2));
527  mavlink_msg_roll_pitch_yaw_speed_thrust_setpoint_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.roll_speed , packet1.pitch_speed , packet1.yaw_speed , packet1.thrust );
528  mavlink_msg_roll_pitch_yaw_speed_thrust_setpoint_decode(&msg, &packet2);
529  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
530 
531  memset(&packet2, 0, sizeof(packet2));
532  mavlink_msg_to_send_buffer(buffer, &msg);
533  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
534  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
535  }
536  mavlink_msg_roll_pitch_yaw_speed_thrust_setpoint_decode(last_msg, &packet2);
537  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
538 
539  memset(&packet2, 0, sizeof(packet2));
540  mavlink_msg_roll_pitch_yaw_speed_thrust_setpoint_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.roll_speed , packet1.pitch_speed , packet1.yaw_speed , packet1.thrust );
541  mavlink_msg_roll_pitch_yaw_speed_thrust_setpoint_decode(last_msg, &packet2);
542  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
543 }
544 
545 static void mavlink_test_set_quad_motors_setpoint(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
546 {
547  mavlink_message_t msg;
548  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
549  uint16_t i;
551  17235,17339,17443,17547,29
552  };
553  mavlink_set_quad_motors_setpoint_t packet1, packet2;
554  memset(&packet1, 0, sizeof(packet1));
555  packet1.motor_front_nw = packet_in.motor_front_nw;
556  packet1.motor_right_ne = packet_in.motor_right_ne;
557  packet1.motor_back_se = packet_in.motor_back_se;
558  packet1.motor_left_sw = packet_in.motor_left_sw;
559  packet1.target_system = packet_in.target_system;
560 
561 
562 
563  memset(&packet2, 0, sizeof(packet2));
564  mavlink_msg_set_quad_motors_setpoint_encode(system_id, component_id, &msg, &packet1);
565  mavlink_msg_set_quad_motors_setpoint_decode(&msg, &packet2);
566  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
567 
568  memset(&packet2, 0, sizeof(packet2));
569  mavlink_msg_set_quad_motors_setpoint_pack(system_id, component_id, &msg , packet1.target_system , packet1.motor_front_nw , packet1.motor_right_ne , packet1.motor_back_se , packet1.motor_left_sw );
570  mavlink_msg_set_quad_motors_setpoint_decode(&msg, &packet2);
571  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
572 
573  memset(&packet2, 0, sizeof(packet2));
574  mavlink_msg_set_quad_motors_setpoint_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.motor_front_nw , packet1.motor_right_ne , packet1.motor_back_se , packet1.motor_left_sw );
575  mavlink_msg_set_quad_motors_setpoint_decode(&msg, &packet2);
576  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
577 
578  memset(&packet2, 0, sizeof(packet2));
579  mavlink_msg_to_send_buffer(buffer, &msg);
580  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
581  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
582  }
583  mavlink_msg_set_quad_motors_setpoint_decode(last_msg, &packet2);
584  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
585 
586  memset(&packet2, 0, sizeof(packet2));
587  mavlink_msg_set_quad_motors_setpoint_send(MAVLINK_COMM_1 , packet1.target_system , packet1.motor_front_nw , packet1.motor_right_ne , packet1.motor_back_se , packet1.motor_left_sw );
588  mavlink_msg_set_quad_motors_setpoint_decode(last_msg, &packet2);
589  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
590 }
591 
592 static void mavlink_test_set_quad_swarm_roll_pitch_yaw_thrust(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
593 {
594  mavlink_message_t msg;
595  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
596  uint16_t i;
598  { 17235, 17236, 17237, 17238 },{ 17651, 17652, 17653, 17654 },{ 18067, 18068, 18069, 18070 },{ 18483, 18484, 18485, 18486 },101,168
599  };
601  memset(&packet1, 0, sizeof(packet1));
602  packet1.group = packet_in.group;
603  packet1.mode = packet_in.mode;
604 
605  mav_array_memcpy(packet1.roll, packet_in.roll, sizeof(int16_t)*4);
606  mav_array_memcpy(packet1.pitch, packet_in.pitch, sizeof(int16_t)*4);
607  mav_array_memcpy(packet1.yaw, packet_in.yaw, sizeof(int16_t)*4);
608  mav_array_memcpy(packet1.thrust, packet_in.thrust, sizeof(uint16_t)*4);
609 
610 
611  memset(&packet2, 0, sizeof(packet2));
612  mavlink_msg_set_quad_swarm_roll_pitch_yaw_thrust_encode(system_id, component_id, &msg, &packet1);
613  mavlink_msg_set_quad_swarm_roll_pitch_yaw_thrust_decode(&msg, &packet2);
614  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
615 
616  memset(&packet2, 0, sizeof(packet2));
617  mavlink_msg_set_quad_swarm_roll_pitch_yaw_thrust_pack(system_id, component_id, &msg , packet1.group , packet1.mode , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust );
618  mavlink_msg_set_quad_swarm_roll_pitch_yaw_thrust_decode(&msg, &packet2);
619  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
620 
621  memset(&packet2, 0, sizeof(packet2));
622  mavlink_msg_set_quad_swarm_roll_pitch_yaw_thrust_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.group , packet1.mode , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust );
623  mavlink_msg_set_quad_swarm_roll_pitch_yaw_thrust_decode(&msg, &packet2);
624  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
625 
626  memset(&packet2, 0, sizeof(packet2));
627  mavlink_msg_to_send_buffer(buffer, &msg);
628  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
629  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
630  }
631  mavlink_msg_set_quad_swarm_roll_pitch_yaw_thrust_decode(last_msg, &packet2);
632  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
633 
634  memset(&packet2, 0, sizeof(packet2));
635  mavlink_msg_set_quad_swarm_roll_pitch_yaw_thrust_send(MAVLINK_COMM_1 , packet1.group , packet1.mode , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust );
636  mavlink_msg_set_quad_swarm_roll_pitch_yaw_thrust_decode(last_msg, &packet2);
637  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
638 }
639 
640 static void mavlink_test_set_quad_swarm_led_roll_pitch_yaw_thrust(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
641 {
642  mavlink_message_t msg;
643  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
644  uint16_t i;
646  { 17235, 17236, 17237, 17238 },{ 17651, 17652, 17653, 17654 },{ 18067, 18068, 18069, 18070 },{ 18483, 18484, 18485, 18486 },101,168,{ 235, 236, 237, 238 },{ 247, 248, 249, 250 },{ 3, 4, 5, 6 }
647  };
649  memset(&packet1, 0, sizeof(packet1));
650  packet1.group = packet_in.group;
651  packet1.mode = packet_in.mode;
652 
653  mav_array_memcpy(packet1.roll, packet_in.roll, sizeof(int16_t)*4);
654  mav_array_memcpy(packet1.pitch, packet_in.pitch, sizeof(int16_t)*4);
655  mav_array_memcpy(packet1.yaw, packet_in.yaw, sizeof(int16_t)*4);
656  mav_array_memcpy(packet1.thrust, packet_in.thrust, sizeof(uint16_t)*4);
657  mav_array_memcpy(packet1.led_red, packet_in.led_red, sizeof(uint8_t)*4);
658  mav_array_memcpy(packet1.led_blue, packet_in.led_blue, sizeof(uint8_t)*4);
659  mav_array_memcpy(packet1.led_green, packet_in.led_green, sizeof(uint8_t)*4);
660 
661 
662  memset(&packet2, 0, sizeof(packet2));
663  mavlink_msg_set_quad_swarm_led_roll_pitch_yaw_thrust_encode(system_id, component_id, &msg, &packet1);
664  mavlink_msg_set_quad_swarm_led_roll_pitch_yaw_thrust_decode(&msg, &packet2);
665  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
666 
667  memset(&packet2, 0, sizeof(packet2));
668  mavlink_msg_set_quad_swarm_led_roll_pitch_yaw_thrust_pack(system_id, component_id, &msg , packet1.group , packet1.mode , packet1.led_red , packet1.led_blue , packet1.led_green , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust );
669  mavlink_msg_set_quad_swarm_led_roll_pitch_yaw_thrust_decode(&msg, &packet2);
670  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
671 
672  memset(&packet2, 0, sizeof(packet2));
673  mavlink_msg_set_quad_swarm_led_roll_pitch_yaw_thrust_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.group , packet1.mode , packet1.led_red , packet1.led_blue , packet1.led_green , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust );
674  mavlink_msg_set_quad_swarm_led_roll_pitch_yaw_thrust_decode(&msg, &packet2);
675  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
676 
677  memset(&packet2, 0, sizeof(packet2));
678  mavlink_msg_to_send_buffer(buffer, &msg);
679  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
680  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
681  }
682  mavlink_msg_set_quad_swarm_led_roll_pitch_yaw_thrust_decode(last_msg, &packet2);
683  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
684 
685  memset(&packet2, 0, sizeof(packet2));
686  mavlink_msg_set_quad_swarm_led_roll_pitch_yaw_thrust_send(MAVLINK_COMM_1 , packet1.group , packet1.mode , packet1.led_red , packet1.led_blue , packet1.led_green , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust );
687  mavlink_msg_set_quad_swarm_led_roll_pitch_yaw_thrust_decode(last_msg, &packet2);
688  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
689 }
690 
691 static void mavlink_test_state_correction(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
692 {
693  mavlink_message_t msg;
694  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
695  uint16_t i;
696  mavlink_state_correction_t packet_in = {
697  17.0,45.0,73.0,101.0,129.0,157.0,185.0,213.0,241.0
698  };
699  mavlink_state_correction_t packet1, packet2;
700  memset(&packet1, 0, sizeof(packet1));
701  packet1.xErr = packet_in.xErr;
702  packet1.yErr = packet_in.yErr;
703  packet1.zErr = packet_in.zErr;
704  packet1.rollErr = packet_in.rollErr;
705  packet1.pitchErr = packet_in.pitchErr;
706  packet1.yawErr = packet_in.yawErr;
707  packet1.vxErr = packet_in.vxErr;
708  packet1.vyErr = packet_in.vyErr;
709  packet1.vzErr = packet_in.vzErr;
710 
711 
712 
713  memset(&packet2, 0, sizeof(packet2));
714  mavlink_msg_state_correction_encode(system_id, component_id, &msg, &packet1);
715  mavlink_msg_state_correction_decode(&msg, &packet2);
716  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
717 
718  memset(&packet2, 0, sizeof(packet2));
719  mavlink_msg_state_correction_pack(system_id, component_id, &msg , packet1.xErr , packet1.yErr , packet1.zErr , packet1.rollErr , packet1.pitchErr , packet1.yawErr , packet1.vxErr , packet1.vyErr , packet1.vzErr );
720  mavlink_msg_state_correction_decode(&msg, &packet2);
721  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
722 
723  memset(&packet2, 0, sizeof(packet2));
724  mavlink_msg_state_correction_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.xErr , packet1.yErr , packet1.zErr , packet1.rollErr , packet1.pitchErr , packet1.yawErr , packet1.vxErr , packet1.vyErr , packet1.vzErr );
725  mavlink_msg_state_correction_decode(&msg, &packet2);
726  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
727 
728  memset(&packet2, 0, sizeof(packet2));
729  mavlink_msg_to_send_buffer(buffer, &msg);
730  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
731  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
732  }
733  mavlink_msg_state_correction_decode(last_msg, &packet2);
734  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
735 
736  memset(&packet2, 0, sizeof(packet2));
737  mavlink_msg_state_correction_send(MAVLINK_COMM_1 , packet1.xErr , packet1.yErr , packet1.zErr , packet1.rollErr , packet1.pitchErr , packet1.yawErr , packet1.vxErr , packet1.vyErr , packet1.vzErr );
738  mavlink_msg_state_correction_decode(last_msg, &packet2);
739  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
740 }
741 
742 static void mavlink_test_roll_pitch_yaw_rates_thrust_setpoint(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
743 {
744  mavlink_message_t msg;
745  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
746  uint16_t i;
748  963497464,45.0,73.0,101.0,129.0
749  };
751  memset(&packet1, 0, sizeof(packet1));
752  packet1.time_boot_ms = packet_in.time_boot_ms;
753  packet1.roll_rate = packet_in.roll_rate;
754  packet1.pitch_rate = packet_in.pitch_rate;
755  packet1.yaw_rate = packet_in.yaw_rate;
756  packet1.thrust = packet_in.thrust;
757 
758 
759 
760  memset(&packet2, 0, sizeof(packet2));
761  mavlink_msg_roll_pitch_yaw_rates_thrust_setpoint_encode(system_id, component_id, &msg, &packet1);
762  mavlink_msg_roll_pitch_yaw_rates_thrust_setpoint_decode(&msg, &packet2);
763  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
764 
765  memset(&packet2, 0, sizeof(packet2));
766  mavlink_msg_roll_pitch_yaw_rates_thrust_setpoint_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.roll_rate , packet1.pitch_rate , packet1.yaw_rate , packet1.thrust );
767  mavlink_msg_roll_pitch_yaw_rates_thrust_setpoint_decode(&msg, &packet2);
768  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
769 
770  memset(&packet2, 0, sizeof(packet2));
771  mavlink_msg_roll_pitch_yaw_rates_thrust_setpoint_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.roll_rate , packet1.pitch_rate , packet1.yaw_rate , packet1.thrust );
772  mavlink_msg_roll_pitch_yaw_rates_thrust_setpoint_decode(&msg, &packet2);
773  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
774 
775  memset(&packet2, 0, sizeof(packet2));
776  mavlink_msg_to_send_buffer(buffer, &msg);
777  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
778  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
779  }
780  mavlink_msg_roll_pitch_yaw_rates_thrust_setpoint_decode(last_msg, &packet2);
781  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
782 
783  memset(&packet2, 0, sizeof(packet2));
784  mavlink_msg_roll_pitch_yaw_rates_thrust_setpoint_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.roll_rate , packet1.pitch_rate , packet1.yaw_rate , packet1.thrust );
785  mavlink_msg_roll_pitch_yaw_rates_thrust_setpoint_decode(last_msg, &packet2);
786  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
787 }
788 
789 static void mavlink_test_spherical_optic_flow(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
790 {
791  mavlink_message_t msg;
792  uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
793  uint16_t i;
794  mavlink_spherical_optic_flow_t packet_in = {
795  93372036854775807ULL,{ 17651, 17652, 17653, 17654, 17655, 17656, 17657, 17658, 17659, 17660, 17661, 17662, 17663, 17664, 17665, 17666, 17667, 17668 },{ 19523, 19524, 19525, 19526, 19527, 19528, 19529, 19530, 19531, 19532, 19533, 19534, 19535, 19536, 19537, 19538, 19539, 19540 },{ 21395, 21396, 21397, 21398, 21399, 21400, 21401, 21402, 21403, 21404, 21405, 21406, 21407, 21408, 21409, 21410, 21411, 21412 },{ 23267, 23268, 23269, 23270, 23271, 23272, 23273, 23274, 23275, 23276, 23277, 23278, 23279, 23280, 23281, 23282, 23283, 23284 },205,16,83,150,{ 217, 218, 219, 220, 221, 222, 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234 }
796  };
797  mavlink_spherical_optic_flow_t packet1, packet2;
798  memset(&packet1, 0, sizeof(packet1));
799  packet1.time_usec = packet_in.time_usec;
800  packet1.id_sensor = packet_in.id_sensor;
801  packet1.nb_sensors = packet_in.nb_sensors;
802  packet1.nb_of = packet_in.nb_of;
803  packet1.status = packet_in.status;
804 
805  mav_array_memcpy(packet1.of_azimuth, packet_in.of_azimuth, sizeof(int16_t)*18);
806  mav_array_memcpy(packet1.of_elevation, packet_in.of_elevation, sizeof(int16_t)*18);
807  mav_array_memcpy(packet1.azimuth, packet_in.azimuth, sizeof(int16_t)*18);
808  mav_array_memcpy(packet1.elevation, packet_in.elevation, sizeof(int16_t)*18);
809  mav_array_memcpy(packet1.of_info, packet_in.of_info, sizeof(uint8_t)*18);
810 
811 
812  memset(&packet2, 0, sizeof(packet2));
813  mavlink_msg_spherical_optic_flow_encode(system_id, component_id, &msg, &packet1);
814  mavlink_msg_spherical_optic_flow_decode(&msg, &packet2);
815  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
816 
817  memset(&packet2, 0, sizeof(packet2));
818  mavlink_msg_spherical_optic_flow_pack(system_id, component_id, &msg , packet1.time_usec , packet1.id_sensor , packet1.nb_sensors , packet1.nb_of , packet1.status , packet1.of_azimuth , packet1.of_elevation , packet1.azimuth , packet1.elevation , packet1.of_info );
819  mavlink_msg_spherical_optic_flow_decode(&msg, &packet2);
820  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
821 
822  memset(&packet2, 0, sizeof(packet2));
823  mavlink_msg_spherical_optic_flow_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.id_sensor , packet1.nb_sensors , packet1.nb_of , packet1.status , packet1.of_azimuth , packet1.of_elevation , packet1.azimuth , packet1.elevation , packet1.of_info );
824  mavlink_msg_spherical_optic_flow_decode(&msg, &packet2);
825  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
826 
827  memset(&packet2, 0, sizeof(packet2));
828  mavlink_msg_to_send_buffer(buffer, &msg);
829  for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
830  comm_send_ch(MAVLINK_COMM_0, buffer[i]);
831  }
832  mavlink_msg_spherical_optic_flow_decode(last_msg, &packet2);
833  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
834 
835  memset(&packet2, 0, sizeof(packet2));
836  mavlink_msg_spherical_optic_flow_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.id_sensor , packet1.nb_sensors , packet1.nb_of , packet1.status , packet1.of_azimuth , packet1.of_elevation , packet1.azimuth , packet1.elevation , packet1.of_info );
837  mavlink_msg_spherical_optic_flow_decode(last_msg, &packet2);
838  MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
839 }
840 
841 static void mavlink_test_mavric(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
842 {
843  mavlink_test_radar_tracked_target(system_id, component_id, last_msg);
844  mavlink_test_radar_velocity_hist(system_id, component_id, last_msg);
845  mavlink_test_radar_raw_data(system_id, component_id, last_msg);
846  mavlink_test_set_local_position_setpoint(system_id, component_id, last_msg);
847  mavlink_test_local_position_setpoint(system_id, component_id, last_msg);
848  mavlink_test_global_position_setpoint_int(system_id, component_id, last_msg);
849  mavlink_test_set_global_position_setpoint_int(system_id, component_id, last_msg);
850  mavlink_test_set_roll_pitch_yaw_thrust(system_id, component_id, last_msg);
851  mavlink_test_set_roll_pitch_yaw_speed_thrust(system_id, component_id, last_msg);
852  mavlink_test_roll_pitch_yaw_thrust_setpoint(system_id, component_id, last_msg);
853  mavlink_test_roll_pitch_yaw_speed_thrust_setpoint(system_id, component_id, last_msg);
854  mavlink_test_set_quad_motors_setpoint(system_id, component_id, last_msg);
855  mavlink_test_set_quad_swarm_roll_pitch_yaw_thrust(system_id, component_id, last_msg);
856  mavlink_test_set_quad_swarm_led_roll_pitch_yaw_thrust(system_id, component_id, last_msg);
857  mavlink_test_state_correction(system_id, component_id, last_msg);
858  mavlink_test_roll_pitch_yaw_rates_thrust_setpoint(system_id, component_id, last_msg);
859  mavlink_test_spherical_optic_flow(system_id, component_id, last_msg);
860 }
861 
862 #ifdef __cplusplus
863 }
864 #endif // __cplusplus
865 #endif // MAVRIC_TESTSUITE_H