Added pathfinder debugging, unit tests for allocators