Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-25 08:36:08 +08:00
Code Issues Actions 9 Packages Projects Releases Wiki Activity

blah

Browse Source
This commit is contained in:
Daniel Agar
2022-04-20 15:52:03 -04:00
parent 6f2feac880
commit 9ae942c67a
1 changed files with 26 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/drivers/device/nuttx/I2C.cpp
+26 -2
View File
@@ -216,6 +216,29 @@ I2C::transfer(const uint8_t *send, const unsigned send_len, uint8_t *recv, const
int ret_transfer = I2C_TRANSFER(_dev, &msgv[0], msgs);
if (ret_transfer != 0) {
switch (ret_transfer) {
case -EAGAIN:
PX4_WARN("I2C bus: %d, Addr: %X, Arbitration Lost", get_device_bus(), get_device_address());
break;
case -EIO:
PX4_WARN("I2C bus: %d, Addr: %X, Overrun/Underrun", get_device_bus(), get_device_address());
break;
case -EADDRNOTAVAIL:
//PX4_WARN("I2C bus: %d, Addr: %X, Address NACK", get_device_bus(), get_device_address());
break;
case -ECOMM:
PX4_WARN("I2C bus: %d, Addr: %X, Data NACK", get_device_bus(), get_device_address());
break;
case -EBUSY:
PX4_WARN("I2C bus: %d, Addr: %X, Bus busy", get_device_bus(), get_device_address());
break;
}
DEVICE_DEBUG("I2C transfer failed, result %d", ret_transfer);
ret = PX4_ERROR;
@@ -225,9 +248,10 @@ I2C::transfer(const uint8_t *send, const unsigned send_len, uint8_t *recv, const
break;
}
/* if we have already retried once, or we are going to give up, then reset the bus */
if ((retry_count >= 1) || (retry_count >= _retries)) {
// if we have already retried once, and we aren't going to give up, then reset the bus
if ((retry_count >= 1) && (retry_count < _retries)) {
#if defined(CONFIG_I2C_RESET)
PX4_WARN("I2C bus: %d, Addr: %X, I2C_RESET %d/%d", get_device_bus(), get_device_address(), retry_count, _retries);
I2C_RESET(_dev);
#endif // CONFIG_I2C_RESET
}