modified A star
Modified version of simple environment without collision check
modified start and goal configuration for testing purpose
add models