综合了网上各种版本的人工势场法的matlab程序,没有震荡和角度计算问题,对更改后障碍物的兼容性好.