大津法二值化的C語言版本

下面是前面我弄的C#版本大津法二值化化轉化爲C語言的。
/***************************************************************
* 河南科技大學一隊
*
* 函數名稱：void GetHistGram(uint8_t Image[Height][Width])
* 功能說明：獲取圖像的灰度信息
* 參數說明：
* 函數返回：void
* 修改時間：2018年3月7日
* 備 注：
***************************************************************/
void GetHistGram(uint8_t Image[Height][Width])
{
int X,Y;
for (Y = 0; Y < 256; Y++)
{
HistGram[Y] = 0; //初始化灰度直方圖
}
for (Y = 0; Y < Image_Height; Y++)
{
for (X = 0; X < Image_Width; X++)
{
HistGram[Image[Y][X]]++; //統計每個灰度值的個數信息
}
}
}
/***************************************************************
* 河南科技大學一隊
*
* 函數名稱：uint8_t OSTUThreshold()
* 功能說明：大津法獲取圖像閾值
* 參數說明：
* 函數返回：uint8_t 閾值
* 修改時間：2018年3月7日
* 備 注：
***************************************************************/
uint8_t OSTUThreshold()
{
int16_t Y;
uint32_t Amount = 0;
uint32_t PixelBack = 0;
uint32_t PixelIntegralBack = 0;
uint32_t PixelIntegral = 0;
int32_t PixelIntegralFore = 0;
int32_t PixelFore = 0;
double OmegaBack, OmegaFore, MicroBack, MicroFore, SigmaB, Sigma; // 類間方差;
int16_t MinValue, MaxValue;
uint8_t Threshold = 0;

for (MinValue = 0; MinValue < 256 && HistGram[MinValue] == 0; MinValue++) ;        //獲取最小灰度的值
for (MaxValue = 255; MaxValue > MinValue && HistGram[MinValue] == 0; MaxValue--) ; //獲取最大灰度的值

if (MaxValue == MinValue) 
{
    return MaxValue;          // 圖像中只有一個顏色    
}
if (MinValue + 1 == MaxValue) 
{
    return MinValue;      // 圖像中只有二個顏色
}

for (Y = MinValue; Y <= MaxValue; Y++)
{
    Amount += HistGram[Y];        //  像素總數
}

PixelIntegral = 0;
for (Y = MinValue; Y <= MaxValue; Y++)
{
    PixelIntegral += HistGram[Y] * Y;//灰度值總數
}
SigmaB = -1;
for (Y = MinValue; Y < MaxValue; Y++)
{
    PixelBack = PixelBack + HistGram[Y];    //前景像素點數
    PixelFore = Amount - PixelBack;         //背景像素點數
    OmegaBack = (double)PixelBack / Amount;//前景像素百分比
    OmegaFore = (double)PixelFore / Amount;//背景像素百分比
    PixelIntegralBack += HistGram[Y] * Y;  //前景灰度值
    PixelIntegralFore = PixelIntegral - PixelIntegralBack;//背景灰度值
    MicroBack = (double)PixelIntegralBack / PixelBack;//前景灰度百分比
    MicroFore = (double)PixelIntegralFore / PixelFore;//背景灰度百分比
    Sigma = OmegaBack * OmegaFore * (MicroBack - MicroFore) * (MicroBack - MicroFore);//g
    if (Sigma > SigmaB)//遍歷最大的類間方差g
    {
        SigmaB = Sigma;
        Threshold = Y;
    }
}
return Threshold;

}
2ms的運行時間還行吧，可能還需要優化，我還沒有成功開啓FPU，希望有人分享一下。