fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-23 17:43:34 +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-10 11:39:28 +01:00
committed by Lorenz Meier
parent 39b40e41c2
commit 8744aa7536
1 changed files with 7 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/ms5611/ms5611_spi.cpp
+7
View File
@@ -236,9 +236,12 @@ MS5611_SPI::_read_prom()
usleep(3000); usleep(3000);
/* read and convert PROM words */ /* read and convert PROM words */
bool all_zero = true;
for (int i = 0; i < 8; i++) { for (int i = 0; i < 8; i++) {
uint8_t cmd = (ADDR_PROM_SETUP + (i * 2)); uint8_t cmd = (ADDR_PROM_SETUP + (i * 2));
_prom.c[i] = _reg16(cmd); _prom.c[i] = _reg16(cmd);
if (_prom.c[i] != 0)
all_zero = false;
//debug("prom[%u]=0x%x", (unsigned)i, (unsigned)_prom.c[i]); //debug("prom[%u]=0x%x", (unsigned)i, (unsigned)_prom.c[i]);
} }
@@ -247,6 +250,10 @@ MS5611_SPI::_read_prom()
if (ret != OK) { if (ret != OK) {
debug("crc failed"); debug("crc failed");
} }
if (all_zero) {
debug("prom all zero");
ret = -EIO;
}
return ret; return ret;
} }