PSO算法路径规划流程：（）初始化；（）个体极值与全局最优；（）更新速度和位置；（）终止条件