基于位置跟踪器的机器人快速示教方法

doi:10.12141/j.issn.1000-565X.220003

华南理工大学学报(自然科学版) ›› 2022, Vol. 50 ›› Issue (10): 62-69.doi: 10.12141/j.issn.1000-565X.220003

所属专题： 2022年电子、通信与自动控制

• 电子、通信与自动控制 • 上一篇下一篇

基于位置跟踪器的机器人快速示教方法

史步海¹ 欧华海¹ 郭清达²

^1.华南理工大学自动化科学与工程学院，广东广州 510640
^2.广州工业智能研究院，广东广州 511458

收稿日期:2022-01-05 出版日期:2022-10-25 发布日期:2022-05-06
通信作者: 史步海（1963-），男，博士，教授，主要从事数控及机器人运动控制系统、计算机远程监控系统以及大时滞系统等研究。 E-mail:bhshi@scut.edu.cn
作者简介:史步海（1963-），男，博士，教授，主要从事数控及机器人运动控制系统、计算机远程监控系统以及大时滞系统等研究。
基金资助:
广东省科技基础研究项目(2018A030321001);广州市基础与应用基础研究项目(202201010081)

A Fast Teaching Method of Robot Based on Position Tracker

SHI Buhai¹ OU Huahai¹ GUO Qingda²

^1.School of Automation Science and Engineering，South China University of Technology，Guangzhou 510640，Guangdong，China
^2.Guangzhou Industrial Intelligence Research Institute，Guangzhou 511458，Guangdong，China

Received:2022-01-05 Online:2022-10-25 Published:2022-05-06
Contact: 史步海（1963-），男，博士，教授，主要从事数控及机器人运动控制系统、计算机远程监控系统以及大时滞系统等研究。 E-mail:bhshi@scut.edu.cn
About author:史步海（1963-），男，博士，教授，主要从事数控及机器人运动控制系统、计算机远程监控系统以及大时滞系统等研究。
Supported by:
Guangdong Province Science and Technology Basic Project(2018A030321001)

摘要/Abstract

摘要：

针对中大型机械臂拖动示教中迟滞和难以精细化操作、控制困难等问题，提出一种基于位置跟踪器的机器人快速示教系统。首先，位置跟踪器接收端被固定在机械臂末端，对其进行坐标系数学建模；其次，分别推导了机器人基坐标系-末端坐标系和位置跟踪器发射端坐标系-接收端坐标系的变换关系，给出了采用基于四元数的求解位置跟踪器发射端坐标系与机器人基坐标系的变换关系的方法；最后，在标定完成后可将位置跟踪器接收端当成示教笔用于机器人示教工作。根据位置跟踪器接收端坐标系与机器人基座标系的变换关系即可将位置跟踪器接收端的位姿转换成机器人基坐标系下的位姿，无需拖动机器人即可快速完成机器人示教，获取路点信息；此外，位置跟踪器接收端相比机器人末端更轻便小巧。在一些需要在小范围示教场景下，使用位置跟踪器接收端进行示教工作比人工拖动机器人更加方便、高效。在验证测试中，采用大象公司的E系列工业机器人和美国Ascension公司的trakStar位置跟踪器搭建了快速示教系统，分别进行了误差实验和喷涂应用场景下的轨迹示教实验。实验结果表明，基于位置跟踪器接收端位姿计算得到的机器人末端位姿中，旋转角误差绝对值不超过0.8°，平移误差绝对值小于2.5 mm，能够满足实际的机器人快速示教需求。

关键词: 机器人, 位置跟踪器, 拖动示教, 轨迹示教

Abstract:

In order to avoid the problems of delay, low control accuracy, and difficult operation in the drag teaching of medium and large manipulators, the study proposed a fast teaching system for robots based on position tracker. Firstly, the position tracker receiver was fixed at the end of the manipulator, and the relationship between their coordinate systems was analyzed. Secondly, the study deduced the transformation relationship between the robot base coordinate system and the position tracker transmitter coordinate system, and the position relationship between the robot end coordinate system and the position tracker receiver coordinate system. A solution method based on quaternion was proposed to carry out transformation relationship between the transmitter coordinate system and the robot base coordinate system. Finally, the position tracker receiver can be used as a teaching pen for robot dragging teaching when the calibration work is done. Accodring to the transformation relationship between the robot base coordinate system and the position tracker receiver, teaching work and getting waypoint information can be completed easily and quickly by converting the pose of the receiver to the pose of the robot base coordinate system without dragging. In addition, the position tracker receiver is lighter and smaller than robot end. Using the position tracker receiver for drag teaching is more convenient and efficient than manually dragging the robot in some scenarios that require drag teaching in a small area. A fast teaching system with the Elephant E series industrial robot and the trakStar position tracker of Ascension in US was built to carry out the error experiment and the trajectory teaching experiment in spraying application. The experimental results show that the absolute of the rotation angle error of the robot end pose calculated by the position tracker’s pose is no more than 0.8°, and the absolute of the translation error is less than 2.5 mm, which can meet the actual control requirements.

Key words: robot, position tracker, drag teaching, trajectory teaching

中图分类号:

TP242.2

史步海, 欧华海, 郭清达. 基于位置跟踪器的机器人快速示教方法[J]. 华南理工大学学报(自然科学版), 2022, 50(10): 62-69.

SHI Buhai, OU Huahai, GUO Qingda . A Fast Teaching Method of Robot Based on Position Tracker[J]. Journal of South China University of Technology(Natural Science Edition), 2022, 50(10): 62-69.

图/表 10

图1

表1

图2

图3

图4

图5

表2

机器人位姿矩阵误差"

校验路点序号

旋转角误差/（°）

平移分量误差/mm

Δ ψ

Δ θ

Δ ?

Δ x

Δ y

Δ z

-0.40

0.40

-0.80

0.22

-0.25

0.50

-0.26

0.17

0.11

-0.03

0.64

-2.11

2.17

2.45

0.11

1.31

1.05

-2.11

表2

表3

7个示教点的笛卡尔空间坐标"

示教点序号

x/mm

y

/mm

z/mm

978.51

931.27

893.38

849.94

826.21

807.53

781.25

-873.73

-876.64

-876.15

-882.92

-894.81

-908.86

-905.29

241.82

210.59

164.31

102.99

19.59

-94.35

-325.34

表3

图6

图7

参考文献 28

1	孔民秀，赵宁．机器人示教臂系统的示教实现［J］．机械与电子，2015（10）：76-80.
	KONG Minxiu， ZAHO Ning ．Realization of teaching met-hod byrobot teaching arm ［J］．Machinery and Electronics，2015（10）：76-80.
2	韦祖杰．机器人快速示教方法及示教点位姿变换的研究［J］．装备制造技术，2021（4）：267-270.
	WEI Zujie ．Research on robot fast teaching method and teaching point attitude transformation ［J］．Equipment Manufacturing Technology，2021（4）：267-270.
3	TSAI R Y， LENZ R K ．A new technique for fully autonomous and efficient 3D robotics hand/eye calibration ［J］．IEEE Transactions on Robotics and Automation，1989，5（3）：345-358.
4	SHIU Y C， AHMAD S ．Calibration of wrist-mounted robotic sensors by solving homogeneous transform equations of the form AX=XB ［J］．IEEE Transactions on Roboticsand Automation，1989，5（1）：16-29.
5	钟宇，张静，张华，等.基于目标检测的机器人手眼标定方法［J］．计算机工程，2022，48（3）：100-106.
	ZHONG Yu， ZHANG Jing， ZHANG Hua，et al ．Hand-eye calibration method of robot based on object detection for robots ［J］．Computer Engineering，2022，48（3）：100-106.
6	ZHANG Z ．A flexible new technique for camera calibration ［J］．IEEE Transactions on Pattern Analysis and Machine Intelligence，2000，22（11）：1330-1334.
7	李巍，吕乃光，董明利，等．凸松弛全局优化机器人手眼标定［J］．计算机应用，2017，37（5）：1451-1455.
	LI Wei， Naiguang LÜ， DONG Mingli，et al ．Robot hand-eye calibration by convex relaxation global optimization ［J］．Journal of Computer Applications，2017，37（5）：1451-1455.
8	WU L， REN H ．Finding the kinematic base frame of a robot by hand-eye calibration using 3D position data ［J］．IEEE Transactions on Automation Science and Engineering，2016，14（1）：314-324.
9	陈昱．基于元学习的机器人智能抓取方法研究［D］．南京：南京邮电大学，2020.
10	程麒，潘丰，袁瑜键．基于3D视觉传感器的龙门架机器人手眼标定方法［J］．光电工程，2021，48（4）：30-38.
	CHENG Qi， PAN Feng， YUAN Yujian ．Hand-eye calibration method of gantry robot based on 3D vision sensor［J］．Opto-Electronic Engineering，2021，48（4）：30-38.
11	ANDREFF N， HORAUD R， ESPIAU B. Robot hand-eye calibration using structure-from-motion ［J］．The Internatio-nal Journal of Robotics Research，2001，20（3）：228-248.
12	ZHAO Z ．Hand-eye calibration using convex optimization ［C］∥Proceedings of 2011 IEEE International Conference on Robotics and Automation.Washington D C：IEEE，2011：2947-2952.
13	QIU S， WANG M， KERMANI M R ．A new formulation for hand-eye calibrations as point-set matching ［J］．IEEE Transactions on Instrumentation and Measurement，2020，69（9）：6490-6498.
14	朱大虎，彭真，华林．一种机器人测量-加工系统扫描仪坐标系自动标定方法：CN108692688B ［P］．2020-02-18.
15	毕德学，王欣亮，刘志芳，等．机器人工具和相机位姿标定的新方法［J］．仪器仪表学报，2019，40（1）：101-108.
	BI Dexue， WANG Xinliang， LIU Zhifang，et al ．New menthod for robot tool and camera pose calibration ［J］．Chinese Journal of Scientific Instrument，2019，40（1）：101-108.
16	殷勤，陈彬，汪莹，等．基于各向异性参数模型的六自由度电磁跟踪系统［J］.系统工程理论与实践，2011，31（2）：351-356.
	YIN Qing， CHEN Bin， WANG Ying，et al ．Six degree of freedom electromagnetic tracking system based on anisotropic parameters model ［J］．Systems Engineering-Theory & Practice，2011，31（2）：351-356.
17	CONDURACHE D， BURLACU A ．Orthogonal dual tensor method for solving the AX=XB sensor calibration problem ［J］．Mechanism and Machine Theory，2016，104：382-404.
18	DICKSON J D， CLARK J E ．Design of a multimodal climbing and gliding robotic platform ［J］．IEEE/ASME Transactions on Mechatronics，2012，18（2）：494-505.
19	CHOU J C K， KAMEL M ．Quaternions approach to solve the kinematic equation of rotation，a/sub a/a/sub x/= a/sub x/a/sub b/，of a sensor-mounted robotic manipulator ［C］∥Proceedings of 1988 IEEE International Conference on Robotics and Automation.Philadelphia：IEEE，1988：656-662.
20	CHOU J C K， KAMEL M. Finding the position and orientation of a sensor on a robot manipulator using quaternions ［J］．The International Journal of Robotics Research，1991，10（3）：240-254.
21	PARK F C， MARTIN B J ．Robot sensor calibration：solving AX= XB on the Euclidean group ［J］．IEEE Transactions on Robotics and Automation，1994，10（5）：717-721.
22	HORAUD R， DORNAIKA F ．Hand-eye calibration ［J］．The International Journal of Robotics Research，1995，14（3）： 195-210.
23	STROBL K H， HIRZINGER G ．Optimal hand-eye calibration ［C］∥Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems. Beijing：IEEE，2006：4647-4653.
24	ANDREFF N， HORAUD R， ESPIAU B ．On-line hand-eye calibration ［C］∥Proceedings of the Second International Conference on 3-D Digital Imaging and Modeling （Cat．No．PR 00062）．Ottawa： IEEE，1999：430-436.
25	DANIILIDIS K ．Hand-eye calibration using dual qua-ternions ［J］．The International Journal of Robotics Research，1999，18（3）：286-298.
26	姜柱，刘庆元，周曼．单位四元素在坐标转换中的应用［J］．矿山测量，2012（5）：28-29.
	JIANG Zhu， LIU Qingyuan， ZHOU Man ．The application of unit quaterninon in coordinate conversion ［J］．Mine Surveying，2012（5）：28-29.
27	克莱格J J ．机器人学导论［M］．贠超，译．北京：机械工业出版社，2006：32.
28	王一凡，段锁林，高仁洲，等.基于对偶四元数的机器人手眼标定算法研究［J］．机电工程，2019，36（7）：755-760，765.
	WANG Yifang， DUAN Suolin， GAO Renzhou，et al ．Study on robot hand-eye calibration using dual quaternion ［J］．Journal of Mechanical and Electrical Engineering，2019，36（7）：755-760，765.

[1]	张铁, 陈亿杰, 邹焱飚. 基于扰动卡尔曼滤波外力矩观测器的机器人碰撞检测[J]. 华南理工大学学报(自然科学版), 2024, 52(3): 84-92.
[2]	季祥, 王海红, 翟天嵩, 等. 多轴机器人系统输出反馈有限时间同步位置控制[J]. 华南理工大学学报(自然科学版), 2023, 51(9): 56-68.
[3]	翟敬梅, 路东伟. 按摩机器人优化示教策略及BPNN-DMPs轨迹学习模型[J]. 华南理工大学学报(自然科学版), 2023, 51(12): 1-8.
[4]	曹学鹏, 王德硕, 冯艳丽, 樊豪, 张弓, 张新荣, 赵睿英. 基于DMPs的双机器人协同搬运轨迹的学习与泛化[J]. 华南理工大学学报(自然科学版), 2023, 51(12): 9-20.
[5]	黄海新, 王峥, 程寿山, 李春明. 负压吸附桥梁检测爬壁机器人的本体结构优化设计[J]. 华南理工大学学报(自然科学版), 2023, 51(12): 21-33.
[6]	姚道金, 殷雄, 罗真, 等. 复杂环境下AGVS路径规划算法[J]. 华南理工大学学报(自然科学版), 2023, 51(11): 56-62.
[7]	万珍平, 罗钊, 陆龙生, 等. 关节角参数化结合接近矢量可行方向的五自由度机械臂逆运动学求解[J]. 华南理工大学学报(自然科学版), 2023, 51(1): 16-21.
[8]	王高, 陈晓鸿, 柳宁, 等. 一种基于视角选择经验增强算法的机器人抓取策略[J]. 华南理工大学学报(自然科学版), 2022, 50(9): 126-137.
[9]	张铁, 许锦盛, 邹焱飚. 基于扰动卡尔曼滤波的机器人免力矩传感器拖动示教方法[J]. 华南理工大学学报(自然科学版), 2022, 50(9): 116-125.
[10]	张勤, 胡嘉辉, 任海林. 饲喂辅助机器人的智能推料方法与试验研究[J]. 华南理工大学学报(自然科学版), 2022, 50(6): 111-120.
[11]	魏武, 韩进, 李艳杰, 等. 基于双树 Quick-RRT* 算法的移动机器人路径规划[J]. 华南理工大学学报（自然科学版）, 2021, 49(7): 51-58.
[12]	翟宇毅, 马新愿, 陈冬冬, 等. 柔性穿戴式上肢康复机器人关节运动控制研究[J]. 华南理工大学学报(自然科学版), 2021, 49(6): 19-27.
[13]	全燕鸣何一明. 多机器人任务分配调度的克隆选择算法[J]. 华南理工大学学报（自然科学版）, 2021, 49(5): 102-110.
[14]	华德正, 刘新华, 赵欣, 等. 基于磁流变液的球形磁控机器人设计及实验[J]. 华南理工大学学报（自然科学版）, 2021, 49(2): 151-160.
[15]	王海涛彭熙凤林本末. 软体机器人研究进展[J]. 华南理工大学学报（自然科学版）, 2020, 48(2): 94-106.

基于位置跟踪器的机器人快速示教方法

A Fast Teaching Method of Robot Based on Position Tracker

RichHTML

PDF

可视化

摘要/Abstract

引用本文

使用本文

图/表 10

参考文献 28

相关文章 15

编辑推荐

Metrics

本文评价