一种行车轨迹的平滑方法

基本信息

申请号 CN201410424307.4 申请日 -
公开(公告)号 CN104215249A 公开(公告)日 2014-12-17
申请公布号 CN104215249A 申请公布日 2014-12-17
分类号 G01C21/26(2006.01)I 分类 测量;测试;
发明人 陈续;庄川杰;林仁飞 申请(专利权)人 厦门市润铭网络科技有限公司
代理机构 厦门市精诚新创知识产权代理有限公司 代理人 李伊飏
地址 361000 福建省厦门市软件园二期望海路39号401室
法律状态 -

摘要

摘要 本发明公开一种行车轨迹的平滑方法,包括如下过程:步骤1:以一定的采样频率获取车辆的行驶坐标,作为原始定位坐标,记为{P1,…Pk,…,Pq},k=1,2,…,q;步骤2:对原始定位坐标{P1,…Pk,…,Pq}进行筛选过滤,避免漂移的坐标点带来的影响;步骤3:对对经过步骤2筛选过滤后的定位坐标进行拐点补偿和插值;步骤4:根据步骤3获得的定位坐标进行路径拟合。本发明通过上述方法,该方法采用覆盖底层到上层的优化算法,在相同的坐标采样周期内,为用户提供最优的轨迹平滑及呈现方法。本发明结合定位漂移抑制算法以及拐点补偿和插值算法,具有很好的平滑效果,同时,其算法简单,易于实现,具有很好的实用性。