一种行车轨迹的平滑方法
基本信息
申请号 | CN201410424307.4 | 申请日 | - |
公开(公告)号 | CN104215249B | 公开(公告)日 | 2017-03-22 |
申请公布号 | CN104215249B | 申请公布日 | 2017-03-22 |
分类号 | G01C21/26(2006.01)I | 分类 | 测量;测试; |
发明人 | 陈续;庄川杰;林仁飞 | 申请(专利权)人 | 厦门市润铭网络科技有限公司 |
代理机构 | 厦门市精诚新创知识产权代理有限公司 | 代理人 | 厦门市润铭电子科技有限公司;厦门市润铭网络科技有限公司 |
地址 | 361000 福建省厦门市软件园二期望海路39号401室 | ||
法律状态 | - |
摘要
摘要 | 本发明公开一种行车轨迹的平滑方法,包括如下过程:步骤1:以一定的采样频率获取车辆的行驶坐标,作为原始定位坐标,记为{P1,…Pk,…,Pq},k=1,2,…,q;步骤2:对原始定位坐标{P1,…Pk,…,Pq}进行筛选过滤,避免漂移的坐标点带来的影响;步骤3:对对经过步骤2筛选过滤后的定位坐标进行拐点补偿和插值;步骤4:根据步骤3获得的定位坐标进行路径拟合。本发明通过上述方法,该方法采用覆盖底层到上层的优化算法,在相同的坐标采样周期内,为用户提供最优的轨迹平滑及呈现方法。本发明结合定位漂移抑制算法以及拐点补偿和插值算法,具有很好的平滑效果,同时,其算法简单,易于实现,具有很好的实用性。 |
