一种解耦型六自由度工业机器人的运动控制方法

摘要

本发明公开了一种解耦型六自由度工业机器人的运动控制方法，该方法包括：（a）根据机器人所需实现的位姿，通过D-H模型法获得末端执行机构相对于基坐标系的位姿矩阵；（b）将机器人避开奇异形位时所能实现的正常位姿定义为不同的关节特性属性，并设定机器人实现所需的位姿时的关节特征属性组合；（c）根据位姿矩阵以及设定的关节特征属性组合及其取值条件，通过反变换法分别求得关于机器人各个关节变量的唯一解；（d）根据所求得的解，执行对六自由度工业机器人的关节运动，相应完成整体运动控制过程。通过本发明，具备可预知过奇异点路径、算法简单、反解速度快以及能较好地确定唯一解等优点，并能很好地应用于实际的工业机器人运动控制。