线激光传感器与机器人法兰盘相对位姿标定方法及系统技术方案

本发明专利技术公开了线激光传感器与机器人法兰盘相对位姿标定方法及系统，涉及线激光传感器与机器人法兰盘相对位姿的标定技术。本发明专利技术公开的标定块通过线激光传感器实现其位姿的测量，同时利用光学动态跟踪系统及配套光笔完成标定块位姿的测量，进而求解得到线激光传感器与机器人法兰盘相对位姿的标定。本发明专利技术不需要移动工业机器人，且线激光传感器仅需要单次测量标定块，即可完成标定，标定求解过程为矩阵方程运算，不存在最优解的计算过程，标定简单且结果准确度高。且结果准确度高。且结果准确度高。

【技术实现步骤摘要】
线激光传感器与机器人法兰盘相对位姿标定方法及系统


[0001]本专利技术属于光学检测技术，特别是涉及线激光传感器与机器人法兰盘相对位姿标定方法及系统。

技术介绍

[0002]随着光学检测技术与工业机器人技术的发展，采用工业机器人携带光学检测设备可以实现自动化监测，使得工业机器人具有了一定的感知能力。线激光传感器可以实现二维空间的测量，结合工业机器人的运动，可以实现三维空间物体点云的采集与测量，具有非接触、高精度、高效率的优点。线激光传感器采集的点云数据是基于其自身坐标系的，要实现工业机器人与线激光传感器的结合，需要完成线激光传感器与工业机器人法兰盘相对位姿的标定，从而实现测量点云数据从线激光传感器坐标系到工业机器人基坐标系的转换。线激光传感器与工业机器人法兰盘相对位姿的标定精度直接影响检测的准确性。
[0003]传统的线激光传感器与工业机器人法兰盘相对位姿标定方法主要为标准球法，其方法无法通过线激光传感器一次测量得到标定物相对于线激光传感器的位姿关系，因此需要多次调整工业机器人位姿，使得线激光传感器以不同的位姿测量标准球，使得标定过程中引入了工业机器人运动学误差，同时标定过程需进行最优解计算，导致操作复杂、标定精度低。

技术实现思路

[0004]本专利技术为解决上述
技术介绍
中存在的技术问题，提供了线激光传感器与机器人法兰盘相对位姿标定方法及系统。解决了线激光传感器与工业机器人法兰盘相对位姿标定过程复杂，标定精度差的问题，简化了标定流程，提高了标定准确性。
[0005]本专利技术采用以下技术方案：一种线激光传感器与机器人法兰盘相对位姿标定方法，包括以下步骤：步骤一、将机器人、法兰盘、标定块、线激光传感器、光学动态跟踪系统以及与光学动态跟踪系统相适配的光笔按照预定位置进行设置；步骤二、标定块、光学动态跟踪系统和光笔构成一标定试验平台，将机器人恢复至初始状态，记机器人坐标系、法兰盘坐标系、线激光传感器坐标系、标定块坐标系、光学动态跟踪系统坐标系分别为{BF}、{FF}、{LF}、{DF}、{CF}；步骤三、分别求解{BF}和{FF}、{LF}和{DF}、{DF}和{CF}、{CF}和{BF}的矩阵变换关系，得到、、、；步骤四、基于所述矩阵变换关系，采用以下公式计算得到线激光传感器坐标系与法兰盘坐标系内的相对位姿：。
[0006]在进一步的实施例中，所述标定块包括：
本体；至少四组半圆柱体，呈放射性排布于所述本体的上表面；相邻的半圆柱体之间的夹角相等。
[0007]在进一步的实施例中，所述预定位置如下：所述机器人与光学动态跟踪系统为相对设置，中间设置有操作台；所述法兰盘安装在机器人的末端，所述线激光传感器安装在所述法兰盘上；所述标定块固定在操作台上，并位于线激光传感器的测量范围内，保证线激光传感器同时测量任意两个相邻半圆柱和相邻半圆柱之间的本体上表面；所述光学动态跟踪系统同时测量机器人和标定块对应位置。
[0008]在进一步的实施例中，所述步骤三中的为法兰盘坐标系与机器人坐标系的相对位姿，其计算流程如下：读取当前法兰盘坐标系相对于机器人基坐标系在X、Y、Z三轴上的对应旋转参数与对应平移参数，通过以下公式求解得到{FF}相对于{BF}的矩阵变换关系：。
[0009]在进一步的实施例中，为标定块坐标系与线激光传感器坐标系的相对位姿，获取流程如下：获取线激光传感器坐标系下的标定块测量点得到第一点云数据，定义线激光传感器测量到的两个相邻半圆柱体分别为第一半圆柱体和第二半圆柱体，采用最小二乘法拟合圆柱体，分别得到关于第一半圆柱体、第二半圆柱体的第一轴线L1和第二轴线L2参数方程：第一轴线L1： ；第二轴线L2：；其中，为线激光传感器测量到的第一半圆柱体上的任意点坐标，为第一轴线L1的一组方向数；为线激光传感器测量到的第二半圆柱体上的任意点坐标，为第二轴线L2的一组方向数；t为参数方程的参数；基于所述第一点云数据和最小二乘法拟合得到直线L0：直线L0：；
其中，为第一点云数据内的任意点坐标，为直线L0的一组方向数；t为参数方程的参数；利用第一轴线L1、第二轴线L2和直线L0在同一平面上的约束条件，求解得到平面P1：；其中，为平面P1一般方程的系数；将第一轴线L1和第二轴线L2投影到平面P1上，得到第一投影线和第二投影线：第一投影线： ；第二投影线： ；其中，为点在平面P1上的投影坐标，为第一投影线的一组方向数；为点在平面P1上的投影坐标，为第二投影线的一组方向数；获取第一投影线和第二投影线的交点，记为点D1；设点D1为标定块坐标系的原点O
DF
，过原点O
DF
沿第一投影线所在方向在标定块坐标系内设置X
DF
轴，过原点O
DF
沿平面P1的法向在标定块坐标系内设置Y
DF
轴，根据右手定则得到标定块坐标系的Y
DF
轴，计算得到{DF}相对于{LF}的矩阵变换关系。
[0010]在进一步的实施例中，为标定块坐标系与光学动态跟踪系统坐标系的相对位姿，其计算流程如下：利用光学动态跟踪系统、光笔对标定块的上表面进行测量，得到多组在光学动态跟踪系统坐标系下标定块的上表面测量点得到第二点云数据，采用最小二乘法原理拟合得到平面P2：，其中为平面一般方程的系数；利用光学动态跟踪系统、光笔对标定块的任意相邻两组半圆柱体进行测量，得到多组在光学动态跟踪系统坐标系下相邻两组半圆柱体的点坐标数据；基于最小二乘法，分别计算得到第一圆柱Q1和第二圆柱Q2，并求解得到关于第一圆柱Q1、第二圆柱Q2的第三轴线L3和第四轴线L4：
第三轴线L3： ；第四轴线L4： ；其中，为光学动态跟踪系统坐标系内的第一圆柱Q1上的任意点坐标，为第三轴线L3的一组方向数；t为参数方程的参数；为光学动态跟踪系统坐标系内的第二圆柱Q2上的任意点坐标，为第四轴线L4的一组方向数；t为参数方程的参数；将第三轴线L3和第四轴线L4投影到平面P2上得到第三投影线和第四投影线：第三投影线：；第四投影线：；其中，为点在平面P2上的投影坐标，为第三投影线的一组方向数；为点在平面P2上的投影坐标，为第四投影线的一组方向数；记第三投影线和第四投影线的交点为；记点为标定块坐标系在光学动态跟踪系统坐标系下的原点，过原点沿第三投影线所在方向在标定块坐标系内设置轴，过原点沿平面P2的法向在标定块坐标系内设置轴，即在光学动态跟踪系统坐标系下建立标定块坐标系，求解得到{DF}相对于{CF}的矩阵变换关系。
[0011]在进一步的实施例中，为机器人坐标系与光学动态跟踪系统坐标系的相对位姿，其获取方式如下：于机器人末端粘贴光学动态跟踪系统检测用的靶标点，分别转动机器人的机械臂轴一和轴二，并多次记录靶标点在光学动态跟踪系统坐标系下的坐标值，在光学动态跟踪系统坐标系下建立机器人基坐标系，求解得到{BF}相对于{CF}的矩阵变换关系。
[0012]一种线激光传感器与机器人法兰盘相对位姿标定系统，包括：机器人，其末端安装有法兰盘；线激光传感器，安装与所述法兰盘上；本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.线激光传感器与机器人法兰盘相对位姿标定方法，其特征在于，包括以下步骤：步骤一、将机器人、法兰盘、标定块、线激光传感器、光学动态跟踪系统以及与光学动态跟踪系统相适配的光笔按照预定位置进行设置；步骤二、标定块、光学动态跟踪系统和光笔构成一标定试验平台，将机器人恢复至初始状态，记机器人坐标系、法兰盘坐标系、线激光传感器坐标系、标定块坐标系、光学动态跟踪系统坐标系分别为{BF}、{FF}、{LF}、{DF}、{CF}；步骤三、分别求解{BF}和{FF}、{LF}和{DF}、{DF}和{CF}、{CF}和{BF}的矩阵变换关系，得到、、、；步骤四、基于所述矩阵变换关系，采用以下公式计算得到线激光传感器坐标系与法兰盘坐标系内的相对位姿：。2.根据权利要求1所述的线激光传感器与机器人法兰盘相对位姿标定方法，其特征在于，所述标定块包括：本体；至少四组半圆柱体，呈放射性排布于所述本体的上表面；相邻的半圆柱体之间的夹角相等。3.根据权利要求1所述的线激光传感器与机器人法兰盘相对位姿标定方法，其特征在于，所述预定位置的位置关系如下：所述机器人与光学动态跟踪系统为相对设置，中间设置有操作台；所述法兰盘安装在机器人的末端，所述线激光传感器安装在所述法兰盘上；所述标定块固定在操作台上，并位于线激光传感器的测量范围内，保证线激光传感器同时测量任意两个相邻半圆柱和相邻半圆柱之间的本体上表面；所述光学动态跟踪系统同时测量机器人和标定块对应位置。4.根据权利要求1所述的线激光传感器与机器人法兰盘相对位姿标定方法，其特征在于，所述步骤三中的为法兰盘坐标系与机器人坐标系的相对位姿，其计算流程如下：读取当前法兰盘坐标系相对于机器人基坐标系在X、Y、Z三轴上的对应旋转参数与对应平移参数，通过以下公式求解得到{FF}相对于{BF}的矩阵变换关系：。5.根据权利要求1所述的线激光传感器与机器人法兰盘相对位姿标定方法，其特征在于，为标定块坐标系与线激光传感器坐标系的相对位姿，获取流程如下：获取线激光传感器坐标系下的标定块测量点得到第一点云数据，定义线激光传感器测
量到的两个相邻半圆柱体分别为第一半圆柱体和第二半圆柱体，采用最小二乘法拟合圆柱体，分别得到关于第一半圆柱体、第二半圆柱体的第一轴线和第二轴线参数方程：第一轴线： ；第二轴线：；其中，为线激光传感器测量到的第一半圆柱体上的任意点坐标，为第一轴线L1的一组方向数；为线激光传感器测量到的第二半圆柱体上的任意点坐标，为第二轴线的一组方向数；为参数方程的参数；基于所述第一点云数据和最小二乘法拟合得到直线：直线L0：；其中，为第一点云数据内的任意点坐标，为直线的一组方向数；t为参数方程的参数；利用第一轴线、第二轴线和直线在同一平面上的约束条件，求解得到平面：；其中，为平面一般方程的系数；将第一轴线和第二轴线投影到平面P1上，得到第一投影线和第二投影线：第一投影线： ；第二投影线： ；其中，为点在平面P1上的投影坐标，为第一投影线的一组方向数；为点在平面P1上的投影坐标，为第二投影线的一组方向数；获取第一投影线和第二投影线的交点，记为点D1；设...

【专利技术属性】
技术研发人员：李鹏程，张奇，王忠康，田威，王品章，孔玲怡，叶昶君，
申请(专利权)人：南京航空航天大学，
类型：发明
国别省市：