Added initial tilt compensated euler calculation and almost finished predictor state of Kalman