fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

Increase the retry count while probing for I2C sensors. This will also unwedge stuck sensors.

Browse Source
This commit is contained in:
px4dev 2012-08-25 10:53:14 -07:00
parent 4456ca8827
commit 0dc0a0539d
2 changed files with 8 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
apps/drivers/hmc5883/hmc5883.cpp
View File

@ -339,12 +339,14 @@ HMC5883::close_last(struct file *filp)
int
HMC5883::probe()
{
uint8_t data[3];
uint8_t data[3] = {0, 0, 0};
_retries = 3;
if (read_reg(ADDR_ID_A, data[0]) ||
read_reg(ADDR_ID_B, data[1]) ||
read_reg(ADDR_ID_C, data[2]))
debug("read_reg fail");
_retries = 1;
if ((data[0] != ID_A_WHO_AM_I) ||
(data[1] != ID_B_WHO_AM_I) ||

9
apps/drivers/ms5611/ms5611.cpp
View File

@ -317,11 +317,12 @@ MS5611::close_last(struct file *filp)
int
MS5611::probe()
{
if (OK == probe_address(MS5611_ADDRESS_1))
return OK;
if (OK == probe_address(MS5611_ADDRESS_2))
_retries = 3;
if((OK == probe_address(MS5611_ADDRESS_1)) ||
(OK == probe_address(MS5611_ADDRESS_2))) {
_retries = 1;
return OK;
}
return -EIO;
}