mavlink_msg_gimbal_manager_set_attitude.h 26 KB

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