Start to work on a new constraint type, RailGraspWrenchConstraint