激光清洗轨迹拟合的方法、装置、设备及存储介质与流程

1.本发明涉及激光清洗技术领域，尤其涉及一种激光清洗轨迹拟合的方法、装置、设备及存储介质。


背景技术：

2.激光清洗是工业中常用的表面处理技术，用于除去工件表面上的油脂、灰尘、锈垢及残留的溶剂、粘结剂等污物，以确保下道工序的质量，如电镀、磷化、喷涂、焊接、包装以及集成线路装配等过程，必须先去除表面污渍。激光清洗是一种“干式”清洗，不需要清洁液或其他化学溶液，且清洁度远远高于化学清洗工艺，能适应各种表面污物的清洗，对环境污染极小，可以做到不损伤基体。目前该方法已成为传统清洗方法的补充和延伸，并因其固有的许多优点而展示了广阔的应用前景。
3.但现有激光清洗中通常人工进行清洗路径的识别规划，虽然能完全覆盖被扫描物体表面，但是由于待清洗工件形状和摆放姿态限制，导致工件表面到激光束光源纵向距离不一致，因而可能出现清洗效果差异。因此，如何克服待清洗工件形状和摆放姿态限制，提高激光清洗效果是亟待解决的技术问题。
4.上述内容仅用于辅助理解本发明的技术方案，并不代表承认上述内容是现有技术。


技术实现要素：

5.本发明的主要目的在于提供一种激光清洗轨迹拟合的方法、装置、设备及计算机存储介质，旨在解决现有技术中由于待清洗工件形状和摆放姿态限制，导致影响激光清洗效果的技术问题。
6.为实现上述目的，本发明提供一种激光清洗轨迹拟合的方法，所述激光清洗轨迹拟合的方法包括以下步骤：
7.获取待扫描工件的工件网格，根据所述工件网格计算最小有向包围盒；
8.根据所述最小有向包围盒生成初始扫描轨迹；
9.将所述工件网格投影到所述最小包围盒的上表面，获得投影网格；
10.遍历所述投影网格中的四角面片，查找与所述初始扫描轨迹相交的四角面片，获得候选投影面片集合；
11.遍历所述候选投影面片集合中四角面片的边，查找与所述初始扫描轨迹相交的相交边及交点；
12.根据所述相交边及交点，在所述工件网格中查找所述交点的投影点，查找到的所有投影点构成投影点集；
13.根据所述投影点集中的投影点拟合所述待扫描工件的实际扫描轨迹。
14.优选地，所述根据所述相交边及交点，在所述工件网格中查找所述交点的投影点，查找到的所有投影点构成投影点集，包括：
15.计算所述交点与所述相交边的两个端点之间的第一距离和第二距离；
16.计算所述第一距离和所述第二距离之间的比值；
17.获取所述相交边对应的目标序号；
18.根据所述比值，在所述工件网格中所述目标序号对应的目标边上寻找所述交点的投影点，查找到的所有投影点构成投影点集。
19.优选地，所述根据所述相交边及交点，在所述工件网格中查找所述交点的投影点，查找到的所有投影点构成投影点集，包括：
20.获取所述相交边对应的目标序号；
21.查找所述工件网格中所述目标序号对应的目标边；
22.获取所述目标边的两个端点坐标；
23.根据所述目标边的两个端点坐标，计算所述交点在所述目标边上的投影点，各所述投影点构成投影点集。
24.优选地，所述根据所述目标边的两个端点坐标，计算所述交点在所述目标边上的投影点，各所述投影点构成投影点集，包括：
25.根据所述目标边的两个端点坐标，计算所述目标边的中点；
26.将所述目标边的中点作为所述交点在所述目标边上的投影点，各所述投影点构成投影点集。
27.优选地，所述将所述工件网格投影到所述最小包围盒的上表面，获得投影网格，包括：
28.将所述工件网格由相机坐标系转换到工件坐标系；
29.将所述工件坐标系下的工件网格投影到所述最小包围盒的上表面，获得投影网格。
30.优选地，所述将所述工件坐标系下的工件网格投影到所述最小包围盒的上表面，获得投影网格之后，还包括：
31.计算所述投影网格中各四角面片的四角面片中心；
32.对任意的所述初始扫描轨迹，设置所述四角面片中心到所述初始扫描轨迹的距离阈值；
33.计算所述初始扫描轨迹的方向向量；
34.计算所述初始扫描轨迹上某一点到所述四角面片中心的目标向量；
35.根据所述方向向量和所述目标向量，计算任意四角面片中心到所述初始扫描轨迹的目标距离；
36.若所述目标距离小于所述距离阈值，则对应的四角面片为候选投影面片，所有的所述候选投影面片构成候选投影面片集合。
37.优选地，所述根据所述投影点集中的投影点拟合所述待扫描工件的实际扫描轨迹之后，还包括：
38.将拟合后的实际扫描轨迹坐标由工件坐标系转换到相机坐标系，获得在相机坐标系下所述待扫描工件的实际扫描轨迹。
39.此外，为实现上述目的，本发明还提出一种激光清洗轨迹拟合的装置，所述激光清洗轨迹拟合的装置包括：
40.计算模块，用于获取待扫描工件的工件网格，根据所述工件网格计算最小有向包围盒；
41.生成模块，用于根据所述最小有向包围盒生成初始扫描轨迹；
42.投影模块，用于将所述工件网格投影到所述最小包围盒的上表面，获得投影网格；
43.查找模块，用于遍历所述投影网格中的四角面片，查找与所述初始扫描轨迹相交的四角面片，获得候选投影面片集合；
44.所述查找模块，还用于遍历所述候选投影面片集合中四角面片的边，查找与所述初始扫描轨迹相交的相交边及交点；
45.所述查找模块，还用于根据所述相交边及交点，在所述工件网格中查找所述交点的投影点，查找到的所有投影点构成投影点集；
46.拟合模块，用于根据所述投影点集中的投影点拟合所述待扫描工件的实际扫描轨迹。
47.此外，为实现上述目的，本发明还提出一种激光清洗轨迹拟合的设备，所述激光清洗轨迹拟合的设备包括：存储器、处理器及存储在所述存储器上并可在所述处理器上运行的激光清洗轨迹拟合的程序，所述激光清洗轨迹拟合的程序被所述处理器执行时实现如上文所述的激光清洗轨迹拟合的方法的步骤。
48.此外，为实现上述目的，本发明还提出一种存储介质，所述存储介质上存储有激光清洗轨迹拟合的程序，所述激光清洗轨迹拟合的程序被处理器执行时实现如上文所述的激光清洗轨迹拟合的方法的步骤。
49.本发明中，通过获取待扫描工件的工件网格，根据所述工件网格计算最小有向包围盒，根据所述最小有向包围盒生成初始扫描轨迹，实现自动化操作，效率高，计算量小；将所述工件网格投影到所述最小包围盒的上表面，获得投影网格，遍历所述投影网格中的四角面片，查找与所述初始扫描轨迹相交的四角面片，获得候选投影面片集合，遍历所述候选投影面片集合中四角面片的边，查找与所述初始扫描轨迹相交的相交边及交点，根据所述相交边及交点，在所述工件网格中查找投影点，查找到的所有投影点构成投影点集，根据所述投影点集中的投影点拟合所述待扫描工件的实际扫描轨迹，拟合出的所述实际扫描轨迹能够克服待清洗工件形状和摆放姿态的限制，使激光束能量在工件表面均匀分布，提升清洗效果。
附图说明
50.图1是本发明实施例方案涉及的硬件运行环境的激光清洗轨迹拟合的设备的结构示意图；
51.图2为本发明激光清洗轨迹拟合的方法第一实施例的流程示意图；
52.图3为本发明激光清洗轨迹拟合的方法实施例中扫描轨迹实际效果图；
53.图4为本发明激光清洗轨迹拟合的装置第一实施例的结构框图。
54.本发明目的的实现、功能特点及优点将结合实施例，参照附图做进一步说明。
具体实施方式
55.应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
56.参照图1，图1为本发明实施例方案涉及的硬件运行环境的激光清洗轨迹拟合的设备结构示意图。
57.如图1所示，该激光清洗轨迹拟合的设备可以包括：处理器1001，例如中央处理器(central processing unit，cpu)，通信总线1002、用户接口1003，网络接口1004，存储器1005。其中，通信总线1002用于实现这些组件之间的连接通信。用户接口1003可以包括显示屏(display)，可选用户接口1003还可以包括标准的有线接口、无线接口，对于用户接口1003的有线接口在本发明中可为usb接口。网络接口1004可选的可以包括标准的有线接口、无线接口(如无线保真(wireless-fidelity，wi-fi)接口)。存储器1005可以是高速的随机存取存储器(randomaccess memory，ram)存储器，也可以是稳定的存储器(non-volatile memory，nvm)，例如磁盘存储器。存储器1005可选的还可以是独立于前述处理器1001的存储装置。
58.本领域技术人员可以理解，图1中示出的结构并不构成对激光清洗轨迹拟合的设备的限定，可以包括比图示更多或更少的部件，或者组合某些部件，或者不同的部件布置。
59.如图1所示，作为一种计算机存储介质的存储器1005中可以包括操作系统、网络通信模块、用户接口模块以及激光清洗轨迹拟合的程序。
60.在图1所示的激光清洗轨迹拟合的设备中，网络接口1004主要用于连接后台服务器，与所述后台服务器进行数据通信；用户接口1003主要用于连接用户设备；所述激光清洗轨迹拟合的设备通过处理器1001调用存储器1005中存储的激光清洗轨迹拟合的程序，并执行本发明实施例提供的激光清洗轨迹拟合的方法。
61.基于上述硬件结构，提出本发明激光清洗轨迹拟合的方法的实施例。
62.参照图2，图2为本发明激光清洗轨迹拟合的方法第一实施例的流程示意图，提出本发明激光清洗轨迹拟合的方法第一实施例。
63.在第一实施例中，所述激光清洗轨迹拟合的方法包括以下步骤：
64.步骤s10：获取待扫描工件的工件网格，根据所述工件网格计算最小有向包围盒。
65.应理解的是，本实施例的执行主体是所述激光清洗轨迹拟合的设备，所述激光清洗轨迹拟合的设备可为个人电脑、工控机、机器人或服务器等电子设备，本实施例对此不加以限制。获取待扫描工件的有序点云，根据所述有序点云生成四角网格。将3d相机固定于待焊接工件正上方，触发拍照获取待扫描工件有序点云。对于所述有序点云中的任意一点v
i,j
，依照行列排序的索引规则查找v
i,j
的相邻点v
i,j+1
，v
i+1,j+1
，v
i+1,j
。其中，有序点云数据中第i行j列、第i行j+1列、第i+1行j+1列、第i+1行j列分别对应的v
i,j
，v
i,j+1
，v
i+1,j+1
，v
i+1,j
四个点，这四个点构成一个四角面片，构成四角面片的点称为网格顶点。依据索引关系，添加四角面片，直至搜索完有序点云中的所有顶点，顶点和四角面片共同构成四角网格。其中每个顶点v
i,j
的3d空间位置坐标记为(x,y,z)。根据四角面片的顶点位置坐标，计算出每个四角面片的法向量，所有四角面片法向，构成四角网格的面法向集合其中nf为四角网格所包含的四角面片个数。
66.需要说明的是，对所述四角网格进行平面分割，获得待扫描工件网格；提取所述待扫描工件网格的四角网格轮廓；根据所述四角网格轮廓计算最小有向包围盒。由四角网格顶点间的拓扑关系，任意一个网格的内顶点v
i,j
，它的相邻顶点数必然为四个，否则顶点v
i,j
为边缘点。从而提取出待扫描工件网格轮廓。为了准确识别任意形状物体的位姿，根据所述四角网格轮廓点云计算所述待扫描工件的最小包络下的位姿，即获得所述最小有向包围盒。
67.进一步地，根据所述四角网格轮廓，计算所述待扫描工件网格在相机坐标系下的质心；计算所述待扫描工件网格在所述相机坐标系下相对于所述质心的惯性张量矩阵；根据所述惯性张量矩阵计算所述待扫描工件网格在所述质心的坐标系下的初步位姿矩阵；根据所述初步位姿矩阵计算所述待扫描工件的最小有向包围盒。
68.质心指的是质量的中心，认为是物体质量集中于此点的假想点。物体质心坐标pc计算公式如下：
69.其中，m为物体的总质量，mi为将物体分为i份，第i份物体的质量，ri为mi的坐标。根据物体质心坐标计算公式计算所述待扫描工件网格在相机坐标系下的质心。
70.惯性张量是描述刚体作定点转动惯性大小的物理量，刚体作定点转动时，只有一点始终保持不动。此外惯性张量是一个实值的三维对称矩阵，对于三维空间中任意一参考点q与以此参考点为原点的直角坐标系q
xyz
，其惯性张量表示方法如下：
[0071][0072]
其中，对角元素i
xx
，i
yy
，i
zz
分别为对于x轴，y轴，z轴的惯性矩。惯性矩一般是指截面抵抗弯曲的性质，设定(x，y，z)为微小质量dm对于点q的相对位置。则这些惯性矩的计算公式如下：
[0073][0074][0075][0076]
而非对角元素，成为惯性积，可定义为：
[0077][0078][0079][0080]
求所述四角网格轮廓相对于质心的惯性张量矩阵，根据平行轴定理，令
[0081]
xi'＝x
i-p
x
[0082]
yi'＝y
i-py[0083]
zi'＝z
i-pz[0084]
其中(p
x
，py，pz)为所述四角网格轮廓在相机坐标系下质心的坐标，(xi，yi，zi)为点
云在相机坐标系下的坐标。即可得到所述四角网格轮廓相对于质心的惯性张量矩阵，其最终计算公式如下：
[0085][0086]
遍历所有四角网格轮廓，带入上述公式，计算获得所述四角网格轮廓在相机坐标系下相对于质心的惯性张量矩阵i。
[0087]
采用对角线化方法，使惯性积为零，使惯性张量成为一个对角矩阵。而对称阵的主元素均为正数，所得到的三个特征值必为正实数，三个特征向量必定互相正交，从而计算获得所述惯性张量矩阵的特征值λ1、λ2、λ3。
[0088]
根据所述惯性张量矩阵的特征值，求解所述惯性张量矩阵的特征向量公式如下：iω＝λω。根据所述惯性张量矩阵的特征向量，也是惯性主轴，根据惯性主轴定义四角网格轮廓在质心的坐标系，从而获得四角网格轮廓在相机坐标系下对质心转动主轴的旋转矩阵r
o2c
，根据所述旋转矩阵和所述相机坐标系中的质心，计算相机坐标系到点云质心坐标系的旋转平移矩阵，获得所述待扫描工件的初步位姿矩阵t
o2c
，即所述最小有向包围盒。其中，相机坐标系到点云质心平移矩阵t
o2c
等于质心pc坐标。
[0089]
步骤s20：根据所述最小有向包围盒生成初始扫描轨迹。
[0090]
可理解的是，查找所述最小有向包围盒最小点b
min
和最大点b
max
。由b
min
和b
max
可以给出有向包围盒上表面顶点坐标分别为a(x
min
,y
min
,z
min
)，b(x
min
,y
max
,z
min
)，c(x
max
,y
max
,z
min
)，d(x
max
,y
min
,z
min
)，四个顶点按照逆时针方向排列。按照单条轨迹沿x轴正向扫描，多条轨迹沿y轴正向排列的方式生成扫描轨迹。也可以是，四个顶点按照顺时针方向排列，按照单条轨迹沿x轴反向扫描，多条轨迹沿y轴反向排列的方式生成扫描轨迹。对此本实施例不加以限制。
[0091]
步骤s30：将所述工件网格投影到所述最小包围盒的上表面，获得投影网格。
[0092]
可理解的是，由于待清洗工件形状和摆放姿态限制，导致工件表面到激光束光源纵向距离不一致，因而所述初始扫描轨迹可能出现清洗效果差异，为了达到更好的清洗效果，需要让激光束完全覆盖被扫描物体表面的同时均匀分布于待扫描物体表面，最大化利用激光束的能量。将网格投影到最小包围盒上表面。最小包围盒上表面顶点坐标为a(x
min
,y
min
,z
min
)，b(x
min
,y
max
,z
min
)，c(x
max
,y
max
,z
min
)，d(x
max
,y
min
,z
min
)，则对任意v
oi
(x
oi
,y
oi
,z
oi
)，令z
oi
＝z
min
，获得投影网格。
[0093]
步骤s40：遍历所述投影网格中的四角面片，查找与所述初始扫描轨迹相交的四角面片，获得候选投影面片集合。
[0094]
应理解的是，对任意扫描轨迹ti，计算有向包围盒沿x轴方向边长则激光清洗轨迹数量为
[0095][0096]
其中为向下取整符号，i∈[0,n)。遍历所述投影网格中的四角面片，计算各四角面片的中心，根据所述四角面片中心，对任意所述初始扫描轨迹，查找与所述初始扫描轨迹相交的四角面片，记录相交的四角面片的目标序号，所有满足条件的四角面片构成所述候选投影面片集合p
fi
，i∈[0,n)。
[0097]
步骤s50：遍历所述候选投影面片集合中四角面片的边，查找与所述初始扫描轨迹相交的相交边及交点。
[0098]
需要说明的是，遍历所述候选投影面片集合p
fi
中四角面片的边，寻找与所述初始扫描轨迹ti相交的边，计算交点，并记录相交边的目标序号id和交点坐标组成交点和边的序列对
[0099]
步骤s60：根据所述相交边及交点，在所述工件网格中查找投影点，查找到的所有投影点构成投影点集。
[0100]
在具体实现中，根据所述相交边的目标序号id，在原来的所述工件网格中，查找所述目标序号id对应的目标边，在所述目标边上查找所述交点的投影点。具体地，可根据所述相交边计算交点坐标根据所述交点坐标在原来的所述工件网格中的所述目标边上寻找对应的点作为点在网格面上的投影点；也可根据所述目标边的两个端点坐标，计算在所述目标边上的点作为点在网格面上的投影点。本实施例对此不加以限制。
[0101]
步骤s70：根据所述投影点集中的投影点拟合所述待扫描工件的实际扫描轨迹。
[0102]
应理解的是，根据所述投影点集中的投影点，将多点拟合成线，拟合出所述待扫描工件的实际扫描轨迹。
[0103]
在本实施例中，通过获取待扫描工件的工件网格，根据所述工件网格计算最小有向包围盒，根据所述最小有向包围盒生成初始扫描轨迹，实现自动化操作，效率高，计算量小；将所述工件网格投影到所述最小包围盒的上表面，获得投影网格，遍历所述投影网格中的四角面片，查找与所述初始扫描轨迹相交的四角面片，获得候选投影面片集合，遍历所述候选投影面片集合中四角面片的边，查找与所述初始扫描轨迹相交的相交边及交点，根据所述相交边及交点，在所述工件网格中查找投影点，查找到的所有投影点构成投影点集，根据所述投影点集中的投影点拟合所述待扫描工件的实际扫描轨迹，拟合出的所述实际扫描轨迹能够克服待清洗工件形状和摆放姿态的限制，使激光束能量在工件表面均匀分布，提升清洗效果。
[0104]
继续参照图2，基于上述第一实施例，提出本发明激光清洗轨迹拟合的方法的第二实施例。
[0105]
在第二实施例中，所述步骤s60，包括：
[0106]
计算所述交点与所述相交边的两个端点之间的第一距离和第二距离；
[0107]
计算所述第一距离和所述第二距离之间的比值；
[0108]
获取所述相交边对应的目标序号；
[0109]
根据所述比值，在所述工件网格中所述目标序号对应的目标边上寻找所述交点的投影点，查找到的所有投影点构成投影点集。
[0110]
应理解的是，遍历所述候选投影面片集合p
fi
中四角面片的边，寻找与扫描轨迹相交的边，并计算交点，记录相交边的目标序号id和交点坐标组成交点和边的序列对
[0111]
计算交点坐标与投影面片中相交边的两个端点的距离d1,d2，计算d1,d2的比值在原工件四角网格中，边序号为id的边上寻找一点使其与边的两个端点的距离的比值等于q。此时，将点作为点在网格面上的投影点。
[0112]
在本实施例中，通过遍历所述候选投影面片集合中四角面片的边，查找与所述初始扫描轨迹相交的相交边，记录所述相交边的目标序号，并计算交点，计算所述交点与所述相交边的两个端点的比值，根据所述比值再在原来的工件网格中所述目标序号对应的目标边上寻找投影点，查找到的所有投影点构成投影点集，能够准确获得曲线在网格面上的投影点，从而获得准确的实际扫描轨迹。
[0113]
继续参照图2，基于上述第一实施例，提出本发明激光清洗轨迹拟合的方法的第三实施例。
[0114]
在第三实施例中，所述步骤s60，包括：
[0115]
获取所述相交边对应的目标序号；
[0116]
查找所述工件网格中所述目标序号对应的目标边；
[0117]
获取所述目标边的两个端点坐标；
[0118]
根据所述目标边的两个端点坐标，计算所述交点在所述目标边上的投影点，各所述投影点构成投影点集。
[0119]
应理解的是，遍历所述候选投影面片集合p
fi
中四角面片的边，寻找与扫描轨迹相交的边，记录相交边的目标序号id。在所述工件网格中查找所述目标序号id对应的目标边，获取所述目标边的两个端点坐标v1(x,y,z)、v2(x,y,z)。
[0120]
进一步地，在本实施例中，所述根据所述目标边的两个端点坐标，计算所述交点在所述目标边上的投影点，各所述投影点构成投影点集，包括：
[0121]
根据所述目标边的两个端点坐标，计算所述目标边的中点；
[0122]
将所述目标边的中点作为所述交点在所述目标边上的投影点，各所述投影点构成投影点集。
[0123]
需要说明的是，可通过计算所述目标边的中点，将所述目标边的中点作为投影点。
[0124]
所述目标边的中点坐标为：
[0125]
则将中点v0作为所述交点在网格面上的投影点。
[0126]
在本实施例中，通过获取所述相交边对应的目标序号，查找所述工件网格中所述目标序号对应的目标边，获取所述目标边的两个端点坐标，根据所述目标边的两个端点坐
标，计算所述交点在所述目标边上的投影点，各所述投影点构成投影点集，能够准确获得曲线在网格面上的投影点，从而获得准确的实际扫描轨迹。
[0127]
继续参照图2，基于上述第三实施例，提出本发明激光清洗轨迹拟合的方法的第四实施例。
[0128]
在本实施例中，所述根据所述目标边的两个端点坐标，计算所述交点在所述目标边上的投影点，各所述投影点构成投影点集，包括：
[0129]
将所述交点的x、y坐标作为投影点的x、y坐标；
[0130]
计算所述目标边的两个端点的z坐标中值，作为所述投影点的z坐标。
[0131]
可理解的是，获取所述目标边的两个端点坐标v1(x,y,z)、v2(x,y,z)，计算投影点的x，y坐标：
[0132][0133]
计算投影点的z坐标：
[0134][0135]
则计算获得点作为点在网格面上的投影点。
[0136]
在本实施例中，通过将所述交点的x、y坐标作为投影点的x、y坐标，计算所述目标边的两个端点的z坐标中值，作为所述投影点的z坐标，能够准确获得曲线在网格面上的投影点，从而获得准确的实际扫描轨迹。
[0137]
继续参照图2，基于上述第一实施例，提出本发明激光清洗轨迹拟合的方法的第五实施例。
[0138]
在本实施例中，所述步骤s30，包括：
[0139]
将所述工件网格由相机坐标系转换到工件坐标系；
[0140]
将所述工件坐标系下的工件网格投影到所述最小包围盒的上表面，获得投影网格。
[0141]
需要说明的是，将工件网格由相机坐标系转换到工件坐标系。工件坐标系到相机坐标系的位姿转换矩阵为t
o2c
，则相机坐标系到工件坐标系的位姿转换矩阵：
[0142][0143]
对相机坐标系下网格中任一顶点vi(xi,yi,zi)，其在工件坐标系下的坐标为v
oi
(x
oi
,y
oi
,z
oi
)。
[0144]voi
＝r
c2o
vi+t
c2o
；
[0145]
其中，r
o2c
为四角网格轮廓在相机坐标系下对质心转动主轴的旋转矩阵；t
o2c
为所述待扫描工件的初步位姿矩阵，即所述最小有向包围盒；相机坐标系到点云质心平移矩阵t
o2c
等于质心pc坐标。
[0146]
进一步地，在本实施例中，所述将所述工件坐标系下的工件网格投影到所述最小包围盒的上表面，获得投影网格之后，还包括：
[0147]
计算所述投影网格中各四角面片的四角面片中心；
[0148]
对任意的所述初始扫描轨迹，设置所述四角面片中心到所述初始扫描轨迹的距离阈值；
[0149]
计算所述初始扫描轨迹的方向向量；
[0150]
计算所述初始扫描轨迹上某一点到所述四角面片中心的目标向量；
[0151]
根据所述方向向量和所述目标向量，计算任意四角面片中心到所述初始扫描轨迹的目标距离；
[0152]
若所述目标距离小于所述距离阈值，则对应的四角面片为候选投影面片，所有的所述候选投影面片构成候选投影面片集合。
[0153]
在具体实现中，计算投影网格四角面片中心。对任意四角面片f
oi
，它的中心为
[0154]
对任意初始扫描轨迹ti，计算有向包围盒沿x轴方向边长则激光清洗轨迹数量为
[0155][0156]
其中为向下取整符号，i∈[0,n)，寻找与ti相交的四角面片，具体为：
[0157]
设置四角面片中心到轨迹ti的距离阈值d
ft
＝r
res
；其中r
res
为点云分辨率。计算所述初始扫描轨迹ti的由起点指向终点的方向向量其中p
si
为所述初始扫描轨迹ti的起点坐标，p
ei
为所述初始扫描轨迹ti的终点坐标。根据最小包围盒的顶点坐标，计算计算和的方向向量为：
[0158][0159]
对任意所述初始扫描轨迹ti，i∈[0,n)，轨迹起、终点坐标为：
[0160][0161][0162]
其中，p_a为顶点a的坐标，p_b为顶点b的坐标，d为给定激光宽度阈值。
[0163]
计算所述初始扫描轨迹ti上某一点到四角面片中心c
oi
的目标向量为：
[0164]
计算任意四角面片中心c
oi
到轨迹ti的目标距离为：
[0165][0166]
如果d
ct
＜d
ft
，记录四角面片f
oi
的序号，所有满足条件的四角面片，构成轨迹ti候选投影面片的集合p
fi
，i∈[0,n)。
[0167]
进一步地，在本实施例中，所述步骤s70之后，还包括：
[0168]
将拟合后的实际扫描轨迹坐标由工件坐标系转换到相机坐标系，获得在相机坐标系下所述待扫描工件的实际扫描轨迹。
[0169]
应理解的是，扫描轨迹投影点集的投影效果如图3所示。对任意初始扫描轨迹ti，将扫描轨迹投影点集坐标由工件坐标系转换到相机坐标系。
[0170]
工件坐标系到相机坐标系的变换矩阵为：
[0171][0172]
则任意初始扫描轨迹ti投影点集在相机坐标系下的坐标为：
[0173][0174]
在本实施例中，将所述工件网格由相机坐标系转换到工件坐标系，将所述工件坐标系下的工件网格投影到所述最小包围盒的上表面，获得投影网格，根据投影网格与基于最小包围盒生成的激光清洗轨迹的交点投影到工件网格表面，获得投影点集，根据投影点集拟合实际扫描轨迹，从而让激光束完全覆盖被扫描物体表面的同时均匀分布于待扫描物体表面，提高清洗效果。
[0175]
此外，本发明还提出一种存储介质，所述存储介质上存储有激光清洗轨迹拟合的程序，所述激光清洗轨迹拟合的程序被处理器执行时实现如上文所述的激光清洗轨迹拟合的方法的步骤。
[0176]
此外，参照图4，本发明实施例还提出一种激光清洗轨迹拟合的装置，所述激光清洗轨迹拟合的装置包括：
[0177]
计算模块10，用于获取待扫描工件的工件网格，根据所述工件网格计算最小有向包围盒；
[0178]
生成模块20，用于根据所述最小有向包围盒生成初始扫描轨迹；
[0179]
投影模块30，用于将所述工件网格投影到所述最小包围盒的上表面，获得投影网格；
[0180]
查找模块40，用于遍历所述投影网格中的四角面片，查找与所述初始扫描轨迹相交的四角面片，获得候选投影面片集合；
[0181]
所述查找模块40，还用于遍历所述候选投影面片集合中四角面片的边，查找与所述初始扫描轨迹相交的相交边及交点；
[0182]
所述查找模块40，还用于根据所述相交边及交点，在所述工件网格中查找所述交点的投影点，查找到的所有投影点构成投影点集；
[0183]
拟合模块50，用于根据所述投影点集中的投影点拟合所述待扫描工件的实际扫描轨迹。
[0184]
本发明所述激光清洗轨迹拟合的装置的其他实施例或具体实现方式可参照上述各方法实施例，此处不再赘述。
[0185]
需要说明的是，在本文中，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者系统不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者系统所固有的要素。在没有更多限制的情况下，由语句“包括一个
……”
限定的要素，并不排除在包括该要素的过程、方法、物品或者系统中还存在另外的相同要素。
[0186]
上述本发明实施例序号仅仅为了描述，不代表实施例的优劣。在列举了若干装置的单元权利要求中，这些装置中的若干个可以是通过同一个硬件项来具体体现。词语第一、第二、以及第三等的使用不表示任何顺序，可将这些词语解释为标识。
[0187]
通过以上的实施方式的描述，本领域的技术人员可以清楚地了解到上述实施例方法可借助软件加必需的通用硬件平台的方式来实现，当然也可以通过硬件，但很多情况下前者是更佳的实施方式。基于这样的理解，本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来，该计算机软件产品存储在一个存储介质(如只读存储器镜像(read only memory image，rom)/随机存取存储器(randomaccess memory，ram)、磁碟、光盘)中，包括若干指令用以使得一台终端设备(可以是手机，计算机，服务器，空调器，或者网络设备等)执行本发明各个实施例所述的方法。
[0188]
以上仅为本发明的优选实施例，并非因此限制本发明的专利范围，凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换，或直接或间接运用在其他相关的技术领域，均同理包括在本发明的专利保护范围内。