CN111238366B - 一种三维扫描路径规划方法及装置 - Google Patents
一种三维扫描路径规划方法及装置 Download PDFInfo
- Publication number
- CN111238366B CN111238366B CN202010022806.6A CN202010022806A CN111238366B CN 111238366 B CN111238366 B CN 111238366B CN 202010022806 A CN202010022806 A CN 202010022806A CN 111238366 B CN111238366 B CN 111238366B
- Authority
- CN
- China
- Prior art keywords
- scanning
- ith
- scanned
- scanner
- area
- 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
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/002—Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/24—Measuring arrangements characterised by the use of optical techniques for measuring contours or curvatures
Abstract
本发明涉及一种三维扫描路径规划方法及装置,属于三维扫描技术领域。本发明基于待扫描区域集合计算扫描仪第i次扫描位置;根据扫描仪第i次扫描位置确定第i次最优有效坐标集合;基于第i次最优有效坐标集合,计算第i+1次扫描区域集合,当第i+1次扫描区域集合中的坐标点的数量大于或者等于预设值则重复之前的步骤;经过多次循环步骤,最终可确定多个扫描位置,使已扫描区域集合不断生长,与待扫描区域集合达到约定的重合度,对最终的扫描仪第1次扫描位置到扫描仪第N次扫描位置进行排序,并将各个扫描位置转换为对应的机器人姿态,得到最优三维扫描路径,从而实现了机器人高效率、高精度和自动化扫描。
Description
技术领域
本发明涉及三维扫描技术领域,具体涉及一种三维扫描路径规划方法及装置。
背景技术
机器人自动化三维扫描是利用机器人搭配三维扫描仪对被测物表面数据进行非接触测量的技术,为满足不同被测工件的尺寸形状与测量需求,往往需要机器人采用不同的拍摄路径。传统的拍摄路径规划工作通常由示教工程师依赖个人经验完成,当工程师收到被测件与用户的测量需求时,通过手动控制机器人运动到某一预估扫描位置,然后进行实际扫描,根据扫描结果来判断当前位置是否满足测量需求,如不满足则需要调整位置后重新扫描,如满足则记录下当前位置作为扫描路径点,如此反复迭代,直至满足用户全部测量需求时为止。
随着机器人自动化三维扫描技术的推广,单纯依赖工程师个人经验逐步示教三维扫描路径的工作模式已经不能满足快速增长的用户测量需求。首先,工程师的个人经验限制了其处理不同类型工件的能力,不同工程师之间的经验差异也会导致示教路径的差异,进而影响到测量效率甚至测量精度;其次,对于被测工件数量庞大或测量需求更新频率较高的用户,人工示教反复迭代过程中消耗的大量时间成本也是难以接受的;最后,对于提供三维检测服务的供应商而言,要通过人工示教的方式满足用户日益增长的测量需求,势必要维持一个较大规模的,由经验丰富的工程师组成的团队,这也意味着经营成本的增加。
发明内容
本发明提供了一种三维扫描路径规划方法及装置,以解决上述背景技术中存在的至少一个问题。
为了实现上述目的,第一方面,本发明实施例提供了一种三维扫描路径规划方法,包括:
基于待扫描标准件模型,得到待扫描区域集合,待扫描区域集合等于已扫描区域集合和未扫描区域集合之和;
针对待扫描区域集合,执行如下步骤:
获取扫描仪第i次扫描位置,其中i为1到N的正整数;
基于扫描仪第i次扫描位置,统计第i次有效坐标集合;
对第i次有效坐标集合进行迭代,得到第i次最优有效坐标集合,更新扫描仪第i次扫描位置,并将第i次最优有效坐标集合添加至已扫描区域集合;
基于第i次最优有效坐标集合,以及未扫描区域集合,得到第i+1次扫描区域集合;
若第i+1次扫描区域集合中的坐标点的数量大于或者等于预设值,则重复上述步骤,直到已扫描区域集合与待扫描区域集合达到约定的重合度;
对更新后的扫描仪第1次扫描位置到更新后的扫描仪第N次扫描位置进行排序,并将各个扫描仪扫描位置转换为对应的机器人姿态,得到机器人最优三维扫描路径。
第二方面,本发明实施例提供了一种三维扫描路径规划装置,包括:
坐标转换单元,用于基于待扫描标准件模型,得到待扫描区域集合,待扫描区域集合等于已扫描区域集合和未扫描区域集合之和;
针对待扫描区域集合,执行如下步骤:
第一计算单元,用于获取扫描仪第i次扫描位置,其中i为1到N的正整数;
优化单元,用于基于扫描仪第i次扫描位置,统计第i次有效坐标集合;
对第i次有效坐标集合进行迭代,得到第i次最优有效坐标集合,更新扫描仪第i次扫描位置,并将第i次最优有效坐标集合添加至已扫描区域集合;
第二计算单元,用于基于第i次最优有效坐标集合,以及未扫描区域集合,得到第i+1次扫描区域集合;
判断单元,用于若第i+1次扫描区域集合中的坐标点的数量大于或者等于预设值,则重复上述步骤,直到已扫描区域集合与待扫描区域集合达到约定的重合度;
路径规划单元,用于对更新后的扫描仪第1次扫描位置到更新后的扫描仪第N次扫描位置进行排序,并将各个扫描仪扫描位置转换为对应的机器人姿态,得到机器人最优三维扫描路径。
由上述技术内容,可以看出本发明具有以下有益效果:
基于待扫描区域集合计算扫描仪第i次扫描位置,根据扫描仪第i次扫描位置确定第i次有效坐标集合,然后对第i次有效坐标集合进行迭代得到第i次最优有效坐标集合以及更新后的第i次扫描位置,使每次扫描可以获取最多的点,每次获取的数据更准确,有效地减少了扫描的次数。基于第i次最优有效坐标集合,计算第i+1次扫描区域集合,当第i+1次扫描区域集合中的坐标点的数量大于或者等于预设值则重复之前的步骤,从而判断是否继续进行扫描。经过多次循环步骤,最终可确定多个扫描仪的扫描位置,使已扫描区域集合不断生长,最终等于待扫描区域集合,对更新后的扫描仪第1次扫描位置到更新后的扫描仪第N次扫描位置进行排序,得到最优三维扫描路径,转化为对应的机器人扫描路径后,实现了机器人高效率、高精度和自动化扫描。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的一种三维扫描路径规划方法流程示意图;
图2为本发明实施例提供的一种计算扫描仪第i次扫描位置的方法流程示意图;
图3为本发明实施例提供的待扫描区域集合的空间包围盒示意图;
图4为本发明实施例提供的再一种计算扫描仪第i次扫描位置的方法流程示意图;
图5为本发明实施例提供的计算第i次最优有效坐标集合的方法流程示意图;
图6为本发明实施例提供的计算第i+1次扫描区域集合的方法流程示意图;
图7为本发明实施例提供的第i次最优有效坐标集合的空间包围盒示意图;
图8为本发明实施例提供了一种三维扫描路径规划装置结构示意图。
具体实施方式
为了能够更清楚地理解本发明的上述目的、特征和优点,下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,所描述的实施例是本发明的一部分实施例,而不是全部的实施例。此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。基于所描述的本发明的实施例,本领域普通技术人员所获得的所有其他实施例,都属于本发明保护的范围。
需要说明的是,在本文中,诸如“第一”和“第二”等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。
第一方面,如图1所示,本发明实施例提供了一种三维扫描路径规划方法,包括:
S101、基于待扫描标准件模型,得到待扫描区域集合,待扫描区域集合等于已扫描区域集合和未扫描区域集合之和;
针对待扫描区域集合,执行如下步骤:
S102、获取扫描仪第i次扫描位置,其中i为1到N的正整数;
S103、基于扫描仪第i次扫描位置,统计第i次有效坐标集合;
S104、对第i次有效坐标集合进行迭代,得到第i次最优有效坐标集合,更新扫描仪第i次扫描位置,并将第i次最优有效坐标集合添加至已扫描区域集合;
S105、基于第i次最优有效坐标集合,以及未扫描区域集合,得到第i+1次扫描区域集合;
S106、若第i+1次扫描区域集合中的坐标点的数量大于或者等于预设值,则重复上述步骤,直到已扫描区域集合与待扫描区域集合达到约定的重合度;
S107、对更新后的扫描仪第1次扫描位置到更新后的扫描仪第N次扫描位置进行排序,并将各个扫描仪扫描位置转换为对应的机器人姿态,得到机器人最优三维扫描路径。
具体地,待扫描标准件模型代表了待扫描物体的标准设计状态,包含了待扫描物体的尺寸、特征和空间坐标等参数。本发明实施例通过计算机模拟仿真技术,可根据导入计算机的待扫描标准件模型和用户的测量需求,得到待扫描区域集合M,集合M中的每个点的坐标表示待扫描标准件模型上相应部位的空间位置。待扫描区域集合M包含已扫描区域集合A和未扫描区域集合B,并且M=A+B。当还未开始对待扫描标准件模型进行扫描时,已扫描区域集合A没有任何点,为空集。
基于待扫描区域集合M,可得到扫描仪第i次扫描位置,扫描位置指每次扫描过程中扫描仪在待扫描标准件模型坐标系下的绝对位置。然后基于扫描仪第i次扫描位置统计第i次有效坐标集合Si={(Xi,j,Yi,j,Zi,j)i,j∈(1,2,3,…,n)},其中Xi,j、Yi,j、Zi,j为第i次有效坐标集合Si中点的三维坐标。有效坐标集合中的点表示每次扫描过程中,扫描仪可扫描到的最大区域中的点的坐标集合。
为了使扫描仪在一次扫描中可以获取到更多的有效坐标点,以减少扫描的次数,需要对每次扫描得到的有效坐标集合进行迭代,调整扫描仪的扫描姿态,从而得到第i次最优有效坐标集合S'i={(X'i,j,Y'i,j,Z'i,j)i,j∈(1,2,3,…,n)},其中X'i,j、Y'i,j、Z'i,j为第i次最优有效坐标集合S'i中点的三维坐标,并可得到更新后扫描仪第i次扫描位置(即扫描仪第i次最终扫描姿态的位置)。最优有效坐标集合表示扫描仪在一次扫描中可以获取到的最多的点的集合,然后将第i次最优有效坐标集合S'i添加到已扫描区域集合A中。
在进行第i+1次扫描时,需要以第i次最优有效坐标集合S'i和未扫描区域集合B为基础,得到第i+1次扫描区域集合Ci+1。为了判断是否继续进行扫描,需要判断第i+1次扫描区域集合Ci+1中点的数量是否大于或者等于预设值,如果大于或者等于预设值,则获取第i+1次扫描位置,重复之前的步骤,即采用区域生长(Region seeds growing,RSG)算法在前一次最优有效坐标集合的基础上查找下一个有扫描需求的区域,使已扫描区域集合A不断生长,并不断更新下一次的扫描位置,直到已扫描区域集合A与待扫描区域集合M达到约定的重合度,整个扫描任务结束。
具体地,已扫描区域集合中与待扫描区域集合约定的重合度以实际扫描的工件而定;示例性地,对于较平面的工件,重合度可以为100%,对于特征较多的工件,重合度可以为80%;对于特征极其复杂的工件,重合度可以为60%~70%;对于只需扫描局部的工件,重合度也可以为20%~30%。
然后将更新后的扫描仪第1次扫描位置到更新后的扫描仪第N次扫描位置进行梳理排序,梳理扫描位置的方法可以是调整扫描位置的先后顺序,将较为接近的扫描位置调整到一起,尽量避免重复路径;再将各个扫描仪的扫描位置转换为对应的机器人姿态,然后按照调整后的顺序确定机器人的运动路径,从而得到一组合理高效的机器人运动路径。
机器人按照得到的最优三维扫描路径进行自动化扫描,从而可以将示教工程师从繁复的机器人姿态调整工作中解脱出来,既降低了部署扫描仪时对工程师经验技术的要求,提高了现场扫描工作的效率,又能够对各种形状的待扫描物体进行自动化扫描,并可以满足各种测量需求。
进一步地,基于待扫描标准件模型,得到待扫描区域集合具体包括:
基于待扫描标准件模型,将待扫描标准件模型由数模坐标系转换至机器人坐标系下,得到待扫描区域集合。
具体地,在使用机器人对待扫描物体进行扫描时,需要根据数模坐标系与机器人坐标系的对应关系,将待扫描标准件模型由数模坐标系转换到机器人坐标系下。具体的坐标转换方法可参照现有技术,本发明实施例不再赘述。将扫描仪扫描位置与机器人姿态之间进行转换也是本领域的公知常识,在此就不一一赘述。
进一步地,如图2所示,当i=1时,获取扫描仪第i次扫描位置具体包括:
S201、采用包围盒算法计算待扫描区域集合的空间包围盒;
S202、将空间包围盒较大面的法向作为扫描方向,并将待扫描区域集合中距离待扫描区域集合的质心最近的点作为待扫描区域的中心点;
S203、基于待扫描区域的中心点,沿扫描方向的反向移动标准工作距离,得到扫描仪第1次扫描位置。
具体地,在本发明实施例中,计算扫描仪第1次扫描位置时,首先采用包围盒算法计算出待扫描区域集合M的空间包围盒。空间包围盒一般包含多个较大面,例如图3所示的空间包围盒,为前、后、上、下面相同的长方体,其包含四个较大面。由于这四个较大面相同,并且前、后面对称,上、下面对称,因此在确定待扫描区域的扫描方向时,只需要将任意一个较大面的法向作为扫描方向即可。此外,将待扫描区域集合M中距离待扫描区域集合M的质心最近的点作为待扫描区域的中心点。
然后通过对扫描仪进行标定,可获取扫描仪的标准工作距离和扫描范围。标定后的标准工作距离为定值,在后续的扫描过程中不再改变。扫描仪扫描时,单次扫描区域为矩形。
最后,以待扫描区域的中心点为起始点,沿扫描方向的反向移动标准工作距离,即可得到扫描仪第1次扫描位置。
需要说明的是,包围盒算法可采用AABB包围盒(Axis-aligned bounding box,轴对齐包围盒)或者方向包围盒OBB(Oriented bounding box)中的任一种,本发明实施例不做具体限制。
进一步地,如图4所示,当i≥2时,获取扫描仪第i次扫描位置具体包括:
S401、将第i次扫描区域集合的质心作为第i次扫描区域的中心点,并将第i次扫描区域集合中所有点的平均法向作为第i次扫描区域的扫描方向;
S402、基于第i次扫描区域的中心点,沿扫描方向反向移动标准工作距离,得到扫描仪第i次扫描位置。
具体地,在本发明实施例中,与计算扫描仪第1次扫描位置相同的是,在计算扫描仪第2次扫描位置到扫描仪第N次扫描位置时,扫描仪的标准工作距离不变。
与计算扫描仪第1次扫描位置不同的是,在计算扫描仪第2次扫描位置到扫描仪第N次扫描位置时,需要将第i次扫描区域集合Ci的质心作为第i次扫描区域的中心点,并将第i次扫描区域集合Ci中所有点的平均法向作为第i次扫描区域的扫描方向。
最后,以第i次扫描区域的中心点为起始点,沿扫描方向的反向标准工作距离,即可得到扫描仪第i次扫描位置。
进一步地,如图5所示,对第i次有效坐标集合进行迭代,得到第i次最优有效坐标集合,更新扫描仪第i次扫描位置,具体包括:
S501、对第i次有效坐标集合进行主成分分析,得到第i次有效坐标集合的最大特征值所对应的第一特征向量;
S502、若第i次扫描区域的长轴与第一特征向量的夹角大于或者等于第一预设角度,则旋转扫描仪的扫描姿态使第i次扫描区域的长轴与第一特征向量重合;
S503、根据扫描仪旋转后的扫描姿态重新统计第i次有效坐标集合与对应的第一特征向量;
S504、重复上述步骤,直至第i次扫描区域的长轴与对应的有效坐标集合的特征向量的夹角小于第一预设角度,将此时扫描仪的扫描位置作为更新后的扫描仪第i次扫描位置,并将最后一次重新统计的第i次有效坐标集合作为第i次最优有效坐标集合。
具体地,在本发明实施例中,采用主成分分析(Principal component analysis,PCA)算法对有效坐标集合进行迭代。首先,对第i次有效坐标集合Si进行主成分分析,得到第i次有效坐标集合Si的最大特征值λi所对应的特征向量ζi,特征向量ζi表示第i次有效坐标集合Si的空间分布趋势。
为了减少扫描的次数,当第i次扫描区域的长轴li与特征向量ζi的夹角大于或者等于第一预设角度α时,则需要旋转扫描仪的扫描姿态,使第i次扫描区域的长轴li与特征向量ζi重合。第一预设角度α可根据实际的扫描任务进行设定,例如可以设置为45°,本发明实施例不做具体限制。
每旋转一次扫描仪的扫描姿态,则重新统计一次第i次有效坐标集合Si。然后基于变动后的第i次扫描位置,对重新统计后的第i次有效坐标集合Si继续进行主成分分析,重复之前的步骤,直至第i次扫描区域的长轴li与对应的有效坐标集合的特征向量的夹角小于第一预设角度α,将最后一次重新统计的第i次有效坐标集合Si作为第i次最优有效坐标集合Si',将最后一次的扫描位置作为更新后的第i次扫描位置。经过多次旋转扫描仪的扫描姿态后,可以使单次扫描获取的点最多,从而减少扫描次数。
具体地,当第i次扫描区域的长轴li与特征向量ζi的夹角小于第一预设角度α时,则无需旋转扫描仪的扫描姿态,第i次有效坐标集合即为第i次最优有效坐标集合,可直接将第i次有效坐标集合Si添加到集合A中。其中,扫描仪第i次扫描位置与更新后的扫描仪第i次扫描位置相同。
进一步地,如图6所示,基于第i次最优有效坐标集合,以及未扫描区域集合,得到第i+1次扫描区域集合具体包括:
S601、采用包围盒算法计算第i次最优有效坐标集合的空间包围盒;
S602、将空间包围盒较大面的长轴和短轴作为搜索方向,并将第i次最优有效坐标集合的质心作为第i+1次扫描区域的中心点;
S603、沿搜索方向搜索未扫描区域集合中与第i次最优有效坐标集合的欧氏距离小于设定阈值,且与第i+1次扫描区域的中心点的连线和搜索方向的夹角小于第二预设角度的点,得到第i+1次扫描区域集合。
具体地,在本发明实施例中,采用包围盒算法计算第i次最优有效坐标集合Si'的空间包围盒。空间包围盒一般包含多个较大面,例如图7所示的空间包围盒,为前、后、上、下面相同的长方体,其包含四个较大面。在计算第i+1次扫描区域集合Ci+1时,将每个较大面的长轴和短轴作为搜索方向,并将第i次最优有效坐标集合Si'的质心作为第i+1次扫描区域的中心点,在降低了算法复杂性的同时还可以很好地适用于对各种形状待扫描物体的扫描需求。需要说明的是,包围盒算法可采用AABB包围盒(Axis-aligned bounding box,轴对齐包围盒)或者方向包围盒OBB(Oriented bounding box)中的任一种,本发明实施例不做具体限制。
然后以第i+1次扫描区域的中心点为起点,沿搜索方向搜索未扫描区域集合B中与第i次最优有效坐标集合S'i的欧氏距离小于设定阈值,且与第i+1次扫描区域的中心点的连线和搜索方向的夹角小于第二预设角度β的点,得到第i+1次扫描区域集合Ci+1。其中,设定阈值的大小根据扫描仪的扫描幅面进行设定,第二预设角度β的大小可根据实际扫描需求进行设定,例如在本发明实施例中可设定为60°,本发明实施例不做具体限制。
进一步地,第i次最优有效坐标集合的空间包围盒包括至少1个较大面,第i+1次扫描区域集合包括至少1个子集,其中,至少1个较大面与至少1个子集一一对应。
具体地,由第i次最优有效坐标集合得到的空间包围盒至少含有一个较大面。相应地,由每个较大面可以确定一个第i+1次扫描区域集合的子集。
进一步地,若第i+1次扫描区域集合中的坐标点的数量大于或者等于预设值则重复上述步骤,直到已扫描区域集合与待扫描区域集合达到约定的重合度,具体包括:
若第i+1次扫描区域集合的特定子集中的坐标点的数量大于或者等于预设值,则重复上述步骤,直到已扫描区域集合与待扫描区域集合达到约定的重合度。
具体地,为判断是否继续进行扫描,需要判断第i+1次扫描区域集合Ci+1每个子集中的坐标点的数量是否大于或者等于预设值,满足条件的子集则重复之前的步骤,直到已扫描区域集合A与待扫描区域集合M达到约定的重合度。满足条件的子集均可以确定一个扫描位置,也就是说在一次扫描中,第i次最优有效坐标集合的空间包围盒的每个较大面均有可能确定一个扫描位置。
进一步地,若第i+1次扫描区域集合的特定子集中的坐标点的数量小于预设值,则结束对特定子集表示区域的扫描,并判断第i+1次扫描区域集合中其它子集中的坐标点的数量是否大于或者等于预设值。
具体地,若第i+1次扫描区域集合Ci+1中某个子集中的坐标点的数量小于预设值,则放弃对这一子集表示区域的扫描,然后判断其它子集中的坐标点的数量是否大于或者等于预设值。
第二方面,如图8所示,本发明实施例提供了一种三维扫描路径规划装置,包括:
坐标转换单元100,用于基于待扫描标准件模型,得到待扫描区域集合,待扫描区域集合等于已扫描区域集合和未扫描区域集合之和;
针对待扫描区域集合:
第一计算单元200,用于获取扫描仪第i次扫描位置,其中i为1到N的正整数;
优化单元300,用于基于扫描仪第i次扫描位置,统计第i次有效坐标集合;
对第i次有效坐标集合进行迭代,得到第i次最优有效坐标集合,更新扫描仪第i次扫描位置,并将第i次最优有效坐标集合添加至已扫描区域集合;
第二计算单元400,用于基于第i次最优有效坐标集合,以及未扫描区域集合,得到第i+1次扫描区域集合;
判断单元500,用于若第i+1次扫描区域集合中的坐标点的数量大于或者等于预设值,则重复上述步骤,直到已扫描区域集合与待扫描区域集合达到约定的重合度;
路径规划单元600,用于对更新后的扫描仪第1次扫描位置到更新后的扫描仪第N次扫描位置进行排序,并将各个扫描仪扫描位置转换为对应的机器人姿态,得到机器人最优三维扫描路径。
进一步地,基于待扫描标准件模型,得到待扫描区域集合具体包括:
基于待扫描标准件模型,将待扫描标准件模型由数模坐标系转换至机器人坐标系下,得到待扫描区域集合。
进一步地,当i=1时,获取扫描仪第i次扫描位置具体包括:
采用包围盒算法计算待扫描区域集合的空间包围盒;
将空间包围盒较大面的法向作为扫描方向,并将待扫描区域集合中距离待扫描区域集合的质心最近的点作为待扫描区域的中心点;
基于待扫描区域的中心点,沿扫描方向的反向移动标准工作距离,得到扫描仪第1次扫描位置。
进一步地,当i≥2时,获取扫描仪第i次扫描位置具体包括:
将第i次扫描区域集合的质心作为第i次扫描区域的中心点,并将第i次扫描区域集合中所有点的平均法向作为第i次扫描区域的扫描方向;
基于第i次扫描区域的中心点,沿扫描方向反向移动标准工作距离,得到扫描仪第i次扫描位置。
进一步地,对第i次有效坐标集合进行迭代,得到第i次最优有效坐标集合,更新扫描仪第i次扫描位置,具体包括:
对第i次有效坐标集合进行主成分分析,得到第i次有效坐标集合的最大特征值所对应的第一特征向量;
若第i次扫描区域的长轴与第一特征向量的夹角大于或者等于第一预设角度,则旋转扫描仪的扫描姿态使第i次扫描区域的长轴与第一特征向量重合;
根据扫描仪旋转后的扫描姿态重新统计第i次有效坐标集合与对应的第一特征向量;
重复上述步骤,直至第i次扫描区域的长轴与对应的有效坐标集合的特征向量的夹角小于第一预设角度,将此时扫描仪的扫描位置作为更新后的扫描仪第i次扫描位置,并将最后一次重新统计的第i次有效坐标集合作为第i次最优有效坐标集合。
进一步地,若第i次扫描区域的长轴与第一特征向量的夹角小于第一预设角度,则无需旋转扫描仪的扫描姿态,并将第i次有效坐标集合作为第i次最优有效坐标集合;其中,更新后的扫描仪第i次扫描位置与扫描仪第i次扫描位置相同。
进一步地,基于第i次最优有效坐标集合,以及未扫描区域集合,得到第i+1次扫描区域集合具体包括:
采用包围盒算法计算第i次最优有效坐标集合的空间包围盒;
将空间包围盒较大面的长轴和短轴作为搜索方向,并将第i次最优有效坐标集合的质心作为第i+1次扫描区域的中心点;
沿搜索方向搜索未扫描区域集合中与第i次最优有效坐标集合的欧氏距离小于设定阈值,且与第i+1次扫描区域的中心点的连线和搜索方向的夹角小于第二预设角度的点,得到第i+1次扫描区域集合。
进一步地,第i次最优有效坐标集合的空间包围盒包括至少1个较大面,第i+1次扫描区域集合包括至少1个子集,其中,至少1个较大面与至少1个子集一一对应。
进一步地,若第i+1次扫描区域集合中的坐标点的数量大于或者等于预设值则重复上述步骤,直到已扫描区域集合与待扫描区域集合达到约定的重合度,具体包括:
若第i+1次扫描区域集合的特定子集中的坐标点的数量大于或者等于预设值,则重复上述步骤,直到已扫描区域集合与待扫描区域集合达到约定的重合度。
进一步地,若第i+1次扫描区域集合的特定子集中的坐标点的数量小于预设值,则结束对特定子集表示区域的扫描,并判断第i+1次扫描区域集合中其它子集中的坐标点的数量是否大于或者等于预设值。
上述三维扫描路径规划装置,可以用于执行图1到图7所示方法实施例的技术方案,其实现原理和技术效果类似,此处不再赘述。
需要说明的是,在本文中,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者装置不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者装置所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括该要素的过程、方法、物品或者装置中还存在另外的相同要素。
本领域的技术人员能够理解,尽管在此所述的一些实施例包括其它实施例中所包括的某些特征而不是其它特征,但是不同实施例的特征的组合意味着处于本发明的范围之内并且形成不同的实施例。
本领域的技术人员能够理解,对各个实施例的描述都各有侧重,某个实施例中没有详述的部分,可以参见其他实施例的相关描述。
虽然结合附图描述了本发明的实施方式,但是本领域技术人员可以在不脱离本发明的精神和范围的情况下做出各种修改和变型,这样的修改和变型均落入由所附权利要求所限定的范围之内。
Claims (10)
1.一种三维扫描路径规划方法,其特征在于,包括:
基于待扫描标准件模型,得到待扫描区域集合,所述待扫描区域集合等于已扫描区域集合和未扫描区域集合之和;
针对所述待扫描区域集合,执行如下步骤:
获取扫描仪第i次扫描位置,其中i为1到N的正整数;
基于所述扫描仪第i次扫描位置,统计第i次有效坐标集合;
对所述第i次有效坐标集合进行迭代,得到第i次最优有效坐标集合,更新扫描仪第i次扫描位置,并将所述第i次最优有效坐标集合添加至所述已扫描区域集合;
基于所述第i次最优有效坐标集合,以及所述未扫描区域集合,得到第i+1次扫描区域集合;
若所述第i+1次扫描区域集合中的坐标点的数量大于或者等于预设值,则重复上述步骤,直到所述已扫描区域集合与所述待扫描区域集合达到约定的重合度;
对更新后的扫描仪第1次扫描位置到更新后的扫描仪第N次扫描位置进行排序,并将各个扫描仪扫描位置转换为对应的机器人姿态,得到机器人最优三维扫描路径。
2.如权利要求1所述的方法,其特征在于,当i=1时,所述获取扫描仪第i次扫描位置具体包括:
采用包围盒算法计算所述待扫描区域集合的空间包围盒;
将所述空间包围盒较大面的法向作为扫描方向,并将所述待扫描区域集合中距离所述待扫描区域集合的质心最近的点作为待扫描区域的中心点;
基于所述待扫描区域的中心点,沿所述扫描方向的反向移动标准工作距离,得到扫描仪第1次扫描位置。
3.如权利要求1所述的方法,其特征在于,当i≥2时,所述获取扫描仪第i次扫描位置具体包括:
将第i次扫描区域集合的质心作为第i次扫描区域的中心点,并将所述第i次扫描区域集合中所有点的平均法向作为所述第i次扫描区域的扫描方向;
基于所述第i次扫描区域的中心点,沿所述扫描方向反向移动标准工作距离,得到扫描仪第i次扫描位置。
4.如权利要求1所述的方法,其特征在于,所述对所述第i次有效坐标集合进行迭代,得到第i次最优有效坐标集合,更新扫描仪第i次扫描位置,具体包括:
对所述第i次有效坐标集合进行主成分分析,得到所述第i次有效坐标集合的最大特征值所对应的第一特征向量;
若第i次扫描区域的长轴与第一特征向量的夹角大于或者等于第一预设角度,则旋转扫描仪的扫描姿态使第i次扫描区域的长轴与第一特征向量重合;
根据扫描仪旋转后的扫描姿态重新统计第i次有效坐标集合与对应的第一特征向量;
重复上述步骤,直至所述第i次扫描区域的长轴与对应的有效坐标集合的特征向量的夹角小于第一预设角度,将此时扫描仪的扫描位置作为更新后的扫描仪第i次扫描位置,并将最后一次重新统计的第i次有效坐标集合作为第i次最优有效坐标集合。
5.如权利要求4所述的方法,其特征在于,若第i次扫描区域的长轴与第一特征向量的夹角小于第一预设角度,则无需旋转扫描仪的扫描姿态,并将第i次有效坐标集合作为第i次最优有效坐标集合;其中,更新后的扫描仪第i次扫描位置与扫描仪第i次扫描位置相同。
6.如权利要求1所述的方法,其特征在于,所述基于所述第i次最优有效坐标集合,以及所述未扫描区域集合,得到第i+1次扫描区域集合具体包括:
采用包围盒算法计算所述第i次最优有效坐标集合的空间包围盒;
将所述空间包围盒较大面的长轴和短轴作为搜索方向,并将所述第i次最优有效坐标集合的质心作为第i+1次扫描区域的中心点;
沿所述搜索方向搜索所述未扫描区域集合中与所述第i次最优有效坐标集合的欧氏距离小于设定阈值,且与所述第i+1次扫描区域的中心点的连线和所述搜索方向的夹角小于第二预设角度的点,得到第i+1次扫描区域集合。
7.如权利要求6所述的方法,其特征在于,所述第i次最优有效坐标集合的空间包围盒包括至少1个较大面,所述第i+1次扫描区域集合包括至少1个子集,其中,所述至少1个较大面与所述至少1个子集一一对应。
8.如权利要求7所述的方法,其特征在于,所述若所述第i+1次扫描区域集合中的坐标点的数量大于或者等于预设值则重复上述步骤,直到所述已扫描区域集合与所述待扫描区域集合达到约定的重合度,具体包括:
若所述第i+1次扫描区域集合的特定子集中的坐标点的数量大于或者等于预设值,则重复上述步骤,直到所述已扫描区域集合与所述待扫描区域集合达到约定的重合度。
9.如权利要求8所述的方法,其特征在于,
若所述第i+1次扫描区域集合的特定子集中的坐标点的数量小于预设值,则结束对所述特定子集表示区域的扫描,并判断所述第i+1次扫描区域集合中其它子集中的坐标点的数量是否大于或者等于预设值。
10.一种三维扫描路径规划装置,其特征在于,包括:
坐标转换单元,用于基于待扫描标准件模型,得到待扫描区域集合,所述待扫描区域集合等于已扫描区域集合和未扫描区域集合之和;
针对所述待扫描区域集合:
第一计算单元,用于获取扫描仪第i次扫描位置,其中i为1到N的正整数;
优化单元,用于基于所述扫描仪第i次扫描位置,统计第i次有效坐标集合;
对所述第i次有效坐标集合进行迭代,得到第i次最优有效坐标集合,更新扫描仪第i次扫描位置,并将所述第i次最优有效坐标集合添加至所述已扫描区域集合;
第二计算单元,用于基于所述第i次最优有效坐标集合,以及所述未扫描区域集合,得到第i+1次扫描区域集合;
判断单元,用于若所述第i+1次扫描区域集合中的坐标点的数量大于或者等于预设值,则重复上述步骤,直到所述已扫描区域集合与所述待扫描区域集合达到约定的重合度;
路径规划单元,用于对更新后的扫描仪第1次扫描位置到更新后的扫描仪第N次扫描位置进行排序,并将各个扫描仪扫描位置转换为对应的机器人姿态,得到机器人最优三维扫描路径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010022806.6A CN111238366B (zh) | 2020-01-09 | 2020-01-09 | 一种三维扫描路径规划方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010022806.6A CN111238366B (zh) | 2020-01-09 | 2020-01-09 | 一种三维扫描路径规划方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111238366A CN111238366A (zh) | 2020-06-05 |
CN111238366B true CN111238366B (zh) | 2021-10-22 |
Family
ID=70872382
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010022806.6A Active CN111238366B (zh) | 2020-01-09 | 2020-01-09 | 一种三维扫描路径规划方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111238366B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112923889B (zh) * | 2021-01-26 | 2023-03-14 | 杭州思锐迪科技有限公司 | 扫描方法、装置、三维扫描系统、电子装置和存储介质 |
CN113432572B (zh) * | 2021-06-04 | 2022-04-12 | 南京淳铁建设有限公司 | 一种基于三维扫描的复杂结构最优测点规划方法 |
CN114113163B (zh) * | 2021-12-01 | 2023-12-08 | 北京航星机器制造有限公司 | 一种基于智能机器人的自动化数字射线检测装置和方法 |
CN114791270B (zh) * | 2022-06-23 | 2022-10-25 | 成都飞机工业(集团)有限责任公司 | 一种基于pca的飞机表面关键形貌特征包络测量场构建方法 |
CN117499547A (zh) * | 2023-12-29 | 2024-02-02 | 先临三维科技股份有限公司 | 自动化三维扫描方法、装置、设备及存储介质 |
Family Cites Families (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TW201124227A (en) * | 2010-01-12 | 2011-07-16 | Univ Nat Formosa | Scrape method of automated scraping workpiece surface. |
WO2015053711A1 (en) * | 2013-10-08 | 2015-04-16 | Nanyang Technological University | Method and system for intelligent crane lifting |
CN103759635B (zh) * | 2013-12-25 | 2016-10-26 | 合肥工业大学 | 一种精度与机器人无关的扫描测量机器人检测方法 |
EP2916099B1 (en) * | 2014-03-07 | 2020-09-30 | Hexagon Technology Center GmbH | Articulated arm coordinate measuring machine |
CN104238560B (zh) * | 2014-09-26 | 2017-04-05 | 深圳市中智科创机器人有限公司 | 一种非线性路径规划方法及系统 |
US20160368336A1 (en) * | 2015-06-19 | 2016-12-22 | Paccar Inc | Use of laser scanner for autonomous truck operation |
CN105203046B (zh) * | 2015-09-10 | 2018-09-18 | 北京天远三维科技股份有限公司 | 多线阵列激光三维扫描系统及多线阵列激光三维扫描方法 |
CN105911992B (zh) * | 2016-06-14 | 2019-02-22 | 广东技术师范学院 | 一种移动机器人的自动规划路径方法及移动机器人 |
CN106546184B (zh) * | 2016-09-30 | 2019-02-26 | 长春理工大学 | 大型复杂曲面三维形貌机器人柔性测量系统 |
CN106500617A (zh) * | 2016-09-30 | 2017-03-15 | 长春理工大学 | 复杂曲面轨迹规划及离线编程方法 |
CN107538487B (zh) * | 2017-02-16 | 2020-01-03 | 北京卫星环境工程研究所 | 用于大尺寸复杂形面的机器人自动测量方法及系统 |
CN107144236A (zh) * | 2017-05-25 | 2017-09-08 | 西安交通大学苏州研究院 | 一种机器人自动扫描仪及扫描方法 |
US10788585B2 (en) * | 2017-09-15 | 2020-09-29 | Toyota Research Institute, Inc. | System and method for object detection using a probabilistic observation model |
CN109839075A (zh) * | 2017-11-29 | 2019-06-04 | 沈阳新松机器人自动化股份有限公司 | 一种机器人自动测量系统及测量方法 |
CN108917593B (zh) * | 2018-05-14 | 2020-01-24 | 南京工业大学 | 一种基于待测工件基元组态的智能测量系统及方法 |
CN109990701B (zh) * | 2019-03-04 | 2020-07-10 | 华中科技大学 | 一种大型复杂曲面三维形貌机器人移动测量系统及方法 |
CN110108288A (zh) * | 2019-05-27 | 2019-08-09 | 北京史河科技有限公司 | 一种场景地图构建方法及装置、场景地图导航方法及装置 |
CN110500969B (zh) * | 2019-10-08 | 2020-07-14 | 大连理工大学 | 一种高陡度复杂曲面在位测量规划方法 |
-
2020
- 2020-01-09 CN CN202010022806.6A patent/CN111238366B/zh active Active
Non-Patent Citations (1)
Title |
---|
3D mapping and path planning from range data;E Teniente;《学位论文》;20151231;1-126 * |
Also Published As
Publication number | Publication date |
---|---|
CN111238366A (zh) | 2020-06-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111238366B (zh) | 一种三维扫描路径规划方法及装置 | |
CN107127755B (zh) | 一种三维点云的实时采集装置及机器人打磨轨迹规划方法 | |
Lee et al. | Data reduction methods for reverse engineering | |
JP6323993B2 (ja) | 情報処理装置、情報処理方法、及びコンピュータプログラム | |
CN113192054B (zh) | 基于2-3d视觉融合的繁杂零件检测与定位的方法及系统 | |
CN107991683A (zh) | 一种基于激光雷达的机器人自主定位方法 | |
JP5627325B2 (ja) | 位置姿勢計測装置、位置姿勢計測方法、およびプログラム | |
JP4210056B2 (ja) | 工具経路の作成装置及び方法 | |
CN115147437B (zh) | 机器人智能引导加工方法与系统 | |
CN109683552B (zh) | 一种基面曲线导向的复杂点云模型上的数控加工路径生成方法 | |
CN105654483A (zh) | 三维点云全自动配准方法 | |
CN104048645B (zh) | 线性拟合地面扫描点云整体定向方法 | |
Yau et al. | Registration and integration of multiple laser scanned data for reverse engineering of complex 3D models | |
CN110047133A (zh) | 一种面向点云数据的列车边界提取方法 | |
CN112762937B (zh) | 一种基于占据栅格的2d激光序列点云配准方法 | |
CN112381862B (zh) | 一种cad模型与三角网格全自动配准方法和装置 | |
CN109448040A (zh) | 一种机械生产制造展示辅助系统 | |
CN113554757A (zh) | 基于数字孪生的工件轨迹三维重构方法及系统 | |
CN206825428U (zh) | 一种三维点云的实时采集装置 | |
Bodenmüller et al. | Online surface reconstruction from unorganized 3d-points for the DLR hand-guided scanner system | |
CN110542379B (zh) | 坐标转换的方法以及装置 | |
CN116934705A (zh) | 一种基于三维激光扫描的平整度检测方法 | |
US8510078B2 (en) | Method and system for registering an object with a probe using entropy-based motion selection and Rao-Blackwellized particle filtering | |
Dong et al. | GA-based modified DH method calibration modelling for 6-DOFs serial robot | |
CN114488943A (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 | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20210728 Address after: 300131 No. 2100, building 7, No. 9, Juxing Road, Haihe Industrial Zone, Jinnan District, Tianjin Applicant after: TENYOUN 3D (TIANJIN) TECHNOLOGY Co.,Ltd. Address before: 100192 rooms 512-519, complex building a 1, Yongtai garden, Qinghe, Haidian District, Beijing Applicant before: TENYOUN 3D (TIANJIN) TECHNOLOGY Co.,Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |