用于六自由度的工业机器人的逆运动学求解方法

摘要

本发明提出了一种用于六自由度的工业机器人的逆运动学求解方法，包括：建立连杆坐标系，其中，所述连杆坐标系包括：X‑Z轴平面，所述工业机器人的六个关节对应坐标系和所述工业机器人末端执行器的坐标系；在所述连杆坐标系基础上，根据所述工业机器人的六个关节之间的结构几何参数计算欧拉角变换矩阵；利用所述欧拉叫变换矩阵，按照预设顺序依次求解所述工业机器人的六个关节的旋转轴转动角度；根据所述六个关节的旋转轴转动角度对应的八个求解结果，解离上一关节空间所处位置对应的各个关节旋转轴角度差值范数总和，依据范数综合最小原则选择最优解。本发明具有求解精度高、求解速度快、求解过程更加简单易懂，计算量小的特点。