Added Kalman Filter for the tilt angle