逻辑航迹起始算法源代码,本代码已测试通过,