Locar silo numa menor distancia

Os pontos do arquivo ponto_origem devem ser levados para um ponto aleatório do arquivo pontos_destino. Depois disso calcula-se a distancia média de todos os pontos do arquivo ponto_origem até ao ponto aleatório escolhido do arquivo pontos_destino.

A partir dessa distancia inicial comeca a levar todos os pontos do arquivo pontos_origem para pontos do arquivo ponto_destino. A idéia é não passar por todos os pontos do  arquivo pontos_destino. Percorrê-lo de 500 em 500 metros.
E ir calculando a distancia dos pontos do arquivo pontos_origem até o destino. Encontrando a  menor distância indicar qual é ela e qual  a coordenada equivalente.

Obs.: Os pontos são coordenadas (x,y,z).

Deve ser implementado em c++.