Added a 'node array' implementation of A*