Fast Marching Method(FMM)是一种基于水平集理论的界面演化跟踪算法,常被应用于求解几何最短路径规划问题。在静态环境信息已知的情况下,FMM比传统的网格搜索算法得到的路径更加光滑。但是,经典FMM对规划路径的方向控制能力弱、缺乏路...Fast Marching Method(FMM)是一种基于水平集理论的界面演化跟踪算法,常被应用于求解几何最短路径规划问题。在静态环境信息已知的情况下,FMM比传统的网格搜索算法得到的路径更加光滑。但是,经典FMM对规划路径的方向控制能力弱、缺乏路径曲率调控能力。基于调整Eiknoal方程中的代价函数的策略,采用人工势场方法,提出一种综合代价模型,依此实现一种改进FMM。通过定义对应于时间距离图最陡下降法所得路径的势能函数,采用变分方法分析得到含路径曲率的Euler-Lagrange方程,给出满足路径曲率约束的代价调整策略。实验结果表明该模型和方法是可行和有效的,它能够在满足转弯机动约束条件下实现航迹方向的控制,可用于机器人或无人飞行器的航迹规划。展开更多