GPS轨迹优化算法