Improves kalman filter for orientation, gives excellent results