The effectiveness of program was testified by living calculation examples on the two DOF robot and PUMA560 robot.

• 对于两自由度机器人和PUMA560机器人的计算实例证明了程序的有效性。