void CMeshWarp::MedianFilter(CDIB *src, CDIB *dest, int kwidth)
{
int x, y, i, j;
int nWidth = src->Width();
int nHeight = src->Height();
int nkHeight = kwidth, nkWidth = kwidth;
int kerx, kery, index, xextra, yextra;
BYTE windowR[9], windowG[9], windowB[9]; /* storage for window samples */
int xpad, ypad;
COLORREF color;
nkHeight = nkWidth = 3;

yextra = (nkHeight / 2) * 2;
ypad = yextra / 2;
xextra = (nkWidth / 2) * 2;
xpad = xextra / 2;

for (y = ypad; y < (nHeight - ypad); y++) {
for (x = xpad; x < (nWidth - xpad); x++) {
index = 0;
for (kery = -1 * ypad; kery <= ypad; kery++)
for (kerx = - 1 * xpad; kerx <= xpad; kerx++) {
color = src->GetPixel(x + kerx, y + kery);
windowR[index] = GetRValue(color);
windowG[index] = GetGValue(color);
windowB[index++] = GetBValue(color);
}
dest->SetPixel(x, y, FindColorMedian(windowR, windowG, windowB, kwidth * kwidth));
}
if (y == ypad) {
for (i = 0; i < ypad; i++) {
dest->SetPixel(0, i, dest->GetPixel(xpad, ypad));
for (j = xpad; j < nWidth - xpad; j++)
dest->SetPixel(j, i, dest->GetPixel(j, ypad));
dest->SetPixel(nWidth - xpad, i, dest->GetPixel(xextra, ypad));
}
} else if (y == nHeight - yextra) {
for (i = 0; i < ypad; i++) {
dest->SetPixel(0, nHeight - yextra + 1 + i, dest->GetPixel(xpad, nHeight - yextra));
for (j = xpad; j < nWidth - xpad; j++)
dest->SetPixel(j, nHeight - yextra + 1 + i, dest->GetPixel(j, nHeight - yextra));
dest->SetPixel(nWidth - xpad, nHeight - yextra + 1 + i, dest->GetPixel(xextra, nHeight - yextra));
}
} else {
dest->SetPixel(0, y, dest->GetPixel(xpad, y));
dest->SetPixel(nWidth - xpad, y, dest->GetPixel(xextra, y));
}
}
}

COLORREF CMeshWarp::FindColorMedian(BYTE *r, BYTE *g, BYTE *b, int wsize)
{
unsigned int vec_sum, min_sum = 10000;
int index = 0;
for (int i = 0; i < wsize; i++) {
vec_sum = 0;
for (int j = 0; j < wsize; j++) {
vec_sum += abs(r[i] - r[j]);
vec_sum += abs(g[i] - g[j]);
vec_sum += abs(b[i] - b[j]);
}
if (vec_sum <= min_sum) {
min_sum = vec_sum;
index = i;
}
}
return RGB(r[index], g[index], b[index]);
}