CN110619679B - 一种路径自动规划装置及方法 - Google Patents
一种路径自动规划装置及方法 Download PDFInfo
- Publication number
- CN110619679B CN110619679B CN201910854469.4A CN201910854469A CN110619679B CN 110619679 B CN110619679 B CN 110619679B CN 201910854469 A CN201910854469 A CN 201910854469A CN 110619679 B CN110619679 B CN 110619679B
- Authority
- CN
- China
- Prior art keywords
- path planning
- target
- subjected
- cloud data
- point cloud
- 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
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
- G06Q10/00—Administration; Management
- G06Q10/04—Forecasting or optimisation specially adapted for administrative or management purposes, e.g. linear programming or "cutting stock problem"
- G06Q10/047—Optimisation of routes or paths, e.g. travelling salesman problem
-
- 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
-
- 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
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2200/00—Indexing scheme for image data processing or generation, in general
- G06T2200/08—Indexing scheme for image data processing or generation, in general involving all processing steps from image acquisition to 3D model generation
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2210/00—Indexing scheme for image generation or computer graphics
- G06T2210/21—Collision detection, intersection
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Business, Economics & Management (AREA)
- Human Resources & Organizations (AREA)
- Theoretical Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Software Systems (AREA)
- Economics (AREA)
- Strategic Management (AREA)
- Computer Graphics (AREA)
- Game Theory and Decision Science (AREA)
- Tourism & Hospitality (AREA)
- Quality & Reliability (AREA)
- General Business, Economics & Management (AREA)
- Operations Research (AREA)
- Marketing (AREA)
- Architecture (AREA)
- Entrepreneurship & Innovation (AREA)
- Computer Hardware Design (AREA)
- General Engineering & Computer Science (AREA)
- Development Economics (AREA)
- Geometry (AREA)
- Processing Or Creating Images (AREA)
Abstract
本发明实施例提供一种路径自动规划装置及方法，装置包括：第一获取模块获取操作前所需进行路径规划的目标体内空间环境的三维点云数据；第二获取模块根据操作前所需进行路径规划的目标体内空间环境的三维点云数据，获取所需进行路径规划的目标体表可操作区域的点云数据；筛选模块根据操作前所需进行路径规划的目标体内空间环境的三维点云数据和所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径；第三获取模块根据保留的非碰撞路径，获取对所需进行路径规划的目标体内的目标物体进行操作最优路径。可自动规划找到所需进行路径规划的目标体内目标物体进行操作的最优路径。
Description
技术领域
本发明涉及计算机技术领域，尤其涉及一种路径自动规划装置及方法。
背景技术
目前，对目标进行操作的路径规划依然完全是由人为进行规划确定的。但是，这种人为进行路径规划的方式完全由人的经验来决定，难以找到最佳的路径，人为进行路径规划的方式可能会带来严重的后果。而通过计算机对目标进行模拟并进行路径规划，能够提高路径规划的精确度。
鉴于此，如何通过计算机对所需进行路径规划的目标的操作进行路径规划，找到最优路径成为目前需要解决的技术问题。
发明内容
针对现有技术存在的问题，本发明实施例提供一种路径自动规划装置及方法。
本发明实施例提供一种路径自动规划装置，包括：
第一获取模块，用于获取操作前所需进行路径规划的目标体内空间环境的三维点云数据；
第二获取模块，用于根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据，获取所需进行路径规划的目标体表可操作区域的点云数据；
筛选模块，用于根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据和所述所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径；
第三获取模块，用于根据所保留的非碰撞路径，获取对所需进行路径规划的目标体内的目标物体进行操作的最优路径。
本发明实施例提供一种路径自动规划方法，包括：
获取操作前所需进行路径规划的目标体内空间环境的三维点云数据；
根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据，获取所需进行路径规划的目标体表可操作区域的点云数据；
根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据和所述所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径；
根据所保留的非碰撞路径，获取对所需进行路径规划的目标体内的目标物体进行操作的最优路径。
本发明实施例提供一种电子设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，所述处理器执行所述计算机程序时实现如上述方法的步骤。
本发明实施例提供的路径自动规划装置及方法，通过筛选模块根据操作前所需进行路径规划的目标体内空间环境的三维点云数据和所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径，第三获取模块根据所保留的非碰撞路径，获取对所需进行路径规划的目标体内的目标物体进行操作的最优路径，由此，能够通过计算机对所需进行路径规划的目标的操作进行路径规划，找到所需进行路径规划的目标体内目标物体进行操作的最优路径，有效提高路径规划的精确度。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍，显而易见地，下面描述中的附图是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1为本发明一实施例提供的一种路径自动规划装置的结构示意图；
图2为本发明一实施例提供的一种路径自动规划方法的流程示意图；
图3为本发明一实施例提供的电子设备的实体结构示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
图1示出了本发明一实施例提供的一种路径自动规划装置的结构示意图，如图1所示，本实施例的路径自动规划装置，包括：第一获取模块11、第二获取模块12、筛选模块13和第三获取模块14；其中：
所述第一获取模块11，用于获取操作前所需进行路径规划的目标体内空间环境的三维点云数据；
所述第二获取模块12，用于根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据，获取所需进行路径规划的目标体表可操作区域的点云数据；
所述筛选模块13，用于根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据和所述所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径；
所述第三获取模块14，用于根据所保留的非碰撞路径，获取对所需进行路径规划的目标体内的目标物体进行操作的最优路径。
具体地，所述第一获取模块11获取操作前所需进行路径规划的目标体内空间环境的三维点云数据；所述第二获取模块12根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据，获取所需进行路径规划的目标体表可操作区域的点云数据；所述筛选模块13根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据和所述所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径；所述第三获取模块14根据所保留的非碰撞路径，获取对所需进行路径规划的目标体内的目标物体进行操作的最优路径。
可以理解的是，本实施例所述装置需要通过计算机先对目标进行模拟。
可以理解的是，所述所需进行路径规划的目标体内空间环境可以包括：体表皮肤、体内结节和肋骨等，本实施例并不对其进行限制。
需要说明的是，本实施例所述装置应用于处理器。
可以理解的是，所需进行路径规划的目标体内碰撞规避物体可以包括：骨骼、心脏、血管和支气管等，可以根据实际情况进行设置，本实施例并不对其进行限制。
可以理解的是，为了对所需进行路径规划的目标体内进行操作的安全，对所需进行路径规划的目标体内的目标物体进行操作的路径，必须是与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径。
可以理解的是，为减小对所需进行路径规划的目标体内目标物体进行操作的损伤，进行操作过程中需要尽量垂直地进行操作，因此，最优路径代表该路径在规避所述碰撞规避物体和操作距离两方面是最优的，本实施例是先筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径，再在所保留的非碰撞路径中，找出操作距离最优的路径作为对所需进行路径规划的目标体内的目标物体进行操作的最优路径。
本发明实施例提供的路径自动规划装置，能够自动规划找到对所需进行路径规划的目标体内的目标物体进行操作的最优路径，有效提高路径规划的精确度。
进一步地，在上述实施例的基础上，所述第一获取模块11，可具体用于获取所需进行路径规划的目标的操作前CT(Computed Tomography，计算机体层摄影)数据，对所述操作前CT数据进行三维重建，重建出操作前所需进行路径规划的目标体内空间环境三维数据；
将所述操作前所需进行路径规划的目标体内空间环境三维数据转换为操作前所需进行路径规划的目标体内空间环境的三维点云数据。
在具体应用中，所述第一获取模块11可以利用计算机相关软件，将所述操作前所需进行路径规划的目标体内空间环境三维数据转换为预设间隔的点云数据用于后续处理，举例来说，所述预设间隔可以为0.1mm(毫米)。
这样，本实施例能够实现操作前所需进行路径规划的目标体内空间环境的三维点云数据的获取。
进一步地，在上述实施例的基础上，所述第二获取模块12，可具体用于
从所述操作前所需进行路径规划的目标体内空间环境的三维点云数据中，随机选取预设数量个采样点；
对于所选取的每个采样点：以所述采样点为圆心，选取距离所述采样点预设第一距离内的所需进行路径规划的目标体表的点云数据；对所选取的点云数据进行曲面拟合，获得所述采样点处拟合曲面的法向量；将所述采样点与操作前所需进行路径规划的目标体内目标物体表面点云的所有点进行连接，获得一个直线集；计算所述直线集中每条直线与所述采样点处拟合曲面的法向量的夹角；若所述直线集中每条直线与所述采样点处拟合曲面的法向量的夹角中的最大的夹角小于预设角度，则保存所述采样点；
对于每个所保存的采样点：以所述采样点为圆心，获得距离所述采样点预设第二距离内的所需进行路径规划的目标体表的点云数据，去除掉所述距离所述采样点预设第二距离内的所需进行路径规划的目标体表的点云数据中的重合区域，获得所需进行路径规划的目标体表可操作区域的点云数据。
在具体应用中，举例来说，所述预设数量个可以为1000个，能够保证所需进行路径规划的目标体表每一个小范围内都能够采样到。
在具体应用中，所述预设第一距离可以根据实际情况进行设置，本实施例并不对其进行限制，举例来说，所述预设第一距离可以设置为3mm。
在具体应用中，所述预设第二距离可以根据实际情况进行设置，本实施例并不对其进行限制，举例来说，所述预设第二距离可以设置为5mm。
在具体应用中，所述预设角度可以根据实际情况进行设置，本实施例并不对其进行限制，举例来说，所述预设角度可以为15度。
在具体应用中，举例来说，所述目标物体可以为肺小结节。
这样，本实施例能够基于所述操作前所需进行路径规划的目标体内空间环境的三维点云数据，实现所需进行路径规划的目标体表可操作区域的点云数据的获取。
进一步地，在上述实施例的基础上，所述筛选模块13，可具体用于
对操作前所需进行路径规划的目标体内目标物体表面点云数据进行加和平均处理，获得操作前所需进行路径规划的目标体内目标物体表面点云数据的质心；
对于所需进行路径规划的目标体表可操作区域的点云数据中的每个点Ci，其中，i＝1,...,n，n为所需进行路径规划的目标体表可操作区域的点云数据中的点的数量：
将所述点Ci与所述操作前所需进行路径规划的目标体内目标物体表面点云数据的质心连线得到一条直线，通过计算得到通过所述质心并垂直于所述直线的平面，获得操作前所需进行路径规划的目标体内目标物体表面点云数据中位于所述平面上的点；
将操作前所需进行路径规划的目标体内目标物体表面点云数据中位于所述平面上的每个点与所述点Ci进行连线，将得到的线段以预设第三距离进行截点(X1,X2,...,Xp,...,Xm)，其中，p＝1,...,m，m为所述截点的数量，计算每个截点与所需进行路径规划的目标体内碰撞规避物体的最小距离；
若某一线段的截点与所需进行路径规划的目标体内碰撞规避物体的最小距离小于预设阈值，则将所述线段作为与所需进行路径规划的目标体内碰撞规避物体发生碰撞的路径进行删除；
若某一线段的截点与所需进行路径规划的目标体内碰撞规避物体的最小距离大于等于预设阈值，则将所述线段作为与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径进行保留。
在具体应用中，所述预设第三距离可以根据实际情况进行设置，本实施例并不对其进行限制，举例来说，所述预设第三距离可以设置为0.1mm。
可以理解的是，若某一线段的截点与所需进行路径规划的目标体内碰撞规避物体的最小距离小于预设阈值，则表明所述线段与所需进行路径规划的目标体内碰撞规避物体发生了碰撞。
在具体应用中，所述预设阈值可以设置为对所需进行路径规划的目标体内的目标物体进行操作时所使用的针形设备的半径。
这样，本实施例能够基于操作前所需进行路径规划的目标体内空间环境的三维点云数据和所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径。
进一步地，在上述实施例的基础上，所述第三获取模块14，可具体用于对于所保留的非碰撞路径中的每条线段Lj，其中，j＝1,...,a，a为所保留的非碰撞路径中线段的数量：
获取所述线段Lj的所有截点的距离参数，所述线段Lj的任一截点的距离参数是所述任一截点与所需进行路径规划的目标体内每个碰撞规避物体的最小距离之和，将所述线段Lj的所有截点的距离参数相加，得到所述线段Lj的距离参数LENj；
根据所述线段Lj的距离参数LENj，通过第一公式，计算得到所述线段Lj的最优参数BESTj；
将所保留的非碰撞路径中最优参数最大的线段作为对所需进行路径规划的目标体内的目标物体进行操作的最优路径；
其中，所述第一公式为：
Mj为表示所述线段Lj长度的截点个数。
这样，本实施例能够在所保留的非碰撞路径中，找出操作距离最优的路径作为对所需进行路径规划的目标体内的目标物体进行操作的最优路径。
本发明实施例提供的路径自动规划装置，能够自动规划找到对所需进行路径规划的目标体内的目标物体进行操作的最优路径，有效提高路径规划的精确度。
图2示出了本发明一实施例提供的一种路径自动规划方法的流程示意图，如图2所示，本实施例的路径自动规划方法，包括：
S1、获取操作前所需进行路径规划的目标体内空间环境的三维点云数据。
可以理解的是，在所述S1之前，需要通过计算机对目标进行模拟。
可以理解的是，所述所需进行路径规划的目标体内空间环境可以包括：体表皮肤、体内结节和肋骨等，本实施例并不对其进行限制。
需要说明的是，本实施例所述方法的执行主体为处理器。
S2、根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据，获取所需进行路径规划的目标体表可操作区域的点云数据。
可以理解的是，本实施例需要在所需进行路径规划的目标体表可操作区域的点云数据的基础上，自动规划找到所需进行路径规划的目标体内目标问题进行操作的最优路径。
S3、根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据和所述所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径。
可以理解的是，所需进行路径规划的目标体内碰撞规避物体可以包括：骨骼、心脏、血管和支气管等，可以根据实际情况进行设置，本实施例并不对其进行限制。
可以理解的是，为了对所需进行路径规划的目标体内进行操作的安全，对所需进行路径规划的目标体内的目标物体进行操作的路径，必须是与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径。
S4、根据所保留的非碰撞路径，获取对所需进行路径规划的目标体内的目标物体进行操作的最优路径。
可以理解的是，为减小对所需进行路径规划的目标体内目标物体进行操作的损伤，进行操作过程中需要尽量垂直地进行操作，因此，最优路径代表该路径在规避所述碰撞规避物体和操作距离两方面是最优的，本实施例是先筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径，再在所保留的非碰撞路径中，找出操作距离最优的路径作为对所需进行路径规划的目标体内的目标物体进行操作的最优路径。
本发明实施例提供的路径自动规划方法，通过先获取操作前所需进行路径规划的目标体内空间环境的三维点云数据，根据操作前所需进行路径规划的目标体内空间环境的三维点云数据，获取所需进行路径规划的目标体表可操作区域的点云数据，再根据操作前所需进行路径规划的目标体内空间环境的三维点云数据和所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径，最后根据所保留的非碰撞路径，获取对所需进行路径规划的目标体内的目标物体进行操作的最优路径，由此，能够自动规划找到对所需进行路径规划的目标体内的目标物体进行操作的最优路径，有效提高路径规划的精确度。
进一步地，在上述实施例的基础上，所述步骤S1，可以包括：
获取所需进行路径规划的目标的操作前CT数据，对所述操作前CT数据进行三维重建，重建出操作前所需进行路径规划的目标体内空间环境三维数据；
将所述操作前所需进行路径规划的目标体内空间环境三维数据转换为操作前所需进行路径规划的目标体内空间环境的三维点云数据。
在具体应用中，本实施例可以利用计算机相关软件，将所述操作前所需进行路径规划的目标体内空间环境三维数据转换为预设间隔的点云数据用于后续处理，举例来说，所述预设间隔可以为0.1mm(毫米)。
这样，本实施例能够实现操作前所需进行路径规划的目标体内空间环境的三维点云数据的获取。
进一步地，在上述实施例的基础上，所述步骤S2，可以包括：
从所述操作前所需进行路径规划的目标体内空间环境的三维点云数据中，随机选取预设数量个采样点；
对于所选取的每个采样点：以所述采样点为圆心，选取距离所述采样点预设第一距离内的所需进行路径规划的目标体表的点云数据；对所选取的点云数据进行曲面拟合，获得所述采样点处拟合曲面的法向量；将所述采样点与操作前所需进行路径规划的目标体内目标物体表面点云的所有点进行连接，获得一个直线集；计算所述直线集中每条直线与所述采样点处拟合曲面的法向量的夹角；若所述直线集中每条直线与所述采样点处拟合曲面的法向量的夹角中的最大的夹角小于预设角度，则保存所述采样点；
对于每个所保存的采样点：以所述采样点为圆心，获得距离所述采样点预设第二距离内的所需进行路径规划的目标体表的点云数据，去除掉所述距离所述采样点预设第二距离内的所需进行路径规划的目标体表的点云数据中的重合区域，获得所需进行路径规划的目标体表可操作区域的点云数据。
在具体应用中，举例来说，所述预设数量个可以为1000个，能够保证所需进行路径规划的目标体表每一个小范围内都能够采样到。
在具体应用中，所述预设第一距离可以根据实际情况进行设置，本实施例并不对其进行限制，举例来说，所述预设第一距离可以设置为3mm。
在具体应用中，所述预设第二距离可以根据实际情况进行设置，本实施例并不对其进行限制，举例来说，所述预设第二距离可以设置为5mm。
在具体应用中，所述预设角度可以根据实际情况进行设置，本实施例并不对其进行限制，举例来说，所述预设角度可以为15度。
在具体应用中，举例来说，所述目标物体可以为肺小结节。
这样，本实施例能够基于所述操作前所需进行路径规划的目标体内空间环境的三维点云数据，实现所需进行路径规划的目标体表可操作区域的点云数据的获取。
进一步地，在上述实施例的基础上，所述步骤S3，可以包括：
对操作前所需进行路径规划的目标体内目标物体表面点云数据进行加和平均处理，获得操作前所需进行路径规划的目标体内目标物体表面点云数据的质心；
对于所需进行路径规划的目标体表可操作区域的点云数据中的每个点Ci，其中，i＝1,...,n，n为所需进行路径规划的目标体表可操作区域的点云数据中的点的数量：
将所述点Ci与所述操作前所需进行路径规划的目标体内目标物体表面点云数据的质心连线得到一条直线，通过计算得到通过所述质心并垂直于所述直线的平面，获得操作前所需进行路径规划的目标体内目标物体表面点云数据中位于所述平面上的点；
将操作前所需进行路径规划的目标体内目标物体表面点云数据中位于所述平面上的每个点与所述点Ci进行连线，将得到的线段以预设第三距离进行截点(X1,X2,...,Xp,...,Xm)，其中，p＝1,...,m，m为所述截点的数量，计算每个截点与所需进行路径规划的目标体内碰撞规避物体的最小距离；
若某一线段的截点与所需进行路径规划的目标体内碰撞规避物体的最小距离小于预设阈值，则将所述线段作为与所需进行路径规划的目标体内碰撞规避物体发生碰撞的路径进行删除；
若某一线段的截点与所需进行路径规划的目标体内碰撞规避物体的最小距离大于等于预设阈值，则将所述线段作为与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径进行保留。
在具体应用中，所述预设第三距离可以根据实际情况进行设置，本实施例并不对其进行限制，举例来说，所述预设第三距离可以设置为0.1mm。
可以理解的是，若某一线段的截点与所需进行路径规划的目标体内碰撞规避物体的最小距离小于预设阈值，则表明所述线段与所需进行路径规划的目标体内碰撞规避物体发生了碰撞。
在具体应用中，所述预设阈值可以设置为对所需进行路径规划的目标体内的目标物体进行操作时所使用的针形设备的半径。
这样，本实施例能够基于操作前所需进行路径规划的目标体内空间环境的三维点云数据和所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径。
进一步地，在上述实施例的基础上，所述步骤S4，可以包括：
对于所保留的非碰撞路径中的每条线段Lj，其中，j＝1,...,a，a为所保留的非碰撞路径中线段的数量：
将所述线段Lj的所有截点与所需进行路径规划的目标体内碰撞规避物体的最小距离进行加和，得到所述线段Lj的距离参数LENj；
根据所述线段Lj的距离参数LENj，通过第一公式，计算得到所述线段Lj的最优参数BESTj；
将所保留的非碰撞路径中最优参数最大的线段作为对所需进行路径规划的目标体内的目标物体进行操作的最优路径；
其中，所述第一公式为：
Mj为表示所述线段Lj长度的截点个数。
这样，本实施例能够在所保留的非碰撞路径中，找出操作距离最优的路径作为对所需进行路径规划的目标体内的目标物体进行操作的最优路径。
本发明实施例提供的路径自动规划方法，能够自动规划找到对所需进行路径规划的目标体内的目标物体进行操作的最优路径，有效提高路径规划的精确度。
图3示出了本发明一实施例提供的一种电子设备的实体结构示意图，如图3所示，该电子设备可以包括存储器302、处理器301、总线303及存储在存储器302上并可在处理器301上运行的计算机程序，其中，处理器301，存储器302通过总线303完成相互间的通信。所述处理器301执行所述计算机程序时实现上述方法的步骤，例如包括：获取操作前所需进行路径规划的目标体内空间环境的三维点云数据；根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据，获取所需进行路径规划的目标体表可操作区域的点云数据；根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据和所述所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径；根据所保留的非碰撞路径，获取对所需进行路径规划的目标体内的目标物体进行操作的最优路径。
本发明实施例提供一种非暂态计算机可读存储介质，其上存储有计算机程序，该计算机程序被处理器执行时实现上述方法的步骤，例如包括：获取操作前所需进行路径规划的目标体内空间环境的三维点云数据；根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据，获取所需进行路径规划的目标体表可操作区域的点云数据；根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据和所述所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径；根据所保留的非碰撞路径，获取对所需进行路径规划的目标体内的目标物体进行操作的最优路径。
以上所描述的装置实施例仅仅是示意性的，其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的，作为单元显示的部件可以是或者也可以不是物理单元，即可以位于一个地方，或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。本领域普通技术人员在不付出创造性的劳动的情况下，即可以理解并实施。
通过以上的实施方式的描述，本领域的技术人员可以清楚地了解到各实施方式可借助软件加必需的通用硬件平台的方式来实现，当然也可以通过硬件。基于这样的理解，上述技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来，该计算机软件产品可以存储在计算机可读存储介质中，如ROM/RAM、磁碟、光盘等，包括若干指令用以使得一台计算机设备(可以是个人计算机，服务器，或者网络设备等)执行各个实施例或者实施例的某些部分所述的方法。
最后应说明的是：以上实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (9)
1.一种路径自动规划装置，其特征在于，包括：
第一获取模块，用于获取操作前所需进行路径规划的目标体内空间环境的三维点云数据；
第二获取模块，用于根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据，获取所需进行路径规划的目标体表可操作区域的点云数据；
筛选模块，用于根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据和所述所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径；
第三获取模块，用于根据所保留的非碰撞路径，获取对所需进行路径规划的目标体内的目标物体进行操作的最优路径；
所述第三获取模块，具体用于
对于所保留的非碰撞路径中的每条线段Lj，其中，j＝1,...,a，a为所保留的非碰撞路径中线段的数量：
获取所述线段Lj的所有截点的距离参数，所述线段Lj的任一截点的距离参数是所述任一截点与所需进行路径规划的目标体内每个碰撞规避物体的最小距离之和，将所述线段Lj的所有截点的距离参数相加，得到所述线段Lj的距离参数LENj；
根据所述线段Lj的距离参数LENj，通过第一公式，计算得到所述线段Lj的最优参数BESTj；
将所保留的非碰撞路径中最优参数最大的线段作为对所需进行路径规划的目标体内的目标物体进行操作的最优路径；
其中，所述第一公式为：
Mj为表示所述线段Lj长度的截点个数。
2.根据权利要求1所述的装置，其特征在于，所述第一获取模块，具体用于
获取所需进行路径规划的目标的操作前CT数据，对所述操作前CT数据进行三维重建，重建出操作前所需进行路径规划的目标体内空间环境三维数据，所述体内空间环境包括：体表皮肤、体内结节和肋骨；
将所述操作前所需进行路径规划的目标体内空间环境三维数据转换为操作前所需进行路径规划的目标体内空间环境的三维点云数据。
3.根据权利要求1所述的装置，其特征在于，所述第二获取模块，具体用于
从所述操作前所需进行路径规划的目标体内空间环境的三维点云数据中，随机选取预设数量个采样点；
对于所选取的每个采样点：以所述采样点为圆心，选取距离所述采样点预设第一距离内的所需进行路径规划的目标体表的点云数据；对所选取的点云数据进行曲面拟合，获得所述采样点处拟合曲面的法向量；将所述采样点与操作前所需进行路径规划的目标体内目标物体表面点云的所有点进行连接，获得一个直线集；计算所述直线集中每条直线与所述采样点处拟合曲面的法向量的夹角；若所述直线集中每条直线与所述采样点处拟合曲面的法向量的夹角中的最大的夹角小于预设角度，则保存所述采样点；
对于每个所保存的采样点：以所述采样点为圆心，获得距离所述采样点预设第二距离内的所需进行路径规划的目标体表的点云数据，去除掉所述距离所述采样点预设第二距离内的所需进行路径规划的目标体表的点云数据中的重合区域，获得所需进行路径规划的目标体表可操作区域的点云数据。
4.根据权利要求1所述的装置，其特征在于，所述筛选模块，具体用于
对操作前所需进行路径规划的目标体内目标物体表面点云数据进行加和平均处理，获得操作前所需进行路径规划的目标体内目标物体表面点云数据的质心；
对于所需进行路径规划的目标体表可操作区域的点云数据中的每个点Ci，其中，i＝1,...,n，n为所需进行路径规划的目标体表可操作区域的点云数据中的点的数量：
将所述点Ci与所述操作前所需进行路径规划的目标体内目标物体表面点云数据的质心连线得到一条直线，通过计算得到通过所述质心并垂直于所述直线的平面，获得操作前所需进行路径规划的目标体内目标物体表面点云数据中位于所述平面上的点；
将操作前所需进行路径规划的目标体内目标物体表面点云数据中位于所述平面上的每个点与所述点Ci进行连线，将得到的线段以预设第三距离进行截点，计算每个截点与所需进行路径规划的目标体内碰撞规避物体的最小距离；
若某一线段的截点与所需进行路径规划的目标体内碰撞规避物体的最小距离小于预设阈值，则将所述线段作为与所需进行路径规划的目标体内碰撞规避物体发生碰撞的路径进行删除；
若某一线段的截点与所需进行路径规划的目标体内碰撞规避物体的最小距离大于等于预设阈值，则将所述线段作为与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径进行保留。
5.一种路径自动规划方法，其特征在于，包括：
获取操作前所需进行路径规划的目标体内空间环境的三维点云数据；
根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据，获取所需进行路径规划的目标体表可操作区域的点云数据；
根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据和所述所需进行路径规划的目标体表可操作区域的点云数据，筛选保留与所需进行路径规划的目标体内碰撞规避物体不发生碰撞的非碰撞路径；
根据所保留的非碰撞路径，获取对所需进行路径规划的目标体内的目标物体进行操作的最优路径；
其中，
对于所保留的非碰撞路径中的每条线段Lj，其中，j＝1,...,a，a为所保留的非碰撞路径中线段的数量：
获取所述线段Lj的所有截点的距离参数，所述线段Lj的任一截点的距离参数是所述任一截点与所需进行路径规划的目标体内每个碰撞规避物体的最小距离之和，将所述线段Lj的所有截点的距离参数相加，得到所述线段Lj的距离参数LENj；
根据所述线段Lj的距离参数LENj，通过第一公式，计算得到所述线段Lj的最优参数BESTj；
将所保留的非碰撞路径中最优参数最大的线段作为对所需进行路径规划的目标体内的目标物体进行操作的最优路径；
其中，所述第一公式为：
Mj为表示所述线段Lj长度的截点个数。
6.根据权利要求5所述的方法，其特征在于，所述获取操作前所需进行路径规划的目标体内空间环境的三维点云数据，包括：
获取所需进行路径规划的目标的操作前CT数据，对所述操作前CT数据进行三维重建，重建出操作前所需进行路径规划的目标体内空间环境三维数据，所述体内空间环境包括：体表皮肤、体内结节和肋骨；
将所述操作前所需进行路径规划的目标体内空间环境三维数据转换为操作前所需进行路径规划的目标体内空间环境的三维点云数据。
7.根据权利要求5所述的方法，其特征在于，所述根据所述操作前所需进行路径规划的目标体内空间环境的三维点云数据，获取所需进行路径规划的目标体表可操作区域的点云数据，包括：
从所述操作前所需进行路径规划的目标体内空间环境的三维点云数据中，随机选取预设数量个采样点；
对于所选取的每个采样点：以所述采样点为圆心，选取距离所述采样点预设第一距离内的所需进行路径规划的目标体表的点云数据；对所选取的点云数据进行曲面拟合，获得所述采样点处拟合曲面的法向量；将所述采样点与操作前所需进行路径规划的目标体内目标物体表面点云的所有点进行连接，获得一个直线集；计算所述直线集中每条直线与所述采样点处拟合曲面的法向量的夹角；若所述直线集中每条直线与所述采样点处拟合曲面的法向量的夹角中的最大的夹角小于预设角度，则保存所述采样点；
对于每个所保存的采样点：以所述采样点为圆心，获得距离所述采样点预设第二距离内的所需进行路径规划的目标体表的点云数据，去除掉所述距离所述采样点预设第二距离内的所需进行路径规划的目标体表的点云数据中的重合区域，获得所需进行路径规划的目标体表可操作区域的点云数据。
8.一种电子设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，其特征在于，所述处理器执行所述计算机程序时实现如权利要求5至7任一项所述方法的步骤。
9.一种非暂态计算机可读存储介质，其上存储有计算机程序，其特征在于，该计算机程序被处理器执行时实现如权利要求5至7任一项所述方法的步骤。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910854469.4A CN110619679B (zh) | 2019-09-10 | 2019-09-10 | 一种路径自动规划装置及方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910854469.4A CN110619679B (zh) | 2019-09-10 | 2019-09-10 | 一种路径自动规划装置及方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110619679A CN110619679A (zh) | 2019-12-27 |
| CN110619679B true CN110619679B (zh) | 2022-05-31 |
Family
ID=68923131
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910854469.4A Active CN110619679B (zh) | 2019-09-10 | 2019-09-10 | 一种路径自动规划装置及方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110619679B (zh) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112842531B (zh) * | 2021-02-10 | 2022-09-30 | 华科精准（北京）医疗科技有限公司 | 一种神经外科手术计划*** |
| CN113876420B (zh) * | 2021-09-08 | 2024-04-26 | 上海微创微航机器人有限公司 | 用于规划手术路径的路径规划方法、***、设备和介质 |
| CN115774452B (zh) * | 2023-02-13 | 2023-05-05 | 南京航空航天大学 | 一种基于形状约束的三维模型表面覆盖路径规划方法 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107126258A (zh) * | 2017-06-29 | 2017-09-05 | 哈尔滨理工大学 | 一种微创手术套管柔性针的路径规划方法 |
| CN108958282A (zh) * | 2018-06-21 | 2018-12-07 | 浙江大学 | 基于动态球形窗口的三维空间路径规划方法 |
| CN109567939A (zh) * | 2018-12-10 | 2019-04-05 | 艾瑞迈迪科技石家庄有限公司 | 一种经皮穿刺最优路径规划方法及装置 |
| CN110083156A (zh) * | 2019-04-25 | 2019-08-02 | 北京航空航天大学 | 基于狼群算法的穿刺机器人柔性针运动路径规划装置及方法 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20140067275A1 (en) * | 2011-03-10 | 2014-03-06 | Junmei Jing | Multidimensional cluster analysis |
-
2019
- 2019-09-10 CN CN201910854469.4A patent/CN110619679B/zh active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107126258A (zh) * | 2017-06-29 | 2017-09-05 | 哈尔滨理工大学 | 一种微创手术套管柔性针的路径规划方法 |
| CN108958282A (zh) * | 2018-06-21 | 2018-12-07 | 浙江大学 | 基于动态球形窗口的三维空间路径规划方法 |
| CN109567939A (zh) * | 2018-12-10 | 2019-04-05 | 艾瑞迈迪科技石家庄有限公司 | 一种经皮穿刺最优路径规划方法及装置 |
| CN110083156A (zh) * | 2019-04-25 | 2019-08-02 | 北京航空航天大学 | 基于狼群算法的穿刺机器人柔性针运动路径规划装置及方法 |
Non-Patent Citations (1)
| Title |
|---|
| 《基于分割的三维医学图像表面重建算法》;何晖光 等;《软件学报》;20020228;第13卷(第2期);正文第219-225页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110619679A (zh) | 2019-12-27 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110619679B (zh) | 一种路径自动规划装置及方法 | |
| KR102016959B1 (ko) | 혈관 모델 생성 방법 및 장치 | |
| JP6695954B2 (ja) | 形状の予測 | |
| CN112861961B (zh) | 肺血管分类方法及装置、存储介质及电子设备 | |
| CN109859833A (zh) | 消融手术治疗效果的评估方法和装置 | |
| CN111383259B (zh) | 图像分析方法、计算机设备和存储介质 | |
| CN109859213A (zh) | 关节置换手术中骨骼关键点检测方法及装置 | |
| CN108027966B (zh) | 使用cfd仿真来减少4d dsa重构伪像的***和方法 | |
| CN113112499B (zh) | 肝脏内部组织的位移预测方法、装置、***及电子设备 | |
| EP3798980A1 (en) | Technologies for determining the accuracy of three-dimensional models for use in an orthopaedic surgical procedure | |
| CN111178420A (zh) | 一种二维造影图像上冠脉段标注方法及*** | |
| CN113888566B (zh) | 目标轮廓曲线确定方法、装置、电子设备以及存储介质 | |
| CN113344926B (zh) | 胆胰超声图像识别方法、装置、服务器及存储介质 | |
| CN110494188B (zh) | 确定至少一幅最终二维图像的设备和方法 | |
| US10453184B2 (en) | Image processing apparatus and X-ray diagnosis apparatus | |
| CN107392976A (zh) | 数据处理方法、装置及设备 | |
| CN111388880B (zh) | 一种弧形放射治疗校验方法、装置、设备及存储介质 | |
| WO2019030348A1 (en) | METHOD AND SYSTEM FOR X-RAY IMAGE PROCESSING, AND COMPUTER STORAGE MEDIUM | |
| US10176576B2 (en) | Medical image processing apparatus, medical image processing method, and computer-readable medium | |
| CN115482231B (zh) | 图像分割方法、装置、存储介质和电子设备 | |
| US20140032180A1 (en) | Method and apparatus for computing deformation of an object | |
| CN112465902B (zh) | 骨科手术用光学跟踪标记球位置确定方法和装置 | |
| US20210321969A1 (en) | Providing a dynamic mask image | |
| CN114022538A (zh) | 一种内窥镜的路径规划方法、装置、终端及存储介质 | |
| US20200234494A1 (en) | Structure estimating apparatus, structure estimating method, and computer program product |
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 | ||
| TR01 | Transfer of patent right | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20230111 Address after: Room 105-75274, No. 6, Baohua Road, Hengqin New District, Zhuhai City, Guangdong Province, 519000 (centralized office area) Patentee after: True Health (Zhuhai) Medical Technology Co.,Ltd. Address before: Room 601, 6th floor, No. 27, Zhichun Road, Haidian District, Beijing 100191 Patentee before: ZHENJIANKANG (BEIJING) MEDICAL TECHNOLOGY Co.,Ltd. |
|
| TR01 | Transfer of patent right | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20230919 Address after: Room 806, Research Headquarters Building, Guangdong Macao Cooperative Traditional Chinese Medicine Technology Industrial Park, No. 1 Doukou Road, Hengqin New District, Zhuhai City, Guangdong Province, 519000 Patentee after: True Health (Guangdong Hengqin) Medical Technology Co.,Ltd. Address before: Room 105-75274, No. 6, Baohua Road, Hengqin New District, Zhuhai City, Guangdong Province, 519000 (centralized office area) Patentee before: True Health (Zhuhai) Medical Technology Co.,Ltd. |