1
0

mavlink_msg_vk_formation_leader.h 34 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764
  1. #pragma once
  2. // MESSAGE VK_FORMATION_LEADER PACKING
  3. #define MAVLINK_MSG_ID_VK_FORMATION_LEADER 53004
  4. MAVPACKED(
  5. typedef struct __mavlink_vk_formation_leader_t {
  6. uint32_t timestamp; /*< [ms] Timestamp in ms from system boot.*/
  7. uint32_t state; /*< formation leader drone state bitmap*/
  8. int32_t lat; /*< [degE7] formation leader latitude in 1e-7deg */
  9. int32_t lon; /*< [degE7] formation leader longitude in 1e-7deg*/
  10. float msl; /*< [m] formation leader msl altitude in meter*/
  11. float ve; /*< [m/s] formation leader east speed*/
  12. float vn; /*< [m/s] formation leader north speed*/
  13. float vu; /*< [m/s] formation leader up speed*/
  14. float yaw; /*< [deg] formation leader yaw*/
  15. int16_t x_dist; /*< [cm] distance between drones in x axis*/
  16. int16_t y_dist; /*< [cm] distance between drones in y axis*/
  17. int16_t z_dist; /*< [cm] distance between drones in z axis*/
  18. uint16_t rect_col_num; /*< columns number of rectangle formation*/
  19. uint8_t formation_type; /*< formation type*/
  20. float formation_heading; /*< [deg] if nan, use yaw as formation heading*/
  21. float form_head_lock; /*< 0 unlock, 1 lock*/
  22. float ae; /*< [m/s/s] formation leader east acceleration*/
  23. float an; /*< [m/s/s] formation leader east acceleration*/
  24. float au; /*< [m/s/s] formation leader east acceleration*/
  25. }) mavlink_vk_formation_leader_t;
  26. #define MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN 65
  27. #define MAVLINK_MSG_ID_VK_FORMATION_LEADER_MIN_LEN 45
  28. #define MAVLINK_MSG_ID_53004_LEN 65
  29. #define MAVLINK_MSG_ID_53004_MIN_LEN 45
  30. #define MAVLINK_MSG_ID_VK_FORMATION_LEADER_CRC 219
  31. #define MAVLINK_MSG_ID_53004_CRC 219
  32. #if MAVLINK_COMMAND_24BIT
  33. #define MAVLINK_MESSAGE_INFO_VK_FORMATION_LEADER { \
  34. 53004, \
  35. "VK_FORMATION_LEADER", \
  36. 19, \
  37. { { "timestamp", NULL, MAVLINK_TYPE_UINT32_T, 0, 0, offsetof(mavlink_vk_formation_leader_t, timestamp) }, \
  38. { "state", NULL, MAVLINK_TYPE_UINT32_T, 0, 4, offsetof(mavlink_vk_formation_leader_t, state) }, \
  39. { "lat", NULL, MAVLINK_TYPE_INT32_T, 0, 8, offsetof(mavlink_vk_formation_leader_t, lat) }, \
  40. { "lon", NULL, MAVLINK_TYPE_INT32_T, 0, 12, offsetof(mavlink_vk_formation_leader_t, lon) }, \
  41. { "msl", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_vk_formation_leader_t, msl) }, \
  42. { "ve", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_vk_formation_leader_t, ve) }, \
  43. { "vn", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_vk_formation_leader_t, vn) }, \
  44. { "vu", NULL, MAVLINK_TYPE_FLOAT, 0, 28, offsetof(mavlink_vk_formation_leader_t, vu) }, \
  45. { "yaw", NULL, MAVLINK_TYPE_FLOAT, 0, 32, offsetof(mavlink_vk_formation_leader_t, yaw) }, \
  46. { "formation_type", NULL, MAVLINK_TYPE_UINT8_T, 0, 44, offsetof(mavlink_vk_formation_leader_t, formation_type) }, \
  47. { "x_dist", NULL, MAVLINK_TYPE_INT16_T, 0, 36, offsetof(mavlink_vk_formation_leader_t, x_dist) }, \
  48. { "y_dist", NULL, MAVLINK_TYPE_INT16_T, 0, 38, offsetof(mavlink_vk_formation_leader_t, y_dist) }, \
  49. { "z_dist", NULL, MAVLINK_TYPE_INT16_T, 0, 40, offsetof(mavlink_vk_formation_leader_t, z_dist) }, \
  50. { "rect_col_num", NULL, MAVLINK_TYPE_UINT16_T, 0, 42, offsetof(mavlink_vk_formation_leader_t, rect_col_num) }, \
  51. { "formation_heading", NULL, MAVLINK_TYPE_FLOAT, 0, 45, offsetof(mavlink_vk_formation_leader_t, formation_heading) }, \
  52. { "form_head_lock", NULL, MAVLINK_TYPE_FLOAT, 0, 49, offsetof(mavlink_vk_formation_leader_t, form_head_lock) }, \
  53. { "ae", NULL, MAVLINK_TYPE_FLOAT, 0, 53, offsetof(mavlink_vk_formation_leader_t, ae) }, \
  54. { "an", NULL, MAVLINK_TYPE_FLOAT, 0, 57, offsetof(mavlink_vk_formation_leader_t, an) }, \
  55. { "au", NULL, MAVLINK_TYPE_FLOAT, 0, 61, offsetof(mavlink_vk_formation_leader_t, au) }, \
  56. } \
  57. }
  58. #else
  59. #define MAVLINK_MESSAGE_INFO_VK_FORMATION_LEADER { \
  60. "VK_FORMATION_LEADER", \
  61. 19, \
  62. { { "timestamp", NULL, MAVLINK_TYPE_UINT32_T, 0, 0, offsetof(mavlink_vk_formation_leader_t, timestamp) }, \
  63. { "state", NULL, MAVLINK_TYPE_UINT32_T, 0, 4, offsetof(mavlink_vk_formation_leader_t, state) }, \
  64. { "lat", NULL, MAVLINK_TYPE_INT32_T, 0, 8, offsetof(mavlink_vk_formation_leader_t, lat) }, \
  65. { "lon", NULL, MAVLINK_TYPE_INT32_T, 0, 12, offsetof(mavlink_vk_formation_leader_t, lon) }, \
  66. { "msl", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_vk_formation_leader_t, msl) }, \
  67. { "ve", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_vk_formation_leader_t, ve) }, \
  68. { "vn", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_vk_formation_leader_t, vn) }, \
  69. { "vu", NULL, MAVLINK_TYPE_FLOAT, 0, 28, offsetof(mavlink_vk_formation_leader_t, vu) }, \
  70. { "yaw", NULL, MAVLINK_TYPE_FLOAT, 0, 32, offsetof(mavlink_vk_formation_leader_t, yaw) }, \
  71. { "formation_type", NULL, MAVLINK_TYPE_UINT8_T, 0, 44, offsetof(mavlink_vk_formation_leader_t, formation_type) }, \
  72. { "x_dist", NULL, MAVLINK_TYPE_INT16_T, 0, 36, offsetof(mavlink_vk_formation_leader_t, x_dist) }, \
  73. { "y_dist", NULL, MAVLINK_TYPE_INT16_T, 0, 38, offsetof(mavlink_vk_formation_leader_t, y_dist) }, \
  74. { "z_dist", NULL, MAVLINK_TYPE_INT16_T, 0, 40, offsetof(mavlink_vk_formation_leader_t, z_dist) }, \
  75. { "rect_col_num", NULL, MAVLINK_TYPE_UINT16_T, 0, 42, offsetof(mavlink_vk_formation_leader_t, rect_col_num) }, \
  76. { "formation_heading", NULL, MAVLINK_TYPE_FLOAT, 0, 45, offsetof(mavlink_vk_formation_leader_t, formation_heading) }, \
  77. { "form_head_lock", NULL, MAVLINK_TYPE_FLOAT, 0, 49, offsetof(mavlink_vk_formation_leader_t, form_head_lock) }, \
  78. { "ae", NULL, MAVLINK_TYPE_FLOAT, 0, 53, offsetof(mavlink_vk_formation_leader_t, ae) }, \
  79. { "an", NULL, MAVLINK_TYPE_FLOAT, 0, 57, offsetof(mavlink_vk_formation_leader_t, an) }, \
  80. { "au", NULL, MAVLINK_TYPE_FLOAT, 0, 61, offsetof(mavlink_vk_formation_leader_t, au) }, \
  81. } \
  82. }
  83. #endif
  84. /**
  85. * @brief Pack a vk_formation_leader message
  86. * @param system_id ID of this system
  87. * @param component_id ID of this component (e.g. 200 for IMU)
  88. * @param msg The MAVLink message to compress the data into
  89. *
  90. * @param timestamp [ms] Timestamp in ms from system boot.
  91. * @param state formation leader drone state bitmap
  92. * @param lat [degE7] formation leader latitude in 1e-7deg
  93. * @param lon [degE7] formation leader longitude in 1e-7deg
  94. * @param msl [m] formation leader msl altitude in meter
  95. * @param ve [m/s] formation leader east speed
  96. * @param vn [m/s] formation leader north speed
  97. * @param vu [m/s] formation leader up speed
  98. * @param yaw [deg] formation leader yaw
  99. * @param formation_type formation type
  100. * @param x_dist [cm] distance between drones in x axis
  101. * @param y_dist [cm] distance between drones in y axis
  102. * @param z_dist [cm] distance between drones in z axis
  103. * @param rect_col_num columns number of rectangle formation
  104. * @param formation_heading [deg] if nan, use yaw as formation heading
  105. * @param form_head_lock 0 unlock, 1 lock
  106. * @param ae [m/s/s] formation leader east acceleration
  107. * @param an [m/s/s] formation leader east acceleration
  108. * @param au [m/s/s] formation leader east acceleration
  109. * @return length of the message in bytes (excluding serial stream start sign)
  110. */
  111. static inline uint16_t mavlink_msg_vk_formation_leader_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
  112. uint32_t timestamp, uint32_t state, int32_t lat, int32_t lon, float msl, float ve, float vn, float vu, float yaw, uint8_t formation_type, int16_t x_dist, int16_t y_dist, int16_t z_dist, uint16_t rect_col_num, float formation_heading, float form_head_lock, float ae, float an, float au)
  113. {
  114. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  115. char buf[MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN];
  116. _mav_put_uint32_t(buf, 0, timestamp);
  117. _mav_put_uint32_t(buf, 4, state);
  118. _mav_put_int32_t(buf, 8, lat);
  119. _mav_put_int32_t(buf, 12, lon);
  120. _mav_put_float(buf, 16, msl);
  121. _mav_put_float(buf, 20, ve);
  122. _mav_put_float(buf, 24, vn);
  123. _mav_put_float(buf, 28, vu);
  124. _mav_put_float(buf, 32, yaw);
  125. _mav_put_int16_t(buf, 36, x_dist);
  126. _mav_put_int16_t(buf, 38, y_dist);
  127. _mav_put_int16_t(buf, 40, z_dist);
  128. _mav_put_uint16_t(buf, 42, rect_col_num);
  129. _mav_put_uint8_t(buf, 44, formation_type);
  130. _mav_put_float(buf, 45, formation_heading);
  131. _mav_put_float(buf, 49, form_head_lock);
  132. _mav_put_float(buf, 53, ae);
  133. _mav_put_float(buf, 57, an);
  134. _mav_put_float(buf, 61, au);
  135. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN);
  136. #else
  137. mavlink_vk_formation_leader_t packet;
  138. packet.timestamp = timestamp;
  139. packet.state = state;
  140. packet.lat = lat;
  141. packet.lon = lon;
  142. packet.msl = msl;
  143. packet.ve = ve;
  144. packet.vn = vn;
  145. packet.vu = vu;
  146. packet.yaw = yaw;
  147. packet.x_dist = x_dist;
  148. packet.y_dist = y_dist;
  149. packet.z_dist = z_dist;
  150. packet.rect_col_num = rect_col_num;
  151. packet.formation_type = formation_type;
  152. packet.formation_heading = formation_heading;
  153. packet.form_head_lock = form_head_lock;
  154. packet.ae = ae;
  155. packet.an = an;
  156. packet.au = au;
  157. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN);
  158. #endif
  159. msg->msgid = MAVLINK_MSG_ID_VK_FORMATION_LEADER;
  160. return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_VK_FORMATION_LEADER_MIN_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_CRC);
  161. }
  162. /**
  163. * @brief Pack a vk_formation_leader message
  164. * @param system_id ID of this system
  165. * @param component_id ID of this component (e.g. 200 for IMU)
  166. * @param status MAVLink status structure
  167. * @param msg The MAVLink message to compress the data into
  168. *
  169. * @param timestamp [ms] Timestamp in ms from system boot.
  170. * @param state formation leader drone state bitmap
  171. * @param lat [degE7] formation leader latitude in 1e-7deg
  172. * @param lon [degE7] formation leader longitude in 1e-7deg
  173. * @param msl [m] formation leader msl altitude in meter
  174. * @param ve [m/s] formation leader east speed
  175. * @param vn [m/s] formation leader north speed
  176. * @param vu [m/s] formation leader up speed
  177. * @param yaw [deg] formation leader yaw
  178. * @param formation_type formation type
  179. * @param x_dist [cm] distance between drones in x axis
  180. * @param y_dist [cm] distance between drones in y axis
  181. * @param z_dist [cm] distance between drones in z axis
  182. * @param rect_col_num columns number of rectangle formation
  183. * @param formation_heading [deg] if nan, use yaw as formation heading
  184. * @param form_head_lock 0 unlock, 1 lock
  185. * @param ae [m/s/s] formation leader east acceleration
  186. * @param an [m/s/s] formation leader east acceleration
  187. * @param au [m/s/s] formation leader east acceleration
  188. * @return length of the message in bytes (excluding serial stream start sign)
  189. */
  190. static inline uint16_t mavlink_msg_vk_formation_leader_pack_status(uint8_t system_id, uint8_t component_id, mavlink_status_t *_status, mavlink_message_t* msg,
  191. uint32_t timestamp, uint32_t state, int32_t lat, int32_t lon, float msl, float ve, float vn, float vu, float yaw, uint8_t formation_type, int16_t x_dist, int16_t y_dist, int16_t z_dist, uint16_t rect_col_num, float formation_heading, float form_head_lock, float ae, float an, float au)
  192. {
  193. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  194. char buf[MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN];
  195. _mav_put_uint32_t(buf, 0, timestamp);
  196. _mav_put_uint32_t(buf, 4, state);
  197. _mav_put_int32_t(buf, 8, lat);
  198. _mav_put_int32_t(buf, 12, lon);
  199. _mav_put_float(buf, 16, msl);
  200. _mav_put_float(buf, 20, ve);
  201. _mav_put_float(buf, 24, vn);
  202. _mav_put_float(buf, 28, vu);
  203. _mav_put_float(buf, 32, yaw);
  204. _mav_put_int16_t(buf, 36, x_dist);
  205. _mav_put_int16_t(buf, 38, y_dist);
  206. _mav_put_int16_t(buf, 40, z_dist);
  207. _mav_put_uint16_t(buf, 42, rect_col_num);
  208. _mav_put_uint8_t(buf, 44, formation_type);
  209. _mav_put_float(buf, 45, formation_heading);
  210. _mav_put_float(buf, 49, form_head_lock);
  211. _mav_put_float(buf, 53, ae);
  212. _mav_put_float(buf, 57, an);
  213. _mav_put_float(buf, 61, au);
  214. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN);
  215. #else
  216. mavlink_vk_formation_leader_t packet;
  217. packet.timestamp = timestamp;
  218. packet.state = state;
  219. packet.lat = lat;
  220. packet.lon = lon;
  221. packet.msl = msl;
  222. packet.ve = ve;
  223. packet.vn = vn;
  224. packet.vu = vu;
  225. packet.yaw = yaw;
  226. packet.x_dist = x_dist;
  227. packet.y_dist = y_dist;
  228. packet.z_dist = z_dist;
  229. packet.rect_col_num = rect_col_num;
  230. packet.formation_type = formation_type;
  231. packet.formation_heading = formation_heading;
  232. packet.form_head_lock = form_head_lock;
  233. packet.ae = ae;
  234. packet.an = an;
  235. packet.au = au;
  236. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN);
  237. #endif
  238. msg->msgid = MAVLINK_MSG_ID_VK_FORMATION_LEADER;
  239. #if MAVLINK_CRC_EXTRA
  240. return mavlink_finalize_message_buffer(msg, system_id, component_id, _status, MAVLINK_MSG_ID_VK_FORMATION_LEADER_MIN_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_CRC);
  241. #else
  242. return mavlink_finalize_message_buffer(msg, system_id, component_id, _status, MAVLINK_MSG_ID_VK_FORMATION_LEADER_MIN_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN);
  243. #endif
  244. }
  245. /**
  246. * @brief Pack a vk_formation_leader message on a channel
  247. * @param system_id ID of this system
  248. * @param component_id ID of this component (e.g. 200 for IMU)
  249. * @param chan The MAVLink channel this message will be sent over
  250. * @param msg The MAVLink message to compress the data into
  251. * @param timestamp [ms] Timestamp in ms from system boot.
  252. * @param state formation leader drone state bitmap
  253. * @param lat [degE7] formation leader latitude in 1e-7deg
  254. * @param lon [degE7] formation leader longitude in 1e-7deg
  255. * @param msl [m] formation leader msl altitude in meter
  256. * @param ve [m/s] formation leader east speed
  257. * @param vn [m/s] formation leader north speed
  258. * @param vu [m/s] formation leader up speed
  259. * @param yaw [deg] formation leader yaw
  260. * @param formation_type formation type
  261. * @param x_dist [cm] distance between drones in x axis
  262. * @param y_dist [cm] distance between drones in y axis
  263. * @param z_dist [cm] distance between drones in z axis
  264. * @param rect_col_num columns number of rectangle formation
  265. * @param formation_heading [deg] if nan, use yaw as formation heading
  266. * @param form_head_lock 0 unlock, 1 lock
  267. * @param ae [m/s/s] formation leader east acceleration
  268. * @param an [m/s/s] formation leader east acceleration
  269. * @param au [m/s/s] formation leader east acceleration
  270. * @return length of the message in bytes (excluding serial stream start sign)
  271. */
  272. static inline uint16_t mavlink_msg_vk_formation_leader_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
  273. mavlink_message_t* msg,
  274. uint32_t timestamp,uint32_t state,int32_t lat,int32_t lon,float msl,float ve,float vn,float vu,float yaw,uint8_t formation_type,int16_t x_dist,int16_t y_dist,int16_t z_dist,uint16_t rect_col_num,float formation_heading,float form_head_lock,float ae,float an,float au)
  275. {
  276. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  277. char buf[MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN];
  278. _mav_put_uint32_t(buf, 0, timestamp);
  279. _mav_put_uint32_t(buf, 4, state);
  280. _mav_put_int32_t(buf, 8, lat);
  281. _mav_put_int32_t(buf, 12, lon);
  282. _mav_put_float(buf, 16, msl);
  283. _mav_put_float(buf, 20, ve);
  284. _mav_put_float(buf, 24, vn);
  285. _mav_put_float(buf, 28, vu);
  286. _mav_put_float(buf, 32, yaw);
  287. _mav_put_int16_t(buf, 36, x_dist);
  288. _mav_put_int16_t(buf, 38, y_dist);
  289. _mav_put_int16_t(buf, 40, z_dist);
  290. _mav_put_uint16_t(buf, 42, rect_col_num);
  291. _mav_put_uint8_t(buf, 44, formation_type);
  292. _mav_put_float(buf, 45, formation_heading);
  293. _mav_put_float(buf, 49, form_head_lock);
  294. _mav_put_float(buf, 53, ae);
  295. _mav_put_float(buf, 57, an);
  296. _mav_put_float(buf, 61, au);
  297. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN);
  298. #else
  299. mavlink_vk_formation_leader_t packet;
  300. packet.timestamp = timestamp;
  301. packet.state = state;
  302. packet.lat = lat;
  303. packet.lon = lon;
  304. packet.msl = msl;
  305. packet.ve = ve;
  306. packet.vn = vn;
  307. packet.vu = vu;
  308. packet.yaw = yaw;
  309. packet.x_dist = x_dist;
  310. packet.y_dist = y_dist;
  311. packet.z_dist = z_dist;
  312. packet.rect_col_num = rect_col_num;
  313. packet.formation_type = formation_type;
  314. packet.formation_heading = formation_heading;
  315. packet.form_head_lock = form_head_lock;
  316. packet.ae = ae;
  317. packet.an = an;
  318. packet.au = au;
  319. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN);
  320. #endif
  321. msg->msgid = MAVLINK_MSG_ID_VK_FORMATION_LEADER;
  322. return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_VK_FORMATION_LEADER_MIN_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_CRC);
  323. }
  324. /**
  325. * @brief Encode a vk_formation_leader struct
  326. *
  327. * @param system_id ID of this system
  328. * @param component_id ID of this component (e.g. 200 for IMU)
  329. * @param msg The MAVLink message to compress the data into
  330. * @param vk_formation_leader C-struct to read the message contents from
  331. */
  332. static inline uint16_t mavlink_msg_vk_formation_leader_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_vk_formation_leader_t* vk_formation_leader)
  333. {
  334. return mavlink_msg_vk_formation_leader_pack(system_id, component_id, msg, vk_formation_leader->timestamp, vk_formation_leader->state, vk_formation_leader->lat, vk_formation_leader->lon, vk_formation_leader->msl, vk_formation_leader->ve, vk_formation_leader->vn, vk_formation_leader->vu, vk_formation_leader->yaw, vk_formation_leader->formation_type, vk_formation_leader->x_dist, vk_formation_leader->y_dist, vk_formation_leader->z_dist, vk_formation_leader->rect_col_num, vk_formation_leader->formation_heading, vk_formation_leader->form_head_lock, vk_formation_leader->ae, vk_formation_leader->an, vk_formation_leader->au);
  335. }
  336. /**
  337. * @brief Encode a vk_formation_leader struct on a channel
  338. *
  339. * @param system_id ID of this system
  340. * @param component_id ID of this component (e.g. 200 for IMU)
  341. * @param chan The MAVLink channel this message will be sent over
  342. * @param msg The MAVLink message to compress the data into
  343. * @param vk_formation_leader C-struct to read the message contents from
  344. */
  345. static inline uint16_t mavlink_msg_vk_formation_leader_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_vk_formation_leader_t* vk_formation_leader)
  346. {
  347. return mavlink_msg_vk_formation_leader_pack_chan(system_id, component_id, chan, msg, vk_formation_leader->timestamp, vk_formation_leader->state, vk_formation_leader->lat, vk_formation_leader->lon, vk_formation_leader->msl, vk_formation_leader->ve, vk_formation_leader->vn, vk_formation_leader->vu, vk_formation_leader->yaw, vk_formation_leader->formation_type, vk_formation_leader->x_dist, vk_formation_leader->y_dist, vk_formation_leader->z_dist, vk_formation_leader->rect_col_num, vk_formation_leader->formation_heading, vk_formation_leader->form_head_lock, vk_formation_leader->ae, vk_formation_leader->an, vk_formation_leader->au);
  348. }
  349. /**
  350. * @brief Encode a vk_formation_leader struct with provided status structure
  351. *
  352. * @param system_id ID of this system
  353. * @param component_id ID of this component (e.g. 200 for IMU)
  354. * @param status MAVLink status structure
  355. * @param msg The MAVLink message to compress the data into
  356. * @param vk_formation_leader C-struct to read the message contents from
  357. */
  358. static inline uint16_t mavlink_msg_vk_formation_leader_encode_status(uint8_t system_id, uint8_t component_id, mavlink_status_t* _status, mavlink_message_t* msg, const mavlink_vk_formation_leader_t* vk_formation_leader)
  359. {
  360. return mavlink_msg_vk_formation_leader_pack_status(system_id, component_id, _status, msg, vk_formation_leader->timestamp, vk_formation_leader->state, vk_formation_leader->lat, vk_formation_leader->lon, vk_formation_leader->msl, vk_formation_leader->ve, vk_formation_leader->vn, vk_formation_leader->vu, vk_formation_leader->yaw, vk_formation_leader->formation_type, vk_formation_leader->x_dist, vk_formation_leader->y_dist, vk_formation_leader->z_dist, vk_formation_leader->rect_col_num, vk_formation_leader->formation_heading, vk_formation_leader->form_head_lock, vk_formation_leader->ae, vk_formation_leader->an, vk_formation_leader->au);
  361. }
  362. /**
  363. * @brief Send a vk_formation_leader message
  364. * @param chan MAVLink channel to send the message
  365. *
  366. * @param timestamp [ms] Timestamp in ms from system boot.
  367. * @param state formation leader drone state bitmap
  368. * @param lat [degE7] formation leader latitude in 1e-7deg
  369. * @param lon [degE7] formation leader longitude in 1e-7deg
  370. * @param msl [m] formation leader msl altitude in meter
  371. * @param ve [m/s] formation leader east speed
  372. * @param vn [m/s] formation leader north speed
  373. * @param vu [m/s] formation leader up speed
  374. * @param yaw [deg] formation leader yaw
  375. * @param formation_type formation type
  376. * @param x_dist [cm] distance between drones in x axis
  377. * @param y_dist [cm] distance between drones in y axis
  378. * @param z_dist [cm] distance between drones in z axis
  379. * @param rect_col_num columns number of rectangle formation
  380. * @param formation_heading [deg] if nan, use yaw as formation heading
  381. * @param form_head_lock 0 unlock, 1 lock
  382. * @param ae [m/s/s] formation leader east acceleration
  383. * @param an [m/s/s] formation leader east acceleration
  384. * @param au [m/s/s] formation leader east acceleration
  385. */
  386. #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
  387. static inline void mavlink_msg_vk_formation_leader_send(mavlink_channel_t chan, uint32_t timestamp, uint32_t state, int32_t lat, int32_t lon, float msl, float ve, float vn, float vu, float yaw, uint8_t formation_type, int16_t x_dist, int16_t y_dist, int16_t z_dist, uint16_t rect_col_num, float formation_heading, float form_head_lock, float ae, float an, float au)
  388. {
  389. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  390. char buf[MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN];
  391. _mav_put_uint32_t(buf, 0, timestamp);
  392. _mav_put_uint32_t(buf, 4, state);
  393. _mav_put_int32_t(buf, 8, lat);
  394. _mav_put_int32_t(buf, 12, lon);
  395. _mav_put_float(buf, 16, msl);
  396. _mav_put_float(buf, 20, ve);
  397. _mav_put_float(buf, 24, vn);
  398. _mav_put_float(buf, 28, vu);
  399. _mav_put_float(buf, 32, yaw);
  400. _mav_put_int16_t(buf, 36, x_dist);
  401. _mav_put_int16_t(buf, 38, y_dist);
  402. _mav_put_int16_t(buf, 40, z_dist);
  403. _mav_put_uint16_t(buf, 42, rect_col_num);
  404. _mav_put_uint8_t(buf, 44, formation_type);
  405. _mav_put_float(buf, 45, formation_heading);
  406. _mav_put_float(buf, 49, form_head_lock);
  407. _mav_put_float(buf, 53, ae);
  408. _mav_put_float(buf, 57, an);
  409. _mav_put_float(buf, 61, au);
  410. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VK_FORMATION_LEADER, buf, MAVLINK_MSG_ID_VK_FORMATION_LEADER_MIN_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_CRC);
  411. #else
  412. mavlink_vk_formation_leader_t packet;
  413. packet.timestamp = timestamp;
  414. packet.state = state;
  415. packet.lat = lat;
  416. packet.lon = lon;
  417. packet.msl = msl;
  418. packet.ve = ve;
  419. packet.vn = vn;
  420. packet.vu = vu;
  421. packet.yaw = yaw;
  422. packet.x_dist = x_dist;
  423. packet.y_dist = y_dist;
  424. packet.z_dist = z_dist;
  425. packet.rect_col_num = rect_col_num;
  426. packet.formation_type = formation_type;
  427. packet.formation_heading = formation_heading;
  428. packet.form_head_lock = form_head_lock;
  429. packet.ae = ae;
  430. packet.an = an;
  431. packet.au = au;
  432. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VK_FORMATION_LEADER, (const char *)&packet, MAVLINK_MSG_ID_VK_FORMATION_LEADER_MIN_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_CRC);
  433. #endif
  434. }
  435. /**
  436. * @brief Send a vk_formation_leader message
  437. * @param chan MAVLink channel to send the message
  438. * @param struct The MAVLink struct to serialize
  439. */
  440. static inline void mavlink_msg_vk_formation_leader_send_struct(mavlink_channel_t chan, const mavlink_vk_formation_leader_t* vk_formation_leader)
  441. {
  442. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  443. mavlink_msg_vk_formation_leader_send(chan, vk_formation_leader->timestamp, vk_formation_leader->state, vk_formation_leader->lat, vk_formation_leader->lon, vk_formation_leader->msl, vk_formation_leader->ve, vk_formation_leader->vn, vk_formation_leader->vu, vk_formation_leader->yaw, vk_formation_leader->formation_type, vk_formation_leader->x_dist, vk_formation_leader->y_dist, vk_formation_leader->z_dist, vk_formation_leader->rect_col_num, vk_formation_leader->formation_heading, vk_formation_leader->form_head_lock, vk_formation_leader->ae, vk_formation_leader->an, vk_formation_leader->au);
  444. #else
  445. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VK_FORMATION_LEADER, (const char *)vk_formation_leader, MAVLINK_MSG_ID_VK_FORMATION_LEADER_MIN_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_CRC);
  446. #endif
  447. }
  448. #if MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN <= MAVLINK_MAX_PAYLOAD_LEN
  449. /*
  450. This variant of _send() can be used to save stack space by re-using
  451. memory from the receive buffer. The caller provides a
  452. mavlink_message_t which is the size of a full mavlink message. This
  453. is usually the receive buffer for the channel, and allows a reply to an
  454. incoming message with minimum stack space usage.
  455. */
  456. static inline void mavlink_msg_vk_formation_leader_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, uint32_t timestamp, uint32_t state, int32_t lat, int32_t lon, float msl, float ve, float vn, float vu, float yaw, uint8_t formation_type, int16_t x_dist, int16_t y_dist, int16_t z_dist, uint16_t rect_col_num, float formation_heading, float form_head_lock, float ae, float an, float au)
  457. {
  458. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  459. char *buf = (char *)msgbuf;
  460. _mav_put_uint32_t(buf, 0, timestamp);
  461. _mav_put_uint32_t(buf, 4, state);
  462. _mav_put_int32_t(buf, 8, lat);
  463. _mav_put_int32_t(buf, 12, lon);
  464. _mav_put_float(buf, 16, msl);
  465. _mav_put_float(buf, 20, ve);
  466. _mav_put_float(buf, 24, vn);
  467. _mav_put_float(buf, 28, vu);
  468. _mav_put_float(buf, 32, yaw);
  469. _mav_put_int16_t(buf, 36, x_dist);
  470. _mav_put_int16_t(buf, 38, y_dist);
  471. _mav_put_int16_t(buf, 40, z_dist);
  472. _mav_put_uint16_t(buf, 42, rect_col_num);
  473. _mav_put_uint8_t(buf, 44, formation_type);
  474. _mav_put_float(buf, 45, formation_heading);
  475. _mav_put_float(buf, 49, form_head_lock);
  476. _mav_put_float(buf, 53, ae);
  477. _mav_put_float(buf, 57, an);
  478. _mav_put_float(buf, 61, au);
  479. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VK_FORMATION_LEADER, buf, MAVLINK_MSG_ID_VK_FORMATION_LEADER_MIN_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_CRC);
  480. #else
  481. mavlink_vk_formation_leader_t *packet = (mavlink_vk_formation_leader_t *)msgbuf;
  482. packet->timestamp = timestamp;
  483. packet->state = state;
  484. packet->lat = lat;
  485. packet->lon = lon;
  486. packet->msl = msl;
  487. packet->ve = ve;
  488. packet->vn = vn;
  489. packet->vu = vu;
  490. packet->yaw = yaw;
  491. packet->x_dist = x_dist;
  492. packet->y_dist = y_dist;
  493. packet->z_dist = z_dist;
  494. packet->rect_col_num = rect_col_num;
  495. packet->formation_type = formation_type;
  496. packet->formation_heading = formation_heading;
  497. packet->form_head_lock = form_head_lock;
  498. packet->ae = ae;
  499. packet->an = an;
  500. packet->au = au;
  501. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VK_FORMATION_LEADER, (const char *)packet, MAVLINK_MSG_ID_VK_FORMATION_LEADER_MIN_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN, MAVLINK_MSG_ID_VK_FORMATION_LEADER_CRC);
  502. #endif
  503. }
  504. #endif
  505. #endif
  506. // MESSAGE VK_FORMATION_LEADER UNPACKING
  507. /**
  508. * @brief Get field timestamp from vk_formation_leader message
  509. *
  510. * @return [ms] Timestamp in ms from system boot.
  511. */
  512. static inline uint32_t mavlink_msg_vk_formation_leader_get_timestamp(const mavlink_message_t* msg)
  513. {
  514. return _MAV_RETURN_uint32_t(msg, 0);
  515. }
  516. /**
  517. * @brief Get field state from vk_formation_leader message
  518. *
  519. * @return formation leader drone state bitmap
  520. */
  521. static inline uint32_t mavlink_msg_vk_formation_leader_get_state(const mavlink_message_t* msg)
  522. {
  523. return _MAV_RETURN_uint32_t(msg, 4);
  524. }
  525. /**
  526. * @brief Get field lat from vk_formation_leader message
  527. *
  528. * @return [degE7] formation leader latitude in 1e-7deg
  529. */
  530. static inline int32_t mavlink_msg_vk_formation_leader_get_lat(const mavlink_message_t* msg)
  531. {
  532. return _MAV_RETURN_int32_t(msg, 8);
  533. }
  534. /**
  535. * @brief Get field lon from vk_formation_leader message
  536. *
  537. * @return [degE7] formation leader longitude in 1e-7deg
  538. */
  539. static inline int32_t mavlink_msg_vk_formation_leader_get_lon(const mavlink_message_t* msg)
  540. {
  541. return _MAV_RETURN_int32_t(msg, 12);
  542. }
  543. /**
  544. * @brief Get field msl from vk_formation_leader message
  545. *
  546. * @return [m] formation leader msl altitude in meter
  547. */
  548. static inline float mavlink_msg_vk_formation_leader_get_msl(const mavlink_message_t* msg)
  549. {
  550. return _MAV_RETURN_float(msg, 16);
  551. }
  552. /**
  553. * @brief Get field ve from vk_formation_leader message
  554. *
  555. * @return [m/s] formation leader east speed
  556. */
  557. static inline float mavlink_msg_vk_formation_leader_get_ve(const mavlink_message_t* msg)
  558. {
  559. return _MAV_RETURN_float(msg, 20);
  560. }
  561. /**
  562. * @brief Get field vn from vk_formation_leader message
  563. *
  564. * @return [m/s] formation leader north speed
  565. */
  566. static inline float mavlink_msg_vk_formation_leader_get_vn(const mavlink_message_t* msg)
  567. {
  568. return _MAV_RETURN_float(msg, 24);
  569. }
  570. /**
  571. * @brief Get field vu from vk_formation_leader message
  572. *
  573. * @return [m/s] formation leader up speed
  574. */
  575. static inline float mavlink_msg_vk_formation_leader_get_vu(const mavlink_message_t* msg)
  576. {
  577. return _MAV_RETURN_float(msg, 28);
  578. }
  579. /**
  580. * @brief Get field yaw from vk_formation_leader message
  581. *
  582. * @return [deg] formation leader yaw
  583. */
  584. static inline float mavlink_msg_vk_formation_leader_get_yaw(const mavlink_message_t* msg)
  585. {
  586. return _MAV_RETURN_float(msg, 32);
  587. }
  588. /**
  589. * @brief Get field formation_type from vk_formation_leader message
  590. *
  591. * @return formation type
  592. */
  593. static inline uint8_t mavlink_msg_vk_formation_leader_get_formation_type(const mavlink_message_t* msg)
  594. {
  595. return _MAV_RETURN_uint8_t(msg, 44);
  596. }
  597. /**
  598. * @brief Get field x_dist from vk_formation_leader message
  599. *
  600. * @return [cm] distance between drones in x axis
  601. */
  602. static inline int16_t mavlink_msg_vk_formation_leader_get_x_dist(const mavlink_message_t* msg)
  603. {
  604. return _MAV_RETURN_int16_t(msg, 36);
  605. }
  606. /**
  607. * @brief Get field y_dist from vk_formation_leader message
  608. *
  609. * @return [cm] distance between drones in y axis
  610. */
  611. static inline int16_t mavlink_msg_vk_formation_leader_get_y_dist(const mavlink_message_t* msg)
  612. {
  613. return _MAV_RETURN_int16_t(msg, 38);
  614. }
  615. /**
  616. * @brief Get field z_dist from vk_formation_leader message
  617. *
  618. * @return [cm] distance between drones in z axis
  619. */
  620. static inline int16_t mavlink_msg_vk_formation_leader_get_z_dist(const mavlink_message_t* msg)
  621. {
  622. return _MAV_RETURN_int16_t(msg, 40);
  623. }
  624. /**
  625. * @brief Get field rect_col_num from vk_formation_leader message
  626. *
  627. * @return columns number of rectangle formation
  628. */
  629. static inline uint16_t mavlink_msg_vk_formation_leader_get_rect_col_num(const mavlink_message_t* msg)
  630. {
  631. return _MAV_RETURN_uint16_t(msg, 42);
  632. }
  633. /**
  634. * @brief Get field formation_heading from vk_formation_leader message
  635. *
  636. * @return [deg] if nan, use yaw as formation heading
  637. */
  638. static inline float mavlink_msg_vk_formation_leader_get_formation_heading(const mavlink_message_t* msg)
  639. {
  640. return _MAV_RETURN_float(msg, 45);
  641. }
  642. /**
  643. * @brief Get field form_head_lock from vk_formation_leader message
  644. *
  645. * @return 0 unlock, 1 lock
  646. */
  647. static inline float mavlink_msg_vk_formation_leader_get_form_head_lock(const mavlink_message_t* msg)
  648. {
  649. return _MAV_RETURN_float(msg, 49);
  650. }
  651. /**
  652. * @brief Get field ae from vk_formation_leader message
  653. *
  654. * @return [m/s/s] formation leader east acceleration
  655. */
  656. static inline float mavlink_msg_vk_formation_leader_get_ae(const mavlink_message_t* msg)
  657. {
  658. return _MAV_RETURN_float(msg, 53);
  659. }
  660. /**
  661. * @brief Get field an from vk_formation_leader message
  662. *
  663. * @return [m/s/s] formation leader east acceleration
  664. */
  665. static inline float mavlink_msg_vk_formation_leader_get_an(const mavlink_message_t* msg)
  666. {
  667. return _MAV_RETURN_float(msg, 57);
  668. }
  669. /**
  670. * @brief Get field au from vk_formation_leader message
  671. *
  672. * @return [m/s/s] formation leader east acceleration
  673. */
  674. static inline float mavlink_msg_vk_formation_leader_get_au(const mavlink_message_t* msg)
  675. {
  676. return _MAV_RETURN_float(msg, 61);
  677. }
  678. /**
  679. * @brief Decode a vk_formation_leader message into a struct
  680. *
  681. * @param msg The message to decode
  682. * @param vk_formation_leader C-struct to decode the message contents into
  683. */
  684. static inline void mavlink_msg_vk_formation_leader_decode(const mavlink_message_t* msg, mavlink_vk_formation_leader_t* vk_formation_leader)
  685. {
  686. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  687. vk_formation_leader->timestamp = mavlink_msg_vk_formation_leader_get_timestamp(msg);
  688. vk_formation_leader->state = mavlink_msg_vk_formation_leader_get_state(msg);
  689. vk_formation_leader->lat = mavlink_msg_vk_formation_leader_get_lat(msg);
  690. vk_formation_leader->lon = mavlink_msg_vk_formation_leader_get_lon(msg);
  691. vk_formation_leader->msl = mavlink_msg_vk_formation_leader_get_msl(msg);
  692. vk_formation_leader->ve = mavlink_msg_vk_formation_leader_get_ve(msg);
  693. vk_formation_leader->vn = mavlink_msg_vk_formation_leader_get_vn(msg);
  694. vk_formation_leader->vu = mavlink_msg_vk_formation_leader_get_vu(msg);
  695. vk_formation_leader->yaw = mavlink_msg_vk_formation_leader_get_yaw(msg);
  696. vk_formation_leader->x_dist = mavlink_msg_vk_formation_leader_get_x_dist(msg);
  697. vk_formation_leader->y_dist = mavlink_msg_vk_formation_leader_get_y_dist(msg);
  698. vk_formation_leader->z_dist = mavlink_msg_vk_formation_leader_get_z_dist(msg);
  699. vk_formation_leader->rect_col_num = mavlink_msg_vk_formation_leader_get_rect_col_num(msg);
  700. vk_formation_leader->formation_type = mavlink_msg_vk_formation_leader_get_formation_type(msg);
  701. vk_formation_leader->formation_heading = mavlink_msg_vk_formation_leader_get_formation_heading(msg);
  702. vk_formation_leader->form_head_lock = mavlink_msg_vk_formation_leader_get_form_head_lock(msg);
  703. vk_formation_leader->ae = mavlink_msg_vk_formation_leader_get_ae(msg);
  704. vk_formation_leader->an = mavlink_msg_vk_formation_leader_get_an(msg);
  705. vk_formation_leader->au = mavlink_msg_vk_formation_leader_get_au(msg);
  706. #else
  707. uint8_t len = msg->len < MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN? msg->len : MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN;
  708. memset(vk_formation_leader, 0, MAVLINK_MSG_ID_VK_FORMATION_LEADER_LEN);
  709. memcpy(vk_formation_leader, _MAV_PAYLOAD(msg), len);
  710. #endif
  711. }