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

ms5611: check for all zero in the prom

Browse Source 
when SPI CLK fails we get all zero data
This commit is contained in:
Andrew Tridgell 2013-12-09 10:03:50 +11:00 committed by Lorenz Meier
parent 39b40e41c2
commit 8744aa7536
1 changed files with 7 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
src/drivers/ms5611/ms5611_spi.cpp
View File

@ -236,9 +236,12 @@ MS5611_SPI::_read_prom()
usleep(3000);
/* read and convert PROM words */
bool all_zero = true;
for (int i = 0; i < 8; i++) {
uint8_t cmd = (ADDR_PROM_SETUP + (i * 2));
_prom.c[i] = _reg16(cmd);
if (_prom.c[i] != 0)
all_zero = false;
//debug("prom[%u]=0x%x", (unsigned)i, (unsigned)_prom.c[i]);
}
@ -247,6 +250,10 @@ MS5611_SPI::_read_prom()
if (ret != OK) {
debug("crc failed");
}
if (all_zero) {
debug("prom all zero");
ret = -EIO;
}
return ret;
}