一种基于形状约束的三维模型表面覆盖路径规划方法

1.本发明涉及自动化设备路径规划技术领域，尤其涉及一种基于形状约束的三维模型表面覆盖路径规划方法。


背景技术：

2.路径规划是目前机器人自主导航规划研究的核心技术之一，目的是在起点和终点之间找到一条路径，该路径能够躲避所有的障碍物，且其长度为两点间路径最小值的最优解或近似最优解。近年来，国内外学者对机器人的路径规划进行了很多研究，并提出多种算法，包括人工势场法、a*算法、dijkstra算法等。随着机器人领域的发展，对移动机器人的工作环境、工作效率和稳定性要求逐步提升，传统的路径搜索算法在路径规划问题中缺乏实用性和有效性。现在大多数采用群智能优化算法去解决路径规划问题，例如粒子群优化算法、遗传算法、鱼群算法、蚁群算法等。
3.基于视觉的自动化检测在复杂三维环境中的应用越来越受到业界和学术界的关注。这些检查任务需要设备在目标物体周围进行导航，以捕获目标表面区域的信息，以便进一步深入处理。检测通常是一项高度重复的任务，而且目标对象具有不同的大小和几何形状。因此，为各种目标对象自动生成高效的检测路径是至关重要的。这种针对检测应用的规划任务必须满足表面覆盖约束，因此通常被认为是覆盖路径规划问题。
4.基于上述背景，发明一种基于形状约束的三维模型表面覆盖路径规划方法具有重要意义。


技术实现要素：

5.针对现有技术的不足，本发明提供了一种基于形状约束的三维模型表面覆盖路径规划方法，解决了现有技术无法在三维物体表面检测过程中根据物体表面点云进行路径规划的技术问题，通过形状约束区域能在后续检测过程中有效约束规划路径在三维模型表面，以便获取近距离高质量数据，同时避免三维模型与检测工具发生干涉，进一步保证了工程安全。
6.为解决上述技术问题，本发明提供了如下技术方案：一种基于形状约束的三维模型表面覆盖路径规划方法，包括以下步骤：s1、通过三维模型下采样或三维激光扫描仪扫描获取其表面点云数据，然后对获取的点云数据进行去噪处理；s2、根据获取的点云数据生成路径点形状约束区域；s3、根据随机采样后融入工程约束进行筛选的方法生成路径点集，工程约束具体为干涉约束；s4、根据生成的路径点集得到唯一路径，即为三维模型表面覆盖路径规划。
7.进一步地，在步骤s2中，根据获取的点云数据生成路径点形状约束区域，具体过程包括以下步骤：
s21、统计点云数据中x、y、z方向的坐标最大值与最小值，根据每个体素的尺寸对x、y、z方向的点云进行网格划分，落到一个网格内的点作为同一体素；s22、设置膨胀体素值，对体素进行两次体素膨胀操作，得到膨胀后的体素；s23、设置收缩体素值，进行一次体素收缩操作，得到收缩后的体素；s24、计算体素与体素的差值得到形状约束区域。
8.进一步地，在步骤s22中，膨胀体素值设置为4。
9.进一步地，在步骤s23中，收缩体素值设置为4。
10.进一步地，在步骤s3中，根据随机采样后融入工程约束进行筛选的方法生成路径点集，具体过程包括以下步骤：s31、设置起始点、目标点、步长及最大迭代次数，划定采样区域为大于三维模型点云的三维空间，并在形状约束区域范围内设置起始点和目标点，设置路径步长和采样的最大迭代次数；s32、在划定采样区域内进行随机采样得到初始点；s33、在已有的路径点中遍历与初始点的最近点得到初始路径点；s34、判断初始路径点是否满足干涉约束筛选；若满足干涉约束筛选，则进行步骤s35；若不满足干涉约束筛选，则舍弃该点后重新进行步骤s32；s35、判断通过筛选的初始路径点是否在形状约束区域的范围内；若在范围内，则视为通过筛选的初始路径点通过形状约束筛选，执行步骤s36；若不在范围内，则舍弃该点后重新进行步骤s32；s36、将满足干涉约束筛选和形状约束区域的初始路径点加入到路径点集，并将初始路径点与最近点的有向连线加入到有向边集中；s37、判断是否达到目标点，计算新加入到路径点集中的初始路径点与目标点的欧式距离；若距离小于步长，视为达到目标点，则结束；否则执行步骤s38；s38、判断是否达到最大迭代次数，若达到，则结束，否则继续执行步骤s32。
11.进一步地，在步骤s31中，划定采样区域为步骤s21中x、y、z方向的坐标最大值与最小值分别向外扩张2个体素的大小，步长设置为10倍体素尺寸的大小。
12.进一步地，在步骤s4中，根据生成的路径点集得到唯一路径，具体过程包括：根据步骤s3中的算法结果，可以得到从起始点到目标点的唯一通路，即在点集和有向边集中，可以从目标点开始反向搜索必定会到达起始点，即得到规划完成的路径。
13.借由上述技术方案，本发明提供了一种基于形状约束的三维模型表面覆盖路径规划方法，至少具备以下有益效果：1、本发明能快速有效规划三维模型表面路径，提高了自动化检测效率，且通过形
状约束区域能在后续检测过程中缩减三维模型与检测工具（如无人机）之间的距离，将检测工具有效的限制在三维模型的表面空间进行近距离高精度的数据采集，同时避免发生碰撞，进一步保证了工程安全。
14.2、本发明可以在三维物体表面检测过程中根据物体表面点云进行路径规划，并提供鲁棒的检测路径。
15.3、本发明通过形状约束区域能在后续检测过程中有效约束规划路径在三维模型表面，以便获取近距离高质量数据，同时避免三维模型与检测工具发生干涉，进一步保证了工程安全。
附图说明
16.此处所说明的附图用来提供对本技术的进一步理解，构成本技术的一部分，本技术的示意性实施例及其说明用于解释本技术，并不构成对本技术的不当限定。在附图中：图1为本发明路径规划方法的流程图；图2为本发明路径规划方法形状约束区域形成过程示意图。
实施方式
17.为使本发明的上述目的、特征和优点能够更加明显易懂，下面结合附图和具体实施方式对本发明作进一步详细的说明。借此对本技术如何应用技术手段来解决技术问题并达成技术功效的实现过程能充分理解并据以实施。
18.本领域普通技术人员可以理解实现上述实施例方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成，因此，本技术可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本技术可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、cd-rom、光学存储器等)上实施的计算机程序产品的形式。
19.请参照图1-图2，示出了本实施例的一种具体实施方式，本实施例通过形状约束区域能在后续检测过程中有效约束规划路径在三维模型表面，以便获取近距离高质量数据，同时避免三维模型与检测工具发生干涉，进一步保证了工程安全。
20.可以在三维物体表面检测过程中根据物体表面点云进行路径规划，并提供鲁棒的检测路径。
21.请参照图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）；s22、设置膨胀体素值，对体素进行两次体素膨胀操作，得到膨胀后的体素；具体的，点云体素膨胀，综合考虑干涉问题和体素大小，设置膨胀体素值，进行两次体素膨胀操作，得到膨胀后的体素；可选地，设置膨胀体素值为4，体素膨胀示意图参见图2（b）；s23、设置收缩体素值，进行一次体素收缩操作，得到收缩后的体素；具体的，点云体素收缩，设置与膨胀体素值相同的收缩体素值4，进行一次体素收缩操作，得到收缩后的体素；体素收缩示意图参见图2（c）；s24、计算体素与体素的差值得到形状约束区域；具体的，形状约束区域生成，将s2-2与s2-3得到的体素做差得到形状约束区域，即：
22.形状约束区域参见图2（d），后续初始生成点筛选过程中，应确保路径点落在形状约束区域内，即生成点属于视为通过筛选。
23.s3、根据随机采样后融入工程约束进行筛选的方法生成路径点集，工程约束具体为干涉约束；在步骤s3中，根据随机采样后融入工程约束进行筛选的方法生成路径点集，具体过程包括以下步骤：s31、设置起始点、目标点、步长及最大迭代次数，划定采样区域为大于三维模型点云的三维空间，并在形状约束区域范围内设置起始点和目标点，设置路径步长和采样的最大迭代次数；具体的，划定采样区域为步骤s21中x、y、z方向的坐标最大值与最小值分别向外扩张2个体素的大小，步长设置为10倍体素尺寸的大小。
24.s32、在划定采样区域内进行随机采样得到初始点；具体的，基于随机采样的初始点生成，在步骤s31所述的采样区域内进行随机采样得到初始点。
25.s33、在已有的路径点中遍历与初始点的最近点得到初始路径点；具体的，基于固定步长的初始路径点生成，在已有的路径点中遍历步骤s32中初始点的最近点，在和的连线上取距离为步骤s31中步长的点作为初始路径点。
26.s34、判断初始路径点是否满足干涉约束筛选；若满足干涉约束筛选，则进行步骤s35；若不满足干涉约束筛选，则舍弃该点后重新进行步骤s32；具体的，判断是否满足干涉约束筛选，判断步骤s33中得到的初始路径点与最近
点的连线是否与步骤s23中的体素有交叉，即遍历体素中的每一个体素，计算直线与体素六个面所形成六个平面的交点，再判断交点是否在六个面上，若存在一个体素形成的平面与直线的交点在体素的面上，则视为连线与体素有交叉，即不满足干涉约束筛选，舍弃该点后重新进行步骤s32；否则视为满足干涉约束筛选，进行步骤s35。
27.在筛选过程中，若直线与平面平行且直线不属于平面，视为交点不在面上。
28.s35、判断通过筛选的初始路径点是否在形状约束区域的范围内；若在范围内，则视为通过筛选的初始路径点通过形状约束筛选，执行步骤s36；若不在范围内，则舍弃该点后重新进行步骤s32；具体的，判断是否满足形状约束筛选，对于步骤s34中通过筛选的初始路径点，判断该点是否在步骤s24形状约束区域范围内。即遍历形状约束区域内的每一个体素，根据步骤s21的体素坐标范围，判断通过筛选的初始路径点是否属于该体素，若形状约束区域内存在一个体素包含通过筛选的初始路径点，则视为通过筛选的初始路径点通过形状约束筛选，执行步骤s36，否则舍弃该点后重新进行步骤s32。
29.s36、将满足干涉约束筛选和形状约束区域的初始路径点加入到路径点集，并将初始路径点与最近点的有向连线加入到有向边集中；s37、判断是否达到目标点，计算新加入到路径点集中的初始路径点与目标点的欧式距离；若距离小于步长，视为达到目标点，则结束；否则执行步骤s38；s38、判断是否达到最大迭代次数，若达到，则结束，否则继续执行步骤s32。
30.s4、根据生成的路径点集得到唯一路径，即为三维模型表面覆盖路径规划；在步骤s4中，根据生成的路径点集得到唯一路径，具体过程包括：根据步骤s3中的算法结果，可以得到从起始点到目标点的唯一通路，即在点集和有向边集中，可以从目标点开始反向搜索必定会到达起始点，即得到规划完成的路径。
31.本实施例能快速有效规划三维模型表面路径，提高了自动化检测效率，且通过形状约束区域能在后续检测过程中缩减三维模型与检测工具（如无人机）之间的距离，将检测工具有效的限制在三维模型的表面空间进行近距离高精度的数据采集，同时避免发生碰撞，进一步保证了工程安全。
32.以上实施方式对本发明进行了详细介绍，本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处，综上所述，本说明书内容不应理解为对本发明的限制。