1. выбираем из матрицы те точки, расстояние которых к p1 равно (либо ~ равно, с каким-нить threshold-ом)
distance(p1, p(i)) ~= distance(p1, p2)
(кстати, этот threshold и определяет "градусность" <=10 )
2. поиск ближайшей точки к точке p2 среди множества отобранных точек.
----------------------------
resume: Тебе нужна 1 функция расчета расстояния между двумя точками , и больше ничего.