(Teorema de Pitágoras) Algoritmo de conversão

Bom dia! Preciso escrever um código de algoritmo que realiza a conta de conversão de latitudes e longitudes em distância utilizando o Teorema de Pitágoras e não sei por onde começar. Encontrei esse calculo que poderá ser inserido. Triângulo PitagóricoImaginemos 2 pontos P=(x1,y1) e Q=(x2,y2), obtemos a distância entre P e Q, traçando as projeções destes pontossobre os eixos coordenados, obtendo um triângulo retângulo e usando o Teorema de Pitágoras. /applications/core/interface/imageproxy/imageproxy.php?img=http://forum.maparadar.com/download/file.php?id=319%26sid=53042f8c676a9f49efe6ffbf8ed8bc8f&key=1bbb6930293b516332425f8119323f84c7a9f5f2c70218564ffcea3deaada5a6" style="border:0px #999999. vertical-align:middle. " /> Pitagoras1.png (682 Bytes) Exibido 36730 vezes Assim, considerando 2 pontos de coordenadas (-22.902778, -43.206667) e (-23.548333, -46.636111)Calculando-se a distância entre eles, tem-se: /applications/core/interface/imageproxy/imageproxy.php?img=http://forum.maparadar.com/download/file.php?id=320%26sid=53042f8c676a9f49efe6ffbf8ed8bc8f&key=8bf51f88ffadd85a737937ff37b5c91074a6a73582f9e130a0d2117f11799a03" style="border:0px #999999. vertical-align:middle. " /> Pitagoras2.png (2.14 KiB) Exibido 36729 vezes /applications/core/interface/imageproxy/imageproxy.php?img=http://forum.maparadar.com/download/file.php?id=321%26sid=53042f8c676a9f49efe6ffbf8ed8bc8f&key=fefc57d407568d28f020c81f3abd2f1a0ed15f824a73fee33d20afadf5fccdb9" style="border:0px #999999. vertical-align:middle. " /> Pitagoras3.png (2.75 KiB) Exibido 36729 vezes A distância em graus resulta 3,4896744O raio da terra tem aproximadamente 6371km.Uma volta na terra tem 2 pi raio = 40030000m.Podemos, através de uma regra de 3 simples, obter a conversão do ângulo encontrado para uma distância em metros.