IMU data reading with Kalman Filter

Allows reading of the IMU data with a Kalman Filter