GOAL: added Astar algorithm toFromUsing/5. Should probably be renamed. GOAL is not sure whether or not it knows the sqrt prolog built-in.