dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

fixed timming issued in I2C whoami communication

This commit is contained in:
Luis Rodrigues 2015-05-31 21:09:21 +02:00
parent 7cde53597c
commit 70bfb42956
1 changed files with 10 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
src/drivers/trone/trone.cpp
View File

@ -319,9 +319,15 @@ TRONE::probe()
uint8_t who_am_i=0; uint8_t who_am_i=0;
const uint8_t cmd = TRONE_WHO_AM_I_REG; 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 // set the I2C bus address
return measure(); 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", debug("WHO_AM_I byte mismatch 0x%02x should be 0x%02x\n",