改进的人工势场避撞方法

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