added debugging info to pathfinder

added util/algorithm

Added a some unit tests to stack and block allocators