Code for autonomous ground vehicle, Data Bus, 3rd place winner in 2012 Sparkfun AVC.
Dependencies: Watchdog mbed Schedule SimpleFilter LSM303DLM PinDetect DebounceIn Servo
mavlink_msg_raw_aux.h
00001 // MESSAGE RAW_AUX PACKING 00002 00003 #define MAVLINK_MSG_ID_RAW_AUX 141 00004 00005 typedef struct __mavlink_raw_aux_t 00006 { 00007 uint16_t adc1; ///< ADC1 (J405 ADC3, LPC2148 AD0.6) 00008 uint16_t adc2; ///< ADC2 (J405 ADC5, LPC2148 AD0.2) 00009 uint16_t adc3; ///< ADC3 (J405 ADC6, LPC2148 AD0.1) 00010 uint16_t adc4; ///< ADC4 (J405 ADC7, LPC2148 AD1.3) 00011 uint16_t vbat; ///< Battery voltage 00012 int16_t temp; ///< Temperature (degrees celcius) 00013 int32_t baro; ///< Barometric pressure (hecto Pascal) 00014 00015 } mavlink_raw_aux_t; 00016 00017 00018 00019 /** 00020 * @brief Pack a raw_aux message 00021 * @param system_id ID of this system 00022 * @param component_id ID of this component (e.g. 200 for IMU) 00023 * @param msg The MAVLink message to compress the data into 00024 * 00025 * @param adc1 ADC1 (J405 ADC3, LPC2148 AD0.6) 00026 * @param adc2 ADC2 (J405 ADC5, LPC2148 AD0.2) 00027 * @param adc3 ADC3 (J405 ADC6, LPC2148 AD0.1) 00028 * @param adc4 ADC4 (J405 ADC7, LPC2148 AD1.3) 00029 * @param vbat Battery voltage 00030 * @param temp Temperature (degrees celcius) 00031 * @param baro Barometric pressure (hecto Pascal) 00032 * @return length of the message in bytes (excluding serial stream start sign) 00033 */ 00034 static inline uint16_t mavlink_msg_raw_aux_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, uint16_t adc1, uint16_t adc2, uint16_t adc3, uint16_t adc4, uint16_t vbat, int16_t temp, int32_t baro) 00035 { 00036 uint16_t i = 0; 00037 msg->msgid = MAVLINK_MSG_ID_RAW_AUX; 00038 00039 i += put_uint16_t_by_index(adc1, i, msg->payload); // ADC1 (J405 ADC3, LPC2148 AD0.6) 00040 i += put_uint16_t_by_index(adc2, i, msg->payload); // ADC2 (J405 ADC5, LPC2148 AD0.2) 00041 i += put_uint16_t_by_index(adc3, i, msg->payload); // ADC3 (J405 ADC6, LPC2148 AD0.1) 00042 i += put_uint16_t_by_index(adc4, i, msg->payload); // ADC4 (J405 ADC7, LPC2148 AD1.3) 00043 i += put_uint16_t_by_index(vbat, i, msg->payload); // Battery voltage 00044 i += put_int16_t_by_index(temp, i, msg->payload); // Temperature (degrees celcius) 00045 i += put_int32_t_by_index(baro, i, msg->payload); // Barometric pressure (hecto Pascal) 00046 00047 return mavlink_finalize_message(msg, system_id, component_id, i); 00048 } 00049 00050 /** 00051 * @brief Pack a raw_aux message 00052 * @param system_id ID of this system 00053 * @param component_id ID of this component (e.g. 200 for IMU) 00054 * @param chan The MAVLink channel this message was sent over 00055 * @param msg The MAVLink message to compress the data into 00056 * @param adc1 ADC1 (J405 ADC3, LPC2148 AD0.6) 00057 * @param adc2 ADC2 (J405 ADC5, LPC2148 AD0.2) 00058 * @param adc3 ADC3 (J405 ADC6, LPC2148 AD0.1) 00059 * @param adc4 ADC4 (J405 ADC7, LPC2148 AD1.3) 00060 * @param vbat Battery voltage 00061 * @param temp Temperature (degrees celcius) 00062 * @param baro Barometric pressure (hecto Pascal) 00063 * @return length of the message in bytes (excluding serial stream start sign) 00064 */ 00065 static inline uint16_t mavlink_msg_raw_aux_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, uint16_t adc1, uint16_t adc2, uint16_t adc3, uint16_t adc4, uint16_t vbat, int16_t temp, int32_t baro) 00066 { 00067 uint16_t i = 0; 00068 msg->msgid = MAVLINK_MSG_ID_RAW_AUX; 00069 00070 i += put_uint16_t_by_index(adc1, i, msg->payload); // ADC1 (J405 ADC3, LPC2148 AD0.6) 00071 i += put_uint16_t_by_index(adc2, i, msg->payload); // ADC2 (J405 ADC5, LPC2148 AD0.2) 00072 i += put_uint16_t_by_index(adc3, i, msg->payload); // ADC3 (J405 ADC6, LPC2148 AD0.1) 00073 i += put_uint16_t_by_index(adc4, i, msg->payload); // ADC4 (J405 ADC7, LPC2148 AD1.3) 00074 i += put_uint16_t_by_index(vbat, i, msg->payload); // Battery voltage 00075 i += put_int16_t_by_index(temp, i, msg->payload); // Temperature (degrees celcius) 00076 i += put_int32_t_by_index(baro, i, msg->payload); // Barometric pressure (hecto Pascal) 00077 00078 return mavlink_finalize_message_chan(msg, system_id, component_id, chan, i); 00079 } 00080 00081 /** 00082 * @brief Encode a raw_aux struct into a message 00083 * 00084 * @param system_id ID of this system 00085 * @param component_id ID of this component (e.g. 200 for IMU) 00086 * @param msg The MAVLink message to compress the data into 00087 * @param raw_aux C-struct to read the message contents from 00088 */ 00089 static inline uint16_t mavlink_msg_raw_aux_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_raw_aux_t* raw_aux) 00090 { 00091 return mavlink_msg_raw_aux_pack(system_id, component_id, msg, raw_aux->adc1, raw_aux->adc2, raw_aux->adc3, raw_aux->adc4, raw_aux->vbat, raw_aux->temp, raw_aux->baro); 00092 } 00093 00094 /** 00095 * @brief Send a raw_aux message 00096 * @param chan MAVLink channel to send the message 00097 * 00098 * @param adc1 ADC1 (J405 ADC3, LPC2148 AD0.6) 00099 * @param adc2 ADC2 (J405 ADC5, LPC2148 AD0.2) 00100 * @param adc3 ADC3 (J405 ADC6, LPC2148 AD0.1) 00101 * @param adc4 ADC4 (J405 ADC7, LPC2148 AD1.3) 00102 * @param vbat Battery voltage 00103 * @param temp Temperature (degrees celcius) 00104 * @param baro Barometric pressure (hecto Pascal) 00105 */ 00106 #ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS 00107 00108 static inline void mavlink_msg_raw_aux_send(mavlink_channel_t chan, uint16_t adc1, uint16_t adc2, uint16_t adc3, uint16_t adc4, uint16_t vbat, int16_t temp, int32_t baro) 00109 { 00110 mavlink_message_t msg; 00111 mavlink_msg_raw_aux_pack_chan(mavlink_system.sysid, mavlink_system.compid, chan, &msg, adc1, adc2, adc3, adc4, vbat, temp, baro); 00112 mavlink_send_uart(chan, &msg); 00113 } 00114 00115 #endif 00116 // MESSAGE RAW_AUX UNPACKING 00117 00118 /** 00119 * @brief Get field adc1 from raw_aux message 00120 * 00121 * @return ADC1 (J405 ADC3, LPC2148 AD0.6) 00122 */ 00123 static inline uint16_t mavlink_msg_raw_aux_get_adc1(const mavlink_message_t* msg) 00124 { 00125 generic_16bit r; 00126 r.b[1] = (msg->payload)[0]; 00127 r.b[0] = (msg->payload)[1]; 00128 return (uint16_t)r.s; 00129 } 00130 00131 /** 00132 * @brief Get field adc2 from raw_aux message 00133 * 00134 * @return ADC2 (J405 ADC5, LPC2148 AD0.2) 00135 */ 00136 static inline uint16_t mavlink_msg_raw_aux_get_adc2(const mavlink_message_t* msg) 00137 { 00138 generic_16bit r; 00139 r.b[1] = (msg->payload+sizeof(uint16_t))[0]; 00140 r.b[0] = (msg->payload+sizeof(uint16_t))[1]; 00141 return (uint16_t)r.s; 00142 } 00143 00144 /** 00145 * @brief Get field adc3 from raw_aux message 00146 * 00147 * @return ADC3 (J405 ADC6, LPC2148 AD0.1) 00148 */ 00149 static inline uint16_t mavlink_msg_raw_aux_get_adc3(const mavlink_message_t* msg) 00150 { 00151 generic_16bit r; 00152 r.b[1] = (msg->payload+sizeof(uint16_t)+sizeof(uint16_t))[0]; 00153 r.b[0] = (msg->payload+sizeof(uint16_t)+sizeof(uint16_t))[1]; 00154 return (uint16_t)r.s; 00155 } 00156 00157 /** 00158 * @brief Get field adc4 from raw_aux message 00159 * 00160 * @return ADC4 (J405 ADC7, LPC2148 AD1.3) 00161 */ 00162 static inline uint16_t mavlink_msg_raw_aux_get_adc4(const mavlink_message_t* msg) 00163 { 00164 generic_16bit r; 00165 r.b[1] = (msg->payload+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t))[0]; 00166 r.b[0] = (msg->payload+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t))[1]; 00167 return (uint16_t)r.s; 00168 } 00169 00170 /** 00171 * @brief Get field vbat from raw_aux message 00172 * 00173 * @return Battery voltage 00174 */ 00175 static inline uint16_t mavlink_msg_raw_aux_get_vbat(const mavlink_message_t* msg) 00176 { 00177 generic_16bit r; 00178 r.b[1] = (msg->payload+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t))[0]; 00179 r.b[0] = (msg->payload+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t))[1]; 00180 return (uint16_t)r.s; 00181 } 00182 00183 /** 00184 * @brief Get field temp from raw_aux message 00185 * 00186 * @return Temperature (degrees celcius) 00187 */ 00188 static inline int16_t mavlink_msg_raw_aux_get_temp(const mavlink_message_t* msg) 00189 { 00190 generic_16bit r; 00191 r.b[1] = (msg->payload+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t))[0]; 00192 r.b[0] = (msg->payload+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t))[1]; 00193 return (int16_t)r.s; 00194 } 00195 00196 /** 00197 * @brief Get field baro from raw_aux message 00198 * 00199 * @return Barometric pressure (hecto Pascal) 00200 */ 00201 static inline int32_t mavlink_msg_raw_aux_get_baro(const mavlink_message_t* msg) 00202 { 00203 generic_32bit r; 00204 r.b[3] = (msg->payload+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(int16_t))[0]; 00205 r.b[2] = (msg->payload+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(int16_t))[1]; 00206 r.b[1] = (msg->payload+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(int16_t))[2]; 00207 r.b[0] = (msg->payload+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(uint16_t)+sizeof(int16_t))[3]; 00208 return (int32_t)r.i; 00209 } 00210 00211 /** 00212 * @brief Decode a raw_aux message into a struct 00213 * 00214 * @param msg The message to decode 00215 * @param raw_aux C-struct to decode the message contents into 00216 */ 00217 static inline void mavlink_msg_raw_aux_decode(const mavlink_message_t* msg, mavlink_raw_aux_t* raw_aux) 00218 { 00219 raw_aux->adc1 = mavlink_msg_raw_aux_get_adc1(msg); 00220 raw_aux->adc2 = mavlink_msg_raw_aux_get_adc2(msg); 00221 raw_aux->adc3 = mavlink_msg_raw_aux_get_adc3(msg); 00222 raw_aux->adc4 = mavlink_msg_raw_aux_get_adc4(msg); 00223 raw_aux->vbat = mavlink_msg_raw_aux_get_vbat(msg); 00224 raw_aux->temp = mavlink_msg_raw_aux_get_temp(msg); 00225 raw_aux->baro = mavlink_msg_raw_aux_get_baro(msg); 00226 }
Generated on Tue Jul 12 2022 14:09:26 by 1.7.2