A simple A* search using C++ and a 2D integer occupancy grid.