Added better highlighting for path finding debugging.