本代码为人工势场法MATLAB源程序，可以直接运行，亲测有效。