mavlink_msg_data_log.h 6.59 KB
Newer Older
James Goppert's avatar
James Goppert committed
1 2 3
// MESSAGE DATA_LOG PACKING

#define MAVLINK_MSG_ID_DATA_LOG 177
lm's avatar
lm committed
4 5
#define MAVLINK_MSG_ID_DATA_LOG_LEN 24
#define MAVLINK_MSG_177_LEN 24
lm's avatar
lm committed
6 7
#define MAVLINK_MSG_ID_DATA_LOG_KEY 0xB9
#define MAVLINK_MSG_177_KEY 0xB9
James Goppert's avatar
James Goppert committed
8 9 10

typedef struct __mavlink_data_log_t 
{
lm's avatar
lm committed
11 12 13 14 15 16
	float fl_1;	///< Log value 1 
	float fl_2;	///< Log value 2 
	float fl_3;	///< Log value 3 
	float fl_4;	///< Log value 4 
	float fl_5;	///< Log value 5 
	float fl_6;	///< Log value 6 
James Goppert's avatar
James Goppert committed
17 18 19 20

} mavlink_data_log_t;

/**
James Goppert's avatar
James Goppert committed
21 22 23 24
 * @brief Pack a data_log message
 * @param system_id ID of this system
 * @param component_id ID of this component (e.g. 200 for IMU)
 * @param msg The MAVLink message to compress the data into
James Goppert's avatar
James Goppert committed
25 26 27 28 29 30 31 32 33 34 35
 *
 * @param fl_1 Log value 1 
 * @param fl_2 Log value 2 
 * @param fl_3 Log value 3 
 * @param fl_4 Log value 4 
 * @param fl_5 Log value 5 
 * @param fl_6 Log value 6 
 * @return length of the message in bytes (excluding serial stream start sign)
 */
static inline uint16_t mavlink_msg_data_log_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, float fl_1, float fl_2, float fl_3, float fl_4, float fl_5, float fl_6)
{
lm's avatar
lm committed
36
	mavlink_data_log_t *p = (mavlink_data_log_t *)&msg->payload[0];
James Goppert's avatar
James Goppert committed
37 38
	msg->msgid = MAVLINK_MSG_ID_DATA_LOG;

lm's avatar
lm committed
39 40 41 42 43 44
	p->fl_1 = fl_1;	// float:Log value 1 
	p->fl_2 = fl_2;	// float:Log value 2 
	p->fl_3 = fl_3;	// float:Log value 3 
	p->fl_4 = fl_4;	// float:Log value 4 
	p->fl_5 = fl_5;	// float:Log value 5 
	p->fl_6 = fl_6;	// float:Log value 6 
James Goppert's avatar
James Goppert committed
45

lm's avatar
lm committed
46
	return mavlink_finalize_message(msg, system_id, component_id, MAVLINK_MSG_ID_DATA_LOG_LEN);
James Goppert's avatar
James Goppert committed
47 48
}

James Goppert's avatar
James Goppert committed
49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64
/**
 * @brief Pack a data_log message
 * @param system_id ID of this system
 * @param component_id ID of this component (e.g. 200 for IMU)
 * @param chan The MAVLink channel this message was sent over
 * @param msg The MAVLink message to compress the data into
 * @param fl_1 Log value 1 
 * @param fl_2 Log value 2 
 * @param fl_3 Log value 3 
 * @param fl_4 Log value 4 
 * @param fl_5 Log value 5 
 * @param fl_6 Log value 6 
 * @return length of the message in bytes (excluding serial stream start sign)
 */
static inline uint16_t mavlink_msg_data_log_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, float fl_1, float fl_2, float fl_3, float fl_4, float fl_5, float fl_6)
{
lm's avatar
lm committed
65
	mavlink_data_log_t *p = (mavlink_data_log_t *)&msg->payload[0];
James Goppert's avatar
James Goppert committed
66 67
	msg->msgid = MAVLINK_MSG_ID_DATA_LOG;

lm's avatar
lm committed
68 69 70 71 72 73
	p->fl_1 = fl_1;	// float:Log value 1 
	p->fl_2 = fl_2;	// float:Log value 2 
	p->fl_3 = fl_3;	// float:Log value 3 
	p->fl_4 = fl_4;	// float:Log value 4 
	p->fl_5 = fl_5;	// float:Log value 5 
	p->fl_6 = fl_6;	// float:Log value 6 
James Goppert's avatar
James Goppert committed
74

lm's avatar
lm committed
75
	return mavlink_finalize_message_chan(msg, system_id, component_id, chan, MAVLINK_MSG_ID_DATA_LOG_LEN);
James Goppert's avatar
James Goppert committed
76 77 78 79 80 81 82 83 84 85
}

/**
 * @brief Encode a data_log struct into a message
 *
 * @param system_id ID of this system
 * @param component_id ID of this component (e.g. 200 for IMU)
 * @param msg The MAVLink message to compress the data into
 * @param data_log C-struct to read the message contents from
 */
James Goppert's avatar
James Goppert committed
86 87 88 89 90
static inline uint16_t mavlink_msg_data_log_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_data_log_t* data_log)
{
	return mavlink_msg_data_log_pack(system_id, component_id, msg, data_log->fl_1, data_log->fl_2, data_log->fl_3, data_log->fl_4, data_log->fl_5, data_log->fl_6);
}

lm's avatar
lm committed
91 92

#ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
James Goppert's avatar
James Goppert committed
93 94 95 96 97 98 99 100 101 102 103
/**
 * @brief Send a data_log message
 * @param chan MAVLink channel to send the message
 *
 * @param fl_1 Log value 1 
 * @param fl_2 Log value 2 
 * @param fl_3 Log value 3 
 * @param fl_4 Log value 4 
 * @param fl_5 Log value 5 
 * @param fl_6 Log value 6 
 */
lm's avatar
lm committed
104 105 106 107 108
static inline void mavlink_msg_data_log_send(mavlink_channel_t chan, float fl_1, float fl_2, float fl_3, float fl_4, float fl_5, float fl_6)
{
	mavlink_header_t hdr;
	mavlink_data_log_t payload;

lm's avatar
lm committed
109 110 111 112 113 114 115
	MAVLINK_BUFFER_CHECK_START( chan, MAVLINK_MSG_ID_DATA_LOG_LEN )
	payload.fl_1 = fl_1;	// float:Log value 1 
	payload.fl_2 = fl_2;	// float:Log value 2 
	payload.fl_3 = fl_3;	// float:Log value 3 
	payload.fl_4 = fl_4;	// float:Log value 4 
	payload.fl_5 = fl_5;	// float:Log value 5 
	payload.fl_6 = fl_6;	// float:Log value 6 
lm's avatar
lm committed
116 117 118 119 120 121 122 123 124 125

	hdr.STX = MAVLINK_STX;
	hdr.len = MAVLINK_MSG_ID_DATA_LOG_LEN;
	hdr.msgid = MAVLINK_MSG_ID_DATA_LOG;
	hdr.sysid = mavlink_system.sysid;
	hdr.compid = mavlink_system.compid;
	hdr.seq = mavlink_get_channel_status(chan)->current_tx_seq;
	mavlink_get_channel_status(chan)->current_tx_seq = hdr.seq + 1;
	mavlink_send_mem(chan, (uint8_t *)&hdr.STX, MAVLINK_NUM_HEADER_BYTES );

lm's avatar
lm committed
126 127 128 129 130 131
	crc_init(&hdr.ck);
	crc_calculate_mem((uint8_t *)&hdr.len, &hdr.ck, MAVLINK_CORE_HEADER_LEN);
	crc_calculate_mem((uint8_t *)&payload, &hdr.ck, hdr.len );
	crc_accumulate( 0xB9, &hdr.ck); /// include key in X25 checksum
	mavlink_send_mem(chan, (uint8_t *)&hdr.ck, MAVLINK_NUM_CHECKSUM_BYTES);
	MAVLINK_BUFFER_CHECK_END
James Goppert's avatar
James Goppert committed
132 133 134 135 136 137 138 139 140 141 142 143
}

#endif
// MESSAGE DATA_LOG UNPACKING

/**
 * @brief Get field fl_1 from data_log message
 *
 * @return Log value 1 
 */
static inline float mavlink_msg_data_log_get_fl_1(const mavlink_message_t* msg)
{
lm's avatar
lm committed
144 145
	mavlink_data_log_t *p = (mavlink_data_log_t *)&msg->payload[0];
	return (float)(p->fl_1);
James Goppert's avatar
James Goppert committed
146 147 148 149 150 151 152 153 154
}

/**
 * @brief Get field fl_2 from data_log message
 *
 * @return Log value 2 
 */
static inline float mavlink_msg_data_log_get_fl_2(const mavlink_message_t* msg)
{
lm's avatar
lm committed
155 156
	mavlink_data_log_t *p = (mavlink_data_log_t *)&msg->payload[0];
	return (float)(p->fl_2);
James Goppert's avatar
James Goppert committed
157 158 159 160 161 162 163 164 165
}

/**
 * @brief Get field fl_3 from data_log message
 *
 * @return Log value 3 
 */
static inline float mavlink_msg_data_log_get_fl_3(const mavlink_message_t* msg)
{
lm's avatar
lm committed
166 167
	mavlink_data_log_t *p = (mavlink_data_log_t *)&msg->payload[0];
	return (float)(p->fl_3);
James Goppert's avatar
James Goppert committed
168 169 170 171 172 173 174 175 176
}

/**
 * @brief Get field fl_4 from data_log message
 *
 * @return Log value 4 
 */
static inline float mavlink_msg_data_log_get_fl_4(const mavlink_message_t* msg)
{
lm's avatar
lm committed
177 178
	mavlink_data_log_t *p = (mavlink_data_log_t *)&msg->payload[0];
	return (float)(p->fl_4);
James Goppert's avatar
James Goppert committed
179 180 181 182 183 184 185 186 187
}

/**
 * @brief Get field fl_5 from data_log message
 *
 * @return Log value 5 
 */
static inline float mavlink_msg_data_log_get_fl_5(const mavlink_message_t* msg)
{
lm's avatar
lm committed
188 189
	mavlink_data_log_t *p = (mavlink_data_log_t *)&msg->payload[0];
	return (float)(p->fl_5);
James Goppert's avatar
James Goppert committed
190 191 192 193 194 195 196 197 198
}

/**
 * @brief Get field fl_6 from data_log message
 *
 * @return Log value 6 
 */
static inline float mavlink_msg_data_log_get_fl_6(const mavlink_message_t* msg)
{
lm's avatar
lm committed
199 200
	mavlink_data_log_t *p = (mavlink_data_log_t *)&msg->payload[0];
	return (float)(p->fl_6);
James Goppert's avatar
James Goppert committed
201 202
}

James Goppert's avatar
James Goppert committed
203 204 205 206 207 208
/**
 * @brief Decode a data_log message into a struct
 *
 * @param msg The message to decode
 * @param data_log C-struct to decode the message contents into
 */
James Goppert's avatar
James Goppert committed
209 210
static inline void mavlink_msg_data_log_decode(const mavlink_message_t* msg, mavlink_data_log_t* data_log)
{
lm's avatar
lm committed
211
	memcpy( data_log, msg->payload, sizeof(mavlink_data_log_t));
James Goppert's avatar
James Goppert committed
212
}