rockbox/firmware/target/arm/tcc780x/cowond2/lcd-cowond2.c
Rob Purchase 8a07e78a06 D2: Fix another timing loop that broke when we switched to the EABI compiler, this time in the LCD driver.
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@27395 a1c6a512-1295-4272-9138-f99709370657
2010-07-11 22:21:33 +00:00

419 lines
12 KiB
C

/***************************************************************************
* __________ __ ___.
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
* \/ \/ \/ \/ \/
* $Id$
*
* Copyright (C) 2008 by Rob Purchase
*
* 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 <sys/types.h> /* off_t */
#include "config.h"
#include "hwcompat.h"
#include "kernel.h"
#include "lcd.h"
#include "system.h"
#include "cpu.h"
/* GPIO A pins for LCD panel SDI interface */
#define LTV250QV_CS (1<<24)
#define LTV250QV_SCL (1<<25)
#define LTV250QV_SDI (1<<26)
/* LCD Controller registers */
#define LCDC_CTRL (*(volatile unsigned long *)0xF0000000)
#define LCDC_CLKDIV (*(volatile unsigned long *)0xF0000008)
#define LCDC_HTIME1 (*(volatile unsigned long *)0xF000000C)
#define LCDC_HTIME2 (*(volatile unsigned long *)0xF0000010)
#define LCDC_VTIME1 (*(volatile unsigned long *)0xF0000014)
#define LCDC_VTIME2 (*(volatile unsigned long *)0xF0000018)
#define LCDC_VTIME3 (*(volatile unsigned long *)0xF000001C)
#define LCDC_VTIME4 (*(volatile unsigned long *)0xF0000020)
#define LCDC_DS (*(volatile unsigned long *)0xF000005C)
#define LCDC_I1CTRL (*(volatile unsigned long *)0xF000008C)
#define LCDC_I1POS (*(volatile unsigned long *)0xF0000090)
#define LCDC_I1SIZE (*(volatile unsigned long *)0xF0000094)
#define LCDC_I1BASE (*(volatile unsigned long *)0xF0000098)
#define LCDC_I1OFF (*(volatile unsigned long *)0xF00000A8)
#define LCDC_I1SCALE (*(volatile unsigned long *)0xF00000AC)
/* Power and display status */
static bool display_on = false; /* Is the display turned on? */
static unsigned lcd_yuv_options = 0;
/* Framebuffer copy as seen by the hardware */
fb_data lcd_driver_framebuffer[LCD_FBHEIGHT][LCD_FBWIDTH];
int lcd_default_contrast(void)
{
return 0x1f;
}
void lcd_set_contrast(int val)
{
/* TODO: This won't be implemented until the S6F2002 controller
is better understood (nb: registers 16-23 control gamma). */
(void)val;
}
/* LTV250QV panel functions */
/* Delay loop based on CPU frequency (FREQ>>23 is 3..22 for 32MHz..192MHz) */
static void delay_loop(void)
{
asm volatile (" mov %[freq], %[freq], asr#23 \n\t"
"1: subs %[freq], %[freq], #1 \n\t"
" bne 1b"
: : [freq] "r" (cpu_frequency) : "memory");
}
#define DELAY delay_loop()
static void ltv250qv_write(unsigned int command)
{
int i;
GPIOA_CLEAR = LTV250QV_CS;
DELAY;
for (i = 23; i >= 0; i--)
{
GPIOA_CLEAR = LTV250QV_SCL;
DELAY;
if ((command>>i) & 1)
GPIOA_SET = LTV250QV_SDI;
else
GPIOA_CLEAR = LTV250QV_SDI;
DELAY;
GPIOA_SET = LTV250QV_SCL;
}
DELAY;
GPIOA_SET = LTV250QV_CS;
}
static void lcd_write_reg(unsigned char reg, unsigned short val)
{
int level = disable_irq_save();
ltv250qv_write(0x740000 | reg);
ltv250qv_write(0x760000 | val);
restore_irq(level);
}
static void lcd_display_on(void)
{
/* power on sequence as per the D2 firmware */
GPIOA_SET = (1<<16);
udelay(10000);
lcd_write_reg(1, 0x1D);
lcd_write_reg(2, 0x0);
lcd_write_reg(3, 0x0);
lcd_write_reg(4, 0x0);
lcd_write_reg(5, 0x40A3);
lcd_write_reg(6, 0x0);
lcd_write_reg(7, 0x0);
lcd_write_reg(8, 0x0);
lcd_write_reg(9, 0x0);
lcd_write_reg(10, 0x0);
lcd_write_reg(16, 0x0);
lcd_write_reg(17, 0x0);
lcd_write_reg(18, 0x0);
lcd_write_reg(19, 0x0);
lcd_write_reg(20, 0x0);
lcd_write_reg(21, 0x0);
lcd_write_reg(22, 0x0);
lcd_write_reg(23, 0x0);
lcd_write_reg(24, 0x0);
lcd_write_reg(25, 0x0);
udelay(10000);
lcd_write_reg(9, 0x4055);
lcd_write_reg(10, 0x0);
udelay(40000);
lcd_write_reg(10, 0x2000);
udelay(40000);
lcd_write_reg(1, 0xC01D);
lcd_write_reg(2, 0x204);
lcd_write_reg(3, 0xE100);
lcd_write_reg(4, 0x1000);
lcd_write_reg(5, 0x5033);
lcd_write_reg(6, 0x2); /* vertical back porch adjusted from 0x4 in OF */
lcd_write_reg(7, 0x30);
lcd_write_reg(8, 0x41C);
lcd_write_reg(16, 0x207);
lcd_write_reg(17, 0x702);
lcd_write_reg(18, 0xB05);
lcd_write_reg(19, 0xB05);
lcd_write_reg(20, 0x707);
lcd_write_reg(21, 0x507);
lcd_write_reg(22, 0x103);
lcd_write_reg(23, 0x406);
lcd_write_reg(24, 0x2);
lcd_write_reg(25, 0x0);
udelay(60000);
lcd_write_reg(9, 0xA55);
lcd_write_reg(10, 0x111F);
udelay(10000);
/* tell that we're on now */
display_on = true;
}
static void lcd_display_off(void)
{
/* block drawing operations and changing of first */
display_on = false;
/* LQV shutdown sequence */
lcd_write_reg(9, 0x55);
lcd_write_reg(10, 0x1417);
lcd_write_reg(5, 0x4003);
udelay(10000);
lcd_write_reg(9, 0x0);
udelay(10000);
/* kill power to LCD panel (unconfirmed) */
GPIOA_CLEAR = (1<<16);
}
void lcd_enable(bool on)
{
if (on == display_on)
return;
if (on)
{
lcd_display_on();
LCDC_CTRL |= 1; /* controller enable */
lcd_update(); /* Resync display */
send_event(LCD_EVENT_ACTIVATION, NULL);
}
else
{
LCDC_CTRL &= ~1; /* controller disable */
lcd_display_off();
}
}
bool lcd_active(void)
{
return display_on;
}
/* TODO: implement lcd_sleep() and separate out the power on/off functions */
void lcd_init_device(void)
{
BCLKCTR |= 4; /* enable LCD bus clock */
/* set PCK_LCD to 108Mhz */
PCLK_LCD &= ~PCK_EN;
PCLK_LCD = PCK_EN | (CKSEL_PLL1<<24) | 1; /* source = PLL1, divided by 2 */
/* reset the LCD controller */
SWRESET |= 4;
SWRESET &= ~4;
/* set port configuration */
PORTCFG1 &= ~0xC0000000;
PORTCFG1 &= ~0x3FC0;
PORTCFG2 &= ~0x100;
/* set physical display size */
LCDC_DS = (LCD_HEIGHT<<16) | LCD_WIDTH;
LCDC_HTIME1 = (0x2d<<16) | 0x3bf;
LCDC_HTIME2 = (1<<16) | 1;
LCDC_VTIME1 = LCDC_VTIME3 = (0<<16) | 239;
LCDC_VTIME2 = LCDC_VTIME4 = (1<<16) | 3;
LCDC_I1BASE = (unsigned int)lcd_driver_framebuffer;
LCDC_I1SIZE = (LCD_HEIGHT<<16) | LCD_WIDTH; /* image 1 size */
LCDC_I1POS = (0<<16) | 0; /* position */
LCDC_I1OFF = 0; /* address offset */
LCDC_I1SCALE = 0; /* scaling */
LCDC_I1CTRL = 5; /* 565bpp (7 = 888bpp) */
LCDC_CTRL &= ~(1<<28);
LCDC_CLKDIV = (LCDC_CLKDIV &~ 0xFF00FF) | (1<<16) | 2; /* and this means? */
/* set and clear various flags - not investigated yet */
LCDC_CTRL &= ~(0x090006AA); /* clear bits 1,3,5,7,9,10,24,27 */
LCDC_CTRL |= 0x02800144; /* set bits 2,6,8,25,23 */
LCDC_CTRL = (LCDC_CTRL &~ 0xF0000) | 0x20000;
LCDC_CTRL = (LCDC_CTRL &~ 0x700000) | 0x700000;
/* enable LCD controller */
LCDC_CTRL |= 1;
/* enable LTV250QV panel */
lcd_display_on();
}
/*** Update functions ***/
/* Copies a rectangle from one framebuffer to another. Can be used in
single transfer mode with width = num pixels, and height = 1 which
allows a full-width rectangle to be copied more efficiently. */
extern void lcd_copy_buffer_rect(fb_data *dst, const fb_data *src,
int width, int height);
/* 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)
{
if (!display_on)
return;
lcd_copy_buffer_rect(&lcd_driver_framebuffer[0][0],
&lcd_framebuffer[0][0], LCD_WIDTH*LCD_HEIGHT, 1);
}
/* 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)
{
fb_data *dst, *src;
if (!display_on)
return;
if (x + width > LCD_WIDTH)
width = LCD_WIDTH - x; /* Clip right */
if (x < 0)
width += x, x = 0; /* Clip left */
if (width <= 0)
return; /* nothing left to do */
if (y + height > LCD_HEIGHT)
height = LCD_HEIGHT - y; /* Clip bottom */
if (y < 0)
height += y, y = 0; /* Clip top */
if (height <= 0)
return; /* nothing left to do */
/* TODO: It may be faster to swap the addresses of lcd_driver_framebuffer
* and lcd_framebuffer */
dst = &lcd_driver_framebuffer[y][x];
src = &lcd_framebuffer[y][x];
/* Copy part of the Rockbox framebuffer to the second framebuffer */
if (width < LCD_WIDTH)
{
/* Not full width - do line-by-line */
lcd_copy_buffer_rect(dst, src, width, height);
}
else
{
/* Full width - copy as one line */
lcd_copy_buffer_rect(dst, src, LCD_WIDTH*height, 1);
}
}
void lcd_set_flip(bool yesno)
{
// TODO
(void)yesno;
}
void lcd_set_invert_display(bool yesno)
{
// TODO
(void)yesno;
}
void lcd_yuv_set_options(unsigned options)
{
lcd_yuv_options = options;
}
/* Line write helper function for lcd_yuv_blit. Write two lines of yuv420. */
extern void lcd_write_yuv420_lines(fb_data *dst,
unsigned char const * const src[3],
int width,
int stride);
extern void lcd_write_yuv420_lines_odither(fb_data *dst,
unsigned char const * const src[3],
int width,
int stride,
int x_screen, /* To align dither pattern */
int y_screen);
/* 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)
{
unsigned char const * yuv_src[3];
off_t z;
if (!display_on)
return;
/* Sorry, but width and height must be >= 2 or else */
width &= ~1;
height >>= 1;
fb_data *dst = &lcd_driver_framebuffer[y][x];
z = stride*src_y;
yuv_src[0] = src[0] + z + src_x;
yuv_src[1] = src[1] + (z >> 2) + (src_x >> 1);
yuv_src[2] = src[2] + (yuv_src[1] - src[1]);
if (lcd_yuv_options & LCD_YUV_DITHER)
{
do
{
lcd_write_yuv420_lines_odither(dst, yuv_src, width, stride, y, x);
yuv_src[0] += stride << 1; /* Skip down two luma lines */
yuv_src[1] += stride >> 1; /* Skip down one chroma line */
yuv_src[2] += stride >> 1;
dst += 2*LCD_FBWIDTH;
y -= 2;
}
while (--height > 0);
}
else
{
do
{
lcd_write_yuv420_lines(dst, yuv_src, width, stride);
yuv_src[0] += stride << 1; /* Skip down two luma lines */
yuv_src[1] += stride >> 1; /* Skip down one chroma line */
yuv_src[2] += stride >> 1;
dst += 2*LCD_FBWIDTH;
}
while (--height > 0);
}
}