[发明专利]机械手臂反向运动方法

说明书

技术领域

本发明涉及一种机械手臂运动方法，尤其涉及一种机械手臂反向运动方法。

背景技术

对于改善生产力及品质而言，机械手臂的精密运动控制是非常重要的。机械手臂在工业上的应用已经非常广泛，例如测量机台的量测手臂，机器人手臂等。然而在研究这些机械手臂的运动中常常运用到反向动力学技术，即已知机械手臂需要到达的空间坐标点，使得该机械手臂到达该目标位置，然而实际情况下，并不能够正好到达该目标位置，只能达到距离目标点最近的位置，即最优位置，这就需要计算该最优位置的坐标值，目前，最常用的方法是枚举出所有可能的方程式进行解析方程，当机械手臂的关节很多的时候，这些方程的计算量会变得很大，导致计算变得很慢，计算结果也不是最优结果。

发明内容

鉴于以上内容，有必要提供一种机械手臂反向运动方法，可以使得机械手臂快速到达最优的位置。

一种机械手臂反向运动方法，该方法包括a)输入机械手臂初始位置的参数值和目标位置参数值，所述机械手臂的初始位置参数值包括初始位置上每个关节的根节点和末节点的坐标值，所述目标位置参数值包括目标位置上每个关节的末节点的坐标值；b)根据输入的初始位置参数值和目标位置参数值，利用迭代法计算每次迭代后每个关节的末节点所到达的位置；c)根据上述计算的每次迭代中每个关节的末节点所到达的位置，计算每次迭代中每个关节的末节点所到达的位置与目标位置之间的距离，并得到其中最小距离的每个关节的位置及对应该位置的每个关节末节点的坐标值；及d)每个关节上的马达驱动该关节移动到达上述与目标位置距离最小的位置。

相较于现有技术，所述机械手臂反向运动方法，利用拟牛顿迭代来计算机械手臂的最优位置，使得机械手臂快速到达该位置。

附图说明

图1是本发明机械手臂反向运动方法的较佳实施例的硬件架构图。

图2是机械手臂运动的平面示意图。

图3是本发明机械手臂反向运动方法较佳实施例的作业流程图。

图4是图3中步骤S31和步骤S32的细化流程图。

具体实施方式

如图1所示，是本发明机械手臂反向运动方法的较佳实施例的硬件架构图。该硬件架构图包括主机1，该主机1连接机械手臂2，本实施例中，该机械手臂2包括多个关节。如图2所示，假设该机械手臂2的关节数目为n，每个关节包括一个根节点和一个末节点，当关节移动时，该关节的根节点的位置不变，该末节点内装有一个马达3，所述主机1发送运动指令给所述马达3，该马达3驱使该末节点带动机械手臂2运动。从该机械手臂2连接主机1的一端开始命名该机械手臂2的关节为第n关节，分别为：第一关节，第二关节等。本图中第一关节的根节点为A，第一关节的末节点为B。第二关节的根节点为B，第二关节的末节点为C。所述主机1包括一个量测单元100，该量测单元100用于测量所述机械手臂2初始位置每个关节的根节点和末节点的坐标值。

如图3所示，是本发明机械手臂反向运动方法较佳实施例的流程图。本实施例中，以图2中所示的机械手臂2为例进行说明本发明。

步骤S30，输入量测单元100所测量的机械手臂2初始位置的参数值、目标位置的参数值及用户设置的精度值FunX。所述机械手臂2的初始位置参数值包括每个关节的根节点和末节点的坐标值。所述机械手臂2目标位置的参数值包括每个关节的末节点的位置坐标值。本实施例中，第一关节根节点A的初始位置坐标值(X_A，Y_A，Z_A)，第一关节的末节点B初始位置坐标值为(X1_B，Y1_B，Z1_B)，该第一关节末节点的目标位置坐标值为(X2_B，Y2_B，Z2_B)。所述精度值FunX是指所述机械手臂2所要到达目标位置的到达程度。

步骤S31，根据输入的机械手臂2的初始位置参数值和目标位置参数值，利用迭代法计算每次迭代后每个关节的末节点所到达的位置。

步骤S32，根据上述计算的每次迭代中每个关节的末节点所到达的位置，计算每次迭代中每个关节的末节点所到达位置与目标位置之间的距离，并得到其中最小距离的每个关节所到达的位置及对应该位置的每个关节的末节点的坐标值。(具体步骤将在图4中详细描述)

步骤S33，每个关节上的马达3驱动该关节移动到步骤S32得到的与目标位置距离最小的位置，从而使得该机械手臂2的每个关节以最快速度到达最优位置。