Adicionado métodos A*

Não terminado