Paparazzi UAS  v7.0_unstable
Paparazzi is a free software Unmanned Aircraft System.
Macros | Functions | Variables
airspeed_sdp3x.c File Reference

Airspeed driver for the SDP3X pressure sensor via I2C. More...

#include "std.h"
#include "mcu_periph/i2c.h"
#include "modules/sensors/airspeed_sdp3x.h"
#include "filters/low_pass_filter.h"
#include "modules/core/abi.h"
#include "mcu_periph/uart.h"
#include "pprzlink/messages.h"
#include "modules/datalink/downlink.h"
#include "modules/datalink/telemetry.h"
+ Include dependency graph for airspeed_sdp3x.c:

Go to the source code of this file.

Macros

#define USE_AIRSPEED_LOWPASS_FILTER   TRUE
 Use low pass filter on pressure values. More...
 
#define SDP3X_SCALE_TEMPERATURE   200.0f
 Commands and scales. More...
 
#define SDP3X_RESET_ADDR   0x00
 
#define SDP3X_RESET_CMD   0x06
 
#define SDP3X_CONT_MEAS_AVG_MODE   0x3615
 
#define SDP3X_CONT_NONE_MODE   0x361E
 
#define SDP3X_SCALE_PRESSURE_SDP31   60
 
#define SDP3X_SCALE_PRESSURE_SDP32   240
 
#define SDP3X_SCALE_PRESSURE_SDP33   20
 
#define SDP3X_I2C_ADDR   0x42
 Sensor I2C slave address (existing defaults 0x42, 0x44 and 0x46) More...
 
#define SDP3X_MODE   SDP3X_CONT_MEAS_AVG_MODE
 Default operation mode. More...
 
#define SDP3X_PRESSURE_SCALE   SDP3X_SCALE_PRESSURE_SDP31
 Default scale for SDP31. More...
 
#define SDP3X_PRESSURE_OFFSET   0.f
 
#define SDP3X_SYNC_SEND   FALSE
 Send a AIRSPEED_MS45XX message with every new measurement. More...
 
#define SDP3X_AIRSPEED_SCALE   1.6327
 Quadratic scale factor for indicated airspeed. More...
 
#define SDP3X_LOWPASS_TAU   0.15
 Time constant for second order Butterworth low pass filter Default of 0.15 should give cut-off freq of 1/(2*pi*tau) ~= 1Hz. More...
 
#define AUTOSET_NB_MAX   20
 

Functions

static bool sdp3x_crc (const uint8_t data[], unsigned size, uint8_t checksum)
 
static void sdp3x_downlink (struct transport_tx *trans, struct link_device *dev)
 
void sdp3x_init (void)
 
void sdp3x_periodic (void)
 
void sdp3x_event (void)
 

Variables

struct AirspeedSdp3x sdp3x
 
static struct i2c_transaction sdp3x_trans
 
static Butterworth2LowPass sdp3x_filter
 

Detailed Description

Airspeed driver for the SDP3X pressure sensor via I2C.

Definition in file airspeed_sdp3x.c.

Macro Definition Documentation

◆ AUTOSET_NB_MAX

#define AUTOSET_NB_MAX   20

Definition at line 199 of file airspeed_sdp3x.c.

◆ SDP3X_AIRSPEED_SCALE

#define SDP3X_AIRSPEED_SCALE   1.6327

Quadratic scale factor for indicated airspeed.

airspeed = sqrt(2*p_diff/density) With p_diff in Pa and standard air density of 1.225 kg/m^3, default airspeed scale is 2/1.225

Definition at line 105 of file airspeed_sdp3x.c.

◆ SDP3X_CONT_MEAS_AVG_MODE

#define SDP3X_CONT_MEAS_AVG_MODE   0x3615

Definition at line 58 of file airspeed_sdp3x.c.

◆ SDP3X_CONT_NONE_MODE

#define SDP3X_CONT_NONE_MODE   0x361E

Definition at line 59 of file airspeed_sdp3x.c.

◆ SDP3X_I2C_ADDR

#define SDP3X_I2C_ADDR   0x42

Sensor I2C slave address (existing defaults 0x42, 0x44 and 0x46)

Definition at line 68 of file airspeed_sdp3x.c.

◆ SDP3X_LOWPASS_TAU

#define SDP3X_LOWPASS_TAU   0.15

Time constant for second order Butterworth low pass filter Default of 0.15 should give cut-off freq of 1/(2*pi*tau) ~= 1Hz.

Definition at line 112 of file airspeed_sdp3x.c.

◆ SDP3X_MODE

#define SDP3X_MODE   SDP3X_CONT_MEAS_AVG_MODE

Default operation mode.

Definition at line 74 of file airspeed_sdp3x.c.

◆ SDP3X_PRESSURE_OFFSET

#define SDP3X_PRESSURE_OFFSET   0.f

Definition at line 86 of file airspeed_sdp3x.c.

◆ SDP3X_PRESSURE_SCALE

#define SDP3X_PRESSURE_SCALE   SDP3X_SCALE_PRESSURE_SDP31

Default scale for SDP31.

Definition at line 80 of file airspeed_sdp3x.c.

◆ SDP3X_RESET_ADDR

#define SDP3X_RESET_ADDR   0x00

Definition at line 55 of file airspeed_sdp3x.c.

◆ SDP3X_RESET_CMD

#define SDP3X_RESET_CMD   0x06

Definition at line 56 of file airspeed_sdp3x.c.

◆ SDP3X_SCALE_PRESSURE_SDP31

#define SDP3X_SCALE_PRESSURE_SDP31   60

Definition at line 61 of file airspeed_sdp3x.c.

◆ SDP3X_SCALE_PRESSURE_SDP32

#define SDP3X_SCALE_PRESSURE_SDP32   240

Definition at line 62 of file airspeed_sdp3x.c.

◆ SDP3X_SCALE_PRESSURE_SDP33

#define SDP3X_SCALE_PRESSURE_SDP33   20

Definition at line 63 of file airspeed_sdp3x.c.

◆ SDP3X_SCALE_TEMPERATURE

#define SDP3X_SCALE_TEMPERATURE   200.0f

Commands and scales.

Definition at line 54 of file airspeed_sdp3x.c.

◆ SDP3X_SYNC_SEND

#define SDP3X_SYNC_SEND   FALSE

Send a AIRSPEED_MS45XX message with every new measurement.

FIXME Mainly for debugging, use with caution, sends message at ~100Hz.

Definition at line 96 of file airspeed_sdp3x.c.

◆ USE_AIRSPEED_LOWPASS_FILTER

#define USE_AIRSPEED_LOWPASS_FILTER   TRUE

Use low pass filter on pressure values.

Definition at line 49 of file airspeed_sdp3x.c.

Function Documentation

◆ sdp3x_crc()

static bool sdp3x_crc ( const uint8_t  data[],
unsigned  size,
uint8_t  checksum 
)
static

Definition at line 122 of file airspeed_sdp3x.c.

References checksum.

Referenced by sdp3x_event().

+ Here is the caller graph for this function:

◆ sdp3x_downlink()

static void sdp3x_downlink ( struct transport_tx *  trans,
struct link_device *  dev 
)
static

Definition at line 144 of file airspeed_sdp3x.c.

References AirspeedSdp3x::airspeed, dev, AirspeedSdp3x::pressure, AirspeedSdp3x::pressure_offset, AirspeedSdp3x::raw_p, sdp3x, SDP3X_SENDER_ID, and AirspeedSdp3x::temperature.

Referenced by sdp3x_event(), and sdp3x_init().

+ Here is the caller graph for this function:

◆ sdp3x_event()

void sdp3x_event ( void  )

Definition at line 201 of file airspeed_sdp3x.c.

References AirspeedSdp3x::airspeed, AirspeedSdp3x::airspeed_scale, AIRSPEED_SDP3X_ID, AUTOSET_NB_MAX, AirspeedSdp3x::autoset_offset, i2c_transaction::buf, DefaultChannel, DefaultDevice, I2CTransDone, I2CTransFailed, I2CTransSuccess, AirspeedSdp3x::initialized, AirspeedSdp3x::pressure, AirspeedSdp3x::pressure_offset, AirspeedSdp3x::pressure_scale, AirspeedSdp3x::raw_p, sdp3x, sdp3x_crc(), sdp3x_downlink(), sdp3x_filter, SDP3X_SCALE_TEMPERATURE, SDP3X_SENDER_ID, sdp3x_trans, i2c_transaction::status, AirspeedSdp3x::sync_send, AirspeedSdp3x::temperature, and update_butterworth_2_low_pass().

+ Here is the call graph for this function:

◆ sdp3x_init()

void sdp3x_init ( void  )

Definition at line 156 of file airspeed_sdp3x.c.

References AirspeedSdp3x::airspeed, AirspeedSdp3x::airspeed_scale, AirspeedSdp3x::autoset_offset, DefaultPeriodic, I2CTransDone, init_butterworth_2_low_pass(), AirspeedSdp3x::initialized, AirspeedSdp3x::pressure, AirspeedSdp3x::pressure_offset, AirspeedSdp3x::pressure_scale, register_periodic_telemetry(), sdp3x, SDP3X_AIRSPEED_SCALE, sdp3x_downlink(), sdp3x_filter, SDP3X_LOWPASS_TAU, SDP3X_PRESSURE_OFFSET, SDP3X_PRESSURE_SCALE, SDP3X_SYNC_SEND, sdp3x_trans, i2c_transaction::status, AirspeedSdp3x::sync_send, and AirspeedSdp3x::temperature.

+ Here is the call graph for this function:

◆ sdp3x_periodic()

void sdp3x_periodic ( void  )

Definition at line 180 of file airspeed_sdp3x.c.

References i2c_transaction::buf, i2c_receive(), i2c_transmit(), I2CTransDone, AirspeedSdp3x::initialized, sdp3x, SDP3X_I2C_ADDR, SDP3X_MODE, sdp3x_trans, and i2c_transaction::status.

+ Here is the call graph for this function:

Variable Documentation

◆ sdp3x

struct AirspeedSdp3x sdp3x

Definition at line 1 of file airspeed_sdp3x.c.

Referenced by sdp3x_downlink(), sdp3x_event(), sdp3x_init(), and sdp3x_periodic().

◆ sdp3x_filter

Butterworth2LowPass sdp3x_filter
static

Definition at line 119 of file airspeed_sdp3x.c.

Referenced by sdp3x_event(), and sdp3x_init().

◆ sdp3x_trans

struct i2c_transaction sdp3x_trans
static

Definition at line 1 of file airspeed_sdp3x.c.

Referenced by sdp3x_event(), sdp3x_init(), and sdp3x_periodic().