[people/ms/u-boot.git] / board / esd / common / lcd.c

/*
 * (C) Copyright 2003-2004
 * Stefan Roese, esd gmbh germany, stefan.roese@esd-electronics.com
 *
 * 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 "lcd.h"


int palette_index;
int palette_value;


#ifdef CFG_LCD_ENDIAN
void lcd_setup(int lcd, int config)
{
	if (lcd == 0) {
		/*
		 * Set endianess and reset lcd controller 0 (small)
		 */
		out32(GPIO0_OR, in32(GPIO0_OR) & ~CFG_LCD0_RST); /* set reset to low */
		udelay(10); /* wait 10us */
		if (config == 1) {
			out32(GPIO0_OR, in32(GPIO0_OR) | CFG_LCD_ENDIAN); /* big-endian */
		} else {
			out32(GPIO0_OR, in32(GPIO0_OR) & ~CFG_LCD_ENDIAN); /* little-endian */
		}
		udelay(10); /* wait 10us */
		out32(GPIO0_OR, in32(GPIO0_OR) | CFG_LCD0_RST); /* set reset to high */
	} else {
		/*
		 * Set endianess and reset lcd controller 1 (big)
		 */
		out32(GPIO0_OR, in32(GPIO0_OR) & ~CFG_LCD1_RST); /* set reset to low */
		udelay(10); /* wait 10us */
		if (config == 1) {
			out32(GPIO0_OR, in32(GPIO0_OR) | CFG_LCD_ENDIAN); /* big-endian */
		} else {
			out32(GPIO0_OR, in32(GPIO0_OR) & ~CFG_LCD_ENDIAN); /* little-endian */
		}
		udelay(10); /* wait 10us */
		out32(GPIO0_OR, in32(GPIO0_OR) | CFG_LCD1_RST); /* set reset to high */
	}

	/*
	 * CFG_LCD_ENDIAN may also be FPGA_RESET, so set inactive
	 */
	out32(GPIO0_OR, in32(GPIO0_OR) | CFG_LCD_ENDIAN); /* set reset high again */
}
#endif /* #ifdef CFG_LCD_ENDIAN */


void lcd_init(uchar *lcd_reg, uchar *lcd_mem, S1D_REGS *regs, int reg_count,
	      uchar *logo_bmp, ulong len)
{
	int i;
	ushort s1dReg;
	uchar s1dValue;
	uchar *ptr;
	ushort *ptr2;
	ushort val;
	unsigned char *dst;
	int x, y;
	int width, height, bpp, colors, line_size;
	int header_size;
	unsigned char *bmp;
	unsigned char r, g, b;
	BITMAPINFOHEADER *bm_info;
	int reg_byte_swap;

	/*
	 * Detect epson
	 */
	if (lcd_reg[0] == 0x1c) {
		/*
		 * Big epson detected
		 */
		reg_byte_swap = FALSE;
		palette_index = 0x1e2;
		palette_value = 0x1e4;
		puts("LCD:   S1D13806");
	} else if (lcd_reg[1] == 0x1c) {
		/*
		 * Big epson detected (with register swap bug)
		 */
		reg_byte_swap = TRUE;
		palette_index = 0x1e3;
		palette_value = 0x1e5;
		puts("LCD:   S1D13806S");
	} else if (lcd_reg[0] == 0x18) {
		/*
		 * Small epson detected (704)
		 */
		reg_byte_swap = FALSE;
		palette_index = 0x15;
		palette_value = 0x17;
		puts("LCD:   S1D13704");
	} else if (lcd_reg[0x10000] == 0x24) {
		/*
		 * Small epson detected (705)
		 */
		reg_byte_swap = FALSE;
		palette_index = 0x15;
		palette_value = 0x17;
		lcd_reg += 0x10000; /* add offset for 705 regs */
		puts("LCD:   S1D13705");
	} else {
		puts("LCD:   No controller detected!\n");
		return;
	}

	for (i = 0; i<reg_count; i++) {
		s1dReg = regs[i].Index;
		if (reg_byte_swap) {
			if ((s1dReg & 0x0001) == 0)
				s1dReg |= 0x0001;
			else
				s1dReg &= ~0x0001;
		}
		s1dValue = regs[i].Value;
		lcd_reg[s1dReg] = s1dValue;
	}

	/*
	 * Decompress bmp image
	 */
	dst = malloc(CFG_LCD_LOGO_MAX_SIZE);
	if (gunzip(dst, CFG_LCD_LOGO_MAX_SIZE, (uchar *)logo_bmp, &len) != 0) {
		return;
	}

	/*
	 * Check for bmp mark 'BM'
	 */
	if (*(ushort *)dst != 0x424d) {
		printf("LCD: Unknown image format!\n");
		free(dst);
		return;
	}

	/*
	 * Get image info from bmp-header
	 */
	bm_info = (BITMAPINFOHEADER *)(dst + 14);
	bpp = LOAD_SHORT(bm_info->biBitCount);
	width = LOAD_LONG(bm_info->biWidth);
	height = LOAD_LONG(bm_info->biHeight);
	switch (bpp) {
	case 1:
		colors = 1;
		line_size = width >> 3;
		break;
	case 4:
		colors = 16;
		line_size = width >> 1;
		break;
	case 8:
		colors = 256;
		line_size = width;
		break;
	case 24:
		colors = 0;
		line_size = width * 3;
		break;
	default:
		printf("LCD: Unknown bpp (%d) im image!\n", bpp);
		free(dst);
		return;
	}
	printf(" (%d*%d, %dbpp)\n", width, height, bpp);

	/*
	 * Write color palette
	 */
	if (colors <= 256) {
		ptr = (unsigned char *)(dst + 14 + 40);
		for (i=0; i<colors; i++) {
			b = *ptr++;
			g = *ptr++;
			r = *ptr++;
			ptr++;
			S1D_WRITE_PALETTE(lcd_reg, i, r, g, b);
		}
	}

	/*
	 * Write bitmap data into framebuffer
	 */
	ptr = lcd_mem;
	ptr2 = (ushort *)lcd_mem;
	header_size = 14 + 40 + 4*colors;          /* skip bmp header */
	for (y=0; y<height; y++) {
		bmp = &dst[(height-1-y)*line_size + header_size];
		if (bpp == 24) {
			for (x=0; x<width; x++) {
				/*
				 * Generate epson 16bpp fb-format from 24bpp image
				 */
				b = *bmp++ >> 3;
				g = *bmp++ >> 2;
				r = *bmp++ >> 3;
				val = ((r & 0x1f) << 11) | ((g & 0x3f) << 5) | (b & 0x1f);
				*ptr2++ = val;
			}
		} else {
			for (x=0; x<line_size; x++) {
				*ptr++ = *bmp++;
			}
		}
	}

	free(dst);
}
Commit	Line	Data
0621f6f9 SR	1	/*
	2	* (C) Copyright 2003-2004
	3	* Stefan Roese, esd gmbh germany, stefan.roese@esd-electronics.com
	4	*
	5	* See file CREDITS for list of people who contributed to this
	6	* project.
	7	*
	8	* This program is free software; you can redistribute it and/or
	9	* modify it under the terms of the GNU General Public License as
	10	* published by the Free Software Foundation; either version 2 of
	11	* the License, or (at your option) any later version.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	21	* MA 02111-1307 USA
	22	*/
	23
	24	#include "lcd.h"
	25
	26
	27	int palette_index;
	28	int palette_value;
	29
	30
	31	#ifdef CFG_LCD_ENDIAN
	32	void lcd_setup(int lcd, int config)
	33	{
	34	if (lcd == 0) {
	35	/*
	36	* Set endianess and reset lcd controller 0 (small)
	37	*/
	38	out32(GPIO0_OR, in32(GPIO0_OR) & ~CFG_LCD0_RST); /* set reset to low */
	39	udelay(10); /* wait 10us */
	40	if (config == 1) {
	41	out32(GPIO0_OR, in32(GPIO0_OR) \| CFG_LCD_ENDIAN); /* big-endian */
	42	} else {
	43	out32(GPIO0_OR, in32(GPIO0_OR) & ~CFG_LCD_ENDIAN); /* little-endian */
	44	}
	45	udelay(10); /* wait 10us */
	46	out32(GPIO0_OR, in32(GPIO0_OR) \| CFG_LCD0_RST); /* set reset to high */
	47	} else {
	48	/*
	49	* Set endianess and reset lcd controller 1 (big)
	50	*/
	51	out32(GPIO0_OR, in32(GPIO0_OR) & ~CFG_LCD1_RST); /* set reset to low */
	52	udelay(10); /* wait 10us */
	53	if (config == 1) {
	54	out32(GPIO0_OR, in32(GPIO0_OR) \| CFG_LCD_ENDIAN); /* big-endian */
	55	} else {
	56	out32(GPIO0_OR, in32(GPIO0_OR) & ~CFG_LCD_ENDIAN); /* little-endian */
	57	}
	58	udelay(10); /* wait 10us */
	59	out32(GPIO0_OR, in32(GPIO0_OR) \| CFG_LCD1_RST); /* set reset to high */
	60	}
	61
	62	/*
	63	* CFG_LCD_ENDIAN may also be FPGA_RESET, so set inactive
	64	*/
65	out32(GPIO0_OR, in32(GPIO0_OR) \| CFG_LCD_ENDIAN); /* set reset high again */
66	}
67	#endif /* #ifdef CFG_LCD_ENDIAN */
68
69
70	void lcd_init(uchar lcd_reg, uchar lcd_mem, S1D_REGS *regs, int reg_count,
71	uchar *logo_bmp, ulong len)
72	{
73	int i;
74	ushort s1dReg;
75	uchar s1dValue;
76	uchar *ptr;
77	ushort *ptr2;
78	ushort val;
79	unsigned char *dst;
80	int x, y;
81	int width, height, bpp, colors, line_size;
82	int header_size;
83	unsigned char *bmp;
84	unsigned char r, g, b;
85	BITMAPINFOHEADER *bm_info;
86	int reg_byte_swap;
87
88	/*
89	* Detect epson
90	*/
91	if (lcd_reg[0] == 0x1c) {
92	/*
93	* Big epson detected
94	*/
95	reg_byte_swap = FALSE;
96	palette_index = 0x1e2;
97	palette_value = 0x1e4;
98	puts("LCD: S1D13806");
99	} else if (lcd_reg[1] == 0x1c) {
100	/*
101	* Big epson detected (with register swap bug)
102	*/
103	reg_byte_swap = TRUE;
104	palette_index = 0x1e3;
105	palette_value = 0x1e5;
106	puts("LCD: S1D13806S");
107	} else if (lcd_reg[0] == 0x18) {
108	/*
109	* Small epson detected (704)
110	*/
111	reg_byte_swap = FALSE;
112	palette_index = 0x15;
113	palette_value = 0x17;
114	puts("LCD: S1D13704");
115	} else if (lcd_reg[0x10000] == 0x24) {
116	/*
117	* Small epson detected (705)
118	*/
119	reg_byte_swap = FALSE;
120	palette_index = 0x15;
121	palette_value = 0x17;
122	lcd_reg += 0x10000; /* add offset for 705 regs */
123	puts("LCD: S1D13705");
124	} else {
125	puts("LCD: No controller detected!\n");
126	return;
127	}
128
129	for (i = 0; i<reg_count; i++) {
130	s1dReg = regs[i].Index;
131	if (reg_byte_swap) {
132	if ((s1dReg & 0x0001) == 0)
133	s1dReg \|= 0x0001;
134	else
135	s1dReg &= ~0x0001;
136	}
137	s1dValue = regs[i].Value;
138	lcd_reg[s1dReg] = s1dValue;
efe2a4d5	139	}
0621f6f9 SR	140
	141	/*
	142	* Decompress bmp image
	143	*/
	144	dst = malloc(CFG_LCD_LOGO_MAX_SIZE);
	145	if (gunzip(dst, CFG_LCD_LOGO_MAX_SIZE, (uchar *)logo_bmp, &len) != 0) {
	146	return;
	147	}
	148
	149	/*
	150	* Check for bmp mark 'BM'
	151	*/
	152	if ((ushort )dst != 0x424d) {
	153	printf("LCD: Unknown image format!\n");
	154	free(dst);
	155	return;
	156	}
	157
	158	/*
	159	* Get image info from bmp-header
	160	*/
	161	bm_info = (BITMAPINFOHEADER *)(dst + 14);
	162	bpp = LOAD_SHORT(bm_info->biBitCount);
	163	width = LOAD_LONG(bm_info->biWidth);
	164	height = LOAD_LONG(bm_info->biHeight);
	165	switch (bpp) {
	166	case 1:
	167	colors = 1;
	168	line_size = width >> 3;
	169	break;
	170	case 4:
	171	colors = 16;
	172	line_size = width >> 1;
	173	break;
	174	case 8:
	175	colors = 256;
	176	line_size = width;
	177	break;
	178	case 24:
	179	colors = 0;
	180	line_size = width * 3;
	181	break;
	182	default:
	183	printf("LCD: Unknown bpp (%d) im image!\n", bpp);
	184	free(dst);
	185	return;
	186	}
	187	printf(" (%d*%d, %dbpp)\n", width, height, bpp);
	188
	189	/*
	190	* Write color palette
	191	*/
	192	if (colors <= 256) {
	193	ptr = (unsigned char *)(dst + 14 + 40);
	194	for (i=0; i<colors; i++) {
	195	b = *ptr++;
	196	g = *ptr++;
	197	r = *ptr++;
	198	ptr++;
	199	S1D_WRITE_PALETTE(lcd_reg, i, r, g, b);
	200	}
	201	}
	202
	203	/*
204	* Write bitmap data into framebuffer
205	*/
206	ptr = lcd_mem;
207	ptr2 = (ushort *)lcd_mem;
208	header_size = 14 + 40 + 4colors; / skip bmp header */
209	for (y=0; y<height; y++) {
210	bmp = &dst[(height-1-y)*line_size + header_size];
211	if (bpp == 24) {
212	for (x=0; x<width; x++) {
213	/*
214	* Generate epson 16bpp fb-format from 24bpp image
215	*/
216	b = *bmp++ >> 3;
217	g = *bmp++ >> 2;
218	r = *bmp++ >> 3;
219	val = ((r & 0x1f) << 11) \| ((g & 0x3f) << 5) \| (b & 0x1f);
220	*ptr2++ = val;
221	}
222	} else {
223	for (x=0; x<line_size; x++) {
224	ptr++ = bmp++;
225	}
226	}
227	}
228
229	free(dst);
230	}