#9 Started to write A* algorithm
Build fixes