Modified prototype of A* implementation
Added more unit tests for A*