CN113246142B - 一种基于激光引导的测量路径规划方法 - Google Patents
一种基于激光引导的测量路径规划方法 Download PDFInfo
- Publication number
- CN113246142B CN113246142B CN202110707500.9A CN202110707500A CN113246142B CN 113246142 B CN113246142 B CN 113246142B CN 202110707500 A CN202110707500 A CN 202110707500A CN 113246142 B CN113246142 B CN 113246142B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- laser
- mechanical arm
- image
- transformation matrix
- 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
- 238000000034 method Methods 0.000 title claims abstract description 36
- 238000005259 measurement Methods 0.000 claims abstract description 28
- 230000008569 process Effects 0.000 claims abstract description 7
- 239000011159 matrix material Substances 0.000 claims description 28
- 230000009466 transformation Effects 0.000 claims description 28
- 230000009977 dual effect Effects 0.000 claims description 19
- 230000033001 locomotion Effects 0.000 claims description 6
- 238000012545 processing Methods 0.000 claims description 3
- HOWHQWFXSLOJEF-MGZLOUMQSA-N systemin Chemical compound NCCCC[C@H](N)C(=O)N[C@@H](CCSC)C(=O)N[C@@H](CCC(N)=O)C(=O)N[C@@H]([C@@H](C)O)C(=O)N[C@@H](CC(O)=O)C(=O)OC(=O)[C@@H]1CCCN1C(=O)[C@H]1N(C(=O)[C@H](CC(O)=O)NC(=O)[C@H](CCCN=C(N)N)NC(=O)[C@H](CCCCN)NC(=O)[C@H](CO)NC(=O)[C@H]2N(CCC2)C(=O)[C@H]2N(CCC2)C(=O)[C@H](CCCCN)NC(=O)[C@H](CO)NC(=O)[C@H](CCC(N)=O)NC(=O)[C@@H](NC(=O)[C@H](C)N)C(C)C)CCC1 HOWHQWFXSLOJEF-MGZLOUMQSA-N 0.000 claims description 3
- 108010050014 systemin Proteins 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 239000013598 vector Substances 0.000 claims description 3
- 238000012986 modification Methods 0.000 abstract description 3
- 230000004048 modification Effects 0.000 abstract description 3
- 238000004904 shortening Methods 0.000 abstract 1
- 230000005540 biological transmission Effects 0.000 description 2
- 238000000691 measurement method Methods 0.000 description 2
- 241001123248 Arma Species 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/70—Determining position or orientation of objects or cameras
- G06T7/73—Determining position or orientation of objects or cameras using feature-based methods
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Theoretical Computer Science (AREA)
- Automation & Control Theory (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明公开了一种基于激光引导的测量路径规划方法,属于机器人自动化测量领域。该方法首先在空间内布设全局相机定位系统,并通过激光投射装置向待测对象上投射特定图案,相机系统实时捕捉投射激光图案的移动轨迹,并根据机器人与相机的相对位姿和测量距离解算出机器人末端的位姿,进而生成机器人测量轨迹。本发明操作便捷,计算过程简单,计算量小,且修改方便,能缩短测量视点规划时间,提高工作效率,易实施且能保证机器人测量姿态的合理性。
Description
技术领域
本发明涉及机器人自动化测量领域,具体涉及一种基于激光引导的测量路径规划方法。
背景技术
随着航空制造业从“模线-样板”的模拟量传递方式到采用数字量传递的方式的转变,产品零件外形测量也由直尺、塞尺、卡板等发展到以激光扫描、结构光测量为主的数字化测量方法。数字化测量方法带来了高精度的测量结果、易于存储的测量数据但也存在设备体积笨重、手持稳定性低、测量姿态难以保证的问题,采用机械臂搭载测量设备进行自动化测量是较为合理的解决方案。
采用机械臂搭载数字化测量设备进行自动化测量的一个关键问题是如何解决机器人测量路径规划。目前机器人测量路径规划方法主要有人工示教编程和基于三维模型的测量路径规划两种。采用示教编程的方法不仅示教时间长、劳动强度大,而且难以保证测量设备与被测物体之间的相对位姿关系。基于三维模型的测量路径规划方法能较好解决示教编程的问题,但其操作复杂、软件开发难度大,并且现有的机器人离线编程软件如Robotstudio、Roboguide、KUKASim、RobotMaster等都还未实现针对自动测量的机器人路径规划功能。因此,针对机器人自动测量路径规划的问题,有必要设计一种简单可靠的路径规划方法。
发明内容
本发明旨在解决现有技术中存在的上述问题,提出一种使用方便、操作简单的基于激光引导的机械臂测量路径规划方法。
为了实现上述发明目的,本发明的技术方案如下:
一种基于激光引导的测量路径规划方法,其特征在于,该方法包括以下步骤:
步骤1、采用激光投射装置向待测位置投射激光图案,投射图案的几何中心与待测位置的中心点重合;
步骤2、待投射位置图案稳定后,控制双相机系统对激光图案进行拍摄,并将拍摄得到的图像传输到控制器进行处理;
步骤4、通过图像坐标系、双相机系统坐标系、机械臂基坐标系、机械臂末端坐标系之间的变换矩阵求解机械臂末端坐标系与基坐标系之间的位姿传递关系如下:
步骤6:通过控制器向机械臂发送关节运动指令,驱动机械臂各关节达到指定的角度位置,同时检查机械臂在运动过程中是否出现奇异位姿;
步骤7:重复步骤1到步骤6,直至机械臂完成所有示教任务。
进一步的,投射的激光图案为十字线激光,且投射在待测物体表面后十字线激光的两条相交线具有易于区分的长短特征。
其中,d为测量设备的最佳测量距离。
综上所述,本发明具有以下优点:
1.本发明提供的轨迹规划方法操作便捷,计算过程简单,计算量小,且修改方便,能缩短测量视点规划时间,提高工作效率;
2.本发明采用激光引导的测量路径规划方法能减少示教编程的工作量,降低操作人员工作强度;
3.本发明方案通过视觉计算并调整测量设备与被测对象之间的位姿能保证测量位姿的合理性,保障测量精度。
附图说明
图1 是本发明的方法流程图;
图2 是本发明所述的实施示意图;
图3是测量设备与投影图像相对位置关系示意图;
图4是各坐标系之间的转换关系。
图中,
1、机械臂,2、控制器,3、双相机系统,4、激光投射装置,5、待测零件,6、十字线激光,7、测量设备。
具体实施方式
为了更清楚地说明本发明,下面结合优选实施例和附图对本发明做进一步的说明。本领域技术人员应当理解,下面所具体描述的内容是说明性的而非限制性的,不应以此限制本发明的保护范围。
本发明的说明书和权利要求书及上述附图中的属于“第一”、“第二”等是用于区别不同的对象,而不是用于描述特定顺序。此外,术语“ 包括”和“ 具有”以及它们任何变形,意图在于覆盖不排他的包含。例如包含了一系列步骤或单元的过程、方法、系统、产品或设备没有限定于已列出的步骤或单元,而是可选地还包括没有列出的步骤或单元,或可选地还包括对于这些过程、方法或设备固有的气体步骤或单元。
实施例1
本发明提供了如图1所示的一种基于激光引导的测量路径规划方法,包括以下步骤:
步骤1:如图2所示,在被测物体附近架设双相机系统3和机械臂1,连接并启动机械臂1、双相机测量系统3和控制器2,同时,打开激光投射器4并向待测零件5投射激光图案。投射的激光图案为十字线激光6,两条直线垂直相交,且投射在待测物体表面后,两条相交线具有易于区分的长短特征。
步骤2:双相机系统3实时监测投射图案,检测到图像稳定后,控制器2控制双相机系统3对激光图案进行拍摄,并将拍摄得到的图像传输到控制器2进行处理。
步骤3:建立图像坐标系,利用双目立体视觉成像原理求解图像坐标系的原
点在双相机系统坐标系下的坐标,以及图像坐标系到双相
机系统坐标系的位姿变换矩阵。其中,图像坐标系的原点为图像中心点,也是十字线激光6的十字交叉中心。
步骤4:如图4所示,通过图像坐标系、双相机系统坐标系、机械臂基坐标系、机械臂末端坐标系之间的变换矩阵求解机械臂工具坐标系与基坐标系之间的位姿传递关系如下:
其中,
为机械臂末端工具坐标系与图像坐标系之间的位姿变换矩阵,根据机械臂上
搭载的测量设备7的最佳测量距离设置。如图3所示,其具体方法是:设机械臂末端坐标系方
向与图像坐标系方向保持一致,坐标系原点在Z方向的距离为d(d是测量设备的最佳测量距
离),则表示为:
步骤6:通过控制器2向机械臂1发送关节运动指令,驱动机械臂各关节达到指定的角度位置,同时检查机械臂在运动过程中是否出现奇异位姿。
步骤7:重复步骤1到步骤6,直至机械臂完成所有示教任务。
虽然结合附图对本发明的具体实施方式进行了详细地描述,但不应理解为对本专利的保护范围的限定。在权利要求书所描述的范围内,本领域技术人员不经创造性劳动即可做出的各种修改和变形仍属本专利的保护范围。
以上所述,仅是本发明的较佳实施例,并非对本发明做任何形式上的限制,凡是依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化,均落入本发明的保护范围之内。
Claims (6)
1.一种基于激光引导的测量路径规划方法,其特征在于,该方法包括以下步骤:
步骤1、采用激光投射装置向待测位置投射激光图案,投射图案的几何中心与待测位置的中心点重合;
步骤2、待投射位置图案稳定后,控制双相机系统对激光图案进行拍摄,并将拍摄得到的图像传输到控制器进行处理;
步骤4、通过图像坐标系、双相机系统坐标系、机械臂基坐标系、机械臂末端坐标系之间的变换矩阵求解机械臂末端坐标系与基坐标系之间的位姿传递关系如下:
步骤6:通过控制器向机械臂发送关节运动指令,驱动机械臂各关节达到指定的角度位置,同时检查机械臂在运动过程中是否出现奇异位姿;
步骤7:重复步骤1到步骤6,直至机械臂完成所有示教任务。
2.如权利要求1所述的一种基于激光引导的测量路径规划方法,其特征在于,投射的激光图案为十字线激光,且投射在待测物体表面后十字线激光的两条相交线具有易于区分的长短特征。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110707500.9A CN113246142B (zh) | 2021-06-25 | 2021-06-25 | 一种基于激光引导的测量路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110707500.9A CN113246142B (zh) | 2021-06-25 | 2021-06-25 | 一种基于激光引导的测量路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113246142A CN113246142A (zh) | 2021-08-13 |
CN113246142B true CN113246142B (zh) | 2021-10-08 |
Family
ID=77189638
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110707500.9A Active CN113246142B (zh) | 2021-06-25 | 2021-06-25 | 一种基于激光引导的测量路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113246142B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114280153B (zh) * | 2022-01-12 | 2022-11-18 | 江苏金晟元控制技术有限公司 | 一种复杂曲面工件智能检测机器人及检测方法和应用 |
CN115349953B (zh) * | 2022-08-03 | 2024-03-15 | 江苏省人民医院(南京医科大学第一附属医院) | 一种基于体外标记引导器械定位的系统 |
CN116652972B (zh) * | 2023-07-31 | 2023-11-10 | 成都飞机工业(集团)有限责任公司 | 基于双向贪心搜索算法的串联机器人末端轨迹规划方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102794763A (zh) * | 2012-08-31 | 2012-11-28 | 江南大学 | 基于线结构光视觉传感器引导的焊接机器人系统标定方法 |
CN104400279A (zh) * | 2014-10-11 | 2015-03-11 | 南京航空航天大学 | 基于ccd的管道空间焊缝自动识别与轨迹规划的方法及系统 |
CN110245599A (zh) * | 2019-06-10 | 2019-09-17 | 深圳市超准视觉科技有限公司 | 一种智能三维焊缝自主寻迹方法 |
CN111941425A (zh) * | 2020-08-17 | 2020-11-17 | 沈阳飞机工业(集团)有限公司 | 基于激光跟踪仪和双目相机的机器人铣削系统工件快速定位方法 |
CN112232319A (zh) * | 2020-12-14 | 2021-01-15 | 成都飞机工业(集团)有限责任公司 | 一种基于单目视觉定位的扫描拼接方法 |
CN112828878A (zh) * | 2019-11-22 | 2021-05-25 | 中国科学院沈阳自动化研究所 | 一种大型设备对接过程三维测量与跟踪方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3485112B1 (en) * | 2016-07-15 | 2021-08-25 | Fastbrick IP Pty Ltd | Vehicle which incorporates a brick laying machine |
CN109226967B (zh) * | 2018-07-25 | 2021-03-09 | 同高先进制造科技(太仓)有限公司 | 一种用于激光-电弧复合焊的主动激光视觉稳健焊缝跟踪系统 |
US11485018B2 (en) * | 2019-09-16 | 2022-11-01 | The Boeing Company | Robotic end effector system with surface tracking and methods for use |
-
2021
- 2021-06-25 CN CN202110707500.9A patent/CN113246142B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102794763A (zh) * | 2012-08-31 | 2012-11-28 | 江南大学 | 基于线结构光视觉传感器引导的焊接机器人系统标定方法 |
CN104400279A (zh) * | 2014-10-11 | 2015-03-11 | 南京航空航天大学 | 基于ccd的管道空间焊缝自动识别与轨迹规划的方法及系统 |
CN110245599A (zh) * | 2019-06-10 | 2019-09-17 | 深圳市超准视觉科技有限公司 | 一种智能三维焊缝自主寻迹方法 |
CN112828878A (zh) * | 2019-11-22 | 2021-05-25 | 中国科学院沈阳自动化研究所 | 一种大型设备对接过程三维测量与跟踪方法 |
CN111941425A (zh) * | 2020-08-17 | 2020-11-17 | 沈阳飞机工业(集团)有限公司 | 基于激光跟踪仪和双目相机的机器人铣削系统工件快速定位方法 |
CN112232319A (zh) * | 2020-12-14 | 2021-01-15 | 成都飞机工业(集团)有限责任公司 | 一种基于单目视觉定位的扫描拼接方法 |
Non-Patent Citations (3)
Title |
---|
Real-time localisation and path-planning in ackermann steering robot using a single RGB camera and 2D LIDAR;Shubhankar Potdar etc.;《2017 International Conference on Innovations in Information, Embedded and Communication Systems (ICIIECS)》;20170318;全文 * |
三维激光引导的自行车三角架机器人焊接轨迹规划技术研究;秦晨;《中国优秀硕士学位论文全文数据库》;20200515;全文 * |
基于激光扫描的结构件测量轨迹规划技术研究;林晶;《中国优秀硕士学位论文全文数据库 基础科学辑》;20200215;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN113246142A (zh) | 2021-08-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113246142B (zh) | 一种基于激光引导的测量路径规划方法 | |
CN112122840B (zh) | 一种基于机器人焊接的视觉定位焊接系统及焊接方法 | |
CN114434059B (zh) | 复合机器人和三维视觉的大型结构件自动焊接系统及方法 | |
CN108286949B (zh) | 一种可移动式三维检测机器人系统 | |
WO2021208230A1 (zh) | 智能装配控制系统 | |
CN108801142B (zh) | 一种特大尺寸工件双移动测量机器人系统及方法 | |
US8406923B2 (en) | Apparatus for determining pickup pose of robot arm with camera | |
CN102135776B (zh) | 基于视觉定位的工业机器人控制方法 | |
CN112833786B (zh) | 一种舱段位姿测量及对准系统、控制方法及应用 | |
JP2004508954A (ja) | 位置決め装置およびシステム | |
WO2018043525A1 (ja) | ロボットシステム、ロボットシステム制御装置、およびロボットシステム制御方法 | |
CN104786226A (zh) | 抓取在线工件的机器人位姿及运动轨迹定位系统与方法 | |
CN111347431A (zh) | 一种手持工具示教的机器人示教喷涂方法和装置 | |
CN108098762A (zh) | 一种基于新型视觉引导的机器人定位装置及方法 | |
CN109764805B (zh) | 一种基于激光扫描的机械臂定位装置与方法 | |
JPH0713613A (ja) | プログラム式ロボット制御器に経路補償データを自動的に供給する方法と装置 | |
CN101261118A (zh) | 基于机器人的快速自动化三维形貌在线测量方法和系统 | |
CN112828552B (zh) | 一种法兰零件智能对接方法及系统 | |
TWI714409B (zh) | 自動研磨系統 | |
CN112917513A (zh) | 一种基于机器视觉的三维点胶针头的tcp标定方法 | |
CN113119077A (zh) | 一种工业机器人手持示教装置和示教方法 | |
CN113352300A (zh) | 一种喷涂机器人示教器及方法 | |
CN114643578A (zh) | 一种提高机器人视觉引导精度的标定装置及方法 | |
CN109900251A (zh) | 一种基于视觉技术的机器人定位装置及方法 | |
CN117381788A (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 |