【技术实现步骤摘要】
一种地图轨迹平滑方法及装置
[0001]本申请涉及数据处理的
,特别是涉及一种地图轨迹平滑方法及装置。
技术介绍
[0002]自动驾驶对于地图的要求很高,需要地图与定位、感知、运动规划和控制等模块相互配合。高精地图精度更高,定位更准确,可以提供超感知距离的周边信息,提供更丰富的语义信息层,包含道路标线、标识等,可以辅助车辆进行运动规划,能更好地为自动驾驶的汽车和机器服务。
[0003]一般而言,高精地图基础层提供的路径轨迹定位数据都会存在一定的误差,其输出的轨迹点如果出现异常的噪点,或者轨迹的曲线不够光滑,会导致车辆运行时出现顿挫,定位不精准等问题,造成行驶故障、急停,影响车辆的自动驾驶以及驾乘的体验感、安全性等。利用拉格朗日多项式进行数据的函数拟合,容易造成过拟合,且在数据边界处会形成震荡,难以看出数据的趋势;而利用三阶样条的方式,分段的三次函数连接各数据点,进行曲线拟合,会导致其分段函数难以进行迭代计算,无法反应数据的整体趋势。
[0004]因此,如何使对地图轨迹进行的平滑处理达到更好的效果,是本领 ...
【技术保护点】
【技术特征摘要】
1.一种地图轨迹平滑方法,其特征在于,所述方法包括:利用预设距离阈值,对原始地图数据进行采样,得到采样数据集合,所述预设距离阈值用于规定相邻两点之间的距离;按照移动平均思想,利用最小二乘法,对所述采样数据集合进行多项式拟合,得到拟合数据集合;对所述拟合数据集合进行指数平滑,得到轨迹平滑数据。2.根据权利要求1所述的方法,其特征在于,所述原始地图数据包括全球定位系统定位数据和实时动态载波相位差分定位数据。3.根据权利要求1所述的方法,其特征在于,所述按照移动平均思想,利用最小二乘法,对所述采样数据集合进行多项式拟合,得到拟合数据集合,包括:设置平滑区间长度;依据所述平滑区间长度,在所述采样数据集合中,选定第一移动数据集合;利用最小二乘法,对所述第一移动数据集合进行多项式拟合,得到第一拟合数据;依据所述平滑区间长度,在所述采样数据集合中,选定第二移动数据集合;利用最小二乘法,对所述第二移动数据集合进行多项式拟合,得到第二拟合数据;根据所述第一拟合数据和所述第二拟合数据,生成拟合数据集合。4.根据权利要求3所述的方法,其特征在于,所述利用最小二乘法,对所述第一移动数据集合进行多项式拟合,得到第一拟合数据,包括:利用最小二乘法,获取所述第一移动数据集合进行多项式拟合的拟合参数;利用所述第一移动数据集合进行多项式拟合的拟合参数,对所述第一移动数据集合进行多项式拟合,得到第一拟合数据。5.根据权利要求3所述的方法,其特征在于,所述利用最小二乘法,对所述第二移动数据集合进行多项式拟合,得到第二拟合数据,包括:利用最小二乘法,获取所述第二移动数据集合进行多项式拟合的拟合参数;利用所述第二移动数据集合进行多项式拟合的拟合参数,对...
【专利技术属性】
技术研发人员:梁高洋,罗杰,张立成,钟声峙,杨喆,
申请(专利权)人:柳州五菱新能源汽车有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。