forked from Archive/PX4-Autopilot
ms4525_airspeed: remove PX4_I2C_ALL
This commit is contained in:
parent
9b2e32c976
commit
dd044ed4be
|
@ -81,7 +81,6 @@
|
||||||
#define MEAS_DRIVER_FILTER_FREQ 1.2f
|
#define MEAS_DRIVER_FILTER_FREQ 1.2f
|
||||||
#define CONVERSION_INTERVAL (1000000 / MEAS_RATE) /* microseconds */
|
#define CONVERSION_INTERVAL (1000000 / MEAS_RATE) /* microseconds */
|
||||||
|
|
||||||
#define PX4_I2C_ALL 0xFF
|
|
||||||
|
|
||||||
class MEASAirspeed : public Airspeed
|
class MEASAirspeed : public Airspeed
|
||||||
{
|
{
|
||||||
|
@ -403,18 +402,14 @@ int reset();
|
||||||
int
|
int
|
||||||
start(int i2c_bus)
|
start(int i2c_bus)
|
||||||
{
|
{
|
||||||
if (i2c_bus == PX4_I2C_ALL) {
|
for (unsigned i = 0; i < NUM_BUS_OPTIONS; i++) {
|
||||||
for (unsigned i = 0; i < NUM_BUS_OPTIONS; i++) {
|
if (start_bus(bus_options[i]) == PX4_OK) {
|
||||||
if (start_bus(bus_options[i]) == PX4_OK) {
|
return PX4_OK;
|
||||||
return PX4_OK;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return PX4_ERROR;
|
|
||||||
|
|
||||||
} else {
|
|
||||||
return start_bus(i2c_bus);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
return PX4_ERROR;
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
bool
|
bool
|
||||||
|
@ -531,6 +526,8 @@ ms4525_airspeed_main(int argc, char *argv[])
|
||||||
int ch;
|
int ch;
|
||||||
const char *myoptarg = nullptr;
|
const char *myoptarg = nullptr;
|
||||||
|
|
||||||
|
bool start_all = false;
|
||||||
|
|
||||||
while ((ch = px4_getopt(argc, argv, "ab:", &myoptind, &myoptarg)) != EOF) {
|
while ((ch = px4_getopt(argc, argv, "ab:", &myoptind, &myoptarg)) != EOF) {
|
||||||
switch (ch) {
|
switch (ch) {
|
||||||
case 'b':
|
case 'b':
|
||||||
|
@ -538,7 +535,7 @@ ms4525_airspeed_main(int argc, char *argv[])
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case 'a':
|
case 'a':
|
||||||
i2c_bus = PX4_I2C_ALL;
|
start_all = true;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
default:
|
default:
|
||||||
|
@ -556,7 +553,13 @@ ms4525_airspeed_main(int argc, char *argv[])
|
||||||
* Start/load the driver.
|
* Start/load the driver.
|
||||||
*/
|
*/
|
||||||
if (!strcmp(argv[myoptind], "start")) {
|
if (!strcmp(argv[myoptind], "start")) {
|
||||||
return meas_airspeed::start(i2c_bus);
|
if (start_all) {
|
||||||
|
return meas_airspeed::start(i2c_bus);
|
||||||
|
|
||||||
|
} else {
|
||||||
|
return meas_airspeed::start_bus(i2c_bus);
|
||||||
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
|
Loading…
Reference in New Issue