基于人工势场算法的复杂环境路径规划优化系统及方法

本发明公开了基于人工势场算法的复杂环境路径规划优化系统及方法，涉及三维航道控制领域，本发明对区域中的各个静止的障碍物进行人工势场建模，通过采用人工势场算法对路径上的障碍物进行建模，只需对行进装置受到的合力这一单个因素进行考虑，为后续对行进装置的行进路径优化目标进行了确定；使得后续的对最优路径的分析过程更加简单和方便；再对多种除静止障碍物之外的影响因素进行全面分析，预测出这些动态影响因素在未来时刻行进装置行进时的发生状态，从而提前对这些影响因素的发生情况进行了预测，从而为最优路径的选择提供了又一个的依据，使得行进装置在最优路径上进行行驶时更加顺利，保证了行进的效率以及稳定性。