CN116841249A - 基于流形误差相似性的孔位姿误差补偿方法及*** - Google Patents
基于流形误差相似性的孔位姿误差补偿方法及*** Download PDFInfo
- Publication number
- CN116841249A CN116841249A CN202310763639.4A CN202310763639A CN116841249A CN 116841249 A CN116841249 A CN 116841249A CN 202310763639 A CN202310763639 A CN 202310763639A CN 116841249 A CN116841249 A CN 116841249A
- Authority
- CN
- China
- Prior art keywords
- pose
- point
- processed
- error
- reference point
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 238000012937 correction Methods 0.000 claims abstract description 58
- 239000012636 effector Substances 0.000 claims abstract description 11
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 8
- 239000011159 matrix material Substances 0.000 claims description 26
- 238000005457 optimization Methods 0.000 claims description 12
- 230000008569 process Effects 0.000 claims description 9
- 238000012545 processing Methods 0.000 claims description 8
- 238000005259 measurement Methods 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 6
- 238000004590 computer program Methods 0.000 claims description 6
- 238000003860 storage Methods 0.000 claims description 2
- 238000003754 machining Methods 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 230000009466 transformation Effects 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/404—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/33—Director till display
- G05B2219/33133—For each action define function for compensation, enter parameters
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
Abstract
本发明提供了一种基于流形误差相似性的孔位姿误差补偿方法及***,涉及机械加工技术领域,包括:步骤S1:根据离线编程获得待加工点位的目标位姿和基准点位的理论位姿;步骤S2:由机器人将末端执行器依次定位至各基准点位,并测量所述基准点位在曲面产品上的真实位姿;步骤S3:通过所述基准点位的理论位姿和真实位姿,计算位姿误差,结合补偿算法,修正曲面产品上待加工点位的目标位姿,实现待加工点位位姿误差的补偿;步骤S4:借助已加工点位的位姿数据,进一步修正待加工点位的初始法向。本发明能够实现了对待加工点位的位置坐标和初始法向的修正,大幅提升了机器人***在工件上的定位和法向精度。
Description
技术领域
本发明涉及机械加工技术领域,具体地,涉及一种基于流形误差相似性的孔位姿误差补偿方法及***。
背景技术
航空自动制孔对于孔位置精度和垂直度有较高的要求,为了保证产品上的最终制孔精度,有必要借助产品上已有的基准孔信息,实现位置和姿态的修正,保证最终制孔精度。
现有方案为利用基准孔的理论坐标和实际坐标进行最佳拟合,之后利用刚体变换实现位姿的修正。该方法适用于产品刚性较好、且基准孔位置制造误差很低的应用场景。在产品刚性弱或基准孔位置制造误差无法忽略的场景下,该方法的补偿效果存在一定的局限性。
公开号为CN110849267B的发明专利,公开了一种基于局部基准孔的移动式自动化***在产品上定位和坐标系转换的方法,首先通过移动或安装移动式自动化***到局部制孔区域,通过设备上的孔位检测装置,对基准孔进行检测,从而确定基准孔在设备坐标系下的空间位置;其次,通过对比基准孔在产品坐标系下的空间位置,可以求解当前设备坐标系和产品坐标系的坐标系齐次变换矩阵,从而确定(定位)了设备坐标系在产品坐标系下的位置;最后,将加工点在产品坐标系下的位置,通过这个坐标系齐次变换矩阵转换到设备坐标系下,从而可以在设备坐标系下对基准孔所确定的局部区域的加工点进行加工。该发明存在的缺陷为:当基准孔位置误差较大时,孔间距和排距易超差,且至少需要3个基准孔。
发明内容
针对现有技术中的缺陷,本发明提供一种基于流形误差相似性的孔位姿误差补偿方法及***。
根据本发明提供的一种基于流形误差相似性的孔位姿误差补偿方法及***,所述方案如下:
第一方面,提供了一种基于流形误差相似性的孔位姿误差补偿方法,所述方法包括:
步骤S1:根据离线编程获得待加工点位的目标位姿和基准点位的理论位姿;
步骤S2:由机器人将末端执行器依次定位至各基准点位,并测量所述基准点位在曲面产品上的真实位姿;
步骤S3:通过所述基准点位的理论位姿和真实位姿,计算位姿误差,结合补偿算法,修正曲面产品上待加工点位的目标位姿,实现待加工点位位姿误差的补偿;
步骤S4:借助已加工点位的位姿数据,进一步修正待加工点位的初始法向。
优选地,所述基准点位的初始位姿包括:
ρ=[pT,qT]T=[pT,0,nT]T
其中,p代表位置矢量,n代表单位法向矢量,q为单位四元数;
位姿误差通过如下公式计算:
其中,ρt和ρo分别为目标位姿和初始位姿,δp为位置误差,δq是指代法向误差的单位四元数,代表no至nt的旋转变换,α=arccos(no·nt)是no和nt的夹角,代表孔位姿误差的广义减法;相对应的,孔位姿修正的广义加法定义如下:
其中,代表四元数的乘法。
优选地,所述步骤S3中修正曲面产品上待加工点位的目标位姿包括:采用<Rm,ρm>实现孔位姿误差的初次修正,方式如下:
式中,ρn表示名义的孔位姿,ρm表示初次修正后的孔位姿,x、y、z分别表示笛卡尔直角坐标系的直线轴方向;其中xm、ym、zm、αm、βm、γm是位姿参数,通过求解下式所示的最优化问题获得:
其中,W代表权重矩阵,ρRri代表实际基准点位坐标,ρRmi代表修正后的基准点位位姿,||·||2表示二范数,i表示第i个基准点位。
优选地,所述步骤S3还包括二次修正,在做孔位姿二次修正前,先根据孔的目标坐标重构曲面s(u,v),对于曲面区域内的pi点,其流形坐标[u,v]通过沿法线在插值曲面上的投影获得,计算过程视为求解如下最优化问题:
[ui,vi]=arg minu,v(||(s(u,v)-pi)×ni||2)
通过如下公式计算得到二次修正后的目标位姿ρti,并将其作为待加工点位定位的目标位姿:
其中,代表基准点位误差矩阵,ci=[1-ui-vi+uivi ui-uivi vi-uivi uivi]T为插值系数矢量,CR=[cR1 cR2 cR3 cR4]为基准点位的插值系数矩阵,ρmi表示初次修正后的待加工点位位姿,ρni表示理论的待加工点位位姿。
优选地,所述步骤S4中,对于孔位姿中的法向矢量修正,利用已加工点位的数据修正待加工点位的初始法向,流程如下:
步骤S4.1:将基准点位的真实位姿ρRr和初次修正后的位姿ρRm存入矩阵Mdone中;
步骤S4.2:计算待加工点位ρi到Mdone中所有孔的距离;
步骤S4.3:选择Mdone中包围待加工点位且距离最近的四个孔作为新的基准点位;
步骤S4.4:利用新的基准点位数据,计算得到二次修正后的目标位姿ρti;
步骤S4.5:将ρti中的法向矢量作为最终定位的法向,定位完成后,设备进行在线的法向测量和调整,得到最终加工时的位姿ρri;
步骤S4.6:如果区域内的孔都已加工完成,则结束;否则将ρri和ρmi存入Mdone后,转入步骤S4.2。
优选地,对于待加工点位成线排列且只有2个基准点位的情况,将其视为曲面的2条边界曲线重合的场景进行处理。
第二方面,提供了一种基于流形误差相似性的孔位姿误差补偿***,所述***包括:
模块M1:根据离线编程获得待加工点位的目标位姿和基准点位的理论位姿;
模块M2:由机器人将末端执行器依次定位至各基准点位,并测量所述基准点位在曲面产品上的真实位姿;
模块M3:通过所述基准点位的理论位姿和真实位姿,计算位姿误差,结合补偿算法,修正曲面产品上待加工点位的目标位姿,实现待加工点位位姿误差的补偿;
模块M4:借助已加工点位的位姿数据,进一步修正待加工点位的初始法向。
优选地,所述基准点位的初始位姿包括:
ρ=[pT,qT]T=[pT,0,nT]T
其中,p代表位置矢量,n代表单位法向矢量,q为单位四元数;
位姿误差通过如下公式计算:
其中,ρt和ρo分别为目标位姿和初始位姿,δp为位置误差,δq是指代法向误差的单位四元数,代表no至nt的旋转变换,α=arccos(no·nt)是no和nt的夹角,代表孔位姿误差的广义减法;相对应的,孔位姿修正的广义加法定义如下:
其中,代表四元数的乘法;
所述模块M3中修正曲面产品上待加工点位的目标位姿包括:采用<Rm,ρm>实现孔位姿误差的初次修正,方式如下:
式中,ρn表示名义的孔位姿,ρm表示初次修正后的孔位姿,x、y、z分别表示笛卡尔直角坐标系的直线轴方向;其中xm、ym、zm、αm、βm、γm是位姿参数,通过求解下式所示的最优化问题获得:
其中,W代表权重矩阵,ρRri代表实际基准点位坐标,ρRmi代表修正后的基准点位的位姿,||·||2表示二范数,i表示第i个基准点位;
所述模块M3还包括二次修正,在做孔位姿二次修正前,先根据孔的目标坐标重构曲面s(u,v),对于曲面区域内的pi点,其流形坐标[u,v]通过沿法线在插值曲面上的投影获得,计算过程视为求解如下最优化问题:
[ui,vi]=arg minu,v(||(s(u,v)-pi)×ni||2)
通过如下公式计算得到二次修正后的目标位姿ρti,并将其作为待加工点位定位的目标位姿:
其中,代表基准点位误差矩阵,ci=[1-ui-vi+uivi ui-uivi vi-uivi uivi]T为插值系数矢量,CR=[cR1 cR2 cR3 cR4]为基准点位的插值系数矩阵,ρmi表示初次修正后的待加工点位位姿,ρni表示理论的待加工点位位姿;
所述模块M4中,对于孔位姿中的法向矢量修正,利用已加工点位的数据修正待加工点位的初始法向,流程如下:
模块M4.1:将基准点位的真实位姿ρRr和初次修正后的位姿ρRm存入矩阵Mdone中;
模块M4.2:计算待加工点位ρi到Mdone中所有孔的距离;
模块M4.3:选择Mdone中包围待加工点位且距离最近的四个孔作为新的基准点位;
模块M4.4:利用新的基准点位数据,计算得到二次修正后的目标位姿ρti;
模块M4.5:将ρti中的法向矢量作为最终定位的法向,定位完成后,设备进行在线的法向测量和调整,得到最终加工时的位姿ρri;
模块M4.6:如果区域内的孔都已加工完成,则结束;否则将ρri和ρmi存入Mdone后,转入模块M4.2;
对于待加工点位成线排列且只有2个基准点位的情况,将其视为曲面的2条边界曲线重合的场景进行处理。
第三方面,提供了一种存储有计算机程序的计算机可读存储介质,所述计算机程序被处理器执行时实现所述基于流形误差相似性的孔位姿误差补偿方法中的步骤。
第四方面,提供了一种电子设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序被处理器执行时实现所述基于流形误差相似性的孔位姿误差补偿方法中的步骤。
与现有技术相比,本发明具有如下的有益效果:
通过充分利用基准点位的位姿数据和已加工点位的法向数据,实现了对待加工点位的位置坐标和初始法向的修正,大幅提升了机器人***在工件上的定位和法向精度。
本发明的其他有益效果,将在具体实施方式中通过具体技术特征和技术方案的介绍来阐述,本领域技术人员通过这些技术特征和技术方案的介绍,应能理解所述技术特征和技术方案带来的有益技术效果。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点将会变得更明显:
图1为本发明整体流程图;
图2为本发明结构示意图;
图3为二次修正示意图;
图4为初始法向修正示意图。
附图标记:1、机器人;2、末端执行器;3、基准点位;4、待加工点位;5、曲面产品。
具体实施方式
下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明,但不以任何形式限制本发明。应当指出的是,对本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变化和改进。这些都属于本发明的保护范围。
本发明实施例提供了一种基于流形误差相似性的孔位姿误差补偿方法,参照图1所示,机器人1末端集成多功能末端执行器2,组成一个自动制孔***,末端执行器2具备制孔、法向测量、基准点位的空间坐标测量等功能。在曲面产品5上,布置有若干基准点位3。自动制孔***通过测量基准点位的位置和法向偏差,结合补偿算法,修正曲面产品5上待加工点位4的理论位姿,即补偿其位置和法向坐标。其中,本实施例中的待加工点位包括但不限于待加工孔,基准点位包括但不限于基准孔/钉。发明内容具体如下:
步骤S1:根据离线编程获得待加工点位4的目标位姿和基准点位的理论位姿。
步骤S2:由机器人1将末端执行器2依次定位至各基准点位3,并测量所述基准点位3在曲面产品5上的真实位姿;
步骤S3:通过所述基准点位3的理论位姿和真实位姿,计算位姿误差,结合补偿算法,修正曲面产品5上待加工点位4的目标位姿,实现待加工点位4位姿误差的补偿;
步骤S4:借助已加工点位的位姿数据,进一步修正待加工点位4的初始法向。
其中,基准点位的初始位姿包括:
ρ=[pT,qT]T=[pT,0,nT]T
其中,p代表位置矢量,n代表单位法向矢量,q为单位四元数;
位姿误差通过如下公式计算:
其中,ρt和ρo分别为目标位姿和初始位姿,δp为位置误差,δq是指代法向误差的单位四元数,代表no至nt的旋转变换,α=arccos(no·nt)是no和nt的夹角,代表孔位姿误差的广义减法;相对应的,孔位姿修正的广义加法定义如下:
其中,代表四元数的乘法。
具体地,步骤S3中修正曲面产品上待加工点位的目标位姿包括:采用<Rm,ρm>实现孔位姿误差的初次修正,方式如下:
式中,ρn表示名义的孔位姿,ρm表示初次修正后的孔位姿,x、y、z分别表示笛卡尔直角坐标系的直线轴方向;其中xm、ym、zm、αm、βm、γm是位姿参数,通过求解下式所示的最优化问题获得:
其中,W代表权重矩阵,ρRri代表实际基准点位坐标,ρRmi代表修正后的基准点位的位姿,||·||2表示二范数,i表示第i个基准点位。
在做孔位姿二次修正前,先根据孔的目标坐标重构曲面s(u,v),对于曲面区域内的pi点,其流形坐标[u,v]通过沿法线在插值曲面上的投影获得,如图2所示。计算过程视为求解如下最优化问题:
[ui,vi]=arg minu,v(||(s(u,v)-pi)×ni||2)
参照图3所示,通过如下公式计算得到二次修正后的目标位姿ρti,并将其作为待加工点位定位的目标位姿:
其中,代表基准点位误差矩阵,ci=[1-ui-vi+uivi ui-uivi vi-uivi uivi]T为插值系数矢量,CR=[cR1 cR2 cR3 cR4]为基准点位的插值系数矩阵,ρmi表示初次修正后的待加工点位位姿,ρni表示理论的待加工点位位姿。
参照图4所示,步骤S4中,对于孔位姿中的法向矢量修正,利用已加工点位的数据修正待加工点位的初始法向,流程如下:
步骤S4.1:将基准点位的真实位姿ρRr和初次修正后的位姿ρRm存入矩阵Mdone中;
步骤S4.2:计算待加工点位ρi到Mdone中所有孔的距离;
步骤S4.3:选择Mdone中包围待加工点位且距离最近的四个孔作为新的基准点位;
步骤S4.4:利用新的基准点位数据,计算得到二次修正后的目标位姿ρti;
步骤S4.5:将ρti中的法向矢量作为最终定位的法向,定位完成后,设备进行在线的法向测量和调整,得到最终加工时的位姿ρri;
步骤S4.6:如果区域内的孔都已加工完成,则结束;否则将ρri和ρmi存入Mdone后,转入步骤S4.2。
对于待加工点位成线排列且只有2个基准点位的情况,将其视为曲面的2条边界曲线重合的场景进行处理。
本发明还提供一种基于流形误差相似性的孔位姿误差补偿***,所述基于流形误差相似性的孔位姿误差补偿***可以通过执行所述基于流形误差相似性的孔位姿误差补偿方法的流程步骤予以实现,即本领域技术人员可以将所述基于流形误差相似性的孔位姿误差补偿方法理解为所述基于流形误差相似性的孔位姿误差补偿***的优选实施方式。
该***根据离线编程获得的理论位姿,机器人将末端执行器依次定位至各基准点位,并测量基准点位的实际位姿,之后通过如下两次修正实现待加工点位位姿误差的补偿。具体如下:
模块M1:根据离线编程获得待加工点位的目标位姿和基准点位的理论位姿;
模块M2:由机器人将末端执行器依次定位至各基准点位,并测量所述基准点位在曲面产品上的真实位姿;
模块M3:通过所述基准点位的理论位姿和真实位姿,计算位姿误差,结合补偿算法,修正曲面产品上待加工点位的目标位姿,实现待加工点位位姿误差的补偿;
模块M4:借助已加工点位的位姿数据,进一步修正待加工点位的初始法向。
其中,基准点位的初始位姿包括:
ρ=[pT,qT]T=[pT,0,nT]T
其中,p代表位置矢量,n代表单位法向矢量,q为单位四元数;
位姿误差通过如下公式计算:
其中,ρt和ρo分别为目标位姿和初始位姿,δp为位置误差,δq是指代法向误差的单位四元数,代表no至nt的旋转变换,α=arccos(no·nt)是no和nt的夹角,代表孔位姿误差的广义减法;相对应的,孔位姿修正的广义加法定义如下:
其中,代表四元数的乘法。
具体地,模块M3中修正曲面产品上待加工点位的目标位姿包括:采用<Rm,ρm>实现孔位姿误差的初次修正,方式如下:
式中,ρn表示名义的孔位姿,ρm表示初次修正后的孔位姿,x、y、z分别表示笛卡尔直角坐标系的直线轴方向;其中xm、ym、zm、αm、βm、γm是位姿参数,通过求解下式所示的最优化问题获得:
其中,W代表权重矩阵,ρRri代表实际基准点位坐标,ρRmi代表修正后的基准点位的位姿,||·||2表示二范数,i表示第i个基准点位。
在做孔位姿二次修正前,先根据孔的目标坐标重构曲面s(u,v),对于曲面区域内的pi点,其流形坐标[u,v]通过沿法线在插值曲面上的投影获得,如图2所示。计算过程视为求解如下最优化问题:
[ui,vi]=arg minu,v(||(s(u,v)-pi)×ni||2)
参照图3所示,通过如下公式计算得到二次修正后的目标位姿ρti,并将其作为待加工点位定位的目标位姿:
其中,代表基准点位误差矩阵,ci=[1-ui-vi+uivi ui-uivi vi-uivi uivi]T为插值系数矢量,CR=[cR1 cR2 cR3 cR4]为基准点位的插值系数矩阵,ρmi表示初次修正后的待加工点位位姿,ρni表示理论的待加工点位位姿;
参照图4所示,模块M4中,对于孔位姿中的法向矢量修正,利用已加工点位的数据修正待加工点位的初始法向,流程如下:
模块M4.1:将基准点位的真实位姿ρRr和初次修正后的位姿ρRm存入矩阵Mdone中;
模块M4.2:计算待加工点位ρi到Mdone中所有孔的距离;
模块M4.3:选择Mdone中包围待加工点位且距离最近的四个孔作为新的基准点位;
模块M4.4:利用新的基准点位数据,计算得到二次修正后的目标位姿ρti;
模块M4.5:将ρti中的法向矢量作为最终定位的法向,定位完成后,设备进行在线的法向测量和调整,得到最终加工时的位姿ρri;
模块M4.6:如果区域内的孔都已加工完成,则结束;否则将ρri和ρmi存入Mdone后,转入模块M4.2;
对于待加工点位成线排列且只有2个基准点位的情况,将其视为曲面的2条边界曲线重合的场景进行处理。
本发明实施例提供了一种基于流形误差相似性的孔位姿误差补偿方法及***,通过充分利用基准点位的位姿数据和已加工点位的法向数据,实现了对待加工点位的位置坐标和初始法向的修正,大幅提升了机器人***在工件上的定位和法向精度。
本领域技术人员知道,除了以纯计算机可读程序代码方式实现本发明提供的***及其各个装置、模块、单元以外,完全可以通过将方法步骤进行逻辑编程来使得本发明提供的***及其各个装置、模块、单元以逻辑门、开关、专用集成电路、可编程逻辑控制器以及嵌入式微控制器等的形式来实现相同功能。所以,本发明提供的***及其各项装置、模块、单元可以被认为是一种硬件部件,而对其内包括的用于实现各种功能的装置、模块、单元也可以视为硬件部件内的结构;也可以将用于实现各种功能的装置、模块、单元视为既可以是实现方法的软件模块又可以是硬件部件内的结构。
以上对本发明的具体实施例进行了描述。需要理解的是,本发明并不局限于上述特定实施方式,本领域技术人员可以在权利要求的范围内做出各种变化或修改,这并不影响本发明的实质内容。在不冲突的情况下,本申请的实施例和实施例中的特征可以任意相互组合。
Claims (10)
1.一种基于流形误差相似性的孔位姿误差补偿方法,其特征在于,包括:
步骤S1:根据离线编程获得待加工点位的目标位姿和基准点位的理论位姿;
步骤S2:由机器人将末端执行器依次定位至各基准点位,并测量所述基准点位在曲面产品上的真实位姿;
步骤S3:通过所述基准点位的理论位姿和真实位姿,计算位姿误差,结合补偿算法,修正曲面产品上待加工点位的目标位姿,实现待加工点位位姿误差的补偿;
步骤S4:借助已加工点位的位姿数据,进一步修正待加工点位的初始法向。
2.根据权利要求1所述的基于流形误差相似性的孔位姿误差补偿方法,其特征在于,所述基准点位的初始位姿包括:
ρ=[pT,qT]T=[pT,0,nT]T
其中,p代表位置矢量,n代表单位法向矢量,q为单位四元数;
位姿误差通过如下公式计算:
其中,ρt和ρo分别为目标位姿和初始位姿,δp为位置误差,δq是指代法向误差的单位四元数,代表no至nt的旋转变换,α=arccos(no·nt)是no和nt的夹角,代表孔位姿误差的广义减法;相对应的,孔位姿修正的广义加法定义如下:
其中,代表四元数的乘法。
3.根据权利要求1所述的基于流形误差相似性的孔位姿误差补偿方法,其特征在于,所述步骤S3中修正曲面产品上待加工点位的目标位姿包括:采用<Rm,ρm>实现孔位姿误差的初次修正,方式如下:
式中,ρn表示名义的孔位姿,ρm表示初次修正后的孔位姿,x、y、z分别表示笛卡尔直角坐标系的直线轴方向;其中xm、ym、zm、αm、βm、γm是位姿参数,通过求解下式所示的最优化问题获得:
其中,W代表权重矩阵,ρRri代表实际基准点位坐标,ρRmi代表修正后的基准点位的位姿,||.||2表示二范数,i表示第i个基准点位。
4.根据权利要求3所述的基于流形误差相似性的孔位姿误差补偿方法,其特征在于,所述步骤S3还包括二次修正,在做孔位姿二次修正前,先根据孔的目标坐标重构曲面s(u,v),对于曲面区域内的pi点,其流形坐标[u,v]通过沿法线在插值曲面上的投影获得,计算过程视为求解如下最优化问题:
[ui,vi]=argminu,v(||(s(u,v)-pi)×ni||2)
通过如下公式计算得到二次修正后的目标位姿ρti,并将其作为待加工点位定位的目标位姿:
其中,代表基准点位误差矩阵,ci=[1-ui-vi+uivi ui-uivi vi-uivi uivi]T为插值系数矢量,CR=[cR1 cR2 cR3 cR4]为基准点位的插值系数矩阵,ρmi表示初次修正后的待加点位位姿,ρni表示理论的待加工点位位姿。
5.根据权利要求4所述的基于流形误差相似性的孔位姿误差补偿方法,其特征在于,所述步骤S4中,对于孔位姿中的法向矢量修正,利用已加工点位的数据修正待加工点位的初始法向,流程如下:
步骤S4.1:将基准点位的真实位姿ρRr和初次修正后的位姿ρRm存入矩阵Mdone中;
步骤S4.2:计算待加工点位ρi到Mdone中所有孔的距离;
步骤S4.3:选择Mdone中包围待加工点位且距离最近的四个孔作为新的基准点位;
步骤S4.4:利用新的基准点位数据,计算得到二次修正后的目标位姿ρti;
步骤S4.5:将ρti中的法向矢量作为最终定位的法向,定位完成后,设备进行在线的法向测量和调整,得到最终加工时的位姿ρri;
步骤S4.6:如果区域内的孔都已加工完成,则结束;否则将ρri和ρmi存入Mdone后,转入步骤S4.2。
6.根据权利要求4所述的基于流形误差相似性的孔位姿误差补偿方法,其特征在于,对于待加工点位成线排列且只有2个基准点位的情况,将其视为曲面的2条边界曲线重合的场景进行处理。
7.一种基于流形误差相似性的孔位姿误差补偿***,其特征在于,包括:
模块M1:根据离线编程获得待加工点位的目标位姿和基准点位的理论位姿;
模块M2:由机器人将末端执行器依次定位至各基准点位,并测量所述基准点位在曲面产品上的真实位姿;
模块M3:通过所述基准点位的理论位姿和真实位姿,计算位姿误差,结合补偿算法,修正曲面产品上待加工点位的目标位姿,实现待加工点位位姿误差的补偿;
模块M4:借助已加工点位的位姿数据,进一步修正待加工点位的初始法向。
8.根据权利要求7所述的基于流形误差相似性的孔位姿误差补偿***,其特征在于,所述基准点位的初始位姿包括:
ρ=[pT,qT]T=[pT,0,nT]T
其中,p代表位置矢量,n代表单位法向矢量,q为单位四元数;
位姿误差通过如下公式计算:
其中,ρt和ρo分别为目标位姿和初始位姿,δp为位置误差,δq是指代法向误差的单位四元数,代表no至nt的旋转变换,α=arccos(no·nt)是no和nt的夹角,代表孔位姿误差的广义减法;相对应的,孔位姿修正的广义加法定义如下:
其中,代表四元数的乘法;
所述模块M3中修正曲面产品上待加工点位的目标位姿包括:采用<Rm,ρm>实现孔位姿误差的初次修正,方式如下:
式中,ρn表示名义的孔位姿,ρm表示初次修正后的孔位姿,x、y、z分别表示笛卡尔直角坐标系的直线轴方向;其中xm、ym、zm、αm、βm、γm是位姿参数,通过求解下式所示的最优化问题获得:
其中,W代表权重矩阵,ρRri代表实际基准点位坐标,ρRmi代表修正后的基准点位的位姿,||.||2表示二范数,i表示第i个基准点位;
所述模块M3还包括二次修正,在做孔位姿二次修正前,先根据孔的目标坐标重构曲面s(u,v),对于曲面区域内的pi点,其流形坐标[u,v]通过沿法线在插值曲面上的投影获得,计算过程视为求解如下最优化问题:
[ui,vi]=argminu,v(||(s(u,v)-pi)×ni||2)
通过如下公式计算得到二次修正后的目标位姿ρti,并将其作为待加工点位定位的目标位姿:
其中,代表基准点位误差矩阵,ci=[1-ui-vi+uivi ui-uivi vi-uivi uivi]T为插值系数矢量,CR=[cR1 cR2 cR3 cR4]为基准点位的插值系数矩阵,ρmi表示初次修正后的待加点位位姿,ρni表示理论的待加工点位位姿;
所述模块M4中,对于孔位姿中的法向矢量修正,利用已加工点位的数据修正待加工点位的初始法向,流程如下:
模块M4.1:将基准点位的真实位姿ρRr和初次修正后的位姿ρRm存入矩阵Mdone中;
模块M4.2:计算待加工点位ρi到Mdone中所有孔的距离;
模块M4.3:选择Mdone中包围待加工点位且距离最近的四个孔作为新的基准点位;
模块M4.4:利用新的基准点位数据,计算得到二次修正后的目标位姿ρti;
模块M4.5:将ρti中的法向矢量作为最终定位的法向,定位完成后,设备进行在线的法向测量和调整,得到最终加工时的位姿ρri;
模块M4.6:如果区域内的孔都已加工完成,则结束;否则将ρri和ρmi存入Mdone后,转入模块M4.2;
对于待加工点位成线排列且只有2个基准点位的情况,将其视为曲面的2条边界曲线重合的场景进行处理。
9.一种存储有计算机程序的计算机可读存储介质,其特征在于,所述计算机程序被处理器执行时实现权利要求1至6中任一项所述的基于流形误差相似性的孔位姿误差补偿方法的步骤。
10.一种电子设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至6中任一项所述的基于流形误差相似性的孔位姿误差补偿方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310763639.4A CN116841249A (zh) | 2023-06-26 | 2023-06-26 | 基于流形误差相似性的孔位姿误差补偿方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310763639.4A CN116841249A (zh) | 2023-06-26 | 2023-06-26 | 基于流形误差相似性的孔位姿误差补偿方法及*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116841249A true CN116841249A (zh) | 2023-10-03 |
Family
ID=88159236
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310763639.4A Pending CN116841249A (zh) | 2023-06-26 | 2023-06-26 | 基于流形误差相似性的孔位姿误差补偿方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116841249A (zh) |
-
2023
- 2023-06-26 CN CN202310763639.4A patent/CN116841249A/zh active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110385720B (zh) | 一种基于深度神经网络的机器人定位误差补偿方法 | |
CN113001535B (zh) | 机器人工件坐标系自动校正***与方法 | |
CN111360827A (zh) | 一种视觉伺服切换控制方法及*** | |
CN112318498B (zh) | 一种考虑参数耦合的工业机器人标定方法 | |
WO2021169855A1 (zh) | 机器人校正方法、装置、计算机设备及存储介质 | |
CN111168719B (zh) | 一种基于定位工装的机器人校准方法及*** | |
CN114523477B (zh) | 关节位姿的校准方法、***及存储介质 | |
CN105574884B (zh) | 一种医疗机器人dh参数标定方法 | |
EP3919995A1 (en) | Systems and methods for compensating for spring back of structures formed through incremental sheet forming | |
CN114012724B (zh) | 一种基于探针的工业机器人坐标系自动标定方法 | |
CN117400267B (zh) | 机器人焊接路径生成方法、装置、计算机设备和存储介质 | |
CN114654466A (zh) | 自动标定方法、装置、***、电子设备及存储介质 | |
CN113814988A (zh) | 7自由度srs型机械臂逆解的解析方法、装置及电子设备 | |
JP5505155B2 (ja) | ロボットシステムおよびロボット制御方法 | |
CN116841249A (zh) | 基于流形误差相似性的孔位姿误差补偿方法及*** | |
CN117021113A (zh) | 一种机械臂协作定位装配方法、***及介质 | |
CN109397293B (zh) | 一种基于移动机器人的地面水平误差建模及补偿方法 | |
CN114750160B (zh) | 机器人控制方法、装置、计算机设备和存储介质 | |
CN116276990A (zh) | 基于神经网络训练的两自由度并联结构运动学正解方法 | |
CN112847441B (zh) | 基于梯度下降法的六轴机器人坐标偏移检测方法和装置 | |
CN114310873B (zh) | 位姿转换模型的生成方法、控制方法、***、设备和介质 | |
CN112184561B (zh) | 一种基于多元搜索的火箭级段位姿纠偏方法及其装置 | |
CN115056213A (zh) | 一种面向大型复杂构件的机器人轨迹自适应修正方法 | |
CN111435244B (zh) | 一种回环闭合方法、装置及机器人 | |
CN116859920B (zh) | 精度补偿方法和装置、电子设备及打孔*** |
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 |