Working state with imu data sent from the MCU into the statemachine
Filter framework restructuring