人工势场改进避撞

在论坛上搜了一些matlab人工势场法程序,但很多都有一些问题,比如目标不可达,角度计算错误等等。在这些的基础上,我进行了改进,使得能够更好地到达目标点,减少了震荡,但是依旧会出现几次震荡,愿高手继续完善。程序可以用C写出来,做机器人路径规划或者避障的同学,该文档有很高的参考性。