Add kinematics constraints