A* Path found!
Further refined A*
Updated linux build.