RflySimSDK v3.05
RflySimSDK说明文档
载入中...
搜索中...
未找到
mavlink_msg_rangefinder.h
1#pragma once
2// MESSAGE RANGEFINDER PACKING
3
4#define MAVLINK_MSG_ID_RANGEFINDER 173
5
6MAVPACKED(
7typedef struct __mavlink_rangefinder_t {
8 float distance; /*< distance in meters*/
9 float voltage; /*< raw voltage if available, zero otherwise*/
10}) mavlink_rangefinder_t;
11
12#define MAVLINK_MSG_ID_RANGEFINDER_LEN 8
13#define MAVLINK_MSG_ID_RANGEFINDER_MIN_LEN 8
14#define MAVLINK_MSG_ID_173_LEN 8
15#define MAVLINK_MSG_ID_173_MIN_LEN 8
16
17#define MAVLINK_MSG_ID_RANGEFINDER_CRC 83
18#define MAVLINK_MSG_ID_173_CRC 83
19
20
21
22#if MAVLINK_COMMAND_24BIT
23#define MAVLINK_MESSAGE_INFO_RANGEFINDER { \
24 173, \
25 "RANGEFINDER", \
26 2, \
27 { { "distance", NULL, MAVLINK_TYPE_FLOAT, 0, 0, offsetof(mavlink_rangefinder_t, distance) }, \
28 { "voltage", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_rangefinder_t, voltage) }, \
29 } \
30}
31#else
32#define MAVLINK_MESSAGE_INFO_RANGEFINDER { \
33 "RANGEFINDER", \
34 2, \
35 { { "distance", NULL, MAVLINK_TYPE_FLOAT, 0, 0, offsetof(mavlink_rangefinder_t, distance) }, \
36 { "voltage", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_rangefinder_t, voltage) }, \
37 } \
38}
39#endif
40
51static inline uint16_t mavlink_msg_rangefinder_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
52 float distance, float voltage)
53{
54#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
55 char buf[MAVLINK_MSG_ID_RANGEFINDER_LEN];
56 _mav_put_float(buf, 0, distance);
57 _mav_put_float(buf, 4, voltage);
58
59 memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_RANGEFINDER_LEN);
60#else
61 mavlink_rangefinder_t packet;
62 packet.distance = distance;
63 packet.voltage = voltage;
64
65 memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_RANGEFINDER_LEN);
66#endif
67
68 msg->msgid = MAVLINK_MSG_ID_RANGEFINDER;
69 return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_RANGEFINDER_MIN_LEN, MAVLINK_MSG_ID_RANGEFINDER_LEN, MAVLINK_MSG_ID_RANGEFINDER_CRC);
70}
71
82static inline uint16_t mavlink_msg_rangefinder_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
83 mavlink_message_t* msg,
84 float distance,float voltage)
85{
86#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
87 char buf[MAVLINK_MSG_ID_RANGEFINDER_LEN];
88 _mav_put_float(buf, 0, distance);
89 _mav_put_float(buf, 4, voltage);
90
91 memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_RANGEFINDER_LEN);
92#else
93 mavlink_rangefinder_t packet;
94 packet.distance = distance;
95 packet.voltage = voltage;
96
97 memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_RANGEFINDER_LEN);
98#endif
99
100 msg->msgid = MAVLINK_MSG_ID_RANGEFINDER;
101 return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_RANGEFINDER_MIN_LEN, MAVLINK_MSG_ID_RANGEFINDER_LEN, MAVLINK_MSG_ID_RANGEFINDER_CRC);
102}
103
112static inline uint16_t mavlink_msg_rangefinder_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_rangefinder_t* rangefinder)
113{
114 return mavlink_msg_rangefinder_pack(system_id, component_id, msg, rangefinder->distance, rangefinder->voltage);
115}
116
126static inline uint16_t mavlink_msg_rangefinder_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_rangefinder_t* rangefinder)
127{
128 return mavlink_msg_rangefinder_pack_chan(system_id, component_id, chan, msg, rangefinder->distance, rangefinder->voltage);
129}
130
138#ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
139
140static inline void mavlink_msg_rangefinder_send(mavlink_channel_t chan, float distance, float voltage)
141{
142#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
143 char buf[MAVLINK_MSG_ID_RANGEFINDER_LEN];
144 _mav_put_float(buf, 0, distance);
145 _mav_put_float(buf, 4, voltage);
146
147 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RANGEFINDER, buf, MAVLINK_MSG_ID_RANGEFINDER_MIN_LEN, MAVLINK_MSG_ID_RANGEFINDER_LEN, MAVLINK_MSG_ID_RANGEFINDER_CRC);
148#else
149 mavlink_rangefinder_t packet;
150 packet.distance = distance;
151 packet.voltage = voltage;
152
153 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RANGEFINDER, (const char *)&packet, MAVLINK_MSG_ID_RANGEFINDER_MIN_LEN, MAVLINK_MSG_ID_RANGEFINDER_LEN, MAVLINK_MSG_ID_RANGEFINDER_CRC);
154#endif
155}
156
162static inline void mavlink_msg_rangefinder_send_struct(mavlink_channel_t chan, const mavlink_rangefinder_t* rangefinder)
163{
164#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
165 mavlink_msg_rangefinder_send(chan, rangefinder->distance, rangefinder->voltage);
166#else
167 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RANGEFINDER, (const char *)rangefinder, MAVLINK_MSG_ID_RANGEFINDER_MIN_LEN, MAVLINK_MSG_ID_RANGEFINDER_LEN, MAVLINK_MSG_ID_RANGEFINDER_CRC);
168#endif
169}
170
171#if MAVLINK_MSG_ID_RANGEFINDER_LEN <= MAVLINK_MAX_PAYLOAD_LEN
172/*
173 This varient of _send() can be used to save stack space by re-using
174 memory from the receive buffer. The caller provides a
175 mavlink_message_t which is the size of a full mavlink message. This
176 is usually the receive buffer for the channel, and allows a reply to an
177 incoming message with minimum stack space usage.
178 */
179static inline void mavlink_msg_rangefinder_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, float distance, float voltage)
180{
181#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
182 char *buf = (char *)msgbuf;
183 _mav_put_float(buf, 0, distance);
184 _mav_put_float(buf, 4, voltage);
185
186 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RANGEFINDER, buf, MAVLINK_MSG_ID_RANGEFINDER_MIN_LEN, MAVLINK_MSG_ID_RANGEFINDER_LEN, MAVLINK_MSG_ID_RANGEFINDER_CRC);
187#else
188 mavlink_rangefinder_t *packet = (mavlink_rangefinder_t *)msgbuf;
189 packet->distance = distance;
190 packet->voltage = voltage;
191
192 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RANGEFINDER, (const char *)packet, MAVLINK_MSG_ID_RANGEFINDER_MIN_LEN, MAVLINK_MSG_ID_RANGEFINDER_LEN, MAVLINK_MSG_ID_RANGEFINDER_CRC);
193#endif
194}
195#endif
196
197#endif
198
199// MESSAGE RANGEFINDER UNPACKING
200
201
207static inline float mavlink_msg_rangefinder_get_distance(const mavlink_message_t* msg)
208{
209 return _MAV_RETURN_float(msg, 0);
210}
211
217static inline float mavlink_msg_rangefinder_get_voltage(const mavlink_message_t* msg)
218{
219 return _MAV_RETURN_float(msg, 4);
220}
221
228static inline void mavlink_msg_rangefinder_decode(const mavlink_message_t* msg, mavlink_rangefinder_t* rangefinder)
229{
230#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
231 rangefinder->distance = mavlink_msg_rangefinder_get_distance(msg);
232 rangefinder->voltage = mavlink_msg_rangefinder_get_voltage(msg);
233#else
234 uint8_t len = msg->len < MAVLINK_MSG_ID_RANGEFINDER_LEN? msg->len : MAVLINK_MSG_ID_RANGEFINDER_LEN;
235 memset(rangefinder, 0, MAVLINK_MSG_ID_RANGEFINDER_LEN);
236 memcpy(rangefinder, _MAV_PAYLOAD(msg), len);
237#endif
238}