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)直至终点。