Home | History | Annotate | Line # | Download | only in iomd
vidc20config.c revision 1.14
      1 /*	$NetBSD: vidc20config.c,v 1.14 2002/09/27 15:35:46 provos Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 2001 Reinoud Zandijk
      5  * Copyright (c) 1996 Mark Brinicombe
      6  * Copyright (c) 1996 Robert Black
      7  * Copyright (c) 1994-1995 Melvyn Tang-Richardson
      8  * Copyright (c) 1994-1995 RiscBSD kernel team
      9  * All rights reserved.
     10  *
     11  * Redistribution and use in source and binary forms, with or without
     12  * modification, are permitted provided that the following conditions
     13  * are met:
     14  * 1. Redistributions of source code must retain the above copyright
     15  *    notice, this list of conditions and the following disclaimer.
     16  * 2. Redistributions in binary form must reproduce the above copyright
     17  *    notice, this list of conditions and the following disclaimer in the
     18  *    documentation and/or other materials provided with the distribution.
     19  * 3. All advertising materials mentioning features or use of this software
     20  *    must display the following acknowledgement:
     21  *	This product includes software developed by the RiscBSD kernel team
     22  * 4. The name of the company nor the name of the author may be used to
     23  *    endorse or promote products derived from this software without specific
     24  *    prior written permission.
     25  *
     26  * THIS SOFTWARE IS PROVIDED BY THE RISCBSD TEAM ``AS IS'' AND ANY EXPRESS
     27  * OR IMPLIED  WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     28  * WARRANTIES OF  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     29  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE
     30  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
     36  * THE POSSIBILITY OF SUCH DAMAGE.
     37  *
     38  * NetBSD kernel project
     39  *
     40  * vidcvideo.c
     41  *
     42  * This file is the lower basis of the wscons driver for VIDC based ARM machines.
     43  * It features the initialisation and all VIDC writing and keeps in internal state
     44  * copy.
     45  * Its currenly set up as a library file and not as a device; it could be named
     46  * vidcvideo0 eventually.
     47  */
     48 
     49 #include <sys/cdefs.h>
     50 
     51 __KERNEL_RCSID(0, "$NetBSD: vidc20config.c,v 1.14 2002/09/27 15:35:46 provos Exp $");
     52 
     53 #include <sys/types.h>
     54 #include <sys/param.h>
     55 #include <arm/iomd/vidc.h>
     56 #include <arm/arm32/katelib.h>
     57 #include <machine/bootconfig.h>
     58 #include <machine/intr.h>
     59 
     60 #include <sys/systm.h>
     61 #include <sys/device.h>
     62 #include <uvm/uvm_extern.h>
     63 
     64 #include <arm/iomd/iomdreg.h>
     65 #include <arm/iomd/iomdvar.h>
     66 #include <arm/iomd/vidc20config.h>
     67 
     68 
     69 /*
     70  * A structure containing ALL the information required to restore
     71  * the VIDC20 to any given state.  ALL vidc transactions should
     72  * go through these procedures, which record the vidc's state.
     73  * it may be an idea to set the permissions of the vidc base address
     74  * so we get a fault, so the fault routine can record the state but
     75  * I guess that's not really necessary for the time being, since we
     76  * can make the kernel more secure later on.  Also, it is possible
     77  * to write a routine to allow 'reading' of the vidc registers.
     78  */
     79 
     80 static struct vidc_state vidc_lookup = {
     81 	{ 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0,
     82           0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0,
     83           0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0,
     84           0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0,
     85           0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0,
     86           0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0,
     87           0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0,
     88           0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0, 0,0,0,0,0,0,0,0
     89 	},
     90 
     91 	VIDC_PALREG,
     92 	VIDC_BCOL,
     93 	VIDC_CP1 ,
     94 	VIDC_CP2,
     95 	VIDC_CP3,
     96 	VIDC_HCR,
     97 	VIDC_HSWR,
     98 	VIDC_HBSR,
     99 	VIDC_HDSR,
    100 	VIDC_HDER,
    101 	VIDC_HBER,
    102 	VIDC_HCSR,
    103 	VIDC_HIR,
    104 	VIDC_VCR,
    105 	VIDC_VSWR,
    106 	VIDC_VBSR,
    107 	VIDC_VDSR,
    108 	VIDC_VDER,
    109 	VIDC_VBER,
    110 	VIDC_VCSR,
    111 	VIDC_VCER,
    112 	VIDC_EREG,
    113 	VIDC_FSYNREG,
    114 	VIDC_CONREG,
    115 	VIDC_DCTL
    116 };
    117 
    118 struct vidc_state vidc_current[1];
    119 
    120 
    121 /*
    122  * XXX global display variables XXX ... should be a structure
    123  */
    124 static int cold_init = 0;		/* flags initialisation */
    125 extern videomemory_t videomemory;
    126 
    127 static struct vidc_mode  vidc_initialmode;
    128 static struct vidc_mode *vidc_currentmode;
    129 
    130 unsigned int dispstart;
    131 unsigned int dispsize;
    132 unsigned int dispbase;
    133 unsigned int dispend;
    134 unsigned int ptov;
    135 unsigned int vmem_base;
    136 unsigned int phys_base;
    137 unsigned int transfersize;
    138 
    139 
    140 /* cursor stuff */
    141 char *cursor_normal;
    142 char *cursor_transparent;
    143 int   p_cursor_normal;
    144 int   p_cursor_transparent;
    145 int   cursor_width;
    146 int   cursor_height;
    147 
    148 
    149 /*
    150  * VIDC mode definitions
    151  * generated from RISC OS mode definition file by an `awk' script
    152  */
    153 extern struct vidc_mode vidcmodes[];
    154 
    155 
    156 /*
    157  * configuration printing
    158  *
    159  */
    160 
    161 void
    162 vidcvideo_printdetails(void)
    163 {
    164         printf(": refclk=%dMHz %dKB %s ", (vidc_fref / 1000000),
    165             videomemory.vidm_size / 1024,
    166             (videomemory.vidm_type == VIDEOMEM_TYPE_VRAM) ? "VRAM" : "DRAM");
    167 }
    168 
    169 
    170 /*
    171  * Common functions to directly access VIDC registers
    172  */
    173 int
    174 vidcvideo_write(reg, value)
    175 	u_int reg;
    176 	int value;
    177 {
    178 	int counter;
    179 
    180 	int *current;
    181 	int *tab;
    182 
    183 	tab 	= (int *)&vidc_lookup;
    184 	current = (int *)vidc_current;
    185 
    186 
    187 	/*
    188 	 * OK, the VIDC_PALETTE register is handled differently
    189 	 * to the others on the VIDC, so take that into account here
    190 	 */
    191 	if (reg==VIDC_PALREG) {
    192 		vidc_current->palreg = 0;
    193 		WriteWord(vidc_base, reg | value);
    194 		return 0;
    195 	}
    196 
    197 	if (reg==VIDC_PALETTE) {
    198 		WriteWord(vidc_base, reg | value);
    199 		vidc_current->palette[vidc_current->palreg] = value;
    200 		vidc_current->palreg++;
    201 		vidc_current->palreg = vidc_current->palreg & 0xff;
    202 		return 0;
    203 	}
    204 
    205 	/*
    206 	 * Undefine SAFER if you wish to speed things up (a little)
    207 	 * although this means the function will assume things abou
    208 	 * the structure of vidc_state. i.e. the first 256 words are
    209 	 * the palette array
    210 	 */
    211 
    212 #define SAFER
    213 
    214 #ifdef 	SAFER
    215 #define INITVALUE 0
    216 #else
    217 #define INITVALUE 256
    218 #endif
    219 
    220 	for ( counter=INITVALUE; counter<= sizeof(struct vidc_state); counter++ ) {
    221 		if ( reg==tab[counter] ) {
    222 			WriteWord ( vidc_base, reg | value );
    223 			current[counter] = value;
    224 			return 0;
    225 		}
    226 	}
    227 	return -1;
    228 }
    229 
    230 
    231 void
    232 vidcvideo_setpalette(vidc)
    233 	struct vidc_state *vidc;
    234 {
    235 	int counter = 0;
    236 
    237 	vidcvideo_write(VIDC_PALREG, 0x00000000);
    238 	for (counter = 0; counter < 255; counter++)
    239 		vidcvideo_write(VIDC_PALETTE, vidc->palette[counter]);
    240 }
    241 
    242 
    243 void
    244 vidcvideo_setstate(vidc)
    245 	struct vidc_state *vidc;
    246 {
    247 	vidcvideo_write ( VIDC_PALREG,		vidc->palreg 	);
    248 	vidcvideo_write ( VIDC_BCOL,		vidc->bcol	);
    249 	vidcvideo_write ( VIDC_CP1,		vidc->cp1	);
    250 	vidcvideo_write ( VIDC_CP2,		vidc->cp2	);
    251 	vidcvideo_write ( VIDC_CP3,		vidc->cp3	);
    252 	vidcvideo_write ( VIDC_HCR,		vidc->hcr	);
    253 	vidcvideo_write ( VIDC_HSWR,		vidc->hswr	);
    254 	vidcvideo_write ( VIDC_HBSR,		vidc->hbsr	);
    255 	vidcvideo_write ( VIDC_HDSR,		vidc->hdsr	);
    256 	vidcvideo_write ( VIDC_HDER,		vidc->hder	);
    257 	vidcvideo_write ( VIDC_HBER,		vidc->hber	);
    258 	vidcvideo_write ( VIDC_HCSR,		vidc->hcsr	);
    259 	vidcvideo_write ( VIDC_HIR,		vidc->hir	);
    260 	vidcvideo_write ( VIDC_VCR,		vidc->vcr	);
    261 	vidcvideo_write ( VIDC_VSWR,		vidc->vswr	);
    262 	vidcvideo_write ( VIDC_VBSR,		vidc->vbsr	);
    263 	vidcvideo_write ( VIDC_VDSR,		vidc->vdsr	);
    264 	vidcvideo_write ( VIDC_VDER,		vidc->vder	);
    265 	vidcvideo_write ( VIDC_VBER,		vidc->vber	);
    266 	vidcvideo_write ( VIDC_VCSR,		vidc->vcsr	);
    267 	vidcvideo_write ( VIDC_VCER,		vidc->vcer	);
    268 /*
    269  * Right, dunno what to set these to yet, but let's keep RiscOS's
    270  * ones for now, until the time is right to finish this code
    271  */
    272 
    273 /*	vidcvideo_write ( VIDC_EREG,		vidc->ereg	);	*/
    274 /*	vidcvideo_write ( VIDC_FSYNREG,	vidc->fsynreg	);	*/
    275 /*	vidcvideo_write ( VIDC_CONREG,	vidc->conreg	);	*/
    276 /*	vidcvideo_write ( VIDC_DCTL,		vidc->dctl	);	*/
    277 
    278 }
    279 
    280 
    281 void
    282 vidcvideo_getstate(vidc)
    283 	struct vidc_state *vidc;
    284 {
    285 	*vidc = *vidc_current;
    286 }
    287 
    288 
    289 void
    290 vidcvideo_getmode(mode)
    291 	struct vidc_mode *mode;
    292 {
    293 	*mode = *vidc_currentmode;
    294 }
    295 
    296 
    297 static int
    298 vidcvideo_coldinit(void)
    299 {
    300 	int found;
    301 	int loop;
    302 
    303 	/* Blank out the cursor */
    304 
    305 	vidcvideo_write(VIDC_CP1, 0x0);
    306 	vidcvideo_write(VIDC_CP2, 0x0);
    307 	vidcvideo_write(VIDC_CP3, 0x0);
    308 
    309 	/* Try to determine the current mode */
    310 	vidc_initialmode.hder     = bootconfig.width+1;
    311 	vidc_initialmode.vder     = bootconfig.height+1;
    312 	vidc_initialmode.log2_bpp = bootconfig.log2_bpp;
    313 
    314 	dispbase = vmem_base = dispstart = videomemory.vidm_vbase;
    315 	phys_base = videomemory.vidm_pbase;
    316 
    317 	/* Nut - should be using videomemory.vidm_size - mark */
    318 	if (videomemory.vidm_type == VIDEOMEM_TYPE_DRAM) {
    319 		dispsize = videomemory.vidm_size;
    320 		transfersize = 16;
    321 	} else {
    322 		dispsize = bootconfig.vram[0].pages * NBPG;
    323 		transfersize = dispsize >> 10;
    324 	};
    325 
    326 	ptov = dispbase - phys_base;
    327 
    328 	dispend = dispstart+dispsize;
    329 
    330 	/* try to find the current mode from the bootloader in my table */
    331 	vidc_currentmode = &vidcmodes[0];
    332 	loop = 0;
    333 	found = 0;
    334 	while (vidcmodes[loop].pixel_rate != 0) {
    335   		if (vidcmodes[loop].hder == (bootconfig.width + 1)
    336   		    && vidcmodes[loop].vder == (bootconfig.height + 1)
    337 		    && vidcmodes[loop].frame_rate == bootconfig.framerate) {
    338 			vidc_currentmode = &vidcmodes[loop];
    339 			found = 1;
    340 		}
    341 		++loop;
    342 	}
    343 
    344 	/* if not found choose first mode but dont be picky on the framerate */
    345 	if (!found) {
    346 		vidc_currentmode = &vidcmodes[0];
    347 		loop = 0;
    348 		found = 0;
    349 
    350 		while (vidcmodes[loop].pixel_rate != 0) {
    351 			if (vidcmodes[loop].hder == (bootconfig.width + 1)
    352  			    && vidcmodes[loop].vder == (bootconfig.height + 1)) {
    353  				vidc_currentmode = &vidcmodes[loop];
    354  				found = 1;
    355  			}
    356  			++loop;
    357  		}
    358 	}
    359 
    360 	vidc_currentmode->log2_bpp = bootconfig.log2_bpp;
    361 
    362 	dispstart = dispbase;
    363 	dispend = dispstart+dispsize;
    364 
    365 	IOMD_WRITE_WORD(IOMD_VIDINIT, dispstart-ptov);
    366 	IOMD_WRITE_WORD(IOMD_VIDSTART, dispstart-ptov);
    367 	IOMD_WRITE_WORD(IOMD_VIDEND, (dispend-transfersize)-ptov);
    368 	return 0;
    369 }
    370 
    371 
    372 /* simple function to abstract vidc variables ; returns virt start address of screen */
    373 /* XXX asumption that video memory is mapped in twice */
    374 void *vidcvideo_hwscroll(int bytes) {
    375 	dispstart += bytes;
    376 	if (dispstart >= dispbase + dispsize) dispstart -= dispsize;
    377 	if (dispstart <  dispbase)            dispstart += dispsize;
    378 	dispend = dispstart+dispsize;
    379 
    380 	/* return the start of the bit map of the screen (left top) */
    381 	return (void *) dispstart;
    382 }
    383 
    384 
    385 /* reset the HW scroll to be at the start for the benefit of f.e. X */
    386 void *vidcvideo_hwscroll_reset(void) {
    387 	void *cookie = (void *) dispstart;
    388 
    389 	dispstart = dispbase;
    390 	dispend = dispstart + dispsize;
    391 	return cookie;
    392 }
    393 
    394 
    395 /* put HW scroll back to where it was */
    396 void *vidcvideo_hwscroll_back(void *cookie) {
    397 	dispstart = (int) cookie;
    398 	dispend = dispstart + dispsize;
    399 	return cookie;
    400 }
    401 
    402 
    403 /* this function is to be called perferably at vsync */
    404 void vidcvideo_progr_scroll(void) {
    405 	IOMD_WRITE_WORD(IOMD_VIDINIT, dispstart-ptov);
    406 	IOMD_WRITE_WORD(IOMD_VIDSTART, dispstart-ptov);
    407 	IOMD_WRITE_WORD(IOMD_VIDEND, (dispend-transfersize)-ptov);
    408 }
    409 
    410 
    411 /*
    412  * Select a new mode by reprogramming the VIDC chip
    413  * XXX this part is known not to work for 32bpp
    414  */
    415 
    416 struct vidc_mode newmode;
    417 
    418 static const int bpp_mask_table[] = {
    419 	0,  /* 1bpp */
    420 	1,  /* 2bpp */
    421 	2,  /* 4bpp */
    422 	3,  /* 8bpp */
    423 	4,  /* 16bpp */
    424 	6   /* 32bpp */
    425 };
    426 
    427 
    428 void
    429 vidcvideo_setmode(struct vidc_mode *mode)
    430 {
    431 	register int acc;
    432 	int bpp_mask;
    433         int ereg;
    434 	int best_r, best_v;
    435 	int least_error;
    436 	int r, v, f;
    437 
    438 	/*
    439 	 * Find out what bit mask we need to or with the vidc20 control register
    440 	 * in order to generate the desired number of bits per pixel.
    441 	 * log_bpp is log base 2 of the number of bits per pixel.
    442 	 */
    443 
    444 	bpp_mask = bpp_mask_table[mode->log2_bpp];
    445 
    446 	newmode = *mode;
    447 	vidc_currentmode = &newmode;
    448 
    449 	least_error = INT_MAX;
    450 	best_r = 0; best_v = 0;
    451 
    452 	for (v = 63; v > 0; v--) {
    453 		for (r = 63; r > 0; r--) {
    454 			f = ((v * vidc_fref) /1000) / r;
    455 			if (least_error >=
    456 			    abs(f - vidc_currentmode->pixel_rate)) {
    457 				least_error =
    458 				    abs(f - vidc_currentmode->pixel_rate);
    459 				best_r = r;
    460 				best_v = v;
    461 			}
    462 		}
    463 	}
    464 
    465 	if (best_r > 63) best_r=63;
    466 	if (best_v > 63) best_v=63;
    467 	if (best_r < 1)  best_r= 1;
    468 	if (best_v < 1)  best_v= 1;
    469 
    470 	vidcvideo_write(VIDC_FSYNREG, (best_v-1)<<8 | (best_r-1)<<0);
    471 
    472 	acc=0;
    473 	acc+=vidc_currentmode->hswr;	vidcvideo_write(VIDC_HSWR, (acc - 8 ) & (~1));
    474 	acc+=vidc_currentmode->hbsr;	vidcvideo_write(VIDC_HBSR, (acc - 12) & (~1));
    475 	acc+=vidc_currentmode->hdsr;	vidcvideo_write(VIDC_HDSR, (acc - 18) & (~1));
    476 	acc+=vidc_currentmode->hder;	vidcvideo_write(VIDC_HDER, (acc - 18) & (~1));
    477 	acc+=vidc_currentmode->hber;	vidcvideo_write(VIDC_HBER, (acc - 12) & (~1));
    478 	acc+=vidc_currentmode->hcr;	vidcvideo_write(VIDC_HCR,  (acc - 8 ) & (~3));
    479 
    480 	acc=0;
    481 	acc+=vidc_currentmode->vswr;	vidcvideo_write(VIDC_VSWR, (acc - 1));
    482 	acc+=vidc_currentmode->vbsr;	vidcvideo_write(VIDC_VBSR, (acc - 1));
    483 	acc+=vidc_currentmode->vdsr;	vidcvideo_write(VIDC_VDSR, (acc - 1));
    484 	acc+=vidc_currentmode->vder;	vidcvideo_write(VIDC_VDER, (acc - 1));
    485 	acc+=vidc_currentmode->vber;	vidcvideo_write(VIDC_VBER, (acc - 1));
    486 	acc+=vidc_currentmode->vcr;	vidcvideo_write(VIDC_VCR,  (acc - 1));
    487 
    488 	IOMD_WRITE_WORD(IOMD_FSIZE, vidc_currentmode->vcr
    489 	    + vidc_currentmode->vswr
    490 	    + vidc_currentmode->vber
    491 	    + vidc_currentmode->vbsr - 1);
    492 
    493 	if (dispsize <= 1024*1024)
    494 		vidcvideo_write(VIDC_DCTL, vidc_currentmode->hder>>2 | 1<<16 | 1<<12);
    495 	else
    496 		vidcvideo_write(VIDC_DCTL, vidc_currentmode->hder>>2 | 3<<16 | 1<<12);
    497 
    498 	ereg = 1<<12;
    499 	if (vidc_currentmode->sync_pol & 0x01)
    500 		ereg |= 1<<16;
    501 	if (vidc_currentmode->sync_pol & 0x02)
    502 		ereg |= 1<<18;
    503 	vidcvideo_write(VIDC_EREG, ereg);
    504 	if (dispsize > 1024*1024) {
    505 		if (vidc_currentmode->hder >= 800)
    506  			vidcvideo_write(VIDC_CONREG, 7<<8 | bpp_mask<<5);
    507 		else
    508 			vidcvideo_write(VIDC_CONREG, 6<<8 | bpp_mask<<5);
    509 	} else {
    510 		vidcvideo_write(VIDC_CONREG, 7<<8 | bpp_mask<<5);
    511 	}
    512 }
    513 
    514 
    515 #if 0
    516 /* not used for now */
    517 void
    518 vidcvideo_set_display_base(base)
    519 	u_int base;
    520 {
    521 	dispstart = dispstart-dispbase + base;
    522 	dispbase = vmem_base = base;
    523 	dispend = base + dispsize;
    524 	ptov = dispbase - phys_base;
    525 }
    526 #endif
    527 
    528 
    529 /*
    530  * Main initialisation routine for now
    531  */
    532 
    533 static int cursor_init = 0;
    534 
    535 int
    536 vidcvideo_init(void)
    537 {
    538 	vidcvideo_coldinit();
    539 	if (cold_init && (cursor_init == 0))
    540 		/*	vidcvideo_flash_go() */;
    541 
    542 	/* setting a mode goes wrong in 32 bpp ... 8 and 16 seem OK */
    543 	vidcvideo_setmode(vidc_currentmode);
    544 	vidcvideo_blank(0);			/* display on */
    545 
    546 	vidcvideo_stdpalette();
    547 
    548 	if (cold_init == 0) {
    549 		vidcvideo_write(VIDC_CP1, 0x0);
    550 		vidcvideo_write(VIDC_CP2, 0x0);
    551 		vidcvideo_write(VIDC_CP3, 0x0);
    552 	} else {
    553 		vidcvideo_cursor_init(CURSOR_MAX_WIDTH, CURSOR_MAX_HEIGHT);
    554 	};
    555 
    556 	cold_init=1;
    557 	return 0;
    558 }
    559 
    560 
    561 /* reinitialise the vidcvideo */
    562 void
    563 vidcvideo_reinit()
    564 {
    565 	vidcvideo_coldinit();
    566 	vidcvideo_setmode(vidc_currentmode);
    567 }
    568 
    569 
    570 int
    571 vidcvideo_cursor_init(int width, int height)
    572 {
    573 	static char *cursor_data = NULL;
    574 	int counter;
    575 	int line;
    576 	paddr_t pa;
    577 
    578 	cursor_width  = width;
    579 	cursor_height = height;
    580 
    581 	if (!cursor_data) {
    582 		/* Allocate cursor memory first time round */
    583 		cursor_data = (char *)uvm_km_zalloc(kernel_map, NBPG);
    584 		if (!cursor_data)
    585 			panic("Cannot allocate memory for hardware cursor");
    586 		(void) pmap_extract(pmap_kernel(), (vaddr_t)cursor_data, &pa);
    587 		IOMD_WRITE_WORD(IOMD_CURSINIT, pa);
    588 	}
    589 
    590 	/* Blank the cursor while initialising it's sprite */
    591 
    592 	vidcvideo_write ( VIDC_CP1, 0x0 );
    593 	vidcvideo_write ( VIDC_CP2, 0x0 );
    594 	vidcvideo_write ( VIDC_CP3, 0x0 );
    595 
    596  	cursor_normal       = cursor_data;
    597 	cursor_transparent  = cursor_data + (height * width);
    598 
    599  	cursor_transparent += 32;					/* ALIGN */
    600 	cursor_transparent = (char *)((int)cursor_transparent & (~31) );
    601 
    602 	for ( line = 0; line<height; ++ line )
    603 	{
    604 	    for ( counter=0; counter<width/4;counter++ )
    605 		cursor_normal[line * width + counter]=0x55;		/* why 0x55 ? */
    606 	    for ( ; counter<8; counter++ )
    607 		cursor_normal[line * width + counter]=0;
    608 	}
    609 
    610 	for ( line = 0; line<height; ++ line )
    611 	{
    612 	    for ( counter=0; counter<width/4;counter++ )
    613 		cursor_transparent[line * width + counter]=0x00;
    614 	    for ( ; counter<8; counter++ )
    615 		cursor_transparent[line * width + counter]=0;
    616 	}
    617 
    618 
    619 	(void) pmap_extract(pmap_kernel(), (vaddr_t)cursor_normal,
    620 	    (paddr_t *)&p_cursor_normal);
    621 	(void) pmap_extract(pmap_kernel(), (vaddr_t)cursor_transparent,
    622 	    (paddr_t *)&p_cursor_transparent);
    623 
    624 	memset ( cursor_normal, 0x55, width*height );			/* white? */
    625 	memset ( cursor_transparent, 0x00, width*height );		/* to see the diffence */
    626 
    627 	/* Ok, now program the cursor; should be blank */
    628 	vidcvideo_enablecursor(0);
    629 
    630         return 0;
    631 }
    632 
    633 
    634 void
    635 vidcvideo_updatecursor(xcur, ycur)
    636 	int xcur, ycur;
    637 {
    638 	int frontporch = vidc_currentmode->hswr + vidc_currentmode->hbsr + vidc_currentmode->hdsr;
    639 	int topporch   = vidc_currentmode->vswr + vidc_currentmode->vbsr + vidc_currentmode->vdsr;
    640 
    641 	vidcvideo_write(VIDC_HCSR, frontporch -17 + xcur);
    642 	vidcvideo_write(VIDC_VCSR, topporch   -2  + (ycur+1)-2 + 3 - cursor_height);
    643 	vidcvideo_write(VIDC_VCER, topporch   -2  + (ycur+3)+2 + 3 );
    644 	return;
    645 }
    646 
    647 
    648 void
    649 vidcvideo_enablecursor(on)
    650 	int on;
    651 {
    652 	if (on) {
    653 		IOMD_WRITE_WORD(IOMD_CURSINIT,p_cursor_normal);
    654 	} else {
    655 		IOMD_WRITE_WORD(IOMD_CURSINIT,p_cursor_transparent);
    656 	};
    657 	vidcvideo_write ( VIDC_CP1, 0xffffff );		/* enable */
    658 
    659 	return;
    660 }
    661 
    662 
    663 void
    664 vidcvideo_stdpalette()
    665 {
    666 	int i;
    667 
    668 	switch (vidc_currentmode->log2_bpp) {
    669 	case 0: /* 1 bpp */
    670 	case 1: /* 2 bpp */
    671 	case 2: /* 4 bpp */
    672 	case 3: /* 8 bpp */
    673 		vidcvideo_write(VIDC_PALREG, 0x00000000);
    674 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(  0,   0,   0));
    675 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(255,   0,   0));
    676 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(  0, 255,   0));
    677 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(255, 255,   0));
    678 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(  0,   0, 255));
    679 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(255,   0, 255));
    680 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(  0, 255, 255));
    681 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(255, 255, 255));
    682 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(128, 128, 128));
    683 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(255, 128, 128));
    684 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(128, 255, 128));
    685 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(255, 255, 128));
    686 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(128, 128, 255));
    687 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(255, 128, 255));
    688 		vidcvideo_write(VIDC_PALETTE, VIDC_COL(255, 255, 255));
    689 		break;
    690 	case 4: /* 16 bpp */
    691 		/*
    692 		 * The use of the palette in 16-bit modes is quite
    693 		 * fun.  Comments in linux/drivers/video/acornfb.c
    694 		 * imply that it goes something like this:
    695 		 *
    696 		 * red   = LUT[pixel[7:0]].red
    697 		 * green = LUT[pixel[11:4]].green
    698 		 * blue  = LUT[pixel[15:8]].blue
    699 		 *
    700 		 * We use 6:5:5 R:G:B cos that's what Xarm32VIDC wants.
    701 		 */
    702 #define RBITS 6
    703 #define GBITS 5
    704 #define BBITS 5
    705 		vidcvideo_write(VIDC_PALREG, 0x00000000);
    706 		for (i = 0; i < 256; i++) {
    707 			int r, g, b;
    708 
    709 			r = i & ((1 << RBITS) - 1);
    710 			g = (i >> (RBITS - 4)) & ((1 << GBITS) - 1);
    711 			b = (i >> (RBITS + GBITS - 8)) & ((1 << BBITS) - 1);
    712 			vidcvideo_write(VIDC_PALETTE,
    713 			    VIDC_COL(r << (8 - RBITS) | r >> (2 * RBITS - 8),
    714 				g << (8 - GBITS) | g >> (2 * GBITS - 8),
    715 				b << (8 - BBITS) | b >> (2 * BBITS - 8)));
    716 		}
    717 		break;
    718 	case 5: /* 32 bpp */
    719 		vidcvideo_write(VIDC_PALREG, 0x00000000);
    720 		for (i = 0; i < 256; i++)
    721 			vidcvideo_write(VIDC_PALETTE, VIDC_COL(i, i, i));
    722 		break;
    723 	}
    724 
    725 }
    726 
    727 int
    728 vidcvideo_blank(video_off)
    729 	int video_off;
    730 {
    731         int ereg;
    732 
    733 	ereg = 1<<12;
    734 	if (vidc_currentmode->sync_pol & 0x01)
    735 		ereg |= 1<<16;
    736 	if (vidc_currentmode->sync_pol & 0x02)
    737 		ereg |= 1<<18;
    738 
    739 	if (!video_off) {
    740     		vidcvideo_write(VIDC_EREG, ereg);
    741 	} else {
    742 		vidcvideo_write(VIDC_EREG, 0);
    743 	};
    744 	return 0;
    745 }
    746 
    747 /* end of vidc20config.c */
    748