static void imlib_sub_line_op(image_t *img, int line, void *other, void *data, bool vflipped) { bool reverse = ((imlib_sub_line_op_state_t *) data)->reverse; image_t *mask = ((imlib_sub_line_op_state_t *) data)->mask; switch(img->bpp) { case IMAGE_BPP_BINARY: { uint32_t *data = IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(img, line); for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_BINARY_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_BINARY_PIXEL_FAST(((uint32_t *) other), i); int p = reverse ? (otherPixel - dataPixel) : (dataPixel - otherPixel); p = IM_MAX(p, COLOR_BINARY_MIN); IMAGE_PUT_BINARY_PIXEL_FAST(data, i, p); } } break; } case IMAGE_BPP_GRAYSCALE: { uint8_t *data = IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(img, line); for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(((uint8_t *) other), i); int p = reverse ? (otherPixel - dataPixel) : (dataPixel - otherPixel); p = IM_MAX(p, COLOR_GRAYSCALE_MIN); IMAGE_PUT_GRAYSCALE_PIXEL_FAST(data, i, p); } } break; } case IMAGE_BPP_RGB565: { uint16_t *data = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, line); for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_RGB565_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_RGB565_PIXEL_FAST(((uint16_t *) other), i); int dR = COLOR_RGB565_TO_R5(dataPixel); int dG = COLOR_RGB565_TO_G6(dataPixel); int dB = COLOR_RGB565_TO_B5(dataPixel); int oR = COLOR_RGB565_TO_R5(otherPixel); int oG = COLOR_RGB565_TO_G6(otherPixel); int oB = COLOR_RGB565_TO_B5(otherPixel); int r = reverse ? (oR - dR) : (dR - oR); int g = reverse ? (oG - dG) : (dG - oG); int b = reverse ? (oB - dB) : (dB - oB); r = IM_MAX(r, COLOR_R5_MIN); g = IM_MAX(g, COLOR_G6_MIN); b = IM_MAX(b, COLOR_B5_MIN); IMAGE_PUT_RGB565_PIXEL_FAST(data, i, COLOR_R5_G6_B5_TO_RGB565(r, g, b)); } } break; } default: { break; } } }
static void imlib_add_line_op(image_t *img, int line, void *other, void *data, bool vflipped) { image_t *mask = (image_t *) data; switch(img->bpp) { case IMAGE_BPP_BINARY: { uint32_t *data = IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(img, line); for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_BINARY_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_BINARY_PIXEL_FAST(((uint32_t *) other), i); int p = dataPixel + otherPixel; p = IM_MIN(p, COLOR_BINARY_MAX); IMAGE_PUT_BINARY_PIXEL_FAST(data, i, p); } } break; } case IMAGE_BPP_GRAYSCALE: { uint8_t *data = IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(img, line); for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(((uint8_t *) other), i); int p = dataPixel + otherPixel; p = IM_MIN(p, COLOR_GRAYSCALE_MAX); IMAGE_PUT_GRAYSCALE_PIXEL_FAST(data, i, p); } } break; } case IMAGE_BPP_RGB565: { uint16_t *data = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, line); for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_RGB565_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_RGB565_PIXEL_FAST(((uint16_t *) other), i); int r = COLOR_RGB565_TO_R5(dataPixel) + COLOR_RGB565_TO_R5(otherPixel); int g = COLOR_RGB565_TO_G6(dataPixel) + COLOR_RGB565_TO_G6(otherPixel); int b = COLOR_RGB565_TO_B5(dataPixel) + COLOR_RGB565_TO_B5(otherPixel); r = IM_MIN(r, COLOR_R5_MAX); g = IM_MIN(g, COLOR_G6_MAX); b = IM_MIN(b, COLOR_B5_MAX); IMAGE_PUT_RGB565_PIXEL_FAST(data, i, COLOR_R5_G6_B5_TO_RGB565(r, g, b)); } } break; } default: { break; } } }
static void imlib_blend_line_op(image_t *img, int line, void *other, void *data, bool vflipped) { float alpha = ((imlib_blend_line_op_t *) data)->alpha, beta = 1 - alpha; image_t *mask = ((imlib_blend_line_op_t *) data)->mask; switch(img->bpp) { case IMAGE_BPP_BINARY: { uint32_t *data = IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(img, line); for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_BINARY_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_BINARY_PIXEL_FAST(((uint32_t *) other), i); int p = (dataPixel * alpha) + (otherPixel * beta); IMAGE_PUT_BINARY_PIXEL_FAST(data, i, p); } } break; } case IMAGE_BPP_GRAYSCALE: { uint8_t *data = IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(img, line); for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(((uint8_t *) other), i); int p = (dataPixel * alpha) + (otherPixel * beta); IMAGE_PUT_GRAYSCALE_PIXEL_FAST(data, i, p); } } break; } case IMAGE_BPP_RGB565: { uint16_t *data = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, line); for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_RGB565_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_RGB565_PIXEL_FAST(((uint16_t *) other), i); int r = (COLOR_RGB565_TO_R5(dataPixel) * alpha) + (COLOR_RGB565_TO_R5(otherPixel) * beta); int g = (COLOR_RGB565_TO_G6(dataPixel) * alpha) + (COLOR_RGB565_TO_G6(otherPixel) * beta); int b = (COLOR_RGB565_TO_B5(dataPixel) * alpha) + (COLOR_RGB565_TO_B5(otherPixel) * beta); IMAGE_PUT_RGB565_PIXEL_FAST(data, i, COLOR_R5_G6_B5_TO_RGB565(r, g, b)); } } break; } default: { break; } } }
void imlib_chrominvar(image_t *img) { switch(img->bpp) { case IMAGE_BPP_BINARY: { break; } case IMAGE_BPP_GRAYSCALE: { break; } case IMAGE_BPP_RGB565: { for (int y = 0, yy = img->h; y < yy; y++) { uint16_t *row_ptr = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, y); for (int x = 0, xx = img->w; x < xx; x++) { int pixel = IMAGE_GET_RGB565_PIXEL_FAST(row_ptr, x); float r_lin = xyz_table[COLOR_RGB565_TO_R8(pixel)]; float g_lin = xyz_table[COLOR_RGB565_TO_G8(pixel)]; float b_lin = xyz_table[COLOR_RGB565_TO_B8(pixel)]; float lin_sum = r_lin + g_lin + b_lin; float r_lin_div = 0.0f; float g_lin_div = 0.0f; float b_lin_div = 0.0f; if (lin_sum > 0.0f) { lin_sum = 1.0f / lin_sum; r_lin_div = r_lin * lin_sum; g_lin_div = g_lin * lin_sum; b_lin_div = b_lin * lin_sum; } int r_lin_div_int = IM_MAX(IM_MIN(r_lin_div * 255.0f, COLOR_R8_MAX), COLOR_R8_MIN); int g_lin_div_int = IM_MAX(IM_MIN(g_lin_div * 255.0f, COLOR_G8_MAX), COLOR_G8_MIN); int b_lin_div_int = IM_MAX(IM_MIN(b_lin_div * 255.0f, COLOR_B8_MAX), COLOR_B8_MIN); IMAGE_PUT_RGB565_PIXEL_FAST(row_ptr, x, COLOR_R8_G8_B8_TO_RGB565(r_lin_div_int, g_lin_div_int, b_lin_div_int)); } } break; } default: { break; } } }
void imlib_negate(image_t *img) { switch(img->bpp) { case IMAGE_BPP_BINARY: { for (int y = 0, yy = img->h; y < yy; y++) { uint32_t *data = IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(img, y); for (int x = 0, xx = img->w; x < xx; x++) { int dataPixel = IMAGE_GET_BINARY_PIXEL_FAST(data, x); int p = (COLOR_BINARY_MAX - COLOR_BINARY_MIN) - dataPixel; IMAGE_PUT_BINARY_PIXEL_FAST(data, x, p); } } break; } case IMAGE_BPP_GRAYSCALE: { for (int y = 0, yy = img->h; y < yy; y++) { uint8_t *data = IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(img, y); for (int x = 0, xx = img->w; x < xx; x++) { int dataPixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(data, x); int p = (COLOR_GRAYSCALE_MAX - COLOR_GRAYSCALE_MIN) - dataPixel; IMAGE_PUT_GRAYSCALE_PIXEL_FAST(data, x, p); } } break; } case IMAGE_BPP_RGB565: { for (int y = 0, yy = img->h; y < yy; y++) { uint16_t *data = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, y); for (int x = 0, xx = img->w; x < xx; x++) { int dataPixel = IMAGE_GET_RGB565_PIXEL_FAST(data, x); int r = (COLOR_R5_MAX - COLOR_R5_MIN) - COLOR_RGB565_TO_R5(dataPixel); int g = (COLOR_G6_MAX - COLOR_G6_MIN) - COLOR_RGB565_TO_G6(dataPixel); int b = (COLOR_B5_MAX - COLOR_B5_MIN) - COLOR_RGB565_TO_B5(dataPixel); IMAGE_PUT_RGB565_PIXEL_FAST(data, x, COLOR_R5_G6_B5_TO_RGB565(r, g, b)); } } break; } default: { break; } } }
void imlib_gamma_corr(image_t *img, float gamma, float contrast, float brightness) { gamma = IM_DIV(1.0, gamma); switch(img->bpp) { case IMAGE_BPP_BINARY: { float pScale = COLOR_BINARY_MAX - COLOR_BINARY_MIN; float pDiv = 1 / pScale; int *p_lut = fb_alloc((COLOR_BINARY_MAX - COLOR_BINARY_MIN + 1) * sizeof(int)); for (int i = COLOR_BINARY_MIN; i <= COLOR_BINARY_MAX; i++) { int p = ((fast_powf(i * pDiv, gamma) * contrast) + brightness) * pScale; p_lut[i] = IM_MIN(IM_MAX(p , COLOR_BINARY_MIN), COLOR_BINARY_MAX); } for (int y = 0, yy = img->h; y < yy; y++) { uint32_t *data = IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(img, y); for (int x = 0, xx = img->w; x < xx; x++) { int dataPixel = IMAGE_GET_BINARY_PIXEL_FAST(data, x); int p = p_lut[dataPixel]; IMAGE_PUT_BINARY_PIXEL_FAST(data, x, p); } } fb_free(); break; } case IMAGE_BPP_GRAYSCALE: { float pScale = COLOR_GRAYSCALE_MAX - COLOR_GRAYSCALE_MIN; float pDiv = 1 / pScale; int *p_lut = fb_alloc((COLOR_GRAYSCALE_MAX - COLOR_GRAYSCALE_MIN + 1) * sizeof(int)); for (int i = COLOR_GRAYSCALE_MIN; i <= COLOR_GRAYSCALE_MAX; i++) { int p = ((fast_powf(i * pDiv, gamma) * contrast) + brightness) * pScale; p_lut[i] = IM_MIN(IM_MAX(p , COLOR_GRAYSCALE_MIN), COLOR_GRAYSCALE_MAX); } for (int y = 0, yy = img->h; y < yy; y++) { uint8_t *data = IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(img, y); for (int x = 0, xx = img->w; x < xx; x++) { int dataPixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(data, x); int p = p_lut[dataPixel]; IMAGE_PUT_GRAYSCALE_PIXEL_FAST(data, x, p); } } fb_free(); break; } case IMAGE_BPP_RGB565: { float rScale = COLOR_R5_MAX - COLOR_R5_MIN; float gScale = COLOR_G6_MAX - COLOR_G6_MIN; float bScale = COLOR_B5_MAX - COLOR_B5_MIN; float rDiv = 1 / rScale; float gDiv = 1 / gScale; float bDiv = 1 / bScale; int *r_lut = fb_alloc((COLOR_R5_MAX - COLOR_R5_MIN + 1) * sizeof(int)); int *g_lut = fb_alloc((COLOR_G6_MAX - COLOR_G6_MIN + 1) * sizeof(int)); int *b_lut = fb_alloc((COLOR_B5_MAX - COLOR_B5_MIN + 1) * sizeof(int)); for (int i = COLOR_R5_MIN; i <= COLOR_R5_MAX; i++) { int r = ((fast_powf(i * rDiv, gamma) * contrast) + brightness) * rScale; r_lut[i] = IM_MIN(IM_MAX(r , COLOR_R5_MIN), COLOR_R5_MAX); } for (int i = COLOR_G6_MIN; i <= COLOR_G6_MAX; i++) { int g = ((fast_powf(i * gDiv, gamma) * contrast) + brightness) * gScale; g_lut[i] = IM_MIN(IM_MAX(g , COLOR_G6_MIN), COLOR_G6_MAX); } for (int i = COLOR_B5_MIN; i <= COLOR_B5_MAX; i++) { int b = ((fast_powf(i * bDiv, gamma) * contrast) + brightness) * bScale; b_lut[i] = IM_MIN(IM_MAX(b , COLOR_B5_MIN), COLOR_B5_MAX); } for (int y = 0, yy = img->h; y < yy; y++) { uint16_t *data = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, y); for (int x = 0, xx = img->w; x < xx; x++) { int dataPixel = IMAGE_GET_RGB565_PIXEL_FAST(data, x); int r = r_lut[COLOR_RGB565_TO_R5(dataPixel)]; int g = g_lut[COLOR_RGB565_TO_G6(dataPixel)]; int b = b_lut[COLOR_RGB565_TO_B5(dataPixel)]; IMAGE_PUT_RGB565_PIXEL_FAST(data, x, COLOR_R5_G6_B5_TO_RGB565(r, g, b)); } } fb_free(); fb_free(); fb_free(); break; } default: { break; } } }
static void imlib_div_line_op(image_t *img, int line, void *other, void *data, bool vflipped) { bool invert = ((imlib_div_line_op_state_t *) data)->invert; bool mod = ((imlib_div_line_op_state_t *) data)->mod; image_t *mask = ((imlib_div_line_op_state_t *) data)->mask; switch(img->bpp) { case IMAGE_BPP_BINARY: { uint32_t *data = IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(img, line); int pScale = COLOR_BINARY_MAX - COLOR_BINARY_MIN; for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_BINARY_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_BINARY_PIXEL_FAST(((uint32_t *) other), i); int p = mod ? IM_MOD((invert?otherPixel:dataPixel) * pScale, (invert?dataPixel:otherPixel)) : IM_DIV((invert?otherPixel:dataPixel) * pScale, (invert?dataPixel:otherPixel)); p = IM_MIN(p, COLOR_BINARY_MAX); IMAGE_PUT_BINARY_PIXEL_FAST(data, i, p); } } break; } case IMAGE_BPP_GRAYSCALE: { uint8_t *data = IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(img, line); int pScale = COLOR_GRAYSCALE_MAX - COLOR_GRAYSCALE_MIN; for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(((uint8_t *) other), i); int p = mod ? IM_MOD((invert?otherPixel:dataPixel) * pScale, (invert?dataPixel:otherPixel)) : IM_DIV((invert?otherPixel:dataPixel) * pScale, (invert?dataPixel:otherPixel)); p = IM_MIN(p, COLOR_GRAYSCALE_MAX); IMAGE_PUT_GRAYSCALE_PIXEL_FAST(data, i, p); } } break; } case IMAGE_BPP_RGB565: { uint16_t *data = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, line); int rScale = COLOR_R5_MAX - COLOR_R5_MIN; int gScale = COLOR_G6_MAX - COLOR_G6_MIN; int bScale = COLOR_B5_MAX - COLOR_B5_MIN; for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_RGB565_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_RGB565_PIXEL_FAST(((uint16_t *) other), i); int dR = COLOR_RGB565_TO_R5(dataPixel); int dG = COLOR_RGB565_TO_G6(dataPixel); int dB = COLOR_RGB565_TO_B5(dataPixel); int oR = COLOR_RGB565_TO_R5(otherPixel); int oG = COLOR_RGB565_TO_G6(otherPixel); int oB = COLOR_RGB565_TO_B5(otherPixel); int r = mod ? IM_MOD((invert?oR:dR) * rScale, (invert?dR:oR)) : IM_DIV((invert?oR:dR) * rScale, (invert?dR:oR)); int g = mod ? IM_MOD((invert?oG:dG) * gScale, (invert?dG:oG)) : IM_DIV((invert?oG:dG) * gScale, (invert?dG:oG)); int b = mod ? IM_MOD((invert?oB:dB) * bScale, (invert?dB:oB)) : IM_DIV((invert?oB:dB) * bScale, (invert?dB:oB)); r = IM_MIN(r, COLOR_R5_MAX); g = IM_MIN(g, COLOR_G6_MAX); b = IM_MIN(b, COLOR_B5_MAX); IMAGE_PUT_RGB565_PIXEL_FAST(data, i, COLOR_R5_G6_B5_TO_RGB565(r, g, b)); } } break; } default: { break; } } }
static void imlib_mul_line_op(image_t *img, int line, void *other, void *data, bool vflipped) { bool invert = ((imlib_mul_line_op_state_t *) data)->invert; image_t *mask = ((imlib_mul_line_op_state_t *) data)->mask; switch(img->bpp) { case IMAGE_BPP_BINARY: { uint32_t *data = IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(img, line); float pScale = COLOR_BINARY_MAX - COLOR_BINARY_MIN; float pDiv = 1 / pScale; for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_BINARY_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_BINARY_PIXEL_FAST(((uint32_t *) other), i); int p = invert ? (pScale - ((pScale - dataPixel) * (pScale - otherPixel) * pDiv)) : (dataPixel * otherPixel * pDiv); IMAGE_PUT_BINARY_PIXEL_FAST(data, i, p); } } break; } case IMAGE_BPP_GRAYSCALE: { uint8_t *data = IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(img, line); float pScale = COLOR_GRAYSCALE_MAX - COLOR_GRAYSCALE_MIN; float pDiv = 1 / pScale; for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(((uint8_t *) other), i); int p = invert ? (pScale - ((pScale - dataPixel) * (pScale - otherPixel) * pDiv)) : (dataPixel * otherPixel * pDiv); IMAGE_PUT_GRAYSCALE_PIXEL_FAST(data, i, p); } } break; } case IMAGE_BPP_RGB565: { uint16_t *data = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, line); float rScale = COLOR_R5_MAX - COLOR_R5_MIN; float gScale = COLOR_G6_MAX - COLOR_G6_MIN; float bScale = COLOR_B5_MAX - COLOR_B5_MIN; float rDiv = 1 / rScale; float gDiv = 1 / gScale; float bDiv = 1 / bScale; for (int i = 0, j = img->w; i < j; i++) { if ((!mask) || image_get_mask_pixel(mask, i, line)) { int dataPixel = IMAGE_GET_RGB565_PIXEL_FAST(data, i); int otherPixel = IMAGE_GET_RGB565_PIXEL_FAST(((uint16_t *) other), i); int dR = COLOR_RGB565_TO_R5(dataPixel); int dG = COLOR_RGB565_TO_G6(dataPixel); int dB = COLOR_RGB565_TO_B5(dataPixel); int oR = COLOR_RGB565_TO_R5(otherPixel); int oG = COLOR_RGB565_TO_G6(otherPixel); int oB = COLOR_RGB565_TO_B5(otherPixel); int r = invert ? (rScale - ((rScale - dR) * (rScale - oR) * rDiv)) : (dR * oR * rDiv); int g = invert ? (gScale - ((gScale - dG) * (gScale - oG) * gDiv)) : (dG * oG * gDiv); int b = invert ? (bScale - ((bScale - dB) * (bScale - oB) * bDiv)) : (dB * oB * bDiv); IMAGE_PUT_RGB565_PIXEL_FAST(data, i, COLOR_R5_G6_B5_TO_RGB565(r, g, b)); } } break; } default: { break; } } }
void imlib_illuminvar(image_t *img) // http://ai.stanford.edu/~alireza/publication/cic15.pdf { switch(img->bpp) { case IMAGE_BPP_BINARY: { break; } case IMAGE_BPP_GRAYSCALE: { break; } case IMAGE_BPP_RGB565: { for (int y = 0, yy = img->h; y < yy; y++) { uint16_t *row_ptr = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, y); for (int x = 0, xx = img->w; x < xx; x++) { int pixel = IMAGE_GET_RGB565_PIXEL_FAST(row_ptr, x); #ifdef IMLIB_ENABLE_INVARIANT_TABLE int rgb565 = invariant_table[pixel]; #else float r_lin = xyz_table[COLOR_RGB565_TO_R8(pixel)] + 1.0; float g_lin = xyz_table[COLOR_RGB565_TO_G8(pixel)] + 1.0; float b_lin = xyz_table[COLOR_RGB565_TO_B8(pixel)] + 1.0; float r_lin_sharp = (r_lin * 0.9968f) + (g_lin * 0.0228f) + (b_lin * 0.0015f); float g_lin_sharp = (r_lin * -0.0071f) + (g_lin * 0.9933f) + (b_lin * 0.0146f); float b_lin_sharp = (r_lin * 0.0103f) + (g_lin * -0.0161f) + (b_lin * 0.9839f); float lin_sharp_avg = r_lin_sharp * g_lin_sharp * b_lin_sharp; lin_sharp_avg = (lin_sharp_avg > 0.0f) ? fast_cbrtf(lin_sharp_avg) : 0.0f; float r_lin_sharp_div = 0.0f; float g_lin_sharp_div = 0.0f; float b_lin_sharp_div = 0.0f; if (lin_sharp_avg > 0.0f) { lin_sharp_avg = 1.0f / lin_sharp_avg; r_lin_sharp_div = r_lin_sharp * lin_sharp_avg; g_lin_sharp_div = g_lin_sharp * lin_sharp_avg; b_lin_sharp_div = b_lin_sharp * lin_sharp_avg; } float r_lin_sharp_div_log = (r_lin_sharp_div > 0.0f) ? fast_log(r_lin_sharp_div) : 0.0f; float g_lin_sharp_div_log = (g_lin_sharp_div > 0.0f) ? fast_log(g_lin_sharp_div) : 0.0f; float b_lin_sharp_div_log = (b_lin_sharp_div > 0.0f) ? fast_log(b_lin_sharp_div) : 0.0f; float chi_x = (r_lin_sharp_div_log * 0.7071f) + (g_lin_sharp_div_log * -0.7071f) + (b_lin_sharp_div_log * 0.0000f); float chi_y = (r_lin_sharp_div_log * 0.4082f) + (g_lin_sharp_div_log * 0.4082f) + (b_lin_sharp_div_log * -0.8164f); float e_t_x = 0.9326f; float e_t_y = -0.3609f; float p_th_00 = e_t_x * e_t_x; float p_th_01 = e_t_x * e_t_y; float p_th_10 = e_t_y * e_t_x; float p_th_11 = e_t_y * e_t_y; float x_th_x = (p_th_00 * chi_x) + (p_th_01 * chi_y); float x_th_y = (p_th_10 * chi_x) + (p_th_11 * chi_y); float r_chi = (x_th_x * 0.7071f) + (x_th_y * 0.4082f); float g_chi = (x_th_x * -0.7071f) + (x_th_y * 0.4082f); float b_chi = (x_th_x * 0.0000f) + (x_th_y * -0.8164f); float r_chi_invariant = fast_expf(r_chi); float g_chi_invariant = fast_expf(g_chi); float b_chi_invariant = fast_expf(b_chi); float chi_invariant_sum = r_chi_invariant + g_chi_invariant + b_chi_invariant; float r_chi_invariant_m = 0.0f; float g_chi_invariant_m = 0.0f; float b_chi_invariant_m = 0.0f; if (chi_invariant_sum > 0.0f) { chi_invariant_sum = 1.0f / chi_invariant_sum; r_chi_invariant_m = r_chi_invariant * chi_invariant_sum; g_chi_invariant_m = g_chi_invariant * chi_invariant_sum; b_chi_invariant_m = b_chi_invariant * chi_invariant_sum; } int r_chi_invariant_m_int = IM_MAX(IM_MIN(r_chi_invariant_m * 255.0f, COLOR_R8_MAX), COLOR_R8_MIN); int g_chi_invariant_m_int = IM_MAX(IM_MIN(g_chi_invariant_m * 255.0f, COLOR_G8_MAX), COLOR_G8_MIN); int b_chi_invariant_m_int = IM_MAX(IM_MIN(b_chi_invariant_m * 255.0f, COLOR_B8_MAX), COLOR_B8_MIN); int rgb565 = COLOR_R8_G8_B8_TO_RGB565(r_chi_invariant_m_int, g_chi_invariant_m_int, b_chi_invariant_m_int); #endif IMAGE_PUT_RGB565_PIXEL_FAST(row_ptr, x, rgb565); } } break; } default: { break; } } }
static void imlib_remove_shadows_sub_line_op(image_t *img, int line, void *data, bool vflipped) { imlib_remove_shadows_line_op_state_t *state = (imlib_remove_shadows_line_op_state_t *) data; if (state->lines_processed >= imlib_remove_shadows_kernel_rank) { int y = vflipped ? (line + imlib_remove_shadows_kernel_rank) : (line - imlib_remove_shadows_kernel_rank); int index = y % imlib_remove_shadows_kernel_size; for (int x = 0, xx = img->w; x < xx; x++) { int img_pixel = IMAGE_GET_RGB565_PIXEL_FAST(state->img_lines[index], x); int img_r = COLOR_RGB565_TO_R8(img_pixel); int img_g = COLOR_RGB565_TO_G8(img_pixel); int img_b = COLOR_RGB565_TO_B8(img_pixel); float img_v = IM_MAX(IM_MAX(img_r, img_g), img_b); int other_pixel = IMAGE_GET_RGB565_PIXEL_FAST(state->other_lines[index], x); int other_r = COLOR_RGB565_TO_R8(other_pixel); int other_g = COLOR_RGB565_TO_G8(other_pixel); int other_b = COLOR_RGB565_TO_B8(other_pixel); float other_v = IM_MAX(IM_MAX(other_r, other_g), other_b); float ratio = img_v / other_v; if ((0.3f < ratio) && (ratio < 1.0f)) { int minY = IM_MAX(y - imlib_remove_shadows_kernel_rank, 0); int maxY = IM_MIN(y + imlib_remove_shadows_kernel_rank, img->h - 1); int minX = IM_MAX(x - imlib_remove_shadows_kernel_rank, 0); int maxX = IM_MIN(x + imlib_remove_shadows_kernel_rank, img->w - 1); int windowArea = (maxX - minX + 1) * (maxY - minY + 1); int hDiffSum = 0; int sDiffSum = 0; for (int k_y = minY; k_y <= maxY; k_y++) { int k_index = k_y % imlib_remove_shadows_kernel_size; for (int k_x = minX; k_x <= maxX; k_x++) { int k_img_pixel = IMAGE_GET_RGB565_PIXEL_FAST(state->img_lines[k_index], k_x); int k_img_r = COLOR_RGB565_TO_R8(k_img_pixel); int k_img_g = COLOR_RGB565_TO_G8(k_img_pixel); int k_img_b = COLOR_RGB565_TO_B8(k_img_pixel); int k_img_cmax = IM_MAX(IM_MAX(k_img_r, k_img_g), k_img_b); int k_img_cmin = IM_MAX(IM_MAX(k_img_r, k_img_g), k_img_b); float k_img_cdel = k_img_cmax - k_img_cmin; float k_img_h = 0; float k_img_s = k_img_cmax ? (k_img_cdel / k_img_cmax) : 0; int k_other_pixel = IMAGE_GET_RGB565_PIXEL_FAST(state->other_lines[k_index], k_x); int k_other_r = COLOR_RGB565_TO_R8(k_other_pixel); int k_other_g = COLOR_RGB565_TO_G8(k_other_pixel); int k_other_b = COLOR_RGB565_TO_B8(k_other_pixel); int k_other_cmax = IM_MAX(IM_MAX(k_other_r, k_other_g), k_other_b); int k_other_cmin = IM_MAX(IM_MAX(k_other_r, k_other_g), k_other_b); float k_other_cdel = k_other_cmax - k_other_cmin; float k_other_h = 0; float k_other_s = k_other_cmax ? (k_other_cdel / k_other_cmax) : 0; if (k_img_cdel) { if (k_img_cmax == k_img_r) { k_img_h = ((k_img_g - k_img_b) / k_img_cdel) + 0; } else if (k_img_cmax == k_img_g) { k_img_h = ((k_img_b - k_img_r) / k_img_cdel) + 2; } else if (k_img_cmax == k_img_b) { k_img_h = ((k_img_r - k_img_g) / k_img_cdel) + 4; } k_img_h *= 60; if (k_img_h < 0) k_img_h += 360.0; } if (k_other_cdel) { if (k_other_cmax == k_other_r) { k_other_h = ((k_other_g - k_other_b) / k_other_cdel) + 0; } else if (k_other_cmax == k_other_g) { k_other_h = ((k_other_b - k_other_r) / k_other_cdel) + 2; } else if (k_other_cmax == k_other_b) { k_other_h = ((k_other_r - k_other_g) / k_other_cdel) + 4; } k_other_h *= 60; if (k_other_h < 0) k_other_h += 360.0; } int hDiff = abs(k_img_h - k_other_h); hDiffSum += (hDiff >= 90) ? (180 - hDiff) : hDiff; sDiffSum += k_img_s - k_other_s; } } bool hIsShadow = (hDiffSum / windowArea) < 48; bool sIsShadow = (sDiffSum / windowArea) < 40; IMAGE_PUT_RGB565_PIXEL_FAST(state->out_lines[index], x, (hIsShadow && sIsShadow) ? other_pixel : img_pixel); } else { IMAGE_PUT_RGB565_PIXEL_FAST(state->out_lines[index], x, img_pixel); } } } imlib_remove_shadows_sub_sub_line_op(img, line, data, vflipped); }
void imlib_remove_shadows(image_t *img, const char *path, image_t *other, int scalar, bool single) { if (!single) { imlib_remove_shadows_line_op_state_t state; for (int i = 0; i < imlib_remove_shadows_kernel_size; i++) { state.img_lines[i] = fb_alloc(img->w * sizeof(uint16_t)); state.other_lines[i] = fb_alloc(img->w * sizeof(uint16_t)); state.out_lines[i] = fb_alloc(img->w * sizeof(uint16_t)); } state.lines_processed = 0; imlib_image_operation(img, path, other, scalar, imlib_remove_shadows_line_op, &state); for (int i = 0; i < imlib_remove_shadows_kernel_size; i++) { fb_free(); fb_free(); fb_free(); } } else { // Create Shadow Mask image_t temp_image; temp_image.w = img->w; temp_image.h = img->h; temp_image.bpp = img->bpp; temp_image.data = fb_alloc(image_size(img)); memcpy(temp_image.data, img->data, image_size(img)); rectangle_t r; r.x = 0; r.y = 0; r.w = temp_image.w; r.h = temp_image.h; histogram_t h; h.LBinCount = COLOR_L_MAX - COLOR_L_MIN + 1; h.ABinCount = COLOR_A_MAX - COLOR_A_MIN + 1; h.BBinCount = COLOR_B_MAX - COLOR_B_MIN + 1; h.LBins = fb_alloc(h.LBinCount * sizeof(float)); h.ABins = fb_alloc(h.ABinCount * sizeof(float)); h.BBins = fb_alloc(h.BBinCount * sizeof(float)); imlib_get_histogram(&h, &temp_image, &r, NULL, false); statistics_t s; imlib_get_statistics(&s, temp_image.bpp, &h); int sum = 0; int mean = s.LMean * 0.8f; for (int y = 0, yy = temp_image.h; y < yy; y++) { uint16_t *row_ptr = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(&temp_image, y); for (int x = 0, xx = temp_image.w; x < xx; x++) { sum += COLOR_RGB565_TO_L(IMAGE_GET_RGB565_PIXEL_FAST(row_ptr, x)) < mean; } } if (sum > ((temp_image.w * temp_image.h) / 20)) { // Don't do anything if the image is mostly flat. threshold_t t; imlib_get_threshold(&t, temp_image.bpp, &h); list_t thresholds; list_init(&thresholds, sizeof(color_thresholds_list_lnk_data_t)); color_thresholds_list_lnk_data_t lnk_data; lnk_data.LMin = COLOR_L_MIN; lnk_data.AMin = COLOR_A_MIN; lnk_data.BMin = COLOR_B_MIN; lnk_data.LMax = t.LValue; lnk_data.AMax = COLOR_A_MAX; lnk_data.BMax = COLOR_B_MAX; list_push_back(&thresholds, &lnk_data); imlib_binary(&temp_image, &temp_image, &thresholds, false, false, NULL); list_free(&thresholds); imlib_erode(&temp_image, 3, 30, NULL); imlib_dilate(&temp_image, 1, 1, NULL); // Get Shadow Average image_t temp_image_2; temp_image_2.w = temp_image.w; temp_image_2.h = temp_image.h; temp_image_2.bpp = temp_image.bpp; temp_image_2.data = fb_alloc(image_size(&temp_image)); memcpy(temp_image_2.data, temp_image.data, image_size(&temp_image)); imlib_erode(&temp_image_2, 3, 48, NULL); int shadow_r_sum = 0; int shadow_g_sum = 0; int shadow_b_sum = 0; int shadow_count = 0; for (int y = 0, yy = temp_image_2.h; y < yy; y++) { uint16_t *row_ptr = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(&temp_image_2, y); uint16_t *row_ptr_2 = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, y); for (int x = 0, xx = temp_image_2.w; x < xx; x++) { if (IMAGE_GET_RGB565_PIXEL_FAST(row_ptr, x)) { int pixel = IMAGE_GET_RGB565_PIXEL_FAST(row_ptr_2, x); int r = COLOR_RGB565_TO_R8(pixel); int g = COLOR_RGB565_TO_G8(pixel); int b = COLOR_RGB565_TO_R8(pixel); shadow_r_sum += r; shadow_g_sum += g; shadow_b_sum += b; shadow_count += 1; } } } memcpy(temp_image_2.data, temp_image.data, image_size(&temp_image)); imlib_invert(&temp_image_2); imlib_erode(&temp_image_2, 5, 120, NULL); imlib_invert(&temp_image_2); imlib_b_xor(&temp_image_2, NULL, &temp_image, 0, NULL); imlib_erode(&temp_image_2, 2, 24, NULL); int not_shadow_r_sum = 0; int not_shadow_g_sum = 0; int not_shadow_b_sum = 0; int not_shadow_count = 0; for (int y = 0, yy = temp_image_2.h; y < yy; y++) { uint16_t *row_ptr = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(&temp_image_2, y); uint16_t *row_ptr_2 = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, y); for (int x = 0, xx = temp_image_2.w; x < xx; x++) { if (IMAGE_GET_RGB565_PIXEL_FAST(row_ptr, x)) { int pixel = IMAGE_GET_RGB565_PIXEL_FAST(row_ptr_2, x); int r = COLOR_RGB565_TO_R8(pixel); int g = COLOR_RGB565_TO_G8(pixel); int b = COLOR_RGB565_TO_R8(pixel); not_shadow_r_sum += r; not_shadow_g_sum += g; not_shadow_b_sum += b; not_shadow_count += 1; } } } // Fill in the umbra... (inner part of the shadow)... memcpy(temp_image_2.data, temp_image.data, image_size(&temp_image)); imlib_mean_filter(&temp_image, 2, false, 0, false, NULL); if (shadow_count && not_shadow_count) { float shadow_r_average = ((float) shadow_r_sum) / ((float) shadow_count); float shadow_g_average = ((float) shadow_g_sum) / ((float) shadow_count); float shadow_b_average = ((float) shadow_b_sum) / ((float) shadow_count); float not_shadow_r_average = ((float) not_shadow_r_sum) / ((float) not_shadow_count); float not_shadow_g_average = ((float) not_shadow_g_sum) / ((float) not_shadow_count); float not_shadow_b_average = ((float) not_shadow_b_sum) / ((float) not_shadow_count); float diff_r = not_shadow_r_average - shadow_r_average; float diff_g = not_shadow_g_average - shadow_g_average; float diff_b = not_shadow_b_average - shadow_b_average; for (int y = 0; y < img->h; y++) { uint16_t *row_ptr = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(&temp_image, y); uint16_t *row_ptr_2 = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, y); for (int x = 0; x < img->w; x++) { float alpha = ((float) (COLOR_RGB565_TO_Y(IMAGE_GET_RGB565_PIXEL_FAST(row_ptr, x)) - COLOR_Y_MIN)) / ((float) (COLOR_Y_MAX - COLOR_Y_MIN)); int pixel = IMAGE_GET_RGB565_PIXEL_FAST(row_ptr_2, x); int r = COLOR_RGB565_TO_R8(pixel); int g = COLOR_RGB565_TO_G8(pixel); int b = COLOR_RGB565_TO_B8(pixel); int r_new = IM_MIN(IM_MAX(r + (diff_r * alpha), COLOR_R8_MIN), COLOR_R8_MAX); int g_new = IM_MIN(IM_MAX(g + (diff_g * alpha), COLOR_G8_MIN), COLOR_G8_MAX); int b_new = IM_MIN(IM_MAX(b + (diff_b * alpha), COLOR_B8_MIN), COLOR_B8_MAX); IMAGE_PUT_RGB565_PIXEL_FAST(row_ptr_2, x, COLOR_R8_G8_B8_TO_RGB565(r_new, g_new, b_new)); } } } // Fill in the penumbra... (outer part of the shadow)... memcpy(temp_image.data, temp_image_2.data, image_size(&temp_image_2)); imlib_erode(&temp_image_2, 1, 8, NULL); imlib_b_xor(&temp_image, NULL, &temp_image_2, 0, NULL); imlib_dilate(&temp_image, 3, 0, NULL); imlib_median_filter(img, 2, 12, false, 0, false, &temp_image); fb_free(); // temp_image_2 } fb_free(); // BBins fb_free(); // ABins fb_free(); // LBins fb_free(); // temp_image } }
static void imlib_b_and_line_op(image_t *img, int line, uint8_t *other, void *data, bool vflipped) { image_t *mask = (image_t *) data; switch(img->bpp) { case IMAGE_BPP_BINARY: { uint32_t *data = IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(img, line); if(!mask) { for (int i = 0, j = IMAGE_BINARY_LINE_LEN(img); i < j; i++) { data[i] &= ((uint32_t *) other)[i]; } } else { for (int i = 0, j = img->w; i < j; i++) { if (image_get_mask_pixel(mask, i, line)) { IMAGE_PUT_BINARY_PIXEL_FAST(data, i, (IMAGE_GET_BINARY_PIXEL_FAST(data, i) & IMAGE_GET_BINARY_PIXEL_FAST(((uint32_t *) other), i))); } } } break; } case IMAGE_BPP_GRAYSCALE: { uint8_t *data = IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(img, line); if(!mask) { for (int i = 0, j = IMAGE_GRAYSCALE_LINE_LEN(img); i < j; i++) { data[i] &= ((uint8_t *) other)[i]; } } else { for (int i = 0, j = img->w; i < j; i++) { if (image_get_mask_pixel(mask, i, line)) { IMAGE_PUT_GRAYSCALE_PIXEL_FAST(data, i, (IMAGE_GET_GRAYSCALE_PIXEL_FAST(data, i) & IMAGE_GET_GRAYSCALE_PIXEL_FAST(((uint8_t *) other), i))); } } } break; } case IMAGE_BPP_RGB565: { uint16_t *data = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, line); if(!mask) { for (int i = 0, j = IMAGE_RGB565_LINE_LEN(img); i < j; i++) { data[i] &= ((uint16_t *) other)[i]; } } else { for (int i = 0, j = img->w; i < j; i++) { if (image_get_mask_pixel(mask, i, line)) { IMAGE_PUT_RGB565_PIXEL_FAST(data, i, (IMAGE_GET_RGB565_PIXEL_FAST(data, i) & IMAGE_GET_RGB565_PIXEL_FAST(((uint16_t *) other), i))); } } } break; } default: { break; } } }
static void imlib_erode_dilate(image_t *img, int ksize, int threshold, int e_or_d, image_t *mask) { int brows = ksize + 1; image_t buf; buf.w = img->w; buf.h = brows; buf.bpp = img->bpp; switch(img->bpp) { case IMAGE_BPP_BINARY: { buf.data = fb_alloc(IMAGE_BINARY_LINE_LEN_BYTES(img) * brows); for (int y = 0, yy = img->h; y < yy; y++) { uint32_t *row_ptr = IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(img, y); uint32_t *buf_row_ptr = IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(&buf, (y % brows)); for (int x = 0, xx = img->w; x < xx; x++) { int pixel = IMAGE_GET_BINARY_PIXEL_FAST(row_ptr, x); IMAGE_PUT_BINARY_PIXEL_FAST(buf_row_ptr, x, pixel); if ((mask && (!image_get_mask_pixel(mask, x, y))) || (pixel == e_or_d)) { continue; // Short circuit. } int acc = e_or_d ? 0 : -1; // Don't count center pixel... for (int j = -ksize; j <= ksize; j++) { uint32_t *k_row_ptr = IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(img, IM_MIN(IM_MAX(y + j, 0), (img->h - 1))); for (int k = -ksize; k <= ksize; k++) { acc += IMAGE_GET_BINARY_PIXEL_FAST(k_row_ptr, IM_MIN(IM_MAX(x + k, 0), (img->w - 1))); } } if (!e_or_d) { // Preserve original pixel value... or clear it. if (acc < threshold) IMAGE_CLEAR_BINARY_PIXEL_FAST(buf_row_ptr, x); } else { // Preserve original pixel value... or set it. if (acc > threshold) IMAGE_SET_BINARY_PIXEL_FAST(buf_row_ptr, x); } } if (y >= ksize) { // Transfer buffer lines... memcpy(IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(img, (y - ksize)), IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(&buf, ((y - ksize) % brows)), IMAGE_BINARY_LINE_LEN_BYTES(img)); } } // Copy any remaining lines from the buffer image... for (int y = img->h - ksize, yy = img->h; y < yy; y++) { memcpy(IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(img, y), IMAGE_COMPUTE_BINARY_PIXEL_ROW_PTR(&buf, (y % brows)), IMAGE_BINARY_LINE_LEN_BYTES(img)); } fb_free(); break; } case IMAGE_BPP_GRAYSCALE: { buf.data = fb_alloc(IMAGE_GRAYSCALE_LINE_LEN_BYTES(img) * brows); for (int y = 0, yy = img->h; y < yy; y++) { uint8_t *row_ptr = IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(img, y); uint8_t *buf_row_ptr = IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(&buf, (y % brows)); for (int x = 0, xx = img->w; x < xx; x++) { int pixel = IMAGE_GET_GRAYSCALE_PIXEL_FAST(row_ptr, x); IMAGE_PUT_GRAYSCALE_PIXEL_FAST(buf_row_ptr, x, pixel); if ((mask && (!image_get_mask_pixel(mask, x, y))) || (COLOR_GRAYSCALE_TO_BINARY(pixel) == e_or_d)) { continue; // Short circuit. } int acc = e_or_d ? 0 : -1; // Don't count center pixel... for (int j = -ksize; j <= ksize; j++) { uint8_t *k_row_ptr = IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(img, IM_MIN(IM_MAX(y + j, 0), (img->h - 1))); for (int k = -ksize; k <= ksize; k++) { acc += COLOR_GRAYSCALE_TO_BINARY(IMAGE_GET_GRAYSCALE_PIXEL_FAST(k_row_ptr, IM_MIN(IM_MAX(x + k, 0), (img->w - 1)))); } } if (!e_or_d) { // Preserve original pixel value... or clear it. if (acc < threshold) IMAGE_PUT_GRAYSCALE_PIXEL_FAST(buf_row_ptr, x, COLOR_GRAYSCALE_BINARY_MIN); } else { // Preserve original pixel value... or set it. if (acc > threshold) IMAGE_PUT_GRAYSCALE_PIXEL_FAST(buf_row_ptr, x, COLOR_GRAYSCALE_BINARY_MAX); } } if (y >= ksize) { // Transfer buffer lines... memcpy(IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(img, (y - ksize)), IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(&buf, ((y - ksize) % brows)), IMAGE_GRAYSCALE_LINE_LEN_BYTES(img)); } } // Copy any remaining lines from the buffer image... for (int y = img->h - ksize, yy = img->h; y < yy; y++) { memcpy(IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(img, y), IMAGE_COMPUTE_GRAYSCALE_PIXEL_ROW_PTR(&buf, (y % brows)), IMAGE_GRAYSCALE_LINE_LEN_BYTES(img)); } fb_free(); break; } case IMAGE_BPP_RGB565: { buf.data = fb_alloc(IMAGE_RGB565_LINE_LEN_BYTES(img) * brows); for (int y = 0, yy = img->h; y < yy; y++) { uint16_t *row_ptr = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, y); uint16_t *buf_row_ptr = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(&buf, (y % brows)); for (int x = 0, xx = img->w; x < xx; x++) { int pixel = IMAGE_GET_RGB565_PIXEL_FAST(row_ptr, x); IMAGE_PUT_RGB565_PIXEL_FAST(buf_row_ptr, x, pixel); if ((mask && (!image_get_mask_pixel(mask, x, y))) || (COLOR_RGB565_TO_BINARY(pixel) == e_or_d)) { continue; // Short circuit. } int acc = e_or_d ? 0 : -1; // Don't count center pixel... for (int j = -ksize; j <= ksize; j++) { uint16_t *k_row_ptr = IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, IM_MIN(IM_MAX(y + j, 0), (img->h - 1))); for (int k = -ksize; k <= ksize; k++) { acc += COLOR_RGB565_TO_BINARY(IMAGE_GET_RGB565_PIXEL_FAST(k_row_ptr, IM_MIN(IM_MAX(x + k, 0), (img->w - 1)))); } } if (!e_or_d) { // Preserve original pixel value... or clear it. if (acc < threshold) IMAGE_PUT_RGB565_PIXEL_FAST(buf_row_ptr, x, COLOR_RGB565_BINARY_MIN); } else { // Preserve original pixel value... or set it. if (acc > threshold) IMAGE_PUT_RGB565_PIXEL_FAST(buf_row_ptr, x, COLOR_RGB565_BINARY_MAX); } } if (y >= ksize) { // Transfer buffer lines... memcpy(IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, (y - ksize)), IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(&buf, ((y - ksize) % brows)), IMAGE_RGB565_LINE_LEN_BYTES(img)); } } // Copy any remaining lines from the buffer image... for (int y = img->h - ksize, yy = img->h; y < yy; y++) { memcpy(IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(img, y), IMAGE_COMPUTE_RGB565_PIXEL_ROW_PTR(&buf, (y % brows)), IMAGE_RGB565_LINE_LEN_BYTES(img)); } fb_free(); break; } default: { break; } } }