Using 2011 sparse A* calculations for successors
grid values now determined based on waypoints and a padding is added around grid