Use AngularVelocitys like in RidgidBodyState defined in MasIMU