CN102692873A - 工业机器人定位精度标定方法 - Google Patents
工业机器人定位精度标定方法 Download PDFInfo
- Publication number
- CN102692873A CN102692873A CN2012101380780A CN201210138078A CN102692873A CN 102692873 A CN102692873 A CN 102692873A CN 2012101380780 A CN2012101380780 A CN 2012101380780A CN 201210138078 A CN201210138078 A CN 201210138078A CN 102692873 A CN102692873 A CN 102692873A
- Authority
- CN
- China
- Prior art keywords
- robot
- joint
- equation
- calibration
- value
- 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
Images
Landscapes
- Manipulator (AREA)
Abstract
本发明涉及一种工业机器人定位精度的标定方法,用于提高机器人的绝对定位精度。通过建立机器人的运动学模型;用圆周法建立旋转关节方程,计算关节扭转角参数值;运用激光跟踪仪对机器人末端实际位姿的精确测量;对D-H算法求逆运动学方程进行改进,求得几何结构参数,实现对关节距离参数值、关节偏移量的标定,从而完成第一次标定。将第一次标定后的结果对D-H参数进行误差修正,如定位精度未达到要求,可将参数修正值代替理论参数值代入运动学方程进行二次标定。实验证明,该标定方法提高了机器人的绝对定位精度。本发明中的标定方法具有简单,实用,引入外界误差小的优点。
Description
技术领域
本发明涉及一种机器人标定方法,特别涉及一种提高工业机器人定位精度的标定方法。
背景技术
工业机器人的运动精度对于它在生产中的应用可靠性起着至关重要的作用。而机器人各关节的几何参数误差是造成机器人定位误差的最主要原因,这主要是由于制造和安装过程中产生的关节实际几何参数与理论参数值之间的偏差造成的。通过标定可以将机器人的位姿误差大幅度降低,进而提高机器人的绝对精度。
标定的结果是一组被识别的机器人参数,这些参数可以作为提供给机器人生产厂家的产品质量检验指标,也可以用来给机器人用户提高机器人的绝对精度。而目前还没有一种精确的工业机器人的运动精度标定方法。
发明内容
本发明是要提供一种工业机器人定位精度的标定方法,用于提高工业机器人定位精度。
为实现上述目的,本发明的技术方案是:
一种工业机器人定位精度的标定方法,其特征在于:具体步骤是:
(1)建立机器人的运动学模型
用D-H连接变换齐次坐标模型来建立机器人的运动学模型,把每个变换定义为 ,在机器人的基座和手之间的总变换为:
(2)关节扭转角参数值的标定
(3)机器人末端实际位姿的测量
(4)关节距离参数值、关节偏移量的标定
通过逆运动学的变形式,利用逆变换矩阵左乘运动学方程两边,利用对应元素相等,由等式左右两边的元素,依次得出含有待修正参数的方程,通过多次运用三角代换和矩阵乘法、加法运算,求得多个含有待修正参数的方程,组成方程组,方程个数要足以解出待修正参数;
(5)将步骤(3)中指定的关节转角值及其对应的由激光跟踪仪测量得到的机器人末端执行器的实际位姿坐标值代入到(4)中所求得的方程组,解此方程租,得到关节距离参数值,关节偏移量的标定修正值。
如上述定位精度未达到要求,可将参数修正值代替理论参数值代入(1)中的运动学模型中,重复进行(1)~(5)的步骤,使标定定位精度更高。
工业机器人定位精度标定方法的运动学转换是在笛卡尔坐标空间中进行的。
用于计算机器人各关节旋转轴线方程的圆周法具体方法:保持各关节电动机不动,由跟踪仪测出机器人末端上的特征点的空间位置;接着,旋转要测的关节轴,分别施加正向力和逆向力,旋转后特征点对应的空间位置坐标分别记为;关节轴旋转方向垂直于三点所决定的空间圆平面,为圆心;则该关节轴的轴线方程为。
本发明的有益效果是:本发明提供的机器人标定方法实用性很强,简单、高效、快捷,并应用激光跟踪仪对机器人进行位姿测量,测量精度高。成功地辨识了机器人的几何结构参数,提高了机器人的绝对定位精度。本发明适用于任何关节型机器人,通用性强。并且能够提高机器人的综合性能。易于在线补偿且成本低,并且有利于实现机器人的离线编程。
本发明的其他特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本发明而了解。本发明的目的和其他优点可通过实施本发明而了解。本发明的目的和其他优点可通过在所写的说明书、权利要求书、以及附图中所特别指出的结构来实现和获得。
附图说明
图1是六轴工业机器人的D-H模型坐标系图;
图2是工业机器人的标定流程图;
图3是确定关节轴线方程的圆周法示意图。
具体实施方式
以下结合附图对本发明的优选实施例进行说明,应当理解,此处所描述的优选实施例仅用于说明和解释本发明,并不用于限定本发明。
参见附图1~2,本发明的工业机器人定位精度标定方法,包括以下几个步骤:
(1)建立机器人的运动学模型
机器人运动学分析通常用Denavit-Hartenberg(D-H)连接变换齐次坐标模型来表示。
在图1中,首先要为每个关节指定一个本地的参考坐标系,然后对相邻的两个关节进行变换。变换中,角表示绕z轴的旋转角(也叫关节转角),d表示在z轴上两条相邻的公垂线之间的距离(也叫关节距离),a表示每一条公垂线的长度(也叫关节偏移量),角表示两个相邻的z轴之间的角度(也叫关节扭转角)。
建立模型的几何参数值由理论参数值确定,在机器人的基座上,可以从第一个关节开始变换到第二个关节,然后到第三个……,最终到末端执行器。对于一个具有六个自由度的机器人而言,有6个矩阵。在六轴机器人的基座和手之间的总变换为:
(1)关节扭转角参数值的标定
利用圆周法确定机器人每个关节轴线方程。如图3所示,保持各关节电动机不动,由跟踪仪测出机器人末端上的特征点的空间位置;接着,旋转要测的关节轴,分别施加正向力和逆向力,旋转后特征点对应的空间位置坐标分别记为;关节轴旋转方向垂直于三点所决定的空间圆平面,为圆心;则该关节轴的轴线方程为。
从而确定机器人运动学模型中的关节扭转角修正参数值。
(3)机器人末端实际位姿的测量
测量之前首先要确定机器人的基坐标系,本实施例中假设所用机器人的基坐标系位于机器人的安装基座的中心上,垂直向上为z轴,正前方为x轴。在关节活动范围内,任意指定n组不同的关节转角值,每组的关节转角值尽可能均匀的分布在关节活动范围内。操作机器人,每组关节转角值δ转到位时,用激光跟踪仪测量出机器人的末端执行器的位姿。
(4)关节距离参数值、关节偏移量的标定
为了求解几何参数,从开始,依次用左乘上述两个矩阵,得到逆运动学方程。通过逆运动学的变形式,利用逆变换矩阵左乘运动学方程两边,利用对应元素相等,由等式左右两边的元素,依次得出含有待修正参数的方程。通过多次运用三角代换和矩阵乘法、加法运算,求得多个含有待修正参数的方程,组成方程组。即可解得,关节距离参数值、、和关节偏移量的修正值。
(5)将步骤(3)中指定的关节转角值及其对应的由激光跟踪仪测量得到的机器人末端执行器的实际位姿坐标代入到(4)中所求得的方程组。解此方程租,得到关节距离参数值,关节偏移量的标定修正值。
(6)如定位精度未达到要求,可将参数修正值代替理论参数值代入(1)中的运动学模型中,重复进行(1)~(5)的步骤,使标定定位精度更高。
Claims (4)
1.一种工业机器人定位精度的标定方法,其特征在于:具体步骤是:
(1)建立机器人的运动学模型
用D-H连接变换齐次坐标模型来建立机器人的运动学模型,把每个变换定义为 ,在机器人的基座和手之间的总变换为:
(2)关节扭转角参数值的标定
(3)机器人末端实际位姿的测量
(4)关节距离参数值、关节偏移量的标定
通过逆运动学的变形式,利用逆变换矩阵左乘运动学方程两边,利用对应元素相等,由等式左右两边的元素,依次得出含有待修正参数的方程,通过多次运用三角代换和矩阵乘法、加法运算,求得多个含有待修正参数的方程,组成方程组,方程个数要足以解出待修正参数;
(5)将步骤(3)中指定的关节转角值及其对应的由激光跟踪仪测量得到的机器人末端执行器的实际位姿坐标值代入到(4)中所求得的方程组,解此方程租,得到关节距离参数值,关节偏移量的标定修正值。
2.根据权利要求1所述的工业机器人定位精度的标定方法,其特征在于:如上述定位精度未达到要求,将参数修正值代替理论参数值代入(1)中的运动学模型中,重复进行(1)~(5)的步骤,使标定定位精度更高。
3.根据权利要求1所述的工业机器人定位精度的标定方法,其特征在于:工业机器人定位精度标定方法的运动学转换是在笛卡尔坐标空间中进行的。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012101380780A CN102692873A (zh) | 2012-05-07 | 2012-05-07 | 工业机器人定位精度标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012101380780A CN102692873A (zh) | 2012-05-07 | 2012-05-07 | 工业机器人定位精度标定方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN102692873A true CN102692873A (zh) | 2012-09-26 |
Family
ID=46858416
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2012101380780A Pending CN102692873A (zh) | 2012-05-07 | 2012-05-07 | 工业机器人定位精度标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102692873A (zh) |
Cited By (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103063213A (zh) * | 2013-01-04 | 2013-04-24 | 上海交通大学 | 一种焊接机器人与变位机位姿关系的标定方法 |
CN103481288A (zh) * | 2013-08-27 | 2014-01-01 | 浙江工业大学 | 一种5关节机器人末端工具位姿控制方法 |
CN103529856A (zh) * | 2013-08-27 | 2014-01-22 | 浙江工业大学 | 5关节机器人末端工具位姿控制方法 |
CN103759635A (zh) * | 2013-12-25 | 2014-04-30 | 合肥工业大学 | 一种精度与机器人无关的扫描测量机器人检测方法 |
CN103968761A (zh) * | 2014-05-28 | 2014-08-06 | 中科华赫(北京)科技有限责任公司 | 串联关节式机器人绝对定位误差校准方法及标定系统 |
CN104006778A (zh) * | 2014-06-12 | 2014-08-27 | 安徽埃夫特智能装备有限公司 | 一种工业机器人末端夹具安装位置的标定方法 |
CN104608129A (zh) * | 2014-11-28 | 2015-05-13 | 江南大学 | 基于平面约束的机器人标定方法 |
CN104833324A (zh) * | 2015-01-28 | 2015-08-12 | 江南大学 | 一种基于测量头的机器人标定方法 |
CN104965486A (zh) * | 2015-06-17 | 2015-10-07 | 广汽本田汽车有限公司 | 一种非标机器人建模方法 |
CN105788443A (zh) * | 2016-05-20 | 2016-07-20 | 南通大学 | 基于d-h参数法的机器人运动学教具 |
CN106097395A (zh) * | 2016-06-21 | 2016-11-09 | 安徽工业大学 | 一种基于直线位移传感器的工业机器人运动学参数的标定算法 |
CN106406277A (zh) * | 2016-09-23 | 2017-02-15 | 贵州珞石三盛科技有限公司 | 机器人运动学参数误差优化补偿方法及装置 |
CN106502208A (zh) * | 2016-09-23 | 2017-03-15 | 佛山华数机器人有限公司 | 一种工业机器人tcp标定方法 |
CN106514636A (zh) * | 2016-12-16 | 2017-03-22 | 宁波帝洲自动化科技有限公司 | 一种机器人末端位姿分析方法 |
CN106777656A (zh) * | 2016-12-09 | 2017-05-31 | 江南大学 | 一种基于pmpsd的工业机器人绝对精度校准方法 |
CN107175660A (zh) * | 2017-05-08 | 2017-09-19 | 同济大学 | 一种基于单目视觉的六自由度机器人运动学标定方法 |
CN107309884A (zh) * | 2016-04-27 | 2017-11-03 | 上海福赛特机器人有限公司 | 机器人标定系统及方法 |
CN107775664A (zh) * | 2017-10-20 | 2018-03-09 | 重庆鲁班机器人技术研究院有限公司 | 控制器位置控制性能测试方法及装置 |
CN108463314A (zh) * | 2016-01-11 | 2018-08-28 | 库卡德国有限公司 | 机器人相对于重力方向的定向的确定 |
CN109238199A (zh) * | 2018-09-03 | 2019-01-18 | 清华大学 | 一种机器人旋转轴运动学参数标定方法 |
CN109864819A (zh) * | 2019-02-15 | 2019-06-11 | 沈阳智能机器人国家研究院有限公司 | 一种获取机器人机械手运动学模型的方法 |
CN110480638A (zh) * | 2019-08-20 | 2019-11-22 | 南京博约智能科技有限公司 | 一种多关节机器人位姿误差自补偿的码垛方法及其码垛系统 |
CN113568366A (zh) * | 2020-04-29 | 2021-10-29 | 北京配天技术有限公司 | 机器人的运动控制方法、系统及计算机存储介质 |
CN115062482A (zh) * | 2022-06-27 | 2022-09-16 | 合肥工业大学 | 一种考虑旋转关节定位误差的串联机器人运动学建模方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050038563A1 (en) * | 2003-08-16 | 2005-02-17 | Abdul Rauf | Device and method for kinematic calibration of robots |
CN101231749A (zh) * | 2007-12-20 | 2008-07-30 | 昆山华恒工程技术中心有限公司 | 一种工业机器人的标定方法 |
CN101660904A (zh) * | 2009-09-22 | 2010-03-03 | 大连海事大学 | 一种用于测量机器人的运动学标定的方法 |
CN102022989A (zh) * | 2010-09-29 | 2011-04-20 | 山东科技大学 | 一种基于指数积模型的机器人标定方法 |
-
2012
- 2012-05-07 CN CN2012101380780A patent/CN102692873A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050038563A1 (en) * | 2003-08-16 | 2005-02-17 | Abdul Rauf | Device and method for kinematic calibration of robots |
CN101231749A (zh) * | 2007-12-20 | 2008-07-30 | 昆山华恒工程技术中心有限公司 | 一种工业机器人的标定方法 |
CN101660904A (zh) * | 2009-09-22 | 2010-03-03 | 大连海事大学 | 一种用于测量机器人的运动学标定的方法 |
CN102022989A (zh) * | 2010-09-29 | 2011-04-20 | 山东科技大学 | 一种基于指数积模型的机器人标定方法 |
Non-Patent Citations (1)
Title |
---|
叶声华等: "基于激光跟踪仪的机器人运动学参数标定方法", 《天津大学学报》 * |
Cited By (36)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103063213B (zh) * | 2013-01-04 | 2015-10-14 | 上海交通大学 | 一种焊接机器人与变位机位姿关系的标定方法 |
CN103063213A (zh) * | 2013-01-04 | 2013-04-24 | 上海交通大学 | 一种焊接机器人与变位机位姿关系的标定方法 |
CN103481288A (zh) * | 2013-08-27 | 2014-01-01 | 浙江工业大学 | 一种5关节机器人末端工具位姿控制方法 |
CN103529856A (zh) * | 2013-08-27 | 2014-01-22 | 浙江工业大学 | 5关节机器人末端工具位姿控制方法 |
CN103529856B (zh) * | 2013-08-27 | 2016-04-13 | 浙江工业大学 | 5旋转关节机器人末端工具位姿控制方法 |
CN103759635A (zh) * | 2013-12-25 | 2014-04-30 | 合肥工业大学 | 一种精度与机器人无关的扫描测量机器人检测方法 |
CN103759635B (zh) * | 2013-12-25 | 2016-10-26 | 合肥工业大学 | 一种精度与机器人无关的扫描测量机器人检测方法 |
CN103968761A (zh) * | 2014-05-28 | 2014-08-06 | 中科华赫(北京)科技有限责任公司 | 串联关节式机器人绝对定位误差校准方法及标定系统 |
CN104006778A (zh) * | 2014-06-12 | 2014-08-27 | 安徽埃夫特智能装备有限公司 | 一种工业机器人末端夹具安装位置的标定方法 |
CN104006778B (zh) * | 2014-06-12 | 2017-04-19 | 埃夫特智能装备股份有限公司 | 一种工业机器人末端夹具安装位置的标定方法 |
CN104608129A (zh) * | 2014-11-28 | 2015-05-13 | 江南大学 | 基于平面约束的机器人标定方法 |
CN104833324A (zh) * | 2015-01-28 | 2015-08-12 | 江南大学 | 一种基于测量头的机器人标定方法 |
CN104965486A (zh) * | 2015-06-17 | 2015-10-07 | 广汽本田汽车有限公司 | 一种非标机器人建模方法 |
CN104965486B (zh) * | 2015-06-17 | 2018-08-07 | 广汽本田汽车有限公司 | 一种非标机器人建模方法 |
CN108463314A (zh) * | 2016-01-11 | 2018-08-28 | 库卡德国有限公司 | 机器人相对于重力方向的定向的确定 |
CN107309884B (zh) * | 2016-04-27 | 2023-03-21 | 上海捷勃特机器人有限公司 | 机器人标定系统及方法 |
CN107309884A (zh) * | 2016-04-27 | 2017-11-03 | 上海福赛特机器人有限公司 | 机器人标定系统及方法 |
CN105788443A (zh) * | 2016-05-20 | 2016-07-20 | 南通大学 | 基于d-h参数法的机器人运动学教具 |
CN105788443B (zh) * | 2016-05-20 | 2018-05-08 | 南通大学 | 基于d-h参数法的机器人运动学教具 |
CN106097395B (zh) * | 2016-06-21 | 2019-03-05 | 安徽工业大学 | 一种基于直线位移传感器的工业机器人运动学参数的标定方法 |
CN106097395A (zh) * | 2016-06-21 | 2016-11-09 | 安徽工业大学 | 一种基于直线位移传感器的工业机器人运动学参数的标定算法 |
CN106502208B (zh) * | 2016-09-23 | 2018-04-27 | 佛山华数机器人有限公司 | 一种工业机器人tcp标定方法 |
CN106502208A (zh) * | 2016-09-23 | 2017-03-15 | 佛山华数机器人有限公司 | 一种工业机器人tcp标定方法 |
CN106406277A (zh) * | 2016-09-23 | 2017-02-15 | 贵州珞石三盛科技有限公司 | 机器人运动学参数误差优化补偿方法及装置 |
CN106777656B (zh) * | 2016-12-09 | 2020-04-14 | 江南大学 | 一种基于pmpsd的工业机器人绝对精度校准方法 |
CN106777656A (zh) * | 2016-12-09 | 2017-05-31 | 江南大学 | 一种基于pmpsd的工业机器人绝对精度校准方法 |
CN106514636A (zh) * | 2016-12-16 | 2017-03-22 | 宁波帝洲自动化科技有限公司 | 一种机器人末端位姿分析方法 |
CN107175660A (zh) * | 2017-05-08 | 2017-09-19 | 同济大学 | 一种基于单目视觉的六自由度机器人运动学标定方法 |
CN107775664A (zh) * | 2017-10-20 | 2018-03-09 | 重庆鲁班机器人技术研究院有限公司 | 控制器位置控制性能测试方法及装置 |
CN109238199A (zh) * | 2018-09-03 | 2019-01-18 | 清华大学 | 一种机器人旋转轴运动学参数标定方法 |
CN109238199B (zh) * | 2018-09-03 | 2020-04-03 | 清华大学 | 一种机器人旋转轴运动学参数标定方法 |
CN109864819A (zh) * | 2019-02-15 | 2019-06-11 | 沈阳智能机器人国家研究院有限公司 | 一种获取机器人机械手运动学模型的方法 |
CN110480638A (zh) * | 2019-08-20 | 2019-11-22 | 南京博约智能科技有限公司 | 一种多关节机器人位姿误差自补偿的码垛方法及其码垛系统 |
CN113568366A (zh) * | 2020-04-29 | 2021-10-29 | 北京配天技术有限公司 | 机器人的运动控制方法、系统及计算机存储介质 |
CN113568366B (zh) * | 2020-04-29 | 2023-03-21 | 北京配天技术有限公司 | 机器人的运动控制方法、系统及计算机存储介质 |
CN115062482A (zh) * | 2022-06-27 | 2022-09-16 | 合肥工业大学 | 一种考虑旋转关节定位误差的串联机器人运动学建模方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102692873A (zh) | 工业机器人定位精度标定方法 | |
CN107443382B (zh) | 工业机器人结构参数误差辨识与补偿方法 | |
CN107717993B (zh) | 一种高效便捷的简易机器人标定方法 | |
KR101162432B1 (ko) | 다축 제어 기계의 오차 보정 방법 | |
CN109159151A (zh) | 一种机械臂空间轨迹跟踪动态补偿方法和系统 | |
CN102161153B (zh) | 一种用于自动化装配的模块化柔性六自由度并联冗余驱动调姿机构及其调整方法 | |
CN102566577A (zh) | 一种工业机器人简易标定方法 | |
CN105773609A (zh) | 一种基于视觉测量及距离误差模型的机器人运动学标定方法 | |
US20210197396A1 (en) | Method for measuring pose of robotic end tool | |
CN105643641B (zh) | 力传感器标定装置、标定方法及力控制机器人 | |
CN104890013A (zh) | 一种基于拉线编码器的工业机器人标定算法 | |
CN102087096A (zh) | 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法 | |
CN108406769B (zh) | 串联机器人的关节旋转角度确定方法及装置 | |
CN109623822B (zh) | 机器人手眼标定方法 | |
CN110757454A (zh) | 一种双机器人协同旋转的路径规划方法和装置 | |
CN113211431B (zh) | 基于二维码修正机器人系统的位姿估计方法 | |
CN105643619B (zh) | 一种采用框架描述的工业机器人工具位姿控制方法 | |
CN103395073A (zh) | 一种六轴工业机器人的零点标定方法 | |
CN111055273A (zh) | 一种用于机器人的两步误差补偿方法 | |
CN109176531A (zh) | 一种串联型机器人运动学标定方法和系统 | |
CN111037542B (zh) | 一种逆动力学控制机器人直线加工的轨迹误差补偿方法 | |
CN104354166A (zh) | 一种三自由度并联机器人的零点标定方法 | |
CN104833324A (zh) | 一种基于测量头的机器人标定方法 | |
CN111426270A (zh) | 一种工业机器人位姿测量靶标装置和关节位置敏感误差标定方法 | |
CN114161425B (zh) | 一种工业机器人的误差补偿方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20120926 |