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

l3gd20: added retries to disable_i2c()

Browse Source
This commit is contained in:
Andrew Tridgell
2013-12-05 09:06:53 +11:00
committed by Lorenz Meier
parent 476070510e
commit 86ec1c37fa
1 changed files with 10 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/l3gd20/l3gd20.cpp
+10 -2
View File
@@ -715,8 +715,16 @@ L3GD20::stop()
void
L3GD20::disable_i2c(void)
{
uint8_t a = read_reg(0x05);
write_reg(0x05, (0x20 | a));
uint8_t retries = 10;
while (retries--) {
// add retries
uint8_t a = read_reg(0x05);
write_reg(0x05, (0x20 | a));
if (read_reg(0x05) == (a | 0x20)) {
return;
}
}
debug("FAILED TO DISABLE I2C");
}
void