Implemented very simple pathfinder using aStar