A Manipulator Pose Planning Algorithm Based on Matrix Information Geometry

Figure 7

Pose at each detected point.