public class PriorityQueue<TElement, TPriority>
{
    /// <summary>
    /// 保存所有節(jié)點(diǎn)的一維數(shù)組且每一項(xiàng)是個(gè)元組
    /// </summary>
    private (TElement Element, TPriority Priority)[] _nodes;

    /// <summary>
    /// 優(yōu)先級(jí)比較器，這里用的泛型，比較器可以自己實(shí)現(xiàn)
    /// </summary>
    private readonly IComparer<TPriority>? _comparer;

    /// <summary>
    /// 當(dāng)前堆的大小
    /// </summary>
    private int _size;

    /// <summary>
    /// 版本號(hào)
    /// </summary>
    private int _version;

    /// <summary>
    /// 代表父節(jié)點(diǎn)最多有4個(gè)子節(jié)點(diǎn)，也就是d=4(d=4時(shí)好像效率最高)
    /// </summary>
    private const int Arity = 4;

    /// <summary>
    /// 使用位運(yùn)算符，表示左移2或右移2(效率更高)，即相當(dāng)于除以4，
    /// </summary>
    private const int Log2Arity = 2;

    /// <summary>
    ///  構(gòu)造函數(shù)初始化堆和比較器
    /// </summary>
    public PriorityQueue()
    {
        _nodes = Array.Empty<(TElement, TPriority)>();
        _comparer = InitializeComparer(null);
    }

    /// <summary>
    ///  重載構(gòu)造函數(shù)，來(lái)定義比較器否則使用默認(rèn)的比較器
    /// </param>
    public PriorityQueue(IComparer<TPriority>? comparer)
    {
        _nodes = Array.Empty<(TElement, TPriority)>();
        _comparer = InitializeComparer(comparer);
    }
    private static IComparer<TPriority>? InitializeComparer(IComparer<TPriority>? comparer)
    {
        //如果是值類(lèi)型，如果是默認(rèn)比較器則返回null
        if (typeof(TPriority).IsValueType)
        {
            if (comparer == Comparer<TPriority>.Default)
            {
                return null;
            }

            return comparer;
        }
        //否則就使用自定義的比較器
        else
        {
            return comparer ?? Comparer<TPriority>.Default;
        }
    }

    /// <summary>
    /// 獲取索引的父節(jié)點(diǎn)
    /// </summary>
    private int GetParentIndex(int index) => (index - 1) >> Log2Arity;

    /// <summary>
    /// 獲取索引的左子節(jié)點(diǎn)
    /// </summary>
    private int GetFirstChildIndex(int index) => (index << Log2Arity) + 1;
}

public void Enqueue(TElement element, TPriority priority)
{
    //拿到最大位置的索引，然后再將數(shù)組長(zhǎng)度+1
    int currentSize = _size++;
    _version++;
    //如果長(zhǎng)度相等，說(shuō)明已經(jīng)到達(dá)最大位置，數(shù)組需要擴(kuò)容了才能容下更多的元素
    if (_nodes.Length == currentSize)
    {
        //擴(kuò)容,參數(shù)是代表數(shù)組最小容量
        Grow(currentSize + 1);
    }

    if (_comparer == null)
    {
        
        MoveUpDefaultComparer((element, priority), currentSize);
    }
    else
    {
        MoveUpCustomComparer((element, priority), currentSize);
    }
}
private void Grow(int minCapacity)
{
    //增長(zhǎng)倍數(shù)
    const int GrowFactor = 2;
    //每次擴(kuò)容的最小值
    const int MinimumGrow = 4;
    //每次擴(kuò)容都2倍擴(kuò)容
    int newcapacity = GrowFactor * _nodes.Length;

    //數(shù)組不能大于最大長(zhǎng)度
    if ((uint)newcapacity > Array.MaxLength) newcapacity = Array.MaxLength;

    //使用他們兩個(gè)的最大值
    newcapacity = Math.Max(newcapacity, _nodes.Length + MinimumGrow);

    //如果比參數(shù)小，則使用參數(shù)的最小值
    if (newcapacity < minCapacity) newcapacity = minCapacity;
    //重新分配內(nèi)存，設(shè)置大小，因?yàn)閿?shù)組的保存在內(nèi)存中是連續(xù)的
    Array.Resize(ref _nodes, newcapacity);
}
private void MoveUpDefaultComparer((TElement Element, TPriority Priority) node, int nodeIndex)
{
    //nodes保存副本
    (TElement Element, TPriority Priority)[] nodes = _nodes;
    //這里入隊(duì)操作是從空閑索引第一個(gè)位置開(kāi)始插入
    while (nodeIndex > 0)
    {
        //找父節(jié)點(diǎn)索引位置
        int parentIndex = GetParentIndex(nodeIndex);
        (TElement Element, TPriority Priority) parent = nodes[parentIndex];
        //插入節(jié)點(diǎn)和父節(jié)點(diǎn)比較，如果小于0(默認(rèn)比較器情況下構(gòu)建的小頂堆)，則交換位置
        if (Comparer<TPriority>.Default.Compare(node.Priority, parent.Priority) < 0)
        {
            nodes[nodeIndex] = parent;
            nodeIndex = parentIndex;
        }
        //算是性能優(yōu)化吧，不必檢查所有節(jié)點(diǎn)，當(dāng)發(fā)現(xiàn)大于時(shí)，就直接退出就可以了
        else
        {
            break;
        }
    }
    //將插入節(jié)點(diǎn)放到它應(yīng)該的位置
    nodes[nodeIndex] = node;
}

public TElement Dequeue()
{
    if (_size == 0)
    {
        throw new InvalidOperationException(SR.InvalidOperation_EmptyQueue);
    }
    //將堆頂元素返回
    TElement element = _nodes[0].Element;
    //然后調(diào)整堆
    RemoveRootNode();
    return element;
}
private void RemoveRootNode()
{
    //記錄最后一個(gè)元素的索引位置，并且將堆的大小-1
    int lastNodeIndex = --_size;
    _version++;

    if (lastNodeIndex > 0)
    {
        //堆的大小已經(jīng)被減1，所以將最后一個(gè)元素作為副本，開(kāi)始從堆頂重新整理堆
        (TElement Element, TPriority Priority) lastNode = _nodes[lastNodeIndex];
        if (_comparer == null)
        {
            MoveDownDefaultComparer(lastNode, 0);
        }
        else
        {
            MoveDownCustomComparer(lastNode, 0);
        }
    }

    if (RuntimeHelpers.IsReferenceOrContainsReferences<(TElement, TPriority)>())
    {
        //將最后一個(gè)位置的元素設(shè)置為默認(rèn)值
        _nodes[lastNodeIndex] = default;
    }
}
private void MoveDownDefaultComparer((TElement Element, TPriority Priority) node, int nodeIndex)
{
    (TElement Element, TPriority Priority)[] nodes = _nodes;
    //堆的實(shí)際大小
    int size = _size;

    int i;
    //當(dāng)左子節(jié)點(diǎn)的索引小于堆的實(shí)際大小時(shí)
    while ((i = GetFirstChildIndex(nodeIndex)) < size)
    {
        //左子節(jié)點(diǎn)元素
        (TElement Element, TPriority Priority) minChild = nodes[i];
        //當(dāng)前左子節(jié)點(diǎn)的索引
        int minChildIndex = i;
        //這里即找到所有同一個(gè)父節(jié)點(diǎn)的相鄰子節(jié)點(diǎn)，但是要判斷是否超出了總的大小
        int childIndexUpperBound = Math.Min(i + Arity, size);
        //按照索引區(qū)間順序查找，并根據(jù)比較器找到最小的子元素位置
        while (++i < childIndexUpperBound)
        {
            (TElement Element, TPriority Priority) nextChild = nodes[i];
            if (Comparer<TPriority>.Default.Compare(nextChild.Priority, minChild.Priority) < 0)
            {
                minChild = nextChild;
                minChildIndex = i;
            }
        }
        //如果最后一個(gè)節(jié)點(diǎn)的元素，比這個(gè)最小的元素還小，那么直接放到父節(jié)點(diǎn)即可
        if (Comparer<TPriority>.Default.Compare(node.Priority, minChild.Priority) <= 0)
        {
            break;
        }
        //將最小的子元素賦值給父節(jié)點(diǎn)
        nodes[nodeIndex] = minChild;
        nodeIndex = minChildIndex;
    }
    //將最后一個(gè)節(jié)點(diǎn)放到空閑出來(lái)的索引位置
    nodes[nodeIndex] = node;
}