encoder-IMU Encoder rotational speed calculated with timer 50ms sampling IMU IMU connection ok IMU registers write and read from sensor IMU acceleration data received, not processed so far, axis should be identified for use