mirror of
				https://github.com/smaeul/u-boot.git
				synced 2025-11-04 05:50:17 +00:00 
			
		
		
		
	- add support for the Epson 156x series of graphical displays
    (These displays are serial and not suitable for using a normal
    framebuffer console on them)
  - add infrastructure needed in order to POST any DSPs in a board
		
	
			
		
			
				
	
	
		
			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 */
 |