偏置腕6R工业机械手笛卡尔轨迹跟踪逆运动学算法
摘要:
本发明提供一种偏置腕6R工业机械手笛卡尔轨迹跟踪逆运动学算法。包括以下步骤:S1、首先,采用改进的断开和重新连接方法,得到了仅包含θ6的非线性方程组和其他关节变量的解析公式;S2、接下来,使用奇异轨迹将前三个关节的关节空间划分为四个唯一区域,建立它们与逆运动学公式中正负号之间的关系;S3、然后,结合黄金分割法和对分法设计一种求解一维非线性方程根的算法;S4、最后,进行数值验证。结果表明,该算法的平均求解时间约为13.7μs,平均位姿误差范数约为1.58×10‑12mm,本发明可以保证实时、高精度的笛卡尔轨迹跟踪。
0/0