[profile/ivi/pixman.git] / pixman / pixman-access.c

/*
 *
 * Copyright © 2000 Keith Packard, member of The XFree86 Project, Inc.
 *             2005 Lars Knoll & Zack Rusin, Trolltech
 *             2008 Aaron Plattner, NVIDIA Corporation
 *
 * Permission to use, copy, modify, distribute, and sell this software and its
 * documentation for any purpose is hereby granted without fee, provided that
 * the above copyright notice appear in all copies and that both that
 * copyright notice and this permission notice appear in supporting
 * documentation, and that the name of Keith Packard not be used in
 * advertising or publicity pertaining to distribution of the software without
 * specific, written prior permission.  Keith Packard makes no
 * representations about the suitability of this software for any purpose.  It
 * is provided "as is" without express or implied warranty.
 *
 * THE COPYRIGHT HOLDERS DISCLAIM ALL WARRANTIES WITH REGARD TO THIS
 * SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND
 * FITNESS, IN NO EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY
 * SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
 * AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING
 * OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS
 * SOFTWARE.
 */

#ifdef HAVE_CONFIG_H
#include <config.h>
#endif

#include <stdlib.h>
#include <string.h>
#include <assert.h>

#include "pixman-private.h"
#include "pixman-accessor.h"

#define CvtR8G8B8toY15(s)       (((((s) >> 16) & 0xff) * 153 + \
                                  (((s) >>  8) & 0xff) * 301 +          \
                                  (((s)      ) & 0xff) * 58) >> 2)
#define miCvtR8G8B8to15(s) ((((s) >> 3) & 0x001f) |  \
                            (((s) >> 6) & 0x03e0) |  \
                            (((s) >> 9) & 0x7c00))
#define miIndexToEnt15(mif,rgb15) ((mif)->ent[rgb15])
#define miIndexToEnt24(mif,rgb24) miIndexToEnt15(mif,miCvtR8G8B8to15(rgb24))

#define miIndexToEntY24(mif,rgb24) ((mif)->ent[CvtR8G8B8toY15(rgb24)])

/*
 * YV12 setup and access macros
 */

#define YV12_SETUP(pict) \
        uint32_t *bits = pict->bits; \
        int stride = pict->rowstride; \
        int offset0 = stride < 0 ? \
                ((-stride) >> 1) * ((pict->height - 1) >> 1) - stride : \
                stride * pict->height; \
        int offset1 = stride < 0 ? \
                offset0 + ((-stride) >> 1) * ((pict->height) >> 1) : \
                offset0 + (offset0 >> 2)
/* Note no trailing semicolon on the above macro; if it's there, then
 * the typical usage of YV12_SETUP(pict); will have an extra trailing ;
 * that some compilers will interpret as a statement -- and then any further
 * variable declarations will cause an error.
 */

#define YV12_Y(line)            \
    ((uint8_t *) ((bits) + (stride) * (line)))

#define YV12_U(line)          \
    ((uint8_t *) ((bits) + offset1 + \
                ((stride) >> 1) * ((line) >> 1)))

#define YV12_V(line)          \
    ((uint8_t *) ((bits) + offset0 + \
                ((stride) >> 1) * ((line) >> 1)))

/*********************************** Fetch ************************************/

static void
fbFetch_a8r8g8b8 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    MEMCPY_WRAPPED(pict,
                   buffer, (const uint32_t *)bits + x,
                   width*sizeof(uint32_t));
}

static void
fbFetch_x8r8g8b8 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint32_t *pixel = (const uint32_t *)bits + x;
    const uint32_t *end = pixel + width;
    while (pixel < end) {
        *buffer++ = READ(pict, pixel++) | 0xff000000;
    }
}

static void
fbFetch_a8b8g8r8 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint32_t *pixel = (uint32_t *)bits + x;
    const uint32_t *end = pixel + width;
    while (pixel < end) {
        uint32_t p = READ(pict, pixel++);
        *buffer++ = (p & 0xff00ff00) |
                    ((p >> 16) & 0xff) |
            ((p & 0xff) << 16);
    }
}

static void
fbFetch_x8b8g8r8 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint32_t *pixel = (uint32_t *)bits + x;
    const uint32_t *end = pixel + width;
    while (pixel < end) {
        uint32_t p = READ(pict, pixel++);
        *buffer++ = 0xff000000 |
            (p & 0x0000ff00) |
            ((p >> 16) & 0xff) |
            ((p & 0xff) << 16);
    }
}

static void
fbFetch_b8g8r8a8 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint32_t *pixel = (uint32_t *)bits + x;
    const uint32_t *end = pixel + width;
    while (pixel < end) {
        uint32_t p = READ(pict, pixel++);
        *buffer++ = ((p & 0xff000000) >> 24) |
            ((p & 0x00ff0000) >> 8) |
            ((p & 0x0000ff00) << 8) |
            ((p & 0x000000ff) << 24);
    }
}

static void
fbFetch_b8g8r8x8 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint32_t *pixel = (uint32_t *)bits + x;
    const uint32_t *end = pixel + width;
    while (pixel < end) {
        uint32_t p = READ(pict, pixel++);
        *buffer++ = 0xff000000 |
            ((p & 0xff000000) >> 24) |
            ((p & 0x00ff0000) >> 8) |
            ((p & 0x0000ff00) << 8);
    }
}

static void
fbFetch_a2b10g10r10 (bits_image_t *pict, int x, int y, int width, uint64_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint32_t *pixel = bits + x;
    const uint32_t *end = pixel + width;
    while (pixel < end) {
        uint32_t p = READ(pict, pixel++);
        uint64_t a = p >> 30;
        uint64_t b = (p >> 20) & 0x3ff;
        uint64_t g = (p >> 10) & 0x3ff;
        uint64_t r = p & 0x3ff;

        r = r << 6 | r >> 4;
        g = g << 6 | g >> 4;
        b = b << 6 | b >> 4;

        a <<= 62;
        a |= a >> 2;
        a |= a >> 4;
        a |= a >> 8;

        *buffer++ = a << 48 | r << 32 | g << 16 | b;
    }
}

static void
fbFetch_x2b10g10r10 (bits_image_t *pict, int x, int y, int width, uint64_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint32_t *pixel = (uint32_t *)bits + x;
    const uint32_t *end = pixel + width;
    while (pixel < end) {
        uint32_t p = READ(pict, pixel++);
        uint64_t b = (p >> 20) & 0x3ff;
        uint64_t g = (p >> 10) & 0x3ff;
        uint64_t r = p & 0x3ff;

        r = r << 6 | r >> 4;
        g = g << 6 | g >> 4;
        b = b << 6 | b >> 4;

        *buffer++ = 0xffffULL << 48 | r << 32 | g << 16 | b;
    }
}

static void
fbFetch_r8g8b8 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint8_t *pixel = (const uint8_t *)bits + 3*x;
    const uint8_t *end = pixel + 3*width;
    while (pixel < end) {
        uint32_t b = 0xff000000;
#ifdef WORDS_BIGENDIAN
        b |= (READ(pict, pixel++) << 16);
        b |= (READ(pict, pixel++) << 8);
        b |= (READ(pict, pixel++));
#else
        b |= (READ(pict, pixel++));
        b |= (READ(pict, pixel++) << 8);
        b |= (READ(pict, pixel++) << 16);
#endif
        *buffer++ = b;
    }
}

static void
fbFetch_b8g8r8 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint8_t *pixel = (const uint8_t *)bits + 3*x;
    const uint8_t *end = pixel + 3*width;
    while (pixel < end) {
        uint32_t b = 0xff000000;
#ifdef WORDS_BIGENDIAN
        b |= (READ(pict, pixel++));
        b |= (READ(pict, pixel++) << 8);
        b |= (READ(pict, pixel++) << 16);
#else
        b |= (READ(pict, pixel++) << 16);
        b |= (READ(pict, pixel++) << 8);
        b |= (READ(pict, pixel++));
#endif
        *buffer++ = b;
    }
}

static void
fbFetch_r5g6b5 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint16_t *pixel = (const uint16_t *)bits + x;
    const uint16_t *end = pixel + width;
    while (pixel < end) {
        uint32_t p = READ(pict, pixel++);
        uint32_t r = (((p) << 3) & 0xf8) |
            (((p) << 5) & 0xfc00) |
            (((p) << 8) & 0xf80000);
        r |= (r >> 5) & 0x70007;
        r |= (r >> 6) & 0x300;
        *buffer++ = 0xff000000 | r;
    }
}

static void
fbFetch_b5g6r5 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint16_t *pixel = (const uint16_t *)bits + x;
    const uint16_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);
        b = ((p & 0xf800) | ((p & 0xe000) >> 5)) >> 8;
        g = ((p & 0x07e0) | ((p & 0x0600) >> 6)) << 5;
        r = ((p & 0x001c) | ((p & 0x001f) << 5)) << 14;
        *buffer++ = 0xff000000 | r | g | b;
    }
}

static void
fbFetch_a1r5g5b5 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b, a;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint16_t *pixel = (const uint16_t *)bits + x;
    const uint16_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);

        a = (uint32_t) ((uint8_t) (0 - ((p & 0x8000) >> 15))) << 24;
        r = ((p & 0x7c00) | ((p & 0x7000) >> 5)) << 9;
        g = ((p & 0x03e0) | ((p & 0x0380) >> 5)) << 6;
        b = ((p & 0x001c) | ((p & 0x001f) << 5)) >> 2;
        *buffer++ = a | r | g | b;
    }
}

static void
fbFetch_x1r5g5b5 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint16_t *pixel = (const uint16_t *)bits + x;
    const uint16_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);

        r = ((p & 0x7c00) | ((p & 0x7000) >> 5)) << 9;
        g = ((p & 0x03e0) | ((p & 0x0380) >> 5)) << 6;
        b = ((p & 0x001c) | ((p & 0x001f) << 5)) >> 2;
        *buffer++ = 0xff000000 | r | g | b;
    }
}

static void
fbFetch_a1b5g5r5 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b, a;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint16_t *pixel = (const uint16_t *)bits + x;
    const uint16_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);

        a = (uint32_t) ((uint8_t) (0 - ((p & 0x8000) >> 15))) << 24;
        b = ((p & 0x7c00) | ((p & 0x7000) >> 5)) >> 7;
        g = ((p & 0x03e0) | ((p & 0x0380) >> 5)) << 6;
        r = ((p & 0x001c) | ((p & 0x001f) << 5)) << 14;
        *buffer++ = a | r | g | b;
    }
}

static void
fbFetch_x1b5g5r5 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint16_t *pixel = (const uint16_t *)bits + x;
    const uint16_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);

        b = ((p & 0x7c00) | ((p & 0x7000) >> 5)) >> 7;
        g = ((p & 0x03e0) | ((p & 0x0380) >> 5)) << 6;
        r = ((p & 0x001c) | ((p & 0x001f) << 5)) << 14;
        *buffer++ = 0xff000000 | r | g | b;
    }
}

static void
fbFetch_a4r4g4b4 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b, a;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint16_t *pixel = (const uint16_t *)bits + x;
    const uint16_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);

        a = ((p & 0xf000) | ((p & 0xf000) >> 4)) << 16;
        r = ((p & 0x0f00) | ((p & 0x0f00) >> 4)) << 12;
        g = ((p & 0x00f0) | ((p & 0x00f0) >> 4)) << 8;
        b = ((p & 0x000f) | ((p & 0x000f) << 4));
        *buffer++ = a | r | g | b;
    }
}

static void
fbFetch_x4r4g4b4 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint16_t *pixel = (const uint16_t *)bits + x;
    const uint16_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);

        r = ((p & 0x0f00) | ((p & 0x0f00) >> 4)) << 12;
        g = ((p & 0x00f0) | ((p & 0x00f0) >> 4)) << 8;
        b = ((p & 0x000f) | ((p & 0x000f) << 4));
        *buffer++ = 0xff000000 | r | g | b;
    }
}

static void
fbFetch_a4b4g4r4 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b, a;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint16_t *pixel = (const uint16_t *)bits + x;
    const uint16_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);

        a = ((p & 0xf000) | ((p & 0xf000) >> 4)) << 16;
        b = ((p & 0x0f00) | ((p & 0x0f00) >> 4)) >> 4;
        g = ((p & 0x00f0) | ((p & 0x00f0) >> 4)) << 8;
        r = ((p & 0x000f) | ((p & 0x000f) << 4)) << 16;
        *buffer++ = a | r | g | b;
    }
}

static void
fbFetch_x4b4g4r4 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint16_t *pixel = (const uint16_t *)bits + x;
    const uint16_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);

        b = ((p & 0x0f00) | ((p & 0x0f00) >> 4)) >> 4;
        g = ((p & 0x00f0) | ((p & 0x00f0) >> 4)) << 8;
        r = ((p & 0x000f) | ((p & 0x000f) << 4)) << 16;
        *buffer++ = 0xff000000 | r | g | b;
    }
}

static void
fbFetch_a8 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint8_t *pixel = (const uint8_t *)bits + x;
    const uint8_t *end = pixel + width;
    while (pixel < end) {
        *buffer++ = READ(pict, pixel++) << 24;
    }
}

static void
fbFetch_r3g3b2 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint8_t *pixel = (const uint8_t *)bits + x;
    const uint8_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);

        r = ((p & 0xe0) | ((p & 0xe0) >> 3) | ((p & 0xc0) >> 6)) << 16;
        g = ((p & 0x1c) | ((p & 0x18) >> 3) | ((p & 0x1c) << 3)) << 8;
        b = (((p & 0x03)     ) |
             ((p & 0x03) << 2) |
             ((p & 0x03) << 4) |
             ((p & 0x03) << 6));
        *buffer++ = 0xff000000 | r | g | b;
    }
}

static void
fbFetch_b2g3r3 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint8_t *pixel = (const uint8_t *)bits + x;
    const uint8_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);

        b = (((p & 0xc0)     ) |
             ((p & 0xc0) >> 2) |
             ((p & 0xc0) >> 4) |
             ((p & 0xc0) >> 6));
        g = ((p & 0x38) | ((p & 0x38) >> 3) | ((p & 0x30) << 2)) << 8;
        r = (((p & 0x07)     ) |
             ((p & 0x07) << 3) |
             ((p & 0x06) << 6)) << 16;
        *buffer++ = 0xff000000 | r | g | b;
    }
}

static void
fbFetch_a2r2g2b2 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t   a,r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint8_t *pixel = (const uint8_t *)bits + x;
    const uint8_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);

        a = ((p & 0xc0) * 0x55) << 18;
        r = ((p & 0x30) * 0x55) << 12;
        g = ((p & 0x0c) * 0x55) << 6;
        b = ((p & 0x03) * 0x55);
        *buffer++ = a|r|g|b;
    }
}

static void
fbFetch_a2b2g2r2 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t   a,r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint8_t *pixel = (const uint8_t *)bits + x;
    const uint8_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);

        a = ((p & 0xc0) * 0x55) << 18;
        b = ((p & 0x30) * 0x55) >> 6;
        g = ((p & 0x0c) * 0x55) << 6;
        r = ((p & 0x03) * 0x55) << 16;
        *buffer++ = a|r|g|b;
    }
}

static void
fbFetch_c8 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const pixman_indexed_t * indexed = pict->indexed;
    const uint8_t *pixel = (const uint8_t *)bits + x;
    const uint8_t *end = pixel + width;
    while (pixel < end) {
        uint32_t  p = READ(pict, pixel++);
        *buffer++ = indexed->rgba[p];
    }
}

static void
fbFetch_x4a4 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const uint8_t *pixel = (const uint8_t *)bits + x;
    const uint8_t *end = pixel + width;
    while (pixel < end) {
        uint8_t p = READ(pict, pixel++) & 0xf;
        *buffer++ = (p | (p << 4)) << 24;
    }
}

#define Fetch8(img,l,o)    (READ(img, (uint8_t *)(l) + ((o) >> 2)))
#ifdef WORDS_BIGENDIAN
#define Fetch4(img,l,o)    ((o) & 2 ? Fetch8(img,l,o) & 0xf : Fetch8(img,l,o) >> 4)
#else
#define Fetch4(img,l,o)    ((o) & 2 ? Fetch8(img,l,o) >> 4 : Fetch8(img,l,o) & 0xf)
#endif

static void
fbFetch_a4 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t  p = Fetch4(pict, bits, i + x);

        p |= p << 4;
        *buffer++ = p << 24;
    }
}

static void
fbFetch_r1g2b1 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t  p = Fetch4(pict, bits, i + x);

        r = ((p & 0x8) * 0xff) << 13;
        g = ((p & 0x6) * 0x55) << 7;
        b = ((p & 0x1) * 0xff);
        *buffer++ = 0xff000000|r|g|b;
    }
}

static void
fbFetch_b1g2r1 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t  p = Fetch4(pict, bits, i + x);

        b = ((p & 0x8) * 0xff) >> 3;
        g = ((p & 0x6) * 0x55) << 7;
        r = ((p & 0x1) * 0xff) << 16;
        *buffer++ = 0xff000000|r|g|b;
    }
}

static void
fbFetch_a1r1g1b1 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  a,r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t  p = Fetch4(pict, bits, i + x);

        a = ((p & 0x8) * 0xff) << 21;
        r = ((p & 0x4) * 0xff) << 14;
        g = ((p & 0x2) * 0xff) << 7;
        b = ((p & 0x1) * 0xff);
        *buffer++ = a|r|g|b;
    }
}

static void
fbFetch_a1b1g1r1 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    uint32_t  a,r,g,b;
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t  p = Fetch4(pict, bits, i + x);

        a = ((p & 0x8) * 0xff) << 21;
        r = ((p & 0x4) * 0xff) >> 3;
        g = ((p & 0x2) * 0xff) << 7;
        b = ((p & 0x1) * 0xff) << 16;
        *buffer++ = a|r|g|b;
    }
}

static void
fbFetch_c4 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const pixman_indexed_t * indexed = pict->indexed;
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t  p = Fetch4(pict, bits, i + x);

        *buffer++ = indexed->rgba[p];
    }
}


static void
fbFetch_a1 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t  p = READ(pict, bits + ((i + x) >> 5));
        uint32_t  a;
#ifdef WORDS_BIGENDIAN
        a = p >> (0x1f - ((i+x) & 0x1f));
#else
        a = p >> ((i+x) & 0x1f);
#endif
        a = a & 1;
        a |= a << 1;
        a |= a << 2;
        a |= a << 4;
        *buffer++ = a << 24;
    }
}

static void
fbFetch_g1 (bits_image_t *pict, int x, int y, int width, uint32_t *buffer)
{
    const uint32_t *bits = pict->bits + y*pict->rowstride;
    const pixman_indexed_t * indexed = pict->indexed;
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t p = READ(pict, bits + ((i+x) >> 5));
        uint32_t a;
#ifdef WORDS_BIGENDIAN
        a = p >> (0x1f - ((i+x) & 0x1f));
#else
        a = p >> ((i+x) & 0x1f);
#endif
        a = a & 1;
        *buffer++ = indexed->rgba[a];
    }
}

static void
fbFetch_yuy2 (bits_image_t *pict, int x, int line, int width, uint32_t *buffer)
{
    int16_t y, u, v;
    int32_t r, g, b;
    int   i;

    const uint32_t *bits = pict->bits + pict->rowstride * line;

    for (i = 0; i < width; i++)
    {
        y = ((uint8_t *) bits)[(x + i) << 1] - 16;
        u = ((uint8_t *) bits)[(((x + i) << 1) & -4) + 1] - 128;
        v = ((uint8_t *) bits)[(((x + i) << 1) & -4) + 3] - 128;

        /* R = 1.164(Y - 16) + 1.596(V - 128) */
        r = 0x012b27 * y + 0x019a2e * v;
        /* G = 1.164(Y - 16) - 0.813(V - 128) - 0.391(U - 128) */
        g = 0x012b27 * y - 0x00d0f2 * v - 0x00647e * u;
        /* B = 1.164(Y - 16) + 2.018(U - 128) */
        b = 0x012b27 * y + 0x0206a2 * u;

        WRITE(pict, buffer++, 0xff000000 |
              (r >= 0 ? r < 0x1000000 ? r         & 0xff0000 : 0xff0000 : 0) |
              (g >= 0 ? g < 0x1000000 ? (g >> 8)  & 0x00ff00 : 0x00ff00 : 0) |
              (b >= 0 ? b < 0x1000000 ? (b >> 16) & 0x0000ff : 0x0000ff : 0));
    }
}

static void
fbFetch_yv12 (bits_image_t *pict, int x, int line, int width, uint32_t *buffer)
{
    YV12_SETUP(pict);
    uint8_t *pY = YV12_Y (line);
    uint8_t *pU = YV12_U (line);
    uint8_t *pV = YV12_V (line);
    int16_t y, u, v;
    int32_t r, g, b;
    int   i;

    for (i = 0; i < width; i++)
    {
        y = pY[x + i] - 16;
        u = pU[(x + i) >> 1] - 128;
        v = pV[(x + i) >> 1] - 128;

        /* R = 1.164(Y - 16) + 1.596(V - 128) */
        r = 0x012b27 * y + 0x019a2e * v;
        /* G = 1.164(Y - 16) - 0.813(V - 128) - 0.391(U - 128) */
        g = 0x012b27 * y - 0x00d0f2 * v - 0x00647e * u;
        /* B = 1.164(Y - 16) + 2.018(U - 128) */
        b = 0x012b27 * y + 0x0206a2 * u;

        WRITE(pict, buffer++, 0xff000000 |
            (r >= 0 ? r < 0x1000000 ? r         & 0xff0000 : 0xff0000 : 0) |
            (g >= 0 ? g < 0x1000000 ? (g >> 8)  & 0x00ff00 : 0x00ff00 : 0) |
            (b >= 0 ? b < 0x1000000 ? (b >> 16) & 0x0000ff : 0x0000ff : 0));
    }
}

/**************************** Pixel wise fetching *****************************/

static void
fbFetchPixel_a2b10g10r10 (bits_image_t *pict, uint64_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = ((uint32_t *)buffer)[2 * i];
        int line = ((uint32_t *)buffer)[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t p = READ(pict, bits + offset);
            uint64_t a = p >> 30;
            uint64_t b = (p >> 20) & 0x3ff;
            uint64_t g = (p >> 10) & 0x3ff;
            uint64_t r = p & 0x3ff;
            
            r = r << 6 | r >> 4;
            g = g << 6 | g >> 4;
            b = b << 6 | b >> 4;
            
            a <<= 62;
            a |= a >> 2;
            a |= a >> 4;
            a |= a >> 8;
            
            buffer[i] = a << 48 | r << 32 | g << 16 | b;
        }
    }
}

static void
fbFetchPixel_x2b10g10r10 (bits_image_t *pict, uint64_t *buffer, int n_pixels)
{
    int i;
    
    for (i = 0; i < n_pixels; ++i)
    {
        int offset = ((uint32_t *)buffer)[2 * i];
        int line = ((uint32_t *)buffer)[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t p = READ(pict, bits + offset);
            uint64_t b = (p >> 20) & 0x3ff;
            uint64_t g = (p >> 10) & 0x3ff;
            uint64_t r = p & 0x3ff;
            
            r = r << 6 | r >> 4;
            g = g << 6 | g >> 4;
            b = b << 6 | b >> 4;
            
            buffer[i] = 0xffffULL << 48 | r << 32 | g << 16 | b;
        }
    }
}

static void
fbFetchPixel_a8r8g8b8 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;
    
    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];
        
        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            buffer[i] = READ(pict, (uint32_t *)bits + offset);
        }
    }
}

static void
fbFetchPixel_x8r8g8b8 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;
    
    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];
        
        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            buffer[i] = READ(pict, (uint32_t *)bits + offset) | 0xff000000;
        }
    }
}

static void
fbFetchPixel_a8b8g8r8 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;
    
    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];
        
        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint32_t *)bits + offset);
            
            buffer[i] = ((pixel & 0xff000000) |
                         ((pixel >> 16) & 0xff) |
                         (pixel & 0x0000ff00) |
                         ((pixel & 0xff) << 16));
        }
    }
}

static void
fbFetchPixel_x8b8g8r8 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;
    
    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];
        
        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint32_t *)bits + offset);
            
            buffer[i] = ((0xff000000) |
                         ((pixel >> 16) & 0xff) |
                         (pixel & 0x0000ff00) |
                         ((pixel & 0xff) << 16));
        }
    }
}

static void
fbFetchPixel_b8g8r8a8 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint32_t *)bits + offset);
            
            buffer[i] = ((pixel & 0xff000000) >> 24 |
                         (pixel & 0x00ff0000) >> 8 |
                         (pixel & 0x0000ff00) << 8 |
                         (pixel & 0x000000ff) << 24);
        }
    }
}

static void
fbFetchPixel_b8g8r8x8 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];
        
        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint32_t *)bits + offset);
            
            buffer[i] = ((0xff000000) |
                         (pixel & 0xff000000) >> 24 |
                         (pixel & 0x00ff0000) >> 8 |
                         (pixel & 0x0000ff00) << 8);
        }
    }
}

static void
fbFetchPixel_r8g8b8 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint8_t   *pixel = ((uint8_t *) bits) + (offset*3);
#ifdef WORDS_BIGENDIAN
            buffer[i] = (0xff000000 |
                         (READ(pict, pixel + 0) << 16) |
                         (READ(pict, pixel + 1) << 8) |
                         (READ(pict, pixel + 2)));
#else
            buffer[i] = (0xff000000 |
                         (READ(pict, pixel + 2) << 16) |
                         (READ(pict, pixel + 1) << 8) |
                         (READ(pict, pixel + 0)));
#endif
        }
    }
}

static void
fbFetchPixel_b8g8r8 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint8_t   *pixel = ((uint8_t *) bits) + (offset*3);
#ifdef WORDS_BIGENDIAN
            buffer[i] = (0xff000000 |
                         (READ(pict, pixel + 2) << 16) |
                         (READ(pict, pixel + 1) << 8) |
                         (READ(pict, pixel + 0)));
#else
            buffer[i] = (0xff000000 |
                         (READ(pict, pixel + 0) << 16) |
                         (READ(pict, pixel + 1) << 8) |
                         (READ(pict, pixel + 2)));
#endif
        }
    }
}

static void
fbFetchPixel_r5g6b5 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint16_t *) bits + offset);
            
            r = ((pixel & 0xf800) | ((pixel & 0xe000) >> 5)) << 8;
            g = ((pixel & 0x07e0) | ((pixel & 0x0600) >> 6)) << 5;
            b = ((pixel & 0x001c) | ((pixel & 0x001f) << 5)) >> 2;
            buffer[i] = (0xff000000 | r | g | b);
        }
    }
}

static void
fbFetchPixel_b5g6r5 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint16_t *) bits + offset);
            
            b = ((pixel & 0xf800) | ((pixel & 0xe000) >> 5)) >> 8;
            g = ((pixel & 0x07e0) | ((pixel & 0x0600) >> 6)) << 5;
            r = ((pixel & 0x001c) | ((pixel & 0x001f) << 5)) << 14;
            buffer[i] = (0xff000000 | r | g | b);
        }
    }
}

static void
fbFetchPixel_a1r5g5b5 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  a,r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint16_t *) bits + offset);
            
            a = (uint32_t) ((uint8_t) (0 - ((pixel & 0x8000) >> 15))) << 24;
            r = ((pixel & 0x7c00) | ((pixel & 0x7000) >> 5)) << 9;
            g = ((pixel & 0x03e0) | ((pixel & 0x0380) >> 5)) << 6;
            b = ((pixel & 0x001c) | ((pixel & 0x001f) << 5)) >> 2;
            buffer[i] = (a | r | g | b);
        }
    }
}

static void
fbFetchPixel_x1r5g5b5 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint16_t *) bits + offset);
            
            r = ((pixel & 0x7c00) | ((pixel & 0x7000) >> 5)) << 9;
            g = ((pixel & 0x03e0) | ((pixel & 0x0380) >> 5)) << 6;
            b = ((pixel & 0x001c) | ((pixel & 0x001f) << 5)) >> 2;
            buffer[i] = (0xff000000 | r | g | b);
        }
    }
}

static void
fbFetchPixel_a1b5g5r5 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  a,r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint16_t *) bits + offset);
            
            a = (uint32_t) ((uint8_t) (0 - ((pixel & 0x8000) >> 15))) << 24;
            b = ((pixel & 0x7c00) | ((pixel & 0x7000) >> 5)) >> 7;
            g = ((pixel & 0x03e0) | ((pixel & 0x0380) >> 5)) << 6;
            r = ((pixel & 0x001c) | ((pixel & 0x001f) << 5)) << 14;
            buffer[i] = (a | r | g | b);
        }
    }
}

static void
fbFetchPixel_x1b5g5r5 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint16_t *) bits + offset);
            
            b = ((pixel & 0x7c00) | ((pixel & 0x7000) >> 5)) >> 7;
            g = ((pixel & 0x03e0) | ((pixel & 0x0380) >> 5)) << 6;
            r = ((pixel & 0x001c) | ((pixel & 0x001f) << 5)) << 14;
            buffer[i] = (0xff000000 | r | g | b);
        }
    }
}

static void
fbFetchPixel_a4r4g4b4 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  a,r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint16_t *) bits + offset);
            
            a = ((pixel & 0xf000) | ((pixel & 0xf000) >> 4)) << 16;
            r = ((pixel & 0x0f00) | ((pixel & 0x0f00) >> 4)) << 12;
            g = ((pixel & 0x00f0) | ((pixel & 0x00f0) >> 4)) << 8;
            b = ((pixel & 0x000f) | ((pixel & 0x000f) << 4));
            buffer[i] = (a | r | g | b);
        }
    }
}

static void
fbFetchPixel_x4r4g4b4 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint16_t *) bits + offset);
            
            r = ((pixel & 0x0f00) | ((pixel & 0x0f00) >> 4)) << 12;
            g = ((pixel & 0x00f0) | ((pixel & 0x00f0) >> 4)) << 8;
            b = ((pixel & 0x000f) | ((pixel & 0x000f) << 4));
            buffer[i] = (0xff000000 | r | g | b);
        }
    }
}

static void
fbFetchPixel_a4b4g4r4 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  a,r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint16_t *) bits + offset);
            
            a = ((pixel & 0xf000) | ((pixel & 0xf000) >> 4)) << 16;
            b = ((pixel & 0x0f00) | ((pixel & 0x0f00) >> 4)) >> 4;
            g = ((pixel & 0x00f0) | ((pixel & 0x00f0) >> 4)) << 8;
            r = ((pixel & 0x000f) | ((pixel & 0x000f) << 4)) << 16;
            buffer[i] = (a | r | g | b);
        }
    }
}

static void
fbFetchPixel_x4b4g4r4 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, (uint16_t *) bits + offset);
            
            b = ((pixel & 0x0f00) | ((pixel & 0x0f00) >> 4)) >> 4;
            g = ((pixel & 0x00f0) | ((pixel & 0x00f0) >> 4)) << 8;
            r = ((pixel & 0x000f) | ((pixel & 0x000f) << 4)) << 16;
            buffer[i] = (0xff000000 | r | g | b);
        }
    }
}

static void
fbFetchPixel_a8 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t   pixel = READ(pict, (uint8_t *) bits + offset);
            
            buffer[i] = pixel << 24;
        }
    }
}

static void
fbFetchPixel_r3g3b2 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t   pixel = READ(pict, (uint8_t *) bits + offset);
            
            r = ((pixel & 0xe0) | ((pixel & 0xe0) >> 3) | ((pixel & 0xc0) >> 6)) << 16;
            g = ((pixel & 0x1c) | ((pixel & 0x18) >> 3) | ((pixel & 0x1c) << 3)) << 8;
            b = (((pixel & 0x03)     ) |
                 ((pixel & 0x03) << 2) |
                 ((pixel & 0x03) << 4) |
                 ((pixel & 0x03) << 6));
            buffer[i] = (0xff000000 | r | g | b);
        }
    }
}

static void
fbFetchPixel_b2g3r3 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t   pixel = READ(pict, (uint8_t *) bits + offset);
            
            b = (((pixel & 0xc0)     ) |
                 ((pixel & 0xc0) >> 2) |
                 ((pixel & 0xc0) >> 4) |
                 ((pixel & 0xc0) >> 6));
            g = ((pixel & 0x38) | ((pixel & 0x38) >> 3) | ((pixel & 0x30) << 2)) << 8;
            r = (((pixel & 0x07)     ) |
                 ((pixel & 0x07) << 3) |
                 ((pixel & 0x06) << 6)) << 16;
            buffer[i] = (0xff000000 | r | g | b);
        }
    }
}

static void
fbFetchPixel_a2r2g2b2 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t   a,r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t   pixel = READ(pict, (uint8_t *) bits + offset);
            
            a = ((pixel & 0xc0) * 0x55) << 18;
            r = ((pixel & 0x30) * 0x55) << 12;
            g = ((pixel & 0x0c) * 0x55) << 6;
            b = ((pixel & 0x03) * 0x55);
            buffer[i] = a|r|g|b;
        }
    }
}

static void
fbFetchPixel_a2b2g2r2 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t   a,r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t   pixel = READ(pict, (uint8_t *) bits + offset);
            
            a = ((pixel & 0xc0) * 0x55) << 18;
            b = ((pixel & 0x30) * 0x55) >> 6;
            g = ((pixel & 0x0c) * 0x55) << 6;
            r = ((pixel & 0x03) * 0x55) << 16;
            buffer[i] = a|r|g|b;
        }
    }
}

static void
fbFetchPixel_c8 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t   pixel = READ(pict, (uint8_t *) bits + offset);
            const pixman_indexed_t * indexed = pict->indexed;
            buffer[i] = indexed->rgba[pixel];
        }
    }
}

static void
fbFetchPixel_x4a4 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t   pixel = READ(pict, (uint8_t *) bits + offset);
            
            buffer[i] = ((pixel & 0xf) | ((pixel & 0xf) << 4)) << 24;
        }
    }
}

static void
fbFetchPixel_a4 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = Fetch4(pict, bits, offset);
            
            pixel |= pixel << 4;
            buffer[i] = pixel << 24;
        }
    }
}

static void
fbFetchPixel_r1g2b1 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];
        
        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = Fetch4(pict, bits, offset);
            
            r = ((pixel & 0x8) * 0xff) << 13;
            g = ((pixel & 0x6) * 0x55) << 7;
            b = ((pixel & 0x1) * 0xff);
            buffer[i] = 0xff000000|r|g|b;
        }
    }
}

static void
fbFetchPixel_b1g2r1 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = Fetch4(pict, bits, offset);
            
            b = ((pixel & 0x8) * 0xff) >> 3;
            g = ((pixel & 0x6) * 0x55) << 7;
            r = ((pixel & 0x1) * 0xff) << 16;
            buffer[i] = 0xff000000|r|g|b;
        }
    }
}

static void
fbFetchPixel_a1r1g1b1 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  a,r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = Fetch4(pict, bits, offset);
            
            a = ((pixel & 0x8) * 0xff) << 21;
            r = ((pixel & 0x4) * 0xff) << 14;
            g = ((pixel & 0x2) * 0xff) << 7;
            b = ((pixel & 0x1) * 0xff);
            buffer[i] = a|r|g|b;
        }
    }
}

static void
fbFetchPixel_a1b1g1r1 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t  a,r,g,b;
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = Fetch4(pict, bits, offset);
            
            a = ((pixel & 0x8) * 0xff) << 21;
            r = ((pixel & 0x4) * 0xff) >> 3;
            g = ((pixel & 0x2) * 0xff) << 7;
            b = ((pixel & 0x1) * 0xff) << 16;
            buffer[i] = a|r|g|b;
        }
    }
}

static void
fbFetchPixel_c4 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = Fetch4(pict, bits, offset);
            const pixman_indexed_t * indexed = pict->indexed;
            
            buffer[i] = indexed->rgba[pixel];
        }
    }
}


static void
fbFetchPixel_a1 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t  pixel = READ(pict, bits + (offset >> 5));
            uint32_t  a;
#ifdef WORDS_BIGENDIAN
            a = pixel >> (0x1f - (offset & 0x1f));
#else
            a = pixel >> (offset & 0x1f);
#endif
            a = a & 1;
            a |= a << 1;
            a |= a << 2;
            a |= a << 4;
            buffer[i] = a << 24;
        }
    }
}

static void
fbFetchPixel_g1 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            uint32_t *bits = pict->bits + line*pict->rowstride;
            uint32_t pixel = READ(pict, bits + (offset >> 5));
            const pixman_indexed_t * indexed = pict->indexed;
            uint32_t a;
#ifdef WORDS_BIGENDIAN
            a = pixel >> (0x1f - (offset & 0x1f));
#else
            a = pixel >> (offset & 0x1f);
#endif
            a = a & 1;
            buffer[i] = indexed->rgba[a];
        }
    }
}

static void
fbFetchPixel_yuy2 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            int16_t y, u, v;
            int32_t r, g, b;
            
            const uint32_t *bits = pict->bits + pict->rowstride * line;
            
            y = ((uint8_t *) bits)[offset << 1] - 16;
            u = ((uint8_t *) bits)[((offset << 1) & -4) + 1] - 128;
            v = ((uint8_t *) bits)[((offset << 1) & -4) + 3] - 128;
            
            /* R = 1.164(Y - 16) + 1.596(V - 128) */
            r = 0x012b27 * y + 0x019a2e * v;
            /* G = 1.164(Y - 16) - 0.813(V - 128) - 0.391(U - 128) */
            g = 0x012b27 * y - 0x00d0f2 * v - 0x00647e * u;
            /* B = 1.164(Y - 16) + 2.018(U - 128) */
            b = 0x012b27 * y + 0x0206a2 * u;
            
            buffer[i] = 0xff000000 |
                (r >= 0 ? r < 0x1000000 ? r         & 0xff0000 : 0xff0000 : 0) |
                (g >= 0 ? g < 0x1000000 ? (g >> 8)  & 0x00ff00 : 0x00ff00 : 0) |
                (b >= 0 ? b < 0x1000000 ? (b >> 16) & 0x0000ff : 0x0000ff : 0);
        }
    }
}

static void
fbFetchPixel_yv12 (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    int i;

    for (i = 0; i < n_pixels; ++i)
    {
        int offset = buffer[2 * i];
        int line = buffer[2 * i + 1];

        if (offset == 0xffffffff || line == 0xffffffff)
        {
            buffer[i] = 0;
        }
        else
        {
            YV12_SETUP(pict);
            int16_t y = YV12_Y (line)[offset] - 16;
            int16_t u = YV12_U (line)[offset >> 1] - 128;
            int16_t v = YV12_V (line)[offset >> 1] - 128;
            int32_t r, g, b;
            
            /* R = 1.164(Y - 16) + 1.596(V - 128) */
            r = 0x012b27 * y + 0x019a2e * v;
            /* G = 1.164(Y - 16) - 0.813(V - 128) - 0.391(U - 128) */
            g = 0x012b27 * y - 0x00d0f2 * v - 0x00647e * u;
            /* B = 1.164(Y - 16) + 2.018(U - 128) */
            b = 0x012b27 * y + 0x0206a2 * u;
            
            buffer[i] = 0xff000000 |
                (r >= 0 ? r < 0x1000000 ? r         & 0xff0000 : 0xff0000 : 0) |
                (g >= 0 ? g < 0x1000000 ? (g >> 8)  & 0x00ff00 : 0x00ff00 : 0) |
                (b >= 0 ? b < 0x1000000 ? (b >> 16) & 0x0000ff : 0x0000ff : 0);
        }
    }
}

/*********************************** Store ************************************/

#define Splita(v)       uint32_t        a = ((v) >> 24), r = ((v) >> 16) & 0xff, g = ((v) >> 8) & 0xff, b = (v) & 0xff
#define Split(v)        uint32_t        r = ((v) >> 16) & 0xff, g = ((v) >> 8) & 0xff, b = (v) & 0xff

static void
fbStore_a2b10g10r10 (pixman_image_t *image,
                     uint32_t *bits, const uint64_t *values,
                     int x, int width)
{
    int i;
    uint32_t *pixel = bits + x;
    for (i = 0; i < width; ++i) {
        WRITE(image, pixel++,
            ((values[i] >> 32) & 0xc0000000) | // A
            ((values[i] >> 38) & 0x3ff) |      // R
            ((values[i] >> 12) & 0xffc00) |    // G
            ((values[i] << 14) & 0x3ff00000)); // B
    }
}

static void
fbStore_x2b10g10r10 (pixman_image_t *image,
                     uint32_t *bits, const uint64_t *values, int x, int width)
{
    int i;
    uint32_t *pixel = bits + x;
    for (i = 0; i < width; ++i) {
        WRITE(image, pixel++,
            ((values[i] >> 38) & 0x3ff) |      // R
            ((values[i] >> 12) & 0xffc00) |    // G
            ((values[i] << 14) & 0x3ff00000)); // B
    }
}

static void
fbStore_a8r8g8b8 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    MEMCPY_WRAPPED(image, ((uint32_t *)bits) + x, values, width*sizeof(uint32_t));
}

static void
fbStore_x8r8g8b8 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint32_t *pixel = (uint32_t *)bits + x;
    for (i = 0; i < width; ++i)
        WRITE(image, pixel++, values[i] & 0xffffff);
}

static void
fbStore_a8b8g8r8 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint32_t *pixel = (uint32_t *)bits + x;
    for (i = 0; i < width; ++i)
        WRITE(image, pixel++, (values[i] & 0xff00ff00) | ((values[i] >> 16) & 0xff) | ((values[i] & 0xff) << 16));
}

static void
fbStore_x8b8g8r8 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint32_t *pixel = (uint32_t *)bits + x;
    for (i = 0; i < width; ++i)
        WRITE(image, pixel++, (values[i] & 0x0000ff00) | ((values[i] >> 16) & 0xff) | ((values[i] & 0xff) << 16));
}

static void
fbStore_b8g8r8a8 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint32_t *pixel = (uint32_t *)bits + x;
    for (i = 0; i < width; ++i)
        WRITE(image, pixel++,
            ((values[i] >> 24) & 0x000000ff) |
            ((values[i] >>  8) & 0x0000ff00) |
            ((values[i] <<  8) & 0x00ff0000) |
            ((values[i] << 24) & 0xff000000));
}

static void
fbStore_b8g8r8x8 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint32_t *pixel = (uint32_t *)bits + x;
    for (i = 0; i < width; ++i)
        WRITE(image, pixel++,
            ((values[i] >>  8) & 0x0000ff00) |
            ((values[i] <<  8) & 0x00ff0000) |
            ((values[i] << 24) & 0xff000000));
}

static void
fbStore_r8g8b8 (pixman_image_t *image,
                uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint8_t *pixel = ((uint8_t *) bits) + 3*x;
    for (i = 0; i < width; ++i)
    {
        uint32_t val = values[i];
#ifdef WORDS_BIGENDIAN
        WRITE(image, pixel++, (val & 0x00ff0000) >> 16);
        WRITE(image, pixel++, (val & 0x0000ff00) >>  8);
        WRITE(image, pixel++, (val & 0x000000ff) >>  0);
#else
        WRITE(image, pixel++, (val & 0x000000ff) >>  0);
        WRITE(image, pixel++, (val & 0x0000ff00) >>  8);
        WRITE(image, pixel++, (val & 0x00ff0000) >> 16);
#endif
    }
}

static void
fbStore_b8g8r8 (pixman_image_t *image,
                uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint8_t *pixel = ((uint8_t *) bits) + 3*x;
    for (i = 0; i < width; ++i)
    {
        uint32_t val = values[i];
#ifdef WORDS_BIGENDIAN
        WRITE(image, pixel++, (val & 0x000000ff) >>  0);
        WRITE(image, pixel++, (val & 0x0000ff00) >>  8);
        WRITE(image, pixel++, (val & 0x00ff0000) >> 16);
#else
        WRITE(image, pixel++, (val & 0x00ff0000) >> 16);
        WRITE(image, pixel++, (val & 0x0000ff00) >>  8);
        WRITE(image, pixel++, (val & 0x000000ff) >>  0);
#endif
    }
}

static void
fbStore_r5g6b5 (pixman_image_t *image,
                uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint16_t *pixel = ((uint16_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        uint32_t s = values[i];
        WRITE(image, pixel++, ((s >> 3) & 0x001f) |
              ((s >> 5) & 0x07e0) |
              ((s >> 8) & 0xf800));
    }
}

static void
fbStore_b5g6r5 (pixman_image_t *image,
                uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint16_t  *pixel = ((uint16_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Split(values[i]);
        WRITE(image, pixel++, ((b << 8) & 0xf800) |
              ((g << 3) & 0x07e0) |
              ((r >> 3)         ));
    }
}

static void
fbStore_a1r5g5b5 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint16_t  *pixel = ((uint16_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Splita(values[i]);
        WRITE(image, pixel++, ((a << 8) & 0x8000) |
              ((r << 7) & 0x7c00) |
              ((g << 2) & 0x03e0) |
              ((b >> 3)         ));
    }
}

static void
fbStore_x1r5g5b5 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint16_t  *pixel = ((uint16_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Split(values[i]);
        WRITE(image, pixel++, ((r << 7) & 0x7c00) |
              ((g << 2) & 0x03e0) |
              ((b >> 3)         ));
    }
}

static void
fbStore_a1b5g5r5 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint16_t  *pixel = ((uint16_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Splita(values[i]);
        WRITE(image, pixel++, ((a << 8) & 0x8000) |
              ((b << 7) & 0x7c00) |
              ((g << 2) & 0x03e0) |
              ((r >> 3)         ));
    }
}

static void
fbStore_x1b5g5r5 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint16_t  *pixel = ((uint16_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Split(values[i]);
        WRITE(image, pixel++, ((b << 7) & 0x7c00) |
              ((g << 2) & 0x03e0) |
              ((r >> 3)         ));
    }
}

static void
fbStore_a4r4g4b4 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint16_t  *pixel = ((uint16_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Splita(values[i]);
        WRITE(image, pixel++, ((a << 8) & 0xf000) |
              ((r << 4) & 0x0f00) |
              ((g     ) & 0x00f0) |
              ((b >> 4)         ));
    }
}

static void
fbStore_x4r4g4b4 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint16_t  *pixel = ((uint16_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Split(values[i]);
        WRITE(image, pixel++, ((r << 4) & 0x0f00) |
              ((g     ) & 0x00f0) |
              ((b >> 4)         ));
    }
}

static void
fbStore_a4b4g4r4 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint16_t  *pixel = ((uint16_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Splita(values[i]);
        WRITE(image, pixel++, ((a << 8) & 0xf000) |
              ((b << 4) & 0x0f00) |
              ((g     ) & 0x00f0) |
              ((r >> 4)         ));
    }
}

static void
fbStore_x4b4g4r4 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint16_t  *pixel = ((uint16_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Split(values[i]);
        WRITE(image, pixel++, ((b << 4) & 0x0f00) |
              ((g     ) & 0x00f0) |
              ((r >> 4)         ));
    }
}

static void
fbStore_a8 (pixman_image_t *image,
            uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint8_t   *pixel = ((uint8_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        WRITE(image, pixel++, values[i] >> 24);
    }
}

static void
fbStore_r3g3b2 (pixman_image_t *image,
                uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint8_t   *pixel = ((uint8_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Split(values[i]);
        WRITE(image, pixel++,
              ((r     ) & 0xe0) |
              ((g >> 3) & 0x1c) |
              ((b >> 6)       ));
    }
}

static void
fbStore_b2g3r3 (pixman_image_t *image,
                uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint8_t   *pixel = ((uint8_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Split(values[i]);
        WRITE(image, pixel++,
              ((b     ) & 0xc0) |
              ((g >> 2) & 0x38) |
              ((r >> 5)       ));
    }
}

static void
fbStore_a2r2g2b2 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint8_t   *pixel = ((uint8_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Splita(values[i]);
        WRITE(image, pixel++, ((a     ) & 0xc0) |
              ((r >> 2) & 0x30) |
              ((g >> 4) & 0x0c) |
              ((b >> 6)       ));
    }
}

static void
fbStore_a2b2g2r2 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint8_t   *pixel = ((uint8_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        Splita(values[i]);
        *(pixel++) =  ((a     ) & 0xc0) |
            ((b >> 2) & 0x30) |
            ((g >> 4) & 0x0c) |
            ((r >> 6)       );
    }
}

static void
fbStore_c8 (pixman_image_t *image,
            uint32_t *bits, const uint32_t *values, int x, int width)
{
    const pixman_indexed_t *indexed = image->bits.indexed;
    int i;
    uint8_t   *pixel = ((uint8_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        WRITE(image, pixel++, miIndexToEnt24(indexed,values[i]));
    }
}

static void
fbStore_x4a4 (pixman_image_t *image,
              uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    uint8_t   *pixel = ((uint8_t *) bits) + x;
    for (i = 0; i < width; ++i) {
        WRITE(image, pixel++, values[i] >> 28);
    }
}

#define Store8(img,l,o,v)  (WRITE(img, (uint8_t *)(l) + ((o) >> 3), (v)))
#ifdef WORDS_BIGENDIAN
#define Store4(img,l,o,v)  Store8(img,l,o,((o) & 4 ?                            \
                                   (Fetch8(img,l,o) & 0xf0) | (v) :             \
                                   (Fetch8(img,l,o) & 0x0f) | ((v) << 4)))
#else
#define Store4(img,l,o,v)  Store8(img,l,o,((o) & 4 ?                           \
                                   (Fetch8(img,l,o) & 0x0f) | ((v) << 4) : \
                                   (Fetch8(img,l,o) & 0xf0) | (v)))
#endif

static void
fbStore_a4 (pixman_image_t *image,
            uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    for (i = 0; i < width; ++i) {
        Store4(image, bits, i + x, values[i]>>28);
    }
}

static void
fbStore_r1g2b1 (pixman_image_t *image,
                uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t  pixel;

        Split(values[i]);
        pixel = (((r >> 4) & 0x8) |
                 ((g >> 5) & 0x6) |
                 ((b >> 7)      ));
        Store4(image, bits, i + x, pixel);
    }
}

static void
fbStore_b1g2r1 (pixman_image_t *image,
                uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t  pixel;

        Split(values[i]);
        pixel = (((b >> 4) & 0x8) |
                 ((g >> 5) & 0x6) |
                 ((r >> 7)      ));
        Store4(image, bits, i + x, pixel);
    }
}

static void
fbStore_a1r1g1b1 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t  pixel;
        Splita(values[i]);
        pixel = (((a >> 4) & 0x8) |
                 ((r >> 5) & 0x4) |
                 ((g >> 6) & 0x2) |
                 ((b >> 7)      ));
        Store4(image, bits, i + x, pixel);
    }
}

static void
fbStore_a1b1g1r1 (pixman_image_t *image,
                  uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t  pixel;
        Splita(values[i]);
        pixel = (((a >> 4) & 0x8) |
                 ((b >> 5) & 0x4) |
                 ((g >> 6) & 0x2) |
                 ((r >> 7)      ));
        Store4(image, bits, i + x, pixel);
    }
}

static void
fbStore_c4 (pixman_image_t *image,
            uint32_t *bits, const uint32_t *values, int x, int width)
{
    const pixman_indexed_t *indexed = image->bits.indexed;
    int i;
    for (i = 0; i < width; ++i) {
        uint32_t  pixel;

        pixel = miIndexToEnt24(indexed, values[i]);
        Store4(image, bits, i + x, pixel);
    }
}

static void
fbStore_a1 (pixman_image_t *image,
            uint32_t *bits, const uint32_t *values, int x, int width)
{
    int i;
    for (i = 0; i < width; ++i)
    {
        uint32_t  *pixel = ((uint32_t *) bits) + ((i+x) >> 5);
        uint32_t mask, v;
#ifdef WORDS_BIGENDIAN
        mask = 1 << (0x1f - ((i+x) & 0x1f));
#else
        mask = 1 << ((i+x) & 0x1f);
#endif
        v = values[i] & 0x80000000 ? mask : 0;
        WRITE(image, pixel, (READ(image, pixel) & ~mask) | v);
    }
}

static void
fbStore_g1 (pixman_image_t *image,
            uint32_t *bits, const uint32_t *values, int x, int width)
{
    const pixman_indexed_t *indexed = image->bits.indexed;
    int i;
    for (i = 0; i < width; ++i)
    {
        uint32_t  *pixel = ((uint32_t *) bits) + ((i+x) >> 5);
        uint32_t  mask, v;
#ifdef WORDS_BIGENDIAN
        mask = 1 << (0x1f - ((i+x) & 0x1f));
#else
        mask = 1 << ((i + x) & 0x1f);
#endif
        v = miIndexToEntY24 (indexed, values[i]) ? mask : 0;
        WRITE(image, pixel, (READ(image, pixel) & ~mask) | v);
    }
}

/*
 * Contracts a 64bpp image to 32bpp and then stores it using a regular 32-bit
 * store proc.
 */
static void
fbStore64_generic (pixman_image_t *image,
                   uint32_t *bits, const uint64_t *values, int x, int width)
{
    uint32_t *argb8Pixels;

    assert(image->common.type == BITS);

    argb8Pixels = pixman_malloc_ab (width, sizeof(uint32_t));
    if (!argb8Pixels)
        return;

    /* Contract the scanline.  We could do this in place if values weren't
     * const.
     */
    pixman_contract(argb8Pixels, values, width);
    
    image->bits.store_scanline_raw_32 (image, bits, argb8Pixels, x, width);

    free(argb8Pixels);
}

static void
fbFetch64_generic (bits_image_t *pict, int x, int y, int width, uint64_t *buffer)
{
    /* Fetch the pixels into the first half of buffer and then expand them in
     * place.
     */
    pict->fetch_scanline_raw_32 (pict, x, y, width, (uint32_t*)buffer);
    
    pixman_expand (buffer, (uint32_t*)buffer, pict->format, width);
}

static void
fbFetchPixel64_generic (bits_image_t *pict, uint64_t *buffer, int n_pixels)
{
    pict->fetch_pixels_raw_32 (pict, (uint32_t *)buffer, n_pixels);
    
    pixman_expand (buffer, (uint32_t *)buffer, pict->format, n_pixels);
}

/*
 * XXX: The transformed fetch path only works at 32-bpp so far.  When all paths
 * have wide versions, this can be removed.
 *
 * WARNING: This function loses precision!
 */
static void
fbFetchPixel32_generic_lossy (bits_image_t *pict, uint32_t *buffer, int n_pixels)
{
    /* Since buffer contains n_pixels coordinate pairs, it also has enough room for
     * n_pixels 64 bit pixels
     */
    pict->fetch_pixels_raw_64 (pict, (uint64_t *)buffer, n_pixels);
    
    pixman_contract (buffer, (uint64_t *)buffer, n_pixels);
}

typedef struct
{
    pixman_format_code_t                format;
    fetchProc32                         fetch_scanline_raw_32;
    fetchProc64                         fetch_scanline_raw_64;
    fetch_pixels_32_t                   fetch_pixels_raw_32;
    fetch_pixels_64_t                   fetch_pixels_raw_64;
    storeProc32                         store_scanline_raw_32;
    storeProc64                         store_scanline_raw_64;
} format_info_t;

#define FORMAT_INFO(format)                                             \
    {                                                                   \
        PIXMAN_##format,                                                \
            fbFetch_##format, fbFetch64_generic,                        \
            fbFetchPixel_##format, fbFetchPixel64_generic,              \
            fbStore_##format, fbStore64_generic                         \
    }

static const format_info_t accessors[] =
{
/* 32 bpp formats */
    FORMAT_INFO (a8r8g8b8),
    FORMAT_INFO (x8r8g8b8),
    FORMAT_INFO (a8b8g8r8),
    FORMAT_INFO (x8b8g8r8),
    FORMAT_INFO (b8g8r8a8),
    FORMAT_INFO (b8g8r8x8),

/* 24bpp formats */
    FORMAT_INFO (r8g8b8),
    FORMAT_INFO (b8g8r8),
    
/* 16bpp formats */
    FORMAT_INFO (r5g6b5),
    FORMAT_INFO (b5g6r5),
    
    FORMAT_INFO (a1r5g5b5),
    FORMAT_INFO (x1r5g5b5),
    FORMAT_INFO (a1b5g5r5),
    FORMAT_INFO (x1b5g5r5),
    FORMAT_INFO (a4r4g4b4),
    FORMAT_INFO (x4r4g4b4),
    FORMAT_INFO (a4b4g4r4),
    FORMAT_INFO (x4b4g4r4),
    
/* 8bpp formats */
    FORMAT_INFO (a8),
    FORMAT_INFO (r3g3b2),
    FORMAT_INFO (b2g3r3),
    FORMAT_INFO (a2r2g2b2),
    FORMAT_INFO (a2b2g2r2),
    
    FORMAT_INFO (c8),

#define fbFetch_g8 fbFetch_c8
#define fbFetchPixel_g8 fbFetchPixel_c8
#define fbStore_g8 fbStore_c8
    FORMAT_INFO (g8),
#define fbFetch_x4c4 fbFetch_c8
#define fbFetchPixel_x4c4 fbFetchPixel_c8
#define fbStore_x4c4 fbStore_c8
    FORMAT_INFO (x4c4),
#define fbFetch_x4g4 fbFetch_c8
#define fbFetchPixel_x4g4 fbFetchPixel_c8
#define fbStore_x4g4 fbStore_c8
    FORMAT_INFO (x4g4),
    
    FORMAT_INFO (x4a4),
    
/* 4bpp formats */
    FORMAT_INFO (a4),
    FORMAT_INFO (r1g2b1),
    FORMAT_INFO (b1g2r1),
    FORMAT_INFO (a1r1g1b1),
    FORMAT_INFO (a1b1g1r1),
    
    FORMAT_INFO (c4),
#define fbFetch_g4 fbFetch_c4
#define fbFetchPixel_g4 fbFetchPixel_c4
#define fbStore_g4 fbStore_c4
    FORMAT_INFO (g4),
    
/* 1bpp formats */
    FORMAT_INFO (a1),
    FORMAT_INFO (g1),

/* Wide formats */
    
    { PIXMAN_a2b10g10r10,
      NULL, fbFetch_a2b10g10r10,
      fbFetchPixel32_generic_lossy, fbFetchPixel_a2b10g10r10,
      NULL, fbStore_a2b10g10r10 },

    { PIXMAN_x2b10g10r10,
      NULL, fbFetch_x2b10g10r10,
      fbFetchPixel32_generic_lossy, fbFetchPixel_x2b10g10r10,
      NULL, fbStore_x2b10g10r10 },

/* YUV formats */
    { PIXMAN_yuy2,
      fbFetch_yuy2, fbFetch64_generic,
      fbFetchPixel_yuy2, fbFetchPixel64_generic,
      NULL, NULL },

    { PIXMAN_yv12,
      fbFetch_yv12, fbFetch64_generic,
      fbFetchPixel_yv12, fbFetchPixel64_generic,
      NULL, NULL },
    
    { PIXMAN_null },
};

static void
setup_accessors (bits_image_t *image)
{
    const format_info_t *info = accessors;

    while (info->format != PIXMAN_null)
    {
        if (info->format == image->format)
        {
            image->fetch_scanline_raw_32 = info->fetch_scanline_raw_32;
            image->fetch_scanline_raw_64 = info->fetch_scanline_raw_64;
            image->fetch_pixels_raw_32 = info->fetch_pixels_raw_32;
            image->fetch_pixels_raw_64 = info->fetch_pixels_raw_64;
            image->store_scanline_raw_32 = info->store_scanline_raw_32;
            image->store_scanline_raw_64 = info->store_scanline_raw_64;

            return;
        }

        info++;
    }
}

#ifndef PIXMAN_FB_ACCESSORS
void
_pixman_bits_image_setup_raw_accessors_accessors (bits_image_t *image);

void
_pixman_bits_image_setup_raw_accessors (bits_image_t *image)
{
    if (image->common.read_func || image->common.write_func)
        _pixman_bits_image_setup_raw_accessors_accessors (image);
    else
        setup_accessors (image);
}

#else

void
_pixman_bits_image_setup_raw_accessors_accessors (bits_image_t *image)
{
    setup_accessors (image);
}

#endif