AI: basic goto movement

Next up Astar graph group search