xref: /OK3568_Linux_fs/u-boot/drivers/video/bus_vcxk.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * (C) Copyright 2005-2009
3*4882a593Smuzhiyun  * Jens Scharsig @ BuS Elektronik GmbH & Co. KG, <esw@bus-elektronik.de>
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * SPDX-License-Identifier:	GPL-2.0+
6*4882a593Smuzhiyun  */
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun #include <common.h>
9*4882a593Smuzhiyun #include <bmp_layout.h>
10*4882a593Smuzhiyun #include <asm/io.h>
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun vu_char  *vcxk_bws      = ((vu_char *) (CONFIG_SYS_VCXK_BASE));
13*4882a593Smuzhiyun vu_short *vcxk_bws_word = ((vu_short *)(CONFIG_SYS_VCXK_BASE));
14*4882a593Smuzhiyun vu_long  *vcxk_bws_long = ((vu_long *) (CONFIG_SYS_VCXK_BASE));
15*4882a593Smuzhiyun 
16*4882a593Smuzhiyun #ifdef CONFIG_AT91RM9200
17*4882a593Smuzhiyun 	#include <asm/arch/hardware.h>
18*4882a593Smuzhiyun 	#include <asm/arch/at91_pio.h>
19*4882a593Smuzhiyun 
20*4882a593Smuzhiyun 	#ifndef VCBITMASK
21*4882a593Smuzhiyun 		#define VCBITMASK(bitno)	(0x0001 << (bitno % 16))
22*4882a593Smuzhiyun 	#endif
23*4882a593Smuzhiyun at91_pio_t *pio = (at91_pio_t *) AT91_PIO_BASE;
24*4882a593Smuzhiyun #define VCXK_INIT_PIN(PORT, PIN, DDR, I0O1) \
25*4882a593Smuzhiyun 	do { \
26*4882a593Smuzhiyun 		writel(PIN, &pio->PORT.per); \
27*4882a593Smuzhiyun 		writel(PIN, &pio->PORT.DDR); \
28*4882a593Smuzhiyun 		writel(PIN, &pio->PORT.mddr); \
29*4882a593Smuzhiyun 		if (!I0O1) \
30*4882a593Smuzhiyun 			writel(PIN, &pio->PORT.puer); \
31*4882a593Smuzhiyun 	} while (0);
32*4882a593Smuzhiyun 
33*4882a593Smuzhiyun #define VCXK_SET_PIN(PORT, PIN)	writel(PIN, &pio->PORT.sodr);
34*4882a593Smuzhiyun #define VCXK_CLR_PIN(PORT, PIN)	writel(PIN, &pio->PORT.codr);
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun #define VCXK_ACKNOWLEDGE	\
37*4882a593Smuzhiyun 	(!(readl(&pio->CONFIG_SYS_VCXK_ACKNOWLEDGE_PORT.pdsr) & \
38*4882a593Smuzhiyun 			CONFIG_SYS_VCXK_ACKNOWLEDGE_PIN))
39*4882a593Smuzhiyun #elif defined(CONFIG_MCF52x2)
40*4882a593Smuzhiyun 	#include <asm/m5282.h>
41*4882a593Smuzhiyun 	#ifndef VCBITMASK
42*4882a593Smuzhiyun 		#define VCBITMASK(bitno) (0x8000 >> (bitno % 16))
43*4882a593Smuzhiyun 	#endif
44*4882a593Smuzhiyun 
45*4882a593Smuzhiyun 	#define VCXK_INIT_PIN(PORT, PIN, DDR, I0O1) \
46*4882a593Smuzhiyun 		if (I0O1) DDR |= PIN; else DDR &= ~PIN;
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun 	#define VCXK_SET_PIN(PORT, PIN)	PORT |= PIN;
49*4882a593Smuzhiyun 	#define VCXK_CLR_PIN(PORT, PIN)	PORT &= ~PIN;
50*4882a593Smuzhiyun 
51*4882a593Smuzhiyun 	#define VCXK_ACKNOWLEDGE \
52*4882a593Smuzhiyun 		(!(CONFIG_SYS_VCXK_ACKNOWLEDGE_PORT &	\
53*4882a593Smuzhiyun 			CONFIG_SYS_VCXK_ACKNOWLEDGE_PIN))
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun #else
56*4882a593Smuzhiyun 	#error no vcxk support for selected ARCH
57*4882a593Smuzhiyun #endif
58*4882a593Smuzhiyun 
59*4882a593Smuzhiyun #define VCXK_DISABLE\
60*4882a593Smuzhiyun 	VCXK_SET_PIN(CONFIG_SYS_VCXK_ENABLE_PORT, CONFIG_SYS_VCXK_ENABLE_PIN)
61*4882a593Smuzhiyun #define VCXK_ENABLE\
62*4882a593Smuzhiyun 	VCXK_CLR_PIN(CONFIG_SYS_VCXK_ENABLE_PORT, CONFIG_SYS_VCXK_ENABLE_PIN)
63*4882a593Smuzhiyun 
64*4882a593Smuzhiyun #ifndef CONFIG_SYS_VCXK_DOUBLEBUFFERED
65*4882a593Smuzhiyun 	#define VCXK_BWS(x, data)		vcxk_bws[x] = data;
66*4882a593Smuzhiyun 	#define VCXK_BWS_WORD_SET(x, mask) 	vcxk_bws_word[x] |= mask;
67*4882a593Smuzhiyun 	#define VCXK_BWS_WORD_CLEAR(x, mask) 	vcxk_bws_word[x] &= ~mask;
68*4882a593Smuzhiyun 	#define VCXK_BWS_LONG(x, data)		vcxk_bws_long[x] = data;
69*4882a593Smuzhiyun #else
70*4882a593Smuzhiyun 	u_char double_bws[16384];
71*4882a593Smuzhiyun 	u_short *double_bws_word;
72*4882a593Smuzhiyun 	u_long  *double_bws_long;
73*4882a593Smuzhiyun 	#define VCXK_BWS(x,data)	\
74*4882a593Smuzhiyun 		double_bws[x] = data; vcxk_bws[x] = data;
75*4882a593Smuzhiyun 	#define VCXK_BWS_WORD_SET(x,mask)	\
76*4882a593Smuzhiyun 		double_bws_word[x] |= mask;	\
77*4882a593Smuzhiyun 		vcxk_bws_word[x] = double_bws_word[x];
78*4882a593Smuzhiyun 	#define VCXK_BWS_WORD_CLEAR(x,mask)	\
79*4882a593Smuzhiyun 		double_bws_word[x] &= ~mask;	\
80*4882a593Smuzhiyun 		vcxk_bws_word[x] = double_bws_word[x];
81*4882a593Smuzhiyun 	#define VCXK_BWS_LONG(x,data) \
82*4882a593Smuzhiyun 		double_bws_long[x] = data; vcxk_bws_long[x] = data;
83*4882a593Smuzhiyun #endif
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun #define VC4K16_Bright1	vcxk_bws_word[0x20004 / 2]
86*4882a593Smuzhiyun #define VC4K16_Bright2 	vcxk_bws_word[0x20006 / 2]
87*4882a593Smuzhiyun #define VC2K_Bright	vcxk_bws[0x8000]
88*4882a593Smuzhiyun #define VC8K_BrightH	vcxk_bws[0xC000]
89*4882a593Smuzhiyun #define VC8K_BrightL	vcxk_bws[0xC001]
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun vu_char VC4K16;
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun u_long display_width;
94*4882a593Smuzhiyun u_long display_height;
95*4882a593Smuzhiyun u_long display_bwidth;
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun ulong search_vcxk_driver(void);
98*4882a593Smuzhiyun void vcxk_cls(void);
99*4882a593Smuzhiyun void vcxk_setbrightness(unsigned int side, short brightness);
100*4882a593Smuzhiyun int vcxk_request(void);
101*4882a593Smuzhiyun int vcxk_acknowledge_wait(void);
102*4882a593Smuzhiyun void vcxk_clear(void);
103*4882a593Smuzhiyun 
104*4882a593Smuzhiyun /*
105*4882a593Smuzhiyun  ****f* bus_vcxk/vcxk_init
106*4882a593Smuzhiyun  * FUNCTION
107*4882a593Smuzhiyun  * initialalize Video Controller
108*4882a593Smuzhiyun  * PARAMETERS
109*4882a593Smuzhiyun  * width	visible display width in pixel
110*4882a593Smuzhiyun  * height	visible display height  in pixel
111*4882a593Smuzhiyun  ***
112*4882a593Smuzhiyun  */
113*4882a593Smuzhiyun 
vcxk_init(unsigned long width,unsigned long height)114*4882a593Smuzhiyun int vcxk_init(unsigned long width, unsigned long height)
115*4882a593Smuzhiyun {
116*4882a593Smuzhiyun #ifdef CONFIG_SYS_VCXK_RESET_PORT
117*4882a593Smuzhiyun 	VCXK_INIT_PIN(CONFIG_SYS_VCXK_RESET_PORT,
118*4882a593Smuzhiyun 		CONFIG_SYS_VCXK_RESET_PIN, CONFIG_SYS_VCXK_RESET_DDR, 1)
119*4882a593Smuzhiyun 	VCXK_SET_PIN(CONFIG_SYS_VCXK_RESET_PORT, CONFIG_SYS_VCXK_RESET_PIN);
120*4882a593Smuzhiyun #endif
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun #ifdef CONFIG_SYS_VCXK_DOUBLEBUFFERED
123*4882a593Smuzhiyun 	double_bws_word  = (u_short *)double_bws;
124*4882a593Smuzhiyun 	double_bws_long  = (u_long *)double_bws;
125*4882a593Smuzhiyun 	debug("%px %px %px\n", double_bws, double_bws_word, double_bws_long);
126*4882a593Smuzhiyun #endif
127*4882a593Smuzhiyun 	display_width  = width;
128*4882a593Smuzhiyun 	display_height = height;
129*4882a593Smuzhiyun #if (CONFIG_SYS_VCXK_DEFAULT_LINEALIGN == 4)
130*4882a593Smuzhiyun 	display_bwidth = ((width + 31) / 8) & ~0x3;
131*4882a593Smuzhiyun #elif (CONFIG_SYS_VCXK_DEFAULT_LINEALIGN == 2)
132*4882a593Smuzhiyun 	display_bwidth = ((width + 15) / 8) & ~0x1;
133*4882a593Smuzhiyun #else
134*4882a593Smuzhiyun 	#error CONFIG_SYS_VCXK_DEFAULT_LINEALIGN is invalid
135*4882a593Smuzhiyun #endif
136*4882a593Smuzhiyun 	debug("linesize ((%ld + 15) / 8 & ~0x1) = %ld\n",
137*4882a593Smuzhiyun 		display_width, display_bwidth);
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun #ifdef CONFIG_SYS_VCXK_AUTODETECT
140*4882a593Smuzhiyun 	VC4K16 = 0;
141*4882a593Smuzhiyun 	vcxk_bws_long[1] = 0x0;
142*4882a593Smuzhiyun 	vcxk_bws_long[1] = 0x55AAAA55;
143*4882a593Smuzhiyun 	vcxk_bws_long[5] = 0x0;
144*4882a593Smuzhiyun 	if (vcxk_bws_long[1] == 0x55AAAA55)
145*4882a593Smuzhiyun 		VC4K16 = 1;
146*4882a593Smuzhiyun #else
147*4882a593Smuzhiyun 	VC4K16 = 1;
148*4882a593Smuzhiyun 	debug("No autodetect: use vc4k\n");
149*4882a593Smuzhiyun #endif
150*4882a593Smuzhiyun 
151*4882a593Smuzhiyun 	VCXK_INIT_PIN(CONFIG_SYS_VCXK_INVERT_PORT,
152*4882a593Smuzhiyun 		CONFIG_SYS_VCXK_INVERT_PIN, CONFIG_SYS_VCXK_INVERT_DDR, 1)
153*4882a593Smuzhiyun 	VCXK_SET_PIN(CONFIG_SYS_VCXK_INVERT_PORT, CONFIG_SYS_VCXK_INVERT_PIN)
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun 	VCXK_SET_PIN(CONFIG_SYS_VCXK_REQUEST_PORT, CONFIG_SYS_VCXK_REQUEST_PIN);
156*4882a593Smuzhiyun 	VCXK_INIT_PIN(CONFIG_SYS_VCXK_REQUEST_PORT,
157*4882a593Smuzhiyun 		CONFIG_SYS_VCXK_REQUEST_PIN, CONFIG_SYS_VCXK_REQUEST_DDR, 1)
158*4882a593Smuzhiyun 
159*4882a593Smuzhiyun 	VCXK_INIT_PIN(CONFIG_SYS_VCXK_ACKNOWLEDGE_PORT,
160*4882a593Smuzhiyun 		CONFIG_SYS_VCXK_ACKNOWLEDGE_PIN,
161*4882a593Smuzhiyun 		CONFIG_SYS_VCXK_ACKNOWLEDGE_DDR, 0)
162*4882a593Smuzhiyun 
163*4882a593Smuzhiyun 	VCXK_DISABLE;
164*4882a593Smuzhiyun 	VCXK_INIT_PIN(CONFIG_SYS_VCXK_ENABLE_PORT,
165*4882a593Smuzhiyun 		CONFIG_SYS_VCXK_ENABLE_PIN, CONFIG_SYS_VCXK_ENABLE_DDR, 1)
166*4882a593Smuzhiyun 
167*4882a593Smuzhiyun 	vcxk_cls();
168*4882a593Smuzhiyun 	vcxk_cls();	/* clear second/hidden page */
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun 	vcxk_setbrightness(3, 1000);
171*4882a593Smuzhiyun 	VCXK_ENABLE;
172*4882a593Smuzhiyun 	return 1;
173*4882a593Smuzhiyun }
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun /*
176*4882a593Smuzhiyun  ****f* bus_vcxk/vcxk_setpixel
177*4882a593Smuzhiyun  * FUNCTION
178*4882a593Smuzhiyun  * set the pixel[x,y] with the given color
179*4882a593Smuzhiyun  * PARAMETER
180*4882a593Smuzhiyun  * x		pixel colum
181*4882a593Smuzhiyun  * y		pixel row
182*4882a593Smuzhiyun  * color	<0x40 off/black
183*4882a593Smuzhiyun  *			>0x40 on
184*4882a593Smuzhiyun  ***
185*4882a593Smuzhiyun  */
186*4882a593Smuzhiyun 
vcxk_setpixel(int x,int y,unsigned long color)187*4882a593Smuzhiyun void vcxk_setpixel(int x, int y, unsigned long color)
188*4882a593Smuzhiyun {
189*4882a593Smuzhiyun 	vu_short dataptr;
190*4882a593Smuzhiyun 
191*4882a593Smuzhiyun 	if ((x < display_width) && (y < display_height)) {
192*4882a593Smuzhiyun 		dataptr = ((x / 16)) + (y * (display_bwidth >> 1));
193*4882a593Smuzhiyun 
194*4882a593Smuzhiyun 		color = ((color >> 16) & 0xFF) |
195*4882a593Smuzhiyun 			    ((color >> 8) & 0xFF) | (color & 0xFF);
196*4882a593Smuzhiyun 
197*4882a593Smuzhiyun 		if (color > 0x40) {
198*4882a593Smuzhiyun 			VCXK_BWS_WORD_SET(dataptr, VCBITMASK(x));
199*4882a593Smuzhiyun 		} else {
200*4882a593Smuzhiyun 			VCXK_BWS_WORD_CLEAR(dataptr, VCBITMASK(x));
201*4882a593Smuzhiyun 		}
202*4882a593Smuzhiyun 	}
203*4882a593Smuzhiyun }
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun /*
206*4882a593Smuzhiyun  ****f* bus_vcxk/vcxk_loadimage
207*4882a593Smuzhiyun  * FUNCTION
208*4882a593Smuzhiyun  * copies a binary image to display memory
209*4882a593Smuzhiyun  ***
210*4882a593Smuzhiyun  */
211*4882a593Smuzhiyun 
vcxk_loadimage(ulong source)212*4882a593Smuzhiyun void vcxk_loadimage(ulong source)
213*4882a593Smuzhiyun {
214*4882a593Smuzhiyun 	int cnt;
215*4882a593Smuzhiyun 	vcxk_acknowledge_wait();
216*4882a593Smuzhiyun 	if (VC4K16) {
217*4882a593Smuzhiyun 		for (cnt = 0; cnt < (16384 / 4); cnt++) {
218*4882a593Smuzhiyun 			VCXK_BWS_LONG(cnt, (*(ulong *) source));
219*4882a593Smuzhiyun 			source = source + 4;
220*4882a593Smuzhiyun 		}
221*4882a593Smuzhiyun 	} else {
222*4882a593Smuzhiyun 		for (cnt = 0; cnt < 16384; cnt++) {
223*4882a593Smuzhiyun 			VCXK_BWS_LONG(cnt*2, (*(vu_char *) source));
224*4882a593Smuzhiyun 			source++;
225*4882a593Smuzhiyun 		}
226*4882a593Smuzhiyun 	}
227*4882a593Smuzhiyun 	vcxk_request();
228*4882a593Smuzhiyun }
229*4882a593Smuzhiyun 
230*4882a593Smuzhiyun /*
231*4882a593Smuzhiyun  ****f* bus_vcxk/vcxk_cls
232*4882a593Smuzhiyun  * FUNCTION
233*4882a593Smuzhiyun  * clear the display
234*4882a593Smuzhiyun  ***
235*4882a593Smuzhiyun  */
236*4882a593Smuzhiyun 
vcxk_cls(void)237*4882a593Smuzhiyun void vcxk_cls(void)
238*4882a593Smuzhiyun {
239*4882a593Smuzhiyun 	vcxk_acknowledge_wait();
240*4882a593Smuzhiyun 	vcxk_clear();
241*4882a593Smuzhiyun 	vcxk_request();
242*4882a593Smuzhiyun }
243*4882a593Smuzhiyun 
244*4882a593Smuzhiyun /*
245*4882a593Smuzhiyun  ****f* bus_vcxk/vcxk_clear(void)
246*4882a593Smuzhiyun  * FUNCTION
247*4882a593Smuzhiyun  * clear the display memory
248*4882a593Smuzhiyun  ***
249*4882a593Smuzhiyun  */
250*4882a593Smuzhiyun 
vcxk_clear(void)251*4882a593Smuzhiyun void vcxk_clear(void)
252*4882a593Smuzhiyun {
253*4882a593Smuzhiyun 	int cnt;
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun 	for (cnt = 0; cnt < (16384 / 4); cnt++) {
256*4882a593Smuzhiyun 		VCXK_BWS_LONG(cnt, 0)
257*4882a593Smuzhiyun 	}
258*4882a593Smuzhiyun }
259*4882a593Smuzhiyun 
260*4882a593Smuzhiyun /*
261*4882a593Smuzhiyun  ****f* bus_vcxk/vcxk_setbrightness
262*4882a593Smuzhiyun  * FUNCTION
263*4882a593Smuzhiyun  * set the display brightness
264*4882a593Smuzhiyun  * PARAMETER
265*4882a593Smuzhiyun  * side	1	set front side brightness
266*4882a593Smuzhiyun  * 		2	set back  side brightness
267*4882a593Smuzhiyun  *		3	set brightness for both sides
268*4882a593Smuzhiyun  * brightness 0..1000
269*4882a593Smuzhiyun  ***
270*4882a593Smuzhiyun  */
271*4882a593Smuzhiyun 
vcxk_setbrightness(unsigned int side,short brightness)272*4882a593Smuzhiyun void vcxk_setbrightness(unsigned int side, short brightness)
273*4882a593Smuzhiyun {
274*4882a593Smuzhiyun 	if (VC4K16) {
275*4882a593Smuzhiyun 		if ((side == 0) || (side & 0x1))
276*4882a593Smuzhiyun 			VC4K16_Bright1 = brightness + 23;
277*4882a593Smuzhiyun 		if ((side == 0) || (side & 0x2))
278*4882a593Smuzhiyun 			VC4K16_Bright2 = brightness + 23;
279*4882a593Smuzhiyun 	} else 	{
280*4882a593Smuzhiyun 		VC2K_Bright = (brightness >> 4) + 2;
281*4882a593Smuzhiyun 		VC8K_BrightH = (brightness + 23) >> 8;
282*4882a593Smuzhiyun 		VC8K_BrightL = (brightness + 23) & 0xFF;
283*4882a593Smuzhiyun 	}
284*4882a593Smuzhiyun }
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun /*
287*4882a593Smuzhiyun  ****f* bus_vcxk/vcxk_request
288*4882a593Smuzhiyun  * FUNCTION
289*4882a593Smuzhiyun  * requests viewing of display memory
290*4882a593Smuzhiyun  ***
291*4882a593Smuzhiyun  */
292*4882a593Smuzhiyun 
vcxk_request(void)293*4882a593Smuzhiyun int vcxk_request(void)
294*4882a593Smuzhiyun {
295*4882a593Smuzhiyun 	VCXK_CLR_PIN(CONFIG_SYS_VCXK_REQUEST_PORT,
296*4882a593Smuzhiyun 		CONFIG_SYS_VCXK_REQUEST_PIN)
297*4882a593Smuzhiyun 	VCXK_SET_PIN(CONFIG_SYS_VCXK_REQUEST_PORT,
298*4882a593Smuzhiyun 		CONFIG_SYS_VCXK_REQUEST_PIN);
299*4882a593Smuzhiyun 	return 1;
300*4882a593Smuzhiyun }
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun /*
303*4882a593Smuzhiyun  ****f* bus_vcxk/vcxk_acknowledge_wait
304*4882a593Smuzhiyun  * FUNCTION
305*4882a593Smuzhiyun  * wait for acknowledge viewing requests
306*4882a593Smuzhiyun  ***
307*4882a593Smuzhiyun  */
308*4882a593Smuzhiyun 
vcxk_acknowledge_wait(void)309*4882a593Smuzhiyun int vcxk_acknowledge_wait(void)
310*4882a593Smuzhiyun {
311*4882a593Smuzhiyun 	while (VCXK_ACKNOWLEDGE)
312*4882a593Smuzhiyun 		;
313*4882a593Smuzhiyun 	return 1;
314*4882a593Smuzhiyun }
315*4882a593Smuzhiyun 
316*4882a593Smuzhiyun /*
317*4882a593Smuzhiyun  ****f* bus_vcxk/vcxk_draw_mono
318*4882a593Smuzhiyun  * FUNCTION
319*4882a593Smuzhiyun  * copies a monochrom bitmap (BMP-Format) from given memory
320*4882a593Smuzhiyun  * PARAMETER
321*4882a593Smuzhiyun  * dataptr	pointer to bitmap
322*4882a593Smuzhiyun  * x		output bitmap @ columne
323*4882a593Smuzhiyun  * y		output bitmap @ row
324*4882a593Smuzhiyun  ***
325*4882a593Smuzhiyun  */
326*4882a593Smuzhiyun 
vcxk_draw_mono(unsigned char * dataptr,unsigned long linewidth,unsigned long cp_width,unsigned long cp_height)327*4882a593Smuzhiyun void vcxk_draw_mono(unsigned char *dataptr, unsigned long linewidth,
328*4882a593Smuzhiyun 	unsigned long  cp_width, unsigned long cp_height)
329*4882a593Smuzhiyun {
330*4882a593Smuzhiyun 	unsigned char *lineptr;
331*4882a593Smuzhiyun 	unsigned long xcnt, ycnt;
332*4882a593Smuzhiyun 
333*4882a593Smuzhiyun 	for (ycnt = cp_height; ycnt > 0; ycnt--) {
334*4882a593Smuzhiyun 		lineptr	= dataptr;
335*4882a593Smuzhiyun 		for (xcnt = 0; xcnt < cp_width; xcnt++) {
336*4882a593Smuzhiyun 			if ((*lineptr << (xcnt % 8)) & 0x80)
337*4882a593Smuzhiyun 				vcxk_setpixel(xcnt, ycnt - 1, 0xFFFFFF);
338*4882a593Smuzhiyun 			else
339*4882a593Smuzhiyun 				vcxk_setpixel(xcnt, ycnt-1, 0);
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun 			if ((xcnt % 8) == 7)
342*4882a593Smuzhiyun 				lineptr++;
343*4882a593Smuzhiyun 		} /* endfor xcnt */
344*4882a593Smuzhiyun 		dataptr = dataptr + linewidth;
345*4882a593Smuzhiyun 	} /* endfor ycnt */
346*4882a593Smuzhiyun }
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun /*
349*4882a593Smuzhiyun  ****f* bus_vcxk/vcxk_display_bitmap
350*4882a593Smuzhiyun  * FUNCTION
351*4882a593Smuzhiyun  * copies a bitmap (BMP-Format) to the given position
352*4882a593Smuzhiyun  * PARAMETER
353*4882a593Smuzhiyun  * addr		pointer to bitmap
354*4882a593Smuzhiyun  * x		output bitmap @ columne
355*4882a593Smuzhiyun  * y		output bitmap @ row
356*4882a593Smuzhiyun  ***
357*4882a593Smuzhiyun  */
358*4882a593Smuzhiyun 
vcxk_display_bitmap(ulong addr,int x,int y)359*4882a593Smuzhiyun int vcxk_display_bitmap(ulong addr, int x, int y)
360*4882a593Smuzhiyun {
361*4882a593Smuzhiyun 	struct bmp_image *bmp;
362*4882a593Smuzhiyun 	unsigned long width;
363*4882a593Smuzhiyun 	unsigned long height;
364*4882a593Smuzhiyun 	unsigned long bpp;
365*4882a593Smuzhiyun 
366*4882a593Smuzhiyun 	unsigned long lw;
367*4882a593Smuzhiyun 
368*4882a593Smuzhiyun 	unsigned long c_width;
369*4882a593Smuzhiyun 	unsigned long c_height;
370*4882a593Smuzhiyun 	unsigned char *dataptr;
371*4882a593Smuzhiyun 
372*4882a593Smuzhiyun 	bmp = (struct bmp_image *)addr;
373*4882a593Smuzhiyun 	if ((bmp->header.signature[0] == 'B') &&
374*4882a593Smuzhiyun 	    (bmp->header.signature[1] == 'M')) {
375*4882a593Smuzhiyun 		width        = le32_to_cpu(bmp->header.width);
376*4882a593Smuzhiyun 		height       = le32_to_cpu(bmp->header.height);
377*4882a593Smuzhiyun 		bpp          = le16_to_cpu(bmp->header.bit_count);
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun 		dataptr = (unsigned char *) bmp +
380*4882a593Smuzhiyun 				le32_to_cpu(bmp->header.data_offset);
381*4882a593Smuzhiyun 
382*4882a593Smuzhiyun 		if (display_width < (width + x))
383*4882a593Smuzhiyun 			c_width = display_width - x;
384*4882a593Smuzhiyun 		else
385*4882a593Smuzhiyun 			c_width = width;
386*4882a593Smuzhiyun 		if (display_height < (height + y))
387*4882a593Smuzhiyun 			c_height = display_height - y;
388*4882a593Smuzhiyun 		else
389*4882a593Smuzhiyun 			c_height = height;
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun 		lw = (((width + 7) / 8) + 3) & ~0x3;
392*4882a593Smuzhiyun 
393*4882a593Smuzhiyun 		if (c_height < height)
394*4882a593Smuzhiyun 			dataptr = dataptr + lw * (height - c_height);
395*4882a593Smuzhiyun 		switch (bpp) {
396*4882a593Smuzhiyun 		case 1:
397*4882a593Smuzhiyun 			vcxk_draw_mono(dataptr, lw, c_width, c_height);
398*4882a593Smuzhiyun 			break;
399*4882a593Smuzhiyun 		default:
400*4882a593Smuzhiyun 			printf("Error: %ld bit per pixel "
401*4882a593Smuzhiyun 				"not supported by VCxK\n", bpp);
402*4882a593Smuzhiyun 			return 0;
403*4882a593Smuzhiyun 		}
404*4882a593Smuzhiyun 	} else	{
405*4882a593Smuzhiyun 		printf("Error: no valid bmp at %lx\n", (ulong) bmp);
406*4882a593Smuzhiyun 		return 0;
407*4882a593Smuzhiyun 	}
408*4882a593Smuzhiyun 	return 1;
409*4882a593Smuzhiyun }
410*4882a593Smuzhiyun 
411*4882a593Smuzhiyun /*
412*4882a593Smuzhiyun  ****f* bus_vcxk/video_display_bitmap
413*4882a593Smuzhiyun  ***
414*4882a593Smuzhiyun  */
415*4882a593Smuzhiyun 
video_display_bitmap(ulong addr,int x,int y)416*4882a593Smuzhiyun int video_display_bitmap(ulong addr, int x, int y)
417*4882a593Smuzhiyun {
418*4882a593Smuzhiyun 	vcxk_acknowledge_wait();
419*4882a593Smuzhiyun 	if (vcxk_display_bitmap(addr, x, y)) {
420*4882a593Smuzhiyun 		vcxk_request();
421*4882a593Smuzhiyun 		return 0;
422*4882a593Smuzhiyun 	}
423*4882a593Smuzhiyun 	return 1;
424*4882a593Smuzhiyun }
425*4882a593Smuzhiyun 
426*4882a593Smuzhiyun /* EOF */
427