Now a kinematic closure constraint will be imposed. Fix the point in the body frame of at in . This yields the constraints

and

by substituting and into (4.60) and (4.61). This yields the variety

which is a subset of . The polynomials are slightly modified because each constraint must be written in the form .

Although (4.64) represents the constrained configuration space for the chain of two links, it is not very explicit. Without an explicit characterization (i.e., a parameterization), it complicates motion planning. From Figure 4.22 it can be seen that there are only two solutions. These occur for , and , . In terms of the polynomial variables, , the two solutions are and . These may be substituted into each polynomial in (4.64) to verify that 0 is obtained. Thus, the variety represents two points in . This can also be interpreted as two points on the torus, .

It might not be surprising that the set of solutions has dimension zero because there are four independent constraints, shown in (4.64), and four variables. Depending on the choices, the variety may be empty. For example, it is physically impossible to bring the point to .

Steven M LaValle 2012-04-20