LXR qemu/hw/display/omap_lcd

   1/*
   2 * QEMU OMAP LCD Emulator templates
   3 *
   4 * Copyright (c) 2006 Andrzej Zaborowski  <balrog@zabor.org>
   5 *
   6 * Redistribution and use in source and binary forms, with or without
   7 * modification, are permitted provided that the following conditions
   8 * are met:
   9 *
  10 * 1. Redistributions of source code must retain the above copyright
  11 *    notice, this list of conditions and the following disclaimer.
  12 * 2. Redistributions in binary form must reproduce the above copyright
  13 *    notice, this list of conditions and the following disclaimer in
  14 *    the documentation and/or other materials provided with the
  15 *    distribution.
  16 *
  17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS''
  18 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
  19 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
  20 * PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR
  21 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
  22 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  23 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
  24 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY
  25 * OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  26 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  27 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28 */
  29
  30#if DEPTH == 32
  31# define BPP 4
  32# define PIXEL_TYPE uint32_t
  33#else
  34# error unsupport depth
  35#endif
  36
  37/*
  38 * 2-bit colour
  39 */
  40static void glue(draw_line2_, DEPTH)(void *opaque,
  41                uint8_t *d, const uint8_t *s, int width, int deststep)
  42{
  43    uint16_t *pal = opaque;
  44    uint8_t v, r, g, b;
  45
  46    do {
  47        v = ldub_p((void *) s);
  48        r = (pal[v & 3] >> 4) & 0xf0;
  49        g = pal[v & 3] & 0xf0;
  50        b = (pal[v & 3] << 4) & 0xf0;
  51        ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b);
  52        d += BPP;
  53        v >>= 2;
  54        r = (pal[v & 3] >> 4) & 0xf0;
  55        g = pal[v & 3] & 0xf0;
  56        b = (pal[v & 3] << 4) & 0xf0;
  57        ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b);
  58        d += BPP;
  59        v >>= 2;
  60        r = (pal[v & 3] >> 4) & 0xf0;
  61        g = pal[v & 3] & 0xf0;
  62        b = (pal[v & 3] << 4) & 0xf0;
  63        ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b);
  64        d += BPP;
  65        v >>= 2;
  66        r = (pal[v & 3] >> 4) & 0xf0;
  67        g = pal[v & 3] & 0xf0;
  68        b = (pal[v & 3] << 4) & 0xf0;
  69        ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b);
  70        d += BPP;
  71        s ++;
  72        width -= 4;
  73    } while (width > 0);
  74}
  75
  76/*
  77 * 4-bit colour
  78 */
  79static void glue(draw_line4_, DEPTH)(void *opaque,
  80                uint8_t *d, const uint8_t *s, int width, int deststep)
  81{
  82    uint16_t *pal = opaque;
  83    uint8_t v, r, g, b;
  84
  85    do {
  86        v = ldub_p((void *) s);
  87        r = (pal[v & 0xf] >> 4) & 0xf0;
  88        g = pal[v & 0xf] & 0xf0;
  89        b = (pal[v & 0xf] << 4) & 0xf0;
  90        ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b);
  91        d += BPP;
  92        v >>= 4;
  93        r = (pal[v & 0xf] >> 4) & 0xf0;
  94        g = pal[v & 0xf] & 0xf0;
  95        b = (pal[v & 0xf] << 4) & 0xf0;
  96        ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b);
  97        d += BPP;
  98        s ++;
  99        width -= 2;
 100    } while (width > 0);
 101}
 102
 103/*
 104 * 8-bit colour
 105 */
 106static void glue(draw_line8_, DEPTH)(void *opaque,
 107                uint8_t *d, const uint8_t *s, int width, int deststep)
 108{
 109    uint16_t *pal = opaque;
 110    uint8_t v, r, g, b;
 111
 112    do {
 113        v = ldub_p((void *) s);
 114        r = (pal[v] >> 4) & 0xf0;
 115        g = pal[v] & 0xf0;
 116        b = (pal[v] << 4) & 0xf0;
 117        ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b);
 118        s ++;
 119        d += BPP;
 120    } while (-- width != 0);
 121}
 122
 123/*
 124 * 12-bit colour
 125 */
 126static void glue(draw_line12_, DEPTH)(void *opaque,
 127                uint8_t *d, const uint8_t *s, int width, int deststep)
 128{
 129    uint16_t v;
 130    uint8_t r, g, b;
 131
 132    do {
 133        v = lduw_le_p((void *) s);
 134        r = (v >> 4) & 0xf0;
 135        g = v & 0xf0;
 136        b = (v << 4) & 0xf0;
 137        ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b);
 138        s += 2;
 139        d += BPP;
 140    } while (-- width != 0);
 141}
 142
 143/*
 144 * 16-bit colour
 145 */
 146static void glue(draw_line16_, DEPTH)(void *opaque,
 147                uint8_t *d, const uint8_t *s, int width, int deststep)
 148{
 149#if defined(HOST_WORDS_BIGENDIAN) == defined(TARGET_WORDS_BIGENDIAN)
 150    memcpy(d, s, width * 2);
 151#else
 152    uint16_t v;
 153    uint8_t r, g, b;
 154
 155    do {
 156        v = lduw_le_p((void *) s);
 157        r = (v >> 8) & 0xf8;
 158        g = (v >> 3) & 0xfc;
 159        b = (v << 3) & 0xf8;
 160        ((PIXEL_TYPE *) d)[0] = glue(rgb_to_pixel, DEPTH)(r, g, b);
 161        s += 2;
 162        d += BPP;
 163    } while (-- width != 0);
 164#endif
 165}
 166
 167#undef DEPTH
 168#undef BPP
 169#undef PIXEL_TYPE
 170