Started implementing pathfindgin for the SimpleAI