基于红外立体视觉定位系统和机械臂的手眼标定方法技术方案

本发明专利技术提供了一种基于红外立体视觉定位系统和机械臂的手眼标定方法，包括如下步骤：步骤1：构建机械臂末端法兰盘坐标系{TCP}和机械臂坐标系{Base}的变换关系

【技术实现步骤摘要】
基于红外立体视觉定位系统和机械臂的手眼标定方法
本专利技术涉及机器人技术和光学传感器技术，具体地涉及基于红外立体视觉定位系统和机械臂的手眼标定方法。
技术介绍
当今社会随着科学技术的发展，机器人技术和光学传感器技术在很多领域都有广泛的应用，特别是精准医疗领域。为了能利用机械臂帮助医生完成一些需要精准定位的手术，需要将机械臂所在的坐标系和病人所在的三维空间坐标系进行配准。这配准的基础是建立机械臂末端(如法兰盘，抓手等)和光学传感器设备(如相机、3D结构光定位器、激光测距仪等)之间的坐标系变换关系，求解这个变换关系的问题称为机器人的手眼标定问题。对机械臂的手眼标定问题，已经有不少学者提出相应的解决办法，Zhuang将机械臂和传感器一起建模，用于机械臂运动学参数校正，Tsai将手眼标定分为旋转和平移两个部分分别求解，Ma采用相互正交的纯平移来线性化手眼矩阵的旋转部分，对旋转部分的求解需要三次有解的平移运动，Malm采用光流场的法向导数方法，Shiu等人将手眼标定问题归结为求解AX＝XB的问题。传统的解决方法大多是结合激光测距仪和机械臂的手眼标定方法，这些方法着眼于以机械臂为机械变姿运动执行装置，以机械臂自身和激光传感器为测量装置，机械臂变姿带动激光传感器对若干空间固定点进行测量，分别记录机械臂的姿态和该空间点在机器人坐标系和激光传感器测量坐标系内的坐标值，通过一定算法求解传感器测量坐标系与机器人末端执行器坐标系之间的变换关系。相比于激光测距仪，由外部标记物和结构光传感器组成的红外立体视觉定位系统应用场景更丰富，应用起来更方便实用，精度也更高，多目标同时定位使得应用的手术场景更多。然而目前并没有解决方案能很好的解决由外部标记物和结构光传感器组成的红外立体视觉定位系统的机械臂手眼标定的问题，本专利技术弥补了这方面的空白。
技术实现思路
针对现有技术中的缺陷，本专利技术的目的是提供一种基于红外立体视觉定位系统和机械臂的手眼标定方法。根据本专利技术提供的一种基于红外立体视觉定位系统和机械臂的手眼标定方法，利用红外立体视觉定位系统和机械臂进行手眼标定，其中，所述红外立体视觉定位系统包括外部标记物、红外传感器；外部标记物紧固安装在机械臂末端的法兰盘上。优选地，所述外部标记物表面涂有反光材料，所述红外传感器内部集成有红外光发射接收装置、传感器。优选地，所述机械臂包括控制器、示教器，控制器用于控制机械臂的机械变姿运动的执行。根据本专利技术提供的一种基于红外立体视觉定位系统和机械臂的手眼标定方法，记机械臂坐标系、机械臂末端法兰盘坐标系、外部标记物的局部坐标系、红外立体视觉定位系统坐标系分别为{Base}、{TCP}、{DRF}、{Tracker}，包括如下步骤：步骤1：构建机械臂末端法兰盘坐标系{TCP}和机械臂坐标系{Base}的变换关系步骤2：构建机械臂末端法兰盘坐标系{TCP}与外部标记物的局部坐标系{DRF}的变换关系步骤3：构建机械臂末端法兰盘坐标系{TCP}和红外立体视觉定位系统坐标系{Tracker}的变换关系步骤4：利用和通过绝对定向方法求得机械臂坐标系{Base}相对于红外立体视觉定位系统坐标系{Tracker}的变换矩阵即实现基于红外立体视觉定位系统和机械臂的手眼标定；其中，步骤1、步骤2、步骤3、步骤4依次执行，或者步骤2、步骤1、步骤3、步骤4依次执行。优选地，所述步骤1具体为：以机械臂基座的几何中心为原点OBase，以机械臂正面前向为X轴正向，正面左向为Y轴正向，正面垂直向上方向为Z轴正向构建{Base}坐标系；以机械臂末端的法兰盘几何中心点OTCP为原点构建{TCP}坐标系；OTCP在{Base}坐标系中的位置描述为[X，Y，Z]，机械臂末端法兰盘坐标系{TCP}和机械臂坐标系{Base}的变换关系用[X，Y，Z]来描述。优选地，{TCP}坐标系的轴向的变化即机械臂末端的法兰盘朝向的变换描述为旋转矢量(Rx，Ry，Rz)，所述步骤2包括如下步骤：步骤2.1：控制机械臂以法兰盘几何中心点为原点进行绕轴旋转运动，即以法兰盘中心OTCP为原点绕机械臂垂直轴向做绕轴旋转运动在{Base}坐标系下可以描述为{TCP}坐标系的原点OTCP不动，标记物绕过OTCP点的平行于{Base}坐标系的Z轴的Z′轴做圆锥状的运动；将机械臂绕轴旋转运动简化成做离散点的绕轴旋转运动，即离散点连起来组成一组绕轴旋转运动，但是每个离散点之间的运动并不要求是绕轴旋转运动；绕轴旋转运动用欧拉角(θz，θy，θx)来描述，具体欧拉角表示拆解为绕过OTCP点的平行于{Base}坐标系X轴的X′轴的横滚变换θx(R0ll)和绕过OTCP点的平行于{Base}坐标系Y轴的Y′轴的俯仰变换θy(Pitch)的以及绕过OTCP点的平行于{Base}坐标系Z轴的Z′轴的首摇变换θz(Yaw)组合，具体表达式如下：θx(Roll)＝sin(i*θ1)*θ2θy(Pitch)＝cos(i*θ1)*θ2θz(Yaw)＝0其中，θ1表示每次转动的角度，i表示离散点的序号，i的取值范围为θ2表示与Z′轴的夹角；步骤2.2：通过罗德里格斯变换，将欧拉角(θz，θy，θx)转换成旋转矢量(Rx，Ry，Rz)发送给机械臂控制器，控制机械臂移动到指定的离散点，红外立体视觉定位系统记录离散点的坐标数据；步骤2.3：控制机械臂末端法兰盘绕固定点，即法兰盘几何中心点OrCP的初始位置做旋转运动，采集一系列外部标记物动态参考系的刚体变换数据[Ri，ti]i＝1：m，即外部标记物的局部坐标系{DRF}的刚体变换数据，其中，Ri表示i时刻的旋转变换，ti表示i时刻的平移变换，i∈[1，m]，m表示收集的旋转运动离散点的数目；刚体变换数据[Ri，ti]i＝1：m，外部标记物的局部坐标系{DRF}原点到固定点的位移ｔDRF，红外立体视觉定位系统坐标系{Tracker}原点到固定点的位移ｔtracker三者之间的关系如下：RiｔDRF+ti＝Rjttracker+ｔj其中，Rj表示j时刻的旋转变换，ｔj表示j时刻的平移变换，j∈[1，m]，j≠i，tDRF通过下面的等式求出：红外立体视觉定位系统坐标系{Tracker}原点到固定点的位移ttracker计算式如下：ttracker＝mean(RiｔDRF+ti)其中，mean函数表示求平均数或者均值；步骤2.4：机械臂末端法兰盘坐标系{TCP}与外部标记物的局部坐标系{DRF}的变换关系求解方法如下所示：简写为其中，I表示3*3单位矩阵，ｔtracker[x]表示平移的具体变化，ｔtracker[0]表示X轴的变化，ｔtracker[1]表示Y轴的变化，ｔtracker[2]表示Z轴的变化。优选地，所述步骤3具体为：其中，由红外立体视觉定位系统得到。优选地，所述步骤4包括如下步骤：步骤4.1：通过随机数生成算法生成在机械臂坐标系{Base}下空间中红外立体视觉定位系统可测范围内的由[Xi，Yi，Zi]i＝1：n，(Rx，Ry，Rz)i＝1：n描述的n个随机点，发送给控制器控制机械臂依次移动法兰盘中心点OTCP到这n个点，然后从红外立体视觉定位系统中抓取出在该点处标记物在红外立体视觉定位系统的变换所以只取的位移部分步骤4.2：将机械臂坐标系{B本文档来自技高网...

【技术保护点】
1.一种基于红外立体视觉定位系统和机械臂的手眼标定方法，其特征在于，利用红外立体视觉定位系统和机械臂进行手眼标定，其中，所述红外立体视觉定位系统包括外部标记物、红外传感器；外部标记物紧固安装在机械臂末端的法兰盘上。

【技术特征摘要】
1.一种基于红外立体视觉定位系统和机械臂的手眼标定方法，其特征在于，利用红外立体视觉定位系统和机械臂进行手眼标定，其中，所述红外立体视觉定位系统包括外部标记物、红外传感器；外部标记物紧固安装在机械臂末端的法兰盘上。2.根据权利要求1所述的基于红外立体视觉定位系统和机械臂的手眼标定方法，其特征在于，所述外部标记物表面涂有反光材料，所述红外传感器内部集成有红外光发射接收装置、传感器。3.根据权利要求1所述的基于红外立体视觉定位系统和机械臂的手眼标定方法，其特征在于，所述机械臂包括控制器、示教器，控制器用于控制机械臂的机械变姿运动的执行。4.一种基于红外立体视觉定位系统和机械臂的手眼标定方法，记机械臂坐标系、机械臂末端法兰盘坐标系、外部标记物的局部坐标系、红外立体视觉定位系统坐标系分别为{Base}、{TCP}、{DRF}、{Tracker}，其特征在于，包括如下步骤：步骤1：构建机械臂末端法兰盘坐标系{TCP}和机械臂坐标系{Base}的变换关系步骤2：构建机械臂末端法兰盘坐标系{TCP}与外部标记物的局部坐标系{DRF}的变换关系步骤3：构建机械臂末端法兰盘坐标系{TCP}和红外立体视觉定位系统坐标系{Tracker}的变换关系步骤4：利用和通过绝对定向方法求得机械臂坐标系{Base}相对于红外立体视觉定位系统坐标系{Tracker}的变换矩阵即实现基于红外立体视觉定位系统和机械臂的手眼标定；其中，步骤1、步骤2、步骤3、步骤4依次执行，或者步骤2、步骤1、步骤3、步骤4依次执行。5.根据权利要求4所述的基于红外立体视觉定位系统和机械臂的手眼标定方法，其特征在于，所述步骤1具体为：以机械臂基座的几何中心为原点OBase，以机械臂正面前向为X轴正向，正面左向为Y轴正向，正面垂直向上方向为Z轴正向构建{Base}坐标系；以机械臂末端的法兰盘几何中心点OTCP为原点构建{TCP}坐标系；OTCP在{Base}坐标系中的位置描述为[X，Y，Z]，机械臂末端法兰盘坐标系{TCP}和机械臂坐标系{Base}的变换关系用[X，Y，Z]来描述。6.根据权利要求4所述的基于红外立体视觉定位系统和机械臂的手眼标定方法，其特征在于，{TCP}坐标系的轴向的变化即机械臂末端的法兰盘朝向的变换描述为旋转矢量(Rx，Ry，Rz)，所述步骤2包括如下步骤：步骤2.1：控制机械臂以法兰盘几何中心点为原点进行绕轴旋转运动，即以法兰盘中心OTCP为原点绕机械臂垂直轴向做绕轴旋转运动在{Base}坐标系下可以描述为{TCP}坐标系的原点OTCP不动，标记物绕过OTCP点的平行于{Base}坐标系的Z轴的Z′轴做圆锥状的运动；将机械臂绕轴旋转运动简化成做离散点的绕轴旋转运动，即离散点连起来组成一组绕轴旋转运动，但是每个离散点之间的运动并不要求是绕轴旋转运动；绕轴旋转运动用欧拉角(θz，θy，θx)来描述，具体欧拉角表示拆解为绕过OTCP点的平行于{Base}坐标系X轴的X′轴的横滚变换θx(Roll)和绕过OTCP点的平行于{Base}坐标系Y轴的Y′轴的俯仰变换θy(Pitch)的以及绕过OTCP点的...

【专利技术属性】
技术研发人员：吕天予，
申请(专利权)人：上海嘉奥信息科技发展有限公司，
类型：发明
国别省市：上海,31