Попытка реализации алгорима Прима на Ruby.

В рамках программы самообразования читаю книжку Р. Хаггарти «Дискретная математика для программистов». Для закрепления прочитанного попытался реализовать алгоритм построения минимального остовного дерева для взвешенного графа, заданного с помощью координат каждой его вершины. Получившаяся у меня программа работает некорректно, дерево строится не минимальной общей длины. Чего не хватает коду? Буду признателен за любую подсказку.

Код с комментариями и выводом консоли.