Agora está funcionando para múltiplos objetos. A imagem é composta de múltiplos objetos com múltiplos pontos cada. Crio uma vetor de listas, cada índice do vetor corresponde a um objeto distinto. Acabei de lembrar que esqueci de limpar as listas no final do algoritmo. Próximo commit faço isso...