SubZer0, все ты правильно написал, осталось только запихнуть теорему в функцию и назвать ее EntityDistance
Но твой вариант более общий, так как позволяет считать в любой из плоскостей, в 3д или по отдельной оси.
Ведь бывают случаи, когда надо посчитать расстояние только в плоскости XOZ, для этого из твоего кода убираем yd и все!
А "ентитидистанс" не упростить....