34b7b715e8
Rewrite the loop to update the framebuffer by rows rather than by columns. This should (a) be more efficient on the majority of targets using horizontal stride framebuffers, (b) skimp a bit on code size and (c) avoid AddressSanitizer errors caused by reading past the end of the source buffer. Change-Id: I238d191d63bfdecd25336fd8879a63d9d6ab7087
827 lines
25 KiB
C
827 lines
25 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright (C) 2005 by Dave Chapman
|
|
*
|
|
* Rockbox driver for 16-bit colour LCDs
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
|
* KIND, either express or implied.
|
|
*
|
|
****************************************************************************/
|
|
|
|
|
|
/* to be #included by lcd-16bit*.c */
|
|
|
|
#if !defined(ROW_INC) || !defined(COL_INC)
|
|
#error ROW_INC or COL_INC not defined
|
|
#endif
|
|
|
|
/* Clear the current viewport */
|
|
void lcd_clear_viewport(void)
|
|
{
|
|
fb_data *dst, *dst_end;
|
|
int x, y, width, height;
|
|
int len, step;
|
|
|
|
x = lcd_current_viewport->x;
|
|
y = lcd_current_viewport->y;
|
|
width = lcd_current_viewport->width;
|
|
height = lcd_current_viewport->height;
|
|
|
|
#if defined(HAVE_VIEWPORT_CLIP)
|
|
/********************* Viewport on screen clipping ********************/
|
|
/* nothing to draw? */
|
|
if ((x >= LCD_WIDTH) || (y >= LCD_HEIGHT)
|
|
|| (x + width <= 0) || (y + height <= 0))
|
|
return;
|
|
|
|
/* clip image in viewport in screen */
|
|
if (x < 0)
|
|
{
|
|
width += x;
|
|
x = 0;
|
|
}
|
|
if (y < 0)
|
|
{
|
|
height += y;
|
|
y = 0;
|
|
}
|
|
if (x + width > LCD_WIDTH)
|
|
width = LCD_WIDTH - x;
|
|
if (y + height > LCD_HEIGHT)
|
|
height = LCD_HEIGHT - y;
|
|
#endif
|
|
|
|
len = STRIDE_MAIN(width, height);
|
|
step = STRIDE_MAIN(ROW_INC, COL_INC);
|
|
|
|
dst = FBADDR(x, y);
|
|
dst_end = FBADDR(x + width - 1 , y + height - 1);
|
|
|
|
if (lcd_current_viewport->drawmode & DRMODE_INVERSEVID)
|
|
{
|
|
do
|
|
{
|
|
memset16(dst, lcd_current_viewport->fg_pattern, len);
|
|
dst += step;
|
|
}
|
|
while (dst <= dst_end);
|
|
}
|
|
else
|
|
{
|
|
if (lcd_backdrop && lcd_current_viewport->buffer == &lcd_framebuffer_default)
|
|
{
|
|
do
|
|
{
|
|
memcpy(dst, PTR_ADD(dst, lcd_backdrop_offset),
|
|
len * sizeof(fb_data));
|
|
dst += step;
|
|
}
|
|
while (dst <= dst_end);
|
|
}
|
|
else
|
|
{
|
|
do
|
|
{
|
|
memset16(dst, lcd_current_viewport->bg_pattern, len);
|
|
dst += step;
|
|
}
|
|
while (dst <= dst_end);
|
|
}
|
|
}
|
|
|
|
if (lcd_current_viewport == &default_vp)
|
|
lcd_scroll_stop();
|
|
else
|
|
lcd_scroll_stop_viewport(lcd_current_viewport);
|
|
|
|
lcd_current_viewport->flags &= ~(VP_FLAG_VP_SET_CLEAN);
|
|
}
|
|
|
|
/*** low-level drawing functions ***/
|
|
|
|
static void ICODE_ATTR setpixel(fb_data *address)
|
|
{
|
|
*address = lcd_current_viewport->fg_pattern;
|
|
}
|
|
|
|
static void ICODE_ATTR clearpixel(fb_data *address)
|
|
{
|
|
*address = lcd_current_viewport->bg_pattern;
|
|
}
|
|
|
|
static void ICODE_ATTR clearimgpixel(fb_data *address)
|
|
{
|
|
*address = *PTR_ADD(address, lcd_backdrop_offset);
|
|
}
|
|
|
|
static void ICODE_ATTR flippixel(fb_data *address)
|
|
{
|
|
*address = ~(*address);
|
|
}
|
|
|
|
static void ICODE_ATTR nopixel(fb_data *address)
|
|
{
|
|
(void)address;
|
|
}
|
|
|
|
lcd_fastpixelfunc_type* const lcd_fastpixelfuncs_bgcolor[8] = {
|
|
flippixel, nopixel, setpixel, setpixel,
|
|
nopixel, clearpixel, nopixel, clearpixel
|
|
};
|
|
|
|
lcd_fastpixelfunc_type* const lcd_fastpixelfuncs_backdrop[8] = {
|
|
flippixel, nopixel, setpixel, setpixel,
|
|
nopixel, clearimgpixel, nopixel, clearimgpixel
|
|
};
|
|
|
|
lcd_fastpixelfunc_type* const * lcd_fastpixelfuncs = lcd_fastpixelfuncs_bgcolor;
|
|
|
|
/* Fill a rectangular area */
|
|
void lcd_fillrect(int x, int y, int width, int height)
|
|
{
|
|
unsigned bits = 0;
|
|
enum fill_opt fillopt = OPT_NONE;
|
|
fb_data *dst, *dst_end;
|
|
int len, step;
|
|
|
|
/******************** In viewport clipping **********************/
|
|
/* nothing to draw? */
|
|
if ((width <= 0) || (height <= 0) || (x >= lcd_current_viewport->width) ||
|
|
(y >= lcd_current_viewport->height) || (x + width <= 0) || (y + height <= 0))
|
|
return;
|
|
|
|
if (x < 0)
|
|
{
|
|
width += x;
|
|
x = 0;
|
|
}
|
|
if (y < 0)
|
|
{
|
|
height += y;
|
|
y = 0;
|
|
}
|
|
if (x + width > lcd_current_viewport->width)
|
|
width = lcd_current_viewport->width - x;
|
|
if (y + height > lcd_current_viewport->height)
|
|
height = lcd_current_viewport->height - y;
|
|
|
|
/* adjust for viewport */
|
|
x += lcd_current_viewport->x;
|
|
y += lcd_current_viewport->y;
|
|
|
|
#if defined(HAVE_VIEWPORT_CLIP)
|
|
/********************* Viewport on screen clipping ********************/
|
|
/* nothing to draw? */
|
|
if ((x >= LCD_WIDTH) || (y >= LCD_HEIGHT)
|
|
|| (x + width <= 0) || (y + height <= 0))
|
|
return;
|
|
|
|
/* clip image in viewport in screen */
|
|
if (x < 0)
|
|
{
|
|
width += x;
|
|
x = 0;
|
|
}
|
|
if (y < 0)
|
|
{
|
|
height += y;
|
|
y = 0;
|
|
}
|
|
if (x + width > LCD_WIDTH)
|
|
width = LCD_WIDTH - x;
|
|
if (y + height > LCD_HEIGHT)
|
|
height = LCD_HEIGHT - y;
|
|
#endif
|
|
|
|
/* drawmode and optimisation */
|
|
if (lcd_current_viewport->drawmode & DRMODE_INVERSEVID)
|
|
{
|
|
if (lcd_current_viewport->drawmode & DRMODE_BG)
|
|
{
|
|
if (!lcd_backdrop)
|
|
{
|
|
fillopt = OPT_SET;
|
|
bits = lcd_current_viewport->bg_pattern;
|
|
}
|
|
else
|
|
fillopt = OPT_COPY;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if (lcd_current_viewport->drawmode & DRMODE_FG)
|
|
{
|
|
fillopt = OPT_SET;
|
|
bits = lcd_current_viewport->fg_pattern;
|
|
}
|
|
}
|
|
if (fillopt == OPT_NONE && lcd_current_viewport->drawmode != DRMODE_COMPLEMENT)
|
|
return;
|
|
|
|
dst = FBADDR(x, y);
|
|
dst_end = FBADDR(x + width - 1, y + height - 1);
|
|
|
|
len = STRIDE_MAIN(width, height);
|
|
step = STRIDE_MAIN(ROW_INC, COL_INC);
|
|
|
|
do
|
|
{
|
|
switch (fillopt)
|
|
{
|
|
case OPT_SET:
|
|
memset16(dst, bits, len);
|
|
break;
|
|
|
|
case OPT_COPY:
|
|
memcpy(dst, PTR_ADD(dst, lcd_backdrop_offset),
|
|
len * sizeof(fb_data));
|
|
break;
|
|
|
|
case OPT_NONE: /* DRMODE_COMPLEMENT */
|
|
{
|
|
fb_data *start = dst;
|
|
fb_data *end = start + len;
|
|
do
|
|
*start = ~(*start);
|
|
while (++start < end);
|
|
break;
|
|
}
|
|
}
|
|
dst += step;
|
|
}
|
|
while (dst <= dst_end);
|
|
}
|
|
|
|
/* About Rockbox' internal monochrome bitmap format:
|
|
*
|
|
* A bitmap contains one bit for every pixel that defines if that pixel is
|
|
* black (1) or white (0). Bits within a byte are arranged vertically, LSB
|
|
* at top.
|
|
* The bytes are stored in row-major order, with byte 0 being top left,
|
|
* byte 1 2nd from left etc. The first row of bytes defines pixel rows
|
|
* 0..7, the second row defines pixel row 8..15 etc.
|
|
*
|
|
* This is the mono bitmap format used on all other targets so far; the
|
|
* pixel packing doesn't really matter on a 8bit+ target. */
|
|
|
|
/* Draw a partial monochrome bitmap */
|
|
|
|
void ICODE_ATTR lcd_mono_bitmap_part(const unsigned char *src, int src_x,
|
|
int src_y, int stride, int x, int y,
|
|
int width, int height)
|
|
{
|
|
/******************** Image in viewport clipping **********************/
|
|
/* nothing to draw? */
|
|
if ((width <= 0) || (height <= 0) || (x >= lcd_current_viewport->width) ||
|
|
(y >= lcd_current_viewport->height) || (x + width <= 0) || (y + height <= 0))
|
|
return;
|
|
|
|
if (x < 0)
|
|
{
|
|
width += x;
|
|
src_x -= x;
|
|
x = 0;
|
|
}
|
|
if (y < 0)
|
|
{
|
|
height += y;
|
|
src_y -= y;
|
|
y = 0;
|
|
}
|
|
if (x + width > lcd_current_viewport->width)
|
|
width = lcd_current_viewport->width - x;
|
|
if (y + height > lcd_current_viewport->height)
|
|
height = lcd_current_viewport->height - y;
|
|
|
|
/* convert to viewport coordinates */
|
|
x += lcd_current_viewport->x;
|
|
y += lcd_current_viewport->y;
|
|
|
|
#if defined(HAVE_VIEWPORT_CLIP)
|
|
/********************* Viewport on screen clipping ********************/
|
|
/* nothing to draw? */
|
|
if ((x >= LCD_WIDTH) || (y >= LCD_HEIGHT)
|
|
|| (x + width <= 0) || (y + height <= 0))
|
|
return;
|
|
|
|
/* clip image in viewport in screen */
|
|
if (x < 0)
|
|
{
|
|
width += x;
|
|
src_x -= x;
|
|
x = 0;
|
|
}
|
|
if (y < 0)
|
|
{
|
|
height += y;
|
|
src_y -= y;
|
|
y = 0;
|
|
}
|
|
if (x + width > LCD_WIDTH)
|
|
width = LCD_WIDTH - x;
|
|
if (y + height > LCD_HEIGHT)
|
|
height = LCD_HEIGHT - y;
|
|
#endif
|
|
|
|
/* move starting point */
|
|
src += stride * (src_y >> 3) + src_x;
|
|
src_y &= 7;
|
|
|
|
unsigned dmask = 0;
|
|
int drmode = lcd_current_viewport->drawmode;
|
|
|
|
if (drmode & DRMODE_INVERSEVID)
|
|
{
|
|
dmask = 0xff;
|
|
drmode &= DRMODE_SOLID; /* mask out inversevid */
|
|
}
|
|
|
|
/* Use extra bit to avoid if () in the switch-cases below */
|
|
if ((drmode & DRMODE_BG) && lcd_backdrop)
|
|
drmode |= DRMODE_INT_BD;
|
|
|
|
fb_data* dst = FBADDR(x, y);
|
|
while(height > 0)
|
|
{
|
|
const unsigned char* src_col = src;
|
|
const unsigned char* src_end = src + width;
|
|
fb_data* dst_col = dst;
|
|
|
|
unsigned data;
|
|
int fg, bg;
|
|
uintptr_t bo;
|
|
|
|
switch (drmode) {
|
|
case DRMODE_COMPLEMENT:
|
|
do {
|
|
data = (*src_col++ ^ dmask) >> src_y;
|
|
if(data & 0x01)
|
|
*dst_col = ~(*dst_col);
|
|
|
|
dst_col += COL_INC;
|
|
} while(src_col != src_end);
|
|
break;
|
|
|
|
case DRMODE_BG|DRMODE_INT_BD:
|
|
bo = lcd_backdrop_offset;
|
|
do {
|
|
data = (*src_col++ ^ dmask) >> src_y;
|
|
if(!(data & 0x01))
|
|
*dst_col = *PTR_ADD(dst_col, bo);
|
|
|
|
dst_col += COL_INC;
|
|
} while(src_col != src_end);
|
|
break;
|
|
|
|
case DRMODE_BG:
|
|
bg = lcd_current_viewport->bg_pattern;
|
|
do {
|
|
data = (*src_col++ ^ dmask) >> src_y;
|
|
if(!(data & 0x01))
|
|
*dst_col = bg;
|
|
|
|
dst_col += COL_INC;
|
|
} while(src_col != src_end);
|
|
break;
|
|
|
|
case DRMODE_FG:
|
|
fg = lcd_current_viewport->fg_pattern;
|
|
do {
|
|
data = (*src_col++ ^ dmask) >> src_y;
|
|
if(data & 0x01)
|
|
*dst_col = fg;
|
|
|
|
dst_col += COL_INC;
|
|
} while(src_col != src_end);
|
|
break;
|
|
|
|
case DRMODE_SOLID|DRMODE_INT_BD:
|
|
fg = lcd_current_viewport->fg_pattern;
|
|
bo = lcd_backdrop_offset;
|
|
do {
|
|
data = (*src_col++ ^ dmask) >> src_y;
|
|
if(data & 0x01)
|
|
*dst_col = fg;
|
|
else
|
|
*dst_col = *PTR_ADD(dst_col, bo);
|
|
|
|
dst_col += COL_INC;
|
|
} while(src_col != src_end);
|
|
break;
|
|
|
|
case DRMODE_SOLID:
|
|
fg = lcd_current_viewport->fg_pattern;
|
|
bg = lcd_current_viewport->bg_pattern;
|
|
do {
|
|
data = (*src_col++ ^ dmask) >> src_y;
|
|
if(data & 0x01)
|
|
*dst_col = fg;
|
|
else
|
|
*dst_col = bg;
|
|
|
|
dst_col += COL_INC;
|
|
} while(src_col != src_end);
|
|
break;
|
|
}
|
|
|
|
src_y = (src_y + 1) & 7;
|
|
if(src_y == 0)
|
|
src += stride;
|
|
|
|
dst += ROW_INC;
|
|
height--;
|
|
}
|
|
}
|
|
|
|
/* Draw a full monochrome bitmap */
|
|
void lcd_mono_bitmap(const unsigned char *src, int x, int y, int width, int height)
|
|
{
|
|
lcd_mono_bitmap_part(src, 0, 0, width, x, y, width, height);
|
|
}
|
|
|
|
|
|
/* About Rockbox' internal alpha channel format (for ALPHA_COLOR_FONT_DEPTH == 2)
|
|
*
|
|
* For each pixel, 4bit of alpha information is stored in a byte-stream,
|
|
* so two pixels are packed into one byte.
|
|
* The lower nibble is the first pixel, the upper one the second. The stride is
|
|
* horizontal. E.g row0: pixel0: byte0[0:3], pixel1: byte0[4:7], pixel2: byte1[0:3],...
|
|
* The format is independant of the internal display orientation and color
|
|
* representation, as to support the same font files on all displays.
|
|
* The values go linear from 0 (fully opaque) to 15 (fully transparent)
|
|
* (note how this is the opposite of the alpha channel in the ARGB format).
|
|
*
|
|
* This might suggest that rows need to have an even number of pixels.
|
|
* However this is generally not the case. lcd_alpha_bitmap_part_mix() can deal
|
|
* with uneven colums (i.e. two rows can share one byte). And font files do
|
|
* exploit this.
|
|
* However, this is difficult to do for image files, especially bottom-up bitmaps,
|
|
* so lcd_bmp() do expect even rows.
|
|
*/
|
|
|
|
#define ALPHA_COLOR_FONT_DEPTH 2
|
|
#define ALPHA_COLOR_LOOKUP_SHIFT (1 << ALPHA_COLOR_FONT_DEPTH)
|
|
#define ALPHA_COLOR_LOOKUP_SIZE ((1 << ALPHA_COLOR_LOOKUP_SHIFT) - 1)
|
|
#define ALPHA_COLOR_PIXEL_PER_BYTE (8 >> ALPHA_COLOR_FONT_DEPTH)
|
|
#define ALPHA_COLOR_PIXEL_PER_WORD (32 >> ALPHA_COLOR_FONT_DEPTH)
|
|
#ifdef CPU_ARM
|
|
#define BLEND_INIT do {} while (0)
|
|
#define BLEND_FINISH do {} while(0)
|
|
#define BLEND_START(acc, color, alpha) \
|
|
asm volatile("mul %0, %1, %2" : "=&r" (acc) : "r" (color), "r" (alpha))
|
|
#define BLEND_CONT(acc, color, alpha) \
|
|
asm volatile("mla %0, %1, %2, %0" : "+&r" (acc) : "r" (color), "r" (alpha))
|
|
#define BLEND_OUT(acc) do {} while (0)
|
|
#elif defined(CPU_COLDFIRE)
|
|
#define ALPHA_BITMAP_READ_WORDS
|
|
#define BLEND_INIT \
|
|
unsigned long _macsr = coldfire_get_macsr(); \
|
|
coldfire_set_macsr(EMAC_UNSIGNED)
|
|
#define BLEND_FINISH \
|
|
coldfire_set_macsr(_macsr)
|
|
#define BLEND_START(acc, color, alpha) \
|
|
asm volatile("mac.l %0, %1, %%acc0" :: "%d" (color), "d" (alpha))
|
|
#define BLEND_CONT BLEND_START
|
|
#define BLEND_OUT(acc) asm volatile("movclr.l %%acc0, %0" : "=d" (acc))
|
|
#else
|
|
#define BLEND_INIT do {} while (0)
|
|
#define BLEND_FINISH do {} while(0)
|
|
#define BLEND_START(acc, color, alpha) ((acc) = (color) * (alpha))
|
|
#define BLEND_CONT(acc, color, alpha) ((acc) += (color) * (alpha))
|
|
#define BLEND_OUT(acc) do {} while (0)
|
|
#endif
|
|
|
|
/* Blend the given two colors */
|
|
static inline unsigned blend_two_colors(unsigned c1, unsigned c2, unsigned a)
|
|
{
|
|
a += a >> (ALPHA_COLOR_LOOKUP_SHIFT - 1);
|
|
#if (LCD_PIXELFORMAT == RGB565SWAPPED)
|
|
c1 = swap16(c1);
|
|
c2 = swap16(c2);
|
|
#endif
|
|
unsigned c1l = (c1 | (c1 << 16)) & 0x07e0f81f;
|
|
unsigned c2l = (c2 | (c2 << 16)) & 0x07e0f81f;
|
|
unsigned p;
|
|
BLEND_START(p, c1l, a);
|
|
BLEND_CONT(p, c2l, ALPHA_COLOR_LOOKUP_SIZE + 1 - a);
|
|
BLEND_OUT(p);
|
|
p = (p >> ALPHA_COLOR_LOOKUP_SHIFT) & 0x07e0f81f;
|
|
p |= (p >> 16);
|
|
#if (LCD_PIXELFORMAT == RGB565SWAPPED)
|
|
return swap16(p);
|
|
#else
|
|
return p;
|
|
#endif
|
|
}
|
|
|
|
/* Blend an image with an alpha channel
|
|
* if image is NULL, drawing will happen according to the drawmode
|
|
* src is the alpha channel (4bit per pixel) */
|
|
static void ICODE_ATTR lcd_alpha_bitmap_part_mix(const fb_data* image,
|
|
const unsigned char *src, int src_x,
|
|
int src_y, int x, int y,
|
|
int width, int height,
|
|
int stride_image, int stride_src)
|
|
{
|
|
fb_data *dst, *dst_row;
|
|
unsigned dmask = 0x00000000;
|
|
int drmode = lcd_current_viewport->drawmode;
|
|
/* nothing to draw? */
|
|
if ((width <= 0) || (height <= 0) || (x >= lcd_current_viewport->width) ||
|
|
(y >= lcd_current_viewport->height) || (x + width <= 0) || (y + height <= 0))
|
|
return;
|
|
/* initialize blending */
|
|
BLEND_INIT;
|
|
|
|
/* clipping */
|
|
if (x < 0)
|
|
{
|
|
width += x;
|
|
src_x -= x;
|
|
x = 0;
|
|
}
|
|
if (y < 0)
|
|
{
|
|
height += y;
|
|
src_y -= y;
|
|
y = 0;
|
|
}
|
|
if (x + width > lcd_current_viewport->width)
|
|
width = lcd_current_viewport->width - x;
|
|
if (y + height > lcd_current_viewport->height)
|
|
height = lcd_current_viewport->height - y;
|
|
|
|
/* adjust for viewport */
|
|
x += lcd_current_viewport->x;
|
|
y += lcd_current_viewport->y;
|
|
|
|
#if defined(HAVE_VIEWPORT_CLIP)
|
|
/********************* Viewport on screen clipping ********************/
|
|
/* nothing to draw? */
|
|
if ((x >= LCD_WIDTH) || (y >= LCD_HEIGHT)
|
|
|| (x + width <= 0) || (y + height <= 0))
|
|
{
|
|
BLEND_FINISH;
|
|
return;
|
|
}
|
|
|
|
/* clip image in viewport in screen */
|
|
if (x < 0)
|
|
{
|
|
width += x;
|
|
src_x -= x;
|
|
x = 0;
|
|
}
|
|
if (y < 0)
|
|
{
|
|
height += y;
|
|
src_y -= y;
|
|
y = 0;
|
|
}
|
|
if (x + width > LCD_WIDTH)
|
|
width = LCD_WIDTH - x;
|
|
if (y + height > LCD_HEIGHT)
|
|
height = LCD_HEIGHT - y;
|
|
#endif
|
|
|
|
/* the following drawmode combinations are possible:
|
|
* 1) COMPLEMENT: just negates the framebuffer contents
|
|
* 2) BG and BG+backdrop: draws _only_ background pixels with either
|
|
* the background color or the backdrop (if any). The backdrop
|
|
* is an image in native lcd format
|
|
* 3) FG and FG+image: draws _only_ foreground pixels with either
|
|
* the foreground color or an image buffer. The image is in
|
|
* native lcd format
|
|
* 4) SOLID, SOLID+backdrop, SOLID+image, SOLID+backdrop+image, i.e. all
|
|
* possible combinations of 2) and 3). Draws both, fore- and background,
|
|
* pixels. The rules of 2) and 3) apply.
|
|
*
|
|
* INVERSEVID swaps fore- and background pixels, i.e. background pixels
|
|
* become foreground ones and vice versa.
|
|
*/
|
|
if (drmode & DRMODE_INVERSEVID)
|
|
{
|
|
dmask = 0xffffffff;
|
|
drmode &= DRMODE_SOLID; /* mask out inversevid */
|
|
}
|
|
|
|
/* Use extra bits to avoid if () in the switch-cases below */
|
|
if (image != NULL)
|
|
drmode |= DRMODE_INT_IMG;
|
|
|
|
if ((drmode & DRMODE_BG) && lcd_backdrop)
|
|
drmode |= DRMODE_INT_BD;
|
|
|
|
dst_row = FBADDR(x, y);
|
|
|
|
int col, row = height;
|
|
unsigned data, pixels;
|
|
unsigned skip_end = (stride_src - width);
|
|
unsigned skip_start = src_y * stride_src + src_x;
|
|
unsigned skip_start_image = STRIDE_MAIN(src_y * stride_image + src_x,
|
|
src_x * stride_image + src_y);
|
|
|
|
#ifdef ALPHA_BITMAP_READ_WORDS
|
|
uint32_t *src_w = (uint32_t *)((uintptr_t)src & ~3);
|
|
skip_start += ALPHA_COLOR_PIXEL_PER_BYTE * ((uintptr_t)src & 3);
|
|
src_w += skip_start / ALPHA_COLOR_PIXEL_PER_WORD;
|
|
data = letoh32(*src_w++) ^ dmask;
|
|
pixels = skip_start % ALPHA_COLOR_PIXEL_PER_WORD;
|
|
#else
|
|
src += skip_start / ALPHA_COLOR_PIXEL_PER_BYTE;
|
|
data = *src ^ dmask;
|
|
pixels = skip_start % ALPHA_COLOR_PIXEL_PER_BYTE;
|
|
#endif
|
|
data >>= pixels * ALPHA_COLOR_LOOKUP_SHIFT;
|
|
#ifdef ALPHA_BITMAP_READ_WORDS
|
|
pixels = 8 - pixels;
|
|
#endif
|
|
|
|
/* image is only accessed in DRMODE_INT_IMG cases, i.e. when non-NULL.
|
|
* Therefore NULL accesses are impossible and we can increment
|
|
* unconditionally (applies for stride at the end of the loop as well) */
|
|
image += skip_start_image;
|
|
/* go through the rows and update each pixel */
|
|
do
|
|
{
|
|
/* saving lcd_current_viewport->fg/bg_pattern and lcd_backdrop_offset into these
|
|
* temp vars just before the loop helps gcc to opimize the loop better
|
|
* (testing showed ~15% speedup) */
|
|
unsigned fg, bg;
|
|
ptrdiff_t bo, img_offset;
|
|
col = width;
|
|
dst = dst_row;
|
|
dst_row += ROW_INC;
|
|
#ifdef ALPHA_BITMAP_READ_WORDS
|
|
#define UPDATE_SRC_ALPHA do { \
|
|
if (--pixels) \
|
|
data >>= ALPHA_COLOR_LOOKUP_SHIFT; \
|
|
else \
|
|
{ \
|
|
data = letoh32(*src_w++) ^ dmask; \
|
|
pixels = ALPHA_COLOR_PIXEL_PER_WORD; \
|
|
} \
|
|
} while (0)
|
|
#elif ALPHA_COLOR_PIXEL_PER_BYTE == 2
|
|
#define UPDATE_SRC_ALPHA do { \
|
|
if (pixels ^= 1) \
|
|
data >>= ALPHA_COLOR_LOOKUP_SHIFT; \
|
|
else \
|
|
data = *(++src) ^ dmask; \
|
|
} while (0)
|
|
#else
|
|
#define UPDATE_SRC_ALPHA do { \
|
|
if (pixels = (++pixels % ALPHA_COLOR_PIXEL_PER_BYTE)) \
|
|
data >>= ALPHA_COLOR_LOOKUP_SHIFT; \
|
|
else \
|
|
data = *(++src) ^ dmask; \
|
|
} while (0)
|
|
#endif
|
|
|
|
switch (drmode)
|
|
{
|
|
case DRMODE_COMPLEMENT:
|
|
do
|
|
{
|
|
*dst = blend_two_colors(*dst, ~(*dst),
|
|
data & ALPHA_COLOR_LOOKUP_SIZE );
|
|
dst += COL_INC;
|
|
UPDATE_SRC_ALPHA;
|
|
}
|
|
while (--col);
|
|
break;
|
|
case DRMODE_BG|DRMODE_INT_BD:
|
|
bo = lcd_backdrop_offset;
|
|
do
|
|
{
|
|
fb_data c = *(fb_data *)((uintptr_t)dst + bo);
|
|
*dst = blend_two_colors(c, *dst, data & ALPHA_COLOR_LOOKUP_SIZE );
|
|
dst += COL_INC;
|
|
image += STRIDE_MAIN(1, stride_image);
|
|
UPDATE_SRC_ALPHA;
|
|
}
|
|
while (--col);
|
|
break;
|
|
case DRMODE_BG:
|
|
bg = lcd_current_viewport->bg_pattern;
|
|
do
|
|
{
|
|
*dst = blend_two_colors(bg, *dst, data & ALPHA_COLOR_LOOKUP_SIZE );
|
|
dst += COL_INC;
|
|
UPDATE_SRC_ALPHA;
|
|
}
|
|
while (--col);
|
|
break;
|
|
case DRMODE_FG|DRMODE_INT_IMG:
|
|
img_offset = image - dst;
|
|
do
|
|
{
|
|
*dst = blend_two_colors(*dst, *(dst + img_offset), data & ALPHA_COLOR_LOOKUP_SIZE );
|
|
dst += COL_INC;
|
|
UPDATE_SRC_ALPHA;
|
|
}
|
|
while (--col);
|
|
break;
|
|
case DRMODE_FG:
|
|
fg = lcd_current_viewport->fg_pattern;
|
|
do
|
|
{
|
|
*dst = blend_two_colors(*dst, fg, data & ALPHA_COLOR_LOOKUP_SIZE );
|
|
dst += COL_INC;
|
|
UPDATE_SRC_ALPHA;
|
|
}
|
|
while (--col);
|
|
break;
|
|
case DRMODE_SOLID|DRMODE_INT_BD:
|
|
bo = lcd_backdrop_offset;
|
|
fg = lcd_current_viewport->fg_pattern;
|
|
do
|
|
{
|
|
fb_data *c = (fb_data *)((uintptr_t)dst + bo);
|
|
*dst = blend_two_colors(*c, fg, data & ALPHA_COLOR_LOOKUP_SIZE );
|
|
dst += COL_INC;
|
|
UPDATE_SRC_ALPHA;
|
|
}
|
|
while (--col);
|
|
break;
|
|
case DRMODE_SOLID|DRMODE_INT_IMG:
|
|
bg = lcd_current_viewport->bg_pattern;
|
|
img_offset = image - dst;
|
|
do
|
|
{
|
|
*dst = blend_two_colors(bg, *(dst + img_offset), data & ALPHA_COLOR_LOOKUP_SIZE );
|
|
dst += COL_INC;
|
|
UPDATE_SRC_ALPHA;
|
|
}
|
|
while (--col);
|
|
break;
|
|
case DRMODE_SOLID|DRMODE_INT_BD|DRMODE_INT_IMG:
|
|
bo = lcd_backdrop_offset;
|
|
img_offset = image - dst;
|
|
do
|
|
{
|
|
fb_data *c = (fb_data *)((uintptr_t)dst + bo);
|
|
*dst = blend_two_colors(*c, *(dst + img_offset), data & ALPHA_COLOR_LOOKUP_SIZE );
|
|
dst += COL_INC;
|
|
UPDATE_SRC_ALPHA;
|
|
}
|
|
while (--col);
|
|
break;
|
|
case DRMODE_SOLID:
|
|
bg = lcd_current_viewport->bg_pattern;
|
|
fg = lcd_current_viewport->fg_pattern;
|
|
do
|
|
{
|
|
*dst = blend_two_colors(bg, fg, data & ALPHA_COLOR_LOOKUP_SIZE );
|
|
dst += COL_INC;
|
|
UPDATE_SRC_ALPHA;
|
|
}
|
|
while (--col);
|
|
break;
|
|
}
|
|
#ifdef ALPHA_BITMAP_READ_WORDS
|
|
if (skip_end < pixels)
|
|
{
|
|
pixels -= skip_end;
|
|
data >>= skip_end * ALPHA_COLOR_LOOKUP_SHIFT;
|
|
} else {
|
|
pixels = skip_end - pixels;
|
|
src_w += pixels / ALPHA_COLOR_PIXEL_PER_WORD;
|
|
pixels %= ALPHA_COLOR_PIXEL_PER_WORD;
|
|
data = letoh32(*src_w++) ^ dmask;
|
|
data >>= pixels * ALPHA_COLOR_LOOKUP_SHIFT;
|
|
pixels = 8 - pixels;
|
|
}
|
|
#else
|
|
if (skip_end)
|
|
{
|
|
pixels += skip_end;
|
|
if (pixels >= ALPHA_COLOR_PIXEL_PER_BYTE)
|
|
{
|
|
src += pixels / ALPHA_COLOR_PIXEL_PER_BYTE;
|
|
pixels %= ALPHA_COLOR_PIXEL_PER_BYTE;
|
|
data = *src ^ dmask;
|
|
data >>= pixels * ALPHA_COLOR_LOOKUP_SHIFT;
|
|
} else
|
|
data >>= skip_end * ALPHA_COLOR_LOOKUP_SHIFT;
|
|
}
|
|
#endif
|
|
|
|
image += STRIDE_MAIN(stride_image,1);
|
|
} while (--row);
|
|
|
|
BLEND_FINISH;
|
|
}
|