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

Reset MS5611 baro sensor after an error

Browse Source 
Reset MS5611 baro sensor after an error in order to avoid endless error
loops
This commit is contained in:
Kynos
2014-05-02 22:00:34 +02:00
parent 5e9639ad9b
commit 2de01964e2
1 changed files with 5 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/ms5611/ms5611.cpp
+5
View File
@@ -526,6 +526,7 @@ void
MS5611::cycle() MS5611::cycle()
{ {
int ret; int ret;
unsigned dummy;
/* collection phase? */ /* collection phase? */
if (_collect_phase) { if (_collect_phase) {
@@ -542,6 +543,8 @@ MS5611::cycle()
} else { } else {
//log("collection error %d", ret); //log("collection error %d", ret);
} }
/* issue a reset command to the sensor */
_interface->ioctl(IOCTL_RESET, dummy);
/* reset the collection state machine and try again */ /* reset the collection state machine and try again */
start_cycle(); start_cycle();
return; return;
@@ -573,6 +576,8 @@ MS5611::cycle()
ret = measure(); ret = measure();
if (ret != OK) { if (ret != OK) {
//log("measure error %d", ret); //log("measure error %d", ret);
/* issue a reset command to the sensor */
_interface->ioctl(IOCTL_RESET, dummy);
/* reset the collection state machine and try again */ /* reset the collection state machine and try again */
start_cycle(); start_cycle();
return; return;