446445e916
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@27752 a1c6a512-1295-4272-9138-f99709370657
424 lines
13 KiB
C
424 lines
13 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright (C) 2009 by Dave Chapman
|
|
*
|
|
* 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 "hwcompat.h"
|
|
#include "kernel.h"
|
|
#include "lcd.h"
|
|
#include "system.h"
|
|
#include "cpu.h"
|
|
#include "pmu-target.h"
|
|
|
|
|
|
/* The Nano 2G has two different LCD types. What we call "type 0"
|
|
appears to be similar to the ILI9320 and "type 1" is similar to the
|
|
LDS176.
|
|
*/
|
|
|
|
/* LCD type 0 register defines */
|
|
|
|
#define R_ENTRY_MODE 0x03
|
|
#define R_DISPLAY_CONTROL_1 0x07
|
|
#define R_POWER_CONTROL_1 0x10
|
|
#define R_POWER_CONTROL_2 0x12
|
|
#define R_POWER_CONTROL_3 0x13
|
|
#define R_HORIZ_GRAM_ADDR_SET 0x20
|
|
#define R_VERT_GRAM_ADDR_SET 0x21
|
|
#define R_WRITE_DATA_TO_GRAM 0x22
|
|
#define R_HORIZ_ADDR_START_POS 0x50
|
|
#define R_HORIZ_ADDR_END_POS 0x51
|
|
#define R_VERT_ADDR_START_POS 0x52
|
|
#define R_VERT_ADDR_END_POS 0x53
|
|
|
|
|
|
/* LCD type 1 register defines */
|
|
|
|
#define R_SLEEP_IN 0x10
|
|
#define R_DISPLAY_OFF 0x28
|
|
#define R_COLUMN_ADDR_SET 0x2a
|
|
#define R_ROW_ADDR_SET 0x2b
|
|
#define R_MEMORY_WRITE 0x2c
|
|
|
|
|
|
/** globals **/
|
|
|
|
int lcd_type; /* also needed in debug-s5l8700.c */
|
|
static int xoffset; /* needed for flip */
|
|
|
|
/** hardware access functions */
|
|
|
|
static inline void s5l_lcd_write_cmd_data(int cmd, int data)
|
|
{
|
|
while (LCD_STATUS & 0x10);
|
|
LCD_WCMD = cmd >> 8;
|
|
while (LCD_STATUS & 0x10);
|
|
LCD_WCMD = cmd & 0xff;
|
|
|
|
while (LCD_STATUS & 0x10);
|
|
LCD_WDATA = data >> 8;
|
|
while (LCD_STATUS & 0x10);
|
|
LCD_WDATA = data & 0xff;
|
|
}
|
|
|
|
static inline void s5l_lcd_write_cmd(unsigned short cmd)
|
|
{
|
|
while (LCD_STATUS & 0x10);
|
|
LCD_WCMD = cmd;
|
|
}
|
|
|
|
static inline void s5l_lcd_write_data(int data)
|
|
{
|
|
while (LCD_STATUS & 0x10);
|
|
LCD_WDATA = data >> 8;
|
|
while (LCD_STATUS & 0x10);
|
|
LCD_WDATA = data & 0xff;
|
|
}
|
|
|
|
/*** hardware configuration ***/
|
|
|
|
int lcd_default_contrast(void)
|
|
{
|
|
return 0x1f;
|
|
}
|
|
|
|
void lcd_set_contrast(int val)
|
|
{
|
|
(void)val;
|
|
}
|
|
|
|
void lcd_set_invert_display(bool yesno)
|
|
{
|
|
(void)yesno;
|
|
}
|
|
|
|
/* turn the display upside down (call lcd_update() afterwards) */
|
|
void lcd_set_flip(bool yesno)
|
|
{
|
|
/* TODO: flip mode isn't working. The commands in the else part of
|
|
this function are how the original firmware inits the LCD */
|
|
|
|
if (yesno)
|
|
{
|
|
xoffset = 132 - LCD_WIDTH; /* 132 colums minus the 128 we have */
|
|
}
|
|
else
|
|
{
|
|
xoffset = 0;
|
|
}
|
|
}
|
|
|
|
void lcd_shutdown(void)
|
|
{
|
|
pmu_write(0x2b, 0); /* Kill the backlight, instantly. */
|
|
pmu_write(0x29, 0);
|
|
|
|
if (lcd_type == 0)
|
|
{
|
|
s5l_lcd_write_cmd_data(R_DISPLAY_CONTROL_1, 0x232);
|
|
s5l_lcd_write_cmd_data(R_POWER_CONTROL_3, 0x1137);
|
|
s5l_lcd_write_cmd_data(R_DISPLAY_CONTROL_1, 0x201);
|
|
s5l_lcd_write_cmd_data(R_POWER_CONTROL_3, 0x137);
|
|
s5l_lcd_write_cmd_data(R_DISPLAY_CONTROL_1, 0x200);
|
|
s5l_lcd_write_cmd_data(R_POWER_CONTROL_1, 0x680);
|
|
s5l_lcd_write_cmd_data(R_POWER_CONTROL_2, 0x160);
|
|
s5l_lcd_write_cmd_data(R_POWER_CONTROL_3, 0x127);
|
|
s5l_lcd_write_cmd_data(R_POWER_CONTROL_1, 0x600);
|
|
}
|
|
else
|
|
{
|
|
s5l_lcd_write_cmd(R_DISPLAY_OFF);
|
|
s5l_lcd_write_data(0);
|
|
s5l_lcd_write_data(0);
|
|
s5l_lcd_write_cmd(R_SLEEP_IN);
|
|
s5l_lcd_write_data(0);
|
|
s5l_lcd_write_data(0);
|
|
}
|
|
}
|
|
|
|
/* LCD init */
|
|
void lcd_init_device(void)
|
|
{
|
|
/* Detect lcd type */
|
|
|
|
PCON13 &= ~0xf; /* Set pin 0 to input */
|
|
PCON14 &= ~0xf0; /* Set pin 1 to input */
|
|
|
|
if (((PDAT13 & 1) == 0) && ((PDAT14 & 2) == 2))
|
|
lcd_type = 0; /* Similar to ILI9320 - aka "type 2" */
|
|
else
|
|
lcd_type = 1; /* Similar to LDS176 - aka "type 7" */
|
|
|
|
/* Now init according to lcd type */
|
|
if (lcd_type == 0) {
|
|
/* TODO */
|
|
|
|
/* Entry Mode: AM=0, I/D1=1, I/D0=1, ORG=0, HWM=1, BGR=1 */
|
|
s5l_lcd_write_cmd_data(R_ENTRY_MODE, 0x1230);
|
|
} else {
|
|
/* TODO */
|
|
}
|
|
}
|
|
|
|
|
|
/*** Update functions ***/
|
|
|
|
static inline void lcd_write_pixel(fb_data pixel)
|
|
{
|
|
while (LCD_STATUS & 0x10);
|
|
LCD_WDATA = (pixel & 0xff00) >> 8;
|
|
while (LCD_STATUS & 0x10);
|
|
LCD_WDATA = pixel & 0xff;
|
|
}
|
|
|
|
/* Update the display.
|
|
This must be called after all other LCD functions that change the display. */
|
|
void lcd_update(void) ICODE_ATTR;
|
|
void lcd_update(void)
|
|
{
|
|
int x,y;
|
|
fb_data* p = &lcd_framebuffer[0][0];
|
|
|
|
if (lcd_type==0) {
|
|
s5l_lcd_write_cmd_data(R_HORIZ_ADDR_START_POS, 0);
|
|
s5l_lcd_write_cmd_data(R_HORIZ_ADDR_END_POS, LCD_WIDTH-1);
|
|
s5l_lcd_write_cmd_data(R_VERT_ADDR_START_POS, 0);
|
|
s5l_lcd_write_cmd_data(R_VERT_ADDR_END_POS, LCD_HEIGHT-1);
|
|
|
|
s5l_lcd_write_cmd_data(R_HORIZ_GRAM_ADDR_SET, 0);
|
|
s5l_lcd_write_cmd_data(R_VERT_GRAM_ADDR_SET, 0);
|
|
|
|
s5l_lcd_write_cmd(0);
|
|
s5l_lcd_write_cmd(R_WRITE_DATA_TO_GRAM);
|
|
} else {
|
|
s5l_lcd_write_cmd(R_COLUMN_ADDR_SET);
|
|
s5l_lcd_write_data(0); /* Start column */
|
|
s5l_lcd_write_data(LCD_WIDTH-1); /* End column */
|
|
|
|
s5l_lcd_write_cmd(R_ROW_ADDR_SET);
|
|
s5l_lcd_write_data(0); /* Start row */
|
|
s5l_lcd_write_data(LCD_HEIGHT-1); /* End row */
|
|
|
|
s5l_lcd_write_cmd(R_MEMORY_WRITE);
|
|
}
|
|
|
|
|
|
/* Copy display bitmap to hardware */
|
|
for (y = 0; y < LCD_HEIGHT; y++) {
|
|
for (x = 0; x < LCD_WIDTH; x++) {
|
|
lcd_write_pixel(*(p++));
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Update a fraction of the display. */
|
|
void lcd_update_rect(int, int, int, int) ICODE_ATTR;
|
|
void lcd_update_rect(int x, int y, int width, int height)
|
|
{
|
|
int xx,yy;
|
|
int y0, x0, y1, x1;
|
|
fb_data* p;
|
|
|
|
x0 = x; /* start horiz */
|
|
y0 = y; /* start vert */
|
|
x1 = (x + width) - 1; /* max horiz */
|
|
y1 = (y + height) - 1; /* max vert */
|
|
|
|
if (lcd_type==0) {
|
|
s5l_lcd_write_cmd_data(R_HORIZ_ADDR_START_POS, x0);
|
|
s5l_lcd_write_cmd_data(R_HORIZ_ADDR_END_POS, x1);
|
|
s5l_lcd_write_cmd_data(R_VERT_ADDR_START_POS, y0);
|
|
s5l_lcd_write_cmd_data(R_VERT_ADDR_END_POS, y1);
|
|
|
|
s5l_lcd_write_cmd_data(R_HORIZ_GRAM_ADDR_SET, (x1 << 8) | x0);
|
|
s5l_lcd_write_cmd_data(R_VERT_GRAM_ADDR_SET, (y1 << 8) | y0);
|
|
|
|
s5l_lcd_write_cmd(0);
|
|
s5l_lcd_write_cmd(R_WRITE_DATA_TO_GRAM);
|
|
} else {
|
|
s5l_lcd_write_cmd(R_COLUMN_ADDR_SET);
|
|
s5l_lcd_write_data(x0); /* Start column */
|
|
s5l_lcd_write_data(x1); /* End column */
|
|
|
|
s5l_lcd_write_cmd(R_ROW_ADDR_SET);
|
|
s5l_lcd_write_data(y0); /* Start row */
|
|
s5l_lcd_write_data(y1); /* End row */
|
|
|
|
s5l_lcd_write_cmd(R_MEMORY_WRITE);
|
|
}
|
|
|
|
|
|
/* Copy display bitmap to hardware */
|
|
p = &lcd_framebuffer[y0][x0];
|
|
yy = height;
|
|
for (yy = y0; yy <= y1; yy++) {
|
|
for (xx = x0; xx <= x1; xx++) {
|
|
lcd_write_pixel(*(p++));
|
|
}
|
|
p += LCD_WIDTH - width;
|
|
}
|
|
}
|
|
|
|
/*** update functions ***/
|
|
|
|
#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
|
|
*/
|
|
|
|
#define RGBYFAC 74 /* 1.0 */
|
|
#define RVFAC 101 /* 1.402 */
|
|
#define GVFAC (-51) /* -0.714136 */
|
|
#define GUFAC (-24) /* -0.334136 */
|
|
#define BUFAC 128 /* 1.772 */
|
|
|
|
/* ROUNDOFFS contain constant for correct round-offs as well as
|
|
constant parts of the conversion matrix (e.g. (Y'-16)*RGBYFAC
|
|
-> constant part = -16*RGBYFAC). Through extraction of these
|
|
constant parts we save at leat 4 substractions in the conversion
|
|
loop */
|
|
#define ROUNDOFFSR (256 - 16*RGBYFAC - 128*RVFAC)
|
|
#define ROUNDOFFSG (128 - 16*RGBYFAC - 128*GVFAC - 128*GUFAC)
|
|
#define ROUNDOFFSB (256 - 16*RGBYFAC - 128*BUFAC)
|
|
|
|
#define MAX_5BIT 0x1f
|
|
#define MAX_6BIT 0x3f
|
|
|
|
/* 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;
|
|
int y0, x0, y1, x1;
|
|
|
|
width = (width + 1) & ~1;
|
|
|
|
x0 = x; /* start horiz */
|
|
y0 = y; /* start vert */
|
|
x1 = (x + width) - 1; /* max horiz */
|
|
y1 = (y + height) - 1; /* max vert */
|
|
|
|
if (lcd_type==0) {
|
|
s5l_lcd_write_cmd_data(R_HORIZ_ADDR_START_POS, x0);
|
|
s5l_lcd_write_cmd_data(R_HORIZ_ADDR_END_POS, x1);
|
|
s5l_lcd_write_cmd_data(R_VERT_ADDR_START_POS, y0);
|
|
s5l_lcd_write_cmd_data(R_VERT_ADDR_END_POS, y1);
|
|
|
|
s5l_lcd_write_cmd_data(R_HORIZ_GRAM_ADDR_SET, (x1 << 8) | x0);
|
|
s5l_lcd_write_cmd_data(R_VERT_GRAM_ADDR_SET, (y1 << 8) | y0);
|
|
|
|
s5l_lcd_write_cmd(0);
|
|
s5l_lcd_write_cmd(R_WRITE_DATA_TO_GRAM);
|
|
} else {
|
|
s5l_lcd_write_cmd(R_COLUMN_ADDR_SET);
|
|
s5l_lcd_write_data(x0); /* Start column */
|
|
s5l_lcd_write_data(x1); /* End column */
|
|
|
|
s5l_lcd_write_cmd(R_ROW_ADDR_SET);
|
|
s5l_lcd_write_data(y0); /* Start row */
|
|
s5l_lcd_write_data(y1); /* End row */
|
|
|
|
s5l_lcd_write_cmd(R_MEMORY_WRITE);
|
|
}
|
|
|
|
const int stride_div_csub_x = stride/CSUB_X;
|
|
|
|
h = height;
|
|
while (h > 0) {
|
|
/* 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;
|
|
const unsigned char *row_end = ysrc + width;
|
|
|
|
int yp, up, vp;
|
|
int red1, green1, blue1;
|
|
int red2, green2, blue2;
|
|
|
|
int rc, gc, bc;
|
|
|
|
do
|
|
{
|
|
up = *usrc++;
|
|
vp = *vsrc++;
|
|
rc = RVFAC * vp + ROUNDOFFSR;
|
|
gc = GVFAC * vp + GUFAC * up + ROUNDOFFSG;
|
|
bc = BUFAC * up + ROUNDOFFSB;
|
|
|
|
/* Pixel 1 -> RGB565 */
|
|
yp = *ysrc++ * RGBYFAC;
|
|
red1 = (yp + rc) >> 9;
|
|
green1 = (yp + gc) >> 8;
|
|
blue1 = (yp + bc) >> 9;
|
|
|
|
/* Pixel 2 -> RGB565 */
|
|
yp = *ysrc++ * RGBYFAC;
|
|
red2 = (yp + rc) >> 9;
|
|
green2 = (yp + gc) >> 8;
|
|
blue2 = (yp + bc) >> 9;
|
|
|
|
/* Since out of bounds errors are relatively rare, we check two
|
|
pixels at once to see if any components are out of bounds, and
|
|
then fix whichever is broken. This works due to high values and
|
|
negative values both being !=0 when bitmasking them.
|
|
We first check for red and blue components (5bit range). */
|
|
if ((red1 | blue1 | red2 | blue2) & ~MAX_5BIT)
|
|
{
|
|
if (red1 & ~MAX_5BIT)
|
|
red1 = (red1 >> 31) ? 0 : MAX_5BIT;
|
|
if (blue1 & ~MAX_5BIT)
|
|
blue1 = (blue1 >> 31) ? 0 : MAX_5BIT;
|
|
if (red2 & ~MAX_5BIT)
|
|
red2 = (red2 >> 31) ? 0 : MAX_5BIT;
|
|
if (blue2 & ~MAX_5BIT)
|
|
blue2 = (blue2 >> 31) ? 0 : MAX_5BIT;
|
|
}
|
|
/* We second check for green component (6bit range) */
|
|
if ((green1 | green2) & ~MAX_6BIT)
|
|
{
|
|
if (green1 & ~MAX_6BIT)
|
|
green1 = (green1 >> 31) ? 0 : MAX_6BIT;
|
|
if (green2 & ~MAX_6BIT)
|
|
green2 = (green2 >> 31) ? 0 : MAX_6BIT;
|
|
}
|
|
|
|
/* output 2 pixels */
|
|
lcd_write_pixel((red1 << 11) | (green1 << 5) | blue1);
|
|
lcd_write_pixel((red2 << 11) | (green2 << 5) | blue2);
|
|
}
|
|
while (ysrc < row_end);
|
|
|
|
src_y++;
|
|
h--;
|
|
}
|
|
}
|