一种环境重建方法及装置

1.本发明涉及三维重建技术领域，更具体的涉及一种环境重建方法及装置。


背景技术：

2.随着计算机技术的发展，环境检测数据越来越重要，并且广泛用于孪生城市、高精地图以及同步定位等领域。但由于视觉传感器在弱纹理环境下很难提取有效的特征，而且受光照影响较大，从而影响双目视觉传感器工作。
3.激光传感器在空旷环境等会出现退化问题，而且在雨雪等极端天气下会产生过多噪声。毫米波雷达对于静止的物体和运动的非金属物体不太敏感，不太容易得到障碍物的轮廓。
4.综上所述，现有环境检测重建中激光雷达和毫米波雷达在数据层的点云数据融合存在传感器误差、点云数据和像素数据的融合存在精度低的问题。


技术实现要素：

5.本发明实施例提供一种环境重建方法及装置，用以解决现有环境检测重建中激光雷达和毫米波雷达在数据层的点云数据融合存在传感器误差、点云数据和像素数据的融合存在精度低的问题。
6.本发明实施例提供一种环境重建方法，包括：
7.根据待检测物的位置，依次设置激光雷达传感器、毫米波雷达传感器、双目视觉传感器，其中，激光雷达传感器、毫米波雷达传感器、双目视觉传感器和待检测物之间的距离、角度均为固定值；
8.所述激光雷达传感器和所述毫米波雷达传感器依次对所述待检测物进行扫描，分别得到激光雷达点云数据、激光雷达点云张量、毫米波雷达点云数据、毫米波雷达点云张量；将激光雷达点云张量和毫米波雷达点云张量进行卷积和最大池化，得到激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像；
9.将激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像输入至下采样卷积网络，得到毫米波
‑
激光雷达数据的特征；将所述毫米波
‑
激光雷达数据的特征和所述双目视觉传感器得到的双目视觉特征通过卷积神经网络，得到所述待检测物的融合特征图；
10.所述待检测物的融合特征图采用pcl poisson表面重建法重建，得到所述待检测物的三维图像。
11.优选地，所述根据待检测物的位置，依次设置激光雷达传感器、毫米波雷达传感器、双目视觉传感器之前，还包括：
12.根据激光雷达传感器、毫米波雷达传感器、双目视觉传感器和标定板的位置，建立全局坐标系；其中，激光雷达传感器、毫米波雷达传感器、双目视觉传感器和标定板之间的距离、角度均为固定值；
13.根据激光雷达传感器、毫米波传感器和双目视觉传感器在全局坐标系内的位置，
依次得到激光雷达传感器、毫米波传感器和双目视觉传感器相对于全局坐标系的激光雷达坐标、毫米波坐标和双目视觉坐标；
14.依次将激光雷达传感器、毫米波传感器和双目视觉传感器相对于全局坐标系的激光雷达坐标、毫米波坐标和双目视觉坐标依次转换为全局坐标激光雷达矩阵、全局坐标毫米波矩阵和全局坐标双目视觉矩阵；
15.根据全局坐标激光雷达矩阵和全局坐标毫米波矩阵确定全局坐标系下激光雷达传感器和毫米波传感器之间的转换矩阵。
16.优选地，所述全局坐标激光雷达矩阵为：
[0017][0018]
其中，r表示表示旋转参数，t表示平移参数，k表示激光雷达坐标转换为全局坐标系的转换矩阵；
[0019]
全局坐标双目视觉矩阵：
[0020][0021]
其中，f表示相机的焦距，s表示双目视觉坐标转换为全局坐标系的转换矩阵；
[0022]
全局坐标毫米波矩阵为：
[0023][0024]
其中，θ表示毫米波雷达坐标系原点与全局坐标系原点和x坐标轴的角度， q表示毫米波坐标转换为全局坐标系的转换矩阵。
[0025]
优选地，所述激光雷达传感器和所述毫米波雷达传感器依次对所述待检测物进行扫描，分别得到激光雷达点云数据、激光雷达点云张量、毫米波雷达点云数据、毫米波雷达点云张量，具体包括：
[0026]
将所述激光雷达点云数据进行编码，得到激光雷达点云张量；其中，激光雷达点云张量为(d，n，p)，d是激光雷达所对应的整体点云柱的特征维度， n为单点云柱中点云数据的个数，p是非空点云柱柱体的数量；
[0027]
将毫米波雷达点云数据进行编码，得到毫米波雷达点云张量；其中，毫米波雷达点云张量为(m，n，p)，m是毫米波雷达所对应的整体点云柱的特征维度，n为单点云柱中点云数据的个数，p是非空点云柱柱体的数量。
[0028]
优选地，所述将激光雷达点云张量和毫米波雷达点云张量进行卷积和最大池化，得到激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像，具体包括：
[0029]
将所述激光雷达点云张量(d，n，p)进行c次1*1卷积并进行线性变化，对激光雷达包括的每个点云柱进行最大池化操作，得到激光雷达特征矩阵(c， p)，将p个非空点云柱内的点映射回检测范围内的原始位置，得到大小为(c，w，h)的激光雷达二维点云伪图像；
[0030]
将所述毫米波雷达点云张量(m，n，p)进行c次1*1卷积并进行线性变化，对激光雷达包括的每个点云柱进行最大池化操作，得到毫米波雷达特征矩阵(c，p)，将p个非空点云柱内的点映射回检测范围内的原始位置，得到大小为(c，w，h)的毫米波雷达二维点云伪图像；
[0031]
其中，c为正整数，表示卷积次数；w表示最右侧点减去最左侧点得到的图像宽度，h表示最上侧点减去最下侧点得到的图像高度。
[0032]
优选地，所述将激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像输入至下采样卷积网络，得到毫米波
‑
激光雷达数据的特征，具体包括：
[0033]
所述激光雷达二维点云伪图像经过下采样卷积层，batchnorm层和relu 激活层得到纬度为(2c，w/2，h/2)激光雷达二维点云伪图像特征图；
[0034]
所述毫米波雷达二维点云伪图像经过下采样卷积层，batchnorm层和 relu激活层得到纬度为(2c，w/2，h/2)毫米波雷达二维点云伪图像特征图；
[0035]
根据毫米波雷达二维点云伪图像特征图、全局坐标系下激光雷达传感器和毫米波传感器之间的转换矩阵，将毫米波雷达二维点云伪图像特征图所包括的特征点转换到所述激光雷达二维点云伪图像特征图上，得到毫米波
‑
激光雷达数据的特征。
[0036]
优选地，将所述毫米波
‑
激光雷达数据的特征和所述双目视觉传感器得到的双目视觉特征通过卷积神经网络，得到所述待检测物的融合特征图，具体包括：
[0037]
对双目视觉传感器得到左右双目图像进行卷积和池化处理，得到双目视觉特征；
[0038]
采用注意力融合方法将所述毫米波
‑
激光雷达数据的特征和所述双目视觉特征进行点乘，得到毫米波
‑
激光雷达数据的特征图和双目视觉特征图的关系权重矩阵；
[0039]
毫米波
‑
激光雷达数据的特征和双目视觉特征的关系权重矩阵和双目视觉特征图相乘，得到所述待检测物的融合特征图。
[0040]
本发明实施例还提供一种环境重建装置，包括：
[0041]
设置单元，用于根据待检测物的位置，依次设置激光雷达传感器、毫米波雷达传感器、双目视觉传感器，其中，激光雷达传感器、毫米波雷达传感器、双目视觉传感器和待检测物之间的距离、角度均为固定值；
[0042]
第一得到单元，用于所述激光雷达传感器和所述毫米波雷达传感器依次对所述待检测物进行扫描，分别得到激光雷达点云数据、激光雷达点云张量、毫米波雷达点云数据、毫米波雷达点云张量；将激光雷达点云张量和毫米波雷达点云张量进行卷积和最大池化，得到激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像；
[0043]
第二得到单元，用于将激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像输入至下采样卷积网络，得到毫米波
‑
激光雷达数据的特征；将所述毫米波
‑
激光雷达数据的特征和所述双目视觉传感器得到的双目视觉特征通过卷积神经网络，得到所述待检测物的融合特征图；
[0044]
第三得到单元，用于所述待检测物的融合特征图采用pcl poisson表面重建法重建，得到所述待检测物的三维图像。
[0045]
优选地，所述第二得到单元具体用于：
[0046]
将所述激光雷达点云张量(d，n，p)进行c次1*1卷积并进行线性变化，对激光雷达包括的每个点云柱进行最大池化操作，得到激光雷达特征矩阵(c， p)，将p个非空点云柱内
的点映射回检测范围内的原始位置，得到大小为(c， w，h)的激光雷达二维点云伪图像；
[0047]
将所述毫米波雷达点云张量(m，n，p)进行c次1*1卷积并进行线性变化，对激光雷达包括的每个点云柱进行最大池化操作，得到毫米波雷达特征矩阵(c，p)，将p个非空点云柱内的点映射回检测范围内的原始位置，得到大小为(c，w，h)的毫米波雷达二维点云伪图像；
[0048]
其中，c为正整数，表示卷积次数；w表示最右侧点减去最左侧点得到的图像宽度，h表示最上侧点减去最下侧点得到的图像高度；
[0049]
所述激光雷达二维点云伪图像经过下采样卷积层，batchnorm层和relu 激活层得到纬度为(2c，w/2，h/2)激光雷达二维点云伪图像特征图；
[0050]
所述毫米波雷达二维点云伪图像经过下采样卷积层，batchnorm层和 relu激活层得到纬度为(2c，w/2，h/2)毫米波雷达二维点云伪图像特征图；
[0051]
根据毫米波雷达二维点云伪图像特征图、全局坐标系下激光雷达传感器和毫米波传感器之间的转换矩阵，将毫米波雷达二维点云伪图像特征图所包括的特征点转换到所述激光雷达二维点云伪图像特征图上，得到毫米波
‑
激光雷达数据的特征。
[0052]
优选地，所述第二得到单元具体包括：
[0053]
对双目视觉传感器得到左右双目图像进行卷积和池化处理，得到双目视觉特征；
[0054]
采用注意力融合方法将所述毫米波
‑
激光雷达数据的特征和所述双目视觉特征进行点乘，得到毫米波
‑
激光雷达数据的特征图和双目视觉特征图的关系权重矩阵；
[0055]
毫米波
‑
激光雷达数据的特征和双目视觉特征的关系权重矩阵和双目视觉特征图相乘，得到所述待检测物的融合特征图。
[0056]
本发明实施例提供一种环境重建方法及装置，该方法包括：根据待检测物的位置，依次设置激光雷达传感器、毫米波雷达传感器、双目视觉传感器，其中，激光雷达传感器、毫米波雷达传感器、双目视觉传感器和待检测物之间的距离、角度均为固定值；所述激光雷达传感器和所述毫米波雷达传感器依次对所述待检测物进行扫描，分别得到激光雷达点云数据、激光雷达点云张量、毫米波雷达点云数据、毫米波雷达点云张量；将激光雷达点云张量和毫米波雷达点云张量进行卷积和最大池化，得到激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像；将激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像输入至下采样卷积网络，得到毫米波
‑
激光雷达数据的特征；将所述毫米波
‑
激光雷达数据的特征和所述双目视觉传感器得到的双目视觉特征通过卷积神经网络，得到所述待检测物的融合特征图；所述待检测物的融合特征图采用pclpoisson表面重建法重建，得到所述待检测物的三维图像。该方法对获取到的激光雷达数据和毫米波雷达数据进行数据层预融合，对融合雷达数据和视觉数据进行特征层融合，可以有效避免因为环境变化导致的传感器误差；以目标为中心的融合神经网络模型，通过对多传感器数据特征提取融合重建，获取到精度更高的点云数据，从而完成高分辨率的三维模型；结合三种传感器的优点，通过对传感器收集到的数据进行融合，从而获得高精度的三维模型，满足环境重建和探测要求。解决现有环境检测重建中激光雷达和毫米波雷达在数据层的点云数据融合存在传感器误差、点云数据和像素数据的融合存在精度低的问题。
附图说明
[0057]
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0058]
图1为本发明实施例提供的一种环境重建方法流程示意图；
[0059]
图2为本发明实施例提供的毫米波
‑
激光雷达数据的特征生成方法流程示意图；
[0060]
图3为本发明实施例提供的待检测物的融合特征图生成方法流程示意图；
[0061]
图4为本发明实施例提供的一种环境重建装置结构示意图；
具体实施方式
[0062]
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
[0063]
图1示例性的示出了本发明新型实施例提供的一种环境重建方法流程示意图，如图1所示，该方法主要包括以下步骤：
[0064]
步骤101，根据待检测物的位置，依次设置激光雷达传感器、毫米波雷达传感器、双目视觉传感器，其中，激光雷达传感器、毫米波雷达传感器、双目视觉传感器和待检测物之间的距离、角度均为固定值；
[0065]
步骤102，所述激光雷达传感器和所述毫米波雷达传感器依次对所述待检测物进行扫描，分别得到激光雷达点云数据、激光雷达点云张量、毫米波雷达点云数据、毫米波雷达点云张量；将激光雷达点云张量和毫米波雷达点云张量进行卷积和最大池化，得到激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像；
[0066]
步骤103，将激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像输入至下采样卷积网络，得到毫米波
‑
激光雷达数据的特征；将所述毫米波
‑
激光雷达数据的特征和所述双目视觉传感器得到的双目视觉特征通过卷积神经网络，得到所述待检测物的融合特征图；
[0067]
步骤104，所述待检测物的融合特征图采用pcl poisson表面重建法重建，得到所述待检测物的三维图像。
[0068]
需要说明的是，本发明实施例所提供的环境重建方法，其主要应用了双目视觉传感器、激光雷达传感器、毫米波雷达传感器和机位。
[0069]
在步骤101之前，需要先完成对双目视觉传感器的标定、建立全局坐标系和确定坐标系转换公式，以下分别介绍这几块内容：
[0070]
1、对双目视觉传感器进行标定，其标定主要包括以下步骤：
[0071]
步骤s01：使用双目视觉传感器对标定板进行不同角度不同位置的拍摄10 张照片。可以从正前方、左前方、右前方等不同方位拍摄，要求标定板全部都在摄像范围内即可。
[0072]
步骤s02：针对双目视觉传感器的标定，本发明实施例采用的是张氏标定法，其已经在opencv库中进行集成，只需调用相关函数即可。因为标定图为黑白的正方形区域相互
交替组成，其黑白边缘的角点便可定位区域边界，所以通过调用findchessboardcorners函数判断输入图像是否为棋盘图像，然后将整幅图像转化为黑白图像，从而提取标定图的角点信息，将标定图各个区域的定位。同时因为相机成像的两个像素间仍有实际物理像素，称为亚像素，使用 cornersubpix函数针对每一张标定图片中的角点计算其周围的亚像素信息，可以更好的识别区域边缘信息，以提高标定精度。
[0073]
步骤s03：使用calibratecamera函数进行标定，计算相机内参和外参系数。其中内参数矩阵主要用于将摄像机坐标系中的点转化为像素点，外参数矩阵包括平移矩阵和旋转矩阵，主要用于将世界坐标系中的点转换到摄像机坐标系。
[0074]
步骤s104：通过相机内外参系数，将标定板上的三维点重新投影在图像上，计算新的投影坐标，然后计算亚像素角点坐标和投影坐标之间的偏差，利用标定结果对标定参数进行矫正。
[0075]
2、建立全局坐标系包括以下步骤：
[0076]
将激光雷达传感器、毫米波雷达传感器、双目视觉传感器和目标物依次设置，并且确定激光雷达传感器、毫米波雷达传感器、双目视觉传感器和目标物之间的距离和角度。
[0077]
根据上述激光雷达传感器、毫米波雷达传感器、双目视觉传感器和目标物确定的位置，先建立全局坐标系o0，然后根据激光雷达传感器、毫米波传感器和双目视觉传感器在全局坐标系内的位置，依次得到激光雷达传感器、毫米波传感器和双目视觉传感器相对于全局坐标系的激光雷达坐标o1、双目视觉坐标 o2和毫米波坐标o3。
[0078]
进一步地，根据目标物的位置，得到目标物在全局坐标系内的坐标(x0， y0，z0)；然后根据目标物分别在激光雷达坐标o1、双目视觉坐标o2和毫米波坐标o3的位置，得到目标物在激光雷达坐标系内的坐标(x1，y1，z1)，双目视觉坐标系内的坐标(x2，y2，z2)，毫米波坐标系内的坐标(x3，y3，z3)。
[0079]
进一步地，分别将激光雷达坐标o1、双目视觉坐标o2和毫米波坐标o3转换到全局坐标系，具体包括以下：
[0080]
将激光雷达坐标o1转换为全局坐标系，如公式(1)所示：
[0081][0082]
其中，r表示表示旋转参数，t表示平移参数，该数值需多次标定进行矫正，k表示激光雷达坐标o1转换为全局坐标系的转换矩阵。
[0083]
将双目视觉坐标o2转换为全局坐标系，如公式(2)所示：
[0084][0085]
其中，f表示相机的焦距，s表示双目视觉坐标o2转换为全局坐标系的转换矩阵。
[0086]
将毫米波坐标o3转换为全局坐标系，如公式(3)所示：
[0087][0088]
其中，θ表示毫米波雷达坐标系原点与全局坐标系原点和x坐标轴的角度， q表示毫米波坐标o3转换为全局坐标系的转换矩阵。
[0089]
进一步地，通过下列公式(4)确定毫米波传感器和激光雷达传感器之间的转换矩阵，通过下列公式(5)激光雷达传感器和视觉传感器之间的转换矩阵：
[0090][0091][0092]
其中，r＝k
‑1*q，t＝k
‑1*s；
[0093]
在步骤101中，根据上述确定的全局坐标和当前待检测物的位置，依次设置激光雷达传感器、毫米波雷达传感器、双目视觉传感器。
[0094]
需要说明的是，激光雷达传感器、毫米波雷达传感器、双目视觉传感器和待检测物之间的距离、角度均为固定值，即将待检测物的位置换到目标物的位置，激光雷达传感器、毫米波雷达传感器、双目视觉传感器保持原来位置不变即可。从而可以确定激光雷达传感器、毫米波雷达传感器、双目视觉传感器和目标检测物所组成的全局坐标系o0，激光雷达传感器、毫米波传感器和双目视觉传感器相对于全局坐标系的激光雷达坐标o1、双目视觉坐标o2和毫米波坐标o3。
[0095]
进一步地，还可以确定在该全局坐标系下，激光雷达坐标o1、双目视觉坐标o2和毫米波坐标o3转换到全局坐标系时所对应的转换公式；毫米波传感器和激光雷达传感器之间的转换矩阵；激光雷达传感器和视觉传感器之间的转换矩阵。
[0096]
在步骤102中，根据激光雷达传感器、毫米波雷达传感器、双目视觉传感器和目标检测物的位置，可以开始对目标检测物进行雷达扫描或者拍摄。
[0097]
在实际应用中，激光雷达传感器与毫米波雷达传感器所产生的传感数据均以三维点云数据为主，由于激光雷达传感器和毫米波雷达传感器都是无序的稀疏点云数据，为了使激光雷达传感器和毫米波雷达传感器能够良好的融合，本发明实施例中对激光雷达传感器和毫米波雷达传感器采取了点云柱快速编码方法。
[0098]
具体地，如图2所示，激光雷达传感器对待检测物进行扫描，得到激光雷达点云数据，在激光雷达点云数据中，以激光雷达传感器为中心，将激光雷达点云数据均匀划分为若干个立方柱体，每个点云柱中的点数约束为n个。
[0099]
进一步地，从获取到的激光雷达点云数据中提取(x1，y1，z1，i，x
c
，y
c
) 六个维度，其中(x1，y1，z1)表示三维点云坐标，i表示点云强度，(x
c
，y
c
)表示单个点云柱中点云的平均坐标值。将所有激光雷达点云数据进行编码，得到激光雷达点云张量(d，n，p)，其中，d是激光雷达所对应的整体点云柱的特征维度，n为单点云柱中点云数据的个数，p是非空点云柱柱
体的数量。
[0100]
具体地，毫米波雷达对待检测物进行扫描，得到毫米波雷达点云数据，在毫米波雷达点云数据中，以毫米波雷达传感器为中心，将毫米波雷达点云数据均匀划分为若干个立方柱体，每个点云柱中的点数约束为n个。
[0101]
进一步地，从获取到的激光雷达点云数据中提取(x2，y2，z2，v
x
，v
y
，rcs) 六个维度，其中(x2，y2，z2)表示三维点云坐标，(v
x
，v
y
)表示补偿速度，rcs 表示目标雷达散射面级。将所有激光雷达点云数据进行编码，得到激光雷达点云张量(m，n，p)，其中，m是毫米波雷达所对应的整体点云柱的特征维度， n为单点云柱中点云数据的个数，p是非空点云柱柱体的数量。
[0102]
得到激光雷达点云张量为(d，n，p)和毫米波雷达点云张量(m，n，p) 之后，可以分别对激光雷达点云张量和毫米波雷达点云张量进行卷积和最大池化操作，然后依次得到激光雷达特征矩阵和毫米波雷达特征矩阵。
[0103]
具体地，将激光雷达点云张量(d，n，p)进行c次1*1卷积并进行线性变化，对激光雷达包括的每个点云柱进行最大池化操作，得到激光雷达特征矩阵(c，p)；将毫米波雷达点云张量(m，n，p)进行c次1*1卷积并进行线性变化，对激光雷达包括的每个点云柱进行最大池化操作，得到毫米波雷达特征矩阵(c，p)。
[0104]
举例来说，将张量(d，n，p)进行c次1x1卷积，得到张量(c，n， p)。对张量(c，n，p)进行最大池化操作，得到特征矩阵(c，p)。
[0105]
c表示原有的特征维度经过c次卷积后得到的新的特征维度，可在实验中，尝试不同数据，观察效率最高的特征维度。最大池化操作表示为在同一个点云柱内的所有点，我们选取其最大值来表示该点云柱的点，针对张量(c，n，p)，选取n个点中的最大值，得到特征矩阵(c，p)。
[0106]
针对张量(d，n，p)，以特征维度为6，单个点云柱中点云数为5，非空点云柱数量为4，进行1次1x1卷积举例。针对上述提取的六个维度信息，建立5x4的矩阵，每个点都可以唯一表示某点云的某一个维度信息。针对6个 5x4矩阵，对其进行1次1x1卷积，其中卷积核使用2，在实际训练中，可以尝试不同卷积核所带来的效果，选取最佳卷积核。生成1个5x4矩阵，表示该点云仅有一个特征维度，表示张量为(1，n，p)。
[0107]
当得到激光雷达特征矩阵和毫米波雷达特征矩阵之后，可以根据激光雷达特征矩阵包括的非空点云柱数量、毫米波雷达特征矩阵包括的非空点云柱数量和检测范围内的原始位置，依次将激光雷达特征矩阵包括的非空点云柱和毫米波雷达特征矩阵包括的非空点云柱映射到检测范围内的原始位置，分别得到激光雷达二维点云伪图像和激光雷达二维点云伪图像。
[0108]
具体地，将激光雷达点云张量(d，n，p)进行c次1*1卷积并进行线性变化，对激光雷达包括的每个点云柱进行最大池化操作，得到激光雷达特征矩阵(c，p)，将p个非空点云柱内的点映射回检测范围内的原始位置，得到大小为(c，w，h)的激光雷达二维点云伪图像。将毫米波雷达点云张量(m， n，p)进行c次1*1卷积并进行线性变化，对激光雷达包括的每个点云柱进行最大池化操作，得到毫米波雷达特征矩阵(c，p)，将p个非空点云柱内的点映射回检测范围内的原始位置，得到大小为(c，w，h)的毫米波雷达二维点云伪图像；其中，c为正整数，表示卷积次数；w表示最右侧点减去最左侧点得到的图像宽度，h表示最上侧点减去最下
侧点得到的图像高度。
[0109]
映射方法采用下述公式：
[0110][0111][0112][0113]
其中，x_img和y_img表示特征点经过映射后生成二维点云伪图像的坐标， (x，y，z)表示特征点的三维坐标，h_res表示激光雷达(毫米波雷达)的水平角度分辨率(雷达自身参数，其分辨率取决于旋转速度)，v_res表示激光雷达 (毫米波雷达)的垂直角度分辨率，采用数据(d，z)填充二维点云伪图像中 (x_img，y_img)点处的数值。在二维点云伪图像中未出现的点，采用(0，0)填充。
[0114]
在步骤103中，激光雷达二维点云伪图像经过下采样卷积层，batchnorm 层和relu激活层得到纬度为(2c，w/2，h/2)激光雷达二维点云伪图像特征图；毫米波雷达二维点云伪图像经过下采样卷积层，batchnorm层和relu 激活层得到纬度为(2c，w/2，h/2)毫米波雷达二维点云伪图像特征图。
[0115]
具体地，大小为(c，w，h)的毫米波雷达二维点云伪图像经过1个大小1x1，采样步长设置为2的下采样卷积层，batchnorm层和relu激活层后得到维度为(2c，w/2，h/2)的特征图激光雷达点云图的特征，大小为(c， w，h)毫米波雷达二维点云伪图像经过1个大小1x1，采样步长设置为2的下采样卷积层，batchnorm层和relu激活层后得到维度为(2c，w/2，h/2) 毫米波雷达点云图的特征。
[0116]
在实际应用中，batchnorm层通过将归一化作为模型体系结构的一部分，并针对每个训练小批量执行归一化来获得其优势，使得下一层的非线性激活函数的输入在合理的范围内。
[0117]
batchnorm先求出此次批量数据x的均值m表示样本数。然后求出这一批次的方差对x做归一化∈是为防止出现除0的错误而设置的较小数，比如∈＝1e
‑
8。引入缩放和平移变量γ和β计算归一化后的值γ和β参数均由反向传播算法自动优化，实现网络层“按需”缩放平移数据的分布的目的。batchnorm层已经在深度学习pytorch和tensorflow中集成，通过通过batchnormalization()类可以非常方便地实现bn层。
[0118]
relu层主要是将bn层的输出结果做非线性映射。激活函数relu如下式所示，前向计算时只需输入值和0比较，即可得到输出值。
relu函数的导数为反向传播时梯度要么为0，要么不变，所以梯度的衰减很小，即使网路层数很深，前边层的收敛速度也不会很慢。因为bn层和relu层仅对数值做线性处理，所以特征图的维度仍为(2c，w/2，h/2)。
[0119]
进一步地，如图3所示，针对毫米波雷达二维点云伪图像特征图和激光雷达二维点云伪图像特征图，采用相加融合的方法，首先，采用上述步骤确定的激光雷达和毫米波雷达坐标转换矩阵，将毫米波雷达二维点云伪图像特征图特征点的坐标乘以转换矩阵得到该点在激光雷达特征图上的坐标表示，将毫米波雷达特征图中所有特征点均转换到激光雷达特征图上，即得到毫米波
‑
激光雷达数据的特征。
[0120]
进一步地，将毫米波
‑
激光雷达数据的特征和双目视觉特征输入到网络中进行特征融合，网络中将采用注意力融合方法，将毫米波
‑
激光雷达数据的特征和双目视觉特征进行点乘，将其结果利用softmax进行归一化，可以计算出毫米波
‑
激光雷达数据的特征图q和双目视觉特征图v的关系权重矩阵a，a 中各项计算如公式(9)(10)所示。在得到关系权重矩阵a后，将权重矩阵和双目视觉特征图相乘，即得到融合特征o。
[0121][0122]
o
j
＝∑
j
a
ij
·
v
j
ꢀꢀꢀ
(10)
[0123]
需要说明的是，在获得双目视觉特征之前，标定过的双目视觉传感器对待检测物进行拍摄，得到左右双目图像，将左右双目图像输入网络进行特征提取，该网络借鉴了语义分割网络unet的结构，包含下采样和上采样模块两部分构成。采用连续两次的编码
‑
解码结构相连接，能够有效的提取图像中的像素特征和空间信息，确保网络能够提取到图像中更宽泛的内容和更加全面的信息。其中下采样模块使用三个大小为3x3，步长为2的卷积核和池化层、全连接层组成，上采样模块使用大小为2x2，步长为2的转置卷积核进行上采样。残差式的网络结构能通过增加相当大的深度进而提高准确率，可以解决网络退化问题。将左右目图像分别输入到网络中，经过下采样模块后，再输入到上采样模块，将上采样模块输出的特征图与下采样模块输出的特征图通过拼接操作组合到一起，然后利用大小为3x3，步长为1的卷积层对拼接的数据结果进行整合，融合左右目图像信息，生成双目视觉特征图。
[0124]
在步骤103中，当获取到待检测物的融合特征图之后，待检测物的融合特征图可以采用pcl poisson表面重建法重建，得到待检测物的三维图像。
[0125]
综上所述，本发明实施例提供一种环境重建方法及装置，该方法包括：根据待检测物的位置，依次设置激光雷达传感器、毫米波雷达传感器、双目视觉传感器，其中，激光雷达传感器、毫米波雷达传感器、双目视觉传感器和待检测物之间的距离、角度均为固定值；所述激光雷达传感器和所述毫米波雷达传感器依次对所述待检测物进行扫描，分别得到激光雷达点云数据、激光雷达点云张量、毫米波雷达点云数据、毫米波雷达点云张量；将激光雷达点云张量和毫米波雷达点云张量进行卷积和最大池化，得到激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像；将激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像输入至下采样卷积网络，得到毫米波
‑
激光雷达数据的特征；将所述毫米波
‑
激光雷达数据的特征和所述双目视觉传感器得到的双目视觉特征通过卷积神经网络，得到所述待检测
物的融合特征图；所述待检测物的融合特征图采用pcl poisson表面重建法重建，得到所述待检测物的三维图像。该方法对获取到的激光雷达数据和毫米波雷达数据进行数据层预融合，对融合雷达数据和视觉数据进行特征层融合，可以有效避免因为环境变化导致的传感器误差；以目标为中心的融合神经网络模型，通过对多传感器数据特征提取融合重建，获取到精度更高的点云数据，从而完成高分辨率的三维模型；结合三种传感器的优点，通过对传感器收集到的数据进行融合，从而获得高精度的三维模型，满足环境重建和探测要求。解决现有环境检测重建中激光雷达和毫米波雷达在数据层的点云数据融合存在传感器误差、点云数据和像素数据的融合存在精度低的问题。
[0126]
基于同一发明构思，本发明实施例提供了一种环境重建装置，由于该装置解决技术问题的原理与一种环境重建方法相似，因此该装置的实施可以参见方法的实施，重复之处不再赘述。如图4所示，该装置主要包括设置单元201，第一得到单元202，第二得到单元203和第三得到单元204。
[0127]
设置单元201，用于根据待检测物的位置，依次设置激光雷达传感器、毫米波雷达传感器、双目视觉传感器，其中，激光雷达传感器、毫米波雷达传感器、双目视觉传感器和待检测物之间的距离、角度均为固定值；
[0128]
第一得到单元202，用于所述激光雷达传感器和所述毫米波雷达传感器依次对所述待检测物进行扫描，分别得到激光雷达点云数据、激光雷达点云张量、毫米波雷达点云数据、毫米波雷达点云张量；将激光雷达点云张量和毫米波雷达点云张量进行卷积和最大池化，得到激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像；
[0129]
第二得到单元203，用于将激光雷达二维点云伪图像和毫米波雷达的二维点云伪图像输入至下采样卷积网络，得到毫米波
‑
激光雷达数据的特征；将所述毫米波
‑
激光雷达数据的特征和所述双目视觉传感器得到的双目视觉特征通过卷积神经网络，得到所述待检测物的融合特征图；
[0130]
第三得到单元204，用于所述待检测物的融合特征图采用pcl poisson表面重建法重建，得到所述待检测物的三维图像。
[0131]
优选地，所述第二得到单元203具体用于：
[0132]
将所述激光雷达点云张量(d，n，p)进行c次1*1卷积并进行线性变化，对激光雷达包括的每个点云柱进行最大池化操作，得到激光雷达特征矩阵(c， p)，将p个非空点云柱内的点映射回检测范围内的原始位置，得到大小为(c，w，h)的激光雷达二维点云伪图像；
[0133]
将所述毫米波雷达点云张量(m，n，p)进行c次1*1卷积并进行线性变化，对激光雷达包括的每个点云柱进行最大池化操作，得到毫米波雷达特征矩阵(c，p)，将p个非空点云柱内的点映射回检测范围内的原始位置，得到大小为(c，w，h)的毫米波雷达二维点云伪图像；
[0134]
其中，c为正整数，表示卷积次数；w表示最右侧点减去最左侧点得到的图像宽度，h表示最上侧点减去最下侧点得到的图像高度；
[0135]
所述激光雷达二维点云伪图像经过下采样卷积层，batchnorm层和relu 激活层得到纬度为(2c，w/2，h/2)激光雷达二维点云伪图像特征图；
[0136]
所述毫米波雷达二维点云伪图像经过下采样卷积层，batchnorm层和 relu激活层得到纬度为(2c，w/2，h/2)毫米波雷达二维点云伪图像特征图；
[0137]
根据毫米波雷达二维点云伪图像特征图、全局坐标系下激光雷达传感器和毫米波传感器之间的转换矩阵，将毫米波雷达二维点云伪图像特征图所包括的特征点转换到所述激光雷达二维点云伪图像特征图上，得到毫米波
‑
激光雷达数据的特征。
[0138]
优选地，所述第二得到单元203具体包括：
[0139]
对双目视觉传感器得到左右双目图像进行卷积和池化处理，得到双目视觉特征；
[0140]
采用注意力融合方法将所述毫米波
‑
激光雷达数据的特征和所述双目视觉特征进行点乘，得到毫米波
‑
激光雷达数据的特征图和双目视觉特征图的关系权重矩阵；
[0141]
毫米波
‑
激光雷达数据的特征和双目视觉特征的关系权重矩阵和双目视觉特征图相乘，得到所述待检测物的融合特征图。
[0142]
应当理解，以上确定一种环境重建装置包括的单元仅为根据该设备装置实现的功能进行的逻辑划分，实际应用中，可以进行上述单元的叠加或拆分。并且该实施例提供的一种环境重建装置所实现的功能与上述实施例提供的一种环境重建方法一一对应，对于该装置所实现的更为详细的处理流程，在上述方法实施例一中已做详细描述，此处不再详细描述。
[0143]
尽管已描述了本发明的优选实施例，但本领域内的技术人员一旦得知了基本创造性概念，则可对这些实施例作出另外的变更和修改。所以，所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。
[0144]
显然，本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样，倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内，则本发明也意图包含这些改动和变型在内。