Как реализовать приоритетную очередь с помощью бинарного дерева поиска

---

Я пытаюсь реализовать функции приоритетной очереди PQ_DeleteMin (), PQ_GetMinKey () для приоритетной очереди с двоичным деревом поиска. Двоичное дерево поиска содержит дополнительную информацию для получения k ближайших узлов. Может ли кто-нибудь помочь мне, как достичь этого в C? Спасибо.

Что я уже пробовал:

Код для вставки узла записывается следующим образом:

Node *insert(Node *Tree, void *Object, float (*Distance)(void *, void *))
{
    if(Tree == NULL){
            if((Tree=(Node *)malloc(sizeof(Node)))==NULL){
            printf("Insufficient memory");
            exit(1);
            }

    Tree->p1 = Object;
    Tree->p2 = NULL;
    Tree->left = Tree->right =NULL;
    }

    else if (Tree->p2 == NULL)
            Tree->p2 = Object;

    else if ((*Distance)(Tree->p1, Object) < (*Distance)(Tree->p2, Object))
            insert(Tree->left, Object, Distance);

    else insert(Tree->right, Object, Distance);
    return(Tree);
}

---