Started A* pathfinding

Started A* pathfinding