arch/common/boot/grub2/video/i386/pc/vbeblit.c

   1 /*
   2  *  GRUB  --  GRand Unified Bootloader
   3  *  Copyright (C) 2006,2007,2008  Free Software Foundation, Inc.
   4  *
   5  *  GRUB is free software: you can redistribute it and/or modify
   6  *  it under the terms of the GNU General Public License as published by
   7  *  the Free Software Foundation, either version 3 of the License, or
   8  *  (at your option) any later version.
   9  *
  10  *  GRUB is distributed in the hope that it will be useful,
  11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  *  GNU General Public License for more details.
  14  *
  15  *  You should have received a copy of the GNU General Public License
  16  *  along with GRUB.  If not, see <http://www.gnu.org/licenses/>.
  17  */
  18
  19 /* SPECIAL NOTES!
  20
  21    Please note following when reading the code below:
  22
  23    - In this driver we assume that every memory can be accessed by same memory
  24    bus.  If there are different address spaces do not use this code as a base
  25    code for other archs.
  26
  27    - Every function in this code assumes that bounds checking has been done in
  28    previous phase and they are opted out in here.  */
  29
  30 #include <grub/machine/vbe.h>
  31 #include <grub/machine/vbeblit.h>
  32 #include <grub/machine/vbeutil.h>
  33 #include <grub/misc.h>
  34 #include <grub/types.h>
  35 #include <grub/video.h>
  36
  37 /* Generic replacing blitter (slow).  Works for every supported format.  */
  38 void
  39 grub_video_i386_vbeblit_replace (struct grub_video_i386_vbeblit_info *dst,
  40                                  struct grub_video_i386_vbeblit_info *src,
  41                                  int x, int y, int width, int height,
  42                                  int offset_x, int offset_y)
  43 {
  44   int i;
  45   int j;
  46   grub_uint8_t src_red;
  47   grub_uint8_t src_green;
  48   grub_uint8_t src_blue;
  49   grub_uint8_t src_alpha;
  50   grub_video_color_t src_color;
  51   grub_video_color_t dst_color;
  52
  53   for (j = 0; j < height; j++)
  54     {
  55       for (i = 0; i < width; i++)
  56         {
  57           src_color = get_pixel (src, i + offset_x, j + offset_y);
  58
  59           grub_video_vbe_unmap_color_int (src, src_color, &src_red, &src_green,
  60                                           &src_blue, &src_alpha);
  61
  62           dst_color = grub_video_vbe_map_rgba (src_red, src_green,
  63                                                src_blue, src_alpha);
  64
  65           set_pixel (dst, x + i, y + j, dst_color);
  66         }
  67     }
  68 }
  69
  70 /* Block copy replacing blitter.  Works with modes multiple of 8 bits.  */
  71 void
  72 grub_video_i386_vbeblit_replace_directN (struct grub_video_i386_vbeblit_info *dst,
  73                                          struct grub_video_i386_vbeblit_info *src,
  74                                          int x, int y, int width, int height,
  75                                          int offset_x, int offset_y)
  76 {
  77   int j;
  78   grub_uint32_t *srcptr;
  79   grub_uint32_t *dstptr;
  80   int bpp;
  81
  82   bpp = src->mode_info->bytes_per_pixel;
  83
  84   for (j = 0; j < height; j++)
  85     {
  86       srcptr = (grub_uint32_t *)get_data_ptr (src, offset_x, j + offset_y);
  87       dstptr = (grub_uint32_t *)get_data_ptr (dst, x, y + j);
  88
  89       grub_memmove (dstptr, srcptr, width * bpp);
  90     }
  91 }
  92
  93 /* Optimized replacing blitter for RGBX8888 to BGRX8888.  */
  94 void
  95 grub_video_i386_vbeblit_replace_BGRX8888_RGBX8888 (struct grub_video_i386_vbeblit_info *dst,
  96                                                    struct grub_video_i386_vbeblit_info *src,
  97                                                    int x, int y,
  98                                                    int width, int height,
  99                                                    int offset_x, int offset_y)
 100 {
 101   int i;
 102   int j;
 103   grub_uint8_t *srcptr;
 104   grub_uint8_t *dstptr;
 105   unsigned int srcrowskip;
 106   unsigned int dstrowskip;
 107
 108   /* Calculate the number of bytes to advance from the end of one line
 109      to the beginning of the next line.  */
 110   srcrowskip = src->mode_info->pitch - src->mode_info->bytes_per_pixel * width;
 111   dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width;
 112
 113   srcptr = (grub_uint8_t *) get_data_ptr (src, offset_x, offset_y);
 114   dstptr = (grub_uint8_t *) get_data_ptr (dst, x, y);
 115
 116   for (j = 0; j < height; j++)
 117     {
 118       for (i = 0; i < width; i++)
 119         {
 120           grub_uint8_t r = *srcptr++;
 121           grub_uint8_t g = *srcptr++;
 122           grub_uint8_t b = *srcptr++;
 123           grub_uint8_t a = *srcptr++;
 124
 125           *dstptr++ = b;
 126           *dstptr++ = g;
 127           *dstptr++ = r;
 128           *dstptr++ = a;
 129         }
 130
 131       srcptr += srcrowskip;
 132       dstptr += dstrowskip;
 133     }
 134 }
 135
 136 /* Optimized replacing blitter for RGB888 to BGRX8888.  */
 137 void
 138 grub_video_i386_vbeblit_replace_BGRX8888_RGB888 (struct grub_video_i386_vbeblit_info *dst,
 139                                                  struct grub_video_i386_vbeblit_info *src,
 140                                                  int x, int y,
 141                                                  int width, int height,
 142                                                  int offset_x, int offset_y)
 143 {
 144   int i;
 145   int j;
 146   grub_uint8_t *srcptr;
 147   grub_uint8_t *dstptr;
 148   unsigned int srcrowskip;
 149   unsigned int dstrowskip;
 150
 151   /* Calculate the number of bytes to advance from the end of one line
 152      to the beginning of the next line.  */
 153   srcrowskip = src->mode_info->pitch - src->mode_info->bytes_per_pixel * width;
 154   dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width;
 155
 156   srcptr = (grub_uint8_t *) get_data_ptr (src, offset_x, offset_y);
 157   dstptr = (grub_uint8_t *) get_data_ptr (dst, x, y);
 158
 159   for (j = 0; j < height; j++)
 160     {
 161       for (i = 0; i < width; i++)
 162         {
 163           grub_uint8_t r = *srcptr++;
 164           grub_uint8_t g = *srcptr++;
 165           grub_uint8_t b = *srcptr++;
 166
 167           *dstptr++ = b;
 168           *dstptr++ = g;
 169           *dstptr++ = r;
 170
 171           /* Set alpha component as opaque.  */
 172           *dstptr++ = 255;
 173         }
 174
 175       srcptr += srcrowskip;
 176       dstptr += dstrowskip;
 177     }
 178 }
 179
 180 /* Optimized replacing blitter for RGBX8888 to BGR888.  */
 181 void
 182 grub_video_i386_vbeblit_replace_BGR888_RGBX8888 (struct grub_video_i386_vbeblit_info *dst,
 183                                                  struct grub_video_i386_vbeblit_info *src,
 184                                                  int x, int y,
 185                                                  int width, int height,
 186                                                  int offset_x, int offset_y)
 187 {
 188   grub_uint32_t *srcptr;
 189   grub_uint8_t *dstptr;
 190   unsigned int srcrowskip;
 191   unsigned int dstrowskip;
 192   int i;
 193   int j;
 194
 195   /* Calculate the number of bytes to advance from the end of one line
 196      to the beginning of the next line.  */
 197   srcrowskip = src->mode_info->pitch - src->mode_info->bytes_per_pixel * width;
 198   dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width;
 199
 200   srcptr = (grub_uint32_t *) get_data_ptr (src, offset_x, offset_y);
 201   dstptr = (grub_uint8_t *) get_data_ptr (dst, x, y);
 202
 203   for (j = 0; j < height; j++)
 204     {
 205       for (i = 0; i < width; i++)
 206         {
 207           grub_uint32_t color;
 208           grub_uint8_t sr;
 209           grub_uint8_t sg;
 210           grub_uint8_t sb;
 211
 212           color = *srcptr++;
 213
 214           sr = (color >> 0) & 0xFF;
 215           sg = (color >> 8) & 0xFF;
 216           sb = (color >> 16) & 0xFF;
 217
 218           *dstptr++ = sb;
 219           *dstptr++ = sg;
 220           *dstptr++ = sr;
 221         }
 222
 223       srcptr = (grub_uint32_t *) (((grub_uint8_t *) srcptr) + srcrowskip);
 224       dstptr += dstrowskip;
 225     }
 226 }
 227
 228 /* Optimized replacing blitter for RGB888 to BGR888.  */
 229 void
 230 grub_video_i386_vbeblit_replace_BGR888_RGB888 (struct grub_video_i386_vbeblit_info *dst,
 231                                                struct grub_video_i386_vbeblit_info *src,
 232                                                int x, int y,
 233                                                int width, int height,
 234                                                int offset_x, int offset_y)
 235 {
 236   int i;
 237   int j;
 238   grub_uint8_t *srcptr;
 239   grub_uint8_t *dstptr;
 240   unsigned int srcrowskip;
 241   unsigned int dstrowskip;
 242
 243   /* Calculate the number of bytes to advance from the end of one line
 244      to the beginning of the next line.  */
 245   srcrowskip = src->mode_info->pitch - src->mode_info->bytes_per_pixel * width;
 246   dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width;
 247
 248   srcptr = (grub_uint8_t *) get_data_ptr (src, offset_x, offset_y);
 249   dstptr = (grub_uint8_t *) get_data_ptr (dst, x, y);
 250
 251   for (j = 0; j < height; j++)
 252     {
 253       for (i = 0; i < width; i++)
 254         {
 255           grub_uint8_t r = *srcptr++;
 256           grub_uint8_t g = *srcptr++;
 257           grub_uint8_t b = *srcptr++;
 258
 259           *dstptr++ = b;
 260           *dstptr++ = g;
 261           *dstptr++ = r;
 262         }
 263
 264       srcptr += srcrowskip;
 265       dstptr += dstrowskip;
 266     }
 267 }
 268
 269 /* Optimized replacing blitter for RGB888 to RGBX8888.  */
 270 void
 271 grub_video_i386_vbeblit_replace_RGBX8888_RGB888 (struct grub_video_i386_vbeblit_info *dst,
 272                                                  struct grub_video_i386_vbeblit_info *src,
 273                                                  int x, int y,
 274                                                  int width, int height,
 275                                                  int offset_x, int offset_y)
 276 {
 277   grub_uint32_t color;
 278   int i;
 279   int j;
 280   grub_uint8_t *srcptr;
 281   grub_uint32_t *dstptr;
 282   unsigned int sr;
 283   unsigned int sg;
 284   unsigned int sb;
 285
 286   for (j = 0; j < height; j++)
 287     {
 288       srcptr = (grub_uint8_t *)get_data_ptr (src, offset_x, j + offset_y);
 289       dstptr = (grub_uint32_t *)get_data_ptr (dst, x, y + j);
 290
 291       for (i = 0; i < width; i++)
 292         {
 293           sr = *srcptr++;
 294           sg = *srcptr++;
 295           sb = *srcptr++;
 296
 297           /* Set alpha as opaque.  */
 298           color = 0xFF000000 | (sb << 16) | (sg << 8) | sr;
 299
 300           *dstptr++ = color;
 301         }
 302     }
 303 }
 304
 305 /* Optimized replacing blitter for RGBX8888 to RGB888.  */
 306 void
 307 grub_video_i386_vbeblit_replace_RGB888_RGBX8888 (struct grub_video_i386_vbeblit_info *dst,
 308                                                  struct grub_video_i386_vbeblit_info *src,
 309                                                  int x, int y,
 310                                                  int width, int height,
 311                                                  int offset_x, int offset_y)
 312 {
 313   grub_uint32_t color;
 314   int i;
 315   int j;
 316   grub_uint32_t *srcptr;
 317   grub_uint8_t *dstptr;
 318   unsigned int sr;
 319   unsigned int sg;
 320   unsigned int sb;
 321
 322   for (j = 0; j < height; j++)
 323     {
 324       srcptr = (grub_uint32_t *)get_data_ptr (src, offset_x, j + offset_y);
 325       dstptr = (grub_uint8_t *)get_data_ptr (dst, x, y + j);
 326
 327       for (i = 0; i < width; i++)
 328         {
 329           color = *srcptr++;
 330
 331           sr = (color >> 0) & 0xFF;
 332           sg = (color >> 8) & 0xFF;
 333           sb = (color >> 16) & 0xFF;
 334
 335           *dstptr++ = sr;
 336           *dstptr++ = sg;
 337           *dstptr++ = sb;
 338         }
 339     }
 340 }
 341
 342 /* Optimized replacing blitter for RGBX8888 to indexed color.  */
 343 void
 344 grub_video_i386_vbeblit_replace_index_RGBX8888 (struct grub_video_i386_vbeblit_info *dst,
 345                                                 struct grub_video_i386_vbeblit_info *src,
 346                                                 int x, int y,
 347                                                 int width, int height,
 348                                                 int offset_x, int offset_y)
 349 {
 350   grub_uint32_t color;
 351   int i;
 352   int j;
 353   grub_uint32_t *srcptr;
 354   grub_uint8_t *dstptr;
 355   unsigned int sr;
 356   unsigned int sg;
 357   unsigned int sb;
 358
 359   for (j = 0; j < height; j++)
 360     {
 361       srcptr = (grub_uint32_t *)get_data_ptr (src, offset_x, j + offset_y);
 362       dstptr = (grub_uint8_t *)get_data_ptr (dst, x, y + j);
 363
 364       for (i = 0; i < width; i++)
 365         {
 366           color = *srcptr++;
 367
 368           sr = (color >> 0) & 0xFF;
 369           sg = (color >> 8) & 0xFF;
 370           sb = (color >> 16) & 0xFF;
 371
 372           color = grub_video_vbe_map_rgb(sr, sg, sb);
 373           *dstptr++ = color & 0xFF;
 374         }
 375     }
 376 }
 377
 378 /* Optimized replacing blitter for RGB888 to indexed color.  */
 379 void
 380 grub_video_i386_vbeblit_replace_index_RGB888 (struct grub_video_i386_vbeblit_info *dst,
 381                                               struct grub_video_i386_vbeblit_info *src,
 382                                               int x, int y,
 383                                               int width, int height,
 384                                               int offset_x, int offset_y)
 385 {
 386   grub_uint32_t color;
 387   int i;
 388   int j;
 389   grub_uint8_t *srcptr;
 390   grub_uint8_t *dstptr;
 391   unsigned int sr;
 392   unsigned int sg;
 393   unsigned int sb;
 394
 395   for (j = 0; j < height; j++)
 396     {
 397       srcptr = (grub_uint8_t *)get_data_ptr (src, offset_x, j + offset_y);
 398       dstptr = (grub_uint8_t *)get_data_ptr (dst, x, y + j);
 399
 400       for (i = 0; i < width; i++)
 401         {
 402           sr = *srcptr++;
 403           sg = *srcptr++;
 404           sb = *srcptr++;
 405
 406           color = grub_video_vbe_map_rgb(sr, sg, sb);
 407
 408           *dstptr++ = color & 0xFF;
 409         }
 410     }
 411 }
 412
 413 /* Generic blending blitter.  Works for every supported format.  */
 414 void
 415 grub_video_i386_vbeblit_blend (struct grub_video_i386_vbeblit_info *dst,
 416                                struct grub_video_i386_vbeblit_info *src,
 417                                int x, int y, int width, int height,
 418                                int offset_x, int offset_y)
 419 {
 420   int i;
 421   int j;
 422
 423   for (j = 0; j < height; j++)
 424     {
 425       for (i = 0; i < width; i++)
 426         {
 427           grub_uint8_t src_red;
 428           grub_uint8_t src_green;
 429           grub_uint8_t src_blue;
 430           grub_uint8_t src_alpha;
 431           grub_uint8_t dst_red;
 432           grub_uint8_t dst_green;
 433           grub_uint8_t dst_blue;
 434           grub_uint8_t dst_alpha;
 435           grub_video_color_t src_color;
 436           grub_video_color_t dst_color;
 437
 438           src_color = get_pixel (src, i + offset_x, j + offset_y);
 439           grub_video_vbe_unmap_color_int (src, src_color, &src_red, &src_green,
 440                                       &src_blue, &src_alpha);
 441
 442           if (src_alpha == 0)
 443             continue;
 444
 445           if (src_alpha == 255)
 446             {
 447               dst_color = grub_video_vbe_map_rgba (src_red, src_green,
 448                                                    src_blue, src_alpha);
 449               set_pixel (dst, x + i, y + j, dst_color);
 450               continue;
 451             }
 452
 453           dst_color = get_pixel (dst, x + i, y + j);
 454
 455           grub_video_vbe_unmap_color_int (dst, dst_color, &dst_red,
 456                                       &dst_green, &dst_blue, &dst_alpha);
 457
 458           dst_red = (((src_red * src_alpha)
 459                       + (dst_red * (255 - src_alpha))) / 255);
 460           dst_green = (((src_green * src_alpha)
 461                         + (dst_green * (255 - src_alpha))) / 255);
 462           dst_blue = (((src_blue * src_alpha)
 463                        + (dst_blue * (255 - src_alpha))) / 255);
 464
 465           dst_alpha = src_alpha;
 466           dst_color = grub_video_vbe_map_rgba (dst_red, dst_green, dst_blue,
 467                                                dst_alpha);
 468
 469           set_pixel (dst, x + i, y + j, dst_color);
 470         }
 471     }
 472 }
 473
 474 /* Optimized blending blitter for RGBA8888 to BGRA8888.  */
 475 void
 476 grub_video_i386_vbeblit_blend_BGRA8888_RGBA8888 (struct grub_video_i386_vbeblit_info *dst,
 477                                                  struct grub_video_i386_vbeblit_info *src,
 478                                                  int x, int y,
 479                                                  int width, int height,
 480                                                  int offset_x, int offset_y)
 481 {
 482   grub_uint32_t *srcptr;
 483   grub_uint32_t *dstptr;
 484   unsigned int srcrowskip;
 485   unsigned int dstrowskip;
 486   int i;
 487   int j;
 488
 489   /* Calculate the number of bytes to advance from the end of one line
 490      to the beginning of the next line.  */
 491   srcrowskip = src->mode_info->pitch - src->mode_info->bytes_per_pixel * width;
 492   dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width;
 493
 494   srcptr = (grub_uint32_t *) get_data_ptr (src, offset_x, offset_y);
 495   dstptr = (grub_uint32_t *) get_data_ptr (dst, x, y);
 496
 497   for (j = 0; j < height; j++)
 498     {
 499       for (i = 0; i < width; i++)
 500         {
 501           grub_uint32_t color;
 502           unsigned int sr;
 503           unsigned int sg;
 504           unsigned int sb;
 505           unsigned int a;
 506           unsigned int dr;
 507           unsigned int dg;
 508           unsigned int db;
 509
 510           color = *srcptr++;
 511
 512           a = color >> 24;
 513
 514           if (a == 0)
 515             {
 516               /* Skip transparent source pixels.  */
 517               dstptr++;
 518               continue;
 519             }
 520
 521           sr = (color >> 0) & 0xFF;
 522           sg = (color >> 8) & 0xFF;
 523           sb = (color >> 16) & 0xFF;
 524
 525           if (a == 255)
 526             {
 527               /* Opaque pixel shortcut.  */
 528               dr = sr;
 529               dg = sg;
 530               db = sb;
 531             }
 532           else
 533             {
 534               /* General pixel color blending.  */
 535               color = *dstptr;
 536
 537               dr = (color >> 16) & 0xFF;
 538               dr = (dr * (255 - a) + sr * a) / 255;
 539               dg = (color >> 8) & 0xFF;
 540               dg = (dg * (255 - a) + sg * a) / 255;
 541               db = (color >> 0) & 0xFF;
 542               db = (db * (255 - a) + sb * a) / 255;
 543             }
 544
 545           color = (a << 24) | (dr << 16) | (dg << 8) | db;
 546
 547           *dstptr++ = color;
 548         }
 549
 550       srcptr = (grub_uint32_t *) (((grub_uint8_t *) srcptr) + srcrowskip);
 551       dstptr = (grub_uint32_t *) (((grub_uint8_t *) dstptr) + dstrowskip);
 552     }
 553 }
 554
 555 /* Optimized blending blitter for RGBA8888 to BGR888.  */
 556 void
 557 grub_video_i386_vbeblit_blend_BGR888_RGBA8888 (struct grub_video_i386_vbeblit_info *dst,
 558                                                struct grub_video_i386_vbeblit_info *src,
 559                                                int x, int y,
 560                                                int width, int height,
 561                                                int offset_x, int offset_y)
 562 {
 563   grub_uint32_t *srcptr;
 564   grub_uint8_t *dstptr;
 565   unsigned int srcrowskip;
 566   unsigned int dstrowskip;
 567   int i;
 568   int j;
 569
 570   /* Calculate the number of bytes to advance from the end of one line
 571      to the beginning of the next line.  */
 572   srcrowskip = src->mode_info->pitch - src->mode_info->bytes_per_pixel * width;
 573   dstrowskip = dst->mode_info->pitch - dst->mode_info->bytes_per_pixel * width;
 574
 575   srcptr = (grub_uint32_t *) get_data_ptr (src, offset_x, offset_y);
 576   dstptr = (grub_uint8_t *) get_data_ptr (dst, x, y);
 577
 578   for (j = 0; j < height; j++)
 579     {
 580       for (i = 0; i < width; i++)
 581         {
 582           grub_uint32_t color;
 583           unsigned int sr;
 584           unsigned int sg;
 585           unsigned int sb;
 586           unsigned int a;
 587           unsigned int dr;
 588           unsigned int dg;
 589           unsigned int db;
 590
 591           color = *srcptr++;
 592
 593           a = color >> 24;
 594
 595           if (a == 0)
 596             {
 597               /* Skip transparent source pixels.  */
 598               dstptr += 3;
 599               continue;
 600             }
 601
 602           sr = (color >> 0) & 0xFF;
 603           sg = (color >> 8) & 0xFF;
 604           sb = (color >> 16) & 0xFF;
 605
 606           if (a == 255)
 607             {
 608               /* Opaque pixel shortcut.  */
 609               dr = sr;
 610               dg = sg;
 611               db = sb;
 612             }
 613           else
 614             {
 615               /* General pixel color blending.  */
 616               color = *dstptr;
 617
 618               db = dstptr[0];
 619               db = (db * (255 - a) + sb * a) / 255;
 620               dg = dstptr[1];
 621               dg = (dg * (255 - a) + sg * a) / 255;
 622               dr = dstptr[2];
 623               dr = (dr * (255 - a) + sr * a) / 255;
 624             }
 625
 626           *dstptr++ = db;
 627           *dstptr++ = dg;
 628           *dstptr++ = dr;
 629         }
 630
 631       srcptr = (grub_uint32_t *) (((grub_uint8_t *) srcptr) + srcrowskip);
 632       dstptr += dstrowskip;
 633     }
 634 }
 635
 636 /* Optimized blending blitter for RGBA888 to RGBA8888.  */
 637 void
 638 grub_video_i386_vbeblit_blend_RGBA8888_RGBA8888 (struct grub_video_i386_vbeblit_info *dst,
 639                                                  struct grub_video_i386_vbeblit_info *src,
 640                                                  int x, int y,
 641                                                  int width, int height,
 642                                                  int offset_x, int offset_y)
 643 {
 644   grub_uint32_t color;
 645   int i;
 646   int j;
 647   grub_uint32_t *srcptr;
 648   grub_uint32_t *dstptr;
 649   unsigned int sr;
 650   unsigned int sg;
 651   unsigned int sb;
 652   unsigned int a;
 653   unsigned int dr;
 654   unsigned int dg;
 655   unsigned int db;
 656
 657   for (j = 0; j < height; j++)
 658     {
 659       srcptr = (grub_uint32_t *)get_data_ptr (src, offset_x, j + offset_y);
 660       dstptr = (grub_uint32_t *)get_data_ptr (dst, x, y + j);
 661
 662       for (i = 0; i < width; i++)
 663         {
 664           color = *srcptr++;
 665
 666           a = color >> 24;
 667
 668           if (a == 0)
 669             {
 670               dstptr++;
 671               continue;
 672             }
 673
 674           if (a == 255)
 675             {
 676               *dstptr++ = color;
 677               continue;
 678             }
 679
 680           sr = (color >> 0) & 0xFF;
 681           sg = (color >> 8) & 0xFF;
 682           sb = (color >> 16) & 0xFF;
 683
 684           color = *dstptr;
 685
 686           dr = (color >> 0) & 0xFF;
 687           dg = (color >> 8) & 0xFF;
 688           db = (color >> 16) & 0xFF;
 689
 690           dr = (dr * (255 - a) + sr * a) / 255;
 691           dg = (dg * (255 - a) + sg * a) / 255;
 692           db = (db * (255 - a) + sb * a) / 255;
 693
 694           color = (a << 24) | (db << 16) | (dg << 8) | dr;
 695
 696           *dstptr++ = color;
 697         }
 698     }
 699 }
 700
 701 /* Optimized blending blitter for RGBA8888 to RGB888.  */
 702 void
 703 grub_video_i386_vbeblit_blend_RGB888_RGBA8888 (struct grub_video_i386_vbeblit_info *dst,
 704                                                struct grub_video_i386_vbeblit_info *src,
 705                                                int x, int y,
 706                                                int width, int height,
 707                                                int offset_x, int offset_y)
 708 {
 709   grub_uint32_t color;
 710   int i;
 711   int j;
 712   grub_uint32_t *srcptr;
 713   grub_uint8_t *dstptr;
 714   unsigned int sr;
 715   unsigned int sg;
 716   unsigned int sb;
 717   unsigned int a;
 718   unsigned int dr;
 719   unsigned int dg;
 720   unsigned int db;
 721
 722   for (j = 0; j < height; j++)
 723     {
 724       srcptr = (grub_uint32_t *)get_data_ptr (src, offset_x, j + offset_y);
 725       dstptr = (grub_uint8_t *)get_data_ptr (dst, x, y + j);
 726
 727       for (i = 0; i < width; i++)
 728         {
 729           color = *srcptr++;
 730
 731           a = color >> 24;
 732
 733           if (a == 0)
 734             {
 735               dstptr += 3;
 736               continue;
 737             }
 738
 739           sr = (color >> 0) & 0xFF;
 740           sg = (color >> 8) & 0xFF;
 741           sb = (color >> 16) & 0xFF;
 742
 743           if (a == 255)
 744             {
 745               *dstptr++ = sr;
 746               *dstptr++ = sg;
 747               *dstptr++ = sb;
 748
 749               continue;
 750             }
 751
 752           dr = dstptr[0];
 753           dg = dstptr[1];
 754           db = dstptr[2];
 755
 756           dr = (dr * (255 - a) + sr * a) / 255;
 757           dg = (dg * (255 - a) + sg * a) / 255;
 758           db = (db * (255 - a) + sb * a) / 255;
 759
 760           *dstptr++ = dr;
 761           *dstptr++ = dg;
 762           *dstptr++ = db;
 763         }
 764     }
 765 }
 766
 767 /* Optimized blending blitter for RGBA8888 to indexed color.  */
 768 void
 769 grub_video_i386_vbeblit_blend_index_RGBA8888 (struct grub_video_i386_vbeblit_info *dst,
 770                                               struct grub_video_i386_vbeblit_info *src,
 771                                               int x, int y,
 772                                               int width, int height,
 773                                               int offset_x, int offset_y)
 774 {
 775   grub_uint32_t color;
 776   int i;
 777   int j;
 778   grub_uint32_t *srcptr;
 779   grub_uint8_t *dstptr;
 780   unsigned int sr;
 781   unsigned int sg;
 782   unsigned int sb;
 783   unsigned int a;
 784   unsigned char dr;
 785   unsigned char dg;
 786   unsigned char db;
 787   unsigned char da;
 788
 789   for (j = 0; j < height; j++)
 790     {
 791       srcptr = (grub_uint32_t *)get_data_ptr (src, offset_x, j + offset_y);
 792       dstptr = (grub_uint8_t *)get_data_ptr (dst, x, y + j);
 793
 794       for (i = 0; i < width; i++)
 795         {
 796           color = *srcptr++;
 797
 798           a = color >> 24;
 799
 800           if (a == 0)
 801             {
 802               dstptr++;
 803               continue;
 804             }
 805
 806           sr = (color >> 0) & 0xFF;
 807           sg = (color >> 8) & 0xFF;
 808           sb = (color >> 16) & 0xFF;
 809
 810           if (a == 255)
 811             {
 812               color = grub_video_vbe_map_rgb(sr, sg, sb);
 813               *dstptr++ = color & 0xFF;
 814               continue;
 815             }
 816
 817           grub_video_vbe_unmap_color_int (dst, *dstptr, &dr, &dg, &db, &da);
 818
 819           dr = (dr * (255 - a) + sr * a) / 255;
 820           dg = (dg * (255 - a) + sg * a) / 255;
 821           db = (db * (255 - a) + sb * a) / 255;
 822
 823           color = grub_video_vbe_map_rgb(dr, dg, db);
 824
 825           *dstptr++ = color & 0xFF;
 826         }
 827     }
 828 }