Use the ConstraintSampler to get a goal joint state isntead of just looking at joint constraints.