rom/hidds/graphics/rgbconv.c

   1 /*
   2     Copyright © 2011, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: RGB pixel format conversion functions.
   6 */
   7
   8 #include "rgbconv.h"
   9
  10
  11 ULONG Convert_RGB24_To_BGR032(APTR srcPixels, ULONG srcMod,
  12     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
  13     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
  14 {
  15     WORD x, y, src_step, dst_step;
  16     UBYTE *p = srcPixels, *q = dstPixels;
  17     UBYTE src_red, src_green, src_blue;
  18
  19     src_step = srcMod - width * 3;
  20     dst_step = dstMod - width * 4;
  21
  22     for(y = 0; y < height; y++)
  23     {
  24         for(x = 0; x < width; x++)
  25         {
  26             src_red   = *p++;
  27             src_green = *p++;
  28             src_blue  = *p++;
  29
  30             *q++ = src_blue;
  31             *q++ = src_green;
  32             *q++ = src_red;
  33             *q++ = 0;
  34         }
  35         p += src_step;
  36         q += dst_step;
  37     }
  38
  39     return TRUE;
  40 }
  41
  42
  43 ULONG Convert_BGR24_To_BGR032(APTR srcPixels, ULONG srcMod,
  44     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
  45     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
  46 {
  47     WORD x, y, src_step, dst_step;
  48     UBYTE *p = srcPixels, *q = dstPixels;
  49     UBYTE src_red, src_green, src_blue;
  50
  51     src_step = srcMod - width * 3;
  52     dst_step = dstMod - width * 4;
  53
  54     for(y = 0; y < height; y++)
  55     {
  56         for(x = 0; x < width; x++)
  57         {
  58             src_blue  = *p++;
  59             src_green = *p++;
  60             src_red   = *p++;
  61
  62             *q++ = src_blue;
  63             *q++ = src_green;
  64             *q++ = src_red;
  65             *q++ = 0;
  66         }
  67         p += src_step;
  68         q += dst_step;
  69     }
  70
  71     return TRUE;
  72 }
  73
  74
  75 ULONG Convert_RGB16_To_BGR032(APTR srcPixels, ULONG srcMod,
  76     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
  77     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
  78 {
  79     WORD x, y, src_step, dst_step;
  80     UBYTE *p = srcPixels, *q = dstPixels;
  81     UBYTE src_red, src_green, src_blue;
  82
  83     src_step = srcMod - width * 2;
  84     dst_step = dstMod - width * 4;
  85
  86     for(y = 0; y < height; y++)
  87     {
  88         for(x = 0; x < width; x++)
  89         {
  90             src_red = *p++;
  91             src_blue = *p++;
  92             src_green = src_red << 5 | src_blue >> 3 & 0x1c;
  93             src_blue <<= 3;
  94             src_red &= 0xf8;
  95
  96             *q++ = src_blue;
  97             *q++ = src_green;
  98             *q++ = src_red;
  99             *q++ = 0;
 100         }
 101         p += src_step;
 102         q += dst_step;
 103     }
 104
 105     return TRUE;
 106 }
 107
 108
 109 ULONG Convert_RGB16LE_To_BGR032(APTR srcPixels, ULONG srcMod,
 110     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 111     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 112 {
 113     WORD x, y, src_step, dst_step;
 114     UBYTE *p = srcPixels, *q = dstPixels;
 115     UBYTE src_red, src_green, src_blue;
 116
 117     src_step = srcMod - width * 2;
 118     dst_step = dstMod - width * 4;
 119
 120     for(y = 0; y < height; y++)
 121     {
 122         for(x = 0; x < width; x++)
 123         {
 124             src_blue = *p++;
 125             src_red = *p++;
 126             src_green = src_red << 5 | src_blue >> 3 & 0x1c;
 127             src_blue <<= 3;
 128             src_red &= 0xf8;
 129
 130             *q++ = src_blue;
 131             *q++ = src_green;
 132             *q++ = src_red;
 133             *q++ = 0;
 134         }
 135         p += src_step;
 136         q += dst_step;
 137     }
 138
 139     return TRUE;
 140 }
 141
 142
 143 ULONG Convert_BGR16_To_BGR032(APTR srcPixels, ULONG srcMod,
 144     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 145     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 146 {
 147     WORD x, y, src_step, dst_step;
 148     UBYTE *p = srcPixels, *q = dstPixels;
 149     UBYTE src_red, src_green, src_blue;
 150
 151     src_step = srcMod - width * 2;
 152     dst_step = dstMod - width * 4;
 153
 154     for(y = 0; y < height; y++)
 155     {
 156         for(x = 0; x < width; x++)
 157         {
 158             src_blue = *p++;
 159             src_red = *p++;
 160             src_green = src_blue << 5 | src_red >> 3 & 0x1c;
 161             src_blue &= 0xf8;
 162             src_red <<= 3;
 163
 164             *q++ = src_blue;
 165             *q++ = src_green;
 166             *q++ = src_red;
 167             *q++ = 0;
 168         }
 169         p += src_step;
 170         q += dst_step;
 171     }
 172
 173     return TRUE;
 174 }
 175
 176
 177 ULONG Convert_BGR16LE_To_BGR032(APTR srcPixels, ULONG srcMod,
 178     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 179     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 180 {
 181     WORD x, y, src_step, dst_step;
 182     UBYTE *p = srcPixels, *q = dstPixels;
 183     UBYTE src_red, src_green, src_blue;
 184
 185     src_step = srcMod - width * 2;
 186     dst_step = dstMod - width * 4;
 187
 188     for(y = 0; y < height; y++)
 189     {
 190         for(x = 0; x < width; x++)
 191         {
 192             src_red = *p++;
 193             src_blue = *p++;
 194             src_green = src_blue << 5 | src_red >> 3 & 0x1c;
 195             src_red <<= 3;
 196             src_blue &= 0xf8;
 197
 198             *q++ = src_blue;
 199             *q++ = src_green;
 200             *q++ = src_red;
 201             *q++ = 0;
 202         }
 203         p += src_step;
 204         q += dst_step;
 205     }
 206
 207     return TRUE;
 208 }
 209
 210
 211 ULONG Convert_ARGB32_To_BGR032(APTR srcPixels, ULONG srcMod,
 212     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 213     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 214 {
 215     WORD x, y, src_step, dst_step;
 216     UBYTE *p = srcPixels, *q = dstPixels;
 217     UBYTE src_red, src_green, src_blue;
 218
 219     src_step = srcMod - width * 4;
 220     dst_step = dstMod - width * 4;
 221
 222     for(y = 0; y < height; y++)
 223     {
 224         for(x = 0; x < width; x++)
 225         {
 226             p++; /* alpha */
 227             src_red   = *p++;
 228             src_green = *p++;
 229             src_blue  = *p++;
 230
 231             *q++ = src_blue;
 232             *q++ = src_green;
 233             *q++ = src_red;
 234             *q++ = 0;
 235         }
 236         p += src_step;
 237         q += dst_step;
 238     }
 239
 240     return TRUE;
 241 }
 242
 243
 244 ULONG Convert_BGRA32_To_BGR032(APTR srcPixels, ULONG srcMod,
 245     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 246     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 247 {
 248     WORD x, y, src_step, dst_step;
 249     UBYTE *p = srcPixels, *q = dstPixels;
 250     UBYTE src_red, src_green, src_blue;
 251
 252     src_step = srcMod - width * 4;
 253     dst_step = dstMod - width * 4;
 254
 255     for(y = 0; y < height; y++)
 256     {
 257         for(x = 0; x < width; x++)
 258         {
 259             src_blue  = *p++;
 260             src_green = *p++;
 261             src_red   = *p++;
 262             p++; /* alpha */
 263
 264             *q++ = src_blue;
 265             *q++ = src_green;
 266             *q++ = src_red;
 267             *q++ = 0;
 268         }
 269         p += src_step;
 270         q += dst_step;
 271     }
 272
 273     return TRUE;
 274 }
 275
 276
 277 ULONG Convert_RGBA32_To_BGR032(APTR srcPixels, ULONG srcMod,
 278     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 279     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 280 {
 281     WORD x, y, src_step, dst_step;
 282     UBYTE *p = srcPixels, *q = dstPixels;
 283     UBYTE src_red, src_green, src_blue;
 284
 285     src_step = srcMod - width * 4;
 286     dst_step = dstMod - width * 4;
 287
 288     for(y = 0; y < height; y++)
 289     {
 290         for(x = 0; x < width; x++)
 291         {
 292             src_red   = *p++;
 293             src_green = *p++;
 294             src_blue  = *p++;
 295             p++; /* alpha */
 296
 297             *q++ = src_blue;
 298             *q++ = src_green;
 299             *q++ = src_red;
 300             *q++ = 0;
 301         }
 302         p += src_step;
 303         q += dst_step;
 304     }
 305
 306     return TRUE;
 307 }
 308
 309
 310 ULONG Convert_ABGR32_To_BGR032(APTR srcPixels, ULONG srcMod,
 311     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 312     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 313 {
 314     WORD x, y, src_step, dst_step;
 315     UBYTE *p = srcPixels, *q = dstPixels;
 316     UBYTE src_red, src_green, src_blue;
 317
 318     src_step = srcMod - width * 4;
 319     dst_step = dstMod - width * 4;
 320
 321     for(y = 0; y < height; y++)
 322     {
 323         for(x = 0; x < width; x++)
 324         {
 325             p++; /* alpha */
 326             src_blue  = *p++;
 327             src_green = *p++;
 328             src_red   = *p++;
 329
 330             *q++ = src_blue;
 331             *q++ = src_green;
 332             *q++ = src_red;
 333             *q++ = 0;
 334         }
 335         p += src_step;
 336         q += dst_step;
 337     }
 338
 339     return TRUE;
 340 }
 341
 342
 343 ULONG Convert_BGR032_To_ARGB32(APTR srcPixels, ULONG srcMod,
 344     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 345     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 346 {
 347     WORD x, y, src_step, dst_step;
 348     UBYTE *p = srcPixels, *q = dstPixels;
 349     UBYTE src_red, src_green, src_blue;
 350
 351     src_step = srcMod - width * 4;
 352     dst_step = dstMod - width * 4;
 353
 354     for(y = 0; y < height; y++)
 355     {
 356         for(x = 0; x < width; x++)
 357         {
 358             src_blue  = *p++;
 359             src_green = *p++;
 360             src_red   = *p++;
 361             p++; /* zero */
 362
 363             *q++ = 0xff;
 364             *q++ = src_red;
 365             *q++ = src_green;
 366             *q++ = src_blue;
 367         }
 368         p += src_step;
 369         q += dst_step;
 370     }
 371
 372     return TRUE;
 373 }
 374
 375
 376 ULONG Convert_RGB24_To_RGB16LE(APTR srcPixels, ULONG srcMod,
 377     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 378     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 379 {
 380     WORD x, y, src_step, dst_step;
 381     UBYTE *p = srcPixels, *q = dstPixels;
 382     UBYTE src_red, src_green, src_blue;
 383
 384     src_step = srcMod - width * 3;
 385     dst_step = dstMod - width * 2;
 386
 387     for(y = 0; y < height; y++)
 388     {
 389         for(x = 0; x < width; x++)
 390         {
 391             src_red   = *p++;
 392             src_green = *p++;
 393             src_blue  = *p++;
 394
 395             *q++ = (src_green << 3) & 0xe0 | src_blue >> 3;
 396             *q++ = src_red & 0xf8 | src_green >> 5;
 397         }
 398         p += src_step;
 399         q += dst_step;
 400     }
 401
 402     return TRUE;
 403 }
 404
 405
 406 ULONG Convert_BGR24_To_RGB16LE(APTR srcPixels, ULONG srcMod,
 407     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 408     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 409 {
 410     WORD x, y, src_step, dst_step;
 411     UBYTE *p = srcPixels, *q = dstPixels;
 412     UBYTE src_red, src_green, src_blue;
 413
 414     src_step = srcMod - width * 3;
 415     dst_step = dstMod - width * 2;
 416
 417     for(y = 0; y < height; y++)
 418     {
 419         for(x = 0; x < width; x++)
 420         {
 421             src_blue  = *p++;
 422             src_green = *p++;
 423             src_red   = *p++;
 424
 425             *q++ = (src_green << 3) & 0xe0 | src_blue >> 3;
 426             *q++ = src_red & 0xf8 | src_green >> 5;
 427         }
 428         p += src_step;
 429         q += dst_step;
 430     }
 431
 432     return TRUE;
 433 }
 434
 435
 436 ULONG Convert_RGB16_To_RGB16LE(APTR srcPixels, ULONG srcMod,
 437     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 438     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 439 {
 440     WORD x, y, src_step, dst_step;
 441     UBYTE *p = srcPixels, *q = dstPixels;
 442     UBYTE src_red, src_blue;
 443
 444     src_step = srcMod - width * 2;
 445     dst_step = dstMod - width * 2;
 446
 447     for(y = 0; y < height; y++)
 448     {
 449         for(x = 0; x < width; x++)
 450         {
 451             src_red   = *p++;
 452             src_blue  = *p++;
 453
 454             *q++ = src_blue;
 455             *q++ = src_red;
 456         }
 457         p += src_step;
 458         q += dst_step;
 459     }
 460
 461     return TRUE;
 462 }
 463
 464
 465 ULONG Convert_RGB16LE_To_RGB16LE(APTR srcPixels, ULONG srcMod,
 466     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 467     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 468 {
 469     WORD x, y, src_step, dst_step;
 470     UBYTE *p = srcPixels, *q = dstPixels;
 471     UBYTE src_red, src_blue;
 472
 473     src_step = srcMod - width * 2;
 474     dst_step = dstMod - width * 2;
 475
 476     for(y = 0; y < height; y++)
 477     {
 478         for(x = 0; x < width; x++)
 479         {
 480             src_blue  = *p++;
 481             src_red   = *p++;
 482
 483             *q++ = src_blue;
 484             *q++ = src_red;
 485         }
 486         p += src_step;
 487         q += dst_step;
 488     }
 489
 490     return TRUE;
 491 }
 492
 493
 494 ULONG Convert_BGR16_To_RGB16LE(APTR srcPixels, ULONG srcMod,
 495     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 496     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 497 {
 498     WORD x, y, src_step, dst_step;
 499     UBYTE *p = srcPixels, *q = dstPixels;
 500     UBYTE src_red, src_green, src_blue;
 501
 502     src_step = srcMod - width * 4;
 503     dst_step = dstMod - width * 2;
 504
 505     for(y = 0; y < height; y++)
 506     {
 507         for(x = 0; x < width; x++)
 508         {
 509             src_blue = *p++;
 510             src_red = *p++;
 511             src_green = src_blue << 5 | src_red >> 3 & 0x1c;
 512             src_blue &= 0xf8;
 513             src_red <<= 3;
 514
 515             *q++ = (src_green << 3) & 0xe0 | src_blue >> 3;
 516             *q++ = src_red & 0xf8 | src_green >> 5;
 517         }
 518         p += src_step;
 519         q += dst_step;
 520     }
 521
 522     return TRUE;
 523 }
 524
 525
 526 ULONG Convert_BGR16LE_To_RGB16LE(APTR srcPixels, ULONG srcMod,
 527     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 528     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 529 {
 530     WORD x, y, src_step, dst_step;
 531     UBYTE *p = srcPixels, *q = dstPixels;
 532     UBYTE src_red, src_green, src_blue;
 533
 534     src_step = srcMod - width * 4;
 535     dst_step = dstMod - width * 2;
 536
 537     for(y = 0; y < height; y++)
 538     {
 539         for(x = 0; x < width; x++)
 540         {
 541             src_red = *p++;
 542             src_blue = *p++;
 543             src_green = src_blue << 5 | src_red >> 3 & 0x1c;
 544             src_red <<= 3;
 545             src_blue &= 0xf8;
 546
 547             *q++ = (src_green << 3) & 0xe0 | src_blue >> 3;
 548             *q++ = src_red & 0xf8 | src_green >> 5;
 549         }
 550         p += src_step;
 551         q += dst_step;
 552     }
 553
 554     return TRUE;
 555 }
 556
 557
 558 ULONG Convert_ARGB32_To_RGB16LE(APTR srcPixels, ULONG srcMod,
 559     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 560     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 561 {
 562     WORD x, y, src_step, dst_step;
 563     UBYTE *p = srcPixels, *q = dstPixels;
 564     UBYTE src_red, src_green, src_blue;
 565
 566     src_step = srcMod - width * 4;
 567     dst_step = dstMod - width * 2;
 568
 569     for(y = 0; y < height; y++)
 570     {
 571         for(x = 0; x < width; x++)
 572         {
 573             p++; /* alpha */
 574             src_red   = *p++;
 575             src_green = *p++;
 576             src_blue  = *p++;
 577
 578             *q++ = (src_green << 3) & 0xe0 | src_blue >> 3;
 579             *q++ = src_red & 0xf8 | src_green >> 5;
 580         }
 581         p += src_step;
 582         q += dst_step;
 583     }
 584
 585     return TRUE;
 586 }
 587
 588
 589 ULONG Convert_BGRA32_To_RGB16LE(APTR srcPixels, ULONG srcMod,
 590     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 591     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 592 {
 593     WORD x, y, src_step, dst_step;
 594     UBYTE *p = srcPixels, *q = dstPixels;
 595     UBYTE src_red, src_green, src_blue;
 596
 597     src_step = srcMod - width * 4;
 598     dst_step = dstMod - width * 2;
 599
 600     for(y = 0; y < height; y++)
 601     {
 602         for(x = 0; x < width; x++)
 603         {
 604             src_blue  = *p++;
 605             src_green = *p++;
 606             src_red   = *p++;
 607             p++; /* alpha */
 608
 609             *q++ = (src_green << 3) & 0xe0 | src_blue >> 3;
 610             *q++ = src_red & 0xf8 | src_green >> 5;
 611         }
 612         p += src_step;
 613         q += dst_step;
 614     }
 615
 616     return TRUE;
 617 }
 618
 619
 620 ULONG Convert_RGBA32_To_RGB16LE(APTR srcPixels, ULONG srcMod,
 621     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 622     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 623 {
 624     WORD x, y, src_step, dst_step;
 625     UBYTE *p = srcPixels, *q = dstPixels;
 626     UBYTE src_red, src_green, src_blue;
 627
 628     src_step = srcMod - width * 4;
 629     dst_step = dstMod - width * 2;
 630
 631     for(y = 0; y < height; y++)
 632     {
 633         for(x = 0; x < width; x++)
 634         {
 635             src_red   = *p++;
 636             src_green = *p++;
 637             src_blue  = *p++;
 638             p++; /* alpha */
 639
 640             *q++ = (src_green << 3) & 0xe0 | src_blue >> 3;
 641             *q++ = src_red & 0xf8 | src_green >> 5;
 642         }
 643         p += src_step;
 644         q += dst_step;
 645     }
 646
 647     return TRUE;
 648 }
 649
 650
 651 ULONG Convert_ABGR32_To_RGB16LE(APTR srcPixels, ULONG srcMod,
 652     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 653     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 654 {
 655     WORD x, y, src_step, dst_step;
 656     UBYTE *p = srcPixels, *q = dstPixels;
 657     UBYTE src_red, src_green, src_blue;
 658
 659     src_step = srcMod - width * 4;
 660     dst_step = dstMod - width * 2;
 661
 662     for(y = 0; y < height; y++)
 663     {
 664         for(x = 0; x < width; x++)
 665         {
 666             p++; /* alpha */
 667             src_blue  = *p++;
 668             src_green = *p++;
 669             src_red   = *p++;
 670
 671             *q++ = (src_green << 3) & 0xe0 | src_blue >> 3;
 672             *q++ = src_red & 0xf8 | src_green >> 5;
 673         }
 674         p += src_step;
 675         q += dst_step;
 676     }
 677
 678     return TRUE;
 679 }
 680
 681
 682 ULONG Convert_RGB16LE_To_ARGB32(APTR srcPixels, ULONG srcMod,
 683     HIDDT_StdPixFmt srcPixFmt, APTR dstPixels, ULONG dstMod,
 684     HIDDT_StdPixFmt dstPixFmt, ULONG width, ULONG height)
 685 {
 686     WORD x, y, src_step, dst_step;
 687     UBYTE *p = srcPixels, *q = dstPixels;
 688     UBYTE src_red, src_green, src_blue;
 689
 690     src_step = srcMod - width * 2;
 691     dst_step = dstMod - width * 4;
 692
 693     for(y = 0; y < height; y++)
 694     {
 695         for(x = 0; x < width; x++)
 696         {
 697             src_blue = *p++;
 698             src_red = *p++;
 699             src_green = src_red << 5 | src_blue >> 3 & 0x1c;
 700             src_blue <<= 3;
 701             src_red &= 0xf8;
 702
 703             *q++ = 0xff;
 704             *q++ = src_red;
 705             *q++ = src_green;
 706             *q++ = src_blue;
 707         }
 708         p += src_step;
 709         q += dst_step;
 710     }
 711
 712     return TRUE;
 713 }
 714
 715