一种GPS轨迹预测与抑制漂移的系统及方法与流程

文档序号:21845583发布日期:2020-08-14 17:00阅读:来源:国知局

技术特征:

1.一种gps轨迹预测与抑制漂移的系统,其特征在于,包括与cpu计算单元连接的车速传感器,与cpu计算单元通过uart通讯的gps定位模块,其中车速传感器输出车辆的运动速度到所述cpu计算单元,gps定位模块输出经纬度坐标和方向角到所述cpu计算单元,所述cpu计算单元将收到的数据经计算并修复后转发到显示单元,显示单元将轨迹展示在地图上。

2.根据权利要求1所述的gps轨迹预测与抑制漂移的系统实现的方法,其特征在于,包括以下步骤:

1)根据公式一所述车速传感器提供的车速v,乘以到下一个坐标点所经过的时间δt,得到距离d,

d=v*δt公式一;

把当前点的gps经纬度(aw,aj),方向角a,距离d带入公式二,得到下一个点的经纬度坐标(bw,bj),

bj=aj+d*sin(a)/[arc*cos(aj)*π/180]公式二;

bw=aw+d*cos(a)/(arc*π/180)公式三;

其中arc为常数:地球半径6378.137km;

2)根据公式四

把经纬度坐标(bw,bj)与gps提供的坐标值(cw,cj)带入,计算预测坐标(bw,bj)和gps当前坐标(cw,cj)2个坐标点的距离d;

3)如果d大于10m,可判定坐标值(cw,cj)存在漂移,用(bw,bj)替代(cw,cj),并将(bw,bj)设为新起始点,然后返回到步骤1)直至终点;

4)如果d不大于10m,则将坐标值(cw,cj)设为起始点,然后返回步骤1)直至终点。


技术总结
本发明公开一种GPS轨迹预测与抑制漂移的系统及方法,该系统包括与CPU计算单元连接的车速传感器,与CPU计算单元通过UART通讯的GPS定位模块,其中车速传感器输出车辆的运动速度到所述CPU计算单元,GPS定位模块输出经纬度坐标和方向角到所述CPU计算单元,CPU计算单元将收到的数据经计算并修复后转发到显示单元,显示单元将轨迹展示在地图上。本发明融合车速和定位数据,能预测下一个定位点的有效位置,并能依据该预测经纬度坐标判断模块是否处于漂移状态,用预测的经纬度替代漂移的经纬度,起到抑制漂移的目的。本发明简便有效,实施成本低。

技术研发人员:孟庆栋
受保护的技术使用者:上海本安仪表系统有限公司
技术研发日:2020.05.19
技术公布日:2020.08.14
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1