mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-12-23 03:23:47 +00:00
567 lines
15 KiB
C
567 lines
15 KiB
C
|
/*
|
||
|
* (C) Copyright 2003
|
||
|
*
|
||
|
* Pantelis Antoniou <panto@intracom.gr>
|
||
|
* Intracom S.A.
|
||
|
*
|
||
|
* See file CREDITS for list of people who contributed to this
|
||
|
* project.
|
||
|
*
|
||
|
* 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 program is distributed in the hope that it will be useful,
|
||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
* GNU General Public License for more details.
|
||
|
*
|
||
|
* You should have received a copy of the GNU General Public License
|
||
|
* along with this program; if not, write to the Free Software
|
||
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
||
|
* MA 02111-1307 USA
|
||
|
*/
|
||
|
|
||
|
#include <common.h>
|
||
|
#include <watchdog.h>
|
||
|
|
||
|
#include <sed156x.h>
|
||
|
|
||
|
#ifdef CONFIG_SED156X
|
||
|
|
||
|
/* configure according to the selected display */
|
||
|
#if defined(CONFIG_SED156X_PG12864Q)
|
||
|
#define LCD_WIDTH 128
|
||
|
#define LCD_HEIGHT 64
|
||
|
#define LCD_LINES 64
|
||
|
#define LCD_PAGES 9
|
||
|
#define LCD_COLUMNS 132
|
||
|
#else
|
||
|
#error Unsupported SED156x configuration
|
||
|
#endif
|
||
|
|
||
|
/* include the font data */
|
||
|
#include <video_font.h>
|
||
|
|
||
|
#if VIDEO_FONT_WIDTH != 8 || VIDEO_FONT_HEIGHT != 16
|
||
|
#error Expecting VIDEO_FONT_WIDTH == 8 && VIDEO_FONT_HEIGHT == 16
|
||
|
#endif
|
||
|
|
||
|
#define LCD_BYTE_WIDTH (LCD_WIDTH / 8)
|
||
|
#define VIDEO_FONT_BYTE_WIDTH (VIDEO_FONT_WIDTH / 8)
|
||
|
|
||
|
#define LCD_TEXT_WIDTH (LCD_WIDTH / VIDEO_FONT_WIDTH)
|
||
|
#define LCD_TEXT_HEIGHT (LCD_HEIGHT / VIDEO_FONT_HEIGHT)
|
||
|
|
||
|
#define LCD_BYTE_LINESZ (LCD_BYTE_WIDTH * VIDEO_FONT_HEIGHT)
|
||
|
|
||
|
const int sed156x_text_width = LCD_TEXT_WIDTH;
|
||
|
const int sed156x_text_height = LCD_TEXT_HEIGHT;
|
||
|
|
||
|
/**************************************************************************************/
|
||
|
|
||
|
#define SED156X_SPI_RXD() (SED156X_SPI_RXD_PORT & SED156X_SPI_RXD_MASK)
|
||
|
|
||
|
#define SED156X_SPI_TXD(x) \
|
||
|
do { \
|
||
|
if (x) \
|
||
|
SED156X_SPI_TXD_PORT |= SED156X_SPI_TXD_MASK; \
|
||
|
else \
|
||
|
SED156X_SPI_TXD_PORT &= ~SED156X_SPI_TXD_MASK; \
|
||
|
} while(0)
|
||
|
|
||
|
#define SED156X_SPI_CLK(x) \
|
||
|
do { \
|
||
|
if (x) \
|
||
|
SED156X_SPI_CLK_PORT |= SED156X_SPI_CLK_MASK; \
|
||
|
else \
|
||
|
SED156X_SPI_CLK_PORT &= ~SED156X_SPI_CLK_MASK; \
|
||
|
} while(0)
|
||
|
|
||
|
#define SED156X_SPI_CLK_TOGGLE() (SED156X_SPI_CLK_PORT ^= SED156X_SPI_CLK_MASK)
|
||
|
|
||
|
#define SED156X_SPI_BIT_DELAY() /* no delay */
|
||
|
|
||
|
#define SED156X_CS(x) \
|
||
|
do { \
|
||
|
if (x) \
|
||
|
SED156X_CS_PORT |= SED156X_CS_MASK; \
|
||
|
else \
|
||
|
SED156X_CS_PORT &= ~SED156X_CS_MASK; \
|
||
|
} while(0)
|
||
|
|
||
|
#define SED156X_A0(x) \
|
||
|
do { \
|
||
|
if (x) \
|
||
|
SED156X_A0_PORT |= SED156X_A0_MASK; \
|
||
|
else \
|
||
|
SED156X_A0_PORT &= ~SED156X_A0_MASK; \
|
||
|
} while(0)
|
||
|
|
||
|
/**************************************************************************************/
|
||
|
|
||
|
/*** LCD Commands ***/
|
||
|
|
||
|
#define LCD_ON 0xAF /* Display ON */
|
||
|
#define LCD_OFF 0xAE /* Display OFF */
|
||
|
#define LCD_LADDR 0x40 /* Display start line set + (6-bit) address */
|
||
|
#define LCD_PADDR 0xB0 /* Page address set + (4-bit) page */
|
||
|
#define LCD_CADRH 0x10 /* Column address set upper + (4-bit) column hi */
|
||
|
#define LCD_CADRL 0x00 /* Column address set lower + (4-bit) column lo */
|
||
|
#define LCD_ADC_NRM 0xA0 /* ADC select Normal */
|
||
|
#define LCD_ADC_REV 0xA1 /* ADC select Reverse */
|
||
|
#define LCD_DSP_NRM 0xA6 /* LCD display Normal */
|
||
|
#define LCD_DSP_REV 0xA7 /* LCD display Reverse */
|
||
|
#define LCD_DPT_NRM 0xA4 /* Display all points Normal */
|
||
|
#define LCD_DPT_ALL 0xA5 /* Display all points ON */
|
||
|
#define LCD_BIAS9 0xA2 /* LCD bias set 1/9 */
|
||
|
#define LCD_BIAS7 0xA3 /* LCD bias set 1/7 */
|
||
|
#define LCD_CAINC 0xE0 /* Read/modify/write */
|
||
|
#define LCD_CAEND 0xEE /* End */
|
||
|
#define LCD_RESET 0xE2 /* Reset */
|
||
|
#define LCD_C_NRM 0xC0 /* Common output mode select Normal direction */
|
||
|
#define LCD_C_RVS 0xC8 /* Common output mode select Reverse direction */
|
||
|
#define LCD_PWRMD 0x28 /* Power control set + (3-bit) mode */
|
||
|
#define LCD_RESRT 0x20 /* V5 v. reg. int. resistor ratio set + (3-bit) ratio */
|
||
|
#define LCD_EVSET 0x81 /* Electronic volume mode set + byte = (6-bit) volume */
|
||
|
#define LCD_SIOFF 0xAC /* Static indicator OFF */
|
||
|
#define LCD_SION 0xAD /* Static indicator ON + byte = (2-bit) mode */
|
||
|
#define LCD_NOP 0xE3 /* NOP */
|
||
|
#define LCD_TEST 0xF0 /* Test/Test mode reset (Note: *DO NOT USE*) */
|
||
|
|
||
|
/*-------------------------------------------------------------------------------
|
||
|
Compound commands
|
||
|
-------------------------------------------------------------------------------
|
||
|
Command Description Commands
|
||
|
---------- ------------------------ -------------------------------------
|
||
|
POWS_ON POWER SAVER ON command LCD_OFF, LCD_D_ALL
|
||
|
POWS_OFF POWER SAVER OFF command LCD_D_NRM
|
||
|
SLEEPON SLEEP mode LCD_SIOFF, POWS_ON
|
||
|
SLEEPOFF SLEEP mode cancel LCD_D_NRM, LCD_SION, LCD_SIS_???
|
||
|
STDBYON STAND BY mode LCD_SION, POWS_ON
|
||
|
STDBYOFF STAND BY mode cancel LCD_D_NRM
|
||
|
-------------------------------------------------------------------------------*/
|
||
|
|
||
|
/*** LCD various parameters ***/
|
||
|
#define LCD_PPB 8 /* Pixels per byte (display is B/W, 1 bit per pixel) */
|
||
|
|
||
|
/*** LCD Status byte masks ***/
|
||
|
#define LCD_S_BUSY 0x80 /* Status Read - BUSY mask */
|
||
|
#define LCD_S_ADC 0x40 /* Status Read - ADC mask */
|
||
|
#define LCD_S_ONOFF 0x20 /* Status Read - ON/OFF mask */
|
||
|
#define LCD_S_RESET 0x10 /* Status Read - RESET mask */
|
||
|
|
||
|
/*** LCD commands parameter masks ***/
|
||
|
#define LCD_M_LADDR 0x3F /* Display start line (6-bit) address mask */
|
||
|
#define LCD_M_PADDR 0x0F /* Page address (4-bit) page mask */
|
||
|
#define LCD_M_CADRH 0x0F /* Column address upper (4-bit) column hi mask */
|
||
|
#define LCD_M_CADRL 0x0F /* Column address lower (4-bit) column lo mask */
|
||
|
#define LCD_M_PWRMD 0x07 /* Power control (3-bit) mode mask */
|
||
|
#define LCD_M_RESRT 0x07 /* V5 v. reg. int. resistor ratio (3-bit) ratio mask */
|
||
|
#define LCD_M_EVSET 0x3F /* Electronic volume mode byte (6-bit) volume mask */
|
||
|
#define LCD_M_SION 0x03 /* Static indicator ON (2-bit) mode mask */
|
||
|
|
||
|
/*** LCD Power control cirquits control masks ***/
|
||
|
#define LCD_PWRBSTR 0x04 /* Power control mode - Booster cirquit ON */
|
||
|
#define LCD_PWRVREG 0x02 /* Power control mode - Voltage regulator cirquit ON */
|
||
|
#define LCD_PWRVFOL 0x01 /* Power control mode - Voltage follower cirquit ON */
|
||
|
|
||
|
/*** LCD Static indicator states ***/
|
||
|
#define LCD_SIS_OFF 0x00 /* Static indicator register set - OFF state */
|
||
|
#define LCD_SIS_BL 0x01 /* Static indicator register set - 1s blink state */
|
||
|
#define LCD_SIS_RBL 0x02 /* Static indicator register set - .5s rapid blink state */
|
||
|
#define LCD_SIS_ON 0x03 /* Static indicator register set - constantly on state */
|
||
|
|
||
|
/*** LCD functions special parameters (commands) ***/
|
||
|
#define LCD_PREVP 0x80 /* Page number for moving to previous */
|
||
|
#define LCD_NEXTP 0x81 /* or next page */
|
||
|
#define LCD_ERR_P 0xFF /* Error in page number */
|
||
|
|
||
|
/*** LCD initialization settings ***/
|
||
|
#define LCD_BIAS LCD_BIAS9 /* Bias: 1/9 */
|
||
|
#define LCD_ADCMODE LCD_ADC_NRM /* ADC mode: normal */
|
||
|
#define LCD_COMDIR LCD_C_NRM /* Common output mode: normal */
|
||
|
#define LCD_RRATIO 0 /* Resistor ratio: 0 */
|
||
|
#define LCD_CNTRST 0x1C /* electronic volume: 1Ch */
|
||
|
#define LCD_POWERM (LCD_PWRBSTR | LCD_PWRVREG | LCD_PWRVFOL) /* Power mode: All on */
|
||
|
|
||
|
/**************************************************************************************/
|
||
|
|
||
|
static inline unsigned int sed156x_transfer(unsigned int val)
|
||
|
{
|
||
|
unsigned int rx;
|
||
|
int b;
|
||
|
|
||
|
rx = 0; b = 8;
|
||
|
while (--b >= 0) {
|
||
|
SED156X_SPI_TXD(val & 0x80);
|
||
|
val <<= 1;
|
||
|
SED156X_SPI_CLK_TOGGLE();
|
||
|
SED156X_SPI_BIT_DELAY();
|
||
|
rx <<= 1;
|
||
|
if (SED156X_SPI_RXD())
|
||
|
rx |= 1;
|
||
|
SED156X_SPI_CLK_TOGGLE();
|
||
|
SED156X_SPI_BIT_DELAY();
|
||
|
}
|
||
|
|
||
|
return rx;
|
||
|
}
|
||
|
|
||
|
unsigned int sed156x_data_transfer(unsigned int val)
|
||
|
{
|
||
|
unsigned int rx;
|
||
|
|
||
|
SED156X_SPI_CLK(1);
|
||
|
SED156X_CS(0);
|
||
|
SED156X_A0(1);
|
||
|
|
||
|
rx = sed156x_transfer(val);
|
||
|
|
||
|
SED156X_CS(1);
|
||
|
|
||
|
return rx;
|
||
|
}
|
||
|
|
||
|
void sed156x_data_block_transfer(const u8 *p, int size)
|
||
|
{
|
||
|
SED156X_SPI_CLK(1);
|
||
|
SED156X_CS(0);
|
||
|
SED156X_A0(1);
|
||
|
|
||
|
while (--size >= 0)
|
||
|
sed156x_transfer(*p++);
|
||
|
|
||
|
SED156X_CS(1);
|
||
|
}
|
||
|
|
||
|
unsigned int sed156x_cmd_transfer(unsigned int val)
|
||
|
{
|
||
|
unsigned int rx;
|
||
|
|
||
|
SED156X_SPI_CLK(1);
|
||
|
SED156X_CS(0);
|
||
|
SED156X_A0(0);
|
||
|
|
||
|
rx = sed156x_transfer(val);
|
||
|
|
||
|
SED156X_CS(1);
|
||
|
SED156X_A0(1);
|
||
|
|
||
|
return rx;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************/
|
||
|
|
||
|
static u8 hw_screen[LCD_PAGES][LCD_COLUMNS];
|
||
|
static u8 last_hw_screen[LCD_PAGES][LCD_COLUMNS];
|
||
|
static u8 sw_screen[LCD_BYTE_WIDTH * LCD_HEIGHT];
|
||
|
|
||
|
void sed156x_sync(void)
|
||
|
{
|
||
|
int i, j, last_page;
|
||
|
u8 *d;
|
||
|
const u8 *s, *e, *b, *r;
|
||
|
u8 v0, v1, v2, v3, v4, v5, v6, v7;
|
||
|
|
||
|
/* copy and rotate sw_screen to hw_screen */
|
||
|
for (i = 0; i < LCD_HEIGHT / 8; i++) {
|
||
|
|
||
|
d = &hw_screen[i][0];
|
||
|
s = &sw_screen[LCD_BYTE_WIDTH * 8 * i + LCD_BYTE_WIDTH - 1];
|
||
|
|
||
|
for (j = 0; j < LCD_WIDTH / 8; j++) {
|
||
|
|
||
|
v0 = s[0 * LCD_BYTE_WIDTH];
|
||
|
v1 = s[1 * LCD_BYTE_WIDTH];
|
||
|
v2 = s[2 * LCD_BYTE_WIDTH];
|
||
|
v3 = s[3 * LCD_BYTE_WIDTH];
|
||
|
v4 = s[4 * LCD_BYTE_WIDTH];
|
||
|
v5 = s[5 * LCD_BYTE_WIDTH];
|
||
|
v6 = s[6 * LCD_BYTE_WIDTH];
|
||
|
v7 = s[7 * LCD_BYTE_WIDTH];
|
||
|
|
||
|
d[0] = ((v7 & 0x01) << 7) |
|
||
|
((v6 & 0x01) << 6) |
|
||
|
((v5 & 0x01) << 5) |
|
||
|
((v4 & 0x01) << 4) |
|
||
|
((v3 & 0x01) << 3) |
|
||
|
((v2 & 0x01) << 2) |
|
||
|
((v1 & 0x01) << 1) |
|
||
|
(v0 & 0x01) ;
|
||
|
|
||
|
d[1] = ((v7 & 0x02) << 6) |
|
||
|
((v6 & 0x02) << 5) |
|
||
|
((v5 & 0x02) << 4) |
|
||
|
((v4 & 0x02) << 3) |
|
||
|
((v3 & 0x02) << 2) |
|
||
|
((v2 & 0x02) << 1) |
|
||
|
((v1 & 0x02) << 0) |
|
||
|
((v0 & 0x02) >> 1) ;
|
||
|
|
||
|
d[2] = ((v7 & 0x04) << 5) |
|
||
|
((v6 & 0x04) << 4) |
|
||
|
((v5 & 0x04) << 3) |
|
||
|
((v4 & 0x04) << 2) |
|
||
|
((v3 & 0x04) << 1) |
|
||
|
(v2 & 0x04) |
|
||
|
((v1 & 0x04) >> 1) |
|
||
|
((v0 & 0x04) >> 2) ;
|
||
|
|
||
|
d[3] = ((v7 & 0x08) << 4) |
|
||
|
((v6 & 0x08) << 3) |
|
||
|
((v5 & 0x08) << 2) |
|
||
|
((v4 & 0x08) << 1) |
|
||
|
(v3 & 0x08) |
|
||
|
((v2 & 0x08) >> 1) |
|
||
|
((v1 & 0x08) >> 2) |
|
||
|
((v0 & 0x08) >> 3) ;
|
||
|
|
||
|
d[4] = ((v7 & 0x10) << 3) |
|
||
|
((v6 & 0x10) << 2) |
|
||
|
((v5 & 0x10) << 1) |
|
||
|
(v4 & 0x10) |
|
||
|
((v3 & 0x10) >> 1) |
|
||
|
((v2 & 0x10) >> 2) |
|
||
|
((v1 & 0x10) >> 3) |
|
||
|
((v0 & 0x10) >> 4) ;
|
||
|
|
||
|
d[5] = ((v7 & 0x20) << 2) |
|
||
|
((v6 & 0x20) << 1) |
|
||
|
(v5 & 0x20) |
|
||
|
((v4 & 0x20) >> 1) |
|
||
|
((v3 & 0x20) >> 2) |
|
||
|
((v2 & 0x20) >> 3) |
|
||
|
((v1 & 0x20) >> 4) |
|
||
|
((v0 & 0x20) >> 5) ;
|
||
|
|
||
|
d[6] = ((v7 & 0x40) << 1) |
|
||
|
(v6 & 0x40) |
|
||
|
((v5 & 0x40) >> 1) |
|
||
|
((v4 & 0x40) >> 2) |
|
||
|
((v3 & 0x40) >> 3) |
|
||
|
((v2 & 0x40) >> 4) |
|
||
|
((v1 & 0x40) >> 5) |
|
||
|
((v0 & 0x40) >> 6) ;
|
||
|
|
||
|
d[7] = (v7 & 0x80) |
|
||
|
((v6 & 0x80) >> 1) |
|
||
|
((v5 & 0x80) >> 2) |
|
||
|
((v4 & 0x80) >> 3) |
|
||
|
((v3 & 0x80) >> 4) |
|
||
|
((v2 & 0x80) >> 5) |
|
||
|
((v1 & 0x80) >> 6) |
|
||
|
((v0 & 0x80) >> 7) ;
|
||
|
|
||
|
d += 8;
|
||
|
s--;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* and now output only the differences */
|
||
|
for (i = 0; i < LCD_PAGES; i++) {
|
||
|
|
||
|
b = &hw_screen[i][0];
|
||
|
e = &hw_screen[i][LCD_COLUMNS];
|
||
|
|
||
|
d = &last_hw_screen[i][0];
|
||
|
s = b;
|
||
|
|
||
|
last_page = -1;
|
||
|
|
||
|
/* update only the differences */
|
||
|
do {
|
||
|
while (s < e && *s == *d) {
|
||
|
s++;
|
||
|
d++;
|
||
|
}
|
||
|
if (s == e)
|
||
|
break;
|
||
|
r = s;
|
||
|
while (s < e && *s != *d)
|
||
|
*d++ = *s++;
|
||
|
|
||
|
j = r - b;
|
||
|
|
||
|
if (i != last_page) {
|
||
|
sed156x_cmd_transfer(LCD_PADDR | i);
|
||
|
last_page = i;
|
||
|
}
|
||
|
|
||
|
sed156x_cmd_transfer(LCD_CADRH | ((j >> 4) & 0x0F));
|
||
|
sed156x_cmd_transfer(LCD_CADRL | (j & 0x0F));
|
||
|
sed156x_data_block_transfer(r, s - r);
|
||
|
|
||
|
} while (s < e);
|
||
|
}
|
||
|
|
||
|
/********
|
||
|
for (i = 0; i < LCD_PAGES; i++) {
|
||
|
sed156x_cmd_transfer(LCD_PADDR | i);
|
||
|
sed156x_cmd_transfer(LCD_CADRH | 0);
|
||
|
sed156x_cmd_transfer(LCD_CADRL | 0);
|
||
|
sed156x_data_block_transfer(&hw_screen[i][0], LCD_COLUMNS);
|
||
|
}
|
||
|
memcpy(last_hw_screen, hw_screen, sizeof(last_hw_screen));
|
||
|
********/
|
||
|
}
|
||
|
|
||
|
void sed156x_clear(void)
|
||
|
{
|
||
|
memset(sw_screen, 0, sizeof(sw_screen));
|
||
|
}
|
||
|
|
||
|
void sed156x_output_at(int x, int y, const char *str, int size)
|
||
|
{
|
||
|
int i, j;
|
||
|
u8 *p;
|
||
|
const u8 *s;
|
||
|
|
||
|
if ((unsigned int)y >= LCD_TEXT_HEIGHT || (unsigned int)x >= LCD_TEXT_WIDTH)
|
||
|
return;
|
||
|
|
||
|
p = &sw_screen[y * VIDEO_FONT_HEIGHT * LCD_BYTE_WIDTH + x * VIDEO_FONT_BYTE_WIDTH];
|
||
|
|
||
|
while (--size >= 0) {
|
||
|
|
||
|
s = &video_fontdata[((int)*str++ & 0xff) * VIDEO_FONT_BYTE_WIDTH * VIDEO_FONT_HEIGHT];
|
||
|
for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
|
||
|
for (j = 0; j < VIDEO_FONT_BYTE_WIDTH; j++)
|
||
|
*p++ = *s++;
|
||
|
p += LCD_BYTE_WIDTH - VIDEO_FONT_BYTE_WIDTH;
|
||
|
}
|
||
|
p -= (LCD_BYTE_LINESZ - VIDEO_FONT_BYTE_WIDTH);
|
||
|
|
||
|
if (x >= LCD_TEXT_WIDTH)
|
||
|
break;
|
||
|
x++;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void sed156x_reverse_at(int x, int y, int size)
|
||
|
{
|
||
|
int i, j;
|
||
|
u8 *p;
|
||
|
|
||
|
if ((unsigned int)y >= LCD_TEXT_HEIGHT || (unsigned int)x >= LCD_TEXT_WIDTH)
|
||
|
return;
|
||
|
|
||
|
p = &sw_screen[y * VIDEO_FONT_HEIGHT * LCD_BYTE_WIDTH + x * VIDEO_FONT_BYTE_WIDTH];
|
||
|
|
||
|
while (--size >= 0) {
|
||
|
|
||
|
for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
|
||
|
for (j = 0; j < VIDEO_FONT_BYTE_WIDTH; j++, p++)
|
||
|
*p = ~*p;
|
||
|
p += LCD_BYTE_WIDTH - VIDEO_FONT_BYTE_WIDTH;
|
||
|
}
|
||
|
p -= (LCD_BYTE_LINESZ - VIDEO_FONT_BYTE_WIDTH);
|
||
|
|
||
|
if (x >= LCD_TEXT_WIDTH)
|
||
|
break;
|
||
|
x++;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void sed156x_scroll_line(void)
|
||
|
{
|
||
|
memmove(&sw_screen[0],
|
||
|
&sw_screen[LCD_BYTE_LINESZ],
|
||
|
LCD_BYTE_WIDTH * (LCD_HEIGHT - VIDEO_FONT_HEIGHT));
|
||
|
}
|
||
|
|
||
|
void sed156x_scroll(int dx, int dy)
|
||
|
{
|
||
|
u8 *p1 = NULL, *p2 = NULL, *p3 = NULL; /* pacify gcc */
|
||
|
int adx, ady, i, sz;
|
||
|
|
||
|
adx = dx > 0 ? dx : -dx;
|
||
|
ady = dy > 0 ? dy : -dy;
|
||
|
|
||
|
/* overscroll? erase everything */
|
||
|
if (adx >= LCD_TEXT_WIDTH || ady >= LCD_TEXT_HEIGHT) {
|
||
|
memset(sw_screen, 0, sizeof(sw_screen));
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
sz = LCD_BYTE_LINESZ * ady;
|
||
|
if (dy > 0) {
|
||
|
p1 = &sw_screen[0];
|
||
|
p2 = &sw_screen[sz];
|
||
|
p3 = &sw_screen[LCD_BYTE_WIDTH * LCD_HEIGHT - sz];
|
||
|
} else if (dy < 0) {
|
||
|
p1 = &sw_screen[sz];
|
||
|
p2 = &sw_screen[0];
|
||
|
p3 = &sw_screen[0];
|
||
|
}
|
||
|
|
||
|
if (ady > 0) {
|
||
|
memmove(p1, p2, LCD_BYTE_WIDTH * LCD_HEIGHT - sz);
|
||
|
memset(p3, 0, sz);
|
||
|
}
|
||
|
|
||
|
sz = VIDEO_FONT_BYTE_WIDTH * adx;
|
||
|
if (dx > 0) {
|
||
|
p1 = &sw_screen[0];
|
||
|
p2 = &sw_screen[0] + sz;
|
||
|
p3 = &sw_screen[0] + LCD_BYTE_WIDTH - sz;
|
||
|
} else if (dx < 0) {
|
||
|
p1 = &sw_screen[0] + sz;
|
||
|
p2 = &sw_screen[0];
|
||
|
p3 = &sw_screen[0];
|
||
|
}
|
||
|
|
||
|
/* xscroll */
|
||
|
if (adx > 0) {
|
||
|
for (i = 0; i < LCD_HEIGHT; i++) {
|
||
|
memmove(p1, p2, LCD_BYTE_WIDTH - sz);
|
||
|
memset(p3, 0, sz);
|
||
|
p1 += LCD_BYTE_WIDTH;
|
||
|
p2 += LCD_BYTE_WIDTH;
|
||
|
p3 += LCD_BYTE_WIDTH;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void sed156x_init(void)
|
||
|
{
|
||
|
int i;
|
||
|
|
||
|
SED156X_CS(1);
|
||
|
SED156X_A0(1);
|
||
|
|
||
|
/* Send initialization commands to the LCD */
|
||
|
sed156x_cmd_transfer(LCD_OFF); /* Turn display OFF */
|
||
|
sed156x_cmd_transfer(LCD_BIAS); /* set the LCD Bias, */
|
||
|
sed156x_cmd_transfer(LCD_ADCMODE); /* ADC mode, */
|
||
|
sed156x_cmd_transfer(LCD_COMDIR); /* common output mode, */
|
||
|
sed156x_cmd_transfer(LCD_RESRT | LCD_RRATIO); /* resistor ratio, */
|
||
|
sed156x_cmd_transfer(LCD_EVSET); /* electronic volume, */
|
||
|
sed156x_cmd_transfer(LCD_CNTRST);
|
||
|
sed156x_cmd_transfer(LCD_PWRMD | LCD_POWERM); /* and power mode */
|
||
|
sed156x_cmd_transfer(LCD_PADDR | 0); /* cursor home */
|
||
|
sed156x_cmd_transfer(LCD_CADRH | 0);
|
||
|
sed156x_cmd_transfer(LCD_CADRL | 0);
|
||
|
sed156x_cmd_transfer(LCD_LADDR | 0); /* and display start line */
|
||
|
sed156x_cmd_transfer(LCD_DSP_NRM); /* LCD display Normal */
|
||
|
|
||
|
/* clear everything */
|
||
|
memset(sw_screen, 0, sizeof(sw_screen));
|
||
|
memset(hw_screen, 0, sizeof(hw_screen));
|
||
|
memset(last_hw_screen, 0, sizeof(last_hw_screen));
|
||
|
|
||
|
for (i = 0; i < LCD_PAGES; i++) {
|
||
|
sed156x_cmd_transfer(LCD_PADDR | i);
|
||
|
sed156x_cmd_transfer(LCD_CADRH | 0);
|
||
|
sed156x_cmd_transfer(LCD_CADRL | 0);
|
||
|
sed156x_data_block_transfer(&hw_screen[i][0], LCD_COLUMNS);
|
||
|
}
|
||
|
|
||
|
sed156x_clear();
|
||
|
sed156x_sync();
|
||
|
sed156x_cmd_transfer(LCD_ON); /* Turn display ON */
|
||
|
}
|
||
|
|
||
|
#endif /* CONFIG_SED156X */
|