灰度直方算法 C++

#include <string>
#include "20140318计算类的面积.cpp"

//////////////////////////////////////////////////////////////////////////
//   函数名称: histeq()
//   传入参数: 
//   BYTE*dstData      传入灰度图像内存空间的指针
//   double *srcArray  模版的直方图累积，并进行归一化，大小为256
//   int m_Width       匹配内存空间的宽度
//   int m_Height      匹配内存空间的高度
//   int m_pitch       匹配内存空间的每行所在内存大小
////////////////////////////////////////////////////////////////////////

void histeq(int **dstData, double *srcArray,int m_Width,int m_Height,int m_pitch)
{
    //void *memset(void *s,int c,size_t n)将已开辟内存空间 s 的首 n 个字节的值设为值 c
    m_pitch=sizeof(data[0][0])*nXSize;
    double dstHist[256];
    memset(dstHist,0,256 * sizeof(double));
    double dstArray[256];
    memset(dstArray,0,256 * sizeof(double));
    int i=0,j=0;
    //统计直方图
    for (i = 0;i < m_Height;i++)
    {
        for (j = 0;j < m_Width;j++)
        {
            dstHist[(int)dstData[i * m_pitch + j]]++;
        }
    }
    //计算直方图累积
    double m_Bytes = m_Width * m_Height;//m_Bytes初始化为像素总个数
    dstArray[0] = dstHist[0];//第一个初始化为dstHist[0]=0
    for (i = 1;i < 256;i++)
    {
        dstArray[i] = dstArray[i - 1] + dstHist[i];
    }
    //直方图累积归一化
    for (i = 0;i < 256;i++)
    {
        dstArray[i] /= m_Bytes;
    }
    //直方图匹配
    double m_diffA,m_diffB;
    int k = 0;
    float mapPixel[256];//每个颜色的value
    memset(mapPixel,0,256 * sizeof(float));
    
    
    for (i = 0;i < 256;i++)
    {
        m_diffB = 1;
        for (j = k; j < 256;j++)
        {
            m_diffA = abs(dstArray[i] - srcArray[j]);
            if (m_diffA - m_diffB < 1.0E-5)
            {
                m_diffB = m_diffA;
                k = j;
            }
            else
            {
                k = j - 1;
                break;
            }
        }
        if (k == 255)
        {
            for (int l = i;l < 256;l++)
            {
                mapPixel[l] = (float) k;
            }
            break;
        }
        mapPixel[i] = (float) k;
    }
    //目标图像查找索引表
    for (i = 0;i < m_Height;i++)
    {
        for (j = 0;j < m_Width;j++)
        {
            dstData[i * m_pitch + j] = mapPixel[(int)dstData[i * m_pitch + j]];
        }
    }
}