CN109623822B - 机器人手眼标定方法 - Google Patents
机器人手眼标定方法 Download PDFInfo
- Publication number
- CN109623822B CN109623822B CN201811621251.6A CN201811621251A CN109623822B CN 109623822 B CN109623822 B CN 109623822B CN 201811621251 A CN201811621251 A CN 201811621251A CN 109623822 B CN109623822 B CN 109623822B
- Authority
- CN
- China
- Prior art keywords
- joint axis
- coordinate system
- robot
- tetrahedron
- calculating
- 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/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
Description
技术领域
本发明属于机器人视觉标定技术领域,具体地说,本发明涉及一种机器人手眼标定方法。
背景技术
目前机器人手眼标定方法主要有求解齐次方程AX=XB,其中X是未知的手眼变换,A和B是机器人末端执行器的运动和相机,在手眼标定过程中,精度较低且容易受到工业机器人参数误差的影响。
发明内容
本发明旨在至少解决现有技术中存在的技术问题之一。为此,本发明提供一种机器人手眼标定方法,目的是提高标定结果精度。
为了实现上述目的,本发明采取的技术方案为:机器人手眼标定方法,包括步骤:
S1、设置激光跟踪仪和四面体,工业机器人上设置对四面体进行测量的激光扫描仪;
所述步骤S1中,工业机器人上设置线性滑台,所述激光扫描仪设置于线性滑台上。
所述步骤S2中,将与所述激光跟踪仪相配合的反射器设置于工业机器人末端,分别旋转工业机器人的第五关节轴和第六关节轴,设第五关节轴的旋转轴为L1,设第六关节轴的旋转轴为L2,以公共垂直线的中点q1作为第五关节轴坐标系O5的原点,n3是单位向量n1和n2的叉积,n'2是单位向量n1和n3的叉积。
所述步骤S3包括:
S301、旋转工业机器人的第六关节轴;
S302、获取四面体的三面点云;
S303、拟合三面点云来获得三个平面S1、S2、S3,将三个平面S1、S2、S3的交点q2设置为四面体的坐标系OT的原点,将四面体坐标系OT的x、y、z轴分别设置为n4、n5、n6;
所述步骤S4包括:
S401、获取四面体的三个平面的数据并且表示为S’1、S’2、S’3,
向量,n'5是平面S’1和S’2交线的单位向量,n′6为n'4和n'5的叉积,q'2是平面S’1、S’2和S’3的交点;
所述步骤S403中,d6=200mm。
本发明的机器人手眼标定方法,利用激光跟踪仪和精心设计的四面体对机器人进行手眼标定,避免手眼标定受工业机器人参数误差的影响,测量精度更高,标定结果准确可靠。
附图说明
本说明书包括以下附图,所示内容分别是:
图1是手眼标定实验方案图;
图2是机器人-激光扫描仪系统的结构示意图;
图3是手眼标定示意图;
图4是步骤S2中建立的原理图;
图5是获取四面体的三面点云示意图;
图6是激光跟踪仪采集的校准数据示意图;
图中标记为:1、工业机器人;2、线性滑台;3、激光扫描仪;4、四面体;5、激光跟踪仪。
具体实施方式
下面对照附图,通过对实施例的描述,对本发明的具体实施方式作进一步详细的说明,目的是帮助本领域的技术人员对本发明的构思、技术方案有更完整、准确和深入的理解,并有助于其实施。
如图1和图2所示,本发明提供了一种机器人手眼标定方法,包括步骤:
S1、设置激光跟踪仪和四面体,工业机器人上设置对四面体进行测量的激光扫描仪;
具体地说,如图1和图2所示,工业机器人为六自由度机器人,末端执行器作为工业机器人的第六关节轴,末端执行器是由伺服电机驱动。工业机器人的一个机械臂以能够旋转的方式与末端执行器连接,形成工业机器人的第五关节轴,第五关节轴的轴线与第六关节轴的轴线相垂直。
在上述步骤S1中,工业机器人上设置线性滑台,激光扫描仪设置于线性滑台上,线性滑台安装在工业机器人的末端执行器上,线性滑台用于控制激光扫描仪进行线性移动。工业机器人运动至要测量的四面体处,通过激光扫描仪对四面体进行测量,为了提高激光扫描仪的测量范围,线性滑台进行线性移动,从而带动激光扫描仪进行测量。
如图2所示,机器人-激光扫描仪系统由一台工业机器人、一台线性滑台和一台激光扫描仪组成,线性滑台和线激光扫描的组合视为3D扫描系统。
在上述步骤S2中,将与激光跟踪仪相配合的反射器设置于工业机器人上,分别旋转工业机器人的第五关节轴和第六关节轴,设第五关节轴的旋转轴为L1,设第六关节轴的旋转轴为L2,以公共垂直线的中点q1作为第五关节轴坐标系O5的原点,n3是单位向量n1和n2的叉积,n'2是单位向量n1和n3的叉积。
具体地说,在上述步骤S2中,将反射器(激光跟踪器的附件)放置在工业机器人的末端执行器上,分别旋转工业机器人的第五关节轴和第六个关节轴,并测量旋转所得圆弧C1和C2的大小,C1是第五关节轴旋转所得圆弧,C2是第六关节轴旋转所得圆弧。随后,分别通过C1和C2计算出第五关节轴的旋转轴L1和第六关节轴的旋转轴L2的位置。假定单位向量n1和n2分别平行于旋转轴L1和L2,n3是单位向量n1和n2的叉积。转换矩阵可以由n1,n2,n3确定,并且n1,n2,n3的交点设置为第五关节轴坐标系O5的原点。由于工业机器人的运动参数的误差,可能导致旋转轴L1和L2处于不同的平面或不垂直,如图4所示。为了获得更高精度的转换矩阵以公共垂直线的中点q1作为第五关节轴坐标系O5的原点,并且利用n1和n3的叉积所得的n'2替换n2。因此,得到转换矩阵的计算如下:
上述步骤S3包括:
S301、旋转工业机器人的第六关节轴;
S302、获取四面体的三面点云;
S303、拟合三面点云来获得三个平面S1、S2、S3,将三个平面S1、S2、S3的交点q2设置为四面体的坐标系OT的原点,将四面体坐标系OT的x、y、z轴分别设置为n4、n5、n6;
具体地说,在上述步骤S3中,将四面体放置在机器人-激光扫描仪系统的工作空间中,并保持机器人的前五个关节轴与步骤S1相同,只是旋转第六关节轴。然后用3D扫描系统获取精心设计的四面体三面点云并且将第六关节轴旋转的角度记为θ。如图5所示,通过拟合三面点云来获得三个平面S1、S2、S3,S1、S2、S3的交点q2设置为四面体坐标系OT的原点。假定n4是S1的单位法向量,L3为平面S1和S2的交线,n5是与L3平行的单位向量,n6为n4和n5的叉积,四面体坐标系OT的x、y、z轴分别设置为n4、n5、n6。因此转换矩阵被定义为:
上述步骤S4包括:
S401、获取四面体的三个平面的数据并且表示为S’1、S’2、S’3,
具体地说,在上述步骤S4中,如图6所示,保持四面体与步骤S3相同,用激光跟踪仪和T-Probe(T-probe是激光跟踪仪的测量辅助件件)分别获取四面体的三个平面的数据并且表示为S’1、S’2、S’3。转换矩阵被定义为:
其中,n'4是平面S’1的单位法向量,n'5是平面S’1和S’2交线的单位向量。n′6为n'4和n'5的叉积,q'2是平面S’1、S’2和S’3的交点。
如图3所示,获得以下等式:
其中,d6,a6,α6是MDH模型的参数。本发明中的工业机器人的参数如下:d6=200mm,a6=0,α6=0。
因此,手眼变换是
其中,θ是步骤S3中第六关节轴的旋转角度。
以上结合附图对本发明进行了示例性描述。显然,本发明具体实现并不受上述方式的限制。只要是采用了本发明的方法构思和技术方案进行的各种非实质性的改进;或未经改进,将本发明的上述构思和技术方案直接应用于其它场合的,均在本发明的保护范围之内。
Claims (2)
1.机器人手眼标定方法,其特征在于,包括步骤:
S1、设置激光跟踪仪和四面体,工业机器人上设置对四面体进行测量的激光扫描仪;
在步骤S2中,将反射器放置在工业机器人的末端执行器上,设第五关节轴的旋转轴为L1,设第六关节轴的旋转轴为L2,分别旋转工业机器人的第五关节轴和第六个关节轴,并测量旋转所得圆弧C1和C2的大小,C1是第五关节轴旋转所得圆弧,C2是第六关节轴旋转所得圆弧;随后,分别通过C1和C2计算出第五关节轴的旋转轴L1和第六关节轴的旋转轴L2的位置;假定单位向量n1和n2分别平行于旋转轴L1和L2,转换矩阵由n1,n2,n3确定,n3是单位向量n1和n2的叉积,n’2是单位向量n1和n3的叉积;n1,n2,n3的交点设置为第五关节轴坐标系O5的原点,利用n1和n3的叉积所得的n’2替换n2;
步骤S3包括:
S301、旋转工业机器人的第六关节轴;
S302、获取四面体的三面点云;
S303、拟合三面点云来获得三个平面S1、S2、S3,将三个平面S1、S2、S3的交点q2设置为四面体的坐标系OT的原点,将四面体坐标系OT的x、y、z轴分别设置为n4、n5、n6;
在步骤S3中,将四面体放置在机器人-激光扫描仪系统的工作空间中,并保持机器人的前五个关节轴与步骤S1相同,只是旋转第六关节轴;然后用3D扫描系统获取精心设计的四面体三面点云并且将第六关节轴旋转的角度记为θ;
步骤S4包括:
S401、保持四面体与步骤S3相同,用激光跟踪仪和T-Probe分别获取四面体的三个平面的数据并且表示为S’1、S’2、S’3;
获得以下等式:
其中,d6,a6,α6是MDH模型的参数;本发明中的工业机器人的参数如下:d6=200mm,a6=0,α6=0;
2.根据权利要求1所述的机器人手眼标定方法,其特征在于,所述步骤S1中,工业机器人上设置线性滑台,所述激光扫描仪设置于线性滑台上。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811621251.6A CN109623822B (zh) | 2018-12-28 | 2018-12-28 | 机器人手眼标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811621251.6A CN109623822B (zh) | 2018-12-28 | 2018-12-28 | 机器人手眼标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109623822A CN109623822A (zh) | 2019-04-16 |
CN109623822B true CN109623822B (zh) | 2022-05-27 |
Family
ID=66078674
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811621251.6A Active CN109623822B (zh) | 2018-12-28 | 2018-12-28 | 机器人手眼标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109623822B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110842901B (zh) * | 2019-11-26 | 2021-01-15 | 广东技术师范大学 | 基于一种新型三维标定块的机器人手眼标定方法与装置 |
CN110986959B (zh) * | 2019-12-31 | 2021-10-29 | 深圳市优必选科技股份有限公司 | 一种双足机器人及其导航定位方法和装置 |
CN111890354B (zh) * | 2020-06-29 | 2022-01-11 | 北京大学 | 一种机器人手眼标定方法、装置及系统 |
CN113681559B (zh) * | 2021-08-24 | 2023-01-03 | 宁波光雷睿融智能系统有限公司 | 一种基于标准圆柱的线激光扫描机器人手眼标定方法 |
CN114798873B (zh) * | 2022-04-26 | 2023-03-07 | 广州蓝方自动化设备有限公司 | 一种用于管接头高速冲压成型工艺及其一体化设备 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104457569A (zh) * | 2014-11-27 | 2015-03-25 | 大连理工大学 | 一种大型复合板材几何参数视觉测量方法 |
CN105014679A (zh) * | 2015-08-03 | 2015-11-04 | 华中科技大学无锡研究院 | 一种基于扫描仪的机器人手眼标定方法 |
CN105303560A (zh) * | 2015-09-22 | 2016-02-03 | 中国计量学院 | 机器人激光扫描式焊缝跟踪系统标定方法 |
CN106959080A (zh) * | 2017-04-10 | 2017-07-18 | 上海交通大学 | 一种大型复杂曲面构件三维形貌光学测量系统和方法 |
-
2018
- 2018-12-28 CN CN201811621251.6A patent/CN109623822B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104457569A (zh) * | 2014-11-27 | 2015-03-25 | 大连理工大学 | 一种大型复合板材几何参数视觉测量方法 |
CN105014679A (zh) * | 2015-08-03 | 2015-11-04 | 华中科技大学无锡研究院 | 一种基于扫描仪的机器人手眼标定方法 |
CN105303560A (zh) * | 2015-09-22 | 2016-02-03 | 中国计量学院 | 机器人激光扫描式焊缝跟踪系统标定方法 |
CN106959080A (zh) * | 2017-04-10 | 2017-07-18 | 上海交通大学 | 一种大型复杂曲面构件三维形貌光学测量系统和方法 |
Non-Patent Citations (2)
Title |
---|
三维形貌柔性测量系统标定方法及验证;侯茂盛,王强,马国庆等;《应用光学》;20180531;第39卷(第3期);全文 * |
基于对偶四元数的机器人基坐标系标定方法研究;高远,刘晓平,王刚等;《机电工程》;20170331;第34卷(第3期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN109623822A (zh) | 2019-04-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109623822B (zh) | 机器人手眼标定方法 | |
CN108818536B (zh) | 一种机器人手眼标定的在线偏移修正方法及装置 | |
CN107717993B (zh) | 一种高效便捷的简易机器人标定方法 | |
US9782899B2 (en) | Calibration method for coordinate system of robot manipulator | |
JP4021413B2 (ja) | 計測装置 | |
US11072078B2 (en) | Method for measuring pose of robotic end tool | |
CN102607457B (zh) | 基于惯性导航技术的大尺寸三维形貌测量装置及方法 | |
CN111660295A (zh) | 工业机器人绝对精度标定系统及标定方法 | |
US20160279800A1 (en) | Robot, robot control device, and robotic system | |
CN109227551B (zh) | 一种视觉定位机器人手眼坐标转换方法 | |
CN110906863B (zh) | 一种用于线结构光传感器的手眼标定系统及标定方法 | |
JP5618770B2 (ja) | ロボットの校正装置および校正方法 | |
CN109781164B (zh) | 一种线激光传感器的静态标定方法 | |
CN111366908B (zh) | 一种激光雷达转台及其测量装置和测量方法 | |
CN106737859B (zh) | 基于不变平面的传感器与机器人的外部参数标定方法 | |
CN102692873A (zh) | 工业机器人定位精度标定方法 | |
CN110480642A (zh) | 工业机器人及其利用视觉标定用户坐标系的方法 | |
TWI493153B (zh) | 非接觸式物件空間資訊量測裝置與方法及取像路徑的計算方法 | |
CN112917513A (zh) | 一种基于机器视觉的三维点胶针头的tcp标定方法 | |
CN110757504A (zh) | 高精度可移动机器人的定位误差补偿方法 | |
CN104197831B (zh) | 一种六关节工业机器人的精度标定装置 | |
CN104385281A (zh) | 一种两自由度高速并联机器人的零点标定方法 | |
CN109514554B (zh) | 利用机器人末端视觉系统的工具坐标系快速标定方法 | |
WO2018043524A1 (ja) | ロボットシステム、ロボットシステム制御装置、およびロボットシステム制御方法 | |
CN113211431A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |