摘要

建立了六自由度工业机器人的D-H连杆坐标系,由此采用正运动学算法求解出以末端位置矢量和欧拉角表示的末端位姿,采用代数解析法对机器人逆运动学进行求解,并对多解问题用综合优选算法进行筛选从而得到最优解。运用Microsoft Visual C#2015的WPF内置3D渲染建模引擎构建六自由度工业机器人矢量旋转矩阵,采用C#编程语言设计运动控制逻辑。通过生产现场验证了正、逆解及综合优选算法的正确性,并且实现了机器人实时数字3D运动位姿和实际末端位姿保持一致。