Programme calcul de distance entre des points

, Bonjour cher communauté je suis un nouveau débutant en programmation et je rencontre un problème je voudrais développer un programme qui a partir d'une liste de points donnés (un point est défini avec ses coordonnées) divisé cette ensemble de points en sous ensemble tel que la distance entre tout les points de cet sous ensemble est inférieur strictement à 20km le but est de savoir combien de sous ensemble on aura et que sont les points de chaque sous ensemble je me suis dit que cet algorithm marche :
Soit E = ensemble de points x tel que E={X1,X2,X3,......Xn}
Pour i allant de 0 à n on a
Fi = Xi
E= E - Fi
Pour j allant de 0 a n et i !=j on a


Si la distance entre Xi et Xi est inférieur à 20km alors Fi = {Xi,Xj}
E= E - Fi
On affiche F1,F2,F3,....Fn on arrête lorsque E est vide
Voilà l'idée pour lalgorithm je sais pas si ca va marcher mais le problème c'est que je n'arrive pas a le coder j'ai rencontré des problèmes avec les tableaux aussi avec la notion de point définie avec ses coordonnées aussi un problème de calcul de distance ainsi que le compteur ... je suis bloqué si vous pouvez m'aider ou m'éclairer je vous en remercie