Add more tests
Implement A* search
Make test target run all tests
Make one target to test all
Refactor (rename)
Implement Problem::h2