用于MATLAB画路径图的测试,提供代码的测试,便于理解使用