A Manipulator Pose Planning Algorithm Based on Matrix Information Geometry

Figure 5

Algorithm for the pose matrix at each detected point.