RflySimSDK v3.08
RflySimSDK说明文档
载入中...
搜索中...
未找到
mavlink_msg_wind.h
1#pragma once
2// MESSAGE WIND PACKING
3
4#define MAVLINK_MSG_ID_WIND 168
5
6MAVPACKED(
7typedef struct __mavlink_wind_t {
8 float direction; /*< wind direction that wind is coming from (degrees)*/
9 float speed; /*< wind speed in ground plane (m/s)*/
10 float speed_z; /*< vertical wind speed (m/s)*/
11}) mavlink_wind_t;
12
13#define MAVLINK_MSG_ID_WIND_LEN 12
14#define MAVLINK_MSG_ID_WIND_MIN_LEN 12
15#define MAVLINK_MSG_ID_168_LEN 12
16#define MAVLINK_MSG_ID_168_MIN_LEN 12
17
18#define MAVLINK_MSG_ID_WIND_CRC 1
19#define MAVLINK_MSG_ID_168_CRC 1
20
21
22
23#if MAVLINK_COMMAND_24BIT
24#define MAVLINK_MESSAGE_INFO_WIND { \
25 168, \
26 "WIND", \
27 3, \
28 { { "direction", NULL, MAVLINK_TYPE_FLOAT, 0, 0, offsetof(mavlink_wind_t, direction) }, \
29 { "speed", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_wind_t, speed) }, \
30 { "speed_z", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_wind_t, speed_z) }, \
31 } \
32}
33#else
34#define MAVLINK_MESSAGE_INFO_WIND { \
35 "WIND", \
36 3, \
37 { { "direction", NULL, MAVLINK_TYPE_FLOAT, 0, 0, offsetof(mavlink_wind_t, direction) }, \
38 { "speed", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_wind_t, speed) }, \
39 { "speed_z", NULL, MAVLINK_TYPE_FLOAT, 0, 8, offsetof(mavlink_wind_t, speed_z) }, \
40 } \
41}
42#endif
43
44/**
45 * @brief Pack a wind message
46 * @param system_id ID of this system
47 * @param component_id ID of this component (e.g. 200 for IMU)
48 * @param msg The MAVLink message to compress the data into
49 *
50 * @param direction wind direction that wind is coming from (degrees)
51 * @param speed wind speed in ground plane (m/s)
52 * @param speed_z vertical wind speed (m/s)
53 * @return length of the message in bytes (excluding serial stream start sign)
54 */
55static inline uint16_t mavlink_msg_wind_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
56 float direction, float speed, float speed_z)
57{
58#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
59 char buf[MAVLINK_MSG_ID_WIND_LEN];
60 _mav_put_float(buf, 0, direction);
61 _mav_put_float(buf, 4, speed);
62 _mav_put_float(buf, 8, speed_z);
63
64 memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_WIND_LEN);
65#else
66 mavlink_wind_t packet;
67 packet.direction = direction;
68 packet.speed = speed;
69 packet.speed_z = speed_z;
70
71 memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_WIND_LEN);
72#endif
73
74 msg->msgid = MAVLINK_MSG_ID_WIND;
75 return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_WIND_MIN_LEN, MAVLINK_MSG_ID_WIND_LEN, MAVLINK_MSG_ID_WIND_CRC);
76}
77
78/**
79 * @brief Pack a wind message on a channel
80 * @param system_id ID of this system
81 * @param component_id ID of this component (e.g. 200 for IMU)
82 * @param chan The MAVLink channel this message will be sent over
83 * @param msg The MAVLink message to compress the data into
84 * @param direction wind direction that wind is coming from (degrees)
85 * @param speed wind speed in ground plane (m/s)
86 * @param speed_z vertical wind speed (m/s)
87 * @return length of the message in bytes (excluding serial stream start sign)
88 */
89static inline uint16_t mavlink_msg_wind_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
90 mavlink_message_t* msg,
91 float direction,float speed,float speed_z)
92{
93#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
94 char buf[MAVLINK_MSG_ID_WIND_LEN];
95 _mav_put_float(buf, 0, direction);
96 _mav_put_float(buf, 4, speed);
97 _mav_put_float(buf, 8, speed_z);
98
99 memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_WIND_LEN);
100#else
101 mavlink_wind_t packet;
102 packet.direction = direction;
103 packet.speed = speed;
104 packet.speed_z = speed_z;
105
106 memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_WIND_LEN);
107#endif
108
109 msg->msgid = MAVLINK_MSG_ID_WIND;
110 return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_WIND_MIN_LEN, MAVLINK_MSG_ID_WIND_LEN, MAVLINK_MSG_ID_WIND_CRC);
111}
112
113/**
114 * @brief Encode a wind struct
115 *
116 * @param system_id ID of this system
117 * @param component_id ID of this component (e.g. 200 for IMU)
118 * @param msg The MAVLink message to compress the data into
119 * @param wind C-struct to read the message contents from
120 */
121static inline uint16_t mavlink_msg_wind_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_wind_t* wind)
122{
123 return mavlink_msg_wind_pack(system_id, component_id, msg, wind->direction, wind->speed, wind->speed_z);
124}
125
126/**
127 * @brief Encode a wind struct on a channel
128 *
129 * @param system_id ID of this system
130 * @param component_id ID of this component (e.g. 200 for IMU)
131 * @param chan The MAVLink channel this message will be sent over
132 * @param msg The MAVLink message to compress the data into
133 * @param wind C-struct to read the message contents from
134 */
135static inline uint16_t mavlink_msg_wind_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_wind_t* wind)
136{
137 return mavlink_msg_wind_pack_chan(system_id, component_id, chan, msg, wind->direction, wind->speed, wind->speed_z);
138}
139
140/**
141 * @brief Send a wind message
142 * @param chan MAVLink channel to send the message
143 *
144 * @param direction wind direction that wind is coming from (degrees)
145 * @param speed wind speed in ground plane (m/s)
146 * @param speed_z vertical wind speed (m/s)
147 */
148#ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
149
150static inline void mavlink_msg_wind_send(mavlink_channel_t chan, float direction, float speed, float speed_z)
151{
152#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
153 char buf[MAVLINK_MSG_ID_WIND_LEN];
154 _mav_put_float(buf, 0, direction);
155 _mav_put_float(buf, 4, speed);
156 _mav_put_float(buf, 8, speed_z);
157
158 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_WIND, buf, MAVLINK_MSG_ID_WIND_MIN_LEN, MAVLINK_MSG_ID_WIND_LEN, MAVLINK_MSG_ID_WIND_CRC);
159#else
160 mavlink_wind_t packet;
161 packet.direction = direction;
162 packet.speed = speed;
163 packet.speed_z = speed_z;
164
165 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_WIND, (const char *)&packet, MAVLINK_MSG_ID_WIND_MIN_LEN, MAVLINK_MSG_ID_WIND_LEN, MAVLINK_MSG_ID_WIND_CRC);
166#endif
167}
168
169/**
170 * @brief Send a wind message
171 * @param chan MAVLink channel to send the message
172 * @param struct The MAVLink struct to serialize
173 */
174static inline void mavlink_msg_wind_send_struct(mavlink_channel_t chan, const mavlink_wind_t* wind)
175{
176#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
177 mavlink_msg_wind_send(chan, wind->direction, wind->speed, wind->speed_z);
178#else
179 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_WIND, (const char *)wind, MAVLINK_MSG_ID_WIND_MIN_LEN, MAVLINK_MSG_ID_WIND_LEN, MAVLINK_MSG_ID_WIND_CRC);
180#endif
181}
182
183#if MAVLINK_MSG_ID_WIND_LEN <= MAVLINK_MAX_PAYLOAD_LEN
184/*
185 This varient of _send() can be used to save stack space by re-using
186 memory from the receive buffer. The caller provides a
187 mavlink_message_t which is the size of a full mavlink message. This
188 is usually the receive buffer for the channel, and allows a reply to an
189 incoming message with minimum stack space usage.
190 */
191static inline void mavlink_msg_wind_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, float direction, float speed, float speed_z)
192{
193#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
194 char *buf = (char *)msgbuf;
195 _mav_put_float(buf, 0, direction);
196 _mav_put_float(buf, 4, speed);
197 _mav_put_float(buf, 8, speed_z);
198
199 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_WIND, buf, MAVLINK_MSG_ID_WIND_MIN_LEN, MAVLINK_MSG_ID_WIND_LEN, MAVLINK_MSG_ID_WIND_CRC);
200#else
201 mavlink_wind_t *packet = (mavlink_wind_t *)msgbuf;
202 packet->direction = direction;
203 packet->speed = speed;
204 packet->speed_z = speed_z;
205
206 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_WIND, (const char *)packet, MAVLINK_MSG_ID_WIND_MIN_LEN, MAVLINK_MSG_ID_WIND_LEN, MAVLINK_MSG_ID_WIND_CRC);
207#endif
208}
209#endif
210
211#endif
212
213// MESSAGE WIND UNPACKING
214
215
216/**
217 * @brief Get field direction from wind message
218 *
219 * @return wind direction that wind is coming from (degrees)
220 */
221static inline float mavlink_msg_wind_get_direction(const mavlink_message_t* msg)
222{
223 return _MAV_RETURN_float(msg, 0);
224}
225
226/**
227 * @brief Get field speed from wind message
228 *
229 * @return wind speed in ground plane (m/s)
230 */
231static inline float mavlink_msg_wind_get_speed(const mavlink_message_t* msg)
232{
233 return _MAV_RETURN_float(msg, 4);
234}
235
236/**
237 * @brief Get field speed_z from wind message
238 *
239 * @return vertical wind speed (m/s)
240 */
241static inline float mavlink_msg_wind_get_speed_z(const mavlink_message_t* msg)
242{
243 return _MAV_RETURN_float(msg, 8);
244}
245
246/**
247 * @brief Decode a wind message into a struct
248 *
249 * @param msg The message to decode
250 * @param wind C-struct to decode the message contents into
251 */
252static inline void mavlink_msg_wind_decode(const mavlink_message_t* msg, mavlink_wind_t* wind)
253{
254#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
255 wind->direction = mavlink_msg_wind_get_direction(msg);
256 wind->speed = mavlink_msg_wind_get_speed(msg);
257 wind->speed_z = mavlink_msg_wind_get_speed_z(msg);
258#else
259 uint8_t len = msg->len < MAVLINK_MSG_ID_WIND_LEN? msg->len : MAVLINK_MSG_ID_WIND_LEN;
260 memset(wind, 0, MAVLINK_MSG_ID_WIND_LEN);
261 memcpy(wind, _MAV_PAYLOAD(msg), len);
262#endif
263}