328 lines
8.4 KiB
C
328 lines
8.4 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright (C) 2009 by Mark Arigo
|
|
*
|
|
* 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 "cpu.h"
|
|
#include "lcd.h"
|
|
#include "kernel.h"
|
|
#include "system.h"
|
|
|
|
/* register defines for Philips LCD 220x176x16 - model: LPH9165-2 */
|
|
#define LCD_REG_UNKNOWN_00 0x00
|
|
#define LCD_REG_UNKNOWN_01 0x01
|
|
#define LCD_REG_UNKNOWN_05 0x05
|
|
#define LCD_REG_WRITE_DATA_2_GRAM 0x06
|
|
#define LCD_REG_HORIZ_ADDR_START 0x08
|
|
#define LCD_REG_HORIZ_ADDR_END 0x09
|
|
#define LCD_REG_VERT_ADDR_START 0x0a
|
|
#define LCD_REG_VERT_ADDR_END 0x0b
|
|
|
|
/* whether the lcd is currently enabled or not */
|
|
static bool lcd_enabled;
|
|
|
|
/* Display status */
|
|
static unsigned lcd_yuv_options SHAREDBSS_ATTR = 0;
|
|
|
|
/* Value used for flipping. Must be remembered when display is turned off. */
|
|
static unsigned short flip;
|
|
|
|
/* Used for flip offset correction */
|
|
static int x_offset;
|
|
|
|
/* Inverse value. Must be remembered when display is turned off. */
|
|
static unsigned short invert;
|
|
|
|
/* wait for LCD */
|
|
static inline void lcd_wait_write(void)
|
|
{
|
|
while (LCD2_PORT & LCD2_BUSY_MASK);
|
|
}
|
|
|
|
/* send LCD data */
|
|
static void lcd_send_data(unsigned data)
|
|
{
|
|
lcd_wait_write();
|
|
LCD2_PORT = LCD2_DATA_MASK | (data & 0xff);
|
|
}
|
|
|
|
/* send LCD command */
|
|
static void lcd_send_reg(unsigned reg)
|
|
{
|
|
lcd_wait_write();
|
|
LCD2_PORT = LCD2_CMD_MASK | (reg & 0xff);
|
|
lcd_wait_write();
|
|
}
|
|
|
|
void lcd_init_device(void)
|
|
{
|
|
x_offset = 16;
|
|
invert = 0x00;
|
|
flip = 0x40;
|
|
|
|
lcd_enabled = true;
|
|
}
|
|
|
|
#ifdef HAVE_LCD_ENABLE
|
|
/* enable / disable lcd */
|
|
void lcd_enable(bool on)
|
|
{
|
|
if (on == lcd_enabled)
|
|
return;
|
|
|
|
if (on) /* lcd_display_on() */
|
|
{
|
|
lcd_send_reg(LCD_REG_UNKNOWN_00);
|
|
lcd_send_data(0x00 | invert);
|
|
lcd_send_reg(LCD_REG_UNKNOWN_01);
|
|
lcd_send_data(0x08 | flip);
|
|
lcd_send_reg(LCD_REG_UNKNOWN_05);
|
|
lcd_send_data(0x0f);
|
|
sleep(HZ/10); /* 100ms */
|
|
|
|
/* Probably out of sync and we don't wanna pepper the code with
|
|
lcd_update() calls for this. */
|
|
lcd_update();
|
|
send_event(LCD_EVENT_ACTIVATION, NULL);
|
|
|
|
lcd_enabled = true;
|
|
}
|
|
else /* lcd_display_off() */
|
|
{
|
|
lcd_send_reg(LCD_REG_UNKNOWN_00);
|
|
lcd_send_data(0x08);
|
|
|
|
lcd_enabled = false;
|
|
}
|
|
}
|
|
|
|
|
|
bool lcd_active(void)
|
|
{
|
|
return lcd_enabled;
|
|
}
|
|
#endif /* HAVE_LCD_ENABLE */
|
|
|
|
|
|
/*** hardware configuration ***/
|
|
int lcd_default_contrast(void)
|
|
{
|
|
return DEFAULT_CONTRAST_SETTING;
|
|
}
|
|
|
|
void lcd_set_contrast(int val)
|
|
{
|
|
(void)val;
|
|
}
|
|
|
|
void lcd_set_invert_display(bool yesno)
|
|
{
|
|
invert = (yesno) ? 0x40 : 0x00;
|
|
lcd_send_reg(LCD_REG_UNKNOWN_00);
|
|
lcd_send_data(invert);
|
|
}
|
|
|
|
/* turn the display upside down (call lcd_update() afterwards) */
|
|
void lcd_set_flip(bool yesno)
|
|
{
|
|
flip = (yesno) ? 0x80 : 0x40;
|
|
x_offset = (yesno) ? 4 : 16;
|
|
lcd_send_reg(LCD_REG_UNKNOWN_01);
|
|
lcd_send_data(0x08 | flip);
|
|
}
|
|
|
|
void lcd_yuv_set_options(unsigned options)
|
|
{
|
|
lcd_yuv_options = options;
|
|
}
|
|
|
|
#define CSUB_X 2
|
|
#define CSUB_Y 2
|
|
|
|
/* YUV- > RGB565 conversion
|
|
* |R| |1.000000 -0.000001 1.402000| |Y'|
|
|
* |G| = |1.000000 -0.334136 -0.714136| |Pb|
|
|
* |B| |1.000000 1.772000 0.000000| |Pr|
|
|
* Scaled, normalized, rounded and tweaked to yield RGB 565:
|
|
* |R| |74 0 101| |Y' - 16| >> 9
|
|
* |G| = |74 -24 -51| |Cb - 128| >> 8
|
|
* |B| |74 128 0| |Cr - 128| >> 9
|
|
*/
|
|
|
|
extern void lcd_yuv_write_inner_loop(unsigned char const * const ysrc,
|
|
unsigned char const * const usrc,
|
|
unsigned char const * const vsrc,
|
|
int width);
|
|
|
|
/* Performance function to blit a YUV bitmap directly to the LCD */
|
|
void lcd_blit_yuv(unsigned char * const src[3],
|
|
int src_x, int src_y, int stride,
|
|
int x, int y, int width, int height)
|
|
{
|
|
int h;
|
|
|
|
width = (width + 1) & ~1;
|
|
|
|
lcd_send_reg(LCD_REG_HORIZ_ADDR_START);
|
|
lcd_send_data(y);
|
|
|
|
lcd_send_reg(LCD_REG_HORIZ_ADDR_END);
|
|
lcd_send_data(y + height - 1);
|
|
|
|
lcd_send_reg(LCD_REG_VERT_ADDR_START);
|
|
lcd_send_data(x + x_offset);
|
|
|
|
lcd_send_reg(LCD_REG_VERT_ADDR_END);
|
|
lcd_send_data(x + width - 1 + x_offset);
|
|
|
|
lcd_send_reg(LCD_REG_WRITE_DATA_2_GRAM);
|
|
|
|
const int stride_div_csub_x = stride/CSUB_X;
|
|
|
|
h=0;
|
|
while (1)
|
|
{
|
|
/* upsampling, YUV->RGB conversion and reduction to RGB565 in one go */
|
|
const unsigned char *ysrc = src[0] + stride * src_y + src_x;
|
|
|
|
const int uvoffset = stride_div_csub_x * (src_y/CSUB_Y) +
|
|
(src_x/CSUB_X);
|
|
|
|
const unsigned char *usrc = src[1] + uvoffset;
|
|
const unsigned char *vsrc = src[2] + uvoffset;
|
|
|
|
int pixels_to_write;
|
|
|
|
if (h==0)
|
|
{
|
|
while (!(LCD2_BLOCK_CTRL & LCD2_BLOCK_READY));
|
|
LCD2_BLOCK_CONFIG = 0;
|
|
|
|
if (height == 0) break;
|
|
|
|
pixels_to_write = (width * height) * 2;
|
|
h = height;
|
|
|
|
/* calculate how much we can do in one go */
|
|
if (pixels_to_write > 0x10000)
|
|
{
|
|
h = (0x10000/2) / width;
|
|
pixels_to_write = (width * h) * 2;
|
|
}
|
|
|
|
height -= h;
|
|
LCD2_BLOCK_CTRL = 0x10000080;
|
|
LCD2_BLOCK_CONFIG = 0xc0010000 | (pixels_to_write - 1);
|
|
LCD2_BLOCK_CTRL = 0x34000000;
|
|
}
|
|
|
|
lcd_yuv_write_inner_loop(ysrc,usrc,vsrc,width);
|
|
|
|
src_y++;
|
|
h--;
|
|
}
|
|
|
|
while (!(LCD2_BLOCK_CTRL & LCD2_BLOCK_READY));
|
|
LCD2_BLOCK_CONFIG = 0;
|
|
}
|
|
|
|
/* Update the display.
|
|
This must be called after all other LCD functions that change the display. */
|
|
void lcd_update(void)
|
|
{
|
|
lcd_update_rect(0, 0, LCD_WIDTH, LCD_HEIGHT);
|
|
}
|
|
|
|
/* Update a fraction of the display. */
|
|
void lcd_update_rect(int x, int y, int width, int height)
|
|
{
|
|
unsigned long *addr;
|
|
int new_x, new_width;
|
|
|
|
/* Ensure x and width are both even - so we can read 32-bit aligned
|
|
data from lcd_framebuffer */
|
|
new_x = x&~1;
|
|
new_width = width&~1;
|
|
if (new_x+new_width < x+width) new_width += 2;
|
|
x = new_x;
|
|
width = new_width;
|
|
|
|
if (x + width >= LCD_WIDTH)
|
|
width = LCD_WIDTH - x;
|
|
if (y + height >= LCD_HEIGHT)
|
|
height = LCD_HEIGHT - y;
|
|
|
|
if ((width <= 0) || (height <= 0))
|
|
return; /* Nothing left to do. */
|
|
|
|
lcd_send_reg(LCD_REG_HORIZ_ADDR_START);
|
|
lcd_send_data(y);
|
|
|
|
lcd_send_reg(LCD_REG_HORIZ_ADDR_END);
|
|
lcd_send_data(y + height - 1);
|
|
|
|
lcd_send_reg(LCD_REG_VERT_ADDR_START);
|
|
lcd_send_data(x + x_offset);
|
|
|
|
lcd_send_reg(LCD_REG_VERT_ADDR_END);
|
|
lcd_send_data(x + width - 1 + x_offset);
|
|
|
|
lcd_send_reg(LCD_REG_WRITE_DATA_2_GRAM);
|
|
|
|
addr = (unsigned long*)FBADDR(x,y);
|
|
|
|
while (height > 0)
|
|
{
|
|
int c, r;
|
|
int h, pixels_to_write;
|
|
|
|
pixels_to_write = (width * height) * 2;
|
|
h = height;
|
|
|
|
/* calculate how much we can do in one go */
|
|
if (pixels_to_write > 0x10000)
|
|
{
|
|
h = (0x10000/2) / width;
|
|
pixels_to_write = (width * h) * 2;
|
|
}
|
|
|
|
LCD2_BLOCK_CTRL = 0x10000080;
|
|
LCD2_BLOCK_CONFIG = 0xc0010000 | (pixels_to_write - 1);
|
|
LCD2_BLOCK_CTRL = 0x34000000;
|
|
|
|
/* for each row */
|
|
for (r = 0; r < h; r++)
|
|
{
|
|
/* for each column */
|
|
for (c = 0; c < width; c += 2)
|
|
{
|
|
while (!(LCD2_BLOCK_CTRL & LCD2_BLOCK_TXOK));
|
|
|
|
/* output 2 pixels */
|
|
LCD2_BLOCK_DATA = *addr++;
|
|
}
|
|
addr += (LCD_WIDTH - width)/2;
|
|
}
|
|
|
|
while (!(LCD2_BLOCK_CTRL & LCD2_BLOCK_READY));
|
|
LCD2_BLOCK_CONFIG = 0;
|
|
|
|
height -= h;
|
|
}
|
|
}
|