mavlink_msg_gimbal_device_set_attitude.h 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418
  1. #pragma once
  2. // MESSAGE GIMBAL_DEVICE_SET_ATTITUDE PACKING
  3. #define MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE 284
  4. typedef struct __mavlink_gimbal_device_set_attitude_t {
  5. float q[4]; /*< Quaternion components, w, x, y, z (1 0 0 0 is the null-rotation). The frame is described in the message description. Set fields to NaN to be ignored.*/
  6. float angular_velocity_x; /*< [rad/s] X component of angular velocity (positive: rolling to the right). The frame is described in the message description. NaN to be ignored.*/
  7. float angular_velocity_y; /*< [rad/s] Y component of angular velocity (positive: pitching up). The frame is described in the message description. NaN to be ignored.*/
  8. float angular_velocity_z; /*< [rad/s] Z component of angular velocity (positive: yawing to the right). The frame is described in the message description. NaN to be ignored.*/
  9. uint16_t flags; /*< Low level gimbal flags.*/
  10. uint8_t target_system; /*< System ID*/
  11. uint8_t target_component; /*< Component ID*/
  12. } mavlink_gimbal_device_set_attitude_t;
  13. #define MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN 32
  14. #define MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_MIN_LEN 32
  15. #define MAVLINK_MSG_ID_284_LEN 32
  16. #define MAVLINK_MSG_ID_284_MIN_LEN 32
  17. #define MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_CRC 99
  18. #define MAVLINK_MSG_ID_284_CRC 99
  19. #define MAVLINK_MSG_GIMBAL_DEVICE_SET_ATTITUDE_FIELD_Q_LEN 4
  20. #if MAVLINK_COMMAND_24BIT
  21. #define MAVLINK_MESSAGE_INFO_GIMBAL_DEVICE_SET_ATTITUDE { \
  22. 284, \
  23. "GIMBAL_DEVICE_SET_ATTITUDE", \
  24. 7, \
  25. { { "target_system", NULL, MAVLINK_TYPE_UINT8_T, 0, 30, offsetof(mavlink_gimbal_device_set_attitude_t, target_system) }, \
  26. { "target_component", NULL, MAVLINK_TYPE_UINT8_T, 0, 31, offsetof(mavlink_gimbal_device_set_attitude_t, target_component) }, \
  27. { "flags", NULL, MAVLINK_TYPE_UINT16_T, 0, 28, offsetof(mavlink_gimbal_device_set_attitude_t, flags) }, \
  28. { "q", NULL, MAVLINK_TYPE_FLOAT, 4, 0, offsetof(mavlink_gimbal_device_set_attitude_t, q) }, \
  29. { "angular_velocity_x", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_gimbal_device_set_attitude_t, angular_velocity_x) }, \
  30. { "angular_velocity_y", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_gimbal_device_set_attitude_t, angular_velocity_y) }, \
  31. { "angular_velocity_z", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_gimbal_device_set_attitude_t, angular_velocity_z) }, \
  32. } \
  33. }
  34. #else
  35. #define MAVLINK_MESSAGE_INFO_GIMBAL_DEVICE_SET_ATTITUDE { \
  36. "GIMBAL_DEVICE_SET_ATTITUDE", \
  37. 7, \
  38. { { "target_system", NULL, MAVLINK_TYPE_UINT8_T, 0, 30, offsetof(mavlink_gimbal_device_set_attitude_t, target_system) }, \
  39. { "target_component", NULL, MAVLINK_TYPE_UINT8_T, 0, 31, offsetof(mavlink_gimbal_device_set_attitude_t, target_component) }, \
  40. { "flags", NULL, MAVLINK_TYPE_UINT16_T, 0, 28, offsetof(mavlink_gimbal_device_set_attitude_t, flags) }, \
  41. { "q", NULL, MAVLINK_TYPE_FLOAT, 4, 0, offsetof(mavlink_gimbal_device_set_attitude_t, q) }, \
  42. { "angular_velocity_x", NULL, MAVLINK_TYPE_FLOAT, 0, 16, offsetof(mavlink_gimbal_device_set_attitude_t, angular_velocity_x) }, \
  43. { "angular_velocity_y", NULL, MAVLINK_TYPE_FLOAT, 0, 20, offsetof(mavlink_gimbal_device_set_attitude_t, angular_velocity_y) }, \
  44. { "angular_velocity_z", NULL, MAVLINK_TYPE_FLOAT, 0, 24, offsetof(mavlink_gimbal_device_set_attitude_t, angular_velocity_z) }, \
  45. } \
  46. }
  47. #endif
  48. /**
  49. * @brief Pack a gimbal_device_set_attitude message
  50. * @param system_id ID of this system
  51. * @param component_id ID of this component (e.g. 200 for IMU)
  52. * @param msg The MAVLink message to compress the data into
  53. *
  54. * @param target_system System ID
  55. * @param target_component Component ID
  56. * @param flags Low level gimbal flags.
  57. * @param q Quaternion components, w, x, y, z (1 0 0 0 is the null-rotation). The frame is described in the message description. Set fields to NaN to be ignored.
  58. * @param angular_velocity_x [rad/s] X component of angular velocity (positive: rolling to the right). The frame is described in the message description. NaN to be ignored.
  59. * @param angular_velocity_y [rad/s] Y component of angular velocity (positive: pitching up). The frame is described in the message description. NaN to be ignored.
  60. * @param angular_velocity_z [rad/s] Z component of angular velocity (positive: yawing to the right). The frame is described in the message description. NaN to be ignored.
  61. * @return length of the message in bytes (excluding serial stream start sign)
  62. */
  63. static inline uint16_t mavlink_msg_gimbal_device_set_attitude_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
  64. uint8_t target_system, uint8_t target_component, uint16_t flags, const float *q, float angular_velocity_x, float angular_velocity_y, float angular_velocity_z)
  65. {
  66. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  67. char buf[MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN];
  68. _mav_put_float(buf, 16, angular_velocity_x);
  69. _mav_put_float(buf, 20, angular_velocity_y);
  70. _mav_put_float(buf, 24, angular_velocity_z);
  71. _mav_put_uint16_t(buf, 28, flags);
  72. _mav_put_uint8_t(buf, 30, target_system);
  73. _mav_put_uint8_t(buf, 31, target_component);
  74. _mav_put_float_array(buf, 0, q, 4);
  75. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN);
  76. #else
  77. mavlink_gimbal_device_set_attitude_t packet;
  78. packet.angular_velocity_x = angular_velocity_x;
  79. packet.angular_velocity_y = angular_velocity_y;
  80. packet.angular_velocity_z = angular_velocity_z;
  81. packet.flags = flags;
  82. packet.target_system = target_system;
  83. packet.target_component = target_component;
  84. mav_array_memcpy(packet.q, q, sizeof(float)*4);
  85. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN);
  86. #endif
  87. msg->msgid = MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE;
  88. return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_MIN_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_CRC);
  89. }
  90. /**
  91. * @brief Pack a gimbal_device_set_attitude message
  92. * @param system_id ID of this system
  93. * @param component_id ID of this component (e.g. 200 for IMU)
  94. * @param status MAVLink status structure
  95. * @param msg The MAVLink message to compress the data into
  96. *
  97. * @param target_system System ID
  98. * @param target_component Component ID
  99. * @param flags Low level gimbal flags.
  100. * @param q Quaternion components, w, x, y, z (1 0 0 0 is the null-rotation). The frame is described in the message description. Set fields to NaN to be ignored.
  101. * @param angular_velocity_x [rad/s] X component of angular velocity (positive: rolling to the right). The frame is described in the message description. NaN to be ignored.
  102. * @param angular_velocity_y [rad/s] Y component of angular velocity (positive: pitching up). The frame is described in the message description. NaN to be ignored.
  103. * @param angular_velocity_z [rad/s] Z component of angular velocity (positive: yawing to the right). The frame is described in the message description. NaN to be ignored.
  104. * @return length of the message in bytes (excluding serial stream start sign)
  105. */
  106. static inline uint16_t mavlink_msg_gimbal_device_set_attitude_pack_status(uint8_t system_id, uint8_t component_id, mavlink_status_t *_status, mavlink_message_t* msg,
  107. uint8_t target_system, uint8_t target_component, uint16_t flags, const float *q, float angular_velocity_x, float angular_velocity_y, float angular_velocity_z)
  108. {
  109. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  110. char buf[MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN];
  111. _mav_put_float(buf, 16, angular_velocity_x);
  112. _mav_put_float(buf, 20, angular_velocity_y);
  113. _mav_put_float(buf, 24, angular_velocity_z);
  114. _mav_put_uint16_t(buf, 28, flags);
  115. _mav_put_uint8_t(buf, 30, target_system);
  116. _mav_put_uint8_t(buf, 31, target_component);
  117. _mav_put_float_array(buf, 0, q, 4);
  118. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN);
  119. #else
  120. mavlink_gimbal_device_set_attitude_t packet;
  121. packet.angular_velocity_x = angular_velocity_x;
  122. packet.angular_velocity_y = angular_velocity_y;
  123. packet.angular_velocity_z = angular_velocity_z;
  124. packet.flags = flags;
  125. packet.target_system = target_system;
  126. packet.target_component = target_component;
  127. mav_array_memcpy(packet.q, q, sizeof(float)*4);
  128. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN);
  129. #endif
  130. msg->msgid = MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE;
  131. #if MAVLINK_CRC_EXTRA
  132. return mavlink_finalize_message_buffer(msg, system_id, component_id, _status, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_MIN_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_CRC);
  133. #else
  134. return mavlink_finalize_message_buffer(msg, system_id, component_id, _status, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_MIN_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN);
  135. #endif
  136. }
  137. /**
  138. * @brief Pack a gimbal_device_set_attitude message on a channel
  139. * @param system_id ID of this system
  140. * @param component_id ID of this component (e.g. 200 for IMU)
  141. * @param chan The MAVLink channel this message will be sent over
  142. * @param msg The MAVLink message to compress the data into
  143. * @param target_system System ID
  144. * @param target_component Component ID
  145. * @param flags Low level gimbal flags.
  146. * @param q Quaternion components, w, x, y, z (1 0 0 0 is the null-rotation). The frame is described in the message description. Set fields to NaN to be ignored.
  147. * @param angular_velocity_x [rad/s] X component of angular velocity (positive: rolling to the right). The frame is described in the message description. NaN to be ignored.
  148. * @param angular_velocity_y [rad/s] Y component of angular velocity (positive: pitching up). The frame is described in the message description. NaN to be ignored.
  149. * @param angular_velocity_z [rad/s] Z component of angular velocity (positive: yawing to the right). The frame is described in the message description. NaN to be ignored.
  150. * @return length of the message in bytes (excluding serial stream start sign)
  151. */
  152. static inline uint16_t mavlink_msg_gimbal_device_set_attitude_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
  153. mavlink_message_t* msg,
  154. uint8_t target_system,uint8_t target_component,uint16_t flags,const float *q,float angular_velocity_x,float angular_velocity_y,float angular_velocity_z)
  155. {
  156. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  157. char buf[MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN];
  158. _mav_put_float(buf, 16, angular_velocity_x);
  159. _mav_put_float(buf, 20, angular_velocity_y);
  160. _mav_put_float(buf, 24, angular_velocity_z);
  161. _mav_put_uint16_t(buf, 28, flags);
  162. _mav_put_uint8_t(buf, 30, target_system);
  163. _mav_put_uint8_t(buf, 31, target_component);
  164. _mav_put_float_array(buf, 0, q, 4);
  165. memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN);
  166. #else
  167. mavlink_gimbal_device_set_attitude_t packet;
  168. packet.angular_velocity_x = angular_velocity_x;
  169. packet.angular_velocity_y = angular_velocity_y;
  170. packet.angular_velocity_z = angular_velocity_z;
  171. packet.flags = flags;
  172. packet.target_system = target_system;
  173. packet.target_component = target_component;
  174. mav_array_memcpy(packet.q, q, sizeof(float)*4);
  175. memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN);
  176. #endif
  177. msg->msgid = MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE;
  178. return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_MIN_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_CRC);
  179. }
  180. /**
  181. * @brief Encode a gimbal_device_set_attitude struct
  182. *
  183. * @param system_id ID of this system
  184. * @param component_id ID of this component (e.g. 200 for IMU)
  185. * @param msg The MAVLink message to compress the data into
  186. * @param gimbal_device_set_attitude C-struct to read the message contents from
  187. */
  188. static inline uint16_t mavlink_msg_gimbal_device_set_attitude_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_gimbal_device_set_attitude_t* gimbal_device_set_attitude)
  189. {
  190. return mavlink_msg_gimbal_device_set_attitude_pack(system_id, component_id, msg, gimbal_device_set_attitude->target_system, gimbal_device_set_attitude->target_component, gimbal_device_set_attitude->flags, gimbal_device_set_attitude->q, gimbal_device_set_attitude->angular_velocity_x, gimbal_device_set_attitude->angular_velocity_y, gimbal_device_set_attitude->angular_velocity_z);
  191. }
  192. /**
  193. * @brief Encode a gimbal_device_set_attitude struct on a channel
  194. *
  195. * @param system_id ID of this system
  196. * @param component_id ID of this component (e.g. 200 for IMU)
  197. * @param chan The MAVLink channel this message will be sent over
  198. * @param msg The MAVLink message to compress the data into
  199. * @param gimbal_device_set_attitude C-struct to read the message contents from
  200. */
  201. static inline uint16_t mavlink_msg_gimbal_device_set_attitude_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_gimbal_device_set_attitude_t* gimbal_device_set_attitude)
  202. {
  203. return mavlink_msg_gimbal_device_set_attitude_pack_chan(system_id, component_id, chan, msg, gimbal_device_set_attitude->target_system, gimbal_device_set_attitude->target_component, gimbal_device_set_attitude->flags, gimbal_device_set_attitude->q, gimbal_device_set_attitude->angular_velocity_x, gimbal_device_set_attitude->angular_velocity_y, gimbal_device_set_attitude->angular_velocity_z);
  204. }
  205. /**
  206. * @brief Encode a gimbal_device_set_attitude struct with provided status structure
  207. *
  208. * @param system_id ID of this system
  209. * @param component_id ID of this component (e.g. 200 for IMU)
  210. * @param status MAVLink status structure
  211. * @param msg The MAVLink message to compress the data into
  212. * @param gimbal_device_set_attitude C-struct to read the message contents from
  213. */
  214. static inline uint16_t mavlink_msg_gimbal_device_set_attitude_encode_status(uint8_t system_id, uint8_t component_id, mavlink_status_t* _status, mavlink_message_t* msg, const mavlink_gimbal_device_set_attitude_t* gimbal_device_set_attitude)
  215. {
  216. return mavlink_msg_gimbal_device_set_attitude_pack_status(system_id, component_id, _status, msg, gimbal_device_set_attitude->target_system, gimbal_device_set_attitude->target_component, gimbal_device_set_attitude->flags, gimbal_device_set_attitude->q, gimbal_device_set_attitude->angular_velocity_x, gimbal_device_set_attitude->angular_velocity_y, gimbal_device_set_attitude->angular_velocity_z);
  217. }
  218. /**
  219. * @brief Send a gimbal_device_set_attitude message
  220. * @param chan MAVLink channel to send the message
  221. *
  222. * @param target_system System ID
  223. * @param target_component Component ID
  224. * @param flags Low level gimbal flags.
  225. * @param q Quaternion components, w, x, y, z (1 0 0 0 is the null-rotation). The frame is described in the message description. Set fields to NaN to be ignored.
  226. * @param angular_velocity_x [rad/s] X component of angular velocity (positive: rolling to the right). The frame is described in the message description. NaN to be ignored.
  227. * @param angular_velocity_y [rad/s] Y component of angular velocity (positive: pitching up). The frame is described in the message description. NaN to be ignored.
  228. * @param angular_velocity_z [rad/s] Z component of angular velocity (positive: yawing to the right). The frame is described in the message description. NaN to be ignored.
  229. */
  230. #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
  231. static inline void mavlink_msg_gimbal_device_set_attitude_send(mavlink_channel_t chan, uint8_t target_system, uint8_t target_component, uint16_t flags, const float *q, float angular_velocity_x, float angular_velocity_y, float angular_velocity_z)
  232. {
  233. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  234. char buf[MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN];
  235. _mav_put_float(buf, 16, angular_velocity_x);
  236. _mav_put_float(buf, 20, angular_velocity_y);
  237. _mav_put_float(buf, 24, angular_velocity_z);
  238. _mav_put_uint16_t(buf, 28, flags);
  239. _mav_put_uint8_t(buf, 30, target_system);
  240. _mav_put_uint8_t(buf, 31, target_component);
  241. _mav_put_float_array(buf, 0, q, 4);
  242. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE, buf, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_MIN_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_CRC);
  243. #else
  244. mavlink_gimbal_device_set_attitude_t packet;
  245. packet.angular_velocity_x = angular_velocity_x;
  246. packet.angular_velocity_y = angular_velocity_y;
  247. packet.angular_velocity_z = angular_velocity_z;
  248. packet.flags = flags;
  249. packet.target_system = target_system;
  250. packet.target_component = target_component;
  251. mav_array_memcpy(packet.q, q, sizeof(float)*4);
  252. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE, (const char *)&packet, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_MIN_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_CRC);
  253. #endif
  254. }
  255. /**
  256. * @brief Send a gimbal_device_set_attitude message
  257. * @param chan MAVLink channel to send the message
  258. * @param struct The MAVLink struct to serialize
  259. */
  260. static inline void mavlink_msg_gimbal_device_set_attitude_send_struct(mavlink_channel_t chan, const mavlink_gimbal_device_set_attitude_t* gimbal_device_set_attitude)
  261. {
  262. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  263. mavlink_msg_gimbal_device_set_attitude_send(chan, gimbal_device_set_attitude->target_system, gimbal_device_set_attitude->target_component, gimbal_device_set_attitude->flags, gimbal_device_set_attitude->q, gimbal_device_set_attitude->angular_velocity_x, gimbal_device_set_attitude->angular_velocity_y, gimbal_device_set_attitude->angular_velocity_z);
  264. #else
  265. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE, (const char *)gimbal_device_set_attitude, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_MIN_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_CRC);
  266. #endif
  267. }
  268. #if MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN <= MAVLINK_MAX_PAYLOAD_LEN
  269. /*
  270. This variant of _send() can be used to save stack space by re-using
  271. memory from the receive buffer. The caller provides a
  272. mavlink_message_t which is the size of a full mavlink message. This
  273. is usually the receive buffer for the channel, and allows a reply to an
  274. incoming message with minimum stack space usage.
  275. */
  276. static inline void mavlink_msg_gimbal_device_set_attitude_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, uint8_t target_system, uint8_t target_component, uint16_t flags, const float *q, float angular_velocity_x, float angular_velocity_y, float angular_velocity_z)
  277. {
  278. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  279. char *buf = (char *)msgbuf;
  280. _mav_put_float(buf, 16, angular_velocity_x);
  281. _mav_put_float(buf, 20, angular_velocity_y);
  282. _mav_put_float(buf, 24, angular_velocity_z);
  283. _mav_put_uint16_t(buf, 28, flags);
  284. _mav_put_uint8_t(buf, 30, target_system);
  285. _mav_put_uint8_t(buf, 31, target_component);
  286. _mav_put_float_array(buf, 0, q, 4);
  287. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE, buf, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_MIN_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_CRC);
  288. #else
  289. mavlink_gimbal_device_set_attitude_t *packet = (mavlink_gimbal_device_set_attitude_t *)msgbuf;
  290. packet->angular_velocity_x = angular_velocity_x;
  291. packet->angular_velocity_y = angular_velocity_y;
  292. packet->angular_velocity_z = angular_velocity_z;
  293. packet->flags = flags;
  294. packet->target_system = target_system;
  295. packet->target_component = target_component;
  296. mav_array_memcpy(packet->q, q, sizeof(float)*4);
  297. _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE, (const char *)packet, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_MIN_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_CRC);
  298. #endif
  299. }
  300. #endif
  301. #endif
  302. // MESSAGE GIMBAL_DEVICE_SET_ATTITUDE UNPACKING
  303. /**
  304. * @brief Get field target_system from gimbal_device_set_attitude message
  305. *
  306. * @return System ID
  307. */
  308. static inline uint8_t mavlink_msg_gimbal_device_set_attitude_get_target_system(const mavlink_message_t* msg)
  309. {
  310. return _MAV_RETURN_uint8_t(msg, 30);
  311. }
  312. /**
  313. * @brief Get field target_component from gimbal_device_set_attitude message
  314. *
  315. * @return Component ID
  316. */
  317. static inline uint8_t mavlink_msg_gimbal_device_set_attitude_get_target_component(const mavlink_message_t* msg)
  318. {
  319. return _MAV_RETURN_uint8_t(msg, 31);
  320. }
  321. /**
  322. * @brief Get field flags from gimbal_device_set_attitude message
  323. *
  324. * @return Low level gimbal flags.
  325. */
  326. static inline uint16_t mavlink_msg_gimbal_device_set_attitude_get_flags(const mavlink_message_t* msg)
  327. {
  328. return _MAV_RETURN_uint16_t(msg, 28);
  329. }
  330. /**
  331. * @brief Get field q from gimbal_device_set_attitude message
  332. *
  333. * @return Quaternion components, w, x, y, z (1 0 0 0 is the null-rotation). The frame is described in the message description. Set fields to NaN to be ignored.
  334. */
  335. static inline uint16_t mavlink_msg_gimbal_device_set_attitude_get_q(const mavlink_message_t* msg, float *q)
  336. {
  337. return _MAV_RETURN_float_array(msg, q, 4, 0);
  338. }
  339. /**
  340. * @brief Get field angular_velocity_x from gimbal_device_set_attitude message
  341. *
  342. * @return [rad/s] X component of angular velocity (positive: rolling to the right). The frame is described in the message description. NaN to be ignored.
  343. */
  344. static inline float mavlink_msg_gimbal_device_set_attitude_get_angular_velocity_x(const mavlink_message_t* msg)
  345. {
  346. return _MAV_RETURN_float(msg, 16);
  347. }
  348. /**
  349. * @brief Get field angular_velocity_y from gimbal_device_set_attitude message
  350. *
  351. * @return [rad/s] Y component of angular velocity (positive: pitching up). The frame is described in the message description. NaN to be ignored.
  352. */
  353. static inline float mavlink_msg_gimbal_device_set_attitude_get_angular_velocity_y(const mavlink_message_t* msg)
  354. {
  355. return _MAV_RETURN_float(msg, 20);
  356. }
  357. /**
  358. * @brief Get field angular_velocity_z from gimbal_device_set_attitude message
  359. *
  360. * @return [rad/s] Z component of angular velocity (positive: yawing to the right). The frame is described in the message description. NaN to be ignored.
  361. */
  362. static inline float mavlink_msg_gimbal_device_set_attitude_get_angular_velocity_z(const mavlink_message_t* msg)
  363. {
  364. return _MAV_RETURN_float(msg, 24);
  365. }
  366. /**
  367. * @brief Decode a gimbal_device_set_attitude message into a struct
  368. *
  369. * @param msg The message to decode
  370. * @param gimbal_device_set_attitude C-struct to decode the message contents into
  371. */
  372. static inline void mavlink_msg_gimbal_device_set_attitude_decode(const mavlink_message_t* msg, mavlink_gimbal_device_set_attitude_t* gimbal_device_set_attitude)
  373. {
  374. #if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
  375. mavlink_msg_gimbal_device_set_attitude_get_q(msg, gimbal_device_set_attitude->q);
  376. gimbal_device_set_attitude->angular_velocity_x = mavlink_msg_gimbal_device_set_attitude_get_angular_velocity_x(msg);
  377. gimbal_device_set_attitude->angular_velocity_y = mavlink_msg_gimbal_device_set_attitude_get_angular_velocity_y(msg);
  378. gimbal_device_set_attitude->angular_velocity_z = mavlink_msg_gimbal_device_set_attitude_get_angular_velocity_z(msg);
  379. gimbal_device_set_attitude->flags = mavlink_msg_gimbal_device_set_attitude_get_flags(msg);
  380. gimbal_device_set_attitude->target_system = mavlink_msg_gimbal_device_set_attitude_get_target_system(msg);
  381. gimbal_device_set_attitude->target_component = mavlink_msg_gimbal_device_set_attitude_get_target_component(msg);
  382. #else
  383. uint8_t len = msg->len < MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN? msg->len : MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN;
  384. memset(gimbal_device_set_attitude, 0, MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_LEN);
  385. memcpy(gimbal_device_set_attitude, _MAV_PAYLOAD(msg), len);
  386. #endif
  387. }