CN115774452A - 一种基于形状约束的三维模型表面覆盖路径规划方法 - Google Patents
一种基于形状约束的三维模型表面覆盖路径规划方法 Download PDFInfo
- Publication number
- CN115774452A CN115774452A CN202310106071.9A CN202310106071A CN115774452A CN 115774452 A CN115774452 A CN 115774452A CN 202310106071 A CN202310106071 A CN 202310106071A CN 115774452 A CN115774452 A CN 115774452A
- Authority
- CN
- China
- Prior art keywords
- point
- path
- voxel
- initial
- shape
- 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
- 238000000034 method Methods 0.000 title claims abstract description 54
- 238000005070 sampling Methods 0.000 claims abstract description 26
- 238000012216 screening Methods 0.000 claims description 31
- 230000008602 contraction Effects 0.000 claims description 6
- 238000012545 processing Methods 0.000 claims description 4
- 238000001514 detection method Methods 0.000 abstract description 24
- 238000001914 filtration Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 4
- 238000013480 data collection Methods 0.000 description 2
- 238000007689 inspection Methods 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 241000251468 Actinopterygii Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002068 genetic effect Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 230000003252 repetitive effect Effects 0.000 description 1
- 238000010845 search algorithm Methods 0.000 description 1
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/30—Computing systems specially adapted for manufacturing
Landscapes
- Processing Or Creating Images (AREA)
Abstract
本发明涉及自动化设备路径规划技术领域,解决了现有技术无法在三维物体表面检测过程中根据物体表面点云进行路径规划的技术问题,尤其涉及一种基于形状约束的三维模型表面覆盖路径规划方法,包括以下步骤:S1、通过三维模型下采样或三维激光扫描仪扫描获取其表面点云数据,然后对获取的点云数据进行去噪处理;S2、根据获取的点云数据生成路径点形状约束区域;S3、根据随机采样后融入工程约束进行筛选的方法生成路径点集,工程约束具体为干涉约束。本发明通过形状约束区域能在后续检测过程中有效约束规划路径在三维模型表面,以便获取近距离高质量数据,同时避免三维模型与检测工具发生干涉,进一步保证了工程安全。
Description
技术领域
本发明涉及自动化设备路径规划技术领域,尤其涉及一种基于形状约束的三维模型表面覆盖路径规划方法。
背景技术
路径规划是目前机器人自主导航规划研究的核心技术之一,目的是在起点和终点之间找到一条路径,该路径能够躲避所有的障碍物,且其长度为两点间路径最小值的最优解或近似最优解。近年来,国内外学者对机器人的路径规划进行了很多研究,并提出多种算法,包括人工势场法、A*算法、Dijkstra算法等。随着机器人领域的发展,对移动机器人的工作环境、工作效率和稳定性要求逐步提升,传统的路径搜索算法在路径规划问题中缺乏实用性和有效性。现在大多数采用群智能优化算法去解决路径规划问题,例如粒子群优化算法、遗传算法、鱼群算法、蚁群算法等。
基于视觉的自动化检测在复杂三维环境中的应用越来越受到业界和学术界的关注。这些检查任务需要设备在目标物体周围进行导航,以捕获目标表面区域的信息,以便进一步深入处理。检测通常是一项高度重复的任务,而且目标对象具有不同的大小和几何形状。因此,为各种目标对象自动生成高效的检测路径是至关重要的。这种针对检测应用的规划任务必须满足表面覆盖约束,因此通常被认为是覆盖路径规划问题。
基于上述背景,发明一种基于形状约束的三维模型表面覆盖路径规划方法具有重要意义。
发明内容
针对现有技术的不足,本发明提供了一种基于形状约束的三维模型表面覆盖路径规划方法,解决了现有技术无法在三维物体表面检测过程中根据物体表面点云进行路径规划的技术问题,通过形状约束区域能在后续检测过程中有效约束规划路径在三维模型表面,以便获取近距离高质量数据,同时避免三维模型与检测工具发生干涉,进一步保证了工程安全。
为解决上述技术问题,本发明提供了如下技术方案:一种基于形状约束的三维模型表面覆盖路径规划方法,包括以下步骤:
S1、通过三维模型下采样或三维激光扫描仪扫描获取其表面点云数据,然后对获取的点云数据进行去噪处理;
S2、根据获取的点云数据生成路径点形状约束区域;
S3、根据随机采样后融入工程约束进行筛选的方法生成路径点集,工程约束具体为干涉约束;
S4、根据生成的路径点集得到唯一路径,即为三维模型表面覆盖路径规划。
进一步地,在步骤S2中,根据获取的点云数据生成路径点形状约束区域,具体过程包括以下步骤:
S21、统计点云数据中X、Y、Z方向的坐标最大值与最小值,根据每个体素的尺寸对X、Y、Z方向的点云进行网格划分,落到一个网格内的点作为同一体素;
进一步地,在步骤S22中,膨胀体素值设置为4。
进一步地,在步骤S23中,收缩体素值设置为4。
进一步地,在步骤S3中,根据随机采样后融入工程约束进行筛选的方法生成路径点集,具体过程包括以下步骤:
若满足干涉约束筛选,则进行步骤S35;
若不满足干涉约束筛选,则舍弃该点后重新进行步骤S32;
若不在范围内,则舍弃该点后重新进行步骤S32;
若距离小于步长,视为达到目标点,则结束;否则执行步骤S38;
S38、判断是否达到最大迭代次数,若达到,则结束,否则继续执行步骤S32。
进一步地,在步骤S31中,划定采样区域为步骤S21中X、Y、Z方向的坐标最大值与最小值分别向外扩张2个体素的大小,步长设置为10倍体素尺寸的大小。
进一步地,在步骤S4中,根据生成的路径点集得到唯一路径,具体过程包括:
借由上述技术方案,本发明提供了一种基于形状约束的三维模型表面覆盖路径规划方法,至少具备以下有益效果:
1、本发明能快速有效规划三维模型表面路径,提高了自动化检测效率,且通过形状约束区域能在后续检测过程中缩减三维模型与检测工具(如无人机)之间的距离,将检测工具有效的限制在三维模型的表面空间进行近距离高精度的数据采集,同时避免发生碰撞,进一步保证了工程安全。
2、本发明可以在三维物体表面检测过程中根据物体表面点云进行路径规划,并提供鲁棒的检测路径。
3、本发明通过形状约束区域能在后续检测过程中有效约束规划路径在三维模型表面,以便获取近距离高质量数据,同时避免三维模型与检测工具发生干涉,进一步保证了工程安全。
附图说明
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1为本发明路径规划方法的流程图;
图2为本发明路径规划方法形状约束区域形成过程示意图。
实施方式
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。借此对本申请如何应用技术手段来解决技术问题并达成技术功效的实现过程能充分理解并据以实施。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成,因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
请参照图1-图2,示出了本实施例的一种具体实施方式,本实施例通过形状约束区域能在后续检测过程中有效约束规划路径在三维模型表面,以便获取近距离高质量数据,同时避免三维模型与检测工具发生干涉,进一步保证了工程安全。
可以在三维物体表面检测过程中根据物体表面点云进行路径规划,并提供鲁棒的检测路径。
请参照图1,本实施例提出了一种基于形状约束的三维模型表面覆盖路径规划方法,该方法包括以下步骤:
S1、通过三维模型下采样或三维激光扫描仪扫描获取其表面点云数据,然后对获取的点云数据进行去噪处理,可选地,点云获取设备可选用形创公司c-track搭配metrascan进行扫描;
S2、根据获取的点云数据生成路径点形状约束区域;
请参照图2,在步骤S2中,根据获取的点云数据生成路径点形状约束区域,具体过程包括以下步骤:
S21、统计点云数据中X、Y、Z方向的坐标最大值与最小值,根据每个体素的尺寸对X、Y、Z方向的点云进行网格划分,落到一个网格内的点作为同一体素;
具体的,物体点云体素化,统计点云数据X、Y、Z方向的坐标最大值与最小值,根据每个体素的尺寸对X、Y、Z方向的点云进行网格划分,落到一个网格内的点作为同一体素;可选地,将体素的尺寸设置为三个最大值减最小值中较大值的1/200,体素示意图参见图2(a);
S3、根据随机采样后融入工程约束进行筛选的方法生成路径点集,工程约束具体为干涉约束;
在步骤S3中,根据随机采样后融入工程约束进行筛选的方法生成路径点集,具体过程包括以下步骤:
具体的,划定采样区域为步骤S21中X、Y、Z方向的坐标最大值与最小值分别向外扩张2个体素的大小,步长设置为10倍体素尺寸的大小。
若满足干涉约束筛选,则进行步骤S35;
若不满足干涉约束筛选,则舍弃该点后重新进行步骤S32;
具体的,判断是否满足干涉约束筛选,判断步骤S33中得到的初始路径点与最近点的连线是否与步骤S23中的体素有交叉,即遍历体素中的每一个体素,计算直线与体素六个面所形成六个平面的交点,再判断交点是否在六个面上,若存在一个体素形成的平面与直线的交点在体素的面上,则视为连线与体素有交叉,即不满足干涉约束筛选,舍弃该点后重新进行步骤S32;否则视为满足干涉约束筛选,进行步骤S35。
在筛选过程中,若直线与平面平行且直线不属于平面,视为交点不在面上。
若不在范围内,则舍弃该点后重新进行步骤S32;
具体的,判断是否满足形状约束筛选,对于步骤S34中通过筛选的初始路径点,判断该点是否在步骤S24形状约束区域范围内。即遍历形状约束区域内的每一个体素,根据步骤S21的体素坐标范围,判断通过筛选的初始路径点是否属于该体素,若形状约束区域内存在一个体素包含通过筛选的初始路径点,则视为通过筛选的初始路径点通过形状约束筛选,执行步骤S36,否则舍弃该点后重新进行步骤S32。
若距离小于步长,视为达到目标点,则结束;否则执行步骤S38;
S38、判断是否达到最大迭代次数,若达到,则结束,否则继续执行步骤S32。
S4、根据生成的路径点集得到唯一路径,即为三维模型表面覆盖路径规划;
在步骤S4中,根据生成的路径点集得到唯一路径,具体过程包括:
本实施例能快速有效规划三维模型表面路径,提高了自动化检测效率,且通过形状约束区域能在后续检测过程中缩减三维模型与检测工具(如无人机)之间的距离,将检测工具有效的限制在三维模型的表面空间进行近距离高精度的数据采集,同时避免发生碰撞,进一步保证了工程安全。
以上实施方式对本发明进行了详细介绍,本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。
Claims (7)
1.一种基于形状约束的三维模型表面覆盖路径规划方法,其特征在于,包括以下步骤:
S1、通过三维模型下采样或三维激光扫描仪扫描获取其表面点云数据,然后对获取的点云数据进行去噪处理;
S2、根据获取的点云数据生成路径点形状约束区域;
S3、根据随机采样后融入工程约束进行筛选的方法生成路径点集,工程约束具体为干涉约束;
S4、根据生成的路径点集得到唯一路径,即为三维模型表面覆盖路径规划。
3.根据权利要求2所述的路径规划方法,其特征在于:在步骤S22中,膨胀体素值设置为4。
4.根据权利要求2所述的路径规划方法,其特征在于:在步骤S23中,收缩体素值设置为4。
5.根据权利要求1所述的路径规划方法,其特征在于:在步骤S3中,根据随机采样后融入工程约束进行筛选的方法生成路径点集,具体过程包括以下步骤:
若满足干涉约束筛选,则进行步骤S35;
若不满足干涉约束筛选,则舍弃该点后重新进行步骤S32;
若不在范围内,则舍弃该点后重新进行步骤S32;
若距离小于步长,视为达到目标点,则结束;否则执行步骤S38;
S38、判断是否达到最大迭代次数,若达到,则结束,否则继续执行步骤S32。
6.根据权利要求5所述的路径规划方法,其特征在于:在步骤S31中,划定采样区域为步骤S21中X、Y、Z方向的坐标最大值与最小值分别向外扩张2个体素的大小,步长设置为10倍体素尺寸的大小。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310106071.9A CN115774452B (zh) | 2023-02-13 | 2023-02-13 | 一种基于形状约束的三维模型表面覆盖路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310106071.9A CN115774452B (zh) | 2023-02-13 | 2023-02-13 | 一种基于形状约束的三维模型表面覆盖路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115774452A true CN115774452A (zh) | 2023-03-10 |
CN115774452B CN115774452B (zh) | 2023-05-05 |
Family
ID=85393681
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310106071.9A Active CN115774452B (zh) | 2023-02-13 | 2023-02-13 | 一种基于形状约束的三维模型表面覆盖路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115774452B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110619679A (zh) * | 2019-09-10 | 2019-12-27 | 真健康(北京)医疗科技有限公司 | 一种路径自动规划装置及方法 |
CN111678524A (zh) * | 2020-07-31 | 2020-09-18 | 中国民用航空飞行学院 | 一种基于飞行安全的救援航空器路径规划方法及系统 |
CN112161622A (zh) * | 2020-08-28 | 2021-01-01 | 深圳市优必选科技股份有限公司 | 一种机器人足迹规划方法、装置、可读存储介质及机器人 |
CN113589753A (zh) * | 2021-07-12 | 2021-11-02 | 西安电子科技大学 | 三维模型表面路径规划方法、系统、设备、终端及应用 |
CN113778130A (zh) * | 2021-09-24 | 2021-12-10 | 南京航空航天大学 | 一种基于三维模型的无人机覆盖路径规划方法 |
CN114355956A (zh) * | 2021-12-27 | 2022-04-15 | 武汉理工大学 | 一种基于三维点云的水下机器人路径规划方法 |
-
2023
- 2023-02-13 CN CN202310106071.9A patent/CN115774452B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110619679A (zh) * | 2019-09-10 | 2019-12-27 | 真健康(北京)医疗科技有限公司 | 一种路径自动规划装置及方法 |
CN111678524A (zh) * | 2020-07-31 | 2020-09-18 | 中国民用航空飞行学院 | 一种基于飞行安全的救援航空器路径规划方法及系统 |
CN112161622A (zh) * | 2020-08-28 | 2021-01-01 | 深圳市优必选科技股份有限公司 | 一种机器人足迹规划方法、装置、可读存储介质及机器人 |
CN113589753A (zh) * | 2021-07-12 | 2021-11-02 | 西安电子科技大学 | 三维模型表面路径规划方法、系统、设备、终端及应用 |
CN113778130A (zh) * | 2021-09-24 | 2021-12-10 | 南京航空航天大学 | 一种基于三维模型的无人机覆盖路径规划方法 |
CN114355956A (zh) * | 2021-12-27 | 2022-04-15 | 武汉理工大学 | 一种基于三维点云的水下机器人路径规划方法 |
Non-Patent Citations (3)
Title |
---|
CHENMING WU 等: "Energy-Efficient Coverage Path Planning for General Terrain Surfaces" * |
SOOHWAN SONG 等: "Online Inspection Path Planning for Autonomous 3D Modeling using a Micro-Aerial Vehicle" * |
张世勇 等: "旋翼无人机环境覆盖与探索规划方法综述" * |
Also Published As
Publication number | Publication date |
---|---|
CN115774452B (zh) | 2023-05-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109514133B (zh) | 一种基于线结构光感知的焊接机器人3d曲线焊缝自主示教方法 | |
CN108356819B (zh) | 基于改进a*算法的工业机械臂无碰撞路径规划方法 | |
CN114571153A (zh) | 一种基于3d点云的焊缝识别与机器人焊缝跟踪方法 | |
CN113203420B (zh) | 一种基于变密度搜索空间的工业机器人动态路径规划方法 | |
CN108213757B (zh) | 一种用于焊接机器人的碰撞检测方法 | |
Li et al. | Path planning method for on-machine inspection of aerospace structures based on adjacent feature graph | |
CN103942837B (zh) | 基于序列线性规划的叶片点云模型截面曲线直接构造方法 | |
CN108663990B (zh) | 一种基于两级体素化模型的多轴加工干涉检测与处理方法 | |
CN107622530B (zh) | 一种高效鲁棒的三角网切割方法 | |
JP4905285B2 (ja) | 工具参照面を作成する装置と方法とプログラム | |
CN114119804A (zh) | 平面模型包围多边形生成方法、装置及家具轮廓识别方法 | |
WO2023231640A1 (zh) | 动态沿边路径生成方法、装置、计算机设备和存储介质 | |
Zhang et al. | Feature extraction and robot path planning method in 3D vision-guided welding for multi-blade wheel structures | |
CN114972640B (zh) | 一种基于点云的线缆三维重建与参数计算的方法 | |
Fan et al. | Fast global collision detection method based on feature-point-set for robotic machining of large complex components | |
CN114986501A (zh) | 一种机械臂路径规划方法、系统及机械臂 | |
CN115774452A (zh) | 一种基于形状约束的三维模型表面覆盖路径规划方法 | |
Vamsi Krishna et al. | FEATURE BASED MODELING AND AUTOMATED PROCESS PLAN GENERATION FOR TURNING COMPONENTS. | |
CN117162098B (zh) | 一种狭小空间机器人姿态自主规划系统及方法 | |
Canann | Plastering-A new approach to automated, 3-D hexahedral mesh generation | |
CN116619381A (zh) | 一种工业机器人避障路径规划方法 | |
CN116910888A (zh) | 一种装配式建筑bim模型构件生成方法及系统 | |
CN113160415B (zh) | 基于三维视觉信息的网格结构工件焊缝定位方法及系统 | |
JP4622987B2 (ja) | 工具参照面データの作成装置と作成方法 | |
Xiao et al. | Robot intelligent welding programming based on line structure light sensing |
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 |