Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-03-03 04:03:59 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_HAL_SITL: add support for multiple i2c buses

Browse Source
This commit is contained in:
Peter Barker 2020-08-19 14:57:37 +10:00 committed by Peter Barker
parent 230ca049c1
commit bddea9e046
2 changed files with 6 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/AP_HAL_SITL/I2CDevice.cpp
View File

@ -101,6 +101,9 @@ I2CBus I2CDeviceManager::buses[NUM_SITL_I2C_BUSES] {};
I2CDeviceManager::I2CDeviceManager()
{
for (uint8_t i=0; i<ARRAY_SIZE(buses); i++) {
buses[i].bus = i;
}
}
AP_HAL::OwnPtr<AP_HAL::I2CDevice>
@ -132,6 +135,7 @@ I2CDevice::I2CDevice(I2CBus &bus, uint8_t address)
: _bus(bus)
, _address(address)
{
::fprintf(stderr, "bus.bus=%u address=0x%02x\n", bus.bus, address);
set_device_bus(bus.bus);
set_device_address(address);
}
@ -159,6 +163,7 @@ bool I2CDevice::_transfer(const uint8_t *send, uint32_t send_len,
unsigned nmsgs = 0;
if (send && send_len != 0) {
msgs[nmsgs].bus = _bus.bus;
msgs[nmsgs].addr = _address;
msgs[nmsgs].flags = 0;
msgs[nmsgs].buf = const_cast<uint8_t*>(send);

1
libraries/AP_HAL_SITL/I2CDevice.h
View File

@ -81,6 +81,7 @@ public:
#define I2C_M_RD 1
#define I2C_RDWR 0
struct i2c_msg {
uint8_t bus;
uint8_t addr;
uint8_t flags;
uint8_t *buf;