Constraints

Five constraints are used to define the robot model.  The first two constraints represent the two joints of the robot, and eliminate 9 of the total 12 degrees of freedom.  The OrthoRevolute4 constraint simply models a pair of revolute joints with intersecting orthogonal axes.

The last three constraints specify the three joint angles to position the robot arm.

SetConstraints incorporates the constraints into the model.