机器人与双轴变位机构基坐标系标定球面拟合法制造技术

本发明专利技术公开了机器人与双轴变位机构基坐标系标定球面拟合法，其特征在于，包括以下步骤：步骤1、建立双轴变位机构坐标系；步骤2、拟合双轴变位机构坐标系原点：根据球上的点到球心的距离为固定值这一原理，使用球面拟合法求解变位机坐标系原点；步骤3、机器人与双轴变位机构的位姿变换矩阵求解：根据拟合的变位机坐标系原点选择最优的标定数据，求解变位机坐标系方向向量，进而建立机器人与双轴变位机构的位姿变换矩阵。本发明专利技术很好地解决了机器人末端工具测量误差以及变位机安装误差导致的测量结果不精确的问题。

【技术实现步骤摘要】
机器人与双轴变位机构基坐标系标定球面拟合法
本专利技术属于工业机器人坐标标定的
，具体涉及一种机器人与双轴变位机的位姿标定方法。
技术介绍
机器人与双焊接相贯线工件时，为保证焊接质量，在焊接过程中需将焊点一直置于船型焊缝姿态[1-2]，而传统的单个机器人焊接显然无法满足焊接要求，因此采用二自由度变位机进行协同运动，完成这一复杂空间曲线工件的焊接[3-6]。在两者进行协同作业前，需对机器人与变位机的位姿关系进行标定。目前，国内外学者对于机器人与变位机的位姿标定已经进行了大量的研究。毕志强[1]使用机器人末端TCP点接触标定点，并提出了由三点标定法改进的轴心标定法来确定机器人与变位机基坐标系之间的关系。齐飞等[2]运用机构运动学分析的方法，通过在线示教，建立变位机基坐标系与机器人基座标系的变换关系。HongminWu[3]等受三点校准方法的启发，提出了一种的简易的标定方法，先标记定位器台上的小位置孔，然后将特殊设计的带锥形尖端的杆安装到机器人末端，用以代替通常的末端执行器，这使得标定测量数据更加精确，通过变位机的两个轴的相应旋转(俯仰和偏转)产生两组三点数据从而计算出机器人与变位机的位姿关系。GanYahui[4]等针对协调多机器人系统的基坐标系标定问题，采用通过两个协调机器人之间的一系列握手操作，然后通过标定方程得到了初步的结果，在此基础上，为了保证标定后的旋转矩阵是正交的，在最优Frobenius范数近似准则下，求出了协调机器人基坐标系间相对旋转的最优估计，最后通过旋转矩阵的四元数表示法和拉格朗日乘子法，可以得到一种标准正交矩阵，即协调机器人基坐标系的标定结果。赵欢等[5]等使用最小二乘法获得拟合球面，进而计算出机器人与变位机相对位置矩阵，该方法可使标定误差在-0.5mm～0.5mm之间。以上学者提出的方法都是将机器人末端工具当作标定工具获得标定数据，这样的标定方式未考虑机器人末端工具的测量精度以及变位机自身安装误差的影响。针对该问题，本专利技术提出了一种机器人与变位机基坐标系标定球面拟合法来解决上述问题。参考文献：[1]毕志强.工业机器人协调运动规划与研究[D].华南理工大学,2014.[2]齐飞,平雪良,刘洁,蒋毅.关于工业机器人标定方法的研究[J].机床与液压,2015,43(21):32-36.[3]Wu,H.,Bi,Z.,Su,M.,Zhang,P.,He,Y.,&Guan,Y.(2014).Coordinatedmotionplanningwithcalibrationandofflineprogrammingforamanipulator-positionersystem.2014IEEEInternationalConferenceonRoboticsandBiomimetics.[4]GanY.,DaiX.Baseframecalibrationforcoordinatedindustrialrobots[J].RoboticsandAutonomousSystems,2011,59(7-8):563-570.[5]赵欢,刘晓春.基于最小二乘法的变位机与焊接机器人的位置关系标定[J].电焊机,2015,45(01):85-88。
技术实现思路
本专利技术的目的在于提供一种机器人与双轴变位机构基坐标系标定球面拟合法，用于解决机器人末端工具测量误差以及变位机安装误差导致的测量结果不精确的问题。为了实现上述目的，本专利技术采用如下的技术方案：本专利技术提供的一种机器人与双轴变位机构基坐标系标定球面拟合法，包括以下步骤：步骤1、建立双轴变位机构坐标系；步骤2、拟合双轴变位机构坐标系原点：根据球上的点到球心的距离为固定值这一原理，使用球面拟合法求解变位机坐标系原点；步骤3、机器人与双轴变位机构的位姿变换矩阵求解：根据拟合的变位机坐标系原点选择最优的标定数据，求解变位机坐标系方向向量，进而建立机器人与双轴变位机构的位姿变换矩阵。其中步骤1具体为，双轴变位机构由水平旋转轴和竖直旋转轴组成，并且水平旋转轴与竖直旋转轴所在的轴线在空间中交汇于一点，将该交汇点定义为双轴变位机构的坐标系原点，并以此建立双轴变位机构坐标系，双轴变位机构坐标系的X轴与水平旋转轴、竖直旋转轴的X轴重合，坐标系的Z轴与水平旋转轴的Z轴重合，坐标系的Y轴与竖直旋转轴的Z轴重合。步骤2中拟合双轴变位机构坐标系原点的过程具体分为以下几个步骤：步骤2.1、在双轴变位机构的工作台上固定一标定点，其坐标值为S(x,y,z)，令双轴变位机构坐标系原点为O(A,B,C)，标定点到双轴变位机构坐标系原点O(A,B,C)距离为R。步骤2.2、单独旋转双轴变位机构的水平旋转轴或竖直旋转轴，标定点将随着双轴变位机构的转动到达不同空间位置，使用机器人末端工具碰触标定点，并读取这些标定点的空间位置S(xi,yi,zi)，1≤i≤n。此时，每个标定点到变位机坐标系原点的距离为Di，其计算公式为：步骤2.3、标定点随着变位机的转动在空间中将形成一个球面，在理想状态下球面的半径应为R。由于误差的影响Di与R存在偏差，因此为准确标定变位机的坐标系原点，应使得所有Di与R距离的和达到最小，并以此作为遗传算法的适应度函数，其计算公式为：步骤2.4、使用遗传算法进行计算求解可得到最优A,B,C,R的值。其中步骤3中机器人与双轴变位机构的位姿变换矩阵求解具体包括以下步骤：步骤3.1、采集标定点位置时，每次只旋转变位机的一个轴，同时另外一个轴处于零位。在只旋转7轴的标定点中找出Di与R距离最短的3个标定点，记为A1、A2、A3点。点A1和A2可确定向量A1A2，点A1和A3可确定向量A1A3，同时这3点可确定一个平面，而这一平面的法向量也是变位机Z轴的方向向量。假设变位机Z轴的单位方向向量为w(wx,wy,wz)，其表达式为：w＝(A1A2×A1A3)/|A1A2×A1A3|(3)步骤3.2、同理，在只旋转8轴的标定点中找出Di与R距离最短的3个标定点，记为A4、A5、A6点，由这三点所确定平面的法向量为变位机Y轴的方向向量。假设变位机Y轴的单位方向向量为v(vx,vy,vz)，其表达式为：v＝(A4A5×A4A6)/|A4A5×A4A6|(4)步骤3.3、根据右手螺旋定则，可计算变位机X轴的方向向量。假设变位机X轴的单位方向向量为u(ux,uy,uz)，其表达式为：u＝v×w(5)步骤3.4、综合公式(3)、(4)、(5)和变位机坐标系原点坐标O(A,B,C)，机器人与变位机基坐标的位姿变换矩阵为：相比于现有技术，本专利技术具有如下有益效果：本专利技术提出了一种球面拟合法拟合变位机原点，并使用遗传算法求得全局最优原点位置，以减少测量误差和变位机自身精度的影响。根据原点位置选取6个最优标定点，计算得到变位机基坐标系的单位方向矢量，最终实现机器人与变位机位姿标定，使本文档来自技高网...

【技术保护点】
1.机器人与双轴变位机构基坐标系标定球面拟合法，其特征在于，包括以下步骤：/n步骤1、建立双轴变位机构坐标系；/n步骤2、拟合双轴变位机构坐标系原点：根据球上的点到球心的距离为固定值这一原理，使用球面拟合法求解变位机坐标系原点；/n步骤3、机器人与双轴变位机构的位姿变换矩阵求解：根据拟合的变位机坐标系原点选择最优的标定数据，求解变位机坐标系方向向量，进而建立机器人与双轴变位机构的位姿变换矩阵。/n

【技术特征摘要】
1.机器人与双轴变位机构基坐标系标定球面拟合法，其特征在于，包括以下步骤：
步骤1、建立双轴变位机构坐标系；
步骤2、拟合双轴变位机构坐标系原点：根据球上的点到球心的距离为固定值这一原理，使用球面拟合法求解变位机坐标系原点；
步骤3、机器人与双轴变位机构的位姿变换矩阵求解：根据拟合的变位机坐标系原点选择最优的标定数据，求解变位机坐标系方向向量，进而建立机器人与双轴变位机构的位姿变换矩阵。


2.如权利要求1所述的机器人与双轴变位机构基坐标系标定球面拟合法，其特征在于：所述步骤1建立坐标系具体为，将双轴变位机构的水平旋转轴与竖直旋转轴所在轴线在空间中的交汇点定义为坐标系原点，坐标系的X轴与水平旋转轴、竖直旋转轴的X轴重合，坐标系的Z轴与水平旋转轴的Z轴重合，坐标系的Y轴与竖直旋转轴的Z轴重合。


3.如权利要求1所述的机器人与双轴变位机构基坐标系标定球面拟合法，其特征在于：所述步骤2中拟合的过程具体分为以下几个分步骤：
步骤2.1、在双轴变位机构的工作台上固定一标定点，其坐标值为S(x,y,z)，令双轴变位机构坐标系原点为O(A,B,C)，所述标定点到原点O(A,B,C)的距离为R；
步骤2.2、单独旋转双轴变位机构的水平旋转轴或竖直旋转轴，标定点将随着双轴变位机构的转动到达不同空间位置，使用机器人末端工具碰触标定点，并读取这些标定点的空间位置S(xi,yi,zi)，1≤i≤n，此时，每个标定点到原点O(A,B,C)的距离为Di，其计算公式为：



步骤2.3、标定点随...

【专利技术属性】
技术研发人员：彭雄祥，
申请(专利权)人：广西玉林玉柴通用机械有限公司，
类型：发明
国别省市：广西;45