/* * GRUB -- GRand Unified Bootloader * Copyright (C) 2006,2007,2008 Free Software Foundation, Inc. * * GRUB is free software: you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation, either version 3 of the License, or * (at your option) any later version. * * GRUB is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with GRUB. If not, see <http://www.gnu.org/licenses/>. */ /* SPECIAL NOTES! Please note following when reading the code below: - In this driver we assume that every memory can be accessed by same memory bus. If there are different address spaces do not use this code as a base code for other archs. - Every function in this code assumes that bounds checking has been done in previous phase and they are opted out in here. */ #include <grub/video_fb.h> #include <grub/fbblit.h> #include <grub/fbutil.h> #include <grub/misc.h> #include <grub/types.h> #include <grub/video.h> /* Generic replacing blitter (slow). Works for every supported format. */ void grub_video_fbblit_replace (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int i; int j; grub_uint8_t src_red; grub_uint8_t src_green; grub_uint8_t src_blue; grub_uint8_t src_alpha; grub_video_color_t src_color; grub_video_color_t dst_color; for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { src_color = get_pixel (src, i + offset_x, j + offset_y); grub_video_fb_unmap_color_int (src, src_color, &src_red, &src_green, &src_blue, &src_alpha); dst_color = grub_video_fb_map_rgba (src_red, src_green, src_blue, src_alpha); set_pixel (dst, x + i, y + j, dst_color); } } } /* Block copy replacing blitter. Works with modes multiple of 8 bits. */ void grub_video_fbblit_replace_directN (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int j; grub_uint32_t *srcptr; grub_uint32_t *dstptr; int bpp; bpp = src->mode_info->bytes_per_pixel; for (j = 0; j < height; j++) { srcptr = (grub_uint32_t *)grub_video_fb_get_video_ptr (src, offset_x, j + offset_y); dstptr = (grub_uint32_t *)grub_video_fb_get_video_ptr (dst, x, y + j); grub_memmove (dstptr, srcptr, width * bpp); } } /* Optimized replacing blitter for 1-bit to 32bit. */ void grub_video_fbblit_replace_32bit_1bit (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int i; int j; grub_uint8_t *srcptr; grub_uint8_t *dstptr; grub_uint8_t srcmask; unsigned int dstrowskip; unsigned int srcrowskipbyte, srcrowskipbit; grub_uint32_t fgcolor, bgcolor; int bit_index; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcrowskipbyte = (src->mode_info->width - width) >> 3; srcrowskipbit = (src->mode_info->width - width) & 7; bit_index = offset_y * src->mode_info->width + offset_x; srcptr = (grub_uint8_t *) src->data + (bit_index >> 3); srcmask = 1 << (~bit_index & 7); dstptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (dst, x, y); fgcolor = grub_video_fb_map_rgba (src->mode_info->fg_red, src->mode_info->fg_green, src->mode_info->fg_blue, src->mode_info->fg_alpha); bgcolor = grub_video_fb_map_rgba (src->mode_info->bg_red, src->mode_info->bg_green, src->mode_info->bg_blue, src->mode_info->bg_alpha); for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { if (*srcptr & srcmask) *(grub_uint32_t *) dstptr = fgcolor; else *(grub_uint32_t *) dstptr = bgcolor; srcmask >>= 1; if (!srcmask) { srcptr++; srcmask = 0x80; } dstptr += 4; } srcptr += srcrowskipbyte; if (srcmask >> srcrowskipbit) srcmask >>= srcrowskipbit; else { srcptr++; srcmask <<= 8 - srcrowskipbit; } dstptr += dstrowskip; } } /* Optimized replacing blitter for 1-bit to 24-bit. */ void grub_video_fbblit_replace_24bit_1bit (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int i; int j; grub_uint8_t *srcptr; grub_uint8_t *dstptr; grub_uint8_t srcmask; unsigned int dstrowskip; unsigned int srcrowskipbyte, srcrowskipbit; grub_uint32_t fgcolor, bgcolor; int bit_index; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcrowskipbyte = (src->mode_info->width - width) >> 3; srcrowskipbit = (src->mode_info->width - width) & 7; bit_index = offset_y * src->mode_info->width + offset_x; srcptr = (grub_uint8_t *) src->data + (bit_index >> 3); srcmask = 1 << (~bit_index & 7); dstptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (dst, x, y); fgcolor = grub_video_fb_map_rgba (src->mode_info->fg_red, src->mode_info->fg_green, src->mode_info->fg_blue, src->mode_info->fg_alpha); bgcolor = grub_video_fb_map_rgba (src->mode_info->bg_red, src->mode_info->bg_green, src->mode_info->bg_blue, src->mode_info->bg_alpha); for (j = 0; j < height; j++) { for (i = 0; i < width - 1; i++) { if (*srcptr & srcmask) *(grub_uint32_t *) dstptr = fgcolor; else *(grub_uint32_t *) dstptr = bgcolor; srcmask >>= 1; if (!srcmask) { srcptr++; srcmask = 0x80; } dstptr += 3; } if (*srcptr & srcmask) { *dstptr++ = fgcolor & 0xff; *dstptr++ = (fgcolor & 0xff00) >> 8; *dstptr++ = (fgcolor & 0xff0000) >> 16; } else { *dstptr++ = bgcolor & 0xff; *dstptr++ = (bgcolor & 0xff00) >> 8; *dstptr++ = (bgcolor & 0xff0000) >> 16; } srcmask >>= 1; if (!srcmask) { srcptr++; srcmask = 0x80; } srcptr += srcrowskipbyte; if (srcmask >> srcrowskipbit) srcmask >>= srcrowskipbit; else { srcptr++; srcmask <<= 8 - srcrowskipbit; } dstptr += dstrowskip; } } /* Optimized replacing blitter for 1-bit to 16-bit. */ void grub_video_fbblit_replace_16bit_1bit (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int i; int j; grub_uint8_t *srcptr; grub_uint8_t *dstptr; grub_uint8_t srcmask; unsigned int dstrowskip; unsigned int srcrowskipbyte, srcrowskipbit; grub_uint16_t fgcolor, bgcolor; int bit_index; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcrowskipbyte = (src->mode_info->width - width) >> 3; srcrowskipbit = (src->mode_info->width - width) & 7; bit_index = offset_y * src->mode_info->width + offset_x; srcptr = (grub_uint8_t *) src->data + (bit_index >> 3); srcmask = 1 << (~bit_index & 7); dstptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (dst, x, y); fgcolor = grub_video_fb_map_rgba (src->mode_info->fg_red, src->mode_info->fg_green, src->mode_info->fg_blue, src->mode_info->fg_alpha); bgcolor = grub_video_fb_map_rgba (src->mode_info->bg_red, src->mode_info->bg_green, src->mode_info->bg_blue, src->mode_info->bg_alpha); for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { if (*srcptr & srcmask) *(grub_uint16_t *) dstptr = fgcolor; else *(grub_uint16_t *) dstptr = bgcolor; srcmask >>= 1; if (!srcmask) { srcptr++; srcmask = 0x80; } dstptr += 2; } srcptr += srcrowskipbyte; if (srcmask >> srcrowskipbit) srcmask >>= srcrowskipbit; else { srcptr++; srcmask <<= 8 - srcrowskipbit; } dstptr += dstrowskip; } } /* Optimized replacing blitter for 1-bit to 8-bit. */ void grub_video_fbblit_replace_8bit_1bit (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int i; int j; grub_uint8_t *srcptr; grub_uint8_t *dstptr; grub_uint8_t srcmask; unsigned int dstrowskip; unsigned int srcrowskipbyte, srcrowskipbit; grub_uint8_t fgcolor, bgcolor; int bit_index; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcrowskipbyte = (src->mode_info->width - width) >> 3; srcrowskipbit = (src->mode_info->width - width) & 7; bit_index = offset_y * src->mode_info->width + offset_x; srcptr = (grub_uint8_t *) src->data + (bit_index >> 3); srcmask = 1 << (~bit_index & 7); dstptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (dst, x, y); fgcolor = grub_video_fb_map_rgba (src->mode_info->fg_red, src->mode_info->fg_green, src->mode_info->fg_blue, src->mode_info->fg_alpha); bgcolor = grub_video_fb_map_rgba (src->mode_info->bg_red, src->mode_info->bg_green, src->mode_info->bg_blue, src->mode_info->bg_alpha); for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { if (*srcptr & srcmask) *(grub_uint8_t *) dstptr = fgcolor; else *(grub_uint8_t *) dstptr = bgcolor; srcmask >>= 1; if (!srcmask) { srcptr++; srcmask = 0x80; } dstptr++; } srcptr += srcrowskipbyte; if (srcmask >> srcrowskipbit) srcmask >>= srcrowskipbit; else { srcptr++; srcmask <<= 8 - srcrowskipbit; } dstptr += dstrowskip; } } /* Optimized replacing blitter for RGBX8888 to BGRX8888. */ void grub_video_fbblit_replace_BGRX8888_RGBX8888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int i; int j; grub_uint8_t *srcptr; grub_uint8_t *dstptr; unsigned int srcrowskip; unsigned int dstrowskip; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ srcrowskip = src->mode_info->pitch - src->mode_info->bytes_per_pixel * width; dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (src, offset_x, offset_y); dstptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (dst, x, y); for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { grub_uint8_t r = *srcptr++; grub_uint8_t g = *srcptr++; grub_uint8_t b = *srcptr++; grub_uint8_t a = *srcptr++; *dstptr++ = b; *dstptr++ = g; *dstptr++ = r; *dstptr++ = a; } srcptr += srcrowskip; dstptr += dstrowskip; } } /* Optimized replacing blitter for RGB888 to BGRX8888. */ void grub_video_fbblit_replace_BGRX8888_RGB888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int i; int j; grub_uint8_t *srcptr; grub_uint8_t *dstptr; unsigned int srcrowskip; unsigned int dstrowskip; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ srcrowskip = src->mode_info->pitch - src->mode_info->bytes_per_pixel * width; dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (src, offset_x, offset_y); dstptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (dst, x, y); for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { grub_uint8_t r = *srcptr++; grub_uint8_t g = *srcptr++; grub_uint8_t b = *srcptr++; *dstptr++ = b; *dstptr++ = g; *dstptr++ = r; /* Set alpha component as opaque. */ *dstptr++ = 255; } srcptr += srcrowskip; dstptr += dstrowskip; } } /* Optimized replacing blitter for RGBX8888 to BGR888. */ void grub_video_fbblit_replace_BGR888_RGBX8888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { grub_uint32_t *srcptr; grub_uint8_t *dstptr; unsigned int srcrowskip; unsigned int dstrowskip; int i; int j; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ srcrowskip = src->mode_info->pitch - src->mode_info->bytes_per_pixel * width; dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcptr = (grub_uint32_t *) grub_video_fb_get_video_ptr (src, offset_x, offset_y); dstptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (dst, x, y); for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { grub_uint32_t color; grub_uint8_t sr; grub_uint8_t sg; grub_uint8_t sb; color = *srcptr++; sr = (color >> 0) & 0xFF; sg = (color >> 8) & 0xFF; sb = (color >> 16) & 0xFF; *dstptr++ = sb; *dstptr++ = sg; *dstptr++ = sr; } srcptr = (grub_uint32_t *) (((grub_uint8_t *) srcptr) + srcrowskip); dstptr += dstrowskip; } } /* Optimized replacing blitter for RGB888 to BGR888. */ void grub_video_fbblit_replace_BGR888_RGB888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int i; int j; grub_uint8_t *srcptr; grub_uint8_t *dstptr; unsigned int srcrowskip; unsigned int dstrowskip; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ srcrowskip = src->mode_info->pitch - src->mode_info->bytes_per_pixel * width; dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (src, offset_x, offset_y); dstptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (dst, x, y); for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { grub_uint8_t r = *srcptr++; grub_uint8_t g = *srcptr++; grub_uint8_t b = *srcptr++; *dstptr++ = b; *dstptr++ = g; *dstptr++ = r; } srcptr += srcrowskip; dstptr += dstrowskip; } } /* Optimized replacing blitter for RGB888 to RGBX8888. */ void grub_video_fbblit_replace_RGBX8888_RGB888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { grub_uint32_t color; int i; int j; grub_uint8_t *srcptr; grub_uint32_t *dstptr; unsigned int sr; unsigned int sg; unsigned int sb; for (j = 0; j < height; j++) { srcptr = (grub_uint8_t *)grub_video_fb_get_video_ptr (src, offset_x, j + offset_y); dstptr = (grub_uint32_t *)grub_video_fb_get_video_ptr (dst, x, y + j); for (i = 0; i < width; i++) { sr = *srcptr++; sg = *srcptr++; sb = *srcptr++; /* Set alpha as opaque. */ color = 0xFF000000 | (sb << 16) | (sg << 8) | sr; *dstptr++ = color; } } } /* Optimized replacing blitter for RGBX8888 to RGB888. */ void grub_video_fbblit_replace_RGB888_RGBX8888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { grub_uint32_t color; int i; int j; grub_uint32_t *srcptr; grub_uint8_t *dstptr; unsigned int sr; unsigned int sg; unsigned int sb; for (j = 0; j < height; j++) { srcptr = (grub_uint32_t *)grub_video_fb_get_video_ptr (src, offset_x, j + offset_y); dstptr = (grub_uint8_t *)grub_video_fb_get_video_ptr (dst, x, y + j); for (i = 0; i < width; i++) { color = *srcptr++; sr = (color >> 0) & 0xFF; sg = (color >> 8) & 0xFF; sb = (color >> 16) & 0xFF; *dstptr++ = sr; *dstptr++ = sg; *dstptr++ = sb; } } } /* Optimized replacing blitter for RGBX8888 to indexed color. */ void grub_video_fbblit_replace_index_RGBX8888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { grub_uint32_t color; int i; int j; grub_uint32_t *srcptr; grub_uint8_t *dstptr; unsigned int sr; unsigned int sg; unsigned int sb; for (j = 0; j < height; j++) { srcptr = (grub_uint32_t *)grub_video_fb_get_video_ptr (src, offset_x, j + offset_y); dstptr = (grub_uint8_t *)grub_video_fb_get_video_ptr (dst, x, y + j); for (i = 0; i < width; i++) { color = *srcptr++; sr = (color >> 0) & 0xFF; sg = (color >> 8) & 0xFF; sb = (color >> 16) & 0xFF; color = grub_video_fb_map_rgb(sr, sg, sb); *dstptr++ = color & 0xFF; } } } /* Optimized replacing blitter for RGB888 to indexed color. */ void grub_video_fbblit_replace_index_RGB888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { grub_uint32_t color; int i; int j; grub_uint8_t *srcptr; grub_uint8_t *dstptr; unsigned int sr; unsigned int sg; unsigned int sb; for (j = 0; j < height; j++) { srcptr = (grub_uint8_t *)grub_video_fb_get_video_ptr (src, offset_x, j + offset_y); dstptr = (grub_uint8_t *)grub_video_fb_get_video_ptr (dst, x, y + j); for (i = 0; i < width; i++) { sr = *srcptr++; sg = *srcptr++; sb = *srcptr++; color = grub_video_fb_map_rgb(sr, sg, sb); *dstptr++ = color & 0xFF; } } } /* Generic blending blitter. Works for every supported format. */ void grub_video_fbblit_blend (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int i; int j; for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { grub_uint8_t src_red; grub_uint8_t src_green; grub_uint8_t src_blue; grub_uint8_t src_alpha; grub_uint8_t dst_red; grub_uint8_t dst_green; grub_uint8_t dst_blue; grub_uint8_t dst_alpha; grub_video_color_t src_color; grub_video_color_t dst_color; src_color = get_pixel (src, i + offset_x, j + offset_y); grub_video_fb_unmap_color_int (src, src_color, &src_red, &src_green, &src_blue, &src_alpha); if (src_alpha == 0) continue; if (src_alpha == 255) { dst_color = grub_video_fb_map_rgba (src_red, src_green, src_blue, src_alpha); set_pixel (dst, x + i, y + j, dst_color); continue; } dst_color = get_pixel (dst, x + i, y + j); grub_video_fb_unmap_color_int (dst, dst_color, &dst_red, &dst_green, &dst_blue, &dst_alpha); dst_red = (((src_red * src_alpha) + (dst_red * (255 - src_alpha))) / 255); dst_green = (((src_green * src_alpha) + (dst_green * (255 - src_alpha))) / 255); dst_blue = (((src_blue * src_alpha) + (dst_blue * (255 - src_alpha))) / 255); dst_alpha = src_alpha; dst_color = grub_video_fb_map_rgba (dst_red, dst_green, dst_blue, dst_alpha); set_pixel (dst, x + i, y + j, dst_color); } } } /* Optimized blending blitter for RGBA8888 to BGRA8888. */ void grub_video_fbblit_blend_BGRA8888_RGBA8888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { grub_uint32_t *srcptr; grub_uint32_t *dstptr; unsigned int srcrowskip; unsigned int dstrowskip; int i; int j; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ srcrowskip = src->mode_info->pitch - src->mode_info->bytes_per_pixel * width; dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcptr = (grub_uint32_t *) grub_video_fb_get_video_ptr (src, offset_x, offset_y); dstptr = (grub_uint32_t *) grub_video_fb_get_video_ptr (dst, x, y); for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { grub_uint32_t color; unsigned int sr; unsigned int sg; unsigned int sb; unsigned int a; unsigned int dr; unsigned int dg; unsigned int db; color = *srcptr++; a = color >> 24; if (a == 0) { /* Skip transparent source pixels. */ dstptr++; continue; } sr = (color >> 0) & 0xFF; sg = (color >> 8) & 0xFF; sb = (color >> 16) & 0xFF; if (a == 255) { /* Opaque pixel shortcut. */ dr = sr; dg = sg; db = sb; } else { /* General pixel color blending. */ color = *dstptr; dr = (color >> 16) & 0xFF; dr = (dr * (255 - a) + sr * a) / 255; dg = (color >> 8) & 0xFF; dg = (dg * (255 - a) + sg * a) / 255; db = (color >> 0) & 0xFF; db = (db * (255 - a) + sb * a) / 255; } color = (a << 24) | (dr << 16) | (dg << 8) | db; *dstptr++ = color; } srcptr = (grub_uint32_t *) (((grub_uint8_t *) srcptr) + srcrowskip); dstptr = (grub_uint32_t *) (((grub_uint8_t *) dstptr) + dstrowskip); } } /* Optimized blending blitter for RGBA8888 to BGR888. */ void grub_video_fbblit_blend_BGR888_RGBA8888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { grub_uint32_t *srcptr; grub_uint8_t *dstptr; unsigned int srcrowskip; unsigned int dstrowskip; int i; int j; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ srcrowskip = src->mode_info->pitch - src->mode_info->bytes_per_pixel * width; dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcptr = (grub_uint32_t *) grub_video_fb_get_video_ptr (src, offset_x, offset_y); dstptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (dst, x, y); for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { grub_uint32_t color; unsigned int sr; unsigned int sg; unsigned int sb; unsigned int a; unsigned int dr; unsigned int dg; unsigned int db; color = *srcptr++; a = color >> 24; if (a == 0) { /* Skip transparent source pixels. */ dstptr += 3; continue; } sr = (color >> 0) & 0xFF; sg = (color >> 8) & 0xFF; sb = (color >> 16) & 0xFF; if (a == 255) { /* Opaque pixel shortcut. */ dr = sr; dg = sg; db = sb; } else { /* General pixel color blending. */ color = *dstptr; db = dstptr[0]; db = (db * (255 - a) + sb * a) / 255; dg = dstptr[1]; dg = (dg * (255 - a) + sg * a) / 255; dr = dstptr[2]; dr = (dr * (255 - a) + sr * a) / 255; } *dstptr++ = db; *dstptr++ = dg; *dstptr++ = dr; } srcptr = (grub_uint32_t *) (((grub_uint8_t *) srcptr) + srcrowskip); dstptr += dstrowskip; } } /* Optimized blending blitter for RGBA888 to RGBA8888. */ void grub_video_fbblit_blend_RGBA8888_RGBA8888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { grub_uint32_t color; int i; int j; grub_uint32_t *srcptr; grub_uint32_t *dstptr; unsigned int sr; unsigned int sg; unsigned int sb; unsigned int a; unsigned int dr; unsigned int dg; unsigned int db; for (j = 0; j < height; j++) { srcptr = (grub_uint32_t *)grub_video_fb_get_video_ptr (src, offset_x, j + offset_y); dstptr = (grub_uint32_t *)grub_video_fb_get_video_ptr (dst, x, y + j); for (i = 0; i < width; i++) { color = *srcptr++; a = color >> 24; if (a == 0) { dstptr++; continue; } if (a == 255) { *dstptr++ = color; continue; } sr = (color >> 0) & 0xFF; sg = (color >> 8) & 0xFF; sb = (color >> 16) & 0xFF; color = *dstptr; dr = (color >> 0) & 0xFF; dg = (color >> 8) & 0xFF; db = (color >> 16) & 0xFF; dr = (dr * (255 - a) + sr * a) / 255; dg = (dg * (255 - a) + sg * a) / 255; db = (db * (255 - a) + sb * a) / 255; color = (a << 24) | (db << 16) | (dg << 8) | dr; *dstptr++ = color; } } } /* Optimized blending blitter for RGBA8888 to RGB888. */ void grub_video_fbblit_blend_RGB888_RGBA8888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { grub_uint32_t color; int i; int j; grub_uint32_t *srcptr; grub_uint8_t *dstptr; unsigned int sr; unsigned int sg; unsigned int sb; unsigned int a; unsigned int dr; unsigned int dg; unsigned int db; for (j = 0; j < height; j++) { srcptr = (grub_uint32_t *)grub_video_fb_get_video_ptr (src, offset_x, j + offset_y); dstptr = (grub_uint8_t *)grub_video_fb_get_video_ptr (dst, x, y + j); for (i = 0; i < width; i++) { color = *srcptr++; a = color >> 24; if (a == 0) { dstptr += 3; continue; } sr = (color >> 0) & 0xFF; sg = (color >> 8) & 0xFF; sb = (color >> 16) & 0xFF; if (a == 255) { *dstptr++ = sr; *dstptr++ = sg; *dstptr++ = sb; continue; } dr = dstptr[0]; dg = dstptr[1]; db = dstptr[2]; dr = (dr * (255 - a) + sr * a) / 255; dg = (dg * (255 - a) + sg * a) / 255; db = (db * (255 - a) + sb * a) / 255; *dstptr++ = dr; *dstptr++ = dg; *dstptr++ = db; } } } /* Optimized blending blitter for RGBA8888 to indexed color. */ void grub_video_fbblit_blend_index_RGBA8888 (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { grub_uint32_t color; int i; int j; grub_uint32_t *srcptr; grub_uint8_t *dstptr; unsigned int sr; unsigned int sg; unsigned int sb; unsigned int a; unsigned char dr; unsigned char dg; unsigned char db; unsigned char da; for (j = 0; j < height; j++) { srcptr = (grub_uint32_t *)grub_video_fb_get_video_ptr (src, offset_x, j + offset_y); dstptr = (grub_uint8_t *)grub_video_fb_get_video_ptr (dst, x, y + j); for (i = 0; i < width; i++) { color = *srcptr++; a = color >> 24; if (a == 0) { dstptr++; continue; } sr = (color >> 0) & 0xFF; sg = (color >> 8) & 0xFF; sb = (color >> 16) & 0xFF; if (a == 255) { color = grub_video_fb_map_rgb(sr, sg, sb); *dstptr++ = color & 0xFF; continue; } grub_video_fb_unmap_color_int (dst, *dstptr, &dr, &dg, &db, &da); dr = (dr * (255 - a) + sr * a) / 255; dg = (dg * (255 - a) + sg * a) / 255; db = (db * (255 - a) + sb * a) / 255; color = grub_video_fb_map_rgb(dr, dg, db); *dstptr++ = color & 0xFF; } } } /* Optimized blending blitter for 1-bit to XXXA8888. */ void grub_video_fbblit_blend_XXXA8888_1bit (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int i; int j; grub_uint8_t *srcptr; grub_uint8_t *dstptr; grub_uint8_t srcmask; unsigned int dstrowskip; unsigned int srcrowskipbyte, srcrowskipbit; grub_uint32_t fgcolor, bgcolor; int bit_index; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcrowskipbyte = (src->mode_info->width - width) >> 3; srcrowskipbit = (src->mode_info->width - width) & 7; bit_index = offset_y * src->mode_info->width + offset_x; srcptr = (grub_uint8_t *) src->data + (bit_index >> 3); srcmask = 1 << (~bit_index & 7); dstptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (dst, x, y); fgcolor = grub_video_fb_map_rgba (src->mode_info->fg_red, src->mode_info->fg_green, src->mode_info->fg_blue, src->mode_info->fg_alpha); bgcolor = grub_video_fb_map_rgba (src->mode_info->bg_red, src->mode_info->bg_green, src->mode_info->bg_blue, src->mode_info->bg_alpha); for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { grub_uint32_t color; grub_uint8_t a; if (*srcptr & srcmask) { color = fgcolor; a = src->mode_info->fg_alpha; } else { color = bgcolor; a = src->mode_info->bg_alpha; } if (a == 255) *(grub_uint32_t *) dstptr = color; else if (a != 0) { grub_uint8_t s1 = (color >> 0) & 0xFF; grub_uint8_t s2 = (color >> 8) & 0xFF; grub_uint8_t s3 = (color >> 16) & 0xFF; grub_uint8_t d1 = (*(grub_uint32_t *) dstptr >> 0) & 0xFF; grub_uint8_t d2 = (*(grub_uint32_t *) dstptr >> 8) & 0xFF; grub_uint8_t d3 = (*(grub_uint32_t *) dstptr >> 16) & 0xFF; d1 = (d1 * (255 - a) + s1 * a) / 255; d2 = (d2 * (255 - a) + s2 * a) / 255; d3 = (d3 * (255 - a) + s3 * a) / 255; *(grub_uint32_t *) dstptr = (a << 24) | (d3 << 16) | (d2 << 8) | d1; } srcmask >>= 1; if (!srcmask) { srcptr++; srcmask = 0x80; } dstptr += 4; } srcptr += srcrowskipbyte; if (srcmask >> srcrowskipbit) srcmask >>= srcrowskipbit; else { srcptr++; srcmask <<= 8 - srcrowskipbit; } dstptr += dstrowskip; } } /* Optimized blending blitter for 1-bit to XXX888. */ void grub_video_fbblit_blend_XXX888_1bit (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int i; int j; grub_uint8_t *srcptr; grub_uint8_t *dstptr; grub_uint8_t srcmask; unsigned int dstrowskip; unsigned int srcrowskipbyte, srcrowskipbit; grub_uint32_t fgcolor, bgcolor; int bit_index; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcrowskipbyte = (src->mode_info->width - width) >> 3; srcrowskipbit = (src->mode_info->width - width) & 7; bit_index = offset_y * src->mode_info->width + offset_x; srcptr = (grub_uint8_t *) src->data + (bit_index >> 3); srcmask = 1 << (~bit_index & 7); dstptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (dst, x, y); fgcolor = grub_video_fb_map_rgba (src->mode_info->fg_red, src->mode_info->fg_green, src->mode_info->fg_blue, src->mode_info->fg_alpha); bgcolor = grub_video_fb_map_rgba (src->mode_info->bg_red, src->mode_info->bg_green, src->mode_info->bg_blue, src->mode_info->bg_alpha); for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { grub_uint32_t color; grub_uint8_t a; if (*srcptr & srcmask) { color = fgcolor; a = src->mode_info->fg_alpha; } else { color = bgcolor; a = src->mode_info->bg_alpha; } if (a == 255) { ((grub_uint8_t *) dstptr)[0] = color & 0xff; ((grub_uint8_t *) dstptr)[1] = (color & 0xff00) >> 8; ((grub_uint8_t *) dstptr)[2] = (color & 0xff0000) >> 16; } else if (a != 0) { grub_uint8_t s1 = (color >> 0) & 0xFF; grub_uint8_t s2 = (color >> 8) & 0xFF; grub_uint8_t s3 = (color >> 16) & 0xFF; grub_uint8_t d1 = (*(grub_uint32_t *) dstptr >> 0) & 0xFF; grub_uint8_t d2 = (*(grub_uint32_t *) dstptr >> 8) & 0xFF; grub_uint8_t d3 = (*(grub_uint32_t *) dstptr >> 16) & 0xFF; ((grub_uint8_t *) dstptr)[0] = (d1 * (255 - a) + s1 * a) / 255; ((grub_uint8_t *) dstptr)[1] = (d2 * (255 - a) + s2 * a) / 255; ((grub_uint8_t *) dstptr)[2] = (d3 * (255 - a) + s3 * a) / 255; } srcmask >>= 1; if (!srcmask) { srcptr++; srcmask = 0x80; } dstptr += 3; } srcptr += srcrowskipbyte; if (srcmask >> srcrowskipbit) srcmask >>= srcrowskipbit; else { srcptr++; srcmask <<= 8 - srcrowskipbit; } dstptr += dstrowskip; } } /* Optimized blending blitter for 1-bit to XXX888. */ void grub_video_fbblit_blend_XXX565_1bit (struct grub_video_fbblit_info *dst, struct grub_video_fbblit_info *src, int x, int y, int width, int height, int offset_x, int offset_y) { int i; int j; grub_uint8_t *srcptr; grub_uint8_t *dstptr; grub_uint8_t srcmask; unsigned int dstrowskip; unsigned int srcrowskipbyte, srcrowskipbit; grub_uint16_t fgcolor, bgcolor; int bit_index; /* Calculate the number of bytes to advance from the end of one line to the beginning of the next line. */ dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width; srcrowskipbyte = (src->mode_info->width - width) >> 3; srcrowskipbit = (src->mode_info->width - width) & 7; bit_index = offset_y * src->mode_info->width + offset_x; srcptr = (grub_uint8_t *) src->data + (bit_index >> 3); srcmask = 1 << (~bit_index & 7); dstptr = (grub_uint8_t *) grub_video_fb_get_video_ptr (dst, x, y); fgcolor = grub_video_fb_map_rgba (src->mode_info->fg_red, src->mode_info->fg_green, src->mode_info->fg_blue, src->mode_info->fg_alpha); bgcolor = grub_video_fb_map_rgba (src->mode_info->bg_red, src->mode_info->bg_green, src->mode_info->bg_blue, src->mode_info->bg_alpha); for (j = 0; j < height; j++) { for (i = 0; i < width; i++) { grub_uint32_t color; grub_uint8_t a; if (*srcptr & srcmask) { color = fgcolor; a = src->mode_info->fg_alpha; } else { color = bgcolor; a = src->mode_info->bg_alpha; } if (a == 255) *(grub_uint16_t *) dstptr = color; else if (a != 0) { grub_uint8_t s1 = (color >> 0) & 0x1F; grub_uint8_t s2 = (color >> 5) & 0x3F; grub_uint8_t s3 = (color >> 11) & 0x1F; grub_uint8_t d1 = (*(grub_uint16_t *) dstptr >> 0) & 0x1F; grub_uint8_t d2 = (*(grub_uint16_t *) dstptr >> 5) & 0x3F; grub_uint8_t d3 = (*(grub_uint16_t *) dstptr >> 11) & 0x1F; d1 = (d1 * (255 - a) + s1 * a) / 255; d2 = (d2 * (255 - a) + s2 * a) / 255; d3 = (d3 * (255 - a) + s3 * a) / 255; *(grub_uint16_t *) dstptr = (d1 & 0x1f) | ((d2 & 0x3f) << 5) | ((d3 & 0x1f) << 11); } srcmask >>= 1; if (!srcmask) { srcptr++; srcmask = 0x80; } dstptr += 2; } srcptr += srcrowskipbyte; if (srcmask >> srcrowskipbit) srcmask >>= srcrowskipbit; else { srcptr++; srcmask <<= 8 - srcrowskipbit; } dstptr += dstrowskip; } }