RflySimSDK v3.08
RflySimSDK说明文档
载入中...
搜索中...
未找到
mavlink_msg_rpm.h
1#pragma once
2// MESSAGE RPM PACKING
3
4#define MAVLINK_MSG_ID_RPM 226
5
6MAVPACKED(
7typedef struct __mavlink_rpm_t {
8 float rpm1; /*< RPM Sensor1*/
9 float rpm2; /*< RPM Sensor2*/
10}) mavlink_rpm_t;
11
12#define MAVLINK_MSG_ID_RPM_LEN 8
13#define MAVLINK_MSG_ID_RPM_MIN_LEN 8
14#define MAVLINK_MSG_ID_226_LEN 8
15#define MAVLINK_MSG_ID_226_MIN_LEN 8
16
17#define MAVLINK_MSG_ID_RPM_CRC 207
18#define MAVLINK_MSG_ID_226_CRC 207
19
20
21
22#if MAVLINK_COMMAND_24BIT
23#define MAVLINK_MESSAGE_INFO_RPM { \
24 226, \
25 "RPM", \
26 2, \
27 { { "rpm1", NULL, MAVLINK_TYPE_FLOAT, 0, 0, offsetof(mavlink_rpm_t, rpm1) }, \
28 { "rpm2", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_rpm_t, rpm2) }, \
29 } \
30}
31#else
32#define MAVLINK_MESSAGE_INFO_RPM { \
33 "RPM", \
34 2, \
35 { { "rpm1", NULL, MAVLINK_TYPE_FLOAT, 0, 0, offsetof(mavlink_rpm_t, rpm1) }, \
36 { "rpm2", NULL, MAVLINK_TYPE_FLOAT, 0, 4, offsetof(mavlink_rpm_t, rpm2) }, \
37 } \
38}
39#endif
40
41/**
42 * @brief Pack a rpm message
43 * @param system_id ID of this system
44 * @param component_id ID of this component (e.g. 200 for IMU)
45 * @param msg The MAVLink message to compress the data into
46 *
47 * @param rpm1 RPM Sensor1
48 * @param rpm2 RPM Sensor2
49 * @return length of the message in bytes (excluding serial stream start sign)
50 */
51static inline uint16_t mavlink_msg_rpm_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
52 float rpm1, float rpm2)
53{
54#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
55 char buf[MAVLINK_MSG_ID_RPM_LEN];
56 _mav_put_float(buf, 0, rpm1);
57 _mav_put_float(buf, 4, rpm2);
58
59 memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_RPM_LEN);
60#else
61 mavlink_rpm_t packet;
62 packet.rpm1 = rpm1;
63 packet.rpm2 = rpm2;
64
65 memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_RPM_LEN);
66#endif
67
68 msg->msgid = MAVLINK_MSG_ID_RPM;
69 return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_RPM_MIN_LEN, MAVLINK_MSG_ID_RPM_LEN, MAVLINK_MSG_ID_RPM_CRC);
70}
71
72/**
73 * @brief Pack a rpm message on a channel
74 * @param system_id ID of this system
75 * @param component_id ID of this component (e.g. 200 for IMU)
76 * @param chan The MAVLink channel this message will be sent over
77 * @param msg The MAVLink message to compress the data into
78 * @param rpm1 RPM Sensor1
79 * @param rpm2 RPM Sensor2
80 * @return length of the message in bytes (excluding serial stream start sign)
81 */
82static inline uint16_t mavlink_msg_rpm_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
83 mavlink_message_t* msg,
84 float rpm1,float rpm2)
85{
86#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
87 char buf[MAVLINK_MSG_ID_RPM_LEN];
88 _mav_put_float(buf, 0, rpm1);
89 _mav_put_float(buf, 4, rpm2);
90
91 memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_RPM_LEN);
92#else
93 mavlink_rpm_t packet;
94 packet.rpm1 = rpm1;
95 packet.rpm2 = rpm2;
96
97 memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_RPM_LEN);
98#endif
99
100 msg->msgid = MAVLINK_MSG_ID_RPM;
101 return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_RPM_MIN_LEN, MAVLINK_MSG_ID_RPM_LEN, MAVLINK_MSG_ID_RPM_CRC);
102}
103
104/**
105 * @brief Encode a rpm struct
106 *
107 * @param system_id ID of this system
108 * @param component_id ID of this component (e.g. 200 for IMU)
109 * @param msg The MAVLink message to compress the data into
110 * @param rpm C-struct to read the message contents from
111 */
112static inline uint16_t mavlink_msg_rpm_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_rpm_t* rpm)
113{
114 return mavlink_msg_rpm_pack(system_id, component_id, msg, rpm->rpm1, rpm->rpm2);
115}
116
117/**
118 * @brief Encode a rpm struct on a channel
119 *
120 * @param system_id ID of this system
121 * @param component_id ID of this component (e.g. 200 for IMU)
122 * @param chan The MAVLink channel this message will be sent over
123 * @param msg The MAVLink message to compress the data into
124 * @param rpm C-struct to read the message contents from
125 */
126static inline uint16_t mavlink_msg_rpm_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_rpm_t* rpm)
127{
128 return mavlink_msg_rpm_pack_chan(system_id, component_id, chan, msg, rpm->rpm1, rpm->rpm2);
129}
130
131/**
132 * @brief Send a rpm message
133 * @param chan MAVLink channel to send the message
134 *
135 * @param rpm1 RPM Sensor1
136 * @param rpm2 RPM Sensor2
137 */
138#ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
139
140static inline void mavlink_msg_rpm_send(mavlink_channel_t chan, float rpm1, float rpm2)
141{
142#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
143 char buf[MAVLINK_MSG_ID_RPM_LEN];
144 _mav_put_float(buf, 0, rpm1);
145 _mav_put_float(buf, 4, rpm2);
146
147 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RPM, buf, MAVLINK_MSG_ID_RPM_MIN_LEN, MAVLINK_MSG_ID_RPM_LEN, MAVLINK_MSG_ID_RPM_CRC);
148#else
149 mavlink_rpm_t packet;
150 packet.rpm1 = rpm1;
151 packet.rpm2 = rpm2;
152
153 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RPM, (const char *)&packet, MAVLINK_MSG_ID_RPM_MIN_LEN, MAVLINK_MSG_ID_RPM_LEN, MAVLINK_MSG_ID_RPM_CRC);
154#endif
155}
156
157/**
158 * @brief Send a rpm message
159 * @param chan MAVLink channel to send the message
160 * @param struct The MAVLink struct to serialize
161 */
162static inline void mavlink_msg_rpm_send_struct(mavlink_channel_t chan, const mavlink_rpm_t* rpm)
163{
164#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
165 mavlink_msg_rpm_send(chan, rpm->rpm1, rpm->rpm2);
166#else
167 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RPM, (const char *)rpm, MAVLINK_MSG_ID_RPM_MIN_LEN, MAVLINK_MSG_ID_RPM_LEN, MAVLINK_MSG_ID_RPM_CRC);
168#endif
169}
170
171#if MAVLINK_MSG_ID_RPM_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_rpm_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, float rpm1, float rpm2)
180{
181#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
182 char *buf = (char *)msgbuf;
183 _mav_put_float(buf, 0, rpm1);
184 _mav_put_float(buf, 4, rpm2);
185
186 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RPM, buf, MAVLINK_MSG_ID_RPM_MIN_LEN, MAVLINK_MSG_ID_RPM_LEN, MAVLINK_MSG_ID_RPM_CRC);
187#else
188 mavlink_rpm_t *packet = (mavlink_rpm_t *)msgbuf;
189 packet->rpm1 = rpm1;
190 packet->rpm2 = rpm2;
191
192 _mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_RPM, (const char *)packet, MAVLINK_MSG_ID_RPM_MIN_LEN, MAVLINK_MSG_ID_RPM_LEN, MAVLINK_MSG_ID_RPM_CRC);
193#endif
194}
195#endif
196
197#endif
198
199// MESSAGE RPM UNPACKING
200
201
202/**
203 * @brief Get field rpm1 from rpm message
204 *
205 * @return RPM Sensor1
206 */
207static inline float mavlink_msg_rpm_get_rpm1(const mavlink_message_t* msg)
208{
209 return _MAV_RETURN_float(msg, 0);
210}
211
212/**
213 * @brief Get field rpm2 from rpm message
214 *
215 * @return RPM Sensor2
216 */
217static inline float mavlink_msg_rpm_get_rpm2(const mavlink_message_t* msg)
218{
219 return _MAV_RETURN_float(msg, 4);
220}
221
222/**
223 * @brief Decode a rpm message into a struct
224 *
225 * @param msg The message to decode
226 * @param rpm C-struct to decode the message contents into
227 */
228static inline void mavlink_msg_rpm_decode(const mavlink_message_t* msg, mavlink_rpm_t* rpm)
229{
230#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
231 rpm->rpm1 = mavlink_msg_rpm_get_rpm1(msg);
232 rpm->rpm2 = mavlink_msg_rpm_get_rpm2(msg);
233#else
234 uint8_t len = msg->len < MAVLINK_MSG_ID_RPM_LEN? msg->len : MAVLINK_MSG_ID_RPM_LEN;
235 memset(rpm, 0, MAVLINK_MSG_ID_RPM_LEN);
236 memcpy(rpm, _MAV_PAYLOAD(msg), len);
237#endif
238}