У вас есть пара ошибок. Должно быть:
d = sqrt ((x2 - x1)*(x2 - x1) + (y2 - y1)*(y2 - y1));
другие опции:
d = dist(x1,y1,x2,y2);
или
d = PVector.dist(new PVector(x1,y1),new PVector(x2,y2));
Представьте, что вы расстояние как гипотенуза прямоугольного треугольника.
Одна сторона определяется осью X (длина x2-x1), а другая -
ось Y (ее длина y2-y1). Поскольку расстояние является гипотенузой,
и вы знаете стороны, вы просто применяете теорему Пифагора:
BC squared = AB squared + AC squared
BC = square root (AB squared + AC squared)
AC = (x2-x1) = dx
AB = (y2-y1) = dy
or
d = sqrt(dx*dx + dy*dy);