大津法二值化的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，希望有人分享一下。