一种机器臂的定位方法
【技术领域】
[0001] 本发明设及机器人控制技术领域，尤其是一种机器臂的定位方法。
【背景技术】
[0002] 多自由度的机器臂的定位控制是多自由度机器臂的一大难点，若对机器臂末端的 定位误差不进行修正，则会在多次移动过程中产生误差累积，最终致使机器臂无法正常工 作。现有技术中对于多自由度机器臂的定位一般是通过独立的终端测量装置，对于机器臂 的末端位置进行测量，从而达到机器臂末端位置误差修正的目的。例如中国发明专利CN 102121827B公开了一种移动机器人定位系统及其定位方法，使用超声激光和航位推测定位 系统对机器人进行独立的定位和位置修正；除此之外，还有实用GPS、巧螺仪、全息图像等 多种不同的方式进行定位和位置修正的方法。不过，运类现有技术的方法都是直接对需要 定位的终端进行直接测量，并根据测量结果进行误差修正，由于多自由度机器臂的活动关 节为串联设置，所W针对终端测量结果对多个自由度的机器臂进行误差修正时，会由于每 个活动关节相互串联影响，造成修正时间过长。
【发明内容】
[0003] 本发明要解决的技术问题是提供一种器臂的定位方法，能够解决现有技术的不 足，改变了现有技术的修正方法，提高了多自由度的机器臂误差修正的速度。
[0004] 为解决上述技术问题，本发明所采取的技术方案如下。
[0005] 一种机器臂的定位方法，步骤如下：
[0006] A、在机器臂已有的设置在活动关节上的编码器的基础上，在机器臂的每个活动关 节设置一个独立的角度检测装置，对机器臂每个活动关节的角度进行测量；
[0007] B、控制终端使用编码器采集到的活动关节的转动角度对机器臂的运动轨迹进行 控制；
[0008] C、通过角度检测装置对机器臂上每个活动关节实际位置的测量，得出活动关节的 实际角度与目标角度的误差；
[0009] D、设定每个活动关节的角度误差与机器臂末端位置的第一关联因数和每个活动 关节与其下游活动关节的第二关联因数，然后使用第一关联因数和第二关联因数对每一个 活动关节进行角度调整；
[0010] 其中，下游活动关节的定义为：目标活动关节与机器臂末端之间与目标活动关节 直接连接的活动关节，称为目标活动关节的下游活动关节。
[0011] 作为本发明的一种优选技术方案，步骤D中，调整顺序为由机器臂与底座连接的 第一个活动关节开始依次向机器臂的末端方向调整。
[0012] 作为本发明的一种优选技术方案，步骤D中，对于第一关联因数和第二关联因数 的使用方法为，使用目标活动关节的第一关联因数确定目标活动关节与机器臂末端之间的 第一正向系数，使用目标活动关节的第二关联因数确定目标活动关节与其下游活动关节的 第一中间正向系数，然后使用下游活动关节与机器臂末端之间的第一关联因数确定下游活 动关节与机器臂末端之间的第二中间正向系数，最后使用第一中间正向系数和第二中间正 向系数得到目标活动关节与机器臂末端之间的第二正向系数，通过第一正向系数和第二正 向系数的加权数据融合结构确定目标活动关节的调整角度。
[0013] 采用上述技术方案所带来的有益效果在于：本发明通过对多自由度机器臂上每个 活动关节的单独测量，针对每个活动关节触点误差进行依次修正；修正过程中，根据每个活 动关节相互关联系数的大小，对活动关节调整的幅度进行针对性地改变，从而实现减少活 动关节调整幅度，减少同一活动关节往复调整的次数，缩短了整个机器臂的调整时长。
【附图说明】
[0014] 图1是本发明中确定第一关联因数和第二关联因数的原理图。
[0015] 图2是本发明中反向修正过程中确定修正系数的原理图。
【具体实施方式】
[0016] 一种机器臂的定位方法，步骤如下：
[0017] A、在机器臂已有的设置在活动关节上的编码器的基础上，在机器臂的每个活动关 节设置一个独立的角度检测装置，对机器臂每个活动关节的角度进行测量；
[0018] B、控制终端使用编码器采集到的活动关节的转动角度对机器臂的运动轨迹进行 控制；
[0019] C、通过角度检测装置对机器臂上每个活动关节实际位置的测量，得出活动关节的 实际角度与目标角度的误差；
[0020] D、设定每个活动关节的角度误差与机器臂末端位置的第一关联因数和每个活动 关节与其下游活动关节的第二关联因数，然后使用第一关联因数和第二关联因数对每一个 活动关节进行角度调整；
[0021] 其中，下游活动关节的定义为：目标活动关节与机器臂末端之间与目标活动关节 直接连接的活动关节，称为目标活动关节的下游活动关节。
[0022] 值得注意的是，步骤D中，调整顺序为由机器臂与底座连接的第一个活动关节开 始依次向机器臂的末端方向调整。
[0023] 此外，步骤D中，对于第一关联因数和第二关联因数的使用方法为，使用目标活动 关节的第一关联因数确定目标活动关节与机器臂末端之间的第一正向系数，使用目标活动 关节的第二关联因数确定目标活动关节与其下游活动关节的第一中间正向系数，然后使用 下游活动关节与机器臂末端之间的第一关联因数确定下游活动关节与机器臂末端之间的 第二中间正向系数，最后使用第一中间正向系数和第二中间正向系数得到目标活动关节与 机器臂末端之间的第二正向系数，通过第一正向系数和第二正向系数的加权数据融合结构 确定目标活动关节的调整角度。
[0024] 其中，角度检测装置优选为光栅。第一关联因数为Sinai,第二关联系数为 Sin a 2, a 1为目标活动关节和机器臂末端的连线与目标活动关节和下游活动关节之间连接 臂的夹角，a 2为下游活动关节两侧的两个活动关节的连线与目标活动关节和下游活动关 节之间连接臂的夹角。 阳O巧]第一正向系数：
[0027] 第一中间正向系数：
[0029] 第二中间正向系数：
阳0川第二正向系数：
[0033] 角度误差调整比例：
阳0对其中，Xi、X2、X3为目标活动关节的S维位置误差，y I、y2、y3为下游活动关节的；维 位置误差，Li为目标活动关节与机器臂末端连线的长度，Lz为目标活动关节与下游活动关 节之间连接臂的长度。
[0036] 在进行完上述调整后，机器臂的末端达到目标位置，但是其中的各个活动关节还 存在一定的位置误差，运时从距离机器臂末端最近的活动关节开始，进行反向修正，修正过 程中始终保持每一段连接臂靠近机器臂的一端位置不变，单独对另一端的位置进行修正。 运一修正过程不会影响机器臂末端的位置，可在机器臂静止时进行，所W不影响整个机器 臂的修正时间。修正过程中，修正系数为：
[0037] A 2= L COS 曰 3，
[003引其中，L为修正端点靠近机器臂末端一侧的连接臂的长度，a 3为修正端点处两个 连接臂的夹角。
[0039] 下表为6自由度机器臂使用本发明技术方案和使用现有技术的技术方案进行定 位修正的调整时间：
[0040]
[0041] 而且，经过实验发现，自由度越多的机器臂，使用本发明的技术方案时，调整时间 减少的效果越明显。
[0042] 上述描述仅作为本发明可实施的技术方案提出，不作为对其技术方案本身的单一 限制条件。
【主权项】
1. 一种机器臂的定位方法，其特征在于步骤如下： A、 在机器臂已有的设置在活动关节上的编码器的基础上，在机器臂的每个活动关节设 置一个独立的角度检测装置，对机器臂每个活动关节的角度进行测量； B、 控制终端使用编码器采集到的活动关节的转动角度对机器臂的运动轨迹进行控 制； C、 通过角度检测装置对机器臂上每个活动关节实际位置的测量，得出活动关节的实际 角度与目标角度的误差； D、 设定每个活动关节的角度误差与机器臂末端位置的第一关联因数和每个活动关节 与其下游活动关节的第二关联因数，然后使用第一关联因数和第二关联因数对每一个活动 关节进行角度调整； 其中，下游活动关节的定义为：目标活动关节与机器臂末端之间与目标活动关节直接 连接的活动关节，称为目标活动关节的下游活动关节。2. 根据权利要求1所述的机器臂的定位方法，其特征在于：步骤D中，调整顺序为由机 器臂与底座连接的第一个活动关节开始依次向机器臂的末端方向调整。3. 根据权利要求2所述的机器臂的定位方法，其特征在于：步骤D中。
【专利摘要】本发明公开了一种机器臂的定位方法，通过设定第一关联因数和第二关联因数，对各个活动关节的角度进行依次修正。本发明能够解决现有技术的不足，改变了现有技术的修正方法，提高了多自由度的机器臂误差修正的速度。
【IPC分类】B25J13/08
【公开号】CN105643642
【申请号】
【发明人】宋明安, 王小龙, 孙洁, 同彦恒, 李志博, 麻辉
【申请人】宁夏巨能机器人系统有限公司
【公开日】2016年6月8日
【申请日】2014年12月2日