check_constraints function

Check the constraint matrix has the correct form