CN109895094B - 一种工业机器人测量轨迹定位误差分析方法及系统 - Google Patents

一种工业机器人测量轨迹定位误差分析方法及系统 Download PDF

Info

Publication number
CN109895094B
CN109895094B CN201910110299.9A CN201910110299A CN109895094B CN 109895094 B CN109895094 B CN 109895094B CN 201910110299 A CN201910110299 A CN 201910110299A CN 109895094 B CN109895094 B CN 109895094B
Authority
CN
China
Prior art keywords
measured
measuring
workpiece
robot
geometric model
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910110299.9A
Other languages
English (en)
Other versions
CN109895094A (zh
Inventor
刘磊
颜昌亚
李振瀚
汪敏敏
杨帆
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Suzhou Hanhua Zhizao Intelligent Technology Co ltd
Original Assignee
Suzhou Hanhua Zhizao Intelligent Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Suzhou Hanhua Zhizao Intelligent Technology Co ltd filed Critical Suzhou Hanhua Zhizao Intelligent Technology Co ltd
Priority to CN201910110299.9A priority Critical patent/CN109895094B/zh
Publication of CN109895094A publication Critical patent/CN109895094A/zh
Application granted granted Critical
Publication of CN109895094B publication Critical patent/CN109895094B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

本发明公开了一种工业机器人测量轨迹定位误差分析方法及系统，该方法包括以下步骤：S1：控制机器人执行测量轨迹，获得测量点云数据；S2：将测量点云数据与待测工件的几何模型进行配准计算，得到待测工件在机器人工作空间中的全局定位误差；S3：基于该全局定位误差对几何模型进行旋转、偏移变换，修正几何模型在机器人工作站中的安装位姿；S4：基于特征点、测量点及特征点所在几何曲面，计算测量轨迹上特征点处的局部定位误差。本发明从机器人实际工作场景出发，计算机器人执行测量轨迹过程中得到的测量点位相对于待测工件几何模型的定位误差，能够对机器人定位误差进行评估，便于后续补偿修正测量轨迹，提高机器人的加工、测量精度。

Description

一种工业机器人测量轨迹定位误差分析方法及系统
技术领域
本发明属于工业机器人测量技术领域，更具体地，涉及一种工业机器人测量轨迹定位误差分析方法及系统。
背景技术
工业机器人是一种可编程的自动化柔性工作设备，具有柔性好、抗干扰性强、重复精度高、工作时间长等特点，被广泛应用在各种生产制造领域，如喷涂、焊接、搬运、装配、物件加工等。就目前工业机器人的生产应用来看，工业机器人通常具有较高的重复定位精度，大部分工业机器人的重复定位精度已到达0.05mm量级。但工业机器人的绝对定位精度较差，大部分工业机器人的绝对定位精度在1mm量级，少数经过精度补偿后，绝对定位精度能达到0.5mm。绝对定位精度差会导致工业机器人执行轨迹程序文件时，其末端点到达的位置会与规划点存在偏差，从而影响机器人的加工、测量精度。这就严重制约了机器人在精密加工制造领域的应用。
到目前为止，国内外学者对提高工业机器人绝对定位精度的研究主要集中在两个方向。其中一个方向集中在机器人本体制造单元的实际尺寸误差和装配误差的标定计算，通过修正机器人的运动学参数来提高机器人控制误差。另一个方向集中在机器人末端定位误差测量补偿方面，通过测量机器人末端运动到的位置和理论位置之间的偏差，补偿机器人运动控制点指令，使机器人末端贴近到理论规划位置。这两种方式都可在一定程度上提高机器人绝对定位精度，但是均未将机器人实际工作场景纳入考虑。机器人在工作时，需要指定待加工工件在机器人工作空间中的安放位姿，机器人末端运动轨迹为相对于待加工工件的轨迹。因此，机器人加工精度的提高，还需要将运动轨迹相对于待加工工件的定位误差纳入考虑。
发明内容
针对现有技术的至少一个缺陷或改进需求，本发明提供了一种工业机器人测量轨迹定位误差分析方法及系统，从机器人实际工作场景出发，对工业机器人执行测量轨迹过程中测量点位相对于待测工件特征点的定位误差进行分析，其目的在于为补偿修正测量轨迹提供参考依据，解决目前工业机器人绝对定位精度较差，不能满足工业机器人离线编程技术在精密加工、测量等领域的应用需求的问题。
为实现上述目的，按照本发明的一个方面，提供了一种工业机器人测量轨迹定位误差分析方法，包括以下步骤：
S1：控制机器人执行基于待测工件的几何模型生成的测量轨迹，触发测量设备采集待测工件的测量点云数据；
S2：将所述测量点云数据与待测工件的几何模型进行配准计算，得到待测工件在机器人工作空间中的安装定位误差，将所述安装定位误差作为测量轨迹相对于待测工件的全局定位误差；
S3：基于所述全局定位误差对待测工件几何模型进行旋转、偏移变换，修正待测工件几何模型在机器人工作空间中的安装位姿。
优选的，上述工业机器人测量轨迹定位误差分析方法，其步骤S2中将所述测量点云数据与待测工件的几何模型进行配准计算具体包括以下子步骤：
S21：初始化迭代计数k＝1；
S22：对于测量点云数据{Pm|m＝1,2,…,n}中每个点Pm，在待测工件的几何模型上查找距点Pm最近的点P′a；
S23：基于目标函数
Figure BDA0001967838730000021
计算得到当前旋转矩阵Rk和偏移向量tk；
S24：判断计算结果是否满足收敛条件
Figure BDA0001967838730000022
若是，则进入下一步；若否，则更新当前测量点云Pm＝Rk·Pm+tk，增加迭代记数k＝k+1，返回步骤S22继续迭代计算；
S25：计算测量点云数据相对于几何模型的旋转变换量R＝Rk·Rk-1·...·R1和偏移变换量
Figure BDA0001967838730000023
根据所述旋转变换量R得到几何模型相对于测量点云数据的旋转变换量R′＝R-1；根据所述旋转变换量R和偏移变换量t得到几何模型相对于测量点云数据的偏移变换量t′＝-R-1·t。
优选的，上述工业机器人测量轨迹定位误差分析方法，其步骤S1中还包括：建立测量轨迹上的特征点与测量点云数据中对应的测量点之间的映射关系，生成特征点-测量点对<Pd,Pm>。
优选的，上述工业机器人测量轨迹定位误差分析方法，其步骤S3之后还包括以下步骤：
S4：基于测量轨迹的特征点与测量点之间的映射关系以及特征点所在几何曲面，计算测量轨迹在特征点处的局部定位误差。
优选的，上述工业机器人测量轨迹定位误差分析方法，其步骤S4中包括以下子步骤：
S41：计算待测工件测量曲面在特征点Pd处的单位法向量
Figure BDA0001967838730000031
确定待测工件测量曲面在特征点处的切平面；
S42：分别将
Figure BDA0001967838730000032
在法向量
Figure BDA00019678387300000310
和所述切平面上进行投影，以
Figure BDA0001967838730000033
在法向量
Figure BDA0001967838730000034
上的投影作为法向误差，以
Figure BDA0001967838730000035
在切平面上的投影作为径向误差，计算得到测量点相对于特征点的法向误差向量
Figure BDA0001967838730000036
和径向误差向量
Figure BDA0001967838730000037
优选的，上述工业机器人测量轨迹定位误差分析方法，其测量设备为光学追踪仪和共焦光谱距离测量传感器。
按照本发明的另一个方面，还提供了一种工业机器人测量轨迹定位误差分析系统，包括机器人控制单元、配准单元和补偿单元；
所述机器人控制单元用于控制机器人执行基于待测工件的几何模型生成的测量轨迹，触发测量设备采集待测工件的测量点云数据；
所述配准单元用于将所述测量点云数据与待测工件的几何模型进行配准计算，得到待测工件在机器人工作空间中的全局定位误差；
所述补偿单元用于基于所述全局定位误差对待测工件几何模型进行旋转、偏移变换，修正待测工件几何模型在机器人工作空间中的安装位姿。
优选的，上述工业机器人测量轨迹定位误差分析系统，其配准单元包括计数模块、查找模块、第一计算模块、判断模块和第二计算模块；
所述计数模块用于初始化迭代计数k＝1；
所述查找模块用于分别在待测工件的几何模型上查找距测量点云数据{Pm|m＝1,2,…,n}中每个点Pm最近的点P′m；
所述第一计算模块用于基于目标函数
Figure BDA0001967838730000038
计算当前旋转矩阵Rk和偏移向量tk；
所述判断模块用于判断第一计算模块的计算结果是否满足收敛条件
Figure BDA0001967838730000039
Figure BDA0001967838730000041
若是，则发出第一触发信号；若否，则发出第二触发信号，所述第二触发信号用于控制计数模块增加迭代记数k＝k+1，并控制查找模块更新当前测量点云Pm＝Rk·Pm+tk，继续迭代计算；
所述第二计算模块用于在所述第一触发信号的控制下计算测量点云数据相对于几何模型的旋转变换量R＝Rk·Rk-1·...·R1和偏移变换量
Figure BDA0001967838730000042
根据所述旋转变换量R得到几何模型相对于测量点云数据的旋转变换量R′＝R-1；根据所述旋转变换量R和偏移变换量t得到几何模型相对于测量点云数据的偏移变换量t′＝-R-1·t。
优选的，上述工业机器人测量轨迹定位误差分析系统，其机器人控制单元还用于建立测量轨迹上的特征点与测量点云数据中对应的测量点之间的映射关系，生成特征点-测量点对<Pd,Pm>。
优选的，上述工业机器人测量轨迹定位误差分析系统，还包括误差计算单元；
所述误差计算单元用于根据机器人控制单元建立的测量轨迹的特征点与测量点之间的映射关系以及特征点所在几何曲面，计算测量轨迹在特征点处的局部定位误差。
优选的，上述工业机器人测量轨迹定位误差分析系统，其误差计算单元包括第三计算模块和第四计算模块；
所述第三计算模块用于计算待测工件测量曲面在特征点Pd处的单位法向量
Figure BDA0001967838730000049
确定待测工件测量曲面在特征点处的切平面；
所述第四计算模块用于分别将
Figure BDA0001967838730000043
在法向量
Figure BDA00019678387300000410
和所述切平面上进行投影，以
Figure BDA0001967838730000044
在法向量
Figure BDA0001967838730000045
上的投影作为法向误差，以
Figure BDA0001967838730000046
在切平面上的投影作为径向误差，计算得到测量点相对于特征点的法向误差向量
Figure BDA0001967838730000047
和径向误差向量
Figure BDA0001967838730000048
优选的，上述工业机器人测量轨迹定位误差分析方法，其测量设备为光学追踪仪和共焦光谱距离测量传感器。
总体而言，通过本发明所构思的以上技术方案与现有技术相比，能够取得下列有益效果：
(1)本发明提供的一种工业机器人测量轨迹定位误差分析方法及系统，首先将测量点云数据与待测工件几何模型做配准计算，计算得到测量轨迹相对于待测工件的全局定位误差；基于该全局定位误差对待测工件几何模型进行旋转、偏移变换，修正待测工件几何模型在虚拟机器人工作站中的安装位姿，消除全局误差对局部误差计算的影响，有利于提高定位误差的计算精度；
(2)本发明提供的一种工业机器人测量轨迹定位误差分析方法及系统，从机器人实际工作场景出发，计算得到机器人测量工作站执行测量轨迹过程中，测量点位相对于待测工件特征点的定位误差；该方法可较为简便的对工业机器人定位误差进行评估，便于后续补偿修正测量轨迹，满足机器人实时工作场景需求；本发明有利于改善工业机器人的绝对定位精度对机器人应用领域的限制，满足工业机器人离线编程技术在精密加工、测量等领域的应用需求。
附图说明
图1是本发明实施例提供的工业机器人测量轨迹定位误差分析方法的流程图；
图2是本发明实施例提供的测量轨迹特征点定义示意图；
图3是本发明实施例提供的运动执行单元及测量设备的硬件结构示意图；
图4是本发明实施例提供的测量轨迹全局定位误差示意图；
图5是本发明实施例提供的测量轨迹特征点局部定位误差示意图；
图6是本发明实施例提供的工业机器人测量轨迹定位误差分析系统的逻辑框图；
在所有附图中，同样的附图标记表示相同的技术特征，具体为：1-测量轨迹，2-特征点，3-工业机器人，4-共焦光谱传感器，5-光学追踪仪，6-待测工件，7-测量点云数据，8-工件实际曲面，9-理论测量轨迹，10-实际测量轨迹。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。此外，下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
图1是本实施例提供的工业机器人测量轨迹定位误差分析方法的流程图；如图1所示，该工业机器人测量轨迹定位误差分析方法包括以下步骤：
S1：基于待测工件的几何模型特征定义测量轨迹的特征点；该测量轨迹是基于待测工件的几何模型生成的，以特征点作为测量轨迹定位误差分析点；
图2是本发明实施例提供的测量轨迹特征点定义示意图，测量轨迹的特征点是测量轨迹上控制轨迹形状的点，如图2中的点P1、P2、P3、P4、P5、P6是测量轨迹1上的特征点2；对于待测工件上几何特征的测量，均可转换为对点的测量，然后由测量点或测量点集分析得到几何特征参数。因此，对于测量轨迹的规划，可先基于工件几何特征得到待测点，然后由待测点生成测量轨迹。那么，对于测量轨迹，待测点作为测量目标点，也是轨迹控制点。对于轨迹定位误差分析，实际是对轨迹上的轨迹控制点作分析。因此，本实施例将测量轨迹中的待测点定义为测量轨迹定位误差分析的特征点。
S2：将测量轨迹传输给机器人控制单元，控制机器人执行该测量轨迹，获得测量点云数据；在机器人运动过程中，当机器人执行到待测点测量指令时，触发测量设备采集测量数据，得到与特征点对应的工件测量点，并记录特征点对应的工件测量点之间的对应关系；轨迹执行完后，得到测量点云数据；
图3是本发明实施例提供的运动执行单元及测量设备的硬件结构示意图；如图3所示，本实施例采用六轴工业机器人3作为运动执行单元，以光学追踪仪HyperScan 5和共焦光谱距离测量传感器4作为组合测量设备，将光学追踪仪HyperScan5在机器人外部安装固定，将共焦光谱距离测量传感器4安装在机器人3法兰末端，由机器人3作为运动执行设备带动测量设备运动，对待测工件4进行测量。其中，光学追踪仪HyperScan用于实时追踪测量共焦光谱传感器的位姿数据，位姿跟踪精度为0.06mm，共焦光谱距离测量传感器用于测量工件上的待测点在共焦光谱距离测量传感器光轴方向上的距离，距离测量精度为0.5um，通过组合测量数据可得到精确的待测点数据；
在机器人运动过程中，当机器人执行到待测点测量指令时，触发光学追踪仪HyperScan 5和共焦光谱距离测量传感器4采集测量数据，得到与特征点对应的工件测量点，同时记录特征点与测量点之间的对应关系，生成特征点-测量点对，用
Figure BDA0001967838730000061
表示；轨迹执行完后，得到测量点云数据；然后根据测量设备坐标系Ot-XYZ与待测工件坐标系Ow-XYZ之间的变换关系，将测量点云数据转换到工件坐标系Ow-XYZ下。
S3：测量轨迹全局定位误差计算：将测量点云数据与待测工件几何模型做配准计算，得到待测工件在机器人工作站中的安装定位误差，将该误差作为测量轨迹相对于待测工件的全局定位误差；
工业机器人在执行测量轨迹过程中，带动测量设备相对待测工件运动；当待测工件在机器人工作空间中的安装位置存在偏差时，测量设备测得的工作点运动轨迹与工件之间会存在整体偏移，但测量到的点仍位于工件表面，测量点云数据7与工件实际曲面8具有同形性，如图4所示。为了计算得到更为准确的测量轨迹定位误差分析结果，本实施例首先对测量得到的点云数据与待测工件几何模型进行配准，计算得到当测量点云与工件模型的被测曲面最近贴合时，待测工件几何模型所需的旋转、平移变换参数，修正待测工件几何模型在虚拟机器人工作空间中的安装位姿；
配准计算过程如下：
a)初始化迭代计数k＝1；
b)对测量点云数据{Pm|m＝1,2,…,n}中每个点Pm，在待测工件几何模型上找到距点Pm最近的点P′m；
c)基于目标函数
Figure BDA0001967838730000071
计算得到当前旋转矩阵Rk和偏移向量tk；
d)判断计算结果是否满足收敛条件
Figure BDA0001967838730000072
若是，则进入下一步；若否，则更新当前测量点云Pm＝Rk·Pm+tk，增加迭代记数k＝k+1，返回步骤b)继续迭代计算；其中，ε为收敛误差，ε的取值需要根据测量精度需求进行调整，测量精度越高，ε越小；本实施例中ε取0.001；
e)计算测量点云数据相对于待测工件几何模型的旋转变换量R＝Rk·Rk-1·...·R1和偏移变换量
Figure BDA0001967838730000073
进而可得到工件几何模型相对于测量点云的旋转变换量R′＝R-1和偏移变换量t′＝-R-1·t。
S4：基于全局定位误差对待测工件几何模型进行旋转、偏移变换，修正待测工件几何模型在虚拟机器人工作站中的安装位姿；
S5：测量轨迹局部定位误差计算：基于测量轨迹特征点、测量点及特征点所在几何曲面，计算测量轨迹上特征点处的局部定位误差，该局部定位误差由径向误差和法向误差两部分构成；
在修正待测工件几何模型在虚拟机器人工作站中的安装位姿后，利用步骤S2中建立的特征点与测量点之间的对应关系，更新特征点-测量点对
Figure BDA0001967838730000074
基于工件几何模型计算测量点偏差；
图5是本发明实施例提供的测量轨迹特征点局部定位误差示意图；如图5所示，特征点所处曲线为理论测量轨迹9，测量点所处曲线为实际测量轨迹10；首先，计算工件测量曲面在特征点Pd处单位法向量
Figure BDA0001967838730000075
确定工件测量曲面在特征点处的切平面；然后，分别将
Figure BDA0001967838730000076
在法向量
Figure BDA0001967838730000077
和切平面上作投影，以
Figure BDA0001967838730000078
在法向量
Figure BDA0001967838730000079
上的投影作为法向误差，以
Figure BDA00019678387300000710
在切平面上的投影作为径向误差，可计算得到测量点相对于特征点的法向误差向量
Figure BDA00019678387300000711
和径向误差向量
Figure BDA00019678387300000712
本实施例提供的工业机器人测量轨迹定位误差分析方法，首先将测量点云数据与待测工件几何模型做配准计算，计算得到测量轨迹相对于待测工件的全局定位误差；基于该全局定位误差对待测工件几何模型进行旋转、偏移变换，修正待测工件几何模型在虚拟机器人工作站中的安装位姿，消除全局误差对局部误差计算的影响，有利于提高定位误差的计算精度。
本实施例还提供了一种工业机器人测量轨迹定位误差分析系统，图6是该系统的逻辑框图；如图6所示，该工业机器人测量轨迹定位误差分析系统包括机器人控制单元、配准单元、补偿单元和误差计算单元；
机器人控制单元用于控制机器人执行基于待测工件的几何模型生成的测量轨迹，触发测量设备采集待测工件的测量点云数据；还用于建立测量轨迹上的特征点与测量点云数据中对应的测量点之间的映射关系，生成特征点-测量点对<Pd,Pm>。
配准单元用于将测量点云数据与待测工件的几何模型进行配准计算，得到待测工件在机器人工作站中的安装定位误差，将该误差作为测量轨迹相对于待测工件的全局定位误差；
该配准单元包括计数模块、查找模块、第一计算模块、判断模块和第二计算模块；
其中，计数模块用于初始化迭代计数k＝1；
查找模块用于分别在待测工件的几何模型上查找距测量点云数据{Pm|m＝1,2,…,n}中每个点Pm最近的点P′m；
第一计算模块用于根据目标函数
Figure BDA0001967838730000081
计算当前旋转矩阵Rk和偏移向量tk；
判断模块用于判断第一计算模块的计算结果是否满足收敛条件
Figure BDA0001967838730000082
Figure BDA0001967838730000083
若是，则发出第一触发信号；若否，则发出第二触发信号，该第二触发信号用于控制计数模块增加迭代记数k＝k+1，并控制查找模块更新当前测量点云Pm＝Rk·Pm+tk，继续迭代计算；其中，ε为收敛误差，ε的取值需要根据测量精度需求进行调整，测量精度越高，ε越小；本实施例中ε取0.001；
第二计算模块用于在第一触发信号的控制下计算测量点云数据相对于几何模型的旋转变换量R＝Rk·Rk-1·...·R1和偏移变换量
Figure BDA0001967838730000084
根据旋转变换量R得到几何模型相对于测量点云数据的旋转变换量R′＝R-1；根据旋转变换量R和偏移变换量t得到几何模型相对于测量点云数据的偏移变换量t′＝-R-1·t。
补偿单元用于根据第二计算模块得到的旋转变换量R′和偏移变换量t′对待测工件几何模型进行旋转、偏移变换，修正待测工件几何模型在机器人工作空间中的安装位姿。
误差计算单元用于根据机器人控制单元建立的测量轨迹的特征点与测量点之间的映射关系以及特征点所在几何曲面，计算测量轨迹在特征点处的局部定位误差；该局部定位误差包括径向误差和法向误差；
该误差计算单元包括第三计算模块和第四计算模块；
其中，第三计算模块用于计算待测工件测量曲面在特征点Pd处的单位法向量
Figure BDA0001967838730000091
确定待测工件测量曲面在特征点处的切平面；
第四计算模块用于分别将
Figure BDA0001967838730000092
在法向量
Figure BDA0001967838730000093
和所述切平面上进行投影，以
Figure BDA0001967838730000094
在法向量
Figure BDA0001967838730000095
上的投影作为法向误差，以
Figure BDA0001967838730000096
在切平面上的投影作为径向误差，计算得到测量点相对于特征点的法向误差向量
Figure BDA0001967838730000097
和径向误差向量
Figure BDA0001967838730000098
本发明提供的一种工业机器人测量轨迹定位误差分析方法及系统，从机器人实际工作场景出发，计算得到机器人测量工作站执行测量轨迹过程中，测量点位相对于待测工件特征点的定位误差；该方法可较为简便的对工业机器人定位误差进行评估，便于后续补偿修正测量轨迹，满足机器人实时工作场景需求；本发明有利于改善工业机器人的绝对定位精度对机器人应用领域的限制，满足工业机器人离线编程技术在精密加工、测量等领域的应用需求。
本领域的技术人员容易理解，以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。

Claims (6)

1.一种工业机器人测量轨迹定位误差分析方法，其特征在于，包括以下步骤：
S1：控制机器人执行基于待测工件的几何模型生成的测量轨迹，获得测量点云数据；
S2：将所述测量点云数据与待测工件的几何模型进行配准计算，得到待测工件在机器人工作空间中的全局定位误差；所述全局定位误差包括几何模型相对于测量点云数据的旋转变换量R′和偏移变换量t′；具体包括以下子步骤：
S21：初始化迭代计数k＝1；
S22：对于测量点云数据{Pm|m＝1,2,…,n}中每个点Pm，在待测工件的几何模型上查找距点Pm最近的点P′m；
S23：基于目标函数
Figure FDA0002691803720000011
计算得到当前旋转矩阵Rk和偏移向量tk；
S24：判断计算结果是否满足收敛条件
Figure FDA0002691803720000012
若是，则进入下一步；若否，则更新当前测量点云Pm＝Rk·Pm+tk，增加迭代记数k＝k+1，返回步骤S22继续迭代计算；
S25：计算测量点云数据相对于几何模型的旋转变换量R＝Rk·Rk-1·…·R1和偏移变换量
Figure FDA0002691803720000013
根据所述旋转变换量R得到几何模型相对于测量点云数据的旋转变换量R′＝R-1；根据所述旋转变换量R和偏移变换量t得到几何模型相对于测量点云数据的偏移变换量t′＝-R-1·t；
S3：基于所述全局定位误差对待测工件几何模型进行旋转、偏移变换，修正待测工件几何模型在机器人工作空间中的安装位姿；
S4：基于从修正后的几何模型对应的测量轨迹中选取的特征点及其在测量点云中对应的测量点计算测量轨迹在所述特征点处的局部定位误差。
2.如权利要求1所述的工业机器人测量轨迹定位误差分析方法，其特征在于，步骤S1中还包括：建立测量轨迹上的特征点与测量点云数据中对应的测量点之间的映射关系。
3.如权利要求1所述的工业机器人测量轨迹定位误差分析方法，其特征在于，步骤S4中包括以下子步骤：
S41：计算待测工件的测量曲面在特征点Pd处的单位法向量
Figure FDA0002691803720000014
确定待测工件测量曲面在特征点处的切平面；
S42：分别将
Figure FDA0002691803720000021
在法向量
Figure FDA0002691803720000022
和所述切平面上进行投影，以
Figure FDA0002691803720000023
在法向量
Figure FDA0002691803720000024
上的投影作为法向误差，以
Figure FDA0002691803720000025
在切平面上的投影作为径向误差，计算得到测量点相对于特征点的法向误差向量
Figure FDA0002691803720000026
和径向误差向量
Figure FDA0002691803720000027
4.一种工业机器人测量轨迹定位误差分析系统，其特征在于，包括机器人控制单元、配准单元、补偿单元和误差计算单元；
所述机器人控制单元用于控制机器人执行基于待测工件的几何模型生成的测量轨迹，获得测量点云数据；
所述配准单元用于将所述测量点云数据与待测工件的几何模型进行配准计算，得到待测工件在机器人工作空间中的全局定位误差；所述配准单元包括计数模块、查找模块、第一计算模块、判断模块和第二计算模块；
所述计数模块用于初始化迭代计数k＝1；
所述查找模块用于分别在待测工件的几何模型上查找距测量点云数据{Pm|m＝1,2,…,n}中每个点Pm最近的点P′m；
所述第一计算模块用于基于目标函数
Figure FDA0002691803720000028
计算当前旋转矩阵Rk和偏移向量tk；
所述判断模块用于判断第一计算模块的计算结果是否满足收敛条件
Figure FDA0002691803720000029
Figure FDA00026918037200000210
若是，则发出第一触发信号；若否，则发出第二触发信号，所述第二触发信号用于控制计数模块增加迭代记数k＝k+1，并控制查找模块更新当前测量点云Pm＝Rk·Pm+tk，继续迭代计算；
所述第二计算模块用于在所述第一触发信号的控制下计算测量点云数据相对于几何模型的旋转变换量R＝Rk·Rk-1·…·R1和偏移变换量
Figure FDA00026918037200000211
根据所述旋转变换量R得到几何模型相对于测量点云数据的旋转变换量R′＝R-1；根据所述旋转变换量R和偏移变换量t得到几何模型相对于测量点云数据的偏移变换量t′＝-R-1·t；
所述补偿单元用于基于所述全局定位误差对待测工件几何模型进行旋转、偏移变换，修正待测工件几何模型在机器人工作空间中的安装位姿；
所述误差计算单元用于根据机器人控制单元建立的测量轨迹的特征点与测量点之间的映射关系以及特征点所在几何曲面，计算测量轨迹在特征点处的局部定位误差。
5.如权利要求4所述的工业机器人测量轨迹定位误差分析系统，其特征在于，所述机器人控制单元还用于建立测量轨迹上的特征点与测量点云数据中对应的测量点之间的映射关系，生成特征点-测量点对<Pd,Pm>。
6.如权利要求4所述的工业机器人测量轨迹定位误差分析系统，其特征在于，所述误差计算单元包括第三计算模块和第四计算模块；
所述第三计算模块用于计算待测工件测量曲面在特征点Pd处的单位法向量
Figure FDA0002691803720000031
确定待测工件测量曲面在特征点处的切平面；
所述第四计算模块用于分别将
Figure FDA0002691803720000032
在法向量
Figure FDA0002691803720000033
和所述切平面上进行投影，以
Figure FDA0002691803720000034
在法向量
Figure FDA0002691803720000035
上的投影作为法向误差，以
Figure FDA0002691803720000036
在切平面上的投影作为径向误差，计算得到测量点相对于特征点的法向误差向量
Figure FDA0002691803720000037
和径向误差向量
Figure FDA0002691803720000038
CN201910110299.9A 2019-02-11 2019-02-11 一种工业机器人测量轨迹定位误差分析方法及系统 Active CN109895094B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910110299.9A CN109895094B (zh) 2019-02-11 2019-02-11 一种工业机器人测量轨迹定位误差分析方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910110299.9A CN109895094B (zh) 2019-02-11 2019-02-11 一种工业机器人测量轨迹定位误差分析方法及系统

Publications (2)

Publication Number Publication Date
CN109895094A CN109895094A (zh) 2019-06-18
CN109895094B true CN109895094B (zh) 2020-11-24

Family

ID=66944720

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910110299.9A Active CN109895094B (zh) 2019-02-11 2019-02-11 一种工业机器人测量轨迹定位误差分析方法及系统

Country Status (1)

Country Link
CN (1) CN109895094B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110801366B (zh) * 2019-11-01 2021-11-19 中国科学院宁波工业技术研究院慈溪生物医学工程研究所 一种摇杆式康复机构的被动轨迹误差检测装置及方法
CN111152229B (zh) * 2020-02-24 2023-08-25 群滨智造科技(苏州)有限公司 3d机械视觉的机械手引导方法和装置
CN111716355A (zh) * 2020-06-16 2020-09-29 海克斯康制造智能技术(青岛)有限公司 机器人绝对定位精度补偿系统及方法
CN112549019B (zh) * 2020-11-06 2022-04-22 北京工业大学 一种基于连续动态时间规整的工业机器人轨迹准确度分析方法
CN112959323B (zh) * 2021-03-02 2022-03-11 中国工程物理研究院激光聚变研究中心 一种机器人运动误差在位检测与补偿方法及设备
CN113751824B (zh) * 2021-08-17 2022-12-13 熵智科技(深圳)有限公司 一种切坡口轨迹自动生成方法、装置、计算机设备及介质
CN113436238B (zh) * 2021-08-27 2021-11-23 湖北亿咖通科技有限公司 点云配准精度的评估方法、装置和电子设备
CN114894116B (zh) * 2022-04-08 2024-02-23 苏州瀚华智造智能技术有限公司 一种测量数据融合方法及非接触式测量设备
CN114851202B (zh) * 2022-05-20 2024-05-10 梅卡曼德（北京）机器人科技有限公司 碰撞检测方法、控制方法、抓取系统及计算机存储介质

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN100559398C (zh) * 2007-06-19 2009-11-11 北京航空航天大学 自动的深度图像配准方法
CA2951523C (en) * 2013-06-11 2021-06-01 Somatis Sensor Solutions LLC Systems and methods for sensing objects
CN105269565B (zh) * 2015-10-30 2017-04-05 福建长江工业有限公司 一种六轴磨抛工业机器人离线编程及修正方法
US10217277B2 (en) * 2015-12-04 2019-02-26 Autodesk, Inc. Keypoint-based point-pair-feature for scalable automatic global registration of large RGB-D scans
CN105760811B (zh) * 2016-01-05 2019-03-22 福州华鹰重工机械有限公司 全局地图闭环匹配方法及装置
CN107240129A (zh) * 2017-05-10 2017-10-10 同济大学 基于rgb‑d相机数据的物体及室内小场景恢复与建模方法
CN108544181B (zh) * 2018-03-27 2020-05-19 西北工业大学 一种整体叶盘损伤叶片的修复方法
CN108537805B (zh) * 2018-04-16 2021-09-21 中北大学 一种基于特征几何收益的目标识别方法
CN109255813B (zh) * 2018-09-06 2021-03-26 大连理工大学 一种面向人机协作的手持物体位姿实时检测方法

Also Published As

Publication number Publication date
CN109895094A (zh) 2019-06-18

Similar Documents

Publication Publication Date Title
CN109895094B (zh) 一种工业机器人测量轨迹定位误差分析方法及系统
CN110202575B (zh) 一种用于工业测量的机器人目标轨迹精度补偿方法
CN108748159B (zh) 一种机械臂工具坐标系自标定方法
Shu et al. Dynamic path tracking of industrial robots with high accuracy using photogrammetry sensor
CN111300406B (zh) 基于运动学分析的工业机器人轨迹精度补偿系统和方法
WO2018188276A1 (zh) 一种六自由度机器人末端空间曲线轨迹的误差建模方法
CN107607918B (zh) 一种基于机器人的柱面近场测量馈源定位及偏焦方法
US20080201015A1 (en) System for Calibration of an Industrial Robot and a Method Thereof
WO2015070010A1 (en) Calibration system and method for calibrating industrial robot
CN111360812B (zh) 一种基于相机视觉的工业机器人dh参数标定方法及标定装置
CN109591019B (zh) 一种无确定性定位特征物体的空间精确定位方法
US11554494B2 (en) Device for acquiring a position and orientation of an end effector of a robot
CN113733088B (zh) 一种基于双目视觉的机械臂运动学自标定方法
CN110977963A (zh) 一种工业机器人标定系统的自适应对准控制方法
CN109062139B (zh) 一种基于数据驱动的机器人直线轴定位误差补偿方法
Landgraf et al. A hybrid neural network approach for increasing the absolute accuracy of industrial robots
CN111687845B (zh) 一种基于惯性测量单元的机械臂运动学参数标定方法
CN115091456A (zh) 基于矩阵求解的机器人手眼标定方法
Santolaria et al. Self-alignment of on-board measurement sensors for robot kinematic calibration
CN115752507A (zh) 基于二维码导航的在线单舵轮agv参数标定方法及系统
KR20200057503A (ko) 로봇 보정 시스템 및 그것의 보정 방법
CN113580137B (zh) 基于视觉测量的移动机器人基座-工件相对位姿确定方法
Nieves et al. Laser beam multi-position alignment approach for an automated industrial robot calibration
Shu et al. Dynamic path tracking of industrial robots with high accuracy by visual servoing
Liu et al. An automated method to calibrate industrial robot joint offset using virtual line-based single-point constraint approach

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant