modificado para melhorar a deteccao de obstaculos e do objetivo,
tbm adicionado mais funcionalidades de modularidade