Modified A star with sucessful test trial
Fished simple environment with collision check, still need figure out action problem
modified configuration for test purpose
Merge branch 'master' of https://github.com/stebl/robot-autonomy-hw4