Added basic pathfinding, but not movement