com32/lib/sys/vesa/fmtpixel.c

   1 /* ----------------------------------------------------------------------- *
   2  *
   3  *   Copyright 2006-2008 H. Peter Anvin - All Rights Reserved
   4  *
   5  *   Permission is hereby granted, free of charge, to any person
   6  *   obtaining a copy of this software and associated documentation
   7  *   files (the "Software"), to deal in the Software without
   8  *   restriction, including without limitation the rights to use,
   9  *   copy, modify, merge, publish, distribute, sublicense, and/or
  10  *   sell copies of the Software, and to permit persons to whom
  11  *   the Software is furnished to do so, subject to the following
  12  *   conditions:
  13  *
  14  *   The above copyright notice and this permission notice shall
  15  *   be included in all copies or substantial portions of the Software.
  16  *
  17  *   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  18  *   EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
  19  *   OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  20  *   NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
  21  *   HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
  22  *   WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  23  *   FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  24  *   OTHER DEALINGS IN THE SOFTWARE.
  25  *
  26  * ----------------------------------------------------------------------- */
  27
  28 /*
  29  * fmtpixel.c
  30  *
  31  * Functions to format a single pixel
  32  */
  33
  34 #include <inttypes.h>
  35 #include "video.h"
  36
  37 /*
  38  * Format a sequence of pixels.  The first argument is the line buffer;
  39  * we can use it to write up to 4 bytes past the end of the last pixel.
  40  * Return the place we should be copying from, this is usually the
  41  * buffer address, but doesn't *have* to be.
  42  */
  43
  44 static const void *format_pxf_bgra32(void *ptr, const uint32_t * p, size_t n)
  45 {
  46     (void)ptr;
  47     (void)n;
  48     return p;                   /* No conversion needed! */
  49 }
  50
  51 static const void *format_pxf_bgr24(void *ptr, const uint32_t * p, size_t n)
  52 {
  53     char *q = ptr;
  54
  55     while (n--) {
  56         *(uint32_t *) q = *p++;
  57         q += 3;
  58     }
  59     return ptr;
  60 }
  61
  62 static const void *format_pxf_le_rgb16_565(void *ptr, const uint32_t * p,
  63                                            size_t n)
  64 {
  65     uint32_t bgra;
  66     uint16_t *q = ptr;
  67
  68     while (n--) {
  69         bgra = *p++;
  70         *q++ =
  71             ((bgra >> 3) & 0x1f) +
  72             ((bgra >> (2 + 8 - 5)) & (0x3f << 5)) +
  73             ((bgra >> (3 + 16 - 11)) & (0x1f << 11));
  74     }
  75     return ptr;
  76 }
  77
  78 static const void *format_pxf_le_rgb15_555(void *ptr, const uint32_t * p,
  79                                            size_t n)
  80 {
  81     uint32_t bgra;
  82     uint16_t *q = ptr;
  83
  84     while (n--) {
  85         bgra = *p++;
  86         *q++ =
  87             ((bgra >> 3) & 0x1f) +
  88             ((bgra >> (2 + 8 - 5)) & (0x1f << 5)) +
  89             ((bgra >> (3 + 16 - 10)) & (0x1f << 10));
  90     }
  91     return ptr;
  92 }
  93
  94 __vesacon_format_pixels_t __vesacon_format_pixels;
  95
  96 const __vesacon_format_pixels_t __vesacon_format_pixels_list[PXF_NONE] = {
  97     [PXF_BGRA32] = format_pxf_bgra32,
  98     [PXF_BGR24] = format_pxf_bgr24,
  99     [PXF_LE_RGB16_565] = format_pxf_le_rgb16_565,
 100     [PXF_LE_RGB15_555] = format_pxf_le_rgb15_555,
 101 };