Clamping of Low Speeds to 0
Changes in Measurement function
EKF Attitude

with Roll and Pitch Estimation