ed99b305a9
This reverts commit ffee661ab7.
Reason for revert: <INSERT REASONING HERE>
iAudio M5 `IRAM' overflowed by 48 bytes
Change-Id: Id808a72c6eacabc562d53eac8acd36b45f678a97
1128 lines
29 KiB
C
1128 lines
29 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright (C) 2004 by Linus Nielsen Feltzing
|
|
*
|
|
* 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.
|
|
*
|
|
****************************************************************************/
|
|
#include "config.h"
|
|
|
|
#include "system.h"
|
|
#include "cpu.h"
|
|
#include "kernel.h"
|
|
#include "lcd.h"
|
|
#include "thread.h"
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include "file.h"
|
|
#include "debug.h"
|
|
#include "font.h"
|
|
#include "rbunicode.h"
|
|
#include "bidi.h"
|
|
#include "scroll_engine.h"
|
|
|
|
/*** globals ***/
|
|
|
|
static fb_data lcd_static_framebuffer[LCD_FBHEIGHT][LCD_FBWIDTH] IRAM_LCDFRAMEBUFFER;
|
|
static void *lcd_frameaddress_default(int x, int y);
|
|
|
|
const unsigned char lcd_dibits[16] ICONST_ATTR = {
|
|
0x00, 0x03, 0x0C, 0x0F, 0x30, 0x33, 0x3C, 0x3F,
|
|
0xC0, 0xC3, 0xCC, 0xCF, 0xF0, 0xF3, 0xFC, 0xFF
|
|
};
|
|
|
|
static const unsigned char pixmask[4] ICONST_ATTR = {
|
|
0x03, 0x0C, 0x30, 0xC0
|
|
};
|
|
|
|
static fb_data* lcd_backdrop = NULL;
|
|
static long lcd_backdrop_offset IDATA_ATTR = 0;
|
|
|
|
/* shouldn't be changed unless you want system-wide framebuffer changes! */
|
|
struct frame_buffer_t lcd_framebuffer_default =
|
|
{
|
|
.fb_ptr = &lcd_static_framebuffer[0][0],
|
|
.get_address_fn = &lcd_frameaddress_default,
|
|
.stride = STRIDE_MAIN(LCD_WIDTH, LCD_HEIGHT),
|
|
.elems = (LCD_FBWIDTH*LCD_FBHEIGHT),
|
|
};
|
|
|
|
static struct viewport default_vp =
|
|
{
|
|
.x = 0,
|
|
.y = 0,
|
|
.width = LCD_WIDTH,
|
|
.height = LCD_HEIGHT,
|
|
.font = FONT_SYSFIXED,
|
|
.drawmode = DRMODE_SOLID,
|
|
.buffer = NULL,
|
|
.fg_pattern = LCD_DEFAULT_FG,
|
|
.bg_pattern = LCD_DEFAULT_BG
|
|
};
|
|
|
|
struct viewport* lcd_current_viewport IBSS_ATTR;
|
|
static unsigned fg_pattern IBSS_ATTR;
|
|
static unsigned bg_pattern IBSS_ATTR;
|
|
|
|
static void *lcd_frameaddress_default(int x, int y)
|
|
{
|
|
/* the default expects a buffer the same size as the screen */
|
|
struct frame_buffer_t *fb = lcd_current_viewport->buffer;
|
|
|
|
#if defined(LCD_STRIDEFORMAT) && LCD_STRIDEFORMAT == VERTICAL_STRIDE
|
|
size_t element = (x * LCD_NATIVE_STRIDE(fb->stride)) + y;
|
|
#else
|
|
size_t element = (y * LCD_NATIVE_STRIDE(fb->stride)) + x;
|
|
#endif
|
|
return fb->fb_ptr + element; /*(element % fb->elems);*/
|
|
}
|
|
|
|
/* LCD init */
|
|
void lcd_init(void)
|
|
{
|
|
/* Initialize the viewport */
|
|
lcd_set_viewport(NULL);
|
|
|
|
lcd_clear_display();
|
|
/* Call device specific init */
|
|
lcd_init_device();
|
|
scroll_init();
|
|
}
|
|
|
|
/*** parameter handling ***/
|
|
|
|
void lcd_set_drawmode(int mode)
|
|
{
|
|
lcd_current_viewport->drawmode = mode & (DRMODE_SOLID|DRMODE_INVERSEVID);
|
|
}
|
|
|
|
int lcd_get_drawmode(void)
|
|
{
|
|
return lcd_current_viewport->drawmode;
|
|
}
|
|
|
|
void lcd_set_foreground(unsigned brightness)
|
|
{
|
|
lcd_current_viewport->fg_pattern = brightness;
|
|
fg_pattern = 0x55 * (~brightness & 3);
|
|
}
|
|
|
|
unsigned lcd_get_foreground(void)
|
|
{
|
|
return lcd_current_viewport->fg_pattern;
|
|
}
|
|
|
|
void lcd_set_background(unsigned brightness)
|
|
{
|
|
lcd_current_viewport->bg_pattern = brightness;
|
|
bg_pattern = 0x55 * (~brightness & 3);
|
|
}
|
|
|
|
unsigned lcd_get_background(void)
|
|
{
|
|
return lcd_current_viewport->bg_pattern;
|
|
}
|
|
|
|
void lcd_set_drawinfo(int mode, unsigned fg_brightness, unsigned bg_brightness)
|
|
{
|
|
lcd_set_drawmode(mode);
|
|
lcd_set_foreground(fg_brightness);
|
|
lcd_set_background(bg_brightness);
|
|
}
|
|
|
|
int lcd_getwidth(void)
|
|
{
|
|
return lcd_current_viewport->width;
|
|
}
|
|
|
|
int lcd_getheight(void)
|
|
{
|
|
return lcd_current_viewport->height;
|
|
}
|
|
|
|
void lcd_setfont(int newfont)
|
|
{
|
|
lcd_current_viewport->font = newfont;
|
|
}
|
|
|
|
int lcd_getfont(void)
|
|
{
|
|
return lcd_current_viewport->font;
|
|
}
|
|
|
|
int lcd_getstringsize(const unsigned char *str, int *w, int *h)
|
|
{
|
|
return font_getstringsize(str, w, h, lcd_current_viewport->font);
|
|
}
|
|
|
|
/*** low-level drawing functions ***/
|
|
|
|
static void setpixel(int x, int y)
|
|
{
|
|
unsigned mask = pixmask[y & 3];
|
|
fb_data *address = FBADDR(x,y>>2);
|
|
unsigned data = *address;
|
|
|
|
*address = data ^ ((data ^ fg_pattern) & mask);
|
|
}
|
|
|
|
static void clearpixel(int x, int y)
|
|
{
|
|
unsigned mask = pixmask[y & 3];
|
|
fb_data *address = FBADDR(x,y>>2);
|
|
unsigned data = *address;
|
|
|
|
*address = data ^ ((data ^ bg_pattern) & mask);
|
|
}
|
|
|
|
static void clearimgpixel(int x, int y)
|
|
{
|
|
unsigned mask = pixmask[y & 3];
|
|
fb_data *address = FBADDR(x,y>>2);
|
|
unsigned data = *address;
|
|
|
|
*address = data ^ ((data ^ *(address + lcd_backdrop_offset)) & mask);
|
|
}
|
|
|
|
static void flippixel(int x, int y)
|
|
{
|
|
unsigned mask = pixmask[y & 3];
|
|
fb_data *address = FBADDR(x,y>>2);
|
|
|
|
*address ^= mask;
|
|
}
|
|
|
|
static void nopixel(int x, int y)
|
|
{
|
|
(void)x;
|
|
(void)y;
|
|
}
|
|
|
|
lcd_pixelfunc_type* const lcd_pixelfuncs_bgcolor[8] = {
|
|
flippixel, nopixel, setpixel, setpixel,
|
|
nopixel, clearpixel, nopixel, clearpixel
|
|
};
|
|
|
|
lcd_pixelfunc_type* const lcd_pixelfuncs_backdrop[8] = {
|
|
flippixel, nopixel, setpixel, setpixel,
|
|
nopixel, clearimgpixel, nopixel, clearimgpixel
|
|
};
|
|
|
|
|
|
lcd_pixelfunc_type* const * lcd_pixelfuncs = lcd_pixelfuncs_bgcolor;
|
|
|
|
/* 'mask' and 'bits' contain 2 bits per pixel */
|
|
static void ICODE_ATTR flipblock(fb_data *address, unsigned mask,
|
|
unsigned bits)
|
|
{
|
|
*address ^= bits & mask;
|
|
}
|
|
|
|
static void ICODE_ATTR bgblock(fb_data *address, unsigned mask,
|
|
unsigned bits)
|
|
{
|
|
unsigned data = *address;
|
|
|
|
*address = data ^ ((data ^ bg_pattern) & mask & ~bits);
|
|
}
|
|
|
|
static void ICODE_ATTR bgimgblock(fb_data *address, unsigned mask,
|
|
unsigned bits)
|
|
{
|
|
unsigned data = *address;
|
|
|
|
*address = data ^ ((data ^ *(address + lcd_backdrop_offset)) & mask & ~bits);
|
|
}
|
|
|
|
static void ICODE_ATTR fgblock(fb_data *address, unsigned mask,
|
|
unsigned bits)
|
|
{
|
|
unsigned data = *address;
|
|
|
|
*address = data ^ ((data ^ fg_pattern) & mask & bits);
|
|
}
|
|
|
|
static void ICODE_ATTR solidblock(fb_data *address, unsigned mask,
|
|
unsigned bits)
|
|
{
|
|
unsigned data = *address;
|
|
unsigned bgp = bg_pattern;
|
|
|
|
bits = bgp ^ ((bgp ^ fg_pattern) & bits);
|
|
*address = data ^ ((data ^ bits) & mask);
|
|
}
|
|
|
|
static void ICODE_ATTR solidimgblock(fb_data *address, unsigned mask,
|
|
unsigned bits)
|
|
{
|
|
unsigned data = *address;
|
|
unsigned bgp = *(address + lcd_backdrop_offset);
|
|
|
|
bits = bgp ^ ((bgp ^ fg_pattern) & bits);
|
|
*address = data ^ ((data ^ bits) & mask);
|
|
}
|
|
|
|
static void ICODE_ATTR flipinvblock(fb_data *address, unsigned mask,
|
|
unsigned bits)
|
|
{
|
|
*address ^= ~bits & mask;
|
|
}
|
|
|
|
static void ICODE_ATTR bginvblock(fb_data *address, unsigned mask,
|
|
unsigned bits)
|
|
{
|
|
unsigned data = *address;
|
|
|
|
*address = data ^ ((data ^ bg_pattern) & mask & bits);
|
|
}
|
|
|
|
static void ICODE_ATTR bgimginvblock(fb_data *address, unsigned mask,
|
|
unsigned bits)
|
|
{
|
|
unsigned data = *address;
|
|
|
|
*address = data ^ ((data ^ *(address + lcd_backdrop_offset)) & mask & bits);
|
|
}
|
|
|
|
static void ICODE_ATTR fginvblock(fb_data *address, unsigned mask,
|
|
unsigned bits)
|
|
{
|
|
unsigned data = *address;
|
|
|
|
*address = data ^ ((data ^ fg_pattern) & mask & ~bits);
|
|
}
|
|
|
|
static void ICODE_ATTR solidinvblock(fb_data *address, unsigned mask,
|
|
unsigned bits)
|
|
{
|
|
unsigned data = *address;
|
|
unsigned fgp = fg_pattern;
|
|
|
|
bits = fgp ^ ((fgp ^ bg_pattern) & bits);
|
|
*address = data ^ ((data ^ bits) & mask);
|
|
}
|
|
|
|
static void ICODE_ATTR solidimginvblock(fb_data *address, unsigned mask,
|
|
unsigned bits)
|
|
{
|
|
unsigned data = *address;
|
|
unsigned fgp = fg_pattern;
|
|
|
|
bits = fgp ^ ((fgp ^ *(address + lcd_backdrop_offset)) & bits);
|
|
*address = data ^ ((data ^ bits) & mask);
|
|
}
|
|
|
|
lcd_blockfunc_type* const lcd_blockfuncs_bgcolor[8] = {
|
|
flipblock, bgblock, fgblock, solidblock,
|
|
flipinvblock, bginvblock, fginvblock, solidinvblock
|
|
};
|
|
|
|
lcd_blockfunc_type* const lcd_blockfuncs_backdrop[8] = {
|
|
flipblock, bgimgblock, fgblock, solidimgblock,
|
|
flipinvblock, bgimginvblock, fginvblock, solidimginvblock
|
|
};
|
|
|
|
lcd_blockfunc_type* const * lcd_blockfuncs = lcd_blockfuncs_bgcolor;
|
|
|
|
|
|
void lcd_set_backdrop(fb_data* backdrop)
|
|
{
|
|
lcd_backdrop = backdrop;
|
|
if (backdrop)
|
|
{
|
|
lcd_backdrop_offset = (long)backdrop - (long)FBADDR(0,0);
|
|
lcd_pixelfuncs = lcd_pixelfuncs_backdrop;
|
|
lcd_blockfuncs = lcd_blockfuncs_backdrop;
|
|
}
|
|
else
|
|
{
|
|
lcd_backdrop_offset = 0;
|
|
lcd_pixelfuncs = lcd_pixelfuncs_bgcolor;
|
|
lcd_blockfuncs = lcd_blockfuncs_bgcolor;
|
|
}
|
|
}
|
|
|
|
fb_data* lcd_get_backdrop(void)
|
|
{
|
|
return lcd_backdrop;
|
|
}
|
|
|
|
|
|
static inline void setblock(fb_data *address, unsigned mask, unsigned bits)
|
|
{
|
|
unsigned data = *address;
|
|
|
|
bits ^= data;
|
|
*address = data ^ (bits & mask);
|
|
}
|
|
|
|
/*** drawing functions ***/
|
|
|
|
/* Clear the whole display */
|
|
void lcd_clear_display(void)
|
|
{
|
|
if (lcd_current_viewport->drawmode & DRMODE_INVERSEVID)
|
|
{
|
|
memset(FBADDR(0,0), fg_pattern, FRAMEBUFFER_SIZE);
|
|
}
|
|
else
|
|
{
|
|
if (lcd_backdrop)
|
|
memcpy(FBADDR(0,0), lcd_backdrop, FRAMEBUFFER_SIZE);
|
|
else
|
|
memset(FBADDR(0,0), bg_pattern, FRAMEBUFFER_SIZE);
|
|
}
|
|
|
|
lcd_scroll_info.lines = 0;
|
|
}
|
|
|
|
/* Clear the current viewport */
|
|
void lcd_clear_viewport(void)
|
|
{
|
|
int lastmode;
|
|
|
|
if (lcd_current_viewport == &default_vp &&
|
|
default_vp.buffer == &lcd_framebuffer_default)
|
|
{
|
|
lcd_clear_display();
|
|
}
|
|
else
|
|
{
|
|
lastmode = lcd_current_viewport->drawmode;
|
|
|
|
/* Invert the INVERSEVID bit and set basic mode to SOLID */
|
|
lcd_current_viewport->drawmode = (~lastmode & DRMODE_INVERSEVID) |
|
|
DRMODE_SOLID;
|
|
|
|
lcd_fillrect(0, 0, lcd_current_viewport->width, lcd_current_viewport->height);
|
|
|
|
lcd_current_viewport->drawmode = lastmode;
|
|
|
|
lcd_scroll_stop_viewport(lcd_current_viewport);
|
|
}
|
|
lcd_current_viewport->flags &= ~(VP_FLAG_VP_SET_CLEAN);
|
|
}
|
|
|
|
/* Set a single pixel */
|
|
void lcd_drawpixel(int x, int y)
|
|
{
|
|
if ( ((unsigned)x < (unsigned)lcd_current_viewport->width)
|
|
&& ((unsigned)y < (unsigned)lcd_current_viewport->height)
|
|
#if defined(HAVE_VIEWPORT_CLIP)
|
|
&& ((unsigned)x < (unsigned)LCD_WIDTH)
|
|
&& ((unsigned)y < (unsigned)LCD_HEIGHT)
|
|
#endif
|
|
)
|
|
lcd_pixelfuncs[lcd_current_viewport->drawmode](lcd_current_viewport->x + x, lcd_current_viewport->y + y);
|
|
}
|
|
|
|
/* Draw a line */
|
|
void lcd_drawline(int x1, int y1, int x2, int y2)
|
|
{
|
|
int numpixels;
|
|
int i;
|
|
int deltax, deltay;
|
|
int d, dinc1, dinc2;
|
|
int x, xinc1, xinc2;
|
|
int y, yinc1, yinc2;
|
|
lcd_pixelfunc_type *pfunc = lcd_pixelfuncs[lcd_current_viewport->drawmode];
|
|
|
|
deltax = abs(x2 - x1);
|
|
if (deltax == 0)
|
|
{
|
|
/* DEBUGF("lcd_drawline() called for vertical line - optimisation.\n"); */
|
|
lcd_vline(x1, y1, y2);
|
|
return;
|
|
}
|
|
deltay = abs(y2 - y1);
|
|
if (deltay == 0)
|
|
{
|
|
/* DEBUGF("lcd_drawline() called for horizontal line - optimisation.\n"); */
|
|
lcd_hline(x1, x2, y1);
|
|
return;
|
|
}
|
|
xinc2 = 1;
|
|
yinc2 = 1;
|
|
|
|
if (deltax >= deltay)
|
|
{
|
|
numpixels = deltax;
|
|
d = 2 * deltay - deltax;
|
|
dinc1 = deltay * 2;
|
|
dinc2 = (deltay - deltax) * 2;
|
|
xinc1 = 1;
|
|
yinc1 = 0;
|
|
}
|
|
else
|
|
{
|
|
numpixels = deltay;
|
|
d = 2 * deltax - deltay;
|
|
dinc1 = deltax * 2;
|
|
dinc2 = (deltax - deltay) * 2;
|
|
xinc1 = 0;
|
|
yinc1 = 1;
|
|
}
|
|
numpixels++; /* include endpoints */
|
|
|
|
if (x1 > x2)
|
|
{
|
|
xinc1 = -xinc1;
|
|
xinc2 = -xinc2;
|
|
}
|
|
|
|
if (y1 > y2)
|
|
{
|
|
yinc1 = -yinc1;
|
|
yinc2 = -yinc2;
|
|
}
|
|
|
|
x = x1;
|
|
y = y1;
|
|
|
|
for (i = 0; i < numpixels; i++)
|
|
{
|
|
if ( ((unsigned)x < (unsigned)lcd_current_viewport->width)
|
|
&& ((unsigned)y < (unsigned)lcd_current_viewport->height)
|
|
#if defined(HAVE_VIEWPORT_CLIP)
|
|
&& ((unsigned)x < (unsigned)LCD_WIDTH)
|
|
&& ((unsigned)y < (unsigned)LCD_HEIGHT)
|
|
#endif
|
|
)
|
|
pfunc(lcd_current_viewport->x + x, lcd_current_viewport->y + y);
|
|
|
|
if (d < 0)
|
|
{
|
|
d += dinc1;
|
|
x += xinc1;
|
|
y += yinc1;
|
|
}
|
|
else
|
|
{
|
|
d += dinc2;
|
|
x += xinc2;
|
|
y += yinc2;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Draw a horizontal line (optimised) */
|
|
void lcd_hline(int x1, int x2, int y)
|
|
{
|
|
int x;
|
|
int width;
|
|
fb_data *dst, *dst_end;
|
|
unsigned mask;
|
|
lcd_blockfunc_type *bfunc;
|
|
|
|
/* direction flip */
|
|
if (x2 < x1)
|
|
{
|
|
x = x1;
|
|
x1 = x2;
|
|
x2 = x;
|
|
}
|
|
|
|
/******************** In viewport clipping **********************/
|
|
/* nothing to draw? */
|
|
if (((unsigned)y >= (unsigned)lcd_current_viewport->height) || (x1 >= lcd_current_viewport->width)
|
|
|| (x2 < 0))
|
|
return;
|
|
|
|
if (x1 < 0)
|
|
x1 = 0;
|
|
if (x2 >= lcd_current_viewport->width)
|
|
x2 = lcd_current_viewport->width-1;
|
|
|
|
/* adjust x1 and y to viewport */
|
|
x1 += lcd_current_viewport->x;
|
|
x2 += lcd_current_viewport->x;
|
|
y += lcd_current_viewport->y;
|
|
|
|
#if defined(HAVE_VIEWPORT_CLIP)
|
|
/********************* Viewport on screen clipping ********************/
|
|
/* nothing to draw? */
|
|
if (((unsigned)y >= (unsigned) LCD_HEIGHT) || (x1 >= LCD_WIDTH)
|
|
|| (x2 < 0))
|
|
return;
|
|
|
|
/* clipping */
|
|
if (x1 < 0)
|
|
x1 = 0;
|
|
if (x2 >= LCD_WIDTH)
|
|
x2 = LCD_WIDTH-1;
|
|
#endif
|
|
|
|
width = x2 - x1 + 1;
|
|
|
|
bfunc = lcd_blockfuncs[lcd_current_viewport->drawmode];
|
|
dst = FBADDR(x1,y>>2);
|
|
mask = pixmask[y & 3];
|
|
|
|
dst_end = dst + width;
|
|
do
|
|
bfunc(dst++, mask, 0xFFu);
|
|
while (dst < dst_end);
|
|
}
|
|
|
|
/* Draw a vertical line (optimised) */
|
|
void lcd_vline(int x, int y1, int y2)
|
|
{
|
|
int ny;
|
|
fb_data *dst;
|
|
int stride_dst;
|
|
unsigned mask, mask_bottom;
|
|
lcd_blockfunc_type *bfunc;
|
|
|
|
/* direction flip */
|
|
if (y2 < y1)
|
|
{
|
|
ny = y1;
|
|
y1 = y2;
|
|
y2 = ny;
|
|
}
|
|
|
|
/******************** In viewport clipping **********************/
|
|
/* nothing to draw? */
|
|
if (((unsigned)x >= (unsigned)lcd_current_viewport->width) || (y1 >= lcd_current_viewport->height)
|
|
|| (y2 < 0))
|
|
return;
|
|
|
|
if (y1 < 0)
|
|
y1 = 0;
|
|
if (y2 >= lcd_current_viewport->height)
|
|
y2 = lcd_current_viewport->height-1;
|
|
|
|
/* adjust for viewport */
|
|
y1 += lcd_current_viewport->y;
|
|
y2 += lcd_current_viewport->y;
|
|
x += lcd_current_viewport->x;
|
|
|
|
#if defined(HAVE_VIEWPORT_CLIP)
|
|
/********************* Viewport on screen clipping ********************/
|
|
/* nothing to draw? */
|
|
if (( (unsigned) x >= (unsigned)LCD_WIDTH) || (y1 >= LCD_HEIGHT)
|
|
|| (y2 < 0))
|
|
return;
|
|
|
|
/* clipping */
|
|
if (y1 < 0)
|
|
y1 = 0;
|
|
if (y2 >= LCD_HEIGHT)
|
|
y2 = LCD_HEIGHT-1;
|
|
#endif
|
|
|
|
bfunc = lcd_blockfuncs[lcd_current_viewport->drawmode];
|
|
dst = FBADDR(x,y1>>2);
|
|
stride_dst = lcd_current_viewport->buffer->stride;
|
|
ny = y2 - (y1 & ~3);
|
|
mask = 0xFFu << (2 * (y1 & 3));
|
|
mask_bottom = 0xFFu >> (2 * (~ny & 3));
|
|
|
|
for (; ny >= 4; ny -= 4)
|
|
{
|
|
bfunc(dst, mask, 0xFFu);
|
|
dst += stride_dst;
|
|
mask = 0xFFu;
|
|
}
|
|
mask &= mask_bottom;
|
|
bfunc(dst, mask, 0xFFu);
|
|
}
|
|
|
|
/* Draw a rectangular box */
|
|
void lcd_drawrect(int x, int y, int width, int height)
|
|
{
|
|
if ((width <= 0) || (height <= 0))
|
|
return;
|
|
|
|
int x2 = x + width - 1;
|
|
int y2 = y + height - 1;
|
|
|
|
lcd_vline(x, y, y2);
|
|
lcd_vline(x2, y, y2);
|
|
lcd_hline(x, x2, y);
|
|
lcd_hline(x, x2, y2);
|
|
}
|
|
|
|
/* Fill a rectangular area */
|
|
void lcd_fillrect(int x, int y, int width, int height)
|
|
{
|
|
int ny;
|
|
fb_data *dst, *dst_end;
|
|
int stride_dst;
|
|
unsigned mask, mask_bottom;
|
|
unsigned bits = 0;
|
|
lcd_blockfunc_type *bfunc;
|
|
bool fillopt = false;
|
|
|
|
/******************** 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
|
|
|
|
if (lcd_current_viewport->drawmode & DRMODE_INVERSEVID)
|
|
{
|
|
if ((lcd_current_viewport->drawmode & DRMODE_BG) && !lcd_backdrop)
|
|
{
|
|
fillopt = true;
|
|
bits = bg_pattern;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if (lcd_current_viewport->drawmode & DRMODE_FG)
|
|
{
|
|
fillopt = true;
|
|
bits = fg_pattern;
|
|
}
|
|
}
|
|
bfunc = lcd_blockfuncs[lcd_current_viewport->drawmode];
|
|
dst = FBADDR(x,y>>2);
|
|
stride_dst = lcd_current_viewport->buffer->stride;
|
|
ny = height - 1 + (y & 3);
|
|
mask = 0xFFu << (2 * (y & 3));
|
|
mask_bottom = 0xFFu >> (2 * (~ny & 3));
|
|
|
|
for (; ny >= 4; ny -= 4)
|
|
{
|
|
if (fillopt && (mask == 0xFFu))
|
|
memset(dst, bits, width);
|
|
else
|
|
{
|
|
fb_data *dst_row = dst;
|
|
|
|
dst_end = dst_row + width;
|
|
do
|
|
bfunc(dst_row++, mask, 0xFFu);
|
|
while (dst_row < dst_end);
|
|
}
|
|
|
|
dst += stride_dst;
|
|
mask = 0xFFu;
|
|
}
|
|
mask &= mask_bottom;
|
|
|
|
if (fillopt && (mask == 0xFFu))
|
|
memset(dst, bits, width);
|
|
else
|
|
{
|
|
dst_end = dst + width;
|
|
do
|
|
bfunc(dst++, mask, 0xFFu);
|
|
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 similar to the internal lcd hw format. */
|
|
|
|
/* 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)
|
|
{
|
|
int shift, ny;
|
|
fb_data *dst, *dst_end;
|
|
int stride_dst;
|
|
unsigned mask, mask_bottom;
|
|
lcd_blockfunc_type *bfunc;
|
|
|
|
/******************** 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;
|
|
|
|
/* 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;
|
|
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
|
|
|
|
src += stride * (src_y >> 3) + src_x; /* move starting point */
|
|
src_y &= 7;
|
|
y -= src_y;
|
|
dst = FBADDR(x,y>>2);
|
|
stride_dst = lcd_current_viewport->buffer->stride;
|
|
shift = y & 3;
|
|
ny = height - 1 + shift + src_y;
|
|
mask = 0xFFFFu << (2 * (shift + src_y));
|
|
/* Overflowing bits aren't important. */
|
|
mask_bottom = 0xFFFFu >> (2 * (~ny & 7));
|
|
|
|
bfunc = lcd_blockfuncs[lcd_current_viewport->drawmode];
|
|
|
|
if (shift == 0)
|
|
{
|
|
unsigned dmask1, dmask2, data;
|
|
|
|
dmask1 = mask & 0xFFu;
|
|
dmask2 = mask >> 8;
|
|
|
|
for (; ny >= 8; ny -= 8)
|
|
{
|
|
const unsigned char *src_row = src;
|
|
fb_data *dst_row = dst + stride_dst;
|
|
|
|
dst_end = dst_row + width;
|
|
|
|
if (dmask1 != 0)
|
|
{
|
|
do
|
|
{
|
|
data = *src_row++;
|
|
bfunc(dst_row - stride_dst, dmask1, lcd_dibits[data&0x0F]);
|
|
bfunc(dst_row++, dmask2, lcd_dibits[(data>>4)&0x0F]);
|
|
}
|
|
while (dst_row < dst_end);
|
|
}
|
|
else
|
|
{
|
|
do
|
|
bfunc(dst_row++, dmask2, lcd_dibits[((*src_row++)>>4)&0x0F]);
|
|
while (dst_row < dst_end);
|
|
}
|
|
src += stride;
|
|
dst += 2*stride_dst;
|
|
dmask1 = dmask2 = 0xFFu;
|
|
}
|
|
dmask1 &= mask_bottom;
|
|
/* & 0xFFu is unnecessary here - dmask1 can't exceed that*/
|
|
dmask2 &= (mask_bottom >> 8);
|
|
dst_end = dst + width;
|
|
|
|
if (dmask1 != 0)
|
|
{
|
|
if (dmask2 != 0)
|
|
{
|
|
do
|
|
{
|
|
data = *src++;
|
|
bfunc(dst, dmask1, lcd_dibits[data&0x0F]);
|
|
bfunc((dst++) + stride_dst, dmask2, lcd_dibits[(data>>4)&0x0F]);
|
|
}
|
|
while (dst < dst_end);
|
|
}
|
|
else
|
|
{
|
|
do
|
|
bfunc(dst++, dmask1, lcd_dibits[(*src++)&0x0F]);
|
|
while (dst < dst_end);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
do
|
|
bfunc((dst++) + stride_dst, dmask2, lcd_dibits[((*src++)>>4)&0x0F]);
|
|
while (dst < dst_end);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
dst_end = dst + width;
|
|
do
|
|
{
|
|
const unsigned char *src_col = src++;
|
|
fb_data *dst_col = dst++;
|
|
unsigned mask_col = mask;
|
|
unsigned data = 0;
|
|
|
|
for (y = ny; y >= 8; y -= 8)
|
|
{
|
|
data |= *src_col << shift;
|
|
|
|
if (mask_col & 0xFFFFu)
|
|
{
|
|
if (mask_col & 0xFFu)
|
|
bfunc(dst_col, mask_col, lcd_dibits[data&0x0F]);
|
|
bfunc(dst_col + stride_dst, mask_col >> 8,
|
|
lcd_dibits[(data>>4)&0x0F]);
|
|
mask_col = 0xFFFFu;
|
|
}
|
|
else
|
|
mask_col >>= 16;
|
|
|
|
src_col += stride;
|
|
dst_col += 2*stride_dst;
|
|
data >>= 8;
|
|
}
|
|
data |= *src_col << shift;
|
|
mask_col &= mask_bottom ;
|
|
if (mask_col & 0xFFu)
|
|
bfunc(dst_col, mask_col, lcd_dibits[data&0x0F]);
|
|
if (mask_col & 0xFF00u)
|
|
bfunc(dst_col + stride_dst, mask_col >> 8,
|
|
lcd_dibits[(data>>4)&0x0F]);
|
|
}
|
|
while (dst < dst_end);
|
|
}
|
|
}
|
|
|
|
/* 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 native bitmap format:
|
|
*
|
|
* A bitmap contains two bits for every pixel. 00 = white, 01 = light grey,
|
|
* 10 = dark grey, 11 = black. 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..3, the second row defines pixel row 4..7 etc.
|
|
*
|
|
* This is the same as the internal lcd hw format. */
|
|
|
|
/* Draw a partial native bitmap */
|
|
void ICODE_ATTR lcd_bitmap_part(const fb_data *src, int src_x, int src_y,
|
|
int stride, int x, int y, int width,
|
|
int height)
|
|
{
|
|
int shift, ny;
|
|
fb_data *dst, *dst_end;
|
|
int stride_dst;
|
|
unsigned mask, mask_bottom;
|
|
|
|
/******************** 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;
|
|
|
|
/* 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;
|
|
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
|
|
src += stride * (src_y >> 2) + src_x; /* move starting point */
|
|
src_y &= 3;
|
|
y -= src_y;
|
|
dst = FBADDR(x,y>>2);
|
|
stride_dst = lcd_current_viewport->buffer->stride;
|
|
shift = y & 3;
|
|
ny = height - 1 + shift + src_y;
|
|
|
|
mask = 0xFFu << (2 * (shift + src_y));
|
|
mask_bottom = 0xFFu >> (2 * (~ny & 3));
|
|
|
|
if (shift == 0)
|
|
{
|
|
for (; ny >= 4; ny -= 4)
|
|
{
|
|
if (mask == 0xFFu)
|
|
memcpy(dst, src, width);
|
|
else
|
|
{
|
|
const fb_data *src_row = src;
|
|
fb_data *dst_row = dst;
|
|
|
|
dst_end = dst_row + width;
|
|
do
|
|
setblock(dst_row++, mask, *src_row++);
|
|
while (dst_row < dst_end);
|
|
}
|
|
src += stride;
|
|
dst += stride_dst;
|
|
mask = 0xFFu;
|
|
}
|
|
mask &= mask_bottom;
|
|
|
|
if (mask == 0xFFu)
|
|
memcpy(dst, src, width);
|
|
else
|
|
{
|
|
dst_end = dst + width;
|
|
do
|
|
setblock(dst++, mask, *src++);
|
|
while (dst < dst_end);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
shift *= 2;
|
|
dst_end = dst + width;
|
|
do
|
|
{
|
|
const fb_data *src_col = src++;
|
|
fb_data *dst_col = dst++;
|
|
unsigned mask_col = mask;
|
|
unsigned data = 0;
|
|
|
|
for (y = ny; y >= 4; y -= 4)
|
|
{
|
|
data |= *src_col << shift;
|
|
|
|
if (mask_col & 0xFFu)
|
|
{
|
|
setblock(dst_col, mask_col, data);
|
|
mask_col = 0xFFu;
|
|
}
|
|
else
|
|
mask_col >>= 8;
|
|
|
|
src_col += stride;
|
|
dst_col += stride_dst;
|
|
data >>= 8;
|
|
}
|
|
data |= *src_col << shift;
|
|
setblock(dst_col, mask_col & mask_bottom, data);
|
|
}
|
|
while (dst < dst_end);
|
|
}
|
|
}
|
|
|
|
/* Draw a full native bitmap */
|
|
void lcd_bitmap(const fb_data *src, int x, int y, int width, int height)
|
|
{
|
|
lcd_bitmap_part(src, 0, 0, width, x, y, width, height);
|
|
}
|
|
|
|
#include "lcd-bitmap-common.c"
|