algortimo A* implementato, funziona