/*
* Render Engine for framebuffer devices
*
* Copyright (c) 2008 CodeSourcery
*
* This library is free software; you can redistribute it and/or
* modify it under the terms of the GNU Lesser General Public
* License as published by the Free Software Foundation; either
* version 2 of the License, or (at your option) any later version.
*
* This library is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* Lesser General Public License for more details.
*
* You should have received a copy of the GNU Lesser General Public
* License along with this library; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*/
/* This file is included from fb_render_def.h
At the moment of this inclusion, the following
preprocessor parameters are defined:
DEST_BPP { 8,15,16,24,32 }
FB_SRC_COLOR_ORDER { FB_CO_RGB, FB_CO_BGR }
FB_SRC_BYTE_ORDER { FB_LITTLE_ENDIAN, FB_BIG_ENDIAN }
FB_SRC_PIXEL_ORDER { FB_LITTLE_ENDIAN, FB_BIG_ENDIAN }
*/
/* The COPY_PIXEL macro does two things:
1) Copies all the bytes involved in the pixel (depending on the DEST_BPP)
2) Leaves the 'dest' parameter pointing to the first byte of next pixel.
This depends also by the rotation parameter. The rotation modifies the
'increment' bytes between pixels.
*/
#if DEST_BPP == 8
# define COPY_PIXEL(to, from, increment) { *to = from; to += increment; }
#elif DEST_BPP == 15 || DEST_BPP == 16
# define COPY_PIXEL(to, from, increment) { *(uint16_t *)to = from; to += increment; }
#elif DEST_BPP == 24
# define COPY_PIXEL(to, from, increment) \
{ *to = from; to += increment; *to = (from) >> 8; to += increment; *to = (from) >> 16; to += increment; }
#elif DEST_BPP == 32
# define COPY_PIXEL(to, from, increment) *(uint32_t *)to = from; to += increment;
#else
# error unknown bit depth
#endif
/* Define the infixes of the functions name */
#if FB_SRC_COLOR_ORDER == FB_CO_RGB
# define SRC_COLOR_ORDER_INFIX rgb
#else
# define SRC_COLOR_ORDER_INFIX bgr
#endif
#if FB_SRC_BYTE_ORDER == FB_LITTLE_ENDIAN
# define SRC_BYTE_ORDER_INFIX lb
#else
# define SRC_BYTE_ORDER_INFIX bb
#endif
#if FB_SRC_PIXEL_ORDER == FB_LITTLE_ENDIAN
# define SRC_PIXEL_ORDER_INFIX lp
#else
# define SRC_PIXEL_ORDER_INFIX bp
#endif
#define MAKE_FN_SUFFIX(dest_bpp,color_order,byte_order,pixel_order) \
byte_order##pixel_order##_##color_order##dest_bpp
#define FN_SUFFIX glue(SRC_BYTE_ORDER_INFIX,glue(SRC_PIXEL_ORDER_INFIX,glue(_,glue(SRC_COLOR_ORDER_INFIX,DEST_BPP))))
#ifdef WORDS_BIGENDIAN
# define FB_DEST_BYTE_ORDER FB_BIG_ENDIAN
#else
# define FB_DEST_BYTE_ORDER FB_LITTLE_ENDIAN
#endif
#if FB_SRC_BYTE_ORDER != FB_DEST_BYTE_ORDER
# define SWAP_WORDS 1
#endif
#if FB_SRC_BYTE_ORDER != FB_SRC_PIXEL_ORDER
# define SWAP_PIXELS 1
#endif
#define FN_2(x, y) FN(x, y) FN(x+1, y)
#define FN_4(x, y) FN_2(x, y) FN_2(x+2, y)
#define FN_8(y) FN_4(0, y) FN_4(4, y)
static void glue(fb_draw_line1_,FN_SUFFIX)(uint32_t *palette, uint8_t *d, const uint8_t *src, int width, int increment)
{
uint32_t data;
while (width > 0) {
data = *(uint32_t *)src;
#ifdef SWAP_PIXELS
# define FN(x, y) COPY_PIXEL(d, palette[(data >> (y + 7 - (x))) & 1], increment);
#else
# define FN(x, y) COPY_PIXEL(d, palette[(data >> ((x) + y)) & 1], increment);
#endif
#ifdef SWAP_WORDS
FN_8(24)
FN_8(16)
FN_8(8)
FN_8(0)
#else
FN_8(0)
FN_8(8)
FN_8(16)
FN_8(24)
#endif
#undef FN
width -= 32;
src += 4;
}
}
static void glue(fb_draw_line2_,FN_SUFFIX)(uint32_t *palette, uint8_t *d, const uint8_t *src, int width, int increment)
{
uint32_t data;
while (width > 0) {
data = *(uint32_t *)src;
#ifdef SWAP_PIXELS
#define FN(x, y) COPY_PIXEL(d, palette[(data >> (y + 6 - (x)*2)) & 3], increment);
#else
#define FN(x, y) COPY_PIXEL(d, palette[(data >> ((x)*2 + y)) & 3], increment);
#endif
#ifdef SWAP_WORDS
FN_4(0, 24)
FN_4(0, 16)
FN_4(0, 8)
FN_4(0, 0)
#else
FN_4(0, 0)
FN_4(0, 8)
FN_4(0, 16)
FN_4(0, 24)
#endif
#undef FN
width -= 16;
src += 4;
}
}
static void glue(fb_draw_line4_,FN_SUFFIX)(uint32_t *palette, uint8_t *d, const uint8_t *src, int width, int increment)
{
uint32_t data;
while (width > 0) {
data = *(uint32_t *)src;
#ifdef SWAP_PIXELS
# define FN(x, y) COPY_PIXEL(d, palette[(data >> (y + 4 - (x)*4)) & 0xf], increment);
#else
# define FN(x, y) COPY_PIXEL(d, palette[(data >> ((x)*4 + y)) & 0xf], increment);
#endif
#ifdef SWAP_WORDS
FN_2(0, 24)
FN_2(0, 16)
FN_2(0, 8)
FN_2(0, 0)
#else
FN_2(0, 0)
FN_2(0, 8)
FN_2(0, 16)
FN_2(0, 24)
#endif
#undef FN
width -= 8;
src += 4;
}
}
static void glue(fb_draw_line8_,FN_SUFFIX)(uint32_t *palette, uint8_t *d, const uint8_t *src, int width, int increment)
{
uint32_t data;
while (width > 0) {
data = *(uint32_t *)src;
#define FN(x) COPY_PIXEL(d, palette[(data >> (x)) & 0xff], increment);
#ifdef SWAP_WORDS
FN(24)
FN(16)
FN(8)
FN(0)
#else
FN(0)
FN(8)
FN(16)
FN(24)
#endif
#undef FN
width -= 4;
src += 4;
}
}
static void glue(fb_draw_line15_,FN_SUFFIX)(uint32_t *palette, uint8_t *d, const uint8_t *src, int width, int increment)
{
uint32_t data;
unsigned int r, g, b;
while (width > 0) {
data = *(uint32_t *)src;
#ifdef SWAP_WORDS
data = bswap32(data);
#endif
#if FB_SRC_COLOR_ORDER == FB_CO_RGB
# define LSB r
# define MSB b
#else
# define LSB b
# define MSB r
#endif
/* byte swapping done by bswap32 */
LSB = (data & 0x1f) << 3;
data >>= 5;
g = (data & 0x1f) << 3;
data >>= 5;
MSB = (data & 0x1f) << 3;
data >>= 6;
COPY_PIXEL(d, glue(rgb_to_pixel,DEST_BPP)(r, g, b), increment);
LSB = (data & 0x1f) << 3;
data >>= 5;
g = (data & 0x1f) << 3;
data >>= 5;
MSB = (data & 0x1f) << 3;
COPY_PIXEL(d, glue(rgb_to_pixel,DEST_BPP)(r, g, b), increment);
#undef MSB
#undef LSB
width -= 2;
src += 4;
}
}
static void glue(fb_draw_line16_,FN_SUFFIX)(uint32_t *palette, uint8_t *d, const uint8_t *src, int width, int increment)
{
uint32_t data;
unsigned int r, g, b;
while (width > 0) {
data = *(uint32_t *)src;
#ifdef SWAP_WORDS
data = bswap32(data);
#endif
#if FB_SRC_COLOR_ORDER == FB_CO_RGB
# define LSB r
# define MSB b
#else
# define LSB b
# define MSB r
#endif
/* byte swapping done by bswap32 */
LSB = (data & 0x1f) << 3;
data >>= 5;
g = (data & 0x3f) << 2;
data >>= 6;
MSB = (data & 0x1f) << 3;
data >>= 5;
COPY_PIXEL(d, glue(rgb_to_pixel,DEST_BPP)(r, g, b), increment);
LSB = (data & 0x1f) << 3;
data >>= 5;
g = (data & 0x3f) << 2;
data >>= 6;
MSB = (data & 0x1f) << 3;
data >>= 5;
COPY_PIXEL(d, glue(rgb_to_pixel,DEST_BPP)(r, g, b), increment);
#undef MSB
#undef LSB
width -= 2;
src += 4;
}
}
static void glue(fb_draw_line24_,FN_SUFFIX)(uint32_t *palette, uint8_t *d, const uint8_t *src, int width, int increment)
{
unsigned int r, g, b;
while (width > 0) {
#if FB_SRC_COLOR_ORDER == FB_CO_RGB
# define LSB r
# define MSB b
#else
# define LSB b
# define MSB r
#endif
/* byte swapping not implemented in 24 bpp */
LSB = *src; src++;
g = *src; src++;
MSB = *src; src++;
COPY_PIXEL(d, glue(rgb_to_pixel,DEST_BPP)(r, g, b), increment);
#undef MSB
#undef LSB
width--;
}
}
static void glue(fb_draw_line32_,FN_SUFFIX)(uint32_t *palette, uint8_t *d, const uint8_t *src, int width, int increment)
{
uint32_t data;
unsigned int r, g, b;
while (width > 0) {
data = *(uint32_t *)src;
#if FB_SRC_COLOR_ORDER == FB_CO_RGB
# define LSB r
# define MSB b
#else
# define LSB b
# define MSB r
#endif
#ifndef SWAP_WORDS
LSB = data & 0xff;
g = (data >> 8) & 0xff;
MSB = (data >> 16) & 0xff;
#else
LSB = (data >> 24) & 0xff;
g = (data >> 16) & 0xff;
MSB = (data >> 8) & 0xff;
#endif
COPY_PIXEL(d, glue(rgb_to_pixel,DEST_BPP)(r, g, b), increment);
#undef MSB
#undef LSB
width--;
src += 4;
}
}
/* Undefine all the local definitions, so they don't collide with the next time
this file is included in the tree */
#undef COPY_PIXEL
#undef SWAP_PIXELS
#undef SWAP_WORDS
#undef FN_SUFFIX
#undef FB_DEST_BYTE_ORDER
#undef SRC_COLOR_ORDER_INFIX
#undef SRC_BYTE_ORDER_INFIX
#undef SRC_PIXEL_ORDER_INFIX