A Manipulator Pose Planning Algorithm Based on Matrix Information Geometry

Figure 6

Flowchart of Algorithm 1.