用于机器人在线手眼标定的自适应运动选择方法技术

一种用于机器人在线手眼标定的自适应运动选择方法，充分利用在线标定时采样到的手眼运动数据序列所反映出来的运动特点，自适应的确定阈值。首先利用机器人手爪前五次运动得到的参数计算用于运动选择的三个阈值的初值，然后，基于运动选择来进行在线手眼标定。每次标定后计算旋转误差和平移误差，根据误差自适应的改变三个阈值。然后再利用新的阈值重新进行运动选择以及手眼标定。循环往复，可连续不断地进行机器人的在线手眼标定操作。本能够根据不同的应用情况，自动计算出用于运动选择的阈值，增加了在线标定的次数，提高机器人手眼标定精度。

【技术实现步骤摘要】
用于机器人在线手眼标定的自适应运动选择方法
本专利技术涉及一种用于机器人在线手眼标定的自适应运动选择方法，可广泛应用于机器人三维视觉测量、视觉伺服和触觉感知等方面。属于先进制造与自动化领域。
技术介绍
机器人手眼标定是机器视觉中一个基本问题。手眼标定的精确性部分决定了机器视觉应用于机器人时的精度。机器人手眼标定就是测量固定在机器人手臂的末端执行器(机器人手爪)上的相机和机器人手爪之间的相对位置和方向关系。以前此类问题的大部分求解方法都是通过迭代优化算法解齐次变换方程AX＝XB(Y.C.Shiu and S.Ahmad，″Calibration of wrist-mounted robotic sensors bysolving homogeneous transform equations of the form AX＝XB，″IEEE Trans.Robot.Automat.，vol.5，pp.16-29，Feb.1989.)，这里A代表机器人手爪的运动，B代表相应的摄像机运动，X为所要标定的摄像机和机器人手爪之间的空间变换关系。由于迭代优化计算过程是非实时的，所以这种情况下手眼标定只能脱机进行。后来Angeles等(J.Angeles，G.Soucy and F.P.Ferrie，“The online solution of thehand-eye problem”，IEEE Trans.Robot. Automat.，vol.16，pp.720-731，Dec.2000.)和Andreff等(N.Andreff，R.Horaud，and B.Espiau，“Robot hand-eye calibrationusing structure-from-motion”，Int.J.Robot.Res.，20(3)：228-248，2001.)几乎同时提出了手眼标定的在线实现技术，克服了传统方法不能进行实时标定的缺点。无论采用何种方法进行手眼标定，手眼关系的计算都要求机器人至少独立运动两次，而且两次运动的旋转轴不得平行。因此，当采集到的手眼运动数据存在退化情况时，如纯旋转或纯平移等，就无法得到手眼变换关系的精确解。但是当我们在进行在线手眼标定的时候，由于机器人的运动是由具体应用确定的而并非为手眼标定而设计，所以此时采集到的用于手眼标定的运动数据就很有-->可能存在退化情形。另外，采样运动中旋转角很小或者平移比较大，或者两次运动的旋转轴之间的夹角很小时，都会使最后的标定结果产生比较大的误差。为了避免这种情况，中国专利技术专利“基于运动选择的机器人在线手眼标定方法”(申请号：200510025252.0)提出了通过运动选择的途径来改善提高机器人在线手眼标定。此种方法先根据经验设定运动选择的三个阈值，即机器人手爪前后两次运动的旋转轴之间夹角的最小阈值α、机器人手爪每次运动的旋转角的最小阈值β和机器人手爪每次运动的平移分量的模的最大阈值d。根据阈值从第一次手眼采样运动开始，依次选择出两个符合要求的手眼运动对来计算手眼变换关系。使用这一方法，大大提高了在线手眼标定的精确性。但是该法的不足之处在于：根据经验设定α，β和d的值，没有考虑到运动序列自身的特点，不具有适应各种情况的鲁棒性，而且阈值一旦设定就不再更改，如果设定的不合适，则可能使得标定次数过少。
技术实现思路
本专利技术的目的在于针对现有技术的不足，提供一种用于机器人在线手眼标定的自适应运动选择方法，能够根据不同的应用情况，自动计算出用于运动选择的阈值，增加了在线标定的次数，提高机器人手眼标定精度。本专利技术的技术方案：充分利用在线标定时采样到的手眼运动数据序列所反映出来的运动特点，自适应的确定阈值。首先利用机器人手爪前五次运动得到的参数计算用于运动选择的三个阈值的初值，然后，基于运动选择来进行在线手眼标定。每次标定后计算旋转误差和平移误差，根据误差自适应的改变三个阈值。然后再利用新的阈值重新进行运动选择以及手眼标定。循环往复，可连续不断地进行机器人的在线手眼标定操作。本专利技术的自适应在线手眼标定方法具体包括以下几个步骤：1.利用机器人手爪前五次运动中每两次运动的旋转轴之间夹角的正弦值、每次运动的旋转角和每次运动的平移分量的模的平均值设定运动选择的三个阈值：α正弦值、β和d；2.根据运动选择算法搜索选择一个满足β和d阈值条件的手眼运动对。若运动-->选择连续进行了5次，还是不能满足阈值，则减小β，增大d，然后利用新的阈值继续寻找。如此循环往复，直至找到符合条件的手眼运动对作为第一个手眼运动对(A′，B′)；3.根据运动选择算法搜索选择一个满足α正弦值、β和d阈值条件的手眼运动对。若运动选择连续进行了5次，还是不能满足阈值，则减小α正弦值和β，增大d，然后利用新的阈值继续寻找。如此循环往复，直至找到符合条件的第二个手眼运动对(A″，B″)；4.利用两个手眼运动对(A′，B′)和(A″，B″)，用Andreff手眼标定线性方程计算手眼变换关系矩阵X，得到一次手眼标定结果；5.计算手眼变换关系矩阵X的旋转和平移分量的均方根误差，记录标定次数。若标定次数小于5次，则改变阈值，增大α正弦值和β，减小d，将上次用于标定的第二个手眼运动对(A″，B″)作为新的第一个手眼运动对(A′，B′)，利用改变后的阈值，采用步骤3的方法从后续采样数据中继续搜索选择新的第二个手眼运动对(A″，B″)，采用步骤4的方法进行新的手眼标定，直到标定次数大于等于5次；6.利用本次标定之前得到的五组手眼变换关系矩阵X的旋转和平移的均方根误差以及五组阈值，利用三次多项式回归来预测新的阈值。将上次用于标定的第二个手眼运动对(A″，B″)作为新的第一个手眼运动对(A′，B′)，再利用新阈值，采用步骤3的方法从后续采样数据中继续搜索选择新的第二个手眼运动对(A″，B″)，采用步骤4的方法进行新的手眼标定，重复本步骤，进行在线标定。实际应用时，可根据自适应设定的三个阈值，由软件自动进行运动选择和手眼标定计算。本专利技术提出的运动选择方法，可以根据运动序列自身的运动性质来自适应的设定运动选择的三个阈值，增加了利用运动选择进行在线手眼标定的标定次数，同时提高了标定精度。本专利技术提出的自适应运动选择方法，可广泛应用于机器人三维视觉测量、视觉伺服和触觉感知等方面，具有相当的实用价值。-->附图说明图1为本专利技术的机器人手眼标定模型示意图。图2为本专利技术的用于在线手眼标定的运动选择算法示意图。具体实施方式为了更好地讲解本专利技术的技术方案，以下结合附图和实施例作进一步的详细描述。1.利用机器人手爪前五次运动中每两次运动的旋转轴之间夹角的正弦值、每次运动的旋转角和每次运动的平移分量的模的平均值设定运动选择的三个阈值：sin(α)，β，d。设第i(i为自然数)次采样到的摄像机和手爪姿态的齐次矩阵分别为Pi、Qi，X为所需要求解的手眼变换关系齐次矩阵。(sin(α),β,d)=15(Σn=15sin(α)n,Σn=15βn,Σn=15dn)]]>2.根据运动选择算法搜索选择一个满足β和d阈值条件的手眼运动对(A′，B′)。首先令start＝6，从第六次和第七本文档来自技高网...

【技术保护点】
一种用于机器人在线手眼标定的自适应运动选择方法，其特征在于包括如下具体步骤：１）利用机器人手爪前五次运动中每两次运动的旋转轴之间夹角的正弦值、每次运动的旋转角和每次运动的平移分量的模的平均值设定运动选择的三个阈值：α正弦值、β和ｄ； ２）根据运动选择算法搜索选择一个满足β和ｄ阈值条件的手眼运动对，若运动选择连续进行了５次，还是不能满足阈值，则减小β，增大ｄ，然后利用新的阈值继续寻找，如此循环往复，直至找到符合条件的手眼运动对作为第一个手眼运动对（Ａ′，Ｂ′）；　 　３）根据运动选择算法搜索选择一个满足α正弦值、β和ｄ阈值条件的手眼运动对，若运动选择连续进行了５次，还是不能满足阈值，则减小α正弦值和β，增大ｄ，然后利用新的阈值继续寻找，如此循环往复，直至找到符合条件的第二个手眼运动对（Ａ″，Ｂ″） ；４）利用两个手眼运动对（Ａ′，Ｂ′）和（Ａ″，Ｂ″），用Ａｎｄｒｅｆｆ手眼标定线性方程计算手眼变换关系矩阵Ｘ，得到一次手眼标定结果；５）计算手眼变换关系矩阵Ｘ的旋转和平移分量的均方根误差，记录标定次数，若标定次数小于５次， 则改变阈值，增大α正弦值和β，减小ｄ，将上次用于标定的第二个手眼运动对（Ａ″，Ｂ″）作为新的第一个手眼运动对（Ａ′，Ｂ′），利用改变后的阈值，采用步骤３）的方法从后续采样数据中继续搜索选择新的第二个手眼运动对（Ａ″，Ｂ″），采用步骤４）的方法进行新的手眼标定，直到标定次数大于等于５次；６）利用本次标定之前得到的五组手眼变换关系矩阵Ｘ的旋转和平移的均方根误差以及五组阈值，利用三次多项式回归来预测新的阈值，将上次用于标定的第二个手眼运动对（Ａ″，Ｂ″）作为新的第一个手眼运 动对（Ａ′，Ｂ′），利用新阈值，采用步骤３）的方法从后续采样数据中继续搜索选择新的第二个手眼运动对（Ａ″，Ｂ″），采用步骤４）的方法进行新的手眼标定，重复本步骤，进行在线标定。...

【技术特征摘要】
1、一种用于机器人在线手眼标定的自适应运动选择方法，其特征在于包括如下具体步骤：1)利用机器人手爪前五次运动中每两次运动的旋转轴之间夹角的正弦值、每次运动的旋转角和每次运动的平移分量的模的平均值设定运动选择的三个阈值：α正弦值、β和d；2)根据运动选择算法搜索选择一个满足β和d阈值条件的手眼运动对，若运动选择连续进行了5次，还是不能满足阈值，则减小β，增大d，然后利用新的阈值继续寻找，如此循环往复，直至找到符合条件的手眼运动对作为第一个手眼运动对(A′，B′)；3)根据运动选择算法搜索选择一个满足α正弦值、β和d阈值条件的手眼运动对，若运动选择连续进行了5次，还是不能满足阈值，则减小α正弦值和β，增大d，然后利用新的阈值继续寻找，如此循环往复，直至找到符合条件的第二个手眼运动对(A″，B″)；4)利用两个手眼运动对(A′，B′)和(A″，B″)，用Andreff手眼标定线性方...

【专利技术属性】
技术研发人员：张婧，石繁槐，王建华，刘允才，
申请(专利权)人：上海交通大学，
类型：发明
国别省市：31[中国|上海]