Added much nicer A* search function (have not cleaned UCS yet).