CN111775153B - 一种重载机器人标定方法 - Google Patents
一种重载机器人标定方法 Download PDFInfo
- Publication number
- CN111775153B CN111775153B CN202010695790.5A CN202010695790A CN111775153B CN 111775153 B CN111775153 B CN 111775153B CN 202010695790 A CN202010695790 A CN 202010695790A CN 111775153 B CN111775153 B CN 111775153B
- Authority
- CN
- China
- Prior art keywords
- robot
- heavy
- model
- deformation
- errors
- 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
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种重载机器人标定方法,通过结合可解析的梁变形模型和数据驱动的高斯过程回归模型的非几何误差补偿方法,先去除非几何误差中不符合高斯过程先验分布的误差,再使用数据驱动的方法进一步提高重载直角坐标机器人的定位精度。解决重载机器人在几何误差补偿后,直接使用高斯过程回归模型补偿非几何误差可能会出现标定精度波动的现象。
Description
技术领域
本发明属于机器人标定技术领域,具体涉及一种结合梁变形和高斯过程回归模型的重载机器人标定方法。
背景技术
大型重载机器人,在长行程工作领域,主要指桁架式直角坐标机器人。由于其具有行程长,负载大,可靠性好的优点,所以被广泛应用在上下料、搬运、喷涂、焊接以及金属精加工等领域。
目前工业机器人普遍存在着重复定位精度高,绝对定位精度低的问题,而影响机器人定位精度的因素可分为几何误差和非几何误差因素。几何误差主要是由于机器人的装配和零件的加工制造引起的误差,非几何误差主要是连杆变形,齿轮间隙和磨损以及温度影响等造成的误差。
提高定位精度的方法最常使用的是标定技术。目前,大多数标定方法仅仅是在运动学层面的,这对应用于高精度领域的重载直角坐标机器人是不够的。近几年,也有人提出在几何误差补偿后,直接使用高斯过程回归模型来补偿机器人的非几何误差。但是对于长行程重载直角坐标机器人,这种方法会造成标定精度出现较大的波动,其主要原因在于直角坐标机器人在大负载作用下的梁变形误差并不是一个简单的、随机的高斯过程,而是一个可解析的模型。因此,我们在完成几何误差补偿之后,提出了一种结合梁变形和高斯过程回归模型的重载直角坐标机器人标定方法。
如何提供一种重载直角坐标机器人标定方案,是一个急需解决的问题。
发明内容
本发明的主要目的在于提供一种重载机器人标定方法,从而克服现有技术的不足。
为实现前述发明目的,本发明采用的技术方案包括:一种重载机器人标定方法,包括以下步骤:
在一优选实施例中,所述S100包括:
S101,建立重载机器人的三维模型,在该模型中,定义运动学参数向量 其中,θ1表示立柱OA与垂直方向的偏离角度,θ2表示AB与水平方向的偏离角度,θ3表示BP与垂直方向的偏离角度,h=|OA|表示立柱的高度,a0,b0表示x轴和z轴的平动关节零点位置的偏移,a,b被定义为x,z轴移动关节的位移;
在一优选实施例中,所述S200包括:
S201,建立在外载荷作用下可解析的梁变形模型,根据不同载荷和力矩作用下的挠度和转角,得到机器人的末端位置P的变形误差∈;
在一优选实施例中,所述S201包括:
S2011计算得到由外载荷作用引起的集中力F的作用下,机器人的挠度和转角分别为:
S2012,计算得到在力矩M1的作用下,机器人的挠度和转角分别为:
S2013,计算得到在力矩M2的作用下,机器人的挠度和转角分别为:
S2014,由上述步骤S2011~2013计算出的挠度和转角,计算得到机器人的末端位置P的变形误差∈为:
Δx=ωA-ωC-b·sinθ;
Δz=ωB-b·(1-cosθ),其中θ=θA+θB-θC。
在一优选实施例中,所述S300包括:
S301,给定数据集D={(xi,ei)|i=1,2…,n=(X,e)},其中xi=(ai,bi,mi)是输入向量,ai,bi是机械手在x和z轴平动关节的移动距离,mi是负载的质量;
S302,设噪声δ~(0,σ2),残差数据e服从高斯过程的先验分布:e~N(0,K(X,X)+σ2I)。
与现有技术相比较,本发明的有益效果至少在于:本发明通过结合可解析的梁变形模型和数据驱动的高斯过程回归模型的非几何误差补偿方法,通过先去除非几何误差中不符合高斯过程先验分布的误差,再使用数据驱动的方法进一步提高重载直角坐标机器人的定位精度。解决重载机器人在几何误差补偿后,直接使用高斯过程回归模型补偿非几何误差可能会出现标定精度波动的现象。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明中记载的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明中重载直角坐标机器人的非理想布局模型图;
图2为本发明中重载直角坐标机器人的名义模型图;
图3为本发明具体实施方式中重载直角坐标机器人的运动学参数偏差辨识流程图;
图4为本发明具体实施方式中重载直角坐标机器人外载荷作用受力图;
图5为本发明具体实施方式中重载直角坐标机器人的单个载荷作用效果叠加图;
图6为本发明具体实施方式中GPR预测z误差的十折交叉验证图;
图7为本发明具体实施方式中几何误差和非几何误差补偿流程图;
图8为本发明具体实施方式中测试点与训练点收集图;
图9为本发明具体实施方式中4种方法补偿结果图。
具体实施方式
通过应连同所附图式一起阅读的以下具体实施方式将更完整地理解本发明。本文中揭示本发明的详细实施例;然而,应理解,所揭示的实施例仅具本发明的示范性,本发明可以各种形式来体现。因此,本文中所揭示的特定功能细节不应解释为具有限制性,而是仅解释为权利要求书的基础且解释为用于教示所属领域的技术人员在事实上任何适当详细实施例中以不同方式采用本发明的代表性基础。
本发明所揭示的一种重载机器人标定方法,通过结合可解析的梁变形模型和数据驱动的高斯过程回归模型的非几何误差补偿方法,通过先去除非几何误差中不符合高斯过程先验分布的误差,再使用数据驱动的方法进一步提高重载直角坐标机器人的定位精度。
本发明所揭示的一种重载机器人标定方法,包括以下步骤:
具体地,S100包括:
S101,建立长行程重载直角坐标机器人的三维模型。
非理想布局的重载直角机器人示意图如图1所示,定义运动学参数向量 其中,θ1表示立柱OA与垂直方向(即z轴方向)的偏离角度,θ2表示AB与水平方向(即x轴方向)的偏离角度,θ3表示BP与垂直方向的偏离角度,h=|OA|表示立柱的高度,a0,b0表示x轴和z轴的平动关节零点位置(即点O)的偏移,a,b被定义为x,z轴移动关节的位移。
在运动学建模过程中取顺时针方向为正方向,因此基于齐次坐标变换(HCT)方法的变换矩阵T为:
T=Rot(y1,-θ1)Trans(0,0,h)Rot(y2,(θ2+θ1))Trans(a+a0,0,0)
假设末端执行器实际的位置是Pa,因此重载直角坐标机器人的误差模型是:
具体地,对于非几何误差,本发明通过先补偿变形误差后补偿残差的两步补偿方法。其中,使用梁变形模型补偿变形误差的过程包括:
建立外载荷作用下可解析的梁变形(BD)模型,根据不同载荷和力矩作用下的挠度和转角,得到机器人的末端位置P的变形误差∈。
具体过程包括:
受外载荷作用的重载直角坐标机器人的受力简图如图4所示。在小变形和线弹性的假设下,由力的独立作用原理和叠加原理,图4可以等效为图5,受单个载荷作用效果的叠加。变形公式推导是在0<a<l/2,而l/2<a<l的情况将由对称性可得到。
计算得到在外负载引起的集中力F的作用下,机器人的挠度和转角分别为:
计算得到在力矩M1的作用下,机器人的挠度和转角分别为:
计算得到在力矩M2的作用下,机器人的挠度和转角分别为:
S2014,由上述步骤S2011~2013计算出的挠度和转角,计算得到机器人的末端位置P的变形误差∈为:
Δx=ωA-ωC-b·sinθ;
Δz=ωB-b·(1-cosθ),其中θ=θA+θB-θC。
具体地,由统计学中的中心极限定理可知,随机因素造成的残差近似服从高斯分布,而高斯过程回归是基于贝叶斯理论和统计学习发展起来的一种全新机器学习方法,适于处理小样本和非线性等回归问题。因此,可以考虑用高斯过程回归来补偿重载机器人的残差(包括由齿轮间隙和磨损,温度效应等因素造成的残差)。
给定数据集D={(xi,ei)|i=1,2…,n=(X,e)},其中xi=(ai,bi,mi)是输入向量,ai,bi是机械手在x和z轴平动关节的移动距离,mi是负载的质量,在训练高斯过程回归模型的过程中,x=(a,b,m)是作为模型的输入向量,其中a,b是机械手在x和z轴平动关节的移动距离,m是负载的质量,残差e在补偿几何误差和变形误差之后收集得到,残差ei∈R,新的预测的残差将作为输出向量。
首先,假设噪声δ~(0,σ2),残差数据e服从高斯过程的先验分布:
e~N(0,K(X,X)+σ2I);
在GPR模型中,使用的协方差函数是ARD平方指数核函数。该协方差函数中每一个预测变量都会有一个单独的特征长度标度,该函数可以被定义如下:
如图6所示,训练好的高斯过程回归模型将使用10折交叉验证方法来验证模型的准确性。
下面以一具体实施方式来描述本发明重载机器人标定方法的原理。
一、运动学参数辨识点的收集
在实验中,本发明采用的重载直角坐标机器人的x轴的有效行程是9米,z轴的有效行程是2.0米。本次实验将使用激光跟踪仪AT901-B测量重载机器人末端位置,该激光测量系统测量精度为15μm+6μm/m,,满足机器人标定的精度要求。
在重载机器人的1900mmx300mm的局部工作空间内,以100mm作为网格的步长,将机器人的局部作业空间划分为80个点的平面网格结构,如图8所示,采集用于辨识运动学参数偏差的数据点具体步骤如下:
(1).操作示教器使得重载直角坐标机器人返回待机点,输入x轴和z轴的移动距离,让重载机器人移动到第一个点,当机器人末端停稳后,用激光跟踪仪采集下第一个点的位置坐标;
(2).x轴每次都偏移100mm,让z轴的高度保持不变,移动到下一个点,同时采集这个点的位置坐标;
(3).当x轴移动次数达到20次后,z轴偏移100mm,在重复步骤(2),直到采集的末端位置坐标的个数达到80时,重载机器人返回待机点位置,同时记录该待机点位置坐标。
二、训练点的收集
通过使用图8的补偿程序,在负载m分别为80kg,100kg,120kg的情况下,每次实验,重载机器人末端以图示80个点为指定位置,使用不同补偿方法进行补偿,激光跟踪仪记录补偿后的位置,然后收集每个点的误差作为数据集。
三、4种标定方法在测试点的补偿结果
将本发明提出的HCT+BD+GPR方法将分别和HCT、HCT+BD、HCT+GPR方法进行对比。4种方法在80kg、100kg和120kg下的补偿结果如图9所示。从该图可以看出,HCT+BD+GPR方法补偿方法基本不受负载的影响,补偿后的精度变化小且鲁棒性强。这也证明了本发明所提出的方法是有效可行的。
本发明的各方面、实施例、特征及实例应视为在所有方面为说明性的且不打算限制本发明,本发明的范围仅由权利要求书界定。在不背离所主张的本发明的精神及范围的情况下,所属领域的技术人员将明了其它实施例、修改及使用。
在本发明案中标题及章节的使用不意味着限制本发明;每一章节可应用于本发明的任何方面、实施例或特征。
除非另外具体陈述,否则术语“包含(include、includes、including)”、“具有(have、has或having)”的使用通常应理解为开放式的且不具限制性。
应理解,各步骤的次序或执行特定动作的次序并非十分重要,只要本发明教示保持可操作即可。此外,可同时进行两个或两个以上步骤或动作。
尽管已参考说明性实施例描述了本发明,但所属领域的技术人员将理解,在不背离本发明的精神及范围的情况下可做出各种其它改变、省略及/或添加且可用实质等效物替代所述实施例的元件。另外,可在不背离本发明的范围的情况下做出许多修改以使特定情形或材料适应本发明的教示。因此,本文并不打算将本发明限制于用于执行本发明的所揭示特定实施例,而是打算使本发明将包含归属于所附权利要求书的范围内的所有实施例。
Claims (7)
1.一种重载机器人标定方法,其特征在于,所述方法包括:
其中,所述S100具体包括:
S101,建立重载机器人的三维模型,在该模型中,定义运动学参数向量 其中,θ1表示立柱OA与垂直方向的偏离角度,θ2表示AB与水平方向的偏离角度,θ3表示BP与垂直方向的偏离角度,h=|OA|表示立柱的高度,a0,b0表示x轴和z轴的平动关节零点位置的偏移,a,b被定义为x,z轴移动关节的位移;
5.根据权利要求1所述的重载机器人标定方法,其特征在于,所述S300包括:
S301,给定数据集D={(xi,ei)|i=1,2…,n=(X,e)},其中xi=(ai,bi,mi)是输入向量,ai,bi是机械手沿x和z轴的平动关节的移动距离,mi是负载的质量;
S302,设噪声δ~(0,σ2),残差数据e服从高斯过程的先验分布:e~N(0,K(X,X)+σ2I)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010695790.5A CN111775153B (zh) | 2020-07-17 | 2020-07-17 | 一种重载机器人标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010695790.5A CN111775153B (zh) | 2020-07-17 | 2020-07-17 | 一种重载机器人标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111775153A CN111775153A (zh) | 2020-10-16 |
CN111775153B true CN111775153B (zh) | 2022-08-26 |
Family
ID=72763449
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010695790.5A Active CN111775153B (zh) | 2020-07-17 | 2020-07-17 | 一种重载机器人标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111775153B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112338917B (zh) * | 2020-10-29 | 2022-04-22 | 广州大学 | 一种大行程多级伸缩臂的控制方法、系统、装置及介质 |
CN112596531B (zh) * | 2021-03-04 | 2021-06-22 | 德鲁动力科技(成都)有限公司 | 一种四足机器人自适应负载参数调整方法 |
CN113927594B (zh) * | 2021-09-26 | 2023-07-14 | 珠海格力智能装备有限公司 | 机器人的关节转角的补偿方法和装置 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4638232A (en) * | 1984-01-20 | 1987-01-20 | Mydata Automation Ab | Method and apparatus for calibrating a positioning system |
CN107042528A (zh) * | 2017-06-01 | 2017-08-15 | 中国科学院宁波材料技术与工程研究所 | 一种工业机器人的运动学标定系统及方法 |
CN108608462A (zh) * | 2018-05-07 | 2018-10-02 | 苏州尚贤医疗机器人技术股份有限公司 | 一种用于大型重载机械臂的四重精度补偿方法 |
CN109352655A (zh) * | 2018-11-28 | 2019-02-19 | 清华大学 | 一种基于多输出高斯过程回归的机器人变形补偿方法 |
CN109732610A (zh) * | 2019-03-01 | 2019-05-10 | 北京航空航天大学 | 人机协作机器人抓取系统及其工作方法 |
CN110549340A (zh) * | 2019-09-16 | 2019-12-10 | 聊城大学 | 重载码垛机器人频响特性分析方法及系统 |
CN111055273A (zh) * | 2019-05-16 | 2020-04-24 | 广西大学 | 一种用于机器人的两步误差补偿方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102015106227B3 (de) * | 2015-04-22 | 2016-05-19 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Steuern und/oder Regeln von Motoren eines Roboters |
-
2020
- 2020-07-17 CN CN202010695790.5A patent/CN111775153B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4638232A (en) * | 1984-01-20 | 1987-01-20 | Mydata Automation Ab | Method and apparatus for calibrating a positioning system |
CN107042528A (zh) * | 2017-06-01 | 2017-08-15 | 中国科学院宁波材料技术与工程研究所 | 一种工业机器人的运动学标定系统及方法 |
CN108608462A (zh) * | 2018-05-07 | 2018-10-02 | 苏州尚贤医疗机器人技术股份有限公司 | 一种用于大型重载机械臂的四重精度补偿方法 |
CN109352655A (zh) * | 2018-11-28 | 2019-02-19 | 清华大学 | 一种基于多输出高斯过程回归的机器人变形补偿方法 |
CN109732610A (zh) * | 2019-03-01 | 2019-05-10 | 北京航空航天大学 | 人机协作机器人抓取系统及其工作方法 |
CN111055273A (zh) * | 2019-05-16 | 2020-04-24 | 广西大学 | 一种用于机器人的两步误差补偿方法 |
CN110549340A (zh) * | 2019-09-16 | 2019-12-10 | 聊城大学 | 重载码垛机器人频响特性分析方法及系统 |
Non-Patent Citations (1)
Title |
---|
A Hybrid Analytical and Data-driven Modeling Approach for Calibration of Heavy-duty Cartesian Robot;Hongyu Wan 等;《2020 IEEE/ASME International Conference on Advanced Intelligent Mechatronics(AIM)》;20200709;第1286-1291页 * |
Also Published As
Publication number | Publication date |
---|---|
CN111775153A (zh) | 2020-10-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111775153B (zh) | 一种重载机器人标定方法 | |
CN110193829B (zh) | 一种耦合运动学与刚度参数辨识的机器人精度控制方法 | |
CN112873199B (zh) | 基于运动学与空间插值的机器人绝对定位精度标定方法 | |
CN111367236B (zh) | 一种面向加工过程的移动机器人系统标定方法及系统 | |
CN109822577B (zh) | 一种基于视觉伺服的移动式机器人高精度加工方法 | |
Chen et al. | A compensation method for enhancing aviation drilling robot accuracy based on co-kriging | |
CN107703748B (zh) | 一种基于偏置板设计的重载机器人静态刚度辨识方法 | |
CN106777656B (zh) | 一种基于pmpsd的工业机器人绝对精度校准方法 | |
CN113927599B (zh) | 绝对精度补偿方法及系统、设备和计算机可读存储介质 | |
CN107457785B (zh) | 一种基于关节反馈的机器人位置补偿方法 | |
CN111055273A (zh) | 一种用于机器人的两步误差补偿方法 | |
CN113580148B (zh) | 基于等效运动链的并联机器人运动学标定方法 | |
CN105773622A (zh) | 一种基于iekf的工业机器人绝对精度校准方法 | |
Cao et al. | Pose error compensation based on joint space division for 6-DOF robot manipulators | |
CN114147726A (zh) | 一种几何误差与非几何误差相结合的机器人标定方法 | |
CN110450165B (zh) | 一种基于零力控制的机器人标定方法 | |
Tang et al. | Trajectory tracking of robotic manipulators with constraints based on model predictive control | |
Bai et al. | The parameter identification model considering both geometric parameters and joint stiffness | |
CN112720480B (zh) | 一种基于分级误差的机器人轨迹修正方法及系统 | |
CN106096099A (zh) | 一种机械产品误差传递分析方法及其装置 | |
Lee et al. | Torque sensor calibration using virtual load for a manipulator | |
CN114131607B (zh) | 工业机器人广义运动学误差的运动学校准方法及系统 | |
Kim et al. | Joint compliance error compensation for robot manipulator using body frame | |
Mei et al. | Calibration of a 6-DOF industrial robot considering the actual mechanical structures and CNC system | |
Fan et al. | Calibration for a robotic drilling system with secondary encoders based on a novel enhanced rigid-flexible coupling model |
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 |