Fix position/velocity/angular velocity indexes
Fix rolling constant & rotation parameters