occupancy grid expansion + map size optimization + A* on AK complete - help from MattCosti and TimMurcko along the way. gg