A* works now. Decision making still gets stuck in a loop when two things are about the same distance away.