bizhang .......\obstacles .......\.........\goalfunction.m .......\.........\main.m .......\.........\obstaclefunction.m