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

Add I2C retries in INA226 to prevent publishing 0's on a single read failure

Browse Source
This commit is contained in:
alexklimaj
2022-04-09 14:23:52 -04:00
committed by Daniel Agar
parent 777540bd02
commit 017f860f44
1 changed files with 11 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/power_monitor/ina226/ina226.cpp
+11 -6
View File
@@ -102,14 +102,19 @@ int INA226::read(uint8_t address, int16_t &data)
{ {
// read desired little-endian value via I2C // read desired little-endian value via I2C
uint16_t received_bytes; uint16_t received_bytes;
const int ret = transfer(&address, 1, (uint8_t *)&received_bytes, sizeof(received_bytes)); int ret = PX4_ERROR;
if (ret == PX4_OK) { for (size_t i = 0; i < 3; i++) {
data = swap16(received_bytes); ret = transfer(&address, 1, (uint8_t *)&received_bytes, sizeof(received_bytes));
} else { if (ret == PX4_OK) {
perf_count(_comms_errors); data = swap16(received_bytes);
PX4_DEBUG("i2c::transfer returned %d", ret); break;
} else {
perf_count(_comms_errors);
PX4_DEBUG("i2c::transfer returned %d", ret);
}
} }
return ret; return ret;