518d9ecb35
Change-Id: I8b72a9c333d8a9dbcb62c366a9af298f1dd9b2f7
434 lines
10 KiB
C
434 lines
10 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright (C) 2008 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 <sys/types.h>
|
|
|
|
#include "config.h"
|
|
#include "cpu.h"
|
|
#include "lcd.h"
|
|
#include "kernel.h"
|
|
#include "system.h"
|
|
|
|
/* The LCD registers appear to match controllers from Leadis Technology,
|
|
either the LDS176 (132x132 4k) or the LDS186 (128x160 65k).
|
|
These defines are from the LDS176 (I couldn't find the LDS186 datasheet. */
|
|
#define NOP 0x00
|
|
#define SWRESET 0x01
|
|
#define BSTROFF 0x02
|
|
#define BSTRON 0x03
|
|
#define RDDID 0x04
|
|
#define RDDST 0x09
|
|
#define SLPIN 0x10
|
|
#define SLPOUT 0x11
|
|
#define PTLON 0x12
|
|
#define NORON 0x13
|
|
#define INVOFF 0x20
|
|
#define INVON 0x21
|
|
#define APOFF 0x22
|
|
#define APON 0x23
|
|
#define WRCNTR 0x25
|
|
#define DISPOFF 0x28
|
|
#define DISPON 0x29
|
|
#define CASET 0x2a
|
|
#define RASET 0x2b
|
|
#define RAMWR 0x2c
|
|
#define RAMRD 0x2e
|
|
#define RGBSET 0x2d
|
|
#define PTLAR 0x30
|
|
#define SCRLAR 0x33
|
|
#define TEOFF 0x34
|
|
#define TEON 0x35
|
|
#define MADCTR 0x36
|
|
#define VSCSAD 0x37
|
|
#define IDMOFF 0x38
|
|
#define IDMON 0x39
|
|
#define COLMOD 0x3a
|
|
#define RDID1 0xda
|
|
#define RDID2 0xdb
|
|
#define RDID3 0xdc
|
|
#define CLKINT 0xb0
|
|
#define CLKEXT 0xb1
|
|
#define FRMSEL 0xb4
|
|
#define FRM8SEL 0xb5
|
|
#define TMPRNG 0xb6
|
|
#define TMPHIS 0xb7
|
|
#define TMPREAD 0xb8
|
|
#define DISCTR 0xba
|
|
#define EPVOL 0xbb
|
|
#define EPWRIN 0xd1
|
|
#define EPWROUT 0xd0
|
|
#define RDEV 0xd4
|
|
#define RDRR 0xd5
|
|
|
|
/* Whether the lcd is currently enabled or not */
|
|
static bool lcd_enabled;
|
|
|
|
/* Display status */
|
|
static unsigned lcd_yuv_options SHAREDBSS_ATTR = 0;
|
|
static unsigned mad_ctrl = 0;
|
|
|
|
/* wait for LCD */
|
|
static inline void lcd_wait_write(void)
|
|
{
|
|
int i = 0;
|
|
while (LCD2_PORT & LCD2_BUSY_MASK)
|
|
{
|
|
if (i < 2000)
|
|
i++;
|
|
else
|
|
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_cmd(unsigned cmd)
|
|
{
|
|
lcd_wait_write();
|
|
LCD2_PORT = LCD2_CMD_MASK | (cmd & 0xff);
|
|
lcd_wait_write();
|
|
}
|
|
|
|
static inline void lcd_send_pixel(unsigned pixel)
|
|
{
|
|
lcd_send_data(pixel >> 8);
|
|
lcd_send_data(pixel);
|
|
}
|
|
|
|
void lcd_init_device(void)
|
|
{
|
|
#if 0
|
|
/* this sequence from the OF bootloader */
|
|
|
|
DEV_EN2 |= 0x2000;
|
|
outl(inl(0x70000014) & ~0xf000000, 0x70000014);
|
|
outl(inl(0x70000014) | 0xa000000, 0x70000014);
|
|
DEV_INIT1 &= 0xc000;
|
|
DEV_INIT1 |= 0x8000;
|
|
MLCD_SCLK_DIV &= ~0x800;
|
|
CLCD_CLOCK_SRC |= 0xc0000000;
|
|
DEV_INIT2 &= ~0x400;
|
|
outl(inl(0x7000002c) | ((1<<4)<<24), 0x7000002c);
|
|
DEV_INIT2 &= ~((1<<4)<<24);
|
|
udelay(10000);
|
|
|
|
DEV_INIT2 |= ((1<<4)<<24);
|
|
outl(0x220, 0x70008a00);
|
|
outl(0x1f00, 0x70008a04);
|
|
LCD2_BLOCK_CTRL = 0x10008080;
|
|
LCD2_BLOCK_CONFIG = 0xF00000;
|
|
|
|
/* lcd power */
|
|
GPIOJ_ENABLE |= 0x4;
|
|
GPIOJ_OUTPUT_VAL |= 0x4;
|
|
GPIOJ_OUTPUT_EN |= 0x4;
|
|
|
|
lcd_send_cmd(SWRESET);
|
|
udelay(10000);
|
|
|
|
lcd_send_cmd(WRCNTR);
|
|
lcd_send_data(0x3f);
|
|
|
|
lcd_send_cmd(SLPOUT);
|
|
udelay(120000);
|
|
|
|
lcd_send_cmd(INVOFF);
|
|
lcd_send_cmd(IDMOFF);
|
|
lcd_send_cmd(NORON);
|
|
|
|
lcd_send_cmd(FRMSEL);
|
|
lcd_send_data(0x2);
|
|
lcd_send_data(0x6);
|
|
lcd_send_data(0x8);
|
|
lcd_send_data(0xd);
|
|
|
|
lcd_send_cmd(FRM8SEL);
|
|
lcd_send_data(0x2);
|
|
lcd_send_data(0x6);
|
|
lcd_send_data(0x8);
|
|
lcd_send_data(0xd);
|
|
|
|
lcd_send_cmd(TMPRNG);
|
|
lcd_send_data(0x19);
|
|
lcd_send_data(0x23);
|
|
lcd_send_data(0x2d);
|
|
|
|
lcd_send_cmd(TMPHIS);
|
|
lcd_send_data(0x5);
|
|
|
|
lcd_send_cmd(DISCTR);
|
|
lcd_send_data(0x7);
|
|
lcd_send_data(0x18);
|
|
|
|
lcd_send_cmd(MADCTR);
|
|
lcd_send_data(0);
|
|
mad_ctrl = 0;
|
|
|
|
lcd_send_cmd(COLMOD);
|
|
lcd_send_data(0x5);
|
|
|
|
lcd_send_cmd(RGBSET);
|
|
lcd_send_data(0x1);
|
|
lcd_send_data(0x2);
|
|
lcd_send_data(0x3);
|
|
lcd_send_data(0x4);
|
|
lcd_send_data(0x5);
|
|
lcd_send_data(0x6);
|
|
lcd_send_data(0x7);
|
|
lcd_send_data(0x8);
|
|
lcd_send_data(0x9);
|
|
lcd_send_data(0xa);
|
|
lcd_send_data(0xb);
|
|
lcd_send_data(0xc);
|
|
lcd_send_data(0xd);
|
|
lcd_send_data(0xe);
|
|
lcd_send_data(0xf);
|
|
lcd_send_data(0x10);
|
|
lcd_send_data(0x11);
|
|
lcd_send_data(0x12);
|
|
lcd_send_data(0x13);
|
|
lcd_send_data(0x14);
|
|
lcd_send_data(0x15);
|
|
lcd_send_data(0x16);
|
|
lcd_send_data(0x17);
|
|
lcd_send_data(0x18);
|
|
lcd_send_data(0x19);
|
|
lcd_send_data(0x1a);
|
|
lcd_send_data(0x1b);
|
|
lcd_send_data(0x1c);
|
|
lcd_send_data(0x1d);
|
|
lcd_send_data(0x1e);
|
|
lcd_send_data(0x1f);
|
|
lcd_send_data(0x20);
|
|
lcd_send_data(0x21);
|
|
lcd_send_data(0x22);
|
|
lcd_send_data(0x23);
|
|
lcd_send_data(0x24);
|
|
lcd_send_data(0x25);
|
|
lcd_send_data(0x26);
|
|
lcd_send_data(0x27);
|
|
lcd_send_data(0x28);
|
|
lcd_send_data(0x29);
|
|
lcd_send_data(0x2a);
|
|
lcd_send_data(0x2b);
|
|
lcd_send_data(0x2c);
|
|
lcd_send_data(0x2d);
|
|
lcd_send_data(0x2e);
|
|
lcd_send_data(0x2f);
|
|
lcd_send_data(0x30);
|
|
|
|
lcd_send_cmd(DISPON);
|
|
#endif
|
|
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() */
|
|
{
|
|
/* from the OF */
|
|
lcd_send_cmd(SLPOUT);
|
|
sleep(HZ/5); /* 200ms */
|
|
|
|
/* 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() */
|
|
{
|
|
/* from the OF */
|
|
lcd_send_cmd(SLPIN);
|
|
|
|
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)
|
|
{
|
|
lcd_send_cmd(WRCNTR);
|
|
lcd_send_data(val);
|
|
}
|
|
|
|
void lcd_set_invert_display(bool yesno)
|
|
{
|
|
if (yesno)
|
|
lcd_send_cmd(INVON);
|
|
else
|
|
lcd_send_cmd(INVOFF);
|
|
}
|
|
|
|
/* turn the display upside down (call lcd_update() afterwards) */
|
|
void lcd_set_flip(bool yesno)
|
|
{
|
|
if (yesno)
|
|
mad_ctrl |= ((1<<7) | (1<<6)); /* flip */
|
|
else
|
|
mad_ctrl &= ~((1<<7) | (1<<6)); /* normal */
|
|
|
|
lcd_send_cmd(MADCTR);
|
|
lcd_send_data(mad_ctrl);
|
|
}
|
|
|
|
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(unsigned char const * const src[3],
|
|
int width, int stride);
|
|
|
|
extern void lcd_write_yuv420_lines_odither(unsigned char const * const src[3],
|
|
int width, int stride,
|
|
int x_screen, 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;
|
|
|
|
/* Sorry, but width and height must be >= 2 or else */
|
|
width &= ~1;
|
|
height >>= 1;
|
|
|
|
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]);
|
|
|
|
/* Set vertical address mode */
|
|
lcd_send_cmd(MADCTR);
|
|
lcd_send_data(mad_ctrl | (1<<5));
|
|
|
|
lcd_send_cmd(RASET);
|
|
lcd_send_data(x);
|
|
lcd_send_data(x + width - 1);
|
|
|
|
if (lcd_yuv_options & LCD_YUV_DITHER)
|
|
{
|
|
do
|
|
{
|
|
lcd_send_cmd(CASET);
|
|
lcd_send_data(y);
|
|
lcd_send_data(y + 1);
|
|
|
|
lcd_send_cmd(RAMWR);
|
|
|
|
lcd_write_yuv420_lines_odither(yuv_src, width, stride, x, y);
|
|
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;
|
|
y += 2;
|
|
}
|
|
while (--height > 0);
|
|
}
|
|
else
|
|
{
|
|
do
|
|
{
|
|
lcd_send_cmd(CASET);
|
|
lcd_send_data(y);
|
|
lcd_send_data(y + 1);
|
|
|
|
lcd_send_cmd(RAMWR);
|
|
|
|
lcd_write_yuv420_lines(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;
|
|
y += 2;
|
|
}
|
|
while (--height > 0);
|
|
}
|
|
|
|
/* Restore the address mode */
|
|
lcd_send_cmd(MADCTR);
|
|
lcd_send_data(mad_ctrl);
|
|
}
|
|
|
|
/* 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)
|
|
{
|
|
const fb_data *addr;
|
|
|
|
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. */
|
|
|
|
addr = FBADDR(x,y);
|
|
|
|
lcd_send_cmd(CASET);
|
|
lcd_send_data(x);
|
|
lcd_send_data(x + width - 1);
|
|
|
|
lcd_send_cmd(RASET);
|
|
lcd_send_data(y);
|
|
lcd_send_data(y + height - 1);
|
|
|
|
lcd_send_cmd(RAMWR);
|
|
do {
|
|
int w = width;
|
|
do {
|
|
lcd_send_pixel(*addr++);
|
|
} while (--w > 0);
|
|
addr += LCD_WIDTH - width;
|
|
} while (--height > 0);
|
|
}
|