闲来无事,在网上逛逛,整理了一套人工势场法代码,都达到目标点 有注释,自动避障,方便理解,完全实现功能