用堆排序实现大致已经排好序的序列

已知一个几乎有序的数组，几乎有序是指，如果把数组排好顺序的话，每个元素移动的距离可以不超过k，并且k相对于数组来说比较小。请选择一个合适的排序算法针对这个数据进行排序。
给定一个int数组A，同时给定A的大小n和题意中的k，请返回排序后的数组。
测试样例：
[2,1,4,3,6,5,8,7,10,9],10,2
返回：[1,2,3,4,5,6,7,8,9,10]

可以利用堆排序，不超过k，每组选择k+1个数，从0开始，每组内进行建堆，建完最小堆之后最前面的元素就是最小值。之后下标加1，继续进行堆排序，时间复杂度可以达到(log(n+k))空间复杂度为O(1)因为使用循环实现最小堆，没用调用栈。不稳定排序。
代码如下：

class ScaleSort {public:    vector<int> sortElement(vector<int> A, int n, int k) {        if(n<2)            return A;          int i=0;        for(;i+k<n;++i)        {            buildheap(A,i,k+1);                   }        while(n-i>1)        {        buildheap(A,i,n-i);        i++;                }        return A;        // write code here    }    void buildheap(vector<int> &A,int begin,int k)        {        if(k<2)            return;        if(A[(k-2)/2+begin]>A[k-1+begin])                swapnum(A[(k-2)/2+begin],A[k-1+begin]);        if(k%2==1){            if(A[(k-2)/2+begin]>A[k-2+begin])             swapnum(A[(k-2)/2+begin],A[k-2+begin]);        }        for(int i=(k-4)/2;i>=0;--i)            {            if(A[i+begin]>A[2*i+1+begin])                swapnum(A[i+begin],A[2*i+1+begin]);            if(A[i+begin]>A[2*i+2+begin])                swapnum(A[i+begin],A[2*i+2+begin]);        }            }    void swapnum(int &a,int &b)        {        int temp;        temp=a;        a=b;        b=temp;            }};