UCS and a-star now passing autograder, but their code needs organizing