A* implemented -> Tests needed
Adicionando uso do Astar -> Ainda não está funcionando
AStar fixed