Updated pathfinding. Switched to shuttle movements using vectors