Fixing build errors on linux
Adding algorithm that outputs the full path in A* and not just a single step
Fixing A* with new full path finding