|
|
@ -967,23 +967,6 @@ namespace vl53lxx |
|
|
|
|
|
|
|
|
|
|
|
VL53LXX *g_dev; |
|
|
|
VL53LXX *g_dev; |
|
|
|
|
|
|
|
|
|
|
|
int bus_options[] = { |
|
|
|
|
|
|
|
#ifdef PX4_I2C_BUS_EXPANSION |
|
|
|
|
|
|
|
PX4_I2C_BUS_EXPANSION, |
|
|
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
#ifdef PX4_I2C_BUS_EXPANSION1 |
|
|
|
|
|
|
|
PX4_I2C_BUS_EXPANSION1, |
|
|
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
#ifdef PX4_I2C_BUS_EXPANSION2 |
|
|
|
|
|
|
|
PX4_I2C_BUS_EXPANSION2, |
|
|
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
#ifdef PX4_I2C_BUS_ONBOARD |
|
|
|
|
|
|
|
PX4_I2C_BUS_ONBOARD, |
|
|
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#define NUM_BUS_OPTIONS (sizeof(bus_options)/sizeof(bus_options[0])) |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int start(uint8_t rotation); |
|
|
|
int start(uint8_t rotation); |
|
|
|
int start_bus(uint8_t rotation, int i2c_bus); |
|
|
|
int start_bus(uint8_t rotation, int i2c_bus); |
|
|
|
int stop(); |
|
|
|
int stop(); |
|
|
@ -1007,8 +990,8 @@ start(uint8_t rotation) |
|
|
|
return PX4_ERROR; |
|
|
|
return PX4_ERROR; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
for (unsigned i = 0; i < NUM_BUS_OPTIONS; i++) { |
|
|
|
for (unsigned i = 0; i < NUM_I2C_BUS_OPTIONS; i++) { |
|
|
|
if (start_bus(rotation, bus_options[i]) == PX4_OK) { |
|
|
|
if (start_bus(rotation, i2c_bus_options[i]) == PX4_OK) { |
|
|
|
return PX4_OK; |
|
|
|
return PX4_OK; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
@ -1068,7 +1051,6 @@ fail: |
|
|
|
g_dev = nullptr; |
|
|
|
g_dev = nullptr; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
PX4_ERR("not started on bus %d", i2c_bus); |
|
|
|
|
|
|
|
return PX4_ERROR; |
|
|
|
return PX4_ERROR; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|