CN113927599B - 绝对精度补偿方法及系统、设备和计算机可读存储介质 - Google Patents
绝对精度补偿方法及系统、设备和计算机可读存储介质 Download PDFInfo
- Publication number
- CN113927599B CN113927599B CN202111308845.3A CN202111308845A CN113927599B CN 113927599 B CN113927599 B CN 113927599B CN 202111308845 A CN202111308845 A CN 202111308845A CN 113927599 B CN113927599 B CN 113927599B
- Authority
- CN
- China
- Prior art keywords
- robot
- error
- joint
- parameters
- compensation
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 239000011159 matrix material Substances 0.000 claims description 79
- 230000009466 transformation Effects 0.000 claims description 19
- 230000005489 elastic deformation Effects 0.000 claims description 7
- 230000005484 gravity Effects 0.000 claims description 7
- 238000011426 transformation method Methods 0.000 claims description 7
- 206010023230 Joint stiffness Diseases 0.000 claims description 6
- 238000004590 computer program Methods 0.000 claims description 4
- 230000008859 change Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明提供一种绝对精度补偿方法及系统、设备和计算机可读存储介质,其中该方法包括:几何误差补偿步骤:在机器人运动学建模时将DH参数误差引起的末端误差直接补偿可配置的运动学参数;非几何误差补偿步骤:建立机器人的柔性误差模型,通过机器人的控制器来补偿柔性误差模型中的误差。本发明提供的技术方案基于关节柔性和配置参数的绝对精度补偿,直接补偿运动学配置参数,不需要修改机器人正逆运动学,可直接应用于工业机器人。
Description
技术领域
本发明涉及机器人领域,尤其涉及绝对精度补偿方法及系统、设备和计算机可读存储介质。
背景技术
随着机器人与视觉等其它传感器的结合应用技术越来越成熟,对机器人的定位精度要求也越来越高。
一般工业机器人的重复定位精度能达到较高水平,而绝对定位精度却相对较低,无法满足一些精度要求较高的应用领域的需求。提高机器人绝对定位精度的一种有效方法是机器人运动学标定,例如现有技术有些是基于位移传感器同时实现了机器人本体几何参数误差及机器人末端坐标系、基坐标系的标定,但是这种方案由于没有考虑关节柔性带来的影响,因此应用具有很大局限性,无法满足一些精度要求较高的应用领域的需求。
又例如,现有技术还有一些是综合位姿误差模型与刚度补偿的机器人精度补偿,通过实验获取机器人本体变形量对载荷的变化曲线,调取离线结果对末端精度进行二次补偿,但是由于变化曲线需要大量不同位置和不同载荷的实验来确定,另外数据库步长将直接影响补偿的精度,且没有考虑不同姿态的影响,因此,这种方案也有很大的应用局限性。
发明内容
有鉴于此,本发明的目的在于提供一种绝对精度补偿方法及系统、设备和计算机可读存储介质,基于关节柔性和配置参数的绝对精度补偿,直接补偿运动学配置参数,不需要修改机器人正逆运动学,可直接应用于工业机器人,适合大规模应用。
本发明提出一种绝对精度补偿方法,所述方法包括:
几何误差补偿步骤:在机器人运动学建模时将DH参数误差引起的末端误差直接补偿可配置的运动学参数;
非几何误差补偿步骤:建立所述机器人的柔性误差模型,通过所述机器人的控制器来补偿所述柔性误差模型中的误差。
优选的,所述几何误差补偿步骤具体包括:
对所述机器人进行运动学建模,得到相邻两连杆{i-1}{i}之间的齐次坐标变换矩阵为:
上式(1)中,s=sin,c=cos,ai-1为连杆长度,ai-1为关节扭角,di为连杆偏距,θi为关节转角,x为连杆坐标系X轴坐标,z为连杆坐标系Z轴坐标;
根据微分变换法获取相邻连杆的齐次变换误差为:
上式(2)表示任意关节的DH参数误差在关节坐标系下产生的误差,其中,Δθi是连杆夹角偏差,Δai-1是连杆扭角偏差,Δdi是连杆距离偏差,Δai-1是连杆长度偏差;
根据所建模型获取所述机器人的末端坐标系与基坐标系之间的运动学关系为:
根据上式(3)得到所述机器人由DH参数引起的末端位姿误差模型为:
ΔpDH=JDHΔηDH (4)
上式(4)中,ΔpDH为所述机器人末端位姿误差向量,为位姿误差对应的辨识雅克比矩阵,ΔηDH=[Δθ Δd Δα Δa]为各关节误差参数向量。
优选的,所述非几何误差补偿步骤具体还包括:
建立所述机器人的关节力矩和各关节的弹性变形之间的关系为:
τ=Kc·dθc (5)
上式(5)中,Kc=diag(K1,…,Kn)为所述机器人的关节刚度矩阵,τ为施加在关节上的等效力矩,dθc为关节角度偏差;
根据所述机器人的运动雅克比ΔX=Jc(θ)dθc和力雅可比并联立上式(4)以得到:
上式(6)中,Sc=[S1,…,Sn]=[1/K1,…,1/Kn]为各关节的柔度参数,Jc为所述机器人的雅克比矩阵,τG为所述机器人的各关节重力矩,F为机器人所受的外力;
结合上式(4)和上式(6),将所述机器人的末端位姿的误差模型扩展为:
Δp=JΔη (7)
上式(7)中,J=[JDH JA]为辨识雅克比矩阵,Δη=[ΔηDH Sc]为包含几何误差参数和柔度参数的误差参数矩阵;
求解上式(7)以获取所述机器人的所述几何误差参数和所述柔度参数,并通过所述机器人的控制器来补偿误差。
优选的,所述方法还包括辨识步骤,所述辨识步骤具体包括:
在所述机器人的工作空间内,给定任意的目标位置,控制所述机器人运动到给定的所述目标位置,记录所述机器人的各关节位置并代入求得所述辨识雅克比矩阵I,利用激光跟踪仪测量给定的所述目标位置的末端实际位置,将所述末端实际位置与所建模型位置做差运算得到上式(7)中的Δp;
采用最小二乘法求解上式(7)以得到所述机器人的所述误差参数矩阵Δη,将所述误差参数矩阵中的几何误差参数ΔηDH直接补偿至所述DH参数,得到修正后的DH参数和所述机器人的零位位置;
将所述误差参数矩阵中的柔度参数Sc直接代入到上式(5)中计算得到各轴角度补偿量;
控制补偿后的所述机器人重复运动到给定的所述目标位置,记录所述机器人各关节位置,使用激光跟踪仪记录所述目标位置的末端实际位置,再次计算得到所述机器人的所述误差参数矩阵;
判断所述误差参数矩阵中的误差参数的变化量是否满足精度要求;
若满足精度要求,则辨识完成。
另一方面,本发明还提供一种绝对精度补偿系统,所述系统包括几何误差补偿模块和非几何误差补偿模块,其中,
几何误差补偿模块,用于在机器人运动学建模时将DH参数误差引起的末端误差直接补偿可配置的运动学参数;
非几何误差补偿模块,用于建立所述机器人的柔性误差模型,通过所述机器人的控制器来补偿所述柔性误差模型中的误差。
优选的,所述几何误差补偿模块具体用于:
对所述机器人进行运动学建模,得到相邻两连杆{i-1}{i}之间的齐次坐标变换矩阵为:
上式(1)中,s=sin,c=cos,ai-1为连杆长度,ai-1为关节扭角,di为连杆偏距,θi为关节转角,x为连杆坐标系X轴坐标,z为连杆坐标系Z轴坐标;
根据微分变换法获取相邻连杆的齐次变换误差为:
上式(2)表示任意关节的DH参数误差在关节坐标系下产生的误差,其中,Δθi是连杆夹角偏差,Δai-1是连杆扭角偏差,Δdi是连杆距离偏差,Δai-1是连杆长度偏差;
根据所建模型获取所述机器人的末端坐标系与基坐标系之间的运动学关系为:
根据上式(3)得到所述机器人由DH参数引起的末端位姿误差模型为:
ΔpDH=JDHΔηDH (4)
上式(4)中,ΔpDH为所述机器人末端位姿误差向量,为位姿误差对应的辨识雅克比矩阵,ΔηDH=[Δθ Δd Δα Δa]为各关节误差参数向量。
优选的,所述非几何误差补偿模块具体用于:
建立所述机器人的关节力矩和各关节的弹性变形之间的关系为:
τ=Kc·dθc (5)
上式(5)中,Kc=diag(k1,…,Kn)为所述机器人的关节刚度矩阵,τ为施加在关节上的等效力矩,dθc为关节角度偏差;
根据所述机器人的运动雅克比ΔX=Jc(θ)dθc和力雅可比并联立上式(4)以得到:
上式(6)中,Sc=[S1,…,Sn]=[1/K1,…,1/Kn]为各关节的柔度参数,Jc为所述机器人的雅克比矩阵,τG为所述机器人的各关节重力矩,F为机器人所受的外力;
结合上式(4)和上式(6),将所述机器人的末端位姿的误差模型扩展为:
Δp=JΔη (7)
上式(7)中,J=[JDH JA]为辨识雅克比矩阵,Δη=[ΔηDH Sc]为包含几何误差参数和柔度参数的误差参数矩阵;
求解上式(7)以获取所述机器人的所述几何误差参数和所述柔度参数,并通过所述机器人的控制器来补偿误差。
优选的,所述系统还包括辨识模块,所述辨识模块具体用于:
在所述机器人的工作空间内,给定任意的目标位置,控制所述机器人运动到给定的所述目标位置,记录所述机器人的各关节位置并代入求得所述辨识雅克比矩阵J,利用激光跟踪仪测量给定的所述目标位置的末端实际位置,将所述末端实际位置与所建模型位置做差运算得到上式(7)中的Δp;
采用最小二乘法求解上式(7)以得到所述机器人的所述误差参数矩阵Δη,将所述误差参数矩阵中的几何误差参数ΔηDH直接补偿至所述DH参数,得到修正后的DH参数和所述机器人的零位位置;
将所述误差参数矩阵中的柔度参数Sc直接代入到上式(5)中计算得到各轴角度补偿量;
控制补偿后的所述机器人重复运动到给定的所述目标位置,记录所述机器人各关节位置,使用激光跟踪仪记录所述目标位置的末端实际位置,再次计算得到所述机器人的所述误差参数矩阵;
判断所述误差参数矩阵中的误差参数的变化量是否满足精度要求;
若满足精度要求,则辨识完成。
再一方面,本发明还提供一种设备,其中,所述设备包括存储器和处理器,所述存储器存储计算机处理指令,所述处理器通过调用所述计算机处理指令来执行前述的绝对精度补偿方法。
又一方面,本发明还提供一种计算机可读存储介质,其中,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现前述的绝对精度补偿方法的步骤。
本发明提供的技术方案具有以下优点:基于关节柔性和配置参数的绝对精度补偿,直接补偿运动学配置参数,不需要修改机器人正逆运动学,可直接应用于工业机器人,适合大规模应用。
附图说明
图1为本发明一实施方式中绝对精度补偿方法的流程示意图;
图2为本发明一实施方式中绝对精度补偿系统的结构示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
以下将对本发明所提供的一种绝对精度补偿方法及其系统进行详细说明。
请参阅图1,为本发明一实施方式中绝对精度补偿方法的流程示意图。
在步骤S1中,几何误差补偿步骤:在机器人运动学建模时将DH参数误差引起的末端误差直接补偿可配置的运动学参数。
在本实施方式中,所述几何误差补偿步骤具体包括:
对所述机器人进行运动学建模,得到相邻两连杆{i-1}{i}之间的齐次坐标变换矩阵为:
上式(1)中,s=sin,c=cos,ai-1为连杆长度,ai-1为关节扭角,di为连杆偏距,θi为关节转角,x为连杆坐标系X轴坐标,z为连杆坐标系Z轴坐标;
根据微分变换法获取相邻连杆的齐次变换误差为:
上式(2)表示任意关节的DH参数误差在关节坐标系下产生的误差,其中,Δθi是连杆夹角偏差,Δai-1是连杆扭角偏差,Δdi是连杆距离偏差,Δai-1是连杆长度偏差;
根据所建模型获取所述机器人的末端坐标系与基坐标系之间的运动学关系为:
根据上式(3)得到所述机器人由DH参数引起的末端位姿误差模型为:
ΔpDH=JDHΔηDH (4)
上式(4)中,ΔpDH为所述机器人末端位姿误差向量,为位姿误差对应的辨识雅克比矩阵,ΔηDH=[Δθ Δd Δα Δa]为各关节误差参数向量。
在本实施方式中,上述的机器人即为工业机器人,采用修正的D-H模型(即MDH模型)对工业机器人进行运动学建模,另外,由于工业机器人各个关节参数存在误差,因此需要根据微分变换法获取相邻连杆的齐次变换误差。
在本实施方式中,对于N关节工业机器人来说,需要根据所建模型获取所述机器人的末端坐标系与基坐标系之间的运动学关系,而且,在上式(3)中需要忽略高阶项微分并化简之后,才能得到机器人由DH参数引起的末端位姿误差模型。在本实施方式中,上式中各关节误差参数向量仅考虑工业机器人可配置的DH参数项,其余项置0,以传统工业六轴机器人为例,即
ΔηDH=[Δd1 Δa1 Δa2 Δa3 Δd4 Δθ1 Δθ2 Δθ3 Δθ4 Δθ5 Δθ6]。
在步骤S2中,非几何误差补偿步骤:建立机器人的柔性误差模型,通过机器人的控制器来补偿柔性误差模型中的误差。
在本实施方式中,所述非几何误差补偿步骤具体还包括:
建立所述机器人的关节力矩和各关节的弹性变形之间的关系为:
τ=Kc·dθc (5)
上式(5)中,Kc=diag(K1,…,Kn)为所述机器人的关节刚度矩阵,τ为施加在关节上的等效力矩,dθc为关节角度偏差;
根据所述机器人的运动雅克比ΔX=Jc(θ)dθc和力雅可比并联立上式(4)以得到:
上式(6)中,Sc=[S1,…,Sn]=[1/K1,…,1/Kn]为各关节的柔度参数,Jc为所述机器人的雅克比矩阵,τG为所述机器人的各关节重力矩,F为机器人所受的外力;
将几何误差和非几何误差耦合在一起,结合上式(4)和上式(6),将所述机器人的末端位姿的误差模型扩展为:
Δp=JΔη (7)
上式(7)中,J=[JDH JA]为辨识雅克比矩阵,Δη=[ΔηDH Sc]为包含几何误差参数和柔度参数的误差参数矩阵;
求解上式(7)以获取所述机器人的所述几何误差参数和所述柔度参数,并通过所述机器人的控制器来补偿误差。
在本实施方式中,采用线性扭转弹簧模型对工业机器人关节的柔性变形进行建模,即柔性变形造成的关节角度偏差与所受的力(力矩)成正比关系,工业机器人关节受力主要包括外加负载及机器人本体自重两个部分,因此,建立所述机器人的关节力矩和各关节的弹性变形之间的关系,如上式(5)所示。
在本实施方式中,正是考虑到关节柔性对工业机器人末端位置的影响,因此基于关节柔性和配置参数的绝对精度补偿,直接补偿运动学配置参数,不需要修改机器人正逆运动学,可直接应用于工业机器人,适合大规模应用,而且,通过控制器来补偿误差,提高了机器人的定位精度。
在本实施方式中,为了进一步提高机器人的定位精度。本发明的绝对精度补偿方法还包括辨识步骤,所述辨识步骤具体包括:
在所述机器人的工作空间内,给定任意的目标位置,控制所述机器人运动到给定的所述目标位置,记录所述机器人的各关节位置并代入求得所述辨识雅克比矩阵J,利用激光跟踪仪测量给定的所述目标位置的末端实际位置,将所述末端实际位置与所建模型位置做差运算得到上式(7)中的Δp;
采用最小二乘法求解上式(7)以得到所述机器人的所述误差参数矩阵Δη,将所述误差参数矩阵中的几何误差参数ΔηDH直接补偿至所述DH参数,得到修正后的DH参数和所述机器人的零位位置;
将所述误差参数矩阵中的柔度参数Sc直接代入到上式(5)中计算得到各轴角度补偿量;
控制补偿后的所述机器人重复运动到给定的所述目标位置,记录所述机器人各关节位置,使用激光跟踪仪记录所述目标位置的末端实际位置,再次计算得到所述机器人的所述误差参数矩阵;
判断所述误差参数矩阵中的误差参数的变化量是否满足精度要求;
若满足精度要求,则辨识完成。若不满足精度要求,则重复上述第四个步骤,即控制控制补偿后的所述机器人重复运动到给定的所述目标位置,重复该步骤。
在本实施方式中,以传统工业六轴机器人为例,取各关节误差参数向量
ΔηDH=[Δd1 Δa1 Δa2 Δa3 Δd4 Δθ1 Δθ2 Δθ3 Δθ4 Δθ5 Δθ6];
由于机器人1轴重力为0,1关节柔度参数不可辨识,取各关节柔度参数
Sc=[S2,S3,...,S6];
其中的辨识步骤具体包括:
在机器人的工作空间内,给定50个目标位置,控制机器人运动到给定的目标位置,记录机器人的各关节位置并代入求得辨识雅克比矩阵J,利用激光跟踪仪测量给定的目标位置的末端实际位置,将末端实际位置与所建模型位置做差运算得到上式(7)中的Δp;
采用最小二乘法求解上式(7)以得到机器人的误差参数矩阵Δη,将误差参数矩阵中的几何误差参数ΔηDH直接补偿至DH参数,得到修正后的DH参数和机器人的零位位置;
将误差参数矩阵中的柔度参数Sc直接代入到上式(5)中计算得到各轴角度补偿量;
控制补偿后的机器人重复运动到给定的目标位置,记录机器人各关节位置,使用激光跟踪仪记录目标位置的末端实际位置,再次计算得到机器人的误差参数矩阵;
判断误差参数矩阵中的误差参数的变化量是否满足精度要求;
若满足精度要求,则辨识完成。若不满足精度要求,则重复上述第四个步骤。
在本实施方式中,通过迭代重新求解误差参数的辨识方法,直接判断误差参数的变化量是否满足精度要求,提升了绝对精度误差模型的精度,提高了机器人的绝对定位精度。
请参阅图2,为本发明一实施方式中绝对精度补偿系统1的结构示意图。
在本实施方式中,绝对精度补偿系统1包括几何误差补偿模块2以及非几何误差补偿模块3。
几何误差补偿模块2,用于在机器人运动学建模时将DH参数误差引起的末端误差直接补偿可配置的运动学参数。
在本实施方式中,几何误差补偿模块2具体用于:
对所述机器人进行运动学建模,得到相邻两连杆{i-1}{i}之间的齐次坐标变换矩阵为:
上式(1)中,s=sin,c=cos,ai-1为连杆长度,ai-1为关节扭角,di为连杆偏距,θi为关节转角,x为连杆坐标系X轴坐标,z为连杆坐标系Z轴坐标;
根据微分变换法获取相邻连杆的齐次变换误差为:
上式(2)表示任意关节的DH参数误差在关节坐标系下产生的误差,其中,Δθi是连杆夹角偏差,Δai-1是连杆扭角偏差,Δdi是连杆距离偏差,Δai-1是连杆长度偏差;
根据所建模型获取所述机器人的末端坐标系与基坐标系之间的运动学关系为:
根据上式(3)得到所述机器人由DH参数引起的末端位姿误差模型为:
ΔpDH=JDHΔηDH (4)
上式(4)中,ΔpDH为所述机器人末端位姿误差向量,为位姿误差对应的辨识雅克比矩阵,ΔηDH=[Δθ Δd Δα Δa]为各关节误差参数向量。
非几何误差补偿模块3,用于建立所述机器人的柔性误差模型,通过所述机器人的控制器来补偿所述柔性误差模型中的误差。
在本实施方式中,非几何误差补偿模块3具体用于:
建立所述机器人的关节力矩和各关节的弹性变形之间的关系为:
τ=Kc·dθc (5)
上式(5)中,Kc=diag(K1,…,Kn)为所述机器人的关节刚度矩阵,τ为施加在关节上的等效力矩,dθc为关节角度偏差;
根据所述机器人的运动雅克比ΔX=Jc(θ)dθc和力雅可比并联立上式(4)以得到:
上式(6)中,Sc=[S1,…,Sn]=[1/K1,…,1/Kn]为各关节的柔度参数,Jc为所述机器人的雅克比矩阵,τG为所述机器人的各关节重力矩,F为机器人所受的外力;
结合上式(4)和上式(6),将所述机器人的末端位姿的误差模型扩展为:
Δp=JΔη (7)
上式(7)中,J=[JDH JA]为辨识雅克比矩阵,Δη=[ΔηDH Sc]为包含几何误差参数和柔度参数的误差参数矩阵;
求解上式(7)以获取所述机器人的所述几何误差参数和所述柔度参数,并通过所述机器人的控制器来补偿误差。
在本实施方式中,正是考虑到关节柔性对工业机器人末端位置的影响,因此基于关节柔性和配置参数的绝对精度补偿系统1,能直接补偿运动学配置参数,不需要修改机器人正逆运动学,可直接应用于工业机器人,适合大规模应用,而且,通过控制器来补偿误差,提高了机器人的定位精度。
在本实施方式中,为了进一步提高机器人的定位精度。本发明的绝对精度补偿系统1还包括辨识模块(图2中未示出),所述辨识模块具体用于:
在所述机器人的工作空间内,给定任意的目标位置,控制所述机器人运动到给定的所述目标位置,记录所述机器人的各关节位置并代入求得所述辨识雅克比矩阵J,利用激光跟踪仪测量给定的所述目标位置的末端实际位置,将所述末端实际位置与所建模型位置做差运算得到上式(7)中的Δp;
采用最小二乘法求解上式(7)以得到所述机器人的所述误差参数矩阵Δη,将所述误差参数矩阵中的几何误差参数ΔηDH直接补偿至所述DH参数,得到修正后的DH参数和所述机器人的零位位置;
将所述误差参数矩阵中的柔度参数Sc直接代入到上式(5)中计算得到各轴角度补偿量;
控制补偿后的所述机器人重复运动到给定的所述目标位置,记录所述机器人各关节位置,使用激光跟踪仪记录所述目标位置的末端实际位置,再次计算得到所述机器人的所述误差参数矩阵;
判断所述误差参数矩阵中的误差参数的变化量是否满足精度要求;
若满足精度要求,则辨识完成。
在本实施方式中,系统装置项的详细说明参阅前述图1所示的方法项的详细说明,在此不做重复记载。
此外,本发明还提供一种设备,其中,设备包括存储器和处理器,存储器存储计算机处理指令,处理器通过调用计算机处理指令来执行前述的绝对精度补偿方法。
另外,本发明还提供一种计算机可读存储介质,其中,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现前述的绝对精度补偿方法的步骤。
本发明提供的技术方案具有以下优点:基于关节柔性和配置参数的绝对精度补偿,直接补偿运动学配置参数,不需要修改机器人正逆运动学,可直接应用于工业机器人,适合大规模应用。
值得注意的是,上述实施例中,所包括的各个单元只是按照功能逻辑进行划分的,但并不局限于上述的划分,只要能够实现相应的功能即可;另外,各功能单元的具体名称也只是为了便于相互区分,并不用于限制本发明的保护范围。
另外,本领域普通技术人员可以理解实现上述各实施例方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成,相应的程序可以存储于一计算机可读取存储介质中,的存储介质,如ROM/RAM、磁盘或光盘等。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (8)
1.一种绝对精度补偿方法,其特征在于,所述方法包括:
几何误差补偿步骤:在机器人运动学建模时将DH参数误差引起的末端误差直接补偿可配置的运动学参数;
非几何误差补偿步骤:建立所述机器人的柔性误差模型,通过所述机器人的控制器来补偿所述柔性误差模型中的误差;
其中,所述几何误差补偿步骤具体包括:
对所述机器人进行运动学建模,得到相邻两连杆{i-1}{i}之间的齐次坐标变换矩阵为:
(1)
上式(1)中,,/>为连杆长度,/>为关节扭角,/>为连杆偏距,/>为关节转角,x为连杆坐标系X轴坐标,z为连杆坐标系Z轴坐标;
根据微分变换法获取相邻连杆的齐次变换误差为:
(2)
上式(2)表示任意关节的DH参数误差在关节坐标系下产生的误差,其中,是连杆夹角偏差,/>是连杆扭角偏差,/>是连杆距离偏差,/>是连杆长度偏差;
根据所建模型获取所述机器人的末端坐标系与基坐标系之间的运动学关系为:
(3);
根据上式(3)得到所述机器人由DH参数引起的末端位姿误差模型为:
(4)
上式(4)中,为所述机器人末端位姿误差向量,/>为位姿误差对应的辨识雅克比矩阵,/>为各关节误差参数向量。
2.如权利要求1所述的绝对精度补偿方法,其特征在于,所述非几何误差补偿步骤具体还包括:
建立所述机器人的关节力矩和各关节的弹性变形之间的关系为:
(5)
上式(5)中,为所述机器人的关节刚度矩阵,/>为施加在关节上的等效力矩,/>为关节角度偏差;
根据所述机器人的运动雅克比和力雅可比/>,并联立上式(4)以得到:
(6)
上式(6)中,为各关节的柔度参数,/>为所述机器人的雅克比矩阵,/>为所述机器人的各关节重力矩,/>为机器人所受的外力;
结合上式(4)和上式(6),将所述机器人的末端位姿的误差模型扩展为:
(7)
上式(7)中,为辨识雅克比矩阵,/>为包含几何误差参数和柔度参数的误差参数矩阵;
求解上式(7)以获取所述机器人的所述几何误差参数和所述柔度参数,并通过所述机器人的控制器来补偿误差。
3.如权利要求2所述的绝对精度补偿方法,其特征在于,所述方法还包括辨识步骤,所述辨识步骤具体包括:
在所述机器人的工作空间内,给定任意的目标位置,控制所述机器人运动到给定的所述目标位置,记录所述机器人的各关节位置并代入求得所述辨识雅克比矩阵,利用激光跟踪仪测量给定的所述目标位置的末端实际位置,将所述末端实际位置与所建模型位置做差运算得到上式(7)中的/>;
采用最小二乘法求解上式(7)以得到所述机器人的所述误差参数矩阵,将所述误差参数矩阵中的几何误差参数/>直接补偿至所述DH参数,得到修正后的DH参数和所述机器人的零位位置;
将所述误差参数矩阵中的柔度参数直接代入到上式(6)中计算得到各轴角度补偿量;
控制补偿后的所述机器人重复运动到给定的所述目标位置,记录所述机器人各关节位置,使用激光跟踪仪记录所述目标位置的末端实际位置,再次计算得到所述机器人的所述误差参数矩阵;
判断所述误差参数矩阵中的误差参数的变化量是否满足精度要求;
若满足精度要求,则辨识完成。
4.一种绝对精度补偿系统,其特征在于,所述系统包括几何误差补偿模块和非几何误差补偿模块,其中,
几何误差补偿模块,用于在机器人运动学建模时将DH参数误差引起的末端误差直接补偿可配置的运动学参数;
非几何误差补偿模块,用于建立所述机器人的柔性误差模型,通过所述机器人的控制器来补偿所述柔性误差模型中的误差;
其中,所述几何误差补偿模块具体用于:
对所述机器人进行运动学建模,得到相邻两连杆{i-1}{i}之间的齐次坐标变换矩阵为:
(1)
上式(1)中,,/>为连杆长度,/>为关节扭角,/>为连杆偏距,/>为关节转角,x为连杆坐标系X轴坐标,z为连杆坐标系Z轴坐标;
根据微分变换法获取相邻连杆的齐次变换误差为:
(2)
上式(2)表示任意关节的DH参数误差在关节坐标系下产生的误差,其中,是连杆夹角偏差,/>是连杆扭角偏差,/>是连杆距离偏差,/>是连杆长度偏差;
根据所建模型获取所述机器人的末端坐标系与基坐标系之间的运动学关系为:
(3);
根据上式(3)得到所述机器人由DH参数引起的末端位姿误差模型为:
(4)
上式(4)中,为所述机器人末端位姿误差向量,/>为位姿误差对应的辨识雅克比矩阵,/>为各关节误差参数向量。
5.如权利要求4所述的绝对精度补偿系统,其特征在于,所述非几何误差补偿模块具体用于:
建立所述机器人的关节力矩和各关节的弹性变形之间的关系为:
(5)
上式(5)中,为所述机器人的关节刚度矩阵,/>为施加在关节上的等效力矩,/>为关节角度偏差;
根据所述机器人的运动雅克比和力雅可比/>,并联立上式(4)以得到:
(6)
上式(6)中,为各关节的柔度参数,/>为所述机器人的雅克比矩阵,/>为所述机器人的各关节重力矩,/>为机器人所受的外力;
结合上式(4)和上式(6),将所述机器人的末端位姿的误差模型扩展为:
(7)
上式(7)中,为辨识雅克比矩阵,/>为包含几何误差参数和柔度参数的误差参数矩阵;
求解上式(7)以获取所述机器人的所述几何误差参数和所述柔度参数,并通过所述机器人的控制器来补偿误差。
6.如权利要求5所述的绝对精度补偿系统,其特征在于,所述系统还包括辨识模块,所述辨识模块具体用于:
在所述机器人的工作空间内,给定任意的目标位置,控制所述机器人运动到给定的所述目标位置,记录所述机器人的各关节位置并代入求得所述辨识雅克比矩阵,利用激光跟踪仪测量给定的所述目标位置的末端实际位置,将所述末端实际位置与所建模型位置做差运算得到上式(7)中的/>;
采用最小二乘法求解上式(7)以得到所述机器人的所述误差参数矩阵,将所述误差参数矩阵中的几何误差参数/>直接补偿至所述DH参数,得到修正后的DH参数和所述机器人的零位位置;
将所述误差参数矩阵中的柔度参数直接代入到上式(6)中计算得到各轴角度补偿量;
控制补偿后的所述机器人重复运动到给定的所述目标位置,记录所述机器人各关节位置,使用激光跟踪仪记录所述目标位置的末端实际位置,再次计算得到所述机器人的所述误差参数矩阵;
判断所述误差参数矩阵中的误差参数的变化量是否满足精度要求;
若满足精度要求,则辨识完成。
7.一种计算机设备,其特征在于,所述计算机设备包括存储器和处理器,所述存储器存储计算机处理指令,所述处理器通过调用所述计算机处理指令来执行上述权利要求1-3中任一项所述的绝对精度补偿方法。
8.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1-3中任一项所述的绝对精度补偿方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111308845.3A CN113927599B (zh) | 2021-11-05 | 2021-11-05 | 绝对精度补偿方法及系统、设备和计算机可读存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111308845.3A CN113927599B (zh) | 2021-11-05 | 2021-11-05 | 绝对精度补偿方法及系统、设备和计算机可读存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113927599A CN113927599A (zh) | 2022-01-14 |
CN113927599B true CN113927599B (zh) | 2023-12-19 |
Family
ID=79285703
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111308845.3A Active CN113927599B (zh) | 2021-11-05 | 2021-11-05 | 绝对精度补偿方法及系统、设备和计算机可读存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113927599B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114918920B (zh) * | 2022-06-01 | 2023-11-21 | 浙江大学 | 一种基于神经网络和距离误差模型的工业机器人标定方法 |
CN115319727A (zh) * | 2022-08-15 | 2022-11-11 | 中国科学院宁波材料技术与工程研究所 | 一种基于位姿约束和力感知的机器人标定方法 |
CN115401699B (zh) * | 2022-10-31 | 2023-03-24 | 广东隆崎机器人有限公司 | 工业机器人精度可靠性分析方法、装置、设备及存储介质 |
CN115816463B (zh) * | 2022-12-30 | 2024-10-18 | 上海拓璞数控科技股份有限公司 | 基于关节全闭环和刚柔耦合模型的机器人精度提升方法和系统 |
CN116901081B (zh) * | 2023-08-22 | 2024-06-21 | 长广溪智能制造(无锡)有限公司 | 机器人dh参数标定方法、装置、电子设备及存储介质 |
CN117170307B (zh) * | 2023-09-22 | 2024-07-16 | 广东工业大学 | 一种多轴并联机床误差补偿方法、装置、设备及存储介质 |
CN117301082B (zh) * | 2023-11-28 | 2024-01-23 | 佛山华数机器人有限公司 | 一种大负载机器人的关节柔性补偿方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109746915A (zh) * | 2019-01-18 | 2019-05-14 | 埃夫特智能装备股份有限公司 | 一种提升工业机器人绝对定位精度的运动学方法 |
CN110193829A (zh) * | 2019-04-24 | 2019-09-03 | 南京航空航天大学 | 一种耦合运动学与刚度参数辨识的机器人精度控制方法 |
CN112873199A (zh) * | 2021-01-08 | 2021-06-01 | 西北工业大学 | 基于运动学与空间插值的机器人绝对定位精度标定方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102016212695B4 (de) * | 2016-05-31 | 2019-02-21 | Siemens Aktiengesellschaft | Industrieroboter |
-
2021
- 2021-11-05 CN CN202111308845.3A patent/CN113927599B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109746915A (zh) * | 2019-01-18 | 2019-05-14 | 埃夫特智能装备股份有限公司 | 一种提升工业机器人绝对定位精度的运动学方法 |
CN110193829A (zh) * | 2019-04-24 | 2019-09-03 | 南京航空航天大学 | 一种耦合运动学与刚度参数辨识的机器人精度控制方法 |
CN112873199A (zh) * | 2021-01-08 | 2021-06-01 | 西北工业大学 | 基于运动学与空间插值的机器人绝对定位精度标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113927599A (zh) | 2022-01-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113927599B (zh) | 绝对精度补偿方法及系统、设备和计算机可读存储介质 | |
CN112873199B (zh) | 基于运动学与空间插值的机器人绝对定位精度标定方法 | |
CN110193829B (zh) | 一种耦合运动学与刚度参数辨识的机器人精度控制方法 | |
CN104608129B (zh) | 基于平面约束的机器人标定方法 | |
CN106777656B (zh) | 一种基于pmpsd的工业机器人绝对精度校准方法 | |
CN109822577B (zh) | 一种基于视觉伺服的移动式机器人高精度加工方法 | |
CN112743541B (zh) | 一种无力/力矩传感器机械臂软浮动控制方法 | |
US8406921B2 (en) | Method and device for controlling a manipulator | |
CN112318498B (zh) | 一种考虑参数耦合的工业机器人标定方法 | |
CN105773609A (zh) | 一种基于视觉测量及距离误差模型的机器人运动学标定方法 | |
CN112123341B (zh) | 机器人双臂协调运动控制方法、装置和电子设备 | |
CN110053051A (zh) | 工业串联机器人关节刚度系数辨识方法 | |
CN111267143A (zh) | 六自由度工业串联机器人关节刚度辨识方法及系统 | |
CN114147726A (zh) | 一种几何误差与非几何误差相结合的机器人标定方法 | |
CN111037542A (zh) | 一种逆动力学控制机器人直线加工的轨迹误差补偿方法 | |
JP2024512827A (ja) | 適応コンプライアンスに基づいたロボット組立のためのシステムおよび方法 | |
Zou et al. | An approach for peg-in-hole assembling based on force feedback control | |
CN114211502B (zh) | 机器人负载识别方法及识别装置 | |
CN110450165B (zh) | 一种基于零力控制的机器人标定方法 | |
CN115179289A (zh) | 一种面向数字孪生的机器人标定方法 | |
CN115091455A (zh) | 一种工业机器人定位误差补偿方法 | |
CN113843804A (zh) | 基于平面约束的机器人运动学标定方法及系统 | |
Li et al. | Positioning error compensation for industrial robots based on stiffness modelling | |
JPH0433006A (ja) | ロボツトシステムの制御方法 | |
Dastangoo et al. | Non-linear Parameter Identification for Humanoid Robot Components |
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 |