Ajout de fonction de groupement des points

Avant on comptait le nombre de points pour savoir s'il y avait un obstacle. Maintenant, on groupe les points proches selon un delta en angle et en distance. On gagne en information sur les obstacles autour du robot.