power_monitor: Determine I2C communication errors

This commit is contained in:
murata 2022-02-19 19:18:31 +09:00 committed by Daniel Agar
parent 09e36e6cb4
commit cc6c6c3b8c

View File

@ -114,7 +114,9 @@ int INA238::init()
return ret;
}
write(INA238_REG_CONFIG, (uint16_t)(INA238_RST_RESET | _range));
if (write(INA238_REG_CONFIG, (uint16_t)(INA238_RST_RESET | _range)) != PX4_OK) {
return ret;
}
uint16_t shunt_calibration = static_cast<uint16_t>(INA238_CONST * _current_lsb * _rshunt);
@ -127,7 +129,9 @@ int INA238::init()
}
// Set the CONFIG for max I
write(INA238_REG_CONFIG, (uint16_t) _range);
if (write(INA238_REG_CONFIG, (uint16_t) _range) != PX4_OK) {
return ret;
}
// Start ADC continous mode here
ret = write(INA238_REG_ADCCONFIG, (uint16_t)INA238_ADCCONFIG);