diff --git a/src/sensors/softfusion/drivers/icm45base.h b/src/sensors/softfusion/drivers/icm45base.h index ace7263..0d07ea5 100644 --- a/src/sensors/softfusion/drivers/icm45base.h +++ b/src/sensors/softfusion/drivers/icm45base.h @@ -230,6 +230,8 @@ struct ICM45Base { BaseRegs::FifoConfig3::reg, BaseRegs::FifoConfig3::value ); + writeBankRegister(); + writeBankRegister(); m_RegisterInterface.writeReg( BaseRegs::PwrMgmt0::reg, BaseRegs::PwrMgmt0::value @@ -240,9 +242,6 @@ struct ICM45Base { BaseRegs::IOCPadScenarioAuxOvrd::value ); - writeBankRegister(); - writeBankRegister(); - read_buffer.resize(FullFifoEntrySize * MaxReadings); delay(1);