本发明涉及定位与地图构建,具体涉及一种基于定位匹配的地图构建方法、系统、存储介质及设备。
背景技术:
1、目前自动驾驶技术的发展和汽车智能化的趋势,自动驾驶已经逐步应用于实际场景,而无论建图和定位都需要处理传感器数据,进而得到较为准确的地图和定位结果。其中,泊车场景是自动驾驶领域里的一个重要应用领域,特别是泊车场景大部分场景缺少gps信号,因此这个场景的实现难度大于高速等场景。现有车辆大部分都装备有多个光学相机,只有高端车型才配备有激光雷达,但激光雷达的成本较高,且要求结构化环境才能有效匹配,如何应用好光学相机进行定位成为实现自动驾驶的最后一公里的关键一环。现有技术较多采用激光雷达配合深度学习来实现车辆自动驾驶时的定位,该方法受限于激光雷达的高成本和深度学习匹配模型算力的额外需求等原因,目前难以普及且发展还不成熟。
2、现有技术公开了一种点云地图处理方法、车道标注数据获取方法、设备及介质,旨在解决提高车道标注数据的准确性的问题。为此目的,该发明提供的点云地图处理方法包括根据车辆行驶过程中行驶环境的三维激光雷达点云建立行驶环境的三维点云地图,根据三维点云地图中每个三维激光雷达点云的激光反射强度,确定不清晰的三维激光雷达点云;根据车辆上图像采集装置采集到的行驶环境的二维图像的颜色信息,对不清晰的三维激光雷达点云进行着色处理,以进行可视化显示。该现有技术存在仅使用激光雷达采集点云进行点云地图的构建,鲁棒性较差的问题。
技术实现思路
1、本发明的目的在于提供一种鲁棒性好的基于定位匹配的地图构建方法、系统、存储介质及设备,以解决现有技术中的仅使用激光雷达采集点云进行点云地图的构建,鲁棒性较差的问题。
2、为了实现上述目的,本发明采用的技术方案如下:
3、一种基于定位匹配的地图构建方法,包括:
4、s1、通过车载光学相机获取车体环境数据集,对数据集进行预处理,得到预处理后的图像数据集;
5、s2、基于轻量型语义分割网络模型,对预处理后的图像数据集进行语义分割,获得语义分割图;
6、s3、根据语义分割图获得像素点对应的语义点云;
7、s4、获取目标车辆的车辆信息,根据车辆信息建立目标车辆的动力学模型;
8、s5、从预处理后的图像数据集选取连续的两帧图像,根据连续的两帧图像对动力学模型进行预积分,获得选取的连续的两帧图像的运动关系;
9、s6、根据获得的连续的两帧图像的运动关系对语义点云进行配准;
10、s7、将配准后的语义点云拼接起来,构成点云地图,同时获得车辆的定位信息。
11、优选的,在步骤s1中,所述车体环境数据集为车体环境的环视图片。
12、优选的,在步骤s3中,所述语义点云的公式如下:
13、p(x,y,z,s)=k-1ds
14、其中k为标定相机外参,d为深度信息,s为语义分割图上的像素点s(u,v)。
15、优选的,在步骤s3中,所述语义点云包括第一点云pk和第二点云pk+1;
16、在步骤s6中,所述对语义点云进行配准的过程为根据获得的连续的两帧图像的运动关系对第一点云pk和第二点云pk+1进行变换,得到变换点云,将变换点云与第一点云pk比较,找出第二点云pk+1中每一个点在第一点云pk中的语义类别相同的最近邻点,然后进行最优变换的计算。
17、优选的,所述根据获得的连续的两帧图像的运动关系对第一点云pk和第二点云pk+1进行变换,得到变换点云的公式为:
18、
19、其中和是点云pk和点云pk+1中一一对应的点,ws语义信息的权重;
20、设分别表示点云pk+1和点云pk的质心,归一化公式为:
21、
22、采用svd分解来计算点云配准的最优变换,假设对h进行svd分解得到h=uσvt,则配准问题的最优旋转公式为:
23、r*=vut
24、最优平移公式为:
25、
26、优选的,根据目标函数找出第二点云中每一个点在第一点云中的语义类别相同的最近邻点,所述目标函数为:
27、
28、其中和是点云pk和点云pk+1中一一对应的点,ws语义信息的权重。
29、优选的,在步骤s4中,所述动力学模型根据车辆上设置的陀螺仪和加速度计的测量估计获得,所述动力学模型如下:
30、
31、
32、其中白噪声为车体的加速度估计值,bat为车体的加速度传感器偏噪声,为车体陀螺仪的角速度估计值,bwt为车体的角速度传感器偏噪声。
33、本发明还提供一种基于定位匹配的地图构建系统,包括:
34、采集模块,用于采集相机拍摄的车辆周围环境信息;
35、数据预处理模块,用于对获取的车辆周围环境信息进行预处理;
36、语义分割模块,用于对预处理后的图像数据集进行语义分割,获得语义分割图;
37、点云获取模块,用于根据语义分割图获得像素点对应的语义点云;
38、点云配准模块,用于利用预设配准方法将所述当前语义点云进行icp配准,得到点云配准结果。
39、一种计算机存储介质,存储有计算机程序,所述计算机程序被处理器执行时,使得所述处理器执行上述任意一项所述的一种基于语义分割的定位匹配方法。
40、一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,所述计算机程序被所述处理器执行时,使得所述处理器执行上述任意一项所述的一种基于语义分割的定位匹配方法。
41、本发明的有益效果:通过采用车载光学相机获得数据集并进行语义分割,得到语义分割图,进而获得带语义类别的点云,构建车辆的动力学模型,结合点云的配准方法,构建带有语义信息的点云地图,实现对车辆的定位,鲁棒性更好。
1.一种基于定位匹配的地图构建方法,其特征在于,包括:
2.根据权利要求1所述的一种基于定位匹配的地图构建方法,其特征在于:在步骤s1中,所述车体环境数据集为车体环境的环视图片。
3.根据权利要求1所述的一种基于定位匹配的地图构建方法,其特征在于:在步骤s3中,所述语义点云的公式如下:
4.根据权利要求1所述的一种基于定位匹配的地图构建方法,其特征在于:在步骤s3中,所述语义点云包括第一点云pk和第二点云pk+1;
5.根据权利要求4所述的一种基于定位匹配的地图构建方法,其特征在于:所述根据获得的连续的两帧图像的运动关系对第一点云pk和第二点云pk+1进行变换,得到变换点云的公式为:
6.根据权利要求5所述的一种基于定位匹配的地图构建方法,其特征在于:根据目标函数找出第二点云中每一个点在第一点云中的语义类别相同的最近邻点,所述目标函数为:
7.根据权利要求1所述的一种基于定位匹配的地图构建方法,其特征在于:在步骤s4中,所述动力学模型根据车辆上设置的陀螺仪和加速度计的测量估计获得,所述动力学模型如下:
8.一种基于定位匹配的地图构建系统,其特征在于,包括:
9.一种计算机存储介质,其特征在于,存储有计算机程序,所述计算机程序被处理器执行时,使得所述处理器执行权利要求1~7任意一项所述的一种基于语义分割的定位匹配方法。
10.一种计算机设备,其特征在于,包括存储器和处理器,所述存储器存储有计算机程序,所述计算机程序被所述处理器执行时,使得所述处理器执行权利要求1~7任意一项所述的一种基于语义分割的定位匹配方法。