Нужна формула расчета попутности заказа

Необходимо написать формулу расчитывающую является ли новый заказ попутным другим заказам.

На входе координаты стартовой локации и координаты заказов. На выходе группированные по попутности заказы