【技术实现步骤摘要】
本专利技术涉及自动驾驶，尤其涉及一种车辆位姿信息处理方法、装置、设备及存储介质。
技术介绍
1、车辆实时定位是自动驾驶系统中不可或缺的关键模块，车辆实时定位系统为下游的规划、感知模块提供车辆实时位姿信息，方便车辆更好地决策和控制。目前主流的车辆定位方案多是采用多传感器融合的方案，融合惯性测量单元(inertial measurement unit，imu)、全球定位系统(global positioning system，gps)、激光雷达(laser radar，lidar)以及轮速计来实现多场景下的车辆定位。利用各种传感器的互补性，这类方案可以覆盖大多数场景下的精确定位任务，但在隧道等退化场景中，gps信号的弱，在隧道环境下确定的位姿信息误差大，而且由于大多数隧道都不存在明显的纹理特征，基于通用lidar的位姿信息处理方案通常也会失效，难以给出准确的纵向位置，仍存在定位困难的问题。
2、解决隧道等退化场景中的定位问题，可以采用室内辅助定位方案，比如超宽带(ultra wide band，uwb)技术，wi-fi定位等，但是，在长隧道中采用uwb或者wi-fi的方案则需要额外的设备铺设成本和政策支持，代价较大。目前，大多数方案都是依赖精确校准的轮速计提供相对准确的纵向位置，而依赖轮速计的方案有较多局限性，一是即使轮速计经过精确校准，其在长时间积分后还是会产生较大的累积误差；另一方面就是轮速本身的校准参数也会随着时间改变，一旦在进入隧道时未得到准确的校准参数，即使隧道不长，也依然会产生较大的累积误差，因此，如何在隧道
技术实现思路
1、本专利技术提供了一种车辆位姿信息处理方法、装置、设备及存储介质，用于提取隧道场景中有效的点云特征，进行车辆位姿信息处理，降低隧道中车辆位姿信息处理对轮速计的依赖，实现隧道场景中全程可靠精确定位，也不需要引入额外的辅助设备，降低了隧道场景中确定车辆位姿信息成本。
2、本专利技术第一方面提供了一种车辆位姿信息处理方法，包括：获取车辆当前隧道点云数据和传感器检测数据；对当前隧道点云数据进行点云特征提取，得到多个点云特征，多个点云特征至少包括隧道附属物特征；根据传感器检测数据进行计算，得到初始车辆位姿信息；根据多个点云特征、初始车辆位姿信息和预置的点云特征地图进行匹配，得到目标车辆位姿信息。
3、在一种可行的实施方式中，对当前隧道点云数据进行点云特征提取，得到多个点云特征，包括：对当前隧道点云数据进行隧道附属物特征提取，得到至少一个隧道附属物特征；对当前隧道点云数据进行近地特征提取，得到多个近地特征；将至少一个隧道附属物特征和多个近地特征，确定为当前隧道点云数据对应的多个点云特征。
4、在一种可行的实施方式中，对当前隧道点云数据进行隧道附属物特征提取，得到至少一个隧道附属物特征，包括：对当前隧道点云数据进行地面点过滤，得到多个非地面点；对多个非地面点进行隧道附属物边缘点提取，得到多个隧道附属物边缘点；根据多个隧道附属物边缘点生成至少一个隧道附属物特征。
5、在一种可行的实施方式中，对当前隧道点云数据进行近地特征提取，得到多个近地特征，包括：对当前隧道点云数据进行近地特征提取，得到路沿特征、地面特征、路面标示线特征；将路沿特征、地面特征和路面标示线特征组合为多个近地特征。
6、在一种可行的实施方式中，根据多个点云特征、初始车辆位姿信息和预置的点云特征地图进行匹配，得到目标车辆位姿信息，包括：获取当前车辆速度，并根据当前车辆速度对多个点云特征中每个点云特征进行运动补偿，得到多个补偿后的点云特征；根据初始车辆位姿信息和预置的点云特征地图，生成局部点云特征地图；将多个补偿后的点云特征和局部点云特征地图进行匹配，得到总匹配误差；根据总匹配误差对初始车辆位姿信息进行优化，得到目标车辆位姿信息。
7、在一种可行的实施方式中，根据总匹配误差对初始车辆位姿信息进行优化，得到目标车辆位姿信息，包括：对总匹配误差进行解析，得到多个特征点的匹配误差；根据每个特征点的匹配误差对初始车辆位姿信息进行约束，得到目标车辆位姿信息。
8、在一种可行的实施方式中，多个特征点包括隧道附属物特征点、路沿特征点、地面点和路面标示线点，根据每个特征点的匹配误差对初始车辆位姿5信息进行约束，得到目标车辆位姿信息，包括：根据每个隧道附属物特征点
9、的匹配误差和每个路面标示线点的匹配误差对初始车辆位姿信息进行纵向位置约束和横向位置约束，得到第一车辆位姿信息；根据每个路沿特征点的匹配误差对第一车辆位姿信息进行横向位置约束和偏航角约束，得到第二车辆
10、位姿信息；根据每个地面点的匹配误差对第二车辆位姿信息进行高度位置约0束、俯仰角约束和翻滚角约束，得到目标车辆位姿信息。
11、在一种可行的实施方式中，根据多个点云特征、初始车辆位姿信息和预置的点云特征地图进行匹配，得到目标车辆位姿信息，包括：根据每个点云特征对应的匹配策略，将多个点云特征中每个特征点与预置的点云特征地图
12、进行匹配，并计算每个特征点的匹配误差，得到总匹配误差；根据总匹配误5差对初始车辆位姿信息进行优化，得到平滑车辆位姿信息；根据平滑车辆位姿信息进行匹配迭代，直至满足迭代终止条件，得到目标车辆位姿信息。
13、在一种可行的实施方式中，点云特征地图包括多个匹配点，根据每个点云特征对应的匹配策略，将多个点云特征与预置的点云特征地图进行匹配，
14、并计算每个特征点的匹配误差，得到总匹配误差，包括：根据点面匹配策略0计算多个点云特征中每个地面点与预置的点云特征地图中多个匹配点所在平
15、面的距离，得到第一匹配误差；根据点线匹配策略计算多个点云特征中其他特征的每个特征点与点云特征地图中两个最近匹配点所在直线的距离，得到第二匹配误差，其他特征包括隧道附属物特征、路面标示线特征和路沿特征；
16、将第一匹配误差和第二匹配误差进行运算，得到总匹配误差。
17、5在一种可行的实施方式中，在根据点面匹配策略计算多个点云特征中每个地面点与预置的点云特征地图中多个匹配点所在平面的距离，得到第一匹配误差之后，还包括：根据点点匹配策略计算多个点云特征中其他特征的每个特征点与点云特征地图中各个匹配点的距离，并将最小距离确定为第三匹配误差；将第一匹配误差、第三匹配误差进行运算，得到总匹配误差。
18、0在一种可行的实施方式中，在根据点面匹配策略计算多个点云特征中每个地面点与预置的点云特征地图中多个匹配点所在平面的距离，得到第一匹配误差之后，还包括：根据点点匹配策略和预置的第一距离范围确定多个点云特征中其他特征的每个特征点在点云特征地图中对应的多个匹配点；计算每个特征点与多个匹配点的距离均值，并将距离均值确定为第四匹配误差；将第一匹配误差、第四匹配误差进行运算，得到总匹配误差。
19、在一种可行的实施方式中，在根据本文档来自技高网...
【技术保护点】
1.一种车辆位姿信息处理方法，其特征在于，所述车辆位姿信息处理方法包括：
2.根据权利要求1所述的车辆位姿信息处理方法，其特征在于，所述对所述当前隧道点云数据进行点云特征提取，得到多个点云特征，包括：
3.根据权利要求2所述的车辆位姿信息处理方法，其特征在于，所述对所述当前隧道点云数据进行隧道附属物特征提取，得到至少一个隧道附属物特征，包括：
4.根据权利要求2所述的车辆位姿信息处理方法，其特征在于，所述对所述当前隧道点云数据进行近地特征提取，得到多个近地特征，包括：
5.根据权利要求1所述的车辆位姿信息处理方法，其特征在于，所述根据所述多个点云特征、所述初始车辆位姿信息和预置的点云特征地图进行匹配，得到目标车辆位姿信息，包括：
6.根据权利要求5所述的车辆位姿信息处理方法，其特征在于，所述根据所述总匹配误差对所述初始车辆位姿信息进行优化，得到目标车辆位姿信息，包括：
7.根据权利要求6所述的车辆位姿信息处理方法，其特征在于，所述多个特征点包括隧道附属物特征点、路沿特征点、地面点和路面标示线点，所述根据每个特
8.根据权利要求1所述的车辆位姿信息处理方法，其特征在于，所述根据所述多个点云特征、所述初始车辆位姿信息和预置的点云特征地图进行匹配，得到目标车辆位姿信息，包括：
9.根据权利要求8所述的车辆位姿信息处理方法，其特征在于，所述点云特征地图包括多个匹配点，所述根据所述每个点云特征对应的匹配策略，将所述多个点云特征与预置的点云特征地图进行匹配，并计算每个特征点的匹配误差，得到总匹配误差，包括：
10.根据权利要求9所述的车辆位姿信息处理方法，其特征在于，在所述根据点面匹配策略计算所述多个点云特征中每个地面点与预置的点云特征地图中多个匹配点所在平面的距离，得到第一匹配误差之后，还包括：
11.根据权利要求9所述的车辆位姿信息处理方法，其特征在于，在所述根据点面匹配策略计算所述多个点云特征中每个地面点与预置的点云特征地图中多个匹配点所在平面的距离，得到第一匹配误差之后，还包括：
12.根据权利要求1所述的车辆位姿信息处理方法，其特征在于，在所述根据所述多个点云特征、所述初始车辆位姿信息和预置的点云特征地图进行匹配，得到目标车辆位姿信息之后，还包括：
13.根据权利要求12所述的车辆位姿信息处理方法，其特征在于，在所述根据所述融合车辆位姿信息和预置的扩展卡尔曼滤波算法，对所述目标车辆位姿信息进行优化，得到定位结果之后，还包括：
14.一种车辆位姿信息处理装置，其特征在于，所述车辆位姿信息处理装置包括：
15.一种车辆位姿信息处理设备，其特征在于，所述车辆位姿信息处理设备包括：存储器和至少一个处理器，所述存储器中存储有指令；
16.一种计算机可读存储介质，所述计算机可读存储介质上存储有指令，其特征在于，所述指令在被读取并运行时执行如权利要求1-13中任一项所述车辆位姿信息处理方法。
...【技术特征摘要】
1.一种车辆位姿信息处理方法，其特征在于，所述车辆位姿信息处理方法包括：
2.根据权利要求1所述的车辆位姿信息处理方法，其特征在于，所述对所述当前隧道点云数据进行点云特征提取，得到多个点云特征，包括：
3.根据权利要求2所述的车辆位姿信息处理方法，其特征在于，所述对所述当前隧道点云数据进行隧道附属物特征提取，得到至少一个隧道附属物特征，包括：
4.根据权利要求2所述的车辆位姿信息处理方法，其特征在于，所述对所述当前隧道点云数据进行近地特征提取，得到多个近地特征，包括：
5.根据权利要求1所述的车辆位姿信息处理方法，其特征在于，所述根据所述多个点云特征、所述初始车辆位姿信息和预置的点云特征地图进行匹配，得到目标车辆位姿信息，包括：
6.根据权利要求5所述的车辆位姿信息处理方法，其特征在于，所述根据所述总匹配误差对所述初始车辆位姿信息进行优化，得到目标车辆位姿信息，包括：
7.根据权利要求6所述的车辆位姿信息处理方法，其特征在于，所述多个特征点包括隧道附属物特征点、路沿特征点、地面点和路面标示线点，所述根据每个特征点的匹配误差对所述初始车辆位姿信息进行约束，得到目标车辆位姿信息，包括：
8.根据权利要求1所述的车辆位姿信息处理方法，其特征在于，所述根据所述多个点云特征、所述初始车辆位姿信息和预置的点云特征地图进行匹配，得到目标车辆位姿信息，包括：
9.根据权利要求8所述的车辆位姿信息处理方法，其特征在于，所述点云特征地图包括...
【专利技术属性】
技术研发人员：柯超凡，韩旭，
申请(专利权)人：文远苏行江苏科技有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。