cout << "La distancia es: " << distancia << endl; // el << endl es un salto de linea 

Nomenglatura usada: objeto(prioridad)
Segun tu caso: numero menor = mas prioridad
priority_queue = { }
insert(A(5)) -> priority_queue = { A(5) }
insert(B(8)) -> priority_queue = { B(8), A(5) }
insert(C(1)) -> priority_queue = { B(8), A(5), C(1) }
insert(D(4)) -> priority_queue = { B(8), A(5), D(4), C(1) }
sacarTop() -> priority_queue = { A(8), B(5), D(4) } 

• insert(cola, elemento) -> inserta el elemento en la posición correcta
• removeFirst(cola) -> elimina el objeto con mas prioridad
• Te recomiendo hacer un top() -> muestra el elemento con mas prioridad. Ya que es recomendable que una función sólo lo muestre y el otro sólo lo elimine (removeFirst). Creo que eso es lo que vas a implementar tú en la función <peek()>.

• display(cola) -> muestra toda la cola.
• create(cola) -> inicializa la cola con valores. Yo lo haría de forma random. O sea <create(cola, num_elementos)> y que meta <num_elementos> elementos en la cola creados de forma aleatoria.

struct Proceso{
    int prioridad; // define la prioridad de un proceso
    int datos; // define los datos de ese proceso. Esto no tiene importancia
};
 
struct ColaPrioridad{
    Proceso cola_interna[SIZE]; // un array de Procesos que es nuestra cola con prioridad
    int size; // determina la cantidad de elementos que tiene la cola_interna.
};
 
// inserta <num_elementos> elementos en la cola (mi_cola.size = num_elementos)
// puede ser void o ser bool y retornar true si num_elementos <= SIZE y se han guardado bien o false si num_elementos > SIZE
void/bool create(ColaPrioridad mi_cola, int num_elementos);
 
// insertar un elemento en la cola en su posicion correspondiente segun su prioridad
// puede ser void o bool y retornar true si no se ha superado el limite de elementos (mi_cola.size < SIZE) o false en caso contrario
void/bool insert(ColaPrioridad mi_cola, Proceso nuevo_proceso);
 
// elimina el elemento con mayor prioridad
// puede ser void o bool y retornar true si la cola no esta vacia y se ha eliminado bien o false en caso contrario
void/bool removeFirst(ColaPrioridad);
 
// retorna el elemento de mayor prioridad de la cola sin eliminarlo de esta
Proceso top(ColaPrioridad);
 
// muestra la cola completa
void display(ColaPrioridad);
 
int main(){
    ColaPrioridad mi_cola;
    create(mi_cola, 5); // insertamos 5 procesos aleatorios en la cola
    display(mi_cola); // vemos el contenido
    Proceso proceso_nuevo1, proceso_nuevo2; // creamos dos procesos nuevos
    // damos valores a prioridad y datos de proceso_nuevo1 y proceso_nuevo2
 
    // insertamos los nuevos procesos despues de haberles dado valores en la cola
    insert(mi_cola, proceso_nuevo1);
    insert(mi_cola, proceso_nuevo2);
    display(mi_cola); // vemos el contenido
 
    removeFirst(mi_cola); // eliminamos el Proceso con mayor prioridad (es decir, con el atributo prioridad menor)
    display(mi_cola); // vemos el contenido
} 

• Sobrecargar el operador <.
• Crear un functor. (Verás que se hablan mucho de functores para <set> y <priority_queue>.

// OPCION 1: Sobrecarga de <
struct foo{
    // miembros
    bool operator<(const foo &f)const{/*...*/}
};
std::set<foo> my_set; // equivalente a std::set<foo, less<foo>, allocator<foo>> se necesita el operador para el criterio less<foo>
 
// OPCION 2: Functor
struct foo{
    // miembros
};
 
struct comparaFoo{
    bool operator()(const foo &f1, const foo &f2)const{/*...*/}
};
std::set<foo, comparaFoo> my_set; // cambiamos el criterio por defecto por el nuestro 

// Lo que se le pasa a alguien por la cabeza cuando esta empezando
// Aqui si es cierto que si no ponemos >= en la condicion tendriamos un problema si numero1 == numero2
int mayor;
if(numero1 >= numero2)
    mayor = numero1;
else
    mayor = numero2;
 
// Como se suele hacer para optimizar
int mayor = numero1; // suponemos que numero1 es mayor
if(numero2 > mayor) // solo si numero2 es mayor estricto actualizamos el mayor, si son iguales mantenemos numero1 ya que es correcto
    mayor = numero2; 

Solo quiero dejar claro que tanto el comentario anterior como este son críticas constructivas. No lo hago por tocar las narices ni nada pero en el fondo todos tenemos nuestro ego y nos gusta defenderlo. Y personalmente me gusta explicar el porqué de lo que hago y digo en un mundo que cada vez más se usa el motivo del porque sí hasta en el sistema educativo, sin ningún tipo de razonamiento en el que apoyarse. Ahora que ya he soltado mi reivindicación y he mostrado las posibilidades que hay hasta para hacer la función más simple del mundo. Suerte a todos y ánimo con la programación

int numeroMayor(int numero1, int numero2, int numero3){
    int mayor = numero1;
    if(numero2 > mayor)
        mayor = numero2;
    if(numero3 > mayor)
        mayor = numero3;
    return mayor;
} 

• Crear la función para 2 parámetros y llamar a la función desde la propia función:

int mayor = numeroMayor(numeroMayor(numero1, numero2), numero3); 

• Crear la función para un array:

int numeroMayor(int *numeros, int size); 

double calcularPromedio(int *numeros, int size); 

int opcion_elegida = menu(); 

while(!fin); 

//Nos ahorramos la llamada a system pause:
int PausaDelSistema;
cout << "El programa a finalizado." << endl
<<"Introduce cualquier caracter y pulsa enter para finalizar" << endl;
cin >> PausaDelSistema; 

cin.get(); 

printf("%d", &variable); // muestras la dirección de memoria de variable
printf("%d", variable); // muestra el valor entero de la variable