CN108015808B - 一种混联机器人的运动学标定方法 - Google Patents
一种混联机器人的运动学标定方法 Download PDFInfo
- Publication number
- CN108015808B CN108015808B CN201711287304.0A CN201711287304A CN108015808B CN 108015808 B CN108015808 B CN 108015808B CN 201711287304 A CN201711287304 A CN 201711287304A CN 108015808 B CN108015808 B CN 108015808B
- Authority
- CN
- China
- Prior art keywords
- error
- robot
- geometric
- vector
- hybrid
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明公开了一种混联机器人运动学标定方法,包括如下步骤:步骤1:基于旋量理论建立混联机器人几何误差模型;步骤2:基于激光跟踪仪空间位置检测信息获取混联机器人末端位姿误差;步骤3:基于Liu估计方法辨识几何误差源;步骤4:基于修正控制器输出方法分步实施误差补偿。本发明精度、高效率、便于工业现场应用的、可基于机器人末端全维或少维位姿误差检测信息实施的一种混联机器人运动学标定方法。本发明方法可以建立满足完备性、极小性、连续型的误差模型,且模型变量均物理意义明确,有效解决辨识矩阵病态问题,提高误差源辨识精度以及辨识结果的稳定性,进而提高补偿精度。
Description
技术领域
本发明属于机器人领域,涉及工业机器人的运动学标定技术,尤其涉及一种混联机器人运动学标定方法。
背景技术
由三自由度并联机构与两(三)自由度串联转头搭建而成的五(六)自由度混联机器人是一种新型多轴联动加工装备,其结合了串联机器人工作空间大和并联机器人加速度大、刚度高的特点,以高速高精加工为目标,在大尺度非结构环境下的加工制造领域具有广泛的应用前景。如Tricept、Exechon等混联机器人已在航空航天、汽车制造等领域开展了初步应用,并取得了良好效果。
几何精度是该类混联机器人的重要性能指标之一。在具备良好基础制造精度的前提下,运动学标定是进一步提高该类装备精度的有效手段。通常情况下,运动学标定分为以下四个步骤:误差建模、误差检测、误差辨识和误差补偿。前期研究表明,上述方法在用于该类混联机器人的运动学标定时尚存在两类主要问题,制约了其工程应用。其一,该类混联机器人关节数目较多,每一关节存在六项误差源,关节两两之间又存在多项结构误差,误差源数量众多,难于建立满足完备性、极小性、连续型的误差模型;其二,该类混联机器人在误差辨识环节中存在辨识矩阵病态问题,传统辨识方法(如最小二乘法)鲁棒性差、辨识结果不稳定,导致难于实现高精度误差补偿。
发明内容
本发明的目的是为了克服现有技术中的不足,提供一种高精度、高效率、便于工业现场应用的、可基于机器人末端全维或少维位姿误差检测信息实施的一种混联机器人运动学标定方法。
本发明的目的是通过以下技术方案实现的:
一种混联机器人运动学标定方法,包括如下步骤:
步骤1:基于旋量理论建立混联机器人几何误差模型,具体地:
(1)建立并联模块所有几何误差源与机器人末端位姿误差旋量之间的映射模型,
(2)建立串联转头所有几何误差源与机器人末端位姿误差旋量之间的映射模型,
$S,t=JSΔξS+GSΔηS
其中,$S,t为串联转头几何误差源在末端引起的位姿误差旋量,ΔξS为串联转头主动关节运动误差向量,ΔηS为串联转头其余几何误差源构成的误差向量,JS、GS为对应的误差映射矩阵;
(3)依据混联机器人构型特点,并综合考虑并联模块、串联转头几何误差源对机器人末端位姿误差旋量的贡献度规律,建立整机几何误差模型
$t=BΔχ
其中,$t为混联机器人末端位姿误差旋量,Δχ为混联机器人几何误差源全集构成的误差向量,B为误差映射矩阵;
步骤2:基于激光跟踪仪空间位置检测信息获取混联机器人末端位姿误差,具体地:
(1)设定混联机器人初始位形及相应坐标系统;
(2)当机器人运行至工作空间中任一位形处时,利用激光跟踪仪检测机器人末端若干点位(至少不共线3点)的空间位置误差,建立激光跟踪仪误差测量值与机器人末端位姿误差旋量之间的映射模型,
Δpk=Pk$t,k
其中,脚标k表示第k个测量位形,Δpk为激光跟踪仪空间位置误差测量值构成的向量,$t,k为混联机器人末端位姿误差旋量,Pk为相应的误差映射矩阵;
(3)考虑所有n个测量位形,建立混联机器人几何误差源与激光跟踪仪误差测量值之间的误差映射模型,
其中,Δp为所有n个测量位形下激光跟踪仪误差测量值构成的向量,ε为测量噪声向量,H为误差映射矩阵;
(4)通过分析矩阵H的性态,剔除线性相关几何误差源,并得到缩减后的几何误差模型。
步骤3:基于Liu估计方法辨识几何误差源,具体地:
(1)求解Liu参数d;
(2)求解混联机器人几何误差源向量的估计值,
步骤4:基于修正控制器输出方法分步实施误差补偿,具体地:
(1)在混联机器人处于初始位置时,采用机械手段调整末端构件位姿,使其尽可能接近理想位姿;
(2)在仅考虑混联机器人主动关节零点误差的前提下实施零点误差补偿,使补偿后机器人在工作空间中均匀分布各点的均方根误差最小,补偿值为
(3)在考虑混联机器人全部几何误差源的前提下实施全参数误差补偿,进一步提高机器人工作精度,补偿值为
与现有技术相比,本发明的技术方案所带来的有益效果是:
(1)建立满足完备性、极小性、连续型的误差模型,且模型变量均物理意义明确。
(2)有效解决辨识矩阵病态问题,提高误差源辨识精度以及辨识结果的稳定性,进而提高补偿精度。
附图说明
图1是一种混联机器人工作站的结构示意图。
图2是混联机器人结构示意图。
1-混联机器人2-立柱,3-工作台,4-末端执行器,10-并联模块,11-串联转头,101-支链1,102-支链2,103-支链3,104-支链4,12-测量夹具,121-激光跟踪仪测量点
具体实施方式
下面结合附图和具体实施例对本发明加以详细说明,以已授权发明专利“CN105058376B——一种具有三对称运动学性能的过约束高刚度机器人”为例。
混联机器人1由并联模块10、串联转头11构成,通过立柱2与工作台3固定连接,混联机器人1的末端可固定连接末端执行器4实现相应功能。在运动学标定过程中,将包含四个激光跟踪仪测量点121的测量夹具12固定连接于串联转头末端开展误差测量。
本发明的一种混联机器人运动学标定方法,它包括以下步骤:
步骤1:基于旋量理论建立混联机器人1几何误差模型。
(1)仅考虑并联模块10几何误差源对机器人1末端位姿误差的影响,可以得到
其中,$P,t为并联模块10支链几何误差源在机器人1末端引起的位姿误差旋量,ni为支链i的连接度,Δξa,j,i为支链i第j个关节的运动误差,为支链i第j个关节轴线的单位旋量,为支链i关节结构误差引起的机器人1末端位姿误差旋量。支链1(101)、支链2(102)、支链3(103)均为UPS支链,支链4(104)为UPRRR支链,其中,U代表虎克铰,P代表移动副,S代表球铰,R代表转动副。
利用对偶向量空间基本性质,综合考虑四条支链的误差映射关系,建立并联模块10所有几何误差源与机器人1末端位姿误差旋量之间的映射模型,
其中,$P,t为并联模块10几何误差源在末端引起的位姿误差旋量,ΔξP为并联模块10主动关节运动误差向量,ΔηP为并联模块10其余几何误差源构成的误差向量,JP、GP为对应的误差映射矩阵。
(2)采用与并联模块10类似的手续,可建立串联转头11所有几何误差源与机器人1末端位姿误差旋量之间的映射模型
其中,Δξa,j,4为支链4第j个关节的运动误差,为支链4第j个关节轴线的单位旋量,为串联转头11关节结构误差引起的机器人1末端位姿误差旋量,$S,t为串联转头11几何误差源在末端引起的位姿误差旋量,ΔξS为串联转头11主动关节运动误差向量,ΔηS为串联转头11其余几何误差源构成的误差向量,JS、GS为对应的误差映射矩阵。
(3)依据混联机器人1构型特点,并综合考虑并联模块10、串联转头11几何误差源对机器人1末端位姿误差旋量的贡献度规律,建立整机几何误差模型
$t=BΔχ
其中,$t为混联机器人1末端位姿误差旋量,Δχ为混联机器人1几何误差源全集构成的误差向量,B为误差映射矩阵,Δξ为混联机器人1主动关节运动误差向量,Δη为混联机器人1其余几何误差源构成的误差向量,JS为混联机器人1主动关节运动误差映射矩阵,GS为混联机器人1其余几何误差映射矩阵。
步骤2:基于激光跟踪仪空间位置检测信息获取混联机器人1末端位姿误差。
(1)当混联机器人1运动至其工作空间几何中心位置处时,调整主轴端面同时垂直于工作台面及工作台3一侧边,设定该位姿为混联机器人1初始位形,并建立相应坐标系统;
(2)当机器人1运行至工作空间中任一位形处时,利用激光跟踪仪检测机器人1末端呈十字交叉分布四个测量点121的空间位置误差,建立激光跟踪仪误差测量值与机器人1末端位姿误差旋量之间的映射模型
Δpk=Pk$t,k
其中,脚标k表示第k个测量位形,Δpk为激光跟踪仪空间位置误差测量值构成的向量,$t,k为混联机器人1末端位姿误差旋量,Pk为相应的误差映射矩阵;
(3)考虑所有n个测量位形,建立混联机器人1几何误差源与激光跟踪仪误差测量值之间的误差映射模型,
其中,Δp为所有n个测量位形下激光跟踪仪误差测量值构成的向量,ε为测量噪声向量,H为误差映射矩阵;
(4)通过分析矩阵H的性态,剔除线性相关几何误差源。首先,将辨识雅克比(即误差映射矩阵)H写成分块矩阵格式
其中,Hi为与第i个测量位形对应的误差雅克比(i=1,2,…,n),n为测量位形数目,Ji、Gi分别为与主动关节运动误差、其余几何误差源对应的误差雅克比Hi的分块矩阵,J′、G′分别为与主动关节运动误差、其余几何误差源对应的误差雅克比H的分块矩阵。
然后,逐一分析矩阵G′中各列对矩阵G′的秩的影响,若剔除掉某一列后,矩阵G′的秩不变,则从矩阵G′中去除该列,若剔除掉某一列后,矩阵G′的秩降低,则维持该列不变。
最后,将与被剔除矩阵G′中各列对应的误差源向量Δχ中的元素一同剔除,形成缩减的、不含线性相关几何误差源的几何误差模型。
步骤3:基于Liu估计方法辨识几何误差源。
(1)将混联机器人1几何误差源向量的Liu估计值表示为
(2)设Λ=diag[λi]为由矩阵HTH的特征值构成的对角矩阵,Q为由矩阵HTH的特征向量构成的正交矩阵,λi为矩阵HTH的第i个特征值,于是有
Δp=ZΔα+ε
其中,Z=HQ,Δα=QTΔχ。
其中,MSE表示均方根误差,tr表示矩阵的迹,Cov表示协方差矩阵,E表示期望,并且有
其中,σ为测量噪声的标准差,Δαi为向量Δα中的第i个元素。
(4)将Liu参数d表示为Δαi、σ和λi的函数
步骤4:基于修正控制器输出方法分步实施误差补偿。
(1)在混联机器人1处于初始位置时,采用机械手段调整末端构件位姿,使其尽可能接近理想位姿;
(2)在仅考虑混联机器人1主动关节零点误差的前提下实施零点误差补偿,使补偿后机器人1在工作空间中均匀分布各点的均方根误差最小,补偿值为
(3)在考虑混联机器人1全部几何误差源的前提下实施全参数误差补偿,进一步提高机器人工作精度,补偿值为
本发明并不限于上文描述的实施方式。以上对具体实施方式的描述旨在描述和说明本发明的技术方案,上述的具体实施方式仅仅是示意性的,并不是限制性的。在不脱离本发明宗旨和权利要求所保护的范围情况下,本领域的普通技术人员在本发明的启示下还可做出很多形式的具体变换,这些均属于本发明的保护范围之内。
Claims (4)
1.一种混联机器人的运动学标定方法,其特征在于,包括以下步骤:
步骤1:基于旋量理论建立混联机器人几何误差模型;具体如下:
(1)建立并联模块所有几何误差源与机器人末端位姿误差旋量之间的映射模型,
(2)建立串联转头所有几何误差源与机器人末端位姿误差旋量之间的映射模型,
$S,t=JSΔξS+GSΔηS
其中,$S,t为串联转头几何误差源在末端引起的位姿误差旋量,ΔξS为串联转头主动关节运动误差向量,ΔηS为串联转头其余几何误差源构成的误差向量,JS、GS为对应的误差映射矩阵;
(3)依据混联机器人构型特点,并综合考虑并联模块、串联转头几何误差源对机器人末端位姿误差旋量的贡献度规律,建立整机几何误差模型
$t=BΔχ
其中,$t为混联机器人末端位姿误差旋量,Δχ为混联机器人几何误差源全集构成的误差向量,B为误差映射矩阵;
步骤2:基于激光跟踪仪空间位置检测信息获取混联机器人末端位姿误差;
步骤3:基于Liu估计方法辨识几何误差源;
步骤4:基于修正控制器输出方法分步实施误差补偿。
2.根据权利要求1所述的一种混联机器人的运动学标定方法,其特征在于,所述基于激光跟踪仪空间位置检测信息获取混联机器人末端位姿误差的过程如下:
(1)设定混联机器人初始位形及相应坐标系统;
(2)当机器人运行至工作空间中任一位形处时,利用激光跟踪仪检测机器人末端至少不共线的3个点位的空间位置误差,建立激光跟踪仪误差测量值与机器人末端位姿误差旋量之间的映射模型,
Δpk=Pk$t,k
其中,脚标k表示第k个测量位形,Δpk为激光跟踪仪空间位置误差测量值构成的向量,$t,k为混联机器人末端位姿误差旋量,Pk为相应的误差映射矩阵;
(3)考虑所有n个测量位形,建立混联机器人几何误差源与激光跟踪仪误差测量值之间的误差映射模型,
其中,Δp为所有n个测量位形下激光跟踪仪误差测量值构成的向量,ε为测量噪声向量,H为误差映射矩阵;
(4)通过分析矩阵H的性态,剔除线性相关几何误差源,并得到缩减后的几何误差模型。
4.根据权利要求3所述的一种混联机器人的运动学标定方法,其特征在于,所述基于修正控制器输出方法分步实施误差补偿的过程如下:
(1)在混联机器人处于初始位置时,采用机械手段调整末端构件位姿,使其尽可能接近理想位姿;
(2)在仅考虑混联机器人主动关节零点误差的前提下实施零点误差补偿,使补偿后机器人在工作空间中均匀分布各点的均方根误差最小,补偿值为
(3)在考虑混联机器人全部几何误差源的前提下实施全参数误差补偿,进一步提高机器人工作精度,补偿值为
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711287304.0A CN108015808B (zh) | 2017-12-07 | 2017-12-07 | 一种混联机器人的运动学标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711287304.0A CN108015808B (zh) | 2017-12-07 | 2017-12-07 | 一种混联机器人的运动学标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108015808A CN108015808A (zh) | 2018-05-11 |
CN108015808B true CN108015808B (zh) | 2021-04-20 |
Family
ID=62078778
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711287304.0A Active CN108015808B (zh) | 2017-12-07 | 2017-12-07 | 一种混联机器人的运动学标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108015808B (zh) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108890645B (zh) * | 2018-06-30 | 2021-09-17 | 天津大学 | 一种五自由度混联机器人驱动关节零点误差的补偿方法 |
CN110815206B (zh) * | 2018-08-14 | 2022-11-29 | 中国科学院沈阳自动化研究所 | 一种Stewart型并联机器人运动学标定方法 |
CN110333552B (zh) * | 2019-07-15 | 2020-09-25 | 中国地质大学(武汉) | 一种基于Liu估计的航磁补偿方法 |
CN110977940B (zh) * | 2019-11-28 | 2021-04-23 | 清华大学 | 并混联机器人的几何误差建模方法及装置 |
CN111189577B (zh) * | 2020-01-16 | 2022-01-07 | 腾讯科技(深圳)有限公司 | 传感器标定及数据测量方法、装置、设备、存储介质 |
CN112462599B (zh) * | 2020-11-30 | 2022-02-25 | 东北大学 | 一种高性能pid控制参数整定方法、装置及系统 |
CN112775935B (zh) * | 2020-12-14 | 2022-03-15 | 华南理工大学 | 一种基于末端误差检测信息子集的并联机器人标定方法 |
CN113334388B (zh) * | 2021-07-08 | 2022-12-02 | 清华大学 | 基于局部线性回归的机器人运动学标定方法及标定装置 |
CN113500585B (zh) * | 2021-07-16 | 2023-09-05 | 清华大学 | 用于运动学标定的机器人测量位姿评价方法及评价装置 |
CN113580142B (zh) * | 2021-08-20 | 2023-10-13 | 天津大学 | 基于旋量理论的机器人无冗余几何误差模型解析建模方法 |
CN113878581B (zh) * | 2021-10-28 | 2023-05-02 | 天津大学 | 一种五自由度混联机器人误差预测及实时补偿方法 |
CN115026819A (zh) * | 2022-06-09 | 2022-09-09 | 天津大学 | 一种基于fis理论的机器人标定方法 |
CN115958593A (zh) * | 2022-11-15 | 2023-04-14 | 山东理工大学 | 一种基于对偶向量的智能破拆机器人碰撞检测方法及系统、计算机存储介质 |
CN116787443B (zh) * | 2023-07-26 | 2023-11-21 | 中国科学院宁波材料技术与工程研究所 | 基于单位对偶四元数的并联机构运动学标定方法和系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101231749A (zh) * | 2007-12-20 | 2008-07-30 | 昆山华恒工程技术中心有限公司 | 一种工业机器人的标定方法 |
CN103231375A (zh) * | 2013-04-28 | 2013-08-07 | 苏州大学 | 基于距离误差模型的工业机器人标定方法 |
CN107421442A (zh) * | 2017-05-22 | 2017-12-01 | 天津大学 | 一种外部测量辅助的机器人定位误差在线补偿方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6418774B1 (en) * | 2001-04-17 | 2002-07-16 | Abb Ab | Device and a method for calibration of an industrial robot |
-
2017
- 2017-12-07 CN CN201711287304.0A patent/CN108015808B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101231749A (zh) * | 2007-12-20 | 2008-07-30 | 昆山华恒工程技术中心有限公司 | 一种工业机器人的标定方法 |
CN103231375A (zh) * | 2013-04-28 | 2013-08-07 | 苏州大学 | 基于距离误差模型的工业机器人标定方法 |
CN107421442A (zh) * | 2017-05-22 | 2017-12-01 | 天津大学 | 一种外部测量辅助的机器人定位误差在线补偿方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108015808A (zh) | 2018-05-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108015808B (zh) | 一种混联机器人的运动学标定方法 | |
CN109822574B (zh) | 一种工业机器人末端六维力传感器标定的方法 | |
CN109176494B (zh) | 绳驱多关节柔性机器人自标定方法及系统、存储介质 | |
Guo et al. | Stiffness-oriented posture optimization in robotic machining applications | |
CN108890645B (zh) | 一种五自由度混联机器人驱动关节零点误差的补偿方法 | |
CN106625573B (zh) | 一种五自由度混联机器人直接误差补偿技术 | |
Chen et al. | A compensation method for enhancing aviation drilling robot accuracy based on co-kriging | |
CN112873199B (zh) | 基于运动学与空间插值的机器人绝对定位精度标定方法 | |
CN107421442A (zh) | 一种外部测量辅助的机器人定位误差在线补偿方法 | |
CN110161850A (zh) | 一种工业机器人变参数刚度辨识与建模方法 | |
CN107718050A (zh) | Scara机器人臂长与零点标定方法、装置、介质及计算机设备 | |
CN112775935B (zh) | 一种基于末端误差检测信息子集的并联机器人标定方法 | |
CN110154022B (zh) | 一种基于定向刚度模型的机器人制孔径向定位修正方法 | |
Klimchik et al. | Optimal pose selection for calibration of planar anthropomorphic manipulators | |
CN113580148B (zh) | 基于等效运动链的并联机器人运动学标定方法 | |
CN115229796A (zh) | 一种面向航空大构件铣削的机器人末端位姿跟踪补偿方法 | |
CN108021756B (zh) | 一种基于d-h表示法的可重构机床运动学误差模型建立方法 | |
Kim et al. | Identification and compensation of a robot kinematic parameter for positioning accuracy improvement | |
Cheng et al. | Sensitivity analysis and kinematic calibration of 3-UCR symmetrical parallel robot leg | |
CN111912401B (zh) | 一种面向飞机大部件调姿机构工作空间求解方法 | |
Luo et al. | Study of error compensations and sensitivity analysis for 6-Dof serial robot | |
Li et al. | Trajectory planning method for docking of large aircraft components | |
Yang et al. | Enhanced stiffness modeling and identification method for a cable-driven spherical joint module | |
Cristalli et al. | Cognitive robot referencing system for high accuracy manufacturing task | |
Liang et al. | Calibration of UR5 manipulator based on kinematic models |
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 |