forked from Archive/PX4-Autopilot
Merge pull request #891 from Kynos/master
Reset MS5611 baro sensor after an error
This commit is contained in:
commit
2569338919
|
@ -526,6 +526,7 @@ void
|
|||
MS5611::cycle()
|
||||
{
|
||||
int ret;
|
||||
unsigned dummy;
|
||||
|
||||
/* collection phase? */
|
||||
if (_collect_phase) {
|
||||
|
@ -542,6 +543,8 @@ MS5611::cycle()
|
|||
} else {
|
||||
//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 */
|
||||
start_cycle();
|
||||
return;
|
||||
|
@ -573,6 +576,8 @@ MS5611::cycle()
|
|||
ret = measure();
|
||||
if (ret != OK) {
|
||||
//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 */
|
||||
start_cycle();
|
||||
return;
|
||||
|
|
Loading…
Reference in New Issue