轨迹跟踪算法