Update MotionConstr to only manage one robot.
That allow to manage multiple robot with different motion constraint.