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

Implement the retry counter for message-vector based transfers.

Browse Source
This commit is contained in:
px4dev
2013-01-26 16:15:23 -08:00
parent 6bd662cfb2
commit fd28217e59
1 changed files with 21 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files
apps/drivers/device/i2c.cpp
+21 -9
View File
@@ -169,19 +169,31 @@ I2C::transfer(const uint8_t *send, unsigned send_len, uint8_t *recv, unsigned re
int int
I2C::transfer(i2c_msg_s *msgv, unsigned msgs) I2C::transfer(i2c_msg_s *msgv, unsigned msgs)
{ {
int ret;
/* force the device address into the message vector */
for (unsigned i = 0; i < msgs; i++) for (unsigned i = 0; i < msgs; i++)
msgv[i].addr = _address; msgv[i].addr = _address;
/* unsigned tries = 0;
* I2C architecture means there is an unavoidable race here
* if there are any devices on the bus with a different frequency
* preference. Really, this is pointless.
*/
I2C_SETFREQUENCY(_dev, _frequency);
int ret = I2C_TRANSFER(_dev, msgv, msgs);
if (ret != OK) do {
up_i2creset(_dev);
/*
* I2C architecture means there is an unavoidable race here
* if there are any devices on the bus with a different frequency
* preference. Really, this is pointless.
*/
I2C_SETFREQUENCY(_dev, _frequency);
ret = I2C_TRANSFER(_dev, msgv, msgs);
if (ret == OK)
break;
if (ret != OK)
up_i2creset(_dev);
} while (tries++ < _retries);
return ret; return ret;
} }