粒子群算法做路径规划？？

在栅格地图环境中，随机产生的粒子，如果落在障碍物上怎么办？另外找不到源码啊 求助