Fixed Astar
Implemented onPathFound callback