|
|
|
@ -37,6 +37,15 @@
@@ -37,6 +37,15 @@
|
|
|
|
|
* @author Simon Wilks |
|
|
|
|
* |
|
|
|
|
* Driver for the MEAS Spec series connected via I2C. |
|
|
|
|
* |
|
|
|
|
* Supported sensors: |
|
|
|
|
* |
|
|
|
|
* - MS4525DO (http://www.meas-spec.com/downloads/MS4525DO.pdf)
|
|
|
|
|
* - untested: MS5525DSO (http://www.meas-spec.com/downloads/MS5525DSO.pdf)
|
|
|
|
|
* |
|
|
|
|
* Interface application notes: |
|
|
|
|
* |
|
|
|
|
* - Interfacing to MEAS Digital Pressure Modules (http://www.meas-spec.com/application-notes.aspx#)
|
|
|
|
|
*/ |
|
|
|
|
|
|
|
|
|
#include <nuttx/config.h> |
|
|
|
@ -79,8 +88,10 @@
@@ -79,8 +88,10 @@
|
|
|
|
|
/* Default I2C bus */ |
|
|
|
|
#define PX4_I2C_BUS_DEFAULT PX4_I2C_BUS_EXPANSION |
|
|
|
|
|
|
|
|
|
/* I2C bus address */ |
|
|
|
|
#define I2C_ADDRESS 0x75 /* 7-bit address. 8-bit address is 0xEA */ |
|
|
|
|
/* I2C bus address is 1010001x */ |
|
|
|
|
#define I2C_ADDRESS_MS4525DO 0x51 /* 7-bit address. */ |
|
|
|
|
/* The MS5525DSO address is 111011Cx, where C is the complementary value of the pin CSB */ |
|
|
|
|
#define I2C_ADDRESS_MS5525DSO 0x77 /* 7-bit address, addr. pin pulled low */ |
|
|
|
|
|
|
|
|
|
/* Register address */ |
|
|
|
|
#define READ_CMD 0x07 /* Read the data */ |
|
|
|
@ -97,8 +108,7 @@
@@ -97,8 +108,7 @@
|
|
|
|
|
class MEASAirspeed : public Airspeed |
|
|
|
|
{ |
|
|
|
|
public: |
|
|
|
|
MEASAirspeed(int bus, int address = I2C_ADDRESS); |
|
|
|
|
virtual ~MEASAirspeed(); |
|
|
|
|
MEASAirspeed(int bus, int address = I2C_ADDRESS_MS4525DO); |
|
|
|
|
|
|
|
|
|
protected: |
|
|
|
|
|
|
|
|
@ -126,122 +136,122 @@ MEASAirspeed::MEASAirspeed(int bus, int address) : Airspeed(bus, address,
@@ -126,122 +136,122 @@ MEASAirspeed::MEASAirspeed(int bus, int address) : Airspeed(bus, address,
|
|
|
|
|
int |
|
|
|
|
MEASAirspeed::measure() |
|
|
|
|
{ |
|
|
|
|
int ret; |
|
|
|
|
// int ret;
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Send the command to begin a measurement. |
|
|
|
|
*/ |
|
|
|
|
uint8_t cmd = READ_CMD; |
|
|
|
|
ret = transfer(&cmd, 1, nullptr, 0); |
|
|
|
|
// /*
|
|
|
|
|
// * Send the command to begin a measurement.
|
|
|
|
|
// */
|
|
|
|
|
// uint8_t cmd = READ_CMD;
|
|
|
|
|
// ret = transfer(&cmd, 1, nullptr, 0);
|
|
|
|
|
|
|
|
|
|
if (OK != ret) { |
|
|
|
|
perf_count(_comms_errors); |
|
|
|
|
log("i2c::transfer returned %d", ret); |
|
|
|
|
return ret; |
|
|
|
|
} |
|
|
|
|
// if (OK != ret) {
|
|
|
|
|
// perf_count(_comms_errors);
|
|
|
|
|
// log("i2c::transfer returned %d", ret);
|
|
|
|
|
// return ret;
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
ret = OK; |
|
|
|
|
// ret = OK;
|
|
|
|
|
|
|
|
|
|
return ret; |
|
|
|
|
// return ret;
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
int |
|
|
|
|
MEASAirspeed::collect() |
|
|
|
|
{ |
|
|
|
|
int ret = -EIO; |
|
|
|
|
// int ret = -EIO;
|
|
|
|
|
|
|
|
|
|
/* read from the sensor */ |
|
|
|
|
uint8_t val[2] = {0, 0}; |
|
|
|
|
// /* read from the sensor */
|
|
|
|
|
// uint8_t val[2] = {0, 0};
|
|
|
|
|
|
|
|
|
|
perf_begin(_sample_perf); |
|
|
|
|
// perf_begin(_sample_perf);
|
|
|
|
|
|
|
|
|
|
ret = transfer(nullptr, 0, &val[0], 2); |
|
|
|
|
// ret = transfer(nullptr, 0, &val[0], 2);
|
|
|
|
|
|
|
|
|
|
if (ret < 0) { |
|
|
|
|
log("error reading from sensor: %d", ret); |
|
|
|
|
return ret; |
|
|
|
|
} |
|
|
|
|
// if (ret < 0) {
|
|
|
|
|
// log("error reading from sensor: %d", ret);
|
|
|
|
|
// return ret;
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
uint16_t diff_pres_pa = val[1] << 8 | val[0]; |
|
|
|
|
// uint16_t diff_pres_pa = val[1] << 8 | val[0];
|
|
|
|
|
|
|
|
|
|
if (diff_pres_pa < _diff_pres_offset + MIN_ACCURATE_DIFF_PRES_PA) { |
|
|
|
|
diff_pres_pa = 0; |
|
|
|
|
// if (diff_pres_pa < _diff_pres_offset + MIN_ACCURATE_DIFF_PRES_PA) {
|
|
|
|
|
// diff_pres_pa = 0;
|
|
|
|
|
|
|
|
|
|
} else { |
|
|
|
|
diff_pres_pa -= _diff_pres_offset; |
|
|
|
|
} |
|
|
|
|
// } else {
|
|
|
|
|
// diff_pres_pa -= _diff_pres_offset;
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
// XXX we may want to smooth out the readings to remove noise.
|
|
|
|
|
// // XXX we may want to smooth out the readings to remove noise.
|
|
|
|
|
|
|
|
|
|
_reports[_next_report].timestamp = hrt_absolute_time(); |
|
|
|
|
_reports[_next_report].differential_pressure_pa = diff_pres_pa; |
|
|
|
|
// _reports[_next_report].timestamp = hrt_absolute_time();
|
|
|
|
|
// _reports[_next_report].differential_pressure_pa = diff_pres_pa;
|
|
|
|
|
|
|
|
|
|
// Track maximum differential pressure measured (so we can work out top speed).
|
|
|
|
|
if (diff_pres_pa > _reports[_next_report].max_differential_pressure_pa) { |
|
|
|
|
_reports[_next_report].max_differential_pressure_pa = diff_pres_pa; |
|
|
|
|
} |
|
|
|
|
// // Track maximum differential pressure measured (so we can work out top speed).
|
|
|
|
|
// if (diff_pres_pa > _reports[_next_report].max_differential_pressure_pa) {
|
|
|
|
|
// _reports[_next_report].max_differential_pressure_pa = diff_pres_pa;
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
/* announce the airspeed if needed, just publish else */ |
|
|
|
|
orb_publish(ORB_ID(differential_pressure), _airspeed_pub, &_reports[_next_report]); |
|
|
|
|
// /* announce the airspeed if needed, just publish else */
|
|
|
|
|
// orb_publish(ORB_ID(differential_pressure), _airspeed_pub, &_reports[_next_report]);
|
|
|
|
|
|
|
|
|
|
/* post a report to the ring - note, not locked */ |
|
|
|
|
INCREMENT(_next_report, _num_reports); |
|
|
|
|
// /* post a report to the ring - note, not locked */
|
|
|
|
|
// INCREMENT(_next_report, _num_reports);
|
|
|
|
|
|
|
|
|
|
/* if we are running up against the oldest report, toss it */ |
|
|
|
|
if (_next_report == _oldest_report) { |
|
|
|
|
perf_count(_buffer_overflows); |
|
|
|
|
INCREMENT(_oldest_report, _num_reports); |
|
|
|
|
} |
|
|
|
|
// /* if we are running up against the oldest report, toss it */
|
|
|
|
|
// if (_next_report == _oldest_report) {
|
|
|
|
|
// perf_count(_buffer_overflows);
|
|
|
|
|
// INCREMENT(_oldest_report, _num_reports);
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
/* notify anyone waiting for data */ |
|
|
|
|
poll_notify(POLLIN); |
|
|
|
|
// /* notify anyone waiting for data */
|
|
|
|
|
// poll_notify(POLLIN);
|
|
|
|
|
|
|
|
|
|
ret = OK; |
|
|
|
|
// ret = OK;
|
|
|
|
|
|
|
|
|
|
perf_end(_sample_perf); |
|
|
|
|
// perf_end(_sample_perf);
|
|
|
|
|
|
|
|
|
|
return ret; |
|
|
|
|
// return ret;
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void |
|
|
|
|
MEASAirspeed::cycle() |
|
|
|
|
{ |
|
|
|
|
/* collection phase? */ |
|
|
|
|
if (_collect_phase) { |
|
|
|
|
|
|
|
|
|
/* perform collection */ |
|
|
|
|
if (OK != collect()) { |
|
|
|
|
log("collection error"); |
|
|
|
|
/* restart the measurement state machine */ |
|
|
|
|
start(); |
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* next phase is measurement */ |
|
|
|
|
_collect_phase = false; |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Is there a collect->measure gap? |
|
|
|
|
*/ |
|
|
|
|
if (_measure_ticks > USEC2TICK(CONVERSION_INTERVAL)) { |
|
|
|
|
|
|
|
|
|
/* schedule a fresh cycle call when we are ready to measure again */ |
|
|
|
|
work_queue(HPWORK, |
|
|
|
|
&_work, |
|
|
|
|
(worker_t)&Airspeed::cycle_trampoline, |
|
|
|
|
this, |
|
|
|
|
_measure_ticks - USEC2TICK(CONVERSION_INTERVAL)); |
|
|
|
|
|
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* measurement phase */ |
|
|
|
|
if (OK != measure()) |
|
|
|
|
log("measure error"); |
|
|
|
|
|
|
|
|
|
/* next phase is collection */ |
|
|
|
|
_collect_phase = true; |
|
|
|
|
// /* collection phase? */
|
|
|
|
|
// if (_collect_phase) {
|
|
|
|
|
|
|
|
|
|
// /* perform collection */
|
|
|
|
|
// if (OK != collect()) {
|
|
|
|
|
// log("collection error");
|
|
|
|
|
// /* restart the measurement state machine */
|
|
|
|
|
// start();
|
|
|
|
|
// return;
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
// /* next phase is measurement */
|
|
|
|
|
// _collect_phase = false;
|
|
|
|
|
|
|
|
|
|
// /*
|
|
|
|
|
// * Is there a collect->measure gap?
|
|
|
|
|
// */
|
|
|
|
|
// if (_measure_ticks > USEC2TICK(CONVERSION_INTERVAL)) {
|
|
|
|
|
|
|
|
|
|
// /* schedule a fresh cycle call when we are ready to measure again */
|
|
|
|
|
// work_queue(HPWORK,
|
|
|
|
|
// &_work,
|
|
|
|
|
// (worker_t)&Airspeed::cycle_trampoline,
|
|
|
|
|
// this,
|
|
|
|
|
// _measure_ticks - USEC2TICK(CONVERSION_INTERVAL));
|
|
|
|
|
|
|
|
|
|
// return;
|
|
|
|
|
// }
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
// /* measurement phase */
|
|
|
|
|
// if (OK != measure())
|
|
|
|
|
// log("measure error");
|
|
|
|
|
|
|
|
|
|
// /* next phase is collection */
|
|
|
|
|
// _collect_phase = true;
|
|
|
|
|
|
|
|
|
|
/* schedule a fresh cycle call when the measurement is done */ |
|
|
|
|
work_queue(HPWORK, |
|
|
|
@ -282,12 +292,23 @@ start(int i2c_bus)
@@ -282,12 +292,23 @@ start(int i2c_bus)
|
|
|
|
|
if (g_dev != nullptr) |
|
|
|
|
errx(1, "already started"); |
|
|
|
|
|
|
|
|
|
/* create the driver */ |
|
|
|
|
g_dev = new MEASAirspeed(i2c_bus); |
|
|
|
|
/* create the driver, try the MS4525DO first */ |
|
|
|
|
g_dev = new MEASAirspeed(i2c_bus, I2C_ADDRESS_MS4525DO); |
|
|
|
|
|
|
|
|
|
/* check if the MS4525DO was instantiated */ |
|
|
|
|
if (g_dev == nullptr) |
|
|
|
|
goto fail; |
|
|
|
|
|
|
|
|
|
/* try the MS5525DSO next if init fails */ |
|
|
|
|
if (OK != g_dev->init()) |
|
|
|
|
delete g_dev; |
|
|
|
|
g_dev = new MEASAirspeed(i2c_bus, I2C_ADDRESS_MS5525DSO); |
|
|
|
|
|
|
|
|
|
/* check if the MS5525DSO was instantiated */ |
|
|
|
|
if (g_dev == nullptr) |
|
|
|
|
goto fail; |
|
|
|
|
|
|
|
|
|
/* both versions failed if the init for the MS5525DSO fails, give up */ |
|
|
|
|
if (OK != g_dev->init()) |
|
|
|
|
goto fail; |
|
|
|
|
|
|
|
|
|