一种六自由度串联机器人运动学反解的求解方法

其它领域

本发明公开了一种六自由度串联机器人运动学反解的求解方法， 该方法包括:读入连杆参数建立机器人连杆坐标系模型;已知连杆末 端关节位置，建立关节位置约束方程;根据各关节位置约束方程，确 定各关节位置;建立机器人各关节坐标系的姿态约束方程;将之前求 得的关节位置坐标解分别代入姿态约束方程中，根据姿态约束方程， 求解各组关节变量中间值;对关节变量中间值进行分析处理，选取最 佳关节变量解。本发明采用空间几何理论将机器人运动学反解中位置 和姿态进行分离求解，大大降低了几何法运动学反解运算的复杂性， 并能够应用于

产业化应用