Algoritmo funcionando, porém esta errado