Nyaaori/rockbox
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity
rockbox/firmware/target/arm/samsung/yh925/lcd-yh925.c
Solomon Peachy 418169aff8 Revert "Remove YUV blitting functions and LCD modes" 
This reverts commit fe6aa21e9e.

Change-Id: I8bb1e5d6c52ed1478002d2140ef494ec5d62b8e3
2022-10-13 11:08:06 -04:00

663 lines
20 KiB
C
Raw Permalink Blame History

/***************************************************************************
* __________ __ ___.
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
* \/ \/ \/ \/ \/
* $Id$
*
* Copyright (C) 2006 by Barry Wardell
*
* 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"
/** Initialized in lcd_init_device() **/
/* Is the power turned on? */
static bool power_on;
/* Is the display turned on? */
static bool display_on;
/* Amount of vertical offset. Used for flip offset correction/detection. */
static int y_offset = 4;
static int x_offset = 16;
/* Reverse flag. Must be remembered when display is turned off. */
static unsigned short disp_control_rev;
/* Contrast setting << 8 */
static int lcd_contrast;
static unsigned lcd_yuv_options SHAREDBSS_ATTR = 0;
/* Forward declarations */
#if defined(HAVE_LCD_ENABLE) || defined(HAVE_LCD_SLEEP)
static void lcd_display_off(void);
#endif
/* register defines for the Renesas HD66773R */
#define R_START_OSC 0x00
#define R_DEVICE_CODE_READ 0x00
#define R_DRV_OUTPUT_CONTROL 0x01
#define R_DRV_AC_CONTROL 0x02
#define R_POWER_CONTROL1 0x03
#define R_POWER_CONTROL2 0x04
#define R_ENTRY_MODE 0x05
#define R_COMPARE_REG 0x06
#define R_DISP_CONTROL 0x07
#define R_FRAME_CYCLE_CONTROL 0x0b
#define R_POWER_CONTROL3 0x0c
#define R_POWER_CONTROL4 0x0d
#define R_POWER_CONTROL5 0x0e
#define R_GATE_SCAN_START_POS 0x0f
#define R_VERT_SCROLL_CONTROL 0x11
#define R_1ST_SCR_DRV_POS 0x14
#define R_2ND_SCR_DRV_POS 0x15
#define R_HORIZ_RAM_ADDR_POS 0x16
#define R_VERT_RAM_ADDR_POS 0x17
#define R_RAM_WRITE_DATA_MASK 0x20
#define R_RAM_ADDR_SET 0x21
#define R_WRITE_DATA_2_GRAM 0x22
#define R_RAM_READ_DATA 0x22
#define R_GAMMA_FINE_ADJ_POS1 0x30
#define R_GAMMA_FINE_ADJ_POS2 0x31
#define R_GAMMA_FINE_ADJ_POS3 0x32
#define R_GAMMA_GRAD_ADJ_POS 0x33
#define R_GAMMA_FINE_ADJ_NEG1 0x34
#define R_GAMMA_FINE_ADJ_NEG2 0x35
#define R_GAMMA_FINE_ADJ_NEG3 0x36
#define R_GAMMA_GRAD_ADJ_NEG 0x37
#define R_GAMMA_AMP_ADJ_POS 0x3a
#define R_GAMMA_AMP_ADJ_NEG 0x3b
#define R_DRV_OUTPUT_CONTROL_NORMAL (1<<9|1<<4|1<<2|1<<0)
#define R_DRV_OUTPUT_CONTROL_FLIPPED (1<<11|1<<8|1<<5|1<<4|1<<3)
static inline void lcd_wait_write(void)
{
while (LCD2_PORT & LCD2_BUSY_MASK);
}
/* Send command */
static inline void lcd_send_cmd(unsigned cmd)
{
lcd_wait_write();
LCD2_PORT = LCD2_CMD_MASK; /* Send MSB first (should always be 0) */
lcd_wait_write();
LCD2_PORT = LCD2_CMD_MASK | cmd;
}
/* Send 16-bit data */
static inline void lcd_send_data(unsigned data)
{
lcd_wait_write();
LCD2_PORT = (data >> 8) | LCD2_DATA_MASK; /* Send MSB first */
lcd_wait_write();
LCD2_PORT = (data & 0xff) | LCD2_DATA_MASK;
}
/* Send 16-bit data byte-swapped. Only needed until we can use block transfer. */
static inline void lcd_send_data_swapped(unsigned v)
{
lcd_wait_write();
LCD2_PORT = LCD2_DATA_MASK | (v & 0xff); /* Send LSB first */
LCD2_PORT = LCD2_DATA_MASK | (v >> 8);
}
/* Write value to register */
static void lcd_write_reg(int reg, int val)
{
lcd_send_cmd(reg);
lcd_send_data(val);
}
/*** hardware configuration ***/
int lcd_default_contrast(void)
{
return DEFAULT_CONTRAST_SETTING;
}
void lcd_set_contrast(int val)
{
/* Clamp val in range 0-14, 16-30 */
if (val < 1)
val = 0;
else if (val <= 15)
--val;
else if (val > 30)
val = 30;
lcd_contrast = val << 8;
if (!power_on)
return;
/* VCOMG=1, VDV4-0=xxxxx, VCM4-0=11000 */
lcd_write_reg(R_POWER_CONTROL5, 0x2018 | lcd_contrast);
}
void lcd_set_invert_display(bool yesno)
{
if (yesno == (disp_control_rev == 0x0000))
return;
disp_control_rev = yesno ? 0x0000 : 0x0004;
if (!display_on)
return;
/* PT1-0=00, VLE2-1=00, SPT=0, GON=1, DTE=1, REV=x, D1-0=11 */
lcd_write_reg(R_DISP_CONTROL, 0x0033 | disp_control_rev);
}
/* turn the display upside down (call lcd_update() afterwards) */
void lcd_set_flip(bool flip)
{
int r_drv_output_control;
if (flip == (y_offset != 4))
return;
/* The LCD controller is 132x160 while the LCD itself is 128x160, so we need
* to shift the origin by 4 when we flip the LCD
*
* the higher bits are the key bits for flipping */
if (flip)
{
x_offset = 0; y_offset = 0;
r_drv_output_control = R_DRV_OUTPUT_CONTROL_FLIPPED;
}
else
{
x_offset = 16; y_offset = 4;
r_drv_output_control = R_DRV_OUTPUT_CONTROL_NORMAL;
}
if (!power_on)
return;
lcd_write_reg(R_1ST_SCR_DRV_POS, ( (LCD_WIDTH + x_offset - 1) << 8) | x_offset);
lcd_write_reg(R_HORIZ_RAM_ADDR_POS, (LCD_HEIGHT - 1) << 8 | 0);
lcd_write_reg(R_VERT_RAM_ADDR_POS, ((LCD_WIDTH + x_offset- 1) << 8) | x_offset);
lcd_write_reg(R_DRV_OUTPUT_CONTROL, r_drv_output_control );
lcd_write_reg(R_ENTRY_MODE, 0x1028);
}
/* Reset the LCD prior to booting the OF */
#ifdef BOOTLOADER
void lcd_reset(void)
{
lcd_write_reg(R_DRV_OUTPUT_CONTROL, 0x0315);
lcd_write_reg(R_ENTRY_MODE, 0x1028);
lcd_write_reg(R_HORIZ_RAM_ADDR_POS, 0x7f00);
lcd_write_reg(R_VERT_RAM_ADDR_POS, 0xaf10);
lcd_write_reg(R_RAM_ADDR_SET, 0x0000);
}
#endif
/* LCD init */
void lcd_init_device(void)
{
#if 0
/* This is the OF LCD init */
int i;
DEV_EN2 |= 0x2000;
DEV_INIT1 |= 0xfc000000;
CLCD_CLOCK_SRC &= ~0xf;
DEV_INIT2 &= ~0x400;
GPIOF_ENABLE |= 0x4;
GPIOF_OUTPUT_EN |= 0x4;
GPIOF_OUTPUT_VAL &= ~0x4;
udelay(300000);
GPIOF_OUTPUT_VAL |= 0x4;
outl(0x220, 0x70008a00);
outl(0x1f00, 0x70008a04);
LCD2_BLOCK_CTRL = 0x10008080;
LCD2_BLOCK_CONFIG = 0xf00000;
udelay(100000);
for (i = 0; i < 8; i++)
{
lcd_send_data(0);
udelay(1);
}
lcd_write_reg(R_START_OSC, 0x0001);
udelay(20000);
lcd_write_reg(R_DRV_OUTPUT_CONTROL, 0x0315);
lcd_write_reg(R_DRV_AC_CONTROL, 0x0700);
lcd_write_reg(R_ENTRY_MODE, 0x1028);
lcd_write_reg(R_COMPARE_REG, 0x0000);
lcd_write_reg(R_FRAME_CYCLE_CONTROL, 0x4008);
lcd_write_reg(R_RAM_ADDR_SET, 0x0000);
lcd_write_reg(R_GAMMA_FINE_ADJ_POS1, 0x0700);
lcd_write_reg(R_GAMMA_FINE_ADJ_POS2, 0x0000);
lcd_write_reg(R_GAMMA_FINE_ADJ_POS3, 0x0000);
lcd_write_reg(R_GAMMA_GRAD_ADJ_POS, 0x0100);
lcd_write_reg(R_GAMMA_FINE_ADJ_NEG1, 0x0707);
lcd_write_reg(R_GAMMA_FINE_ADJ_NEG2, 0x0007);
lcd_write_reg(R_GAMMA_FINE_ADJ_NEG3, 0x0700);
lcd_write_reg(R_GAMMA_GRAD_ADJ_NEG, 0x0001);
lcd_write_reg(R_GATE_SCAN_START_POS, 0x0000);
lcd_write_reg(R_VERT_SCROLL_CONTROL, 0x0000);
lcd_write_reg(R_1ST_SCR_DRV_POS, ( (LCD_WIDTH + 16 - 1) << 8) | 16);
lcd_write_reg(R_2ND_SCR_DRV_POS, 0x0000);
lcd_write_reg(R_HORIZ_RAM_ADDR_POS, (LCD_HEIGHT - 1) << 8 | 0);
lcd_write_reg(R_VERT_RAM_ADDR_POS, ((LCD_WIDTH + 16- 1) << 8) | 16);
lcd_write_reg(R_GAMMA_AMP_ADJ_POS, 0x1600);
lcd_write_reg(R_GAMMA_AMP_ADJ_NEG, 0x0006);
lcd_write_reg(R_DISP_CONTROL, 0x0104);
lcd_write_reg(R_POWER_CONTROL4, 0x0100);
lcd_write_reg(R_POWER_CONTROL5, 0x0d18);
lcd_write_reg(R_POWER_CONTROL3, 0x0000);
udelay(50000);
lcd_write_reg(R_POWER_CONTROL1, 0x0008);
lcd_write_reg(R_POWER_CONTROL3, 0x0000);
lcd_write_reg(R_POWER_CONTROL2, 0x0000);
udelay(50000);
lcd_write_reg(R_POWER_CONTROL5, 0x2d18);
lcd_write_reg(R_POWER_CONTROL3, 0x0000);
udelay(50000);
lcd_write_reg(R_POWER_CONTROL4, 0x0110);
//~ lcd_clear_display();
lcd_write_reg(R_DISP_CONTROL, 0x0105);
udelay(20000);
lcd_write_reg(R_DISP_CONTROL, 0x0125);
lcd_write_reg(R_DISP_CONTROL, 0x0127);
udelay(20000);
lcd_write_reg(R_DISP_CONTROL, 0x0137);
lcd_send_cmd(R_WRITE_DATA_2_GRAM);
GPIOF_ENABLE |= 0x02;
GPIOF_OUTPUT_EN |= 0x02;
GPIOF_OUTPUT_VAL |= 0x02;
#endif
#ifndef BOOTLOADER
/* The OF won't boot if this is done in the bootloader - ideally we should
tweak the lcd controller speed settings but this will do for now */
CLCD_CLOCK_SRC |= 0xc0000000; /* Set LCD interface clock to PLL */
#endif
/* only these bits are needed from the OF init */
lcd_write_reg(R_DRV_OUTPUT_CONTROL, R_DRV_OUTPUT_CONTROL_NORMAL);
lcd_write_reg(R_ENTRY_MODE, 0x1028);
power_on = true;
display_on = true;
disp_control_rev = 0x0004;
lcd_contrast = DEFAULT_CONTRAST_SETTING << 8;
}
/* THE SLEEP AND POWER FUNCTIONS HAVE NOT BEEN MODIFIED FOR THE YH-925 */
#ifdef HAVE_LCD_SLEEP
static void lcd_power_on(void)
{
/* Be sure standby bit is clear. */
/* BT2-0=000, DC2-0=000, AP2-0=000, SLP=0, STB=0 */
lcd_write_reg(R_POWER_CONTROL1, 0x0000);
/** Power ON Sequence **/
/* Per datasheet Rev.1.10, Jun.21.2003, p. 99 */
lcd_write_reg(R_START_OSC, 0x0001); /* Start Oscillation */
/* 10ms or more for oscillation circuit to stabilize */
sleep(HZ/50);
/* Instruction (1) for power setting; VC2-0, VRH3-0, CAD,
VRL3-0, VCM4-0, VDV4-0 */
/* VC2-0=001 */
lcd_write_reg(R_POWER_CONTROL3, 0x0001);
/* VRL3-0=0100, PON=0, VRH3-0=0001 */
lcd_write_reg(R_POWER_CONTROL4, 0x0401);
/* CAD=1 */
lcd_write_reg(R_POWER_CONTROL2, 0x8000);
/* VCOMG=0, VDV4-0=xxxxx (19), VCM4-0=11000 */
lcd_write_reg(R_POWER_CONTROL5, 0x0018 | lcd_contrast);
/* Instruction (2) for power setting; BT2-0, DC2-0, AP2-0 */
/* BT2-0=000, DC2-0=001, AP2-0=011, SLP=0, STB=0 */
lcd_write_reg(R_POWER_CONTROL1, 0x002c);
/* Instruction (3) for power setting; VCOMG = "1" */
/* VCOMG=1, VDV4-0=xxxxx (19), VCM4-0=11000 */
lcd_write_reg(R_POWER_CONTROL5, 0x2018 | lcd_contrast);
/* 40ms or more; time for step-up circuits 1,2 to stabilize */
sleep(HZ/25);
/* Instruction (4) for power setting; PON = "1" */
/* VRL3-0=0100, PON=1, VRH3-0=0001 */
lcd_write_reg(R_POWER_CONTROL4, 0x0411);
/* 40ms or more; time for step-up circuit 4 to stabilize */
sleep(HZ/25);
/* Instructions for other mode settings (in register order). */
/* SM=0, GS=x, SS=0, NL4-0=10011 (G1-G160)*/
lcd_write_reg(R_DRV_OUTPUT_CONTROL, y_offset ? 0x0013 : 0x0113); /* different to X5 */
/* FLD1-0=01 (1 field), B/C=1, EOR=1 (C-pat), NW5-0=000000 (1 row) */
lcd_write_reg(R_DRV_AC_CONTROL, 0x0700);
/* DIT=0, BGR=1, HWM=0, I/D1-0=10, AM=1, LG2-0=000 */
lcd_write_reg(R_ENTRY_MODE, 0x1028); /* different to X5 */
/* CP15-0=0000000000000000 */
lcd_write_reg(R_COMPARE_REG, 0x0000);
/* NO1-0=01, SDT1-0=00, EQ1-0=00, DIV1-0=00, RTN3-00000 */
lcd_write_reg(R_FRAME_CYCLE_CONTROL, 0x4000);
/* SCN4-0=000x0 (G1/G160) */
/* lcd_write_reg(R_GATE_SCAN_START_POS, y_offset ? 0x0000 : 0x0002); */
/* VL7-0=0x00 */
lcd_write_reg(R_VERT_SCROLL_CONTROL, 0x0000);
/* SE17-10(End)=0x9f (159), SS17-10(Start)=0x00 */
lcd_write_reg(R_1ST_SCR_DRV_POS, 0x9f00);
/* SE27-20(End)=0x5c (92), SS27-20(Start)=0x00 */
lcd_write_reg(R_2ND_SCR_DRV_POS, 0x5c00);
/* HEA7-0=7f, HSA7-0=00 */
lcd_write_reg(R_HORIZ_RAM_ADDR_POS, 0x7f00);
/* PKP12-10=0x0, PKP02-00=0x0 */
lcd_write_reg(R_GAMMA_FINE_ADJ_POS1, 0x0003);
/* PKP32-30=0x4, PKP22-20=0x0 */
lcd_write_reg(R_GAMMA_FINE_ADJ_POS2, 0x0400);
/* PKP52-50=0x4, PKP42-40=0x7 */
lcd_write_reg(R_GAMMA_FINE_ADJ_POS3, 0x0407);
/* PRP12-10=0x3, PRP02-00=0x5 */
lcd_write_reg(R_GAMMA_GRAD_ADJ_POS, 0x0305);
/* PKN12-10=0x0, PKN02-00=0x3 */
lcd_write_reg(R_GAMMA_FINE_ADJ_NEG1, 0x0003);
/* PKN32-30=0x7, PKN22-20=0x4 */
lcd_write_reg(R_GAMMA_FINE_ADJ_NEG2, 0x0704);
/* PKN52-50=0x4, PRN42-40=0x7 */
lcd_write_reg(R_GAMMA_FINE_ADJ_NEG3, 0x0407);
/* PRN12-10=0x5, PRN02-00=0x3 */
lcd_write_reg(R_GAMMA_GRAD_ADJ_NEG, 0x0503);
/* VRP14-10=0x14, VRP03-00=0x09 */
lcd_write_reg(R_GAMMA_AMP_ADJ_POS, 0x1409);
/* VRN14-00=0x06, VRN03-00=0x02 */
lcd_write_reg(R_GAMMA_AMP_ADJ_NEG, 0x0602);
/* 100ms or more; time for step-up circuits to stabilize */
sleep(HZ/10);
power_on = true;
}
static void lcd_power_off(void)
{
/* Display must be off first */
if (display_on)
lcd_display_off();
power_on = false;
/** Power OFF sequence **/
/* Per datasheet Rev.1.10, Jun.21.2003, p. 99 */
/* Step-up1 halt setting bit */
/* BT2-0=110, DC2-0=001, AP2-0=011, SLP=0, STB=0 */
lcd_write_reg(R_POWER_CONTROL1, 0x062c);
/* Step-up3,4 halt setting bit */
/* VRL3-0=0100, PON=0, VRH3-0=0001 */
lcd_write_reg(R_POWER_CONTROL4, 0x0401);
/* VCOMG=0, VDV4-0=10011, VCM4-0=11000 */
lcd_write_reg(R_POWER_CONTROL5, 0x0018 | lcd_contrast);
/* Wait 100ms or more */
sleep(HZ/10);
/* Step-up2,amp halt setting bit */
/* BT2-0=000, DC2-0=000, AP2-0=000, SLP=0, STB=0 */
lcd_write_reg(R_POWER_CONTROL1, 0x0000);
}
void lcd_sleep(void)
{
if (power_on)
lcd_power_off();
/* Set standby mode */
/* BT2-0=000, DC2-0=000, AP2-0=000, SLP=0, STB=1 */
lcd_write_reg(R_POWER_CONTROL1, 0x0001);
}
#endif
#if defined(HAVE_LCD_ENABLE) || defined(HAVE_LCD_SLEEP)
static void lcd_display_off(void)
{
display_on = false;
/** Display OFF sequence **/
/* Per datasheet Rev.1.10, Jun.21.2003, p. 97 */
/* EQ1-0=00 already */
/* PT1-0=00, VLE2-1=00, SPT=0, GON=1, DTE=1, REV=x, D1-0=10 */
lcd_write_reg(R_DISP_CONTROL, 0x0032 | disp_control_rev);
sleep(HZ/25); /* Wait 2 frames or more */
/* PT1-0=00, VLE2-1=00, SPT=0, GON=1, DTE=0, REV=x, D1-0=10 */
lcd_write_reg(R_DISP_CONTROL, 0x0022 | disp_control_rev);
sleep(HZ/25); /* Wait 2 frames or more */
/* PT1-0=00, VLE2-1=00, SPT=0, GON=0, DTE=0, REV=0, D1-0=00 */
lcd_write_reg(R_DISP_CONTROL, 0x0000);
}
#endif
#if defined(HAVE_LCD_ENABLE)
static void lcd_display_on(void)
{
/* Be sure power is on first */
if (!power_on)
lcd_power_on();
/** Display ON Sequence **/
/* Per datasheet Rev.1.10, Jun.21.2003, p. 97 */
/* PT1-0=00, VLE2-1=00, SPT=0, GON=0, DTE=0, REV=0, D1-0=01 */
lcd_write_reg(R_DISP_CONTROL, 0x0001);
sleep(HZ/25); /* Wait 2 frames or more */
/* PT1-0=00, VLE2-1=00, SPT=0, GON=1, DTE=0, REV=x, D1-0=01 */
lcd_write_reg(R_DISP_CONTROL, 0x0021 | disp_control_rev);
/* PT1-0=00, VLE2-1=00, SPT=0, GON=1, DTE=0, REV=x, D1-0=11 */
lcd_write_reg(R_DISP_CONTROL, 0x0023 | disp_control_rev);
sleep(HZ/25); /* Wait 2 frames or more */
/* PT1-0=00, VLE2-1=00, SPT=0, GON=1, DTE=1, REV=x, D1-0=11 */
lcd_write_reg(R_DISP_CONTROL, 0x0033 | disp_control_rev);
display_on = true;
}
void lcd_enable(bool on)
{
if (on == display_on)
return;
if (on)
{
lcd_display_on();
/* 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);
}
else
{
lcd_display_off();
}
}
#endif
#if defined(HAVE_LCD_ENABLE) || defined(HAVE_LCD_SLEEP)
bool lcd_active(void)
{
return display_on;
}
#endif
/*** update functions ***/
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, /* 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)
{
const unsigned char *yuv_src[3];
const unsigned char *ysrc_max;
int y0;
int options;
/* NOT MODIFIED FOR THE YH-925 */
if (!display_on)
return;
width &= ~1;
height &= ~1;
x += x_offset;
/* calculate the drawing region */
/* The 20GB LCD is actually 128x160 but rotated 90 degrees so the origin
* is actually the bottom left and horizontal and vertical are swapped.
* Rockbox expects the origin to be the top left so we need to use
* 127 - y instead of just y */
/* max vert << 8 | start vert */
lcd_write_reg(R_VERT_RAM_ADDR_POS, ((x + width - 1) << 8) | x);
y0 = LCD_HEIGHT - 1 - y + y_offset;
/* DIT=0, BGR=1, HWM=0, I/D1-0=10, AM=0, LG2-0=000 */
lcd_write_reg(R_ENTRY_MODE, 0x1020);
yuv_src[0] = src[0] + src_y * stride + src_x;
yuv_src[1] = src[1] + (src_y * stride >> 2) + (src_x >> 1);
yuv_src[2] = src[2] + (yuv_src[1] - src[1]);
ysrc_max = yuv_src[0] + height * stride;
options = lcd_yuv_options;
do
{
/* max horiz << 8 | start horiz */
lcd_write_reg(R_HORIZ_RAM_ADDR_POS, (y0 << 8) | (y0 - 1));
/* position cursor (set AD0-AD15) */
/* start vert << 8 | start horiz */
lcd_write_reg(R_RAM_ADDR_SET, (x << 8) | y0);
/* start drawing */
lcd_send_cmd(R_WRITE_DATA_2_GRAM);
if (options & LCD_YUV_DITHER)
{
lcd_write_yuv420_lines_odither(yuv_src, width, stride,
x, y);
y -= 2;
}
else
{
lcd_write_yuv420_lines(yuv_src, width, stride);
}
y0 -= 2;
yuv_src[0] += stride << 1;
yuv_src[1] += stride >> 1;
yuv_src[2] += stride >> 1;
}
while (yuv_src[0] < ysrc_max);
/* DIT=0, BGR=1, HWM=0, I/D1-0=10, AM=1, LG2-0=000 */
lcd_write_reg(R_ENTRY_MODE, 0x1028);
}
/* Update a fraction of the display. */
void lcd_update_rect(int x0, int y0, int width, int height)
{
int x1, y1;
int lcd_x0, lcd_x1, lcd_y0, lcd_y1;
unsigned short *addr;
if (!display_on)
return;
/* calculate the drawing region */
y1 = (y0 + height) - 1; /* max vert */
x1 = (x0 + width) - 1; /* max horiz */
if(x1 >= LCD_WIDTH)
x1 = LCD_WIDTH - 1;
if (x1 <= 0)
return; /* nothing left to do, 0 is harmful to lcd_write_data() */
if(y1 >= LCD_HEIGHT)
y1 = LCD_HEIGHT-1;
/* The LCD is actually 128x160 rotated 90 degrees */
lcd_x0 = (LCD_HEIGHT - 1) - y1 + y_offset;
lcd_x1 = (LCD_HEIGHT - 1) - y0 + y_offset;
lcd_y0 = x0 + x_offset;
lcd_y1 = x1 + x_offset;
/* set the drawing window */
lcd_write_reg(R_HORIZ_RAM_ADDR_POS, (lcd_x1 << 8) | lcd_x0);
lcd_write_reg(R_VERT_RAM_ADDR_POS, (lcd_y1 << 8) | lcd_y0);
/* set the starting position */
lcd_write_reg(R_RAM_ADDR_SET, (lcd_y0 << 8) | lcd_x1);
/* start drawing */
lcd_send_cmd(R_WRITE_DATA_2_GRAM);
addr = (unsigned short*)FBADDR(x0,y0);
int c, r;
/* for each row */
for (r = 0; r < height; r++) {
/* for each column */
for (c = 0; c < width; c++) {
/* output 1 pixel */
lcd_send_data(*addr++);
}
addr += (LCD_WIDTH - width);
}
}
/* 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);
}
Reference in a new issue View git blame Copy permalink