diff --git a/include/sot/talos_balance/imu_offset_compensation.hh b/include/sot/talos_balance/imu_offset_compensation.hh index 13465dddc1cba3a9433f401fc8bb0376d50b452c..d5854bb888c2189b36511c911d17917171ece49b 100644 --- a/include/sot/talos_balance/imu_offset_compensation.hh +++ b/include/sot/talos_balance/imu_offset_compensation.hh @@ -81,7 +81,7 @@ namespace dynamicgraph { protected: bool m_initSucceeded; /// true if the entity has been successfully initialized - float m_dt; /// sampling time in seconds + double m_dt; /// sampling time in seconds int m_update_cycles_left; /// number of update cycles left int m_update_cycles; /// total number of update cycles to perform double m_a_gyro_DC_blocker; /// filter parameter to remove DC from gyro online (should be close to <1.0 and equal to 1.0 for disabling) diff --git a/src/imu_offset_compensation.cpp b/src/imu_offset_compensation.cpp index 5f88cc2b7d3188b1e6007a7cbb774c2f93f5f1f9..fe1f799d42682268cfac1a24040ad2d9566859ea 100644 --- a/src/imu_offset_compensation.cpp +++ b/src/imu_offset_compensation.cpp @@ -42,11 +42,10 @@ namespace dynamicgraph ,CONSTRUCT_SIGNAL_OUT(accelerometer_out, dynamicgraph::Vector, m_accelerometer_inSIN) ,CONSTRUCT_SIGNAL_OUT(gyrometer_out, dynamicgraph::Vector, m_gyrometer_inSIN) ,m_initSucceeded(false) + ,m_dt(0.001) ,m_update_cycles_left(0) ,m_update_cycles(0) - ,m_dt(0.001) ,m_a_gyro_DC_blocker(1.0) - { Entity::signalRegistration( INPUT_SIGNALS << OUTPUT_SIGNALS );