AP_InertialSensor: fix slave register structure for Invensensev2

This commit is contained in:
Siddharth Purohit 2019-02-25 17:22:18 +05:30 committed by Andrew Tridgell
parent 104c433081
commit b76ec8cc11
1 changed files with 2 additions and 2 deletions

View File

@ -725,10 +725,10 @@ bool AP_InertialSensor_Invensensev2::_hardware_init(void)
AP_Invensensev2_AuxiliaryBusSlave::AP_Invensensev2_AuxiliaryBusSlave(AuxiliaryBus &bus, uint8_t addr,
uint8_t instance)
: AuxiliaryBusSlave(bus, addr, instance)
, _inv2_addr(INV2REG_I2C_SLV0_ADDR + _instance * 3)
, _inv2_addr(INV2REG_I2C_SLV0_ADDR + _instance * 4)
, _inv2_reg(_inv2_addr + 1)
, _inv2_ctrl(_inv2_addr + 2)
, _inv2_do(INV2REG_I2C_SLV0_DO + _instance)
, _inv2_do(_inv2_addr + 3)
{
}