Add GripperTorqueContraint to limit torque applied on the gripper.
Add constraint matrix accessor.