一种自动驾驶场景下的地图生成方法与流程

1.本发明涉及自主导航技术领域，尤其涉及一种自动驾驶场景下的地图生成方法。


背景技术：

2.随着汽车电子化、互联化、智能化的快速发展，自动驾驶作为解决未来交通出行的一项重要技术，已成为全球范围内汽车行业的研究热点和重要发展方向。自动驾驶的核心问题之一是定位，在此基础上其他自动驾驶任务如路径规划、决策控制才可以正常完成。传统的自动驾驶汽车定位方法通常依赖gps和ins的数据融合，但由于树木、岩石、建筑物等遮挡物的存在，gps信号容易丢失，加之imu的累积误差导致其精度快速降低。因此，同时定位与建图技术 (simultaneous localization and mapping，slam)逐渐成为自动驾驶领域的重要研究方向并且在过去的十年中取得非常快速的发展。
3.slam技术主要使用视觉或激光雷达传感器并融合其它多种传感器，如imu、gps、轮速计等以提供精确的六自由度状态估计和建立3d点云地图。基于视觉的slam主要信息来源于单目或深度像机输出的图像，其成本较低并且包含更多信息来构建稠密地图。然而， visual-slam对初始化、光照和检测范围很敏感，限制了其实际应用。而基于激光雷达的slam对干扰具有更强的鲁棒性，更适合应用于对安全性要求极高的自动驾驶领域。因此，如何基于激光雷达构建准确的稠密地图是亟待解决的问题。


技术实现要素：

4.有鉴于此，有必要提供一种自动驾驶场景下的地图生成方法，用以克服现有技术中在基于激光雷达构建地图的过程中缺少初始姿态信息、鲁棒性差、建图和定位精度低的问题。
5.本发明提供一种自动驾驶场景下的地图生成方法，包括：
6.获取imu信号、雷达信号和gps信号；
7.根据所述imu信号和gps信号，确定初始位姿；
8.根据所述imu信号和所述雷达信号进行局部优化融合，确定在所述初始位姿状态下的融合位姿，并选取其中的关键帧位姿；
9.根据所述gps信号和所述雷达信号，更新所述关键帧位姿，并进行全局优化，生成全局一致性点云地图。
10.进一步地，所述根据所述imu信号和gps信号，确定初始位姿包括：
11.根据所述imu信号，求解初始滚转角和初始俯仰角；
12.根据所述gps信号，将初始经度、初始纬度和初始高度分别映射为零；
13.将所述初始滚转角、所述初始俯仰角、所述初始经度、所述初始纬度、所述初始高度和未知的初始航向角构成数组，形成所述初始位姿。
14.进一步地，所述根据所述imu信号和所述雷达信号进行局部优化融合，确定在所述初始位姿状态下的融合位姿包括：
15.根据所述imu信号，确定零速检测信息；
16.根据所述零速检测信号，判断车辆行驶状态；
17.针对不同的车辆行驶状态，确定对应的imu预积分信息和雷达里程计信息，结合imu观测值、雷达里程计观测值进行局部优化融合，确定在所述初始位姿状态下的所述融合位姿；
18.其中，所述雷达里程信息为根据所述雷达信号中的点云数据帧进行非线性求解得到的两帧之间的位姿变化，所述imu预积分信息包括通过所述imu信号而确定的非线性求解初值和两帧之间的位姿输出。
19.进一步地，所述针对不同的车辆行驶状态，更新对应的imu预积分信息和雷达里程计信息，结合imu观测值、雷达里程计观测值进行局部优化融合，确定在所述初始位姿状态下的所述融合位姿包括：
20.当车辆行驶状态为运行时，更新所述imu预积分信息和所述雷达里程计信息，并基于增量式因子图优化的方式，结合所述imu观测值、所述雷达里程计观测值进行局部优化融合，确定所述融合位姿，并更新所述imu信号的偏置；
21.当车辆行驶状态为静止时，所述imu预积分信息和所述雷达里程计信息保持不变，当前位姿保持不变，并利用0位移更新所述imu 信号的偏置。
22.进一步地，所述局部优化融合通过如下公式表示：
[0023][0024]
其中，static表示车辆状态信息，当static＝1时，车辆行驶状态为静止，当static＝0时，车辆行驶状态为运动，pn表示第n帧的所述融合位姿，bn表示第n帧的所述imu信号的偏置，p
n-1
表示第n-1 帧的所述融合位姿，z＝{z
lidar
，zi}表示所述imu观测值、所述雷达里程计观测值的观测量集合，z
lidar
表示所述雷达里程计观测值，zi表示所述imu观测值，表示第n帧的雷达里程计观测值， p(pn，bn|z，p
n-1
)表示在所述观测量集合z和第n-1帧的所述融合位姿 p
n-1
的条件下，第n帧的所述融合位姿pn和第n帧的所述imu信号的偏置bn的联合概率，表示在第n帧的所述融合位姿pn和第n帧的所述imu信号的偏置bn的条件下，第n帧的雷达里程计观测值为0的概率，表示在第n帧的所述融合位姿 pn和第n帧的所述imu信号的偏置bn的条件下，第n帧imu观测值的概率，.表示在第n帧的所述融合位姿pn和第n 帧的所述imu信号的偏置bn的条件下，第n帧的雷达里程计观测值的概率，其中，第n帧的所述融合位姿pn通过增量式因子图优化进行求解。
[0025]
进一步地，所述选取其中的关键帧位姿包括：根据预设的位移间隔或旋转角度，在多帧所述融合位姿中，选取所述关键帧位姿。
[0026]
进一步地，所述根据所述gps信号和所述雷达信号，更新所述关键帧位姿，并进行
全局优化，生成全局一致性点云地图包括：
[0027]
根据所述gps信号和所述雷达信号，确定初始航向角；
[0028]
将所述初始航向角带入至所述关键帧位姿，确定对应的最终位姿，并将所述最终位姿和对应的点云数据映射在预设坐标系下；
[0029]
当接收到gps信号或回环检测信号时，对全局的所述最终位姿进行优化，生成所述全局一致性点云地图。
[0030]
进一步地，所述根据所述gps信号和所述雷达信号，确定初始航向角包括：
[0031]
分别根据所述gps信号和所述雷达信号，确定对应的gps输出位姿和雷达信号里程计输出位姿；
[0032]
根据所述gps输出位姿和所述雷达信号里程计输出位姿，确定与所述初始航向角的对应关系，通过如下公式表示：
[0033]
p
gps
≈p
lidarrz
(λ0)
[0034]
其中，p
gps
表示所述gps输出位姿，p
lidar
表示所述雷达信号里程计输出位姿，rz(λ0)表示绕z轴旋转所述初始航向角λ0；
[0035]
基于所述对应关系，建立对应的损失函数，通过ceres库进行求解所述初始航向角。
[0036]
进一步地，所述当接收到gps信号或回环检测信号时，对全局的所述最终位姿进行优化，生成所述全局一致性点云地图包括：
[0037]
当接收到gps信号或回环检测信号时，将所有所述最终位姿作为输入，输入至全局优化网络；
[0038]
基于位姿图优化的方式，对所述全局优化网络进行求解，将所述最终位姿进行融合优化，确定融合优化后的最佳位姿；
[0039]
根据所有所述最佳位姿，生成所述全局一致性点云地图。
[0040]
进一步地，所述全局优化网络包括贝叶斯网络，通过如下公式表下：
[0041][0042]
其中，表示所述融合优化后的最佳位姿组成的向量，表示第i帧的雷达里程计观测值，表示第j帧的gps信号的观测值，表示第h帧的回环检测信号的观测值，z＝{zo，z
gps
，z
l
}，表示雷达里程计观测值、gps信号的观测值和回环检测信号的观测值的集合，表示第i帧的最终位姿，表示第i-1帧的最终位姿，表示第j 帧的最终位姿，表示第h帧的最终位姿。
[0043]
与现有技术相比，本发明的有益效果包括：首先，对多种传感信号进行有效的获取，结合imu信号、雷达信号和gps信号，进行多方面的数据处理；然后，基于imu信号和gps信号，初步确定车辆的初始位姿；进而，结合imu信号和雷达信号进行局部优化融合，确定对应的融合位姿，并选取关键帧位姿；最后，进行全局优化，进一步保证生成地图的准确性。综上，本发明结合局部优化和全局优化，将多种传感器数据进行融合，实现高频率的精确定位
和全局一致性建图，解决了低成本激光雷达slam系统缺少初始姿态信息、鲁棒性差、建图和定位精度低的问题。
附图说明
[0044]
图1为本发明提供的自动驾驶场景下的地图生成方法的应用系统一实施例的场景示意图；
[0045]
图2为本发明提供的自动驾驶场景下的地图生成方法一实施例的流程示意图；
[0046]
图3为本发明提供的图2中步骤s2一实施例的流程示意图；
[0047]
图4为本发明提供的图2中步骤s3融合位姿一实施例的流程示意图；
[0048]
图5为本发明提供的图4中步骤s23一实施例的流程示意图；
[0049]
图6为本发明提供的图2中步骤s4一实施例的流程示意图；
[0050]
图7为本发明提供的图6中步骤s41一实施例的流程示意图；
[0051]
图8为本发明提供的图7中步骤s43一实施例的流程示意图；
[0052]
图9为本发明提供的全局优化网络一实施例的结构示意图；
[0053]
图10为本发明提供的自动驾驶场景下的地图生成装置一实施例的结构示意图；
[0054]
图11为本发明提供的自动驾驶场景下的地图生成系统一实施例的结构示意图；
[0055]
图12为本发明提供的系统技术流程一实施例的技术框示意图。
具体实施方式
[0056]
下面结合附图来具体描述本发明的优选实施例，其中，附图构成本技术一部分，并与本发明的实施例一起用于阐释本发明的原理，并非用于限定本发明的范围。
[0057]
在本发明的描述中，术语“第一”、“第二”仅用于描述目的，而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。此外，“多个”的含义是至少两个，例如两个，三个等，除非另有明确具体的限定。
[0058]
在本发明的描述中，提及“实施例”意味着，结合实施例描述的特定特征、结构或特性可以包含在本发明的至少一个实施例中。在说明书中的各个位置出现该短语并不一定均是指相同的实施例，也不是与其它实施例互斥的独立的或备选的实施例。本领域技术人员显式地和隐式地理解的是，所描述的实施例可以与其它实施例相结合。
[0059]
本发明提供了一种自动驾驶场景下的地图生成方法，应用于自动驾驶过程中，有效融合传感数据，结合局部优化和全局优化，生成准确的位姿，为进一步提高基于雷达数据建立的稠密地图的准确性提供了新思路。以下分别进行详细说明：
[0060]
本发明实施例提供了一种自动驾驶场景下的地图生成方法的应用系统，图1为本发明提供的自动驾驶场景下的地图生成方法的应用系统一实施例的场景示意图，该系统可以包括服务器100，服务器100 中集成有自动驾驶场景下的地图生成装置，如图1中的服务器。
[0061]
本发明实施例中服务器100主要用于：
[0062]
获取imu信号、雷达信号和gps信号；
[0063]
根据所述imu信号和gps信号，确定初始位姿；
[0064]
根据所述imu信号和所述雷达信号进行局部优化融合，确定在所述初始位姿状态下的融合位姿，并选取其中的关键帧位姿；
[0065]
根据所述gps信号和所述雷达信号，更新所述关键帧位姿，并进行全局优化，生成全局一致性点云地图。
[0066]
本发明实施例中，该服务器100可以是独立的服务器，也可以是服务器组成的服务器网络或服务器集群，例如，本发明实施例中所描述的服务器100，其包括但不限于计算机、网络主机、单个网络服务器、多个网络服务器集或多个服务器构成的云服务器。其中，云服务器由基于云计算(cloud computing)的大量计算机或网络服务器构成。
[0067]
可以理解的是，本发明实施例中所使用的终端200可以是既包括接收和发射硬件的设备，即具有能够在双向通信链路上，执行双向通信的接收和发射硬件的设备。这种设备可以包括：蜂窝或其他通信设备，其具有单线路显示器或多线路显示器或没有多线路显示器的蜂窝或其他通信设备。具体的终端200可以是台式机、便携式电脑、网络服务器、掌上电脑(personal digital assistant，pda)、移动手机、平板电脑、无线终端设备、通信设备、嵌入式设备等，本实施例不限定终端200的类型。
[0068]
本领域技术人员可以理解，图1中示出的应用环境，仅仅是与本发明方案一种应用场景，并不构成对本发明方案应用场景的限定，其他的应用环境还可以包括比图1中所示更多或更少的终端，例如图1 中仅示出2个终端，可以理解的，该自动驾驶场景下的地图生成方法的应用系统还可以包括一个或多个其他终端，具体此处不作限定。
[0069]
另外，如图1所示，该自动驾驶场景下的地图生成方法的应用系统还可以包括存储器200，用于存储数据，如imu信号、雷达信号和gps信号和关键帧位姿等。
[0070]
需要说明的是，图1所示的自动驾驶场景下的地图生成方法的应用系统的场景示意图仅仅是一个示例，本发明实施例描述的自动驾驶场景下的地图生成方法的应用系统以及场景是为了更加清楚的说明本发明实施例的技术方案，并不构成对于本发明实施例提供的技术方案的限定，本领域普通技术人员可知，随着自动驾驶场景下的地图生成方法的应用系统的演变和新业务场景的出现，本发明实施例提供的技术方案对于类似的技术问题，同样适用。
[0071]
本发明实施例提供了一种自动驾驶场景下的地图生成方法，结合图2来看，图2为本发明提供的自动驾驶场景下的地图生成方法一实施例的流程示意图，包括步骤s1至步骤s4，其中：
[0072]
在步骤s1中，获取imu信号、雷达信号和gps信号；
[0073]
在步骤s2中，根据所述imu信号和gps信号，确定初始位姿；
[0074]
在步骤s3中，根据所述imu信号和所述雷达信号进行局部优化融合，确定在所述初始位姿状态下的融合位姿，并选取其中的关键帧位姿；
[0075]
在步骤s4中，根据所述gps信号和所述雷达信号，更新所述关键帧位姿，并进行全局优化，生成全局一致性点云地图。
[0076]
在本发明实施例中，首先，对多种传感信号进行有效的获取，结合imu信号、雷达信号和gps信号，进行多方面的数据处理；然后，基于imu信号和gps信号，初步确定车辆的初始位姿；进而，结合 imu信号和雷达信号进行局部优化融合，确定对应的融合位姿，并选取关键帧位姿；最后，进行全局优化，进一步保证生成地图的准确性。
[0077]
需要说明的是，整个算法流程可以描述为：
[0078]
第一，系统启动后，获取imu信号、雷达信号和gps信号；
[0079]
第二，进行初始位姿解算，通过imu解算α0，β0。读取此时的gps 值将此时的经纬高映射为[0，0，0]；
[0080]
第三，通过局部优化融合lidar里程计信号、imu预积分信号和零速检测信号得到优化后的车辆位姿。其中雷达帧位姿按固定的位移距离或者旋转角度选取为关键帧位姿。
[0081]
第四，将接收的gps信号和雷达里程计信号解算初始航向角λ0，并回溯更新之前的关键帧位姿和对应的点云将其映射在utm坐标系上；解算完成初始航向角λ0之后，在接收到gps信号或者回环检测信号时，对全局的所有关键帧进行优化，得到全局一致性点云地图。
[0082]
作为优选的实施例，结合图3来看，图3为本发明提供的图2中步骤s2一实施例的流程示意图，包括步骤s21至步骤s23，其中：
[0083]
在步骤s21中，根据所述imu信号，求解初始滚转角和初始俯仰角；
[0084]
在步骤s22中，根据所述gps信号，将初始经度、初始纬度和初始高度分别映射为零；
[0085]
在步骤s23中，将所述初始滚转角、所述初始俯仰角、所述初始经度、所述初始纬度、所述初始高度和未知的初始航向角构成数组，形成所述初始位姿。
[0086]
在本发明实施例中，结合imu信号和gps信号，对初始位姿进行有效求解。
[0087]
在本发明一个具体的实施例中，初始位姿解算主要由imu信号和gps信号来解算初始位姿p0＝[x0，y0，z0，α0，β0，γ0]，其中初始位置 [x0，y0，z0]为[0，0，0]，初始姿态中滚转角、俯仰角可以由imu静态解算得到，设imu接收到的数据为[a
x
，ay，az，ω
α
，ω
β
，ω
λ
]，则初始滚转角α0、俯仰角β0为：
[0088][0089]
作为优选的实施例，结合图4来看，图4为本发明提供的图2中步骤s3融合位姿一实施例的流程示意图，包括步骤s21至步骤s23，其中：
[0090]
在步骤s31中，根据所述imu信号，确定零速检测信息；
[0091]
在步骤s22中，根据所述零速检测信号，判断车辆行驶状态；
[0092]
在步骤s23中，针对不同的车辆行驶状态，确定对应的imu预积分信息和雷达里程计信息，结合imu观测值、雷达里程计观测值进行局部优化融合，确定在所述初始位姿状态下的所述融合位姿；
[0093]
其中，所述雷达里程信息为根据所述雷达信号中的点云数据帧进行非线性求解得到的两帧之间的位姿变化，所述imu预积分信息包括通过所述imu信号而确定的非线性求解初值和两帧之间的位姿输出。
[0094]
在本发明实施例中，通过零速检测信号，判断车辆的静止与否，进行结合imu观测值、雷达里程计观测值进行局部优化融合。
[0095]
作为优选的实施例，上述零速检测信号对应的零速检测模块基于广义似然比检测
(glrt)来判定车辆静止状态。在本发明实施例中，采用广义似然比检测对车辆是否静止进行有效的判断。需要说明的是，本发明实施例采用构建零速检测模块的方式，利用零速检测信号，判断车辆行驶状态，其判别方法包括但不限于上述广义似然比检测方式，只要能达到准确判别的目的即可。
[0096]
作为优选的实施例，结合图5来看，图5为本发明提供的图4中步骤s23一实施例的流程示意图，包括步骤s231至步骤s232，其中：
[0097]
在步骤s231中，当车辆行驶状态为运行时，更新所述imu预积分信息和所述雷达里程计信息，并基于增量式因子图优化的方式，结合所述imu观测值、所述雷达里程计观测值进行局部优化融合，确定所述融合位姿，并更新所述imu信号的偏置；
[0098]
在步骤s232中，当车辆行驶状态为静止时，所述imu预积分信息和所述雷达里程计信息保持不变，当前位姿保持不变，并利用0位移更新所述imu信号的偏置。
[0099]
在本发明实施例中，针对不同的车辆行驶状态，进行局部优化融合，同时更新imu信号的偏置。
[0100]
作为优选的实施例，所述局部优化融合通过如下公式表示：
[0101][0102]
其中，static表示车辆状态信息，当static＝1时，车辆行驶状态为静止，当static＝0时，车辆行驶状态为运动，pn表示第n帧的所述融合位姿，bn表示第n帧的所述imu信号的偏置，p
n-1
表示第n-1 帧的所述融合位姿，z＝{z
lidar
，zi}表示所述imu观测值、所述雷达里程计观测值的观测量集合，z
lidar
表示所述雷达里程计观测值，zi表示所述imu观测值，表示第n帧的雷达里程计观测值， p(pn，bn|z，p
n-1
)表示在所述观测量集合z和第n-1帧的所述融合位姿 p
n-1
的条件下，第n帧的所述融合位姿pn和第n帧的所述imu信号的偏置bn的联合概率，表示在第n帧的所述融合位姿pn和第n帧的所述imu信号的偏置bn的条件下，第n帧的雷达里程计观测值为0的概率，表示在第n帧的所述融合位姿 pn和第n帧的所述imu信号的偏置bn的条件下，第n帧imu观测值的概率，表示在第n帧的所述融合位姿pn和第n 帧的所述imu信号的偏置bn的条件下，第n帧的雷达里程计观测值的概率，其中，第n帧的所述融合位姿pn通过增量式因子图优化进行求解。
[0103]
在本发明实施例中，基于上述公式，结合多方面信息，进行高效的局部融合位姿，并更新偏置。
[0104]
在本发明一个具体的实施例中，局部优化的流程可以描述为：
[0105]
第一，零速检测模块接收imu信号并判定车辆是否静止，随后输出车辆状态信息static；
[0106]
第二，如果static＝0表示车辆处于运行状态，此时lidar里程计模块和imu预积分
之后，在接收到gps信号或者回环检测信号时，对全局的所有关键帧进行优化，得到全局一致性点云地图。
[0119]
作为优选的实施例，结合图7来看，图7为本发明提供的图6中步骤s41一实施例的流程示意图，包括步骤s411至步骤s413，其中：
[0120]
在步骤s411中，分别根据所述gps信号和所述雷达信号，确定对应的gps输出位姿和雷达信号里程计输出位姿；
[0121]
在步骤s412中，根据所述gps输出位姿和所述雷达信号里程计输出位姿，确定与所述初始航向角的对应关系，通过如下公式表示：
[0122]
p
gps
≈p
lidarrz
(λ0)
[0123]
其中，p
gps
表示所述gps输出位姿，p
lidar
表示所述雷达信号里程计输出位姿，rz(λ0)表示绕z轴旋转所述初始航向角λ0；
[0124]
在步骤s413中，基于所述对应关系，建立对应的损失函数，通过ceres库进行求解所述初始航向角。
[0125]
在本发明实施例中，基于所述gps输出位姿、所述雷达信号里程计输出位姿、所述初始航向角的对应关系，进行有效的初始航向角求解。
[0126]
作为优选的实施例，结合图8来看，图8为本发明提供的图7中步骤s43一实施例的流程示意图，包括步骤s431至步骤s433，其中：
[0127]
在步骤s431中，当接收到gps信号或回环检测信号时，将所有所述最终位姿作为输入，输入至全局优化网络；
[0128]
在步骤s432中，基于位姿图优化的方式，对所述全局优化网络进行求解，将所述最终位姿进行融合优化，确定融合优化后的最佳位姿；
[0129]
在步骤s433中，根据所有所述最佳位姿，生成所述全局一致性点云地图。
[0130]
在本发明实施例中，基于位姿图优化的方式进行进一步的全局融合求解，生成最佳位姿，由此构建全局一致性点云地图。
[0131]
作为优选的实施例，所述全局优化网络包括贝叶斯网络，通过如下公式表示：
[0132][0133]
其中，表示所述融合优化后的最佳位姿组成的向量，表示第i帧的雷达里程计观测值，表示第j帧的gps信号的观测值，表示第h帧的回环检测信号的观测值，z＝{zo，z
gps
，z
l
}，表示雷达里程计观测值、gps信号的观测值和回环检测信号的观测值的集合，表示第i帧的最终位姿，表示第i-1帧的最终位姿，表示第j 帧的最终位姿，表示第h帧的最终位姿。
[0134]
在本发明一个具体的实施例中，结合图9来看，图9为本发明提供的全局优化网络一实施例的结构示意图，将局部优化中lidar帧的位姿按固定的位移距离或者旋转角度选取为关键帧位姿，并作为全局优化的其中一个输入。全局优化在能接收到gps信号或者回环检测信号的时候将其接收作为输入，通过位姿图优化的方式对接收到的信息进行融合优
化，得到全局一致性的点云地图。全局优化作为贝叶斯网络可以以图9示意。
[0135]
本发明实施例还提供了一种自动驾驶场景下的地图生成装置，结合图10来看，图10为本发明提供的自动驾驶场景下的地图生成装置一实施例的结构示意图，包括：
[0136]
获取单元1001，用于获取imu信号、雷达信号和gps信号；
[0137]
处理单元1002，用于根据所述imu信号和gps信号，确定初始位姿；还用于根据所述imu信号和所述雷达信号进行局部优化融合，确定在所述初始位姿状态下的融合位姿，并选取其中的关键帧位姿
[0138]
地图生成单元1003，用于根据所述gps信号和所述雷达信号，更新所述关键帧位姿，并进行全局优化，生成全局一致性点云地图。
[0139]
自动驾驶场景下的地图生成装置的各个单元的更具体实现方式可以参见对于本发明的自动驾驶场景下的地图生成方法的描述，且具有与之相似的有益效果，在此不再赘述。
[0140]
本发明实施例还提供了一种计算机可读存储介质，其上存储有计算机程序，该程序被处理器执行时，实现如上所述的自动驾驶场景下的地图生成方法。
[0141]
一般来说，用于实现本发明方法的计算机指令的可以采用一个或多个计算机可读的存储介质的任意组合来承载。非临时性计算机可读存储介质可以包括任何计算机可读介质，除了临时性地传播中的信号本身。
[0142]
计算机可读存储介质例如可以是——但不限于——电、磁、光、电磁、红外线、或半导体的系统、装置或器件，或者任意以上的组合。计算机可读存储介质的更具体的例子(非穷举的列表)包括：具有一个或多个导线的电连接、便携式计算机磁盘、硬盘、随机存取存储器 (ram)、只读存储器(rom)、可擦式可编程只读存储器(eprom或闪存)、光纤、便携式紧凑磁盘只读存储器(cd-rom)、光存储器件、磁存储器件、或者上述的任意合适的组合。在本文件中，计算机可读存储介质可以是任何包含或存储程序的有形介质，该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。
[0143]
可以以一种或多种程序设计语言或其组合来编写用于执行本发明操作的计算机程序代码，程序设计语言包括面向对象的程序设计语言-诸如java、smalltalk、c ，还包括常规的过程式程序设计语言
ꢀ‑
诸如“c”语言或类似的程序设计语言，特别是可以使用适于神经网络计算的python语言和基于tensorflow、pytorch等平台框架。程序代码可以完全地在用户计算机上执行、部分地在用户计算机上执行、作为一个独立的软件包执行、部分在用户计算机上部分在远程计算机上执行、或者完全在远程计算机或服务器上执行。在涉及远程计算机的情形中，远程计算机可以通过任意种类的网络——包括局域网 (lan)或广域网(wan)-连接到用户计算机，或者，可以连接到外部计算机(例如利用因特网服务提供商来通过因特网连接)。
[0144]
本发明实施例还提供了一种计算设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，处理器执行程序时，实现如上所述的自动驾驶场景下的地图生成方法。
[0145]
根据本发明上述实施例提供的计算机可读存储介质和计算设备，可以参照根据本发明实现如上所述的自动驾驶场景下的地图生成方法具体描述的内容实现，并具有与如上所述的自动驾驶场景下的地图生成方法类似的有益效果，在此不再赘述。
[0146]
本发明实施例还提供一种自动驾驶场景下的地图生成系统，结合图11来看，图11为本发明提供的自动驾驶场景下的地图生成系统一实施例的结构示意图，包括雷达传感器装置、imu传感器装置、gps 定位装置和如上所述的计算设备，其中：
[0147]
所述雷达传感器装置，用于获取雷达信号，基于tcp/ip将雷达点云数据传输到计算设备上；
[0148]
所述imu传感器装置，用于获取imu信号，基于can总线将 imu信号传输到计算设备上；
[0149]
所述gps定位装置，用于获取gps信号，基于串口将gps信号传输到计算设备上；
[0150]
所述计算设备，用于实现如上所述的自动驾驶场景下的地图生成方法。
[0151]
在本发明一个具体的实施例中，所述雷达传感器装置为16线激光雷达leishen c-16lidar，所述imu传感器装置为6轴惯性测量单元vigor technology tt810imu，所述gps定位装置为单点全球定位系统，所述计算设备为以英伟达公司的jetson tx2作为计算单元，系统使用自动驾驶车辆作为移动平台，传感器由16线激光雷达 leishen c-16lidar、6轴惯性测量单元vigor technology tt810 imu和单点全球定位系统(gps)组成，以英伟达公司的jetson tx2作为计算单元，在其上运行机器人操作系统(robot operating system，ros)。lidar基于tcp/ip将点云数据传输到tx2上，通过lidar驱动程序解析数据并封装入sensormsgs/pointclouds2数据结构中。imu 基于can总线将数据发布到can网络上，tx2通过usb-can总线转换器读取can网络上imu信息，通过imu驱动解析数据并封装入sensormsgs/imu数据结构中。gps基于串口将数据传输到tx2，通过gps驱动将串口数据解析并封装入sensor_msgs/navsatfix数据结构中。
[0152]
其中，结合图12来看，图12为本发明提供的系统技术流程一实施例的技术框示意图。系统主要由初始位姿解算、局部优化定位和全局优化建图组成，系统的主要求解状态为其中 p＝[x，y，z，α，β，γ]代表车辆在东北天坐标系(enu)中的位姿，其中 x，y，z，α，β，γ分别代表在x/y/z轴的坐标和滚转角、俯仰角、航向角。b 代表imu的偏置。代表关键帧的位姿，关键帧的lidar点云一起组成了点云地图。
[0153]
本发明公开了一种自动驾驶场景下的地图生成方法，首先，对实测目的层的压力参数、应力参数和应变关系参数进行有效获取，反馈实测目的层的压力情况、应力情况、应变关系情况；然后，结合多种参数，确定不同的第一指数、第二指数和第三指数；最后，通过第一指数、第二指数和第三指数，综合多方面因素，确定实测目的层的预测压力，并基于此进行判断是否是可能存在油气的区域。
[0154]
本发明技术方案，结合局部优化和全局优化，将多种传感器数据进行融合，实现高频率的精确定位和全局一致性建图，解决了低成本激光雷达slam系统缺少初始姿态信息、鲁棒性差、建图和定位精度低的问题。
[0155]
以上所述，仅为本发明较佳的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到的变化或替换，都应涵盖在本发明的保护范围之内。