Astar builds path. Goal is drawn, but moves relative to the robot for some reason.