高精地图变道区间车道向量平滑方法、系统及介质技术方案

本发明专利技术公开了一种高精地图变道区间车道向量平滑方法、系统及介质，其方法包括以下步骤：获取待优化车道向量段；在待优化车道向量段上按照预设采样锚点条件选取多个采样点和多个锚点，基于Frenet标架将相邻两个锚点之间的待优化车道向量段转换为多阶函数，获取多个单元向量段多阶函数；对每个采样点和每个所述锚点施加预设约束条件，获取待优化车道向量段的所有单元向量段多阶函数的目标函数；根据求解系数后的单元向量段多阶函数，获取待优化车道向量段对应的优化曲线；将优化曲线转换为三维优化曲线，并将三维优化曲线与原始车道向量被截取后余下的部分进行拼接；以解决车道向量形状弯折、突变、曲率过大等不满足自动驾驶平稳平滑行驶要求的问题。稳平滑行驶要求的问题。稳平滑行驶要求的问题。

【技术实现步骤摘要】
高精地图变道区间车道向量平滑方法、系统及介质


[0001]本专利技术涉及高精地图
，特别涉及一种高精地图变道区间车道向量平滑方法、系统及介质。

技术介绍

[0002]高精度电子地图主要服务于自动驾驶车辆，自动驾驶车辆为了保证行驶过程中的平稳性、舒适性，会尽量选择平滑的行驶路线；高精度地图的车道向量作为自动驾驶车辆的行驶参考线和引导线，也需要达到平滑的效果，特别是在变道区间需要不减速变道的情况下。
[0003]因此如何对高精地图变道区间车道向量进行平滑处理，以解决车道向量形状弯折、突变、曲率过大等不满足自动驾驶平稳平滑行驶要求的问题。

技术实现思路

[0004]本专利技术的提供一种基于高精地图变道区间车道向量平滑方法、系统及介质，以解决车道向量形状弯折、突变、曲率过大等不满足自动驾驶平稳平滑行驶要求的问题，大大减少了人工排查的时间成本，提高高精度地图制作效率。
[0005]第一方面，提供一种高精地图变道区间车道向量平滑方法，包括以下步骤：
[0006]获取原始车道向量，按照预设截取条件对所述原始车道向本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种高精地图变道区间车道向量平滑方法，其特征在于，包括以下步骤：获取原始车道向量，按照预设截取条件对所述原始车道向量进行截取，获取待优化车道向量段；在所述待优化车道向量段上按照预设采样锚点条件选取多个采样点和多个锚点，基于Frenet标架将相邻两个所述锚点之间的待优化车道向量段转换为多阶函数，获取多个单元向量段多阶函数；对每个所述采样点和每个所述锚点施加预设约束条件后，获取待优化车道向量段的所有单元向量段多阶函数的目标函数，并求解所述目标函数获取单元向量段多阶函数的各项系数；根据求解系数后的单元向量段多阶函数，获取待优化车道向量段对应的优化曲线；将所述优化曲线转换为三维优化曲线，并将所述三维优化曲线与所述原始车道向量被截取后余下的部分进行拼接。2.如权利要求1所述的高精地图变道区间车道向量平滑方法，其特征在于，所述“获取原始车道向量，按照预设截取条件对所述原始车道向量进行截取，获取待优化车道向量段”步骤，具体包括以下步骤：选取原始车道向量的分歧终点或汇流起点；以所述分歧终点或所述汇流起点为起始截取点，根据预设截取长度对所述原始车道向量进行截取，获取第一截取点，计算第一截取点处的曲率或航向角；当所述原始车道向量中任意两条车道向量的曲率差值或航向角差值大于预设阈值时，则按照预设截取长度对剩下的原始车道向量继续进行截取，直至截取点处任意两条车道向量的曲率差值或航向角差值小于预设阈值，选取起始截取点与最后一个截取点之间的车道向量段为待优化车道向量段。3.如权利要求2所述的高精地图变道区间车道向量平滑方法，其特征在于，所述“在所述待优化车道向量段上按照预设采样锚点条件选取多个采样点和多个锚点”步骤，具体包括以下步骤：选取待优化车道向量段的起始截取点和最后一个截取点为锚点，按照预设采样长度在起始截取点和最后一个截取点之间设置多个采样点，并按照预设锚点长度在起始截取点和最后一个截取点之间设置多个锚点。4.如权利要求2所述的高精地图变道区间车道向量平滑方法，其特征在于，所述“对每个所述采样点和每个所述锚点施加预设约束条件”步骤，具体包括以下步骤：获取所述待优化车道向量段的起点航向角、尾点航向角；对每个采样点限定可行域；使单元向量段多阶函数在起始截取点处的值等于同位置起点坐标、在起始截取点处的一阶导数等于所述起点航向角，使单元向量段多阶函数在最后一个截取点处的值等于同位...

【专利技术属性】
技术研发人员：张维，郭杨斌，罗跃军，
申请(专利权)人：武汉中海庭数据技术有限公司，
类型：发明
国别省市：