CN113618277A - 带可达性球分层搜索树的焊接机器人离线焊接路径规划方法 - Google Patents
带可达性球分层搜索树的焊接机器人离线焊接路径规划方法 Download PDFInfo
- Publication number
- CN113618277A CN113618277A CN202110854206.0A CN202110854206A CN113618277A CN 113618277 A CN113618277 A CN 113618277A CN 202110854206 A CN202110854206 A CN 202110854206A CN 113618277 A CN113618277 A CN 113618277A
- Authority
- CN
- China
- Prior art keywords
- welding
- path
- point
- planning
- reachability
- 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.)
- Granted
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23K—SOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
- B23K37/00—Auxiliary devices or processes, not specially adapted to a procedure covered by only one of the preceding main groups
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23K—SOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
- B23K37/00—Auxiliary devices or processes, not specially adapted to a procedure covered by only one of the preceding main groups
- B23K37/02—Carriages for supporting the welding or cutting element
- B23K37/0252—Steering means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/005—Manipulators for mechanical processing tasks
-
- 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/1661—Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
-
- 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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1669—Programme controls characterised by programming, planning systems for manipulators characterised by special application, e.g. multi-arm co-operation, assembly, grasping
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Physics & Mathematics (AREA)
- Optics & Photonics (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明涉及带可达性球分层搜索树的焊接机器人离线焊接路径规划方法,包括以下步骤:S1、进行路径预处理,对给定的几何路径进行离散化并进行预处理;S2、解析焊接约束和目标函数,通过数学方式描述焊接过程中涉及到的约束以及对应的目标函数;S3、求解规划空间并搜索路径,基于可达性球对规划空间进行求解,并使用分层搜索树进行路径搜素。本发明通过对离线焊接过程中的约束进行数学分析,并基于可达性球来离散规划空间,能够在有限时间内给出路径可行解,当问题无解时,能够及时地终止算法。
Description
技术领域
本发明涉及机器人工程技术领域,尤其涉及带可达性球分层搜索树的焊接机器人离线焊接路径规划方法。
背景技术
在焊接领域中,通常需要借助焊接机器人来提高生产效率。现有的人工示教方式需要占用机器人且对操作者的技术要求高,对于某些复杂曲线来说,示教的难度大,焊接质量难以保证,生产效率低。通过仿真软件搭建焊接场景,借助离线编程中的路径规划模块,可以实现示教过程的自动化,避免人工示教的缺点。
离线焊接路径规划通常是根据图形学从仿真模型上获取工件的几何信息,几何信息包括焊缝的位置信息,焊缝相邻面信息等,基于该几何信息规划出机器人的运动路径,以满足焊接质量要求。影响焊接质量的因素有电流电压、送丝速度、工作角、行走角等,而一个因素的改变往往导致其他因素的同时改变。
在现有的焊接路径规划方法中,通常根据焊接要求给出机器人的理想焊接位姿,只能通过验证机器人运动在该路径上不与工件发生碰撞,来保证给出的理想位姿是满足要求的,一旦发生碰撞,则该路径是非法路径,由于没有提供冗余自由度进行路径的修正从而导致规划问题的无解。
发明内容
为解决现有技术所存在的技术问题,本发明提供带可达性球分层搜索树的焊接机器人离线焊接路径规划方法,通过对离线焊接过程中的约束进行数学分析,并基于可达性球来离散规划空间,能够在有限时间内给出路径可行解,当问题无解时,能够及时地终止算法。
本发明采用以下技术方案来实现,带可达性球分层搜索树的焊接机器人离线焊接路径规划方法,包括以下步骤:
S1、进行路径预处理,对给定的几何路径进行离散化并进行预处理;
S2、解析焊接约束和目标函数,通过数学方式描述焊接过程中涉及到的约束以及对应的目标函数;
S3、求解规划空间并搜索路径,基于可达性球对规划空间进行求解,并使用分层搜索树进行路径搜素。
本发明与现有技术相比,具有如下优点和有益效果:
1、本发明通过对离线焊接的约束进行解析,然后代入到带可达性球分层搜索树中,分层搜索树每一层的计算都借助可达性球,基于采样的方法从可达规划空间中获得满足约束的位形,当采样次数趋于无穷时,若问题有解,则必然能够找到可行解,满足概率完备性。
2、本发明通过对离线焊接过程中的约束进行数学分析,并基于可达性球来离散规划空间,能够在有限时间内给出路径可行解,当问题无解时,能够及时地终止算法。
3、本发明通用地解释了机器人焊接约束,并对其目标函数进行归一化。
4、本发明使用可达性球来离散空间某一点的所有可达位形,能够快速计算某一位置点对应的规划空间,当规划空间不存在可达位形时,算法立刻终止,能够及时反映出该问题是否有解。
附图说明
图1是本发明的方法流程图;
图2是路径预处理示意图;
图3是焊接约束示意图;
图4是带可达性球分层搜索树示意图。
具体实施方式
下面结合实施例及附图对本发明作进一步详细的描述,但本发明的实施方式不限于此。
实施例
如图1所示,本实施例带可达性球分层搜索树的焊接机器人离线焊接路径规划方法,主要包括以下步骤:
S1、进行路径预处理,对给定的几何路径进行离散化并进行预处理;
S2、解析焊接约束和目标函数,通过数学方式描述焊接过程中涉及到的约束以及对应的目标函数;
S3、求解规划空间并搜索路径,基于可达性球对规划空间进行求解,并使用分层搜索树进行路径搜素。
如图2所示,本实施例中,步骤S1中路径预处理的具体步骤如下:
S11、将焊缝路径按照分辨率为1mm进行离散化获取焊缝离散点集P,按“以直代曲”的思路,在一定误差范围内使用多段直线取代焊缝曲线;
S13、将离散点Pj投影到向量vyi得到投影点Ppj,计算离散点到投影点的误差距离serr:
S14、控制误差距离小于给定值,即
serr<ε;
S15、将满足误差距离的离散点视为同一条直线上的点,无需作为规划点,可舍去,直到找到刚好不超过误差距离的离散点作为规划点,并以其作为下次搜索的起点,直到搜索到路径点的末端点。
如图3所示,本实施例中,步骤S2中解析焊接约束和目标函数的具体步骤如下:
S21、在焊缝上的路径点建立坐标系,以焊接点所在位置为坐标系原点p,以该焊缝点相邻面的法向量之和单位化作为坐标系Z轴,表示为:
其中,n1和n2为焊缝点相邻面的法向量;
S22、以焊缝在当前焊缝点出的切向量作为坐标系Y轴vy,通过右手坐标系得到X轴vx;设焊缝点坐标系的Z轴与焊板的夹角为最佳工作角θz,对于当前机器人位形qr,通过正运动学求出其末端执行器负方向向量为:
vw=-vrz=-Fkz(qr)
其中,vrz为末端执行器Z轴方向向量;
S23、将该末端执行器负方向向量投影到焊缝点坐标系的XOZ平面上,得到:
其中,vwp为末端执行器负方向向量的投影向量;Rp为焊缝点坐标系的旋转矩阵;S24、设机器人末端执行器的工作角为向量vwp与焊板之间的夹角,通过限制机器人末端执行器的工作角的范围来作为焊接约束,用向量vwp与向量vz之间的夹角θe来衡量当前位形是否满足焊接约束,即
其中,θε为限制机器人末端执行器的工作角的可调整范围;
S25、若满足焊接约束,用机器人末端执行器的工作角的变化量作为焊接代价函数,设机器人相邻两个路径点为qi与qi+1,对应的末端执行器Z轴投影向量为vwp_i和vwp_i+1,则相邻两点构成的局部路径LPi的焊接目标函数为:
其中,θw为机器人相邻两个路径点对应的末端执行器Z轴投影向量之间的夹角角度值。
本实施例中,步骤S3中求解规划空间并搜索路径的具体步骤如下:
S31、求解规划空间,以当前规划点为球心放置可达性球,离散化当前位置的所有位形,并对其作碰撞检测、可达性检测、焊接约束判定,获得当前位置点对应的规划空间;
S32、搜索路径,如图4所示,为基于可达性球的分层搜索树,分层搜索树每一层的建立通过从规划空间中进行采样,并根据焊接目标函数从上一层中选择代价最小的父节点作为扩展起始点,根据搜索树最大步长以当前层的节点作为扩展终止点,进行树的扩展,扩展过程中对机器人位形进行约束判定,若满足所有约束,则扩展成功,搜索树持续进行搜索扩展直到最后一层。
上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。
Claims (4)
1.带可达性球分层搜索树的焊接机器人离线焊接路径规划方法,其特征在于,包括以下步骤:
S1、进行路径预处理,对给定的几何路径进行离散化并进行预处理;
S2、解析焊接约束和目标函数,通过数学方式描述焊接过程中涉及到的约束以及对应的目标函数;
S3、求解规划空间并搜索路径,基于可达性球对规划空间进行求解,并使用分层搜索树进行路径搜素。
2.根据权利要求1所述的带可达性球分层搜索树的焊接机器人离线焊接路径规划方法,其特征在于,步骤S1中路径预处理的具体步骤如下:
S11、将焊缝路径进行离散化获取焊缝离散点集P,在误差范围内使用多段直线取代焊缝曲线;
S13、将离散点Pj投影到向量vyi得到投影点Ppj,计算离散点到投影点的误差距离serr:
S14、控制误差距离小于给定值,即
serr<ε;
S15、将满足误差距离的离散点作为同一条直线上的点,获取不超过误差距离的离散点作为规划点,并以其作为下次搜索的起点,直到搜索到路径点的末端点。
3.根据权利要求1所述的带可达性球分层搜索树的焊接机器人离线焊接路径规划方法,其特征在于,步骤S2中解析焊接约束和目标函数的具体步骤如下:
S21、在焊缝上的路径点建立坐标系,以焊接点所在位置为坐标系原点p,以该焊缝点相邻面的法向量之和单位化作为坐标系Z轴,表示为:
其中,n1和n2为焊缝点相邻面的法向量;
S22、以焊缝在当前焊缝点出的切向量作为坐标系Y轴vy,通过右手坐标系得到X轴vx;设焊缝点坐标系的Z轴与焊板的夹角为最佳工作角θz,对于当前机器人位形qr,通过正运动学求出其末端执行器负方向向量为:
vw=-vrz=-Fkz(qr)
其中,vrz为末端执行器Z轴方向向量;
S23、将该末端执行器负方向向量投影到焊缝点坐标系的XOZ平面上,得到:
其中,vwp为末端执行器负方向向量的投影向量;Rp为焊缝点坐标系的旋转矩阵;
S24、设机器人末端执行器的工作角为向量vwp与焊板之间的夹角,通过限制机器人末端执行器的工作角的范围来作为焊接约束,用向量vwp与向量vz之间的夹角θe来衡量当前位形的焊接约束,即
其中,θε为限制机器人末端执行器的工作角的可调整范围;
S25、若满足焊接约束,用机器人末端执行器的工作角的变化量作为焊接代价函数,设机器人相邻两个路径点为qi与qi+1,对应的末端执行器Z轴投影向量为vwp_i和vwp_i+1,则相邻两点构成的局部路径LPi的焊接目标函数为:
其中,θw为机器人相邻两个路径点对应的末端执行器Z轴投影向量之间的夹角角度值。
4.根据权利要求1所述的带可达性球分层搜索树的焊接机器人离线焊接路径规划方法,其特征在于,步骤S3中求解规划空间并搜索路径的具体步骤如下:
S31、求解规划空间,以当前规划点为球心放置可达性球,离散化当前位置的所有位形,并对其作碰撞检测、可达性检测、焊接约束判定,获得当前位置点对应的规划空间;
S32、搜索路径,分层搜索树每一层的建立通过从规划空间中进行采样,并根据焊接目标函数从上一层中选择代价最小的父节点作为扩展起始点,根据搜索树最大步长以当前层的节点作为扩展终止点,进行树的扩展,扩展过程中对机器人位形进行约束判定,若满足所有约束,则扩展成功,搜索树持续进行搜索扩展直到最后一层。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110854206.0A CN113618277B (zh) | 2021-07-28 | 2021-07-28 | 带可达性球分层搜索树的焊接机器人离线焊接路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110854206.0A CN113618277B (zh) | 2021-07-28 | 2021-07-28 | 带可达性球分层搜索树的焊接机器人离线焊接路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113618277A true CN113618277A (zh) | 2021-11-09 |
CN113618277B CN113618277B (zh) | 2022-04-05 |
Family
ID=78381312
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110854206.0A Active CN113618277B (zh) | 2021-07-28 | 2021-07-28 | 带可达性球分层搜索树的焊接机器人离线焊接路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113618277B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117601136A (zh) * | 2024-01-24 | 2024-02-27 | 济宁鲁鑫工程机械有限公司 | 一种自动焊接机器人路径规划方法及系统 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103278164A (zh) * | 2013-06-13 | 2013-09-04 | 北京大学深圳研究生院 | 一种复杂动态场景下机器人仿生路径规划方法及仿真平台 |
CN105302062A (zh) * | 2015-10-15 | 2016-02-03 | 东南大学 | 一种基于任务解耦的多机器人协作焊接路径的生成方法 |
CN107065768A (zh) * | 2017-04-25 | 2017-08-18 | 华中科技大学 | 一种叶轮加工刀具路径整体优化方法 |
CN111515503A (zh) * | 2020-04-30 | 2020-08-11 | 华东理工大学 | 一种弧焊机器人无碰撞路径规划方法 |
CN111546347A (zh) * | 2020-06-03 | 2020-08-18 | 中国人民解放军海军工程大学 | 一种适用于动态环境下的机械臂路径规划方法 |
CN111752306A (zh) * | 2020-08-14 | 2020-10-09 | 西北工业大学 | 一种基于快速扩展随机树的无人机航路规划方法 |
CN112393728A (zh) * | 2020-10-23 | 2021-02-23 | 浙江工业大学 | 一种基于a*算法和rrt*算法的移动机器人路径规划方法 |
CN112677153A (zh) * | 2020-12-16 | 2021-04-20 | 东北林业大学 | 一种改进的rrt算法及工业机器人路径避障规划方法 |
CN112757294A (zh) * | 2020-12-28 | 2021-05-07 | 华南理工大学 | 一种基于可达性球的机器人路径中转点搜索方法 |
CN112947489A (zh) * | 2021-04-08 | 2021-06-11 | 华东理工大学 | 复杂环境下焊接机器人无碰撞路径规划方法及装置 |
-
2021
- 2021-07-28 CN CN202110854206.0A patent/CN113618277B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103278164A (zh) * | 2013-06-13 | 2013-09-04 | 北京大学深圳研究生院 | 一种复杂动态场景下机器人仿生路径规划方法及仿真平台 |
CN105302062A (zh) * | 2015-10-15 | 2016-02-03 | 东南大学 | 一种基于任务解耦的多机器人协作焊接路径的生成方法 |
CN107065768A (zh) * | 2017-04-25 | 2017-08-18 | 华中科技大学 | 一种叶轮加工刀具路径整体优化方法 |
CN111515503A (zh) * | 2020-04-30 | 2020-08-11 | 华东理工大学 | 一种弧焊机器人无碰撞路径规划方法 |
CN111546347A (zh) * | 2020-06-03 | 2020-08-18 | 中国人民解放军海军工程大学 | 一种适用于动态环境下的机械臂路径规划方法 |
CN111752306A (zh) * | 2020-08-14 | 2020-10-09 | 西北工业大学 | 一种基于快速扩展随机树的无人机航路规划方法 |
CN112393728A (zh) * | 2020-10-23 | 2021-02-23 | 浙江工业大学 | 一种基于a*算法和rrt*算法的移动机器人路径规划方法 |
CN112677153A (zh) * | 2020-12-16 | 2021-04-20 | 东北林业大学 | 一种改进的rrt算法及工业机器人路径避障规划方法 |
CN112757294A (zh) * | 2020-12-28 | 2021-05-07 | 华南理工大学 | 一种基于可达性球的机器人路径中转点搜索方法 |
CN112947489A (zh) * | 2021-04-08 | 2021-06-11 | 华东理工大学 | 复杂环境下焊接机器人无碰撞路径规划方法及装置 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117601136A (zh) * | 2024-01-24 | 2024-02-27 | 济宁鲁鑫工程机械有限公司 | 一种自动焊接机器人路径规划方法及系统 |
CN117601136B (zh) * | 2024-01-24 | 2024-04-02 | 济宁鲁鑫工程机械有限公司 | 一种自动焊接机器人路径规划方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN113618277B (zh) | 2022-04-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109226937B (zh) | 一种工业机器人空间相贯曲线焊接离线编程方法 | |
Fang et al. | Robot path planning optimization for welding complex joints | |
CN114571153B (zh) | 一种基于3d点云的焊缝识别与机器人焊缝跟踪方法 | |
CN112847353B (zh) | 一种基于离线编程软件的多段焊缝轨迹修正方法 | |
CN108994418B (zh) | 一种管-管相贯线机器人运动轨迹规划方法 | |
CN109514133A (zh) | 一种基于线结构光感知的焊接机器人3d曲线焊缝自主示教方法 | |
US11759958B2 (en) | Autonomous welding robots | |
CN111496428B (zh) | 基于直焊缝轮廓识别的多层多道焊道规划方法及焊接工作站 | |
CN112958959A (zh) | 一种基于三维视觉的自动化焊接和检测方法 | |
CN113618277B (zh) | 带可达性球分层搜索树的焊接机器人离线焊接路径规划方法 | |
CN112809167B (zh) | 一种用于大曲率管件全位置焊接的机器人焊缝跟踪方法 | |
US20230173676A1 (en) | Machine learning logic-based adjustment techniques for robots | |
CN114378830B (zh) | 一种机器人腕关节奇异规避方法及系统 | |
Wang et al. | Fuzzy-PI double-layer stability control of an online vision-based tracking system | |
CN110370276A (zh) | 基于三维模型Morse分解的工业机器人加工轨迹自动规划方法 | |
CN114904844A (zh) | 一种针对精密复杂零件的机器人激光清洗路径规划与控制的方法 | |
CN115056213A (zh) | 一种面向大型复杂构件的机器人轨迹自适应修正方法 | |
US9207667B2 (en) | Automatic generation of robotic processes for symmetric products | |
Wang et al. | A path correction method based on global and local matching for robotic autonomous systems | |
Lina et al. | Modeling, control algorithm, and cloud technology application of an automated SAW platform for large-size and thick-wall workpieces | |
Shen et al. | Path planning based on the analytical inverse kinematics of the rail-mounted industrial robot for continuous-trajectory tracking | |
CN117371137B (zh) | 基于sqp的球头铣刀多轴铣削表面形貌快速预测方法 | |
CN115026843B (zh) | 一种基于交叉激光传感器的自动tcp标定及纠偏方法 | |
Han et al. | Dual Robot Coordinated Welding Trajectory Planning for Single Y-Groove Weld Seam of Plug-in Cross Pipe | |
US20240042614A1 (en) | Techniques for multipass welding |
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 |