CN110370276A - 基于三维模型Morse分解的工业机器人加工轨迹自动规划方法 - Google Patents
基于三维模型Morse分解的工业机器人加工轨迹自动规划方法 Download PDFInfo
- Publication number
- CN110370276A CN110370276A CN201910605661.XA CN201910605661A CN110370276A CN 110370276 A CN110370276 A CN 110370276A CN 201910605661 A CN201910605661 A CN 201910605661A CN 110370276 A CN110370276 A CN 110370276A
- Authority
- CN
- China
- Prior art keywords
- vertex
- morse
- point
- cut
- model
- 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
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
-
- 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
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T17/00—Three dimensional [3D] modelling, e.g. data description of 3D objects
- G06T17/20—Finite element generation, e.g. wire-frame surface description, tesselation
- G06T17/205—Re-meshing
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T19/00—Manipulating 3D models or images for computer graphics
- G06T19/20—Editing of 3D images, e.g. changing shapes or colours, aligning objects or positioning parts
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Mechanical Engineering (AREA)
- Computer Graphics (AREA)
- Software Systems (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Robotics (AREA)
- Geometry (AREA)
- Architecture (AREA)
- Computer Hardware Design (AREA)
- General Engineering & Computer Science (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明涉及基于三维模型Morse分解的工业机器人加工轨迹自动规划方法,包括通过相机建立网络模型M;使每个顶点v在半径为r的领域内平滑;利用Morse函数f按照Morse Lemma计算网络模型M的关键点,并选出顶点集合S,并创建分割边界集合B及关键分割点集合P;依照分割边界集合B中的分割线段生成分割线集合L,根据分割线集合L生成子模型集合Ms;根据机器人加工任务是面向空间曲线还是空间曲面选择不同的机器人加工轨迹生成方法生成机器人轨迹。本发明使用了基于Morse理论的模型分割算法,取代了传统的基于几何特征模型分割算法,提升了分割算法的性能,并简化了轨迹规划步骤。
Description
技术领域
本发明涉及机器人轨迹规划领域,具体的说是基于三维模型Morse分解的工业机器人加工轨迹自动规划方法。
背景技术
现有的机器人加工轨迹主要依赖人工示教或离线编程。在自动规划方面大部分方法需要根据待加工物体的三维数模进行加工轨迹的规划。绝大部分规划方法倾向将三维数模作为一个整体,但由于机器人加工轨迹范围有限,不同结构适用轨迹不同的问题,后续规划方法极为复杂且缺乏泛用性,导致最终此类规划方法整体表现较差。在上述方法的基础上,衍生出了先对原始数模分割再根据分割结果得到的子模型进行机器人轨迹规划的策略;
现有技术中模型分割环节涉及到手工选择算法阈值,因此鲁棒性较差,对数据噪音较为敏感,且存在分割不完全,分割线成锯齿状等问题;常规策略下分割遗留的问题将转移给机器人轨迹规划算法解决,这直接导致了机器人规划算法部分设计复杂,控制参数众多且不同子模型适用参数不同并最终导致方法整体泛用性及鲁棒性较差、调参困难的问题。
发明内容
现为了解决上述技术问题,本发明提出了基于三维模型Morse分解的工业机器人加工轨迹自动规划方法。本发明所要解决的技术问题采用以下技术方案来实现:基于三维模型Morse分解的工业机器人加工轨迹自动规划方法,包括以下步骤:
第一步:在坐标系下重建待加工物体的网格模型M,并建立网格模型M中各个顶点v到其平均曲率HV的Morse函数f,使得f(v)=Hv;
第二步:使每个顶点v在半径为r的领域内进行平滑;
第三步:利用第二步更新获得的Morse函数f按照Morse Lemma计算网格模型M的关键点,并选出所有被标记为鞍型点的顶点集合S,利用顶点集合S创建分割边界集合B及关键分割点集合P;
第四步:依照顶点顺序连接分割边界集合B中的分割线段,通过相同顶点首尾连接生成网格模型M不同部位的分割线集合L={l1,l2...ln},根据分割线集合L通过区域生长法将网格模型M分割为若干个互不相交的子模型集合Ms={m1,m2...mn};
第五步:根据机器人加工任务是面向空间曲线还是面向空间曲面选择不同的机器人加工轨迹生成方法生成机器人轨迹。
所述第三步中利用顶点集合S创建分割边界方法如下:
第一步:若顶点集合S为空集,将执行下一步工作,若顶点集合S不为空集,从顶点集合S中取出一个顶点c;
第二步:将顶点c加入分割点集合P中,搜索网格模型M中与顶点c相连的顶点集合VC,选择对应f值最小的点p;
第三步:若f(p)<f(c),则将顶点c与顶点p的连线加入分割边界B,将p加入分割点集合P,令c=p,返回第二步,否则返回第一步。
所述第五步中的面向空间曲线轨迹生成方法如下:
第一步:根据加工需要及机器人工作范围,筛选分割线集合L中机器人可加工的分割线,对于每条分割线利用B中分割线段信息,选出其所经过的全部关键分割点pi;
第二步:利用网络模型M的原始信息求出关键分割点pi对应的法向量并根据实际加工中要求的末端执行器与物体表面距离d计算关键分割点pi对应的实际机器人末端执行器轨迹点
第三步:利用样条拟合末端执行器轨迹点,从而生成最终沿工件不同部位接合处加工的机器人加工轨迹。
所述第五步中面向空间曲面的轨迹生成方法如下:
第一步:首先在子模型Ms表面进行均匀采样;
第二步:对每个采样点pi,利用网络模型M的原始信息求出采样点pi对应的法向量并根据实际加工中要求的末端执行器与物体表面距离d计算采样点pi对应的实际机器人末端执行器轨迹点
第三步:对所有末端执行器轨迹点所组成的集合进行PCA主成分分析,得到机器人加工轨迹。
所述第二步中通过双边滤波算法,反复执行以下公式进行计算:
使每个顶点v在半径为r的领域内进行平滑。
在生成机器人轨迹之前根据加工要求及机器人作业范围滤除分割线集合L及子模型集合Ms中不需处理的分割线和子模型。
本发明的有益效果是:本发明通过优化模型分割算法、简化机器人轨迹规划算法,增强了方法的泛用性及鲁棒性。大幅减少了实际应用中控制参数的调试难度;同时实现一种方法对多种不同实际应用的支持;
本发明使用了基于Morse理论的模型分割算法,取代了传统的基于几何特征模型分割算法,极大地提升了分割算法的整体性能,并简化了后续机器人轨迹规划步骤。
附图说明
下面结合附图和实施例对本发明进一步说明。
图1为本发明工作流程示意图;
图2为本发明子模型实例;
图3为本发明图2子模型的轨迹实例;
图4为本发明轨迹实例2。
具体实施方式
为了使本领域的技术人员更好的理解本发明的技术方案,下面将结合实施例中的附图,对本发明进行更清楚、更完整的阐述,当然所描述的实施例只是本发明的一部分而非全部,基于本实施例,本领域技术人员在不付出创造性劳动性的前提下所获得的其他的实施例,均在本发明的保护范围内。
如图1至图4所示,基于三维模型Morse分解的工业机器人加工轨迹自动规划方法,包括以下步骤:
第一步:在坐标系下重建待加工物体的网格模型M,并建立网格模型M中各个顶点v到其平均曲率HV的Morse函数f,使得f(v)=Hv;通过三维相机在机器人的世界坐标系下重建网格模型M;
第二步:使每个顶点v在半径为r的领域内进行平滑;
第三步:利用第二步更新获得的Morse函数f按照Morse Lemma计算网格模型M的关键点,并选出所有被标记为鞍型点的顶点集合S,利用顶点集合S创建分割边界集合B及关键分割点集合P;
第四步:依照顶点顺序连接分割边界集合B中的分割线段,通过相同顶点首尾连接生成网格模型M不同部位的分割线集合L={l1,l2...ln},根据分割线集合L通过区域生长法将网格模型M分割为若干个互不相交的子模型集合Ms={m1,m2...mn};图2为模型的Morse分解效果图示,图2中的着色深浅部位代表分解后的不同子模型,图中坐标系为模型尺寸的标记,单位为毫米;子模型上的标号代表分割后子模型包含的顶点个数,例如“1056”代表分割后子模型包含有1056个顶点;
第五步:根据机器人加工任务是面向空间曲线还是面向空间曲面选择不同的机器人加工轨迹生成方法生成机器人轨迹;根据上述步骤可得出如图3和图4所示的加工轨迹,图3和图4中的深色线条为按照空间曲面加工轨迹规范方法所规划的加工轨迹。
所述第三步中分割边界生成方法如下:
第一步:若顶点集合S为空集,将执行下一步工作,若顶点集合S不为空集,从顶点集合S中取出一个顶点c;
第二步:将顶点c加入分割点集合P中,搜索网格模型M中与顶点c相连的顶点集合VC,选择对应f值最小的点p;
第三步:若f(p)<f(c),则将顶点c与顶点p的连线加入分割边界B,将p加入分割点集合P,令c=p,返回第二步,否则返回第一步。
所述第五步中的面向空间曲线轨迹生成方法如下:
第一步:根据加工需要及机器人工作范围,筛选分割线集合L中机器人可加工的分割线,对于每条分割线利用B中分割线段信息,选出其所经过的全部关键分割点pi;
第二步:利用网络模型M的原始信息求出关键分割点pi对应的法向量并根据实际加工中要求的末端执行器与物体表面距离d计算关键分割点pi对应的实际机器人末端执行器轨迹点
第三步:利用样条拟合末端执行器轨迹点,从而生成最终沿工件不同部位接合处加工的机器人加工轨迹;由于机器人弧焊和激光切割等应用,机器人执行器作用点的加工轨迹通常位于工件不同部位的接合处,既L中每一条分割线所对应的空间路径,为了使加工曲线更加平滑则使用上述面向空间曲线轨迹生产方法进行优化,确保焊接和激光切割的准确性;样条拟合进行三次,减少执行器轨迹点的误差。
所述第五步中面向空间曲面的轨迹生成方法如下:
第一步:首先在子模型Ms表面进行均匀采样;
第二步:对每个采样点pi,利用网络模型M的原始信息求出采样点pi对应的法向量并根据实际加工中要求的末端执行器与物体表面距离d计算采样点pi对应的实际机器人末端执行器轨迹点
第三步:对所有末端执行器轨迹点所组成的集合进行PCA主成分分析,按照分析得出的第一主成分方向与第二主成分方向搭建依次按照S型连接执行器轨迹点,得到机器人加工轨迹;对于机器人喷涂和表面检测等应用,机器人执行器作用点的轨迹通常需要近似覆盖模型表面或某一子模型表面,既M中每一子模型所对应的空间表面,因此需要通过上述方法对子模型Ms进行优化,保证喷涂和检测的准确性。
所述面向空间曲面的轨迹生成方法第一步中采样点间距与末端执行器有关,对于喷涂任务,间距与喷枪在物体表面的喷涂区域半径相等,对于表面检测任务,间距与视野半径相等。
所述第二步中通过双边滤波算法,反复执行以下公式进行计算:
使每个顶点v在半径为r的领域内进行平滑;上述公式中n为顶点v的半径为r的邻域中其他定点的个数,||v-vi||为两顶点间的测地线距离,σ1为v的邻域中||v-vi||的最大值,||f(v)-f(vi)||以及σ2与前者处理方式相似。ω为小于1的平滑系数;。
在生成机器人轨迹之前根据加工要求及机器人作业范围滤除分割线集合L及子模型集合Ms中不需处理的分割线和子模型。
以上显示和描述了本发明的基本原理、主要特征和本发明的优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明内。本发明要求保护范围由所附的权利要求书及其等效物界定。
Claims (6)
1.基于三维模型Morse分解的工业机器人加工轨迹自动规划方法,其特征在于:包括以下步骤:
第一步:在坐标系下重建待加工物体的网格模型M,并建立网格模型M中各个顶点v到其平均曲率HV的Morse函数使得f(v)=Hv;
第二步:使每个顶点v在半径为r的领域内进行平滑;
第三步:利用第二步更新获得的Morse函数按照Morse Lemma计算网格模型M的关键点,并选出所有被标记为鞍型点的顶点集合S,利用顶点集合S创建分割边界集合B及关键分割点集合P;
第四步:依照顶点顺序连接分割边界集合B中的分割线段,通过相同顶点首尾连接生成网格模型M不同部位的分割线集合L={l1,l2...ln},根据分割线集合L通过区域生长法将网格模型M分割为若干个互不相交的子模型集合Ms={m1,m2...mn};
第五步:根据机器人加工任务是面向空间曲线还是面向空间曲面选择不同的机器人加工轨迹生成方法生成机器人轨迹。
2.根据权利要求1所述的基于三维模型Morse分解的工业机器人加工轨迹自动规划方法,其特征在于:所述第三步中利用顶点集合S创建分割边界方法如下:
第一步:若顶点集合S为空集,将执行下一步工作,若顶点集合S不为空集,从顶点集合S中取出一个顶点c;
第二步:将顶点c加入分割点集合P中,搜索网格模型M中与顶点c相连的顶点集合VC,选择对应值最小的点p;
第三步:若f(p)<f(c),则将顶点c与顶点p的连线加入分割边界B,将p加入分割点集合P,令c=p,返回第二步,否则返回第一步。
3.根据权利要求1所述的基于三维模型Morse分解的工业机器人加工轨迹自动规划方法,其特征在于:所述第五步中的面向空间曲线轨迹生成方法如下:
第一步:根据加工需要及机器人工作范围,筛选分割线集合L中机器人可加工的分割线,对于每条分割线利用B中分割线段信息,选出其所经过的全部关键分割点pi;
第二步:利用网络模型M的原始信息求出关键分割点pi对应的法向量并根据实际加工中要求的末端执行器与物体表面距离d计算关键分割点pi对应的实际机器人末端执行器轨迹点
第三步:利用样条拟合末端执行器轨迹点,从而生成最终沿工件不同部位接合处加工的机器人加工轨迹。
4.根据权利要求1所述的基于三维模型Morse分解的工业机器人加工轨迹自动规划方法,其特征在于:所述第五步中面向空间曲面的轨迹生成方法如下:
第一步:首先在子模型Ms表面进行均匀采样;
第二步:对每个采样点pi,利用网络模型M的原始信息求出采样点pi对应的法向量并根据实际加工中要求的末端执行器与物体表面距离d计算采样点pi对应的实际机器人末端执行器轨迹点
第三步:对所有末端执行器轨迹点所组成的集合进行PCA主成分分析,得到机器人加工轨迹。
5.根据权利要求1所述的基于三维模型Morse分解的工业机器人加工轨迹自动规划方法,其特征在于:所述第二步中通过双边滤波算法,反复执行以下公式进行计算:
使每个顶点v在半径为r的领域内进行平滑。
6.根据权利要求1所述的基于三维模型Morse分解的工业机器人加工轨迹自动规划方法,其特征在于:在生成机器人轨迹之前根据加工要求及机器人作业范围滤除分割线集合L及子模型集合Ms中不需处理的分割线和子模型。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910605661.XA CN110370276B (zh) | 2019-07-05 | 2019-07-05 | 基于三维模型Morse分解的工业机器人加工轨迹自动规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910605661.XA CN110370276B (zh) | 2019-07-05 | 2019-07-05 | 基于三维模型Morse分解的工业机器人加工轨迹自动规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110370276A true CN110370276A (zh) | 2019-10-25 |
CN110370276B CN110370276B (zh) | 2022-04-08 |
Family
ID=68252082
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910605661.XA Active CN110370276B (zh) | 2019-07-05 | 2019-07-05 | 基于三维模型Morse分解的工业机器人加工轨迹自动规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110370276B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112666890A (zh) * | 2020-12-30 | 2021-04-16 | 西安中科微精光子制造科技有限公司 | 一种曲面工件加工轨迹规划方法 |
CN113379790A (zh) * | 2021-06-21 | 2021-09-10 | 山东八五信息技术有限公司 | 一种基于3d模型的高空瞭望观测物体的ai预警定位方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20110026776A (ko) * | 2009-09-08 | 2011-03-16 | 부산대학교 산학협력단 | 실제 로봇의 다중 경로계획 방법 |
CN106041928A (zh) * | 2016-06-24 | 2016-10-26 | 东南大学 | 一种基于工件模型的机器人作业任务生成方法 |
CN107972034A (zh) * | 2017-12-31 | 2018-05-01 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于ros平台的复杂工件轨迹规划仿真*** |
CN108846895A (zh) * | 2018-06-05 | 2018-11-20 | 浙江大学 | 一种基于莫尔斯-斯梅尔复形和参数化的混合四边形化方法 |
-
2019
- 2019-07-05 CN CN201910605661.XA patent/CN110370276B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20110026776A (ko) * | 2009-09-08 | 2011-03-16 | 부산대학교 산학협력단 | 실제 로봇의 다중 경로계획 방법 |
CN106041928A (zh) * | 2016-06-24 | 2016-10-26 | 东南大学 | 一种基于工件模型的机器人作业任务生成方法 |
CN107972034A (zh) * | 2017-12-31 | 2018-05-01 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于ros平台的复杂工件轨迹规划仿真*** |
CN108846895A (zh) * | 2018-06-05 | 2018-11-20 | 浙江大学 | 一种基于莫尔斯-斯梅尔复形和参数化的混合四边形化方法 |
Non-Patent Citations (2)
Title |
---|
侯鑫等: "基于网格特征临界点的三维工程模型检索算法", 《计算机集成制造***》 * |
徐士彪等: "基于形状特征的三维模型检索技术综述", 《中国体视学与图像分析》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112666890A (zh) * | 2020-12-30 | 2021-04-16 | 西安中科微精光子制造科技有限公司 | 一种曲面工件加工轨迹规划方法 |
CN112666890B (zh) * | 2020-12-30 | 2022-09-16 | 西安中科微精光子科技股份有限公司 | 一种曲面工件加工轨迹规划方法 |
CN113379790A (zh) * | 2021-06-21 | 2021-09-10 | 山东八五信息技术有限公司 | 一种基于3d模型的高空瞭望观测物体的ai预警定位方法 |
CN113379790B (zh) * | 2021-06-21 | 2022-03-22 | 山东八五信息技术有限公司 | 一种基于3d模型的高空瞭望观测物体的ai预警定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110370276B (zh) | 2022-04-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110227876B (zh) | 基于3d点云数据的机器人焊接路径自主规划方法 | |
CN110039538B (zh) | 一种基于大型复杂构件点云信息的机器人轨迹规划方法 | |
Fang et al. | Robot path planning optimization for welding complex joints | |
CN104759379B (zh) | 基于喷涂目标三维成像技术的全流程闭环智能喷涂机器人 | |
CN106826829A (zh) | 一种可控误差的工业机器人光顺运动轨迹生成方法 | |
CN106625666A (zh) | 冗余机械臂的控制方法及装置 | |
CN110434856B (zh) | 一种焊接控制方法、装置、存储介质及焊接机器人 | |
CN107972034B (zh) | 一种基于ros平台的复杂工件轨迹规划仿真*** | |
EP0429276B1 (en) | Absolute gouge avoidance for computer-aided control of cutter paths | |
CN102672306A (zh) | 基于曲面多层多道焊的机器人自动焊接的方法及*** | |
Patil et al. | Extraction of weld seam in 3d point clouds for real time welding using 5 dof robotic arm | |
Zhen et al. | Adaptive automatic robot tool path generation based on point cloud projection algorithm | |
CN106423657A (zh) | 一种基于索引曲线的热喷涂机器人路径规划方法及*** | |
CN110370276A (zh) | 基于三维模型Morse分解的工业机器人加工轨迹自动规划方法 | |
CN114851209B (zh) | 一种基于视觉的工业机器人工作路径规划优化方法及*** | |
CN110171000A (zh) | 坡口切割方法、装置及控制设备 | |
Bhatt et al. | Incorporating tool contact considerations in tool-path planning for robotic operations | |
Basanez et al. | Robotic polishing systems | |
CN115685988A (zh) | 一种自由曲面喷涂路径自动生成方法与装置 | |
CN115018813A (zh) | 一种机器人自主识别与精确定位焊缝的方法 | |
Chang et al. | Machining process planning of prismatic parts using case-based reasoning and past process knowledge | |
Xu et al. | A new welding path planning method based on point cloud and deep learning | |
US4961041A (en) | Method of creating numerical control data for rough machining | |
Yuan et al. | Mobile collaborative welding system for complex welding seams | |
CN110053045A (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 |