UCS works completely, prints all required output.
ASTAR search works now, templated from UCS.