Gitarist, вообще-то вам надо не сортировать, а искать наиболее короткий путь через все точки
Попробуйте к Galkov-у обратиться