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

Merge pull request #2260 from Terabee/master

Browse Source 
fixed timming issued in I2C whoami communication
This commit is contained in:
Lorenz Meier
2015-06-02 01:32:47 -07:00
parent c49f902635 70bfb42956
commit 6a35887f54
1 changed files with 10 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/trone/trone.cpp
+10 -4
View File
@@ -319,10 +319,16 @@ TRONE::probe()
uint8_t who_am_i=0;
const uint8_t cmd = TRONE_WHO_AM_I_REG;
if (transfer(&cmd, 1, &who_am_i, 1) == OK && who_am_i == TRONE_WHO_AM_I_REG_VAL) {
// it is responding correctly to a WHO_AM_I
return measure();
}
// set the I2C bus address
set_address(TRONE_BASEADDR);
// can't use a single transfer as TROne need a bit of time for internal processing
if (transfer(&cmd, 1, nullptr, 0) == OK) {
if ( transfer(nullptr, 0, &who_am_i, 1) == OK && who_am_i == TRONE_WHO_AM_I_REG_VAL){
return measure();
}
}
debug("WHO_AM_I byte mismatch 0x%02x should be 0x%02x\n",
(unsigned)who_am_i,