一种可穿越腕部奇异点的机器人路径规划方法
本发明公开了一种可穿越腕部奇异点的机器人路径规划方法, 包括以下步骤:操作拖拽示教机器人的末端完成一次完整的作业,采 集路径点进行工业机器人的坐标转换和运动学反解,当所述工业机器 人当前位姿对应的关节变量值处于腕部奇异区域边界,且原始目标位 姿对应的关节变量值在腕关节奇异区域以内时,将机器人 5,6 轴进行 固连,分别根据第三连杆坐标系相对于基坐标系的连杆变换矩阵和工具坐标系相对于连杆坐标系以及工具坐标系相对于基坐标系的连杆变 换矩阵之积,计算第三连杆坐标系相对于基坐标系的位置矢量,并据 此建立方程
华中科技大学
2021-04-14