Ya hice las pruebas y funciona bien, me puedo fiar de la heurística por la distancia
Ahora el problema que tengo es falla al usar el cuadrado de las distancias en algunas circunstancias por lo que consume bastante el tener que hallar la raíz cuadrada, por lo que tengo de nuevo el problema

Supongo que tendré que ajustar también el resto de variables donde guardo distancias para que también sean al cuadrado :huh:
En cualquier caso estas discusiones me han aclarado algunas cosas