Home | History | Annotate | Line # | Download | only in vsa
lcg.c revision 1.3
      1 /*	$NetBSD: lcg.c,v 1.3 2018/02/08 09:05:18 dholland Exp $ */
      2 /*
      3  * LCG accelerated framebuffer driver
      4  * Copyright (c) 2003, 2004 Blaz Antonic
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  * 3. All advertising materials mentioning features or use of this software
     16  *    must display the abovementioned copyrights
     17  * 4. The name of the author may not be used to endorse or promote products
     18  *    derived from this software without specific prior written permission
     19  *
     20  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     21  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     22  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     23  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     24  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     25  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     26  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     27  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     28  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     29  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 /*
     32  * Resurrection and dumb framebuffer mode by Bjrn Johannesson
     33  * rherdware (at) yahoo.com in December 2014
     34  */
     35 
     36 #include <sys/cdefs.h>
     37 __KERNEL_RCSID(0, "$NetBSD: lcg.c,v 1.3 2018/02/08 09:05:18 dholland Exp $");
     38 
     39 #define LCG_NO_ACCEL
     40 
     41 #include <sys/param.h>
     42 #include <sys/device.h>
     43 #include <sys/systm.h>
     44 #include <sys/callout.h>
     45 #include <sys/time.h>
     46 #include <sys/malloc.h>
     47 #include <sys/conf.h>
     48 #include <sys/kernel.h>
     49 #include <sys/systm.h>
     50 
     51 #include <machine/vsbus.h>
     52 #include <machine/sid.h>
     53 #include <machine/cpu.h>
     54 #include <machine/lcgreg.h>
     55 
     56 #include <dev/cons.h>
     57 
     58 #include <dev/dec/dzreg.h>
     59 #include <dev/dec/dzvar.h>
     60 #include <dev/dec/dzkbdvar.h>
     61 
     62 #include <dev/wscons/wsdisplayvar.h>
     63 #include <dev/wscons/wsconsio.h>
     64 #include <dev/wscons/wscons_callbacks.h>
     65 #include <dev/wsfont/wsfont.h>
     66 
     67 #include "machine/scb.h"
     68 
     69 #include "dzkbd.h"
     70 
     71 /* Screen hardware defs */
     72 
     73 #define	LCG_FB_ADDR		0x21801000	/* Frame buffer */
     74 
     75 /* FIFO defines */
     76 #define LCG_FIFO_SIZE		0x10000	/* 64 KB */
     77 #define LCG_FIFO_WIN_ADDR	0x20180000
     78 #define LCG_FIFO_WIN_SIZE	VAX_NBPG
     79 #define LCG_FIFO_ALIGN		0x10000
     80 
     81 /* font rendering defines */
     82 #define LCG_FONT_ADDR		(LCG_FB_ADDR + lcg_fb_size)
     83 #define LCG_FONT_STORAGE_SIZE	0x40000	/* 16 KB, enough to accommodate 16x32 font bitmaps */
     84 
     85 /* register space defines */
     86 #define LCG_REG_ADDR	0x20100000	/* LCG registers */
     87 #define LCG_REG_SIZE	0x4000		/* 16384 bytes */
     88 #define LCG_REG(reg) regaddr[(reg / 4)]
     89 
     90 /* LUT defines */
     91 #define LCG_LUT_ADDR	0x21800800	/* LUT right before onscreen FB */
     92 #define LCG_LUT_OFFSET	0x00000800
     93 #define LCG_LUT_SIZE	0x800		/* 2048 bytes */
     94 
     95 #define	LCG_BG_COLOR	WSCOL_BLACK
     96 #define	LCG_FG_COLOR	WSCOL_WHITE
     97 
     98 #define	LCG_CONFIG	0x200f0010	/* LCG model information */
     99 
    100 /* implement sanity checks at certain points to ensure safer operation */
    101 #define LCG_SAFE
    102 //#define LCG_DEBUG
    103 
    104 static	int lcg_match(struct device *, struct cfdata *, void *);
    105 static	void lcg_attach(struct device *, struct device *, void *);
    106 
    107 struct	lcg_softc {
    108 	struct	device ss_dev;
    109 	bus_dmamap_t sc_dm;
    110 };
    111 
    112 CFATTACH_DECL_NEW(lcg, sizeof(struct lcg_softc),
    113     lcg_match, lcg_attach, NULL, NULL);
    114 
    115 static void	lcg_cursor(void *, int, int, int);
    116 static int	lcg_mapchar(void *, int, unsigned int *);
    117 static void	lcg_putchar(void *, int, int, u_int, long);
    118 static void	lcg_copycols(void *, int, int, int,int);
    119 static void	lcg_erasecols(void *, int, int, int, long);
    120 static void	lcg_copyrows(void *, int, int, int);
    121 static void	lcg_eraserows(void *, int, int, long);
    122 static int	lcg_allocattr(void *, int, int, int, long *);
    123 static int	lcg_get_cmap(struct wsdisplay_cmap *);
    124 static int	lcg_set_cmap(struct wsdisplay_cmap *);
    125 static void	lcg_init_common(struct device *, struct vsbus_attach_args *);
    126 
    127 const struct wsdisplay_emulops lcg_emulops = {
    128 	lcg_cursor,
    129 	lcg_mapchar,
    130 	lcg_putchar,
    131 	lcg_copycols,
    132 	lcg_erasecols,
    133 	lcg_copyrows,
    134 	lcg_eraserows,
    135 	lcg_allocattr
    136 };
    137 
    138 static char lcg_stdscreen_name[10] = "160x68";
    139 struct wsscreen_descr lcg_stdscreen = {
    140 	lcg_stdscreen_name, 160, 68,		/* dynamically set */
    141 	&lcg_emulops,
    142 	8, 15,					/* dynamically set */
    143 	WSSCREEN_UNDERLINE|WSSCREEN_REVERSE|WSSCREEN_WSCOLORS,
    144 };
    145 
    146 const struct wsscreen_descr *_lcg_scrlist[] = {
    147 	&lcg_stdscreen,
    148 };
    149 
    150 const struct wsscreen_list lcg_screenlist = {
    151 	sizeof(_lcg_scrlist) / sizeof(struct wsscreen_descr *),
    152 	_lcg_scrlist,
    153 };
    154 
    155 static	char *lcgaddr;
    156 static	char *lutaddr;
    157 static	volatile long *regaddr;
    158 static	volatile long *fifoaddr;
    159 #ifndef LCG_NO_ACCEL
    160 static	char *fontaddr;
    161 #endif
    162 
    163 static int	lcg_xsize;
    164 static int	lcg_ysize;
    165 static int	lcg_depth;
    166 static int	lcg_cols;
    167 static int	lcg_rows;
    168 static int	lcg_onerow;
    169 static int	lcg_fb_size;
    170 static int	lcg_glyph_size; /* bitmap size in bits */
    171 
    172 static	char *cursor;
    173 
    174 static	int cur_on;
    175 
    176 static	int cur_fg, cur_bg;
    177 
    178 
    179 /* Our current hardware colormap */
    180 static struct hwcmap256 {
    181 #define	CMAP_SIZE	256	/* 256 R/G/B entries */
    182 	u_int8_t r[CMAP_SIZE];
    183 	u_int8_t g[CMAP_SIZE];
    184 	u_int8_t b[CMAP_SIZE];
    185 } lcg_cmap;
    186 
    187 /* The default colormap */
    188 static struct {
    189 	u_int8_t r[8];
    190 	u_int8_t g[8];
    191 	u_int8_t b[8];
    192 } lcg_default_cmap = {
    193 	{ 0x00, 0xff, 0x00, 0xff, 0x00, 0xff, 0x00, 0xff },
    194 	{ 0x00, 0x00, 0xff, 0x7f, 0x00, 0x00, 0xff, 0xff },
    195 	{ 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff }
    196 };
    197 
    198 struct wsdisplay_font lcg_font;
    199 static u_char *qf;
    200 static u_short *qf2;
    201 
    202 #define QCHAR(c) (c < lcg_font.firstchar ? 0 : \
    203 	(c >= (lcg_font.firstchar + lcg_font.numchars) ? 0 : c - lcg_font.firstchar))
    204 #define QFONT(c,line)	((lcg_font.stride == 2 ? \
    205 	qf2[QCHAR(c) * lcg_font.fontheight + line] : \
    206 	qf[QCHAR(c) * lcg_font.fontheight + line]))
    207 #define	LCG_ADDR(row, col, line, dot) \
    208 	lcgaddr[((col) * lcg_font.fontwidth) + ((row) * lcg_font.fontheight * lcg_xsize) + \
    209 	    (line) * lcg_xsize + dot]
    210 
    211 
    212 static int	lcg_ioctl(void *, void *, u_long, void *, int, struct lwp *);
    213 static paddr_t	lcg_mmap(void *, void *, off_t, int);
    214 static int	lcg_alloc_screen(void *, const struct wsscreen_descr *,
    215 				      void **, int *, int *, long *);
    216 static void	lcg_free_screen(void *, void *);
    217 static int	lcg_show_screen(void *, void *, int,
    218 				     void (*) (void *, int, int), void *);
    219 static void	lcg_crsr_blink(void *);
    220 
    221 /* LCG HW accel functions */
    222 #ifndef LCG_NO_ACCEL
    223 static void	fifo_put(long data);
    224 static int	fifo_fill(int iterations);
    225 static u_char	fifo_counter = 0;
    226 
    227 static void	blkcpy(long source, long dest, int xdim, int ydim);
    228 static void	blkset(long dest, int xdim, int ydim, char color);
    229 static void	renderchar(long source, long dest, int xdim, int ydim, char fg, char bg);
    230 #endif /* LCG_NO_ACCEL */
    231 
    232 const struct wsdisplay_accessops lcg_accessops = {
    233 	lcg_ioctl,
    234 	lcg_mmap,
    235 	lcg_alloc_screen,
    236 	lcg_free_screen,
    237 	lcg_show_screen,
    238 	0 /* load_font */
    239 };
    240 
    241 /* TODO allocate ss_image dynamically for consoles beyond first one */
    242 struct	lcg_screen {
    243 	int	ss_curx;
    244 	int	ss_cury;
    245 	int	ss_cur_fg;
    246 	int	ss_cur_bg;
    247 	struct {
    248 		u_char	data;			/* Image character */
    249 		u_char	attr;			/* Attribute: 80/70/08/07 */
    250 	} ss_image[160 * 128];			/* allow for maximum possible cell matrix */
    251 };
    252 #define	LCG_ATTR_UNDERLINE	0x80
    253 #define	LCG_BG_MASK		0x70
    254 #define	LCG_ATTR_REVERSE	0x08
    255 #define	LCG_FG_MASK		0x07
    256 
    257 static	struct lcg_screen lcg_conscreen;
    258 static	struct lcg_screen *curscr;
    259 static	struct lcg_screen *savescr;
    260 
    261 static	callout_t lcg_cursor_ch;
    262 
    263 #ifndef LCG_NO_ACCEL
    264 void fifo_put(long data)
    265 {
    266 	fifo_counter &= 0x3;
    267 	fifoaddr[fifo_counter] = data;
    268 	fifo_counter++;
    269 }
    270 
    271 int fifo_fill(int iterations)
    272 {
    273 	long status;
    274 	int counter = 0;;
    275 
    276 	while (fifo_counter % 4)
    277 		fifo_put(0);
    278 
    279 #ifdef LCG_SAFE
    280 	status = LCG_REG(LCG_REG_GRAPHICS_SUB_STATUS);
    281 	while ((counter < iterations) && ((status & 0x80000000) == 0x80000000)) {
    282 		delay(1000);
    283 		status = LCG_REG(LCG_REG_GRAPHICS_SUB_STATUS);
    284 		counter++;
    285 	}
    286 #endif
    287 
    288 	if (counter == 0)
    289 		return 0;
    290 	else
    291 		return 1;
    292 }
    293 
    294 void blkcpy(long source, long dest, int xdim, int ydim)
    295 {
    296 	int err;
    297 
    298 #ifdef LCG_SAFE
    299 	if ((source < LCG_FB_ADDR) || (source > LCG_FB_ADDR + lcg_fb_size)) {
    300 		printf("lcg: blkcpy: invalid source 0x%lx\n", source);
    301 		return;
    302 	}
    303 	if ((dest < LCG_FB_ADDR) || (dest > LCG_FB_ADDR + lcg_fb_size)) {
    304 		printf("lcg: blkcpy: invalid destination 0x%lx\n", dest);
    305 		return;
    306 	}
    307 #endif
    308 
    309 #ifdef LCG_SAFE
    310 	fifo_put(0x0c010000 | (cur_fg & 0xff));
    311 #endif
    312 	fifo_put(0x01020006);
    313 
    314 	fifo_put(0x06800000);
    315 	fifo_put(source);
    316 	fifo_put(lcg_xsize);
    317 
    318 	fifo_put(0x05800000);
    319 	fifo_put(dest);
    320 	fifo_put(lcg_xsize);
    321 
    322 	fifo_put(0x03400000);
    323 	fifo_put(0xff);
    324 
    325 	fifo_put(0x02000003);
    326 
    327 #ifdef LCG_SAFE
    328 	fifo_put(0x04c00000);
    329 	fifo_put(0);
    330 	fifo_put(lcg_xsize);
    331 	fifo_put(lcg_fb_size - (dest - LCG_FB_ADDR));
    332 #endif
    333 
    334 	fifo_put(0x09c00000);
    335 	fifo_put(((ydim & 0xffff) << 16) | xdim);
    336 	fifo_put(0);
    337 	fifo_put(0);
    338 
    339 	err = fifo_fill(200);
    340 	if (err)
    341 		printf("lcg: AG still busy after 200 msec\n");
    342 }
    343 
    344 void blkset(long dest, int xdim, int ydim, char color)
    345 {
    346 	int err;
    347 
    348 #ifdef LCG_SAFE
    349 	if ((dest < LCG_FB_ADDR) || (dest > LCG_FB_ADDR + lcg_fb_size)) {
    350 		printf("lcg: blkset: invalid destination 0x%lx\n", dest);
    351 		return;
    352 	}
    353 #endif
    354 
    355 	fifo_put(0x0c010000 | (color & 0xff));
    356 
    357 	fifo_put(0x01000000);
    358 
    359 	fifo_put(0x05800000);
    360 	fifo_put(dest);
    361 	fifo_put(lcg_xsize);
    362 
    363 	fifo_put(0x03400000);
    364 	fifo_put(0xff);
    365 
    366 	fifo_put(0x02000003);
    367 
    368 #ifdef LCG_SAFE
    369 	fifo_put(0x04c00000);
    370 	fifo_put(0);
    371 	fifo_put(lcg_xsize);
    372 	fifo_put(lcg_fb_size - (dest - LCG_FB_ADDR));
    373 #endif
    374 
    375 	fifo_put(0x09c00000);
    376 	fifo_put(((ydim & 0xffff) << 16) | xdim);
    377 	fifo_put(0);
    378 	fifo_put(0);
    379 
    380 	err = fifo_fill(200);
    381 	if (err)
    382 		printf("lcg: AG still busy after 200 msec\n");
    383 }
    384 
    385 void renderchar(long source, long dest, int xdim, int ydim, char fg, char bg)
    386 {
    387 	int err;
    388 #ifdef LCG_SAFE
    389 	if ((dest < LCG_FB_ADDR) || (dest > LCG_FB_ADDR + lcg_fb_size)) {
    390 		printf("lcg: blkset: invalid destination 0x%lx\n", dest);
    391 		return;
    392 	}
    393 #endif
    394 
    395 	fifo_put(0x0c050000 | (bg & 0xff));
    396 	fifo_put(0x0c010000 | (fg & 0xff));
    397 
    398 	fifo_put(0x01030008);
    399 
    400 	fifo_put(0x06800000);
    401 	fifo_put(source);
    402 	//fifo_put(lcg_xsize);
    403 	fifo_put(lcg_font.stride);
    404 
    405 	fifo_put(0x05800000);
    406 	fifo_put(dest);
    407 	fifo_put(lcg_xsize);
    408 
    409 	fifo_put(0x03400000);
    410 	fifo_put(0xff);
    411 
    412 	fifo_put(0x02000003);
    413 
    414 #ifdef LCG_SAFE
    415 	fifo_put(0x04c00000);
    416 	fifo_put(0);
    417 	fifo_put(lcg_xsize);
    418 	fifo_put(lcg_fb_size - (dest - LCG_FB_ADDR));
    419 #endif
    420 
    421 	fifo_put(0x09c00000);
    422 	fifo_put(((ydim & 0xffff) << 16) | (xdim & 0xffff));
    423 	fifo_put(0);
    424 	fifo_put(0);
    425 
    426 	err = fifo_fill(200);
    427 	if (err)
    428 		printf("lcg: AG still busy after 200 msec\n");
    429 }
    430 #endif /* LCG_NO_ACCEL */
    431 
    432 int
    433 lcg_match(struct device *parent, struct cfdata *match, void *aux)
    434 {
    435 	struct vsbus_softc *sc = device_private(parent);
    436 	struct vsbus_attach_args *va = aux;
    437 	char *ch = (char *)va->va_addr;
    438 
    439 	if ((vax_boardtype != VAX_BTYP_46) && (vax_boardtype != VAX_BTYP_48))
    440 		return 0;
    441 
    442 	*ch = 1;
    443 	if ((*ch & 1) == 0)
    444 		return 0;
    445 	*ch = 0;
    446 	if ((*ch & 1) != 0)
    447 		return 0;
    448 
    449 	/* XXX use vertical interrupt? */
    450 	sc->sc_mask = 0x04; /* XXX - should be generated */
    451 	scb_fake(0x120, 0x15);
    452 	return 20;
    453 }
    454 
    455 void
    456 lcg_attach(struct device *parent, struct device *self, void *aux)
    457 {
    458 	struct vsbus_attach_args *va = aux;
    459 	struct wsemuldisplaydev_attach_args aa;
    460 
    461 	printf("\n");
    462 	aa.console = lcgaddr != NULL;
    463 
    464 	lcg_init_common(self, va);
    465 
    466 	curscr = &lcg_conscreen;
    467 
    468 	aa.scrdata = &lcg_screenlist;
    469 	aa.accessops = &lcg_accessops;
    470 
    471 	/* enable software cursor */
    472 	callout_init(&lcg_cursor_ch, 0);
    473 	callout_reset(&lcg_cursor_ch, hz / 2, lcg_crsr_blink, NULL);
    474 
    475 	config_found(self, &aa, wsemuldisplaydevprint);
    476 }
    477 
    478 static void
    479 lcg_crsr_blink(void *arg)
    480 {
    481 	int dot;
    482 
    483 	if (cur_on && curscr != NULL)
    484 		for (dot = 0; dot < lcg_font.fontwidth; dot++)
    485 			cursor[dot] = ((cursor[dot] & 0x0f) == cur_fg) ? cur_bg : cur_fg;
    486 
    487 	callout_reset(&lcg_cursor_ch, hz / 2, lcg_crsr_blink, NULL);
    488 }
    489 
    490 void
    491 lcg_cursor(void *id, int on, int row, int col)
    492 {
    493 	struct lcg_screen *ss = id;
    494 	int dot, attr;
    495 
    496 	attr = ss->ss_image[row * lcg_cols + col].attr;
    497 	if (ss == curscr) {
    498 		if (cursor != NULL) {
    499 			int ch = QFONT(ss->ss_image[ss->ss_cury * lcg_cols +
    500 			    ss->ss_curx].data, lcg_font.fontheight - 1);
    501 			attr = ss->ss_image[ss->ss_cury * lcg_cols +
    502 			    ss->ss_curx].attr;
    503 
    504 			if (attr & LCG_ATTR_REVERSE) {
    505 				cur_bg = attr & LCG_FG_MASK;
    506 				cur_fg = (attr & LCG_BG_MASK) >> 4;
    507 			} else {
    508 				cur_fg = attr & LCG_FG_MASK;
    509 				cur_bg = (attr & LCG_BG_MASK) >> 4;
    510 			}
    511 			for (dot = 0; dot < lcg_font.fontwidth; dot++)
    512 				cursor[dot] =  (ch & (1 << dot)) ?
    513 				    cur_fg : cur_bg;
    514 		}
    515 
    516 		cursor = &LCG_ADDR(row, col, lcg_font.fontheight - 1, 0);
    517 		cur_on = on;
    518 		if (attr & LCG_ATTR_REVERSE) {
    519 			cur_bg = attr & LCG_FG_MASK;
    520 			cur_fg = (attr & LCG_BG_MASK) >> 4;
    521 		} else {
    522 			cur_fg = attr & LCG_FG_MASK;
    523 			cur_bg = (attr & LCG_BG_MASK) >> 4;
    524 		}
    525 	}
    526 	ss->ss_curx = col;
    527 	ss->ss_cury = row;
    528 	if (attr & LCG_ATTR_REVERSE) {
    529 		ss->ss_cur_bg = attr & LCG_FG_MASK;
    530 		ss->ss_cur_fg = (attr & LCG_BG_MASK) >> 4;
    531 	} else {
    532 		ss->ss_cur_fg = attr & LCG_FG_MASK;
    533 		ss->ss_cur_bg = (attr & LCG_BG_MASK) >> 4;
    534 	}
    535 }
    536 
    537 int
    538 lcg_mapchar(void *id, int uni, unsigned int *index)
    539 {
    540 	if (uni < 256) {
    541 		*index = uni;
    542 		return (5);
    543 	}
    544 	*index = ' ';
    545 	return (0);
    546 }
    547 
    548 static void
    549 lcg_putchar(void *id, int row, int col, u_int c, long attr)
    550 {
    551 	struct lcg_screen *ss = id;
    552 	int i;
    553 	char dot_fg, dot_bg;
    554 
    555 	c &= 0xff;
    556 
    557 	ss->ss_image[row * lcg_cols + col].data = c;
    558 	ss->ss_image[row * lcg_cols + col].attr = attr;
    559 	if (ss != curscr)
    560 		return;
    561 
    562 	dot_fg = attr & LCG_FG_MASK;
    563 	dot_bg = (attr & LCG_BG_MASK) >> 4;
    564 	if (attr & LCG_ATTR_REVERSE) {
    565 		dot_fg = (attr & LCG_BG_MASK) >> 4;
    566 		dot_bg = attr & LCG_FG_MASK;
    567 	}
    568 
    569 #ifndef LCG_NO_ACCEL
    570 	renderchar(LCG_FONT_ADDR + (c * lcg_glyph_size),
    571 		   LCG_FB_ADDR + (row * lcg_onerow) + (col * lcg_font.fontwidth),
    572 		   lcg_font.fontwidth, lcg_font.fontheight, dot_fg, dot_bg);
    573 #else
    574 	for (i = 0; i < lcg_font.fontheight; i++) {
    575 		unsigned char ch = QFONT(c,i);
    576 		for (int j = 0; j < lcg_font.fontwidth; j++) {
    577 			LCG_ADDR(row, col, i, j) = ((ch >> j) & 1) ? dot_fg : dot_bg;
    578 		}
    579 	}
    580 #endif /* LCG_NO_ACCEL */
    581 	if (attr & LCG_ATTR_UNDERLINE) {
    582 		char *p = &LCG_ADDR(row, col, lcg_font.fontheight - 1, 0);
    583 		for (i = 0; i < lcg_font.fontwidth; i++)
    584 			p[i] = ~p[i];
    585 	}
    586 }
    587 
    588 
    589 
    590 /*
    591  * copies columns inside a row.
    592  */
    593 static void
    594 lcg_copycols(void *id, int row, int srccol, int dstcol, int ncols)
    595 {
    596 	struct lcg_screen *ss = id;
    597 #ifdef LCG_NO_ACCEL
    598 	int i = 0;
    599 #endif
    600 
    601 	bcopy(&ss->ss_image[row * lcg_cols + srccol], &ss->ss_image[row *
    602 	    lcg_cols + dstcol], ncols * sizeof(ss->ss_image[0]));
    603 	if (ss != curscr)
    604 		return;
    605 #ifdef LCG_NO_ACCEL
    606 	for (i = 0; i < lcg_font.fontheight; i++)
    607 		memcpy(&LCG_ADDR(row, dstcol, i, 0),
    608 		&LCG_ADDR(row,srccol, i, 0), ncols * lcg_font.fontwidth);
    609 
    610 #else
    611 	blkcpy(LCG_FB_ADDR + (row * lcg_onerow) + (srccol * lcg_font.fontwidth),
    612 	       LCG_FB_ADDR + (row * lcg_onerow) + (dstcol * lcg_font.fontwidth),
    613 	       (ncols * lcg_font.fontwidth), lcg_font.fontheight);
    614 #endif
    615 }
    616 
    617 /*
    618  * Erases a bunch of chars inside one row.
    619  */
    620 static void
    621 lcg_erasecols(void *id, int row, int startcol, int ncols, long fillattr)
    622 {
    623 	struct lcg_screen *ss = id;
    624 	int i;
    625 
    626 	bzero(&ss->ss_image[row * lcg_cols + startcol], ncols * sizeof(ss->ss_image[0]));
    627 	for (i = row * lcg_cols + startcol; i < row * lcg_cols + startcol + ncols; ++i)
    628 		ss->ss_image[i].attr = fillattr;
    629 	if (ss != curscr)
    630 		return;
    631 #ifdef LCG_NO_ACCEL
    632 	for (i = 0; i < lcg_font.fontheight; i++)
    633                 memset(&LCG_ADDR(row, startcol, i, 0), 0, ncols * lcg_font.fontwidth);
    634 #else
    635 	blkset(LCG_FB_ADDR + (row * lcg_onerow) + (startcol * lcg_font.fontwidth),
    636 		(ncols * lcg_font.fontwidth), lcg_font.fontheight, (fillattr & LCG_BG_MASK) >> 4);
    637 #endif
    638 }
    639 
    640 static void
    641 lcg_copyrows(void *id, int srcrow, int dstrow, int nrows)
    642 {
    643 	struct lcg_screen *ss = id;
    644 
    645 	bcopy(&ss->ss_image[srcrow * lcg_cols], &ss->ss_image[dstrow * lcg_cols],
    646 	    nrows * lcg_cols * sizeof(ss->ss_image[0]));
    647 	if (ss != curscr)
    648 		return;
    649 #ifdef LCG_NO_ACCEL
    650 	memcpy(&lcgaddr[dstrow * lcg_onerow],
    651             &lcgaddr[srcrow * lcg_onerow], nrows * lcg_onerow);
    652 #else
    653 	blkcpy(LCG_FB_ADDR + (srcrow * lcg_onerow), LCG_FB_ADDR + (dstrow * lcg_onerow),
    654 		(lcg_cols * lcg_font.fontwidth), (nrows * lcg_font.fontheight));
    655 #endif
    656 }
    657 
    658 static void
    659 lcg_eraserows(void *id, int startrow, int nrows, long fillattr)
    660 {
    661 	struct lcg_screen *ss = id;
    662 	int i;
    663 
    664 	bzero(&ss->ss_image[startrow * lcg_cols], nrows * lcg_cols *
    665 	    sizeof(ss->ss_image[0]));
    666 	for (i = startrow * lcg_cols; i < (startrow + nrows) * lcg_cols; ++i)
    667 		ss->ss_image[i].attr = fillattr;
    668 	if (ss != curscr)
    669 		return;
    670 #ifdef LCG_NO_ACCEL
    671 	memset(&lcgaddr[startrow * lcg_onerow], 0, nrows * lcg_onerow);
    672 #else
    673 	blkset(LCG_FB_ADDR + (startrow * lcg_onerow), (lcg_cols * lcg_font.fontwidth),
    674 		(nrows * lcg_font.fontheight), (fillattr & LCG_BG_MASK) >> 4);
    675 #endif
    676 }
    677 
    678 static int
    679 lcg_allocattr(void *id, int fg, int bg, int flags, long *attrp)
    680 {
    681 	long myattr;
    682 
    683 	if (flags & WSATTR_WSCOLORS)
    684 		myattr = (fg & LCG_FG_MASK) | ((bg << 4) & LCG_BG_MASK);
    685 	else
    686 		myattr = WSCOL_WHITE << 4;	/* XXXX */
    687 	if (flags & WSATTR_REVERSE)
    688 		myattr |= LCG_ATTR_REVERSE;
    689 	if (flags & WSATTR_UNDERLINE)
    690 		myattr |= LCG_ATTR_UNDERLINE;
    691 	*attrp = myattr;
    692 	return 0;
    693 }
    694 
    695 static int
    696 lcg_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
    697 {
    698 	struct wsdisplay_fbinfo *fb = (void *)data;
    699 	int i;
    700 
    701 	switch (cmd) {
    702 	case WSDISPLAYIO_GTYPE:
    703 		*(u_int *)data = WSDISPLAY_TYPE_LCG;
    704 		break;
    705 
    706 	case WSDISPLAYIO_GINFO:
    707 		fb->height = lcg_ysize;
    708 		fb->width = lcg_xsize;
    709 		fb->depth = lcg_depth;
    710 		fb->cmsize = 1 << lcg_depth;
    711 		break;
    712 
    713 	case WSDISPLAYIO_LINEBYTES:
    714 		*(u_int *)data = lcg_xsize;
    715 		break;
    716 
    717 	case WSDISPLAYIO_GETCMAP:
    718 		return lcg_get_cmap((struct wsdisplay_cmap *)data);
    719 
    720 	case WSDISPLAYIO_PUTCMAP:
    721 		return lcg_set_cmap((struct wsdisplay_cmap *)data);
    722 
    723 	case WSDISPLAYIO_GMODE:
    724 		return EPASSTHROUGH;
    725 
    726 	case WSDISPLAYIO_SMODE:
    727 		/* if setting WSDISPLAYIO_MODE_EMUL, restore console cmap, current screen */
    728 		if (*(u_int *)data == WSDISPLAYIO_MODE_EMUL) {
    729 			/* FIXME: if this is meant to reset palette LUT reload has to be triggered too */
    730 			bzero(lutaddr, LCG_LUT_SIZE);
    731 			for (i = 0; i < 8; ++i) {
    732 				lcg_cmap.r[i] = lcg_default_cmap.r[i];
    733 				lcg_cmap.g[i] = lcg_default_cmap.g[i];
    734 				lcg_cmap.b[i] = lcg_default_cmap.b[i];
    735 				lutaddr[i * 8 + 1] = i;
    736 				lutaddr[i * 8 + 2] = 1;
    737 				lutaddr[i * 8 + 3] = lcg_cmap.r[i] >> (lcg_depth & 7);
    738 				lutaddr[i * 8 + 4] = 1;
    739 				lutaddr[i * 8 + 5] = lcg_cmap.g[i] >> (lcg_depth & 7);
    740 				lutaddr[i * 8 + 6] = 1;
    741 				lutaddr[i * 8 + 7] = lcg_cmap.b[i] >> (lcg_depth & 7);
    742 			}
    743 			if (savescr != NULL)
    744 				lcg_show_screen(NULL, savescr, 0, NULL, NULL);
    745 			savescr = NULL;
    746 		} else {		/* WSDISPLAYIO_MODE_MAPPED */
    747 			savescr = curscr;
    748 			curscr = NULL;
    749 			/* clear screen? */
    750 		}
    751 
    752 		return EPASSTHROUGH;
    753 #if 0
    754 	case WSDISPLAYIO_SVIDEO:
    755 		if (*(u_int *)data == WSDISPLAYIO_VIDEO_ON) {
    756 			curcmd = curc;
    757 		} else {
    758 			curc = curcmd;
    759 			curcmd &= ~(CUR_CMD_FOPA|CUR_CMD_ENPA);
    760 			curcmd |= CUR_CMD_FOPB;
    761 		}
    762 		WRITECUR(CUR_CMD, curcmd);
    763 		break;
    764 
    765 	case WSDISPLAYIO_GVIDEO:
    766 		*(u_int *)data = (curcmd & CUR_CMD_FOPB ?
    767 		    WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON);
    768 		break;
    769 
    770 #endif
    771 	default:
    772 		return EPASSTHROUGH;
    773 	}
    774 	return 0;
    775 }
    776 
    777 static paddr_t
    778 lcg_mmap(void *v, void *vs, off_t offset, int prot)
    779 {
    780 	if (offset >= lcg_fb_size || offset < 0)
    781 		return -1;
    782 	return (LCG_FB_ADDR + offset) >> PGSHIFT;
    783 }
    784 
    785 int
    786 lcg_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
    787     int *curxp, int *curyp, long *defattrp)
    788 {
    789 	int i;
    790 	struct lcg_screen *ss;
    791 
    792 	*cookiep = malloc(sizeof(struct lcg_screen), M_DEVBUF, M_WAITOK);
    793 	bzero(*cookiep, sizeof(struct lcg_screen));
    794 	*curxp = *curyp = 0;
    795 	*defattrp = (LCG_BG_COLOR << 4) | LCG_FG_COLOR;
    796 	ss = *cookiep;
    797 	for (i = 0; i < lcg_cols * lcg_rows; ++i)
    798 		ss->ss_image[i].attr = (LCG_BG_COLOR << 4) | LCG_FG_COLOR;
    799 	return 0;
    800 }
    801 
    802 void
    803 lcg_free_screen(void *v, void *cookie)
    804 {
    805 }
    806 
    807 int
    808 lcg_show_screen(void *v, void *cookie, int waitok,
    809     void (*cb)(void *, int, int), void *cbarg)
    810 {
    811 	struct lcg_screen *ss = cookie;
    812 	int row, col, dot_fg, dot_bg, j, attr;
    813 #ifdef LCG_NO_ACCEL
    814 	int iter, jter;
    815 	unsigned char ch;
    816 #endif
    817 
    818 	if (ss == curscr)
    819 		return (0);
    820 #ifdef LCG_NO_ACCEL
    821 	memset(lcgaddr, LCG_BG_COLOR, lcg_xsize * lcg_ysize);
    822 #endif
    823 
    824 	for (row = 0; row < lcg_rows; row++)
    825 		for (col = 0; col < lcg_cols; col++) {
    826 			attr = ss->ss_image[row * lcg_cols + col].attr;
    827 			if (attr & LCG_ATTR_REVERSE) {
    828 				dot_fg = (attr & LCG_BG_MASK) >> 4;
    829 				dot_bg = attr & LCG_FG_MASK;
    830 			} else {
    831 				dot_fg = attr & LCG_FG_MASK;
    832 				dot_bg = (attr & LCG_BG_MASK) >> 4;
    833 			}
    834 			u_char c = ss->ss_image[row * lcg_cols + col].data;
    835 
    836 			if (c < 32)
    837 				c = 32;
    838 #ifndef LCG_NO_ACCEL
    839 			renderchar(LCG_FONT_ADDR + (c * lcg_glyph_size),
    840 				   LCG_FB_ADDR + (row * lcg_onerow) + (col * lcg_font.fontwidth),
    841 				   lcg_font.fontwidth, lcg_font.fontheight, dot_fg, dot_bg);
    842 #else
    843 			for (iter = 0; iter < lcg_font.fontheight; iter++) {
    844 				ch = QFONT(c,iter);
    845 				for (jter = 0; jter < lcg_font.fontwidth; jter++) {
    846 					LCG_ADDR(row, col, iter, jter) = ((ch >> jter) & 1) ? dot_fg : dot_bg;
    847 				}
    848 			}
    849 #endif
    850 			if (attr & LCG_ATTR_UNDERLINE)
    851 				for (j = 0; j < lcg_font.fontwidth; j++)
    852 					LCG_ADDR(row, col,
    853 					    lcg_font.fontheight - 1, j) = dot_fg;
    854 		}
    855 
    856 	cursor = &lcgaddr[(ss->ss_cury * lcg_onerow) +
    857 		((lcg_font.fontheight - 1) * lcg_xsize) +
    858 			(ss->ss_curx * lcg_font.fontwidth)];
    859 	cur_fg = ss->ss_cur_fg;
    860 	cur_bg = ss->ss_cur_bg;
    861 
    862 	curscr = ss;
    863 	return (0);
    864 }
    865 
    866 static int
    867 lcg_get_cmap(struct wsdisplay_cmap *p)
    868 {
    869 	u_int index = p->index, count = p->count;
    870 	int error;
    871 
    872 	if (index >= (1 << lcg_depth) || count > (1 << lcg_depth) - index)
    873 		return (EINVAL);
    874 
    875 	error = copyout(&lcg_cmap.r[index], p->red, count);
    876 	if (error)
    877 		return error;
    878 	error = copyout(&lcg_cmap.g[index], p->green, count);
    879 	if (error)
    880 		return error;
    881 	error = copyout(&lcg_cmap.b[index], p->blue, count);
    882 	return error;
    883 }
    884 
    885 static int
    886 lcg_set_cmap(struct wsdisplay_cmap *p)
    887 {
    888 	u_int index = p->index, count = p->count;
    889 	int error, s;
    890 
    891 	if (index >= (1 << lcg_depth) || count > (1 << lcg_depth) - index)
    892 		return (EINVAL);
    893 
    894 	error = copyin(p->red, &lcg_cmap.r[index], count);
    895 	if (error)
    896 		return error;
    897 	error = copyin(p->green, &lcg_cmap.g[index], count);
    898 	if (error)
    899 		return error;
    900 	error = copyin(p->blue, &lcg_cmap.b[index], count);
    901 	if (error)
    902 		return error;
    903 
    904 	s = spltty();
    905 	/* FIXME: if this is meant to set palette LUT reload has to be triggered too */
    906 	while (count-- > 0) {
    907 		lutaddr[index * 8 + 0] = 0;
    908 		lutaddr[index * 8 + 1] = index;
    909 		lutaddr[index * 8 + 2] = 1;
    910 		lutaddr[index * 8 + 3] = lcg_cmap.r[index] >> (lcg_depth & 7);
    911 		lutaddr[index * 8 + 4] = 1;
    912 		lutaddr[index * 8 + 5] = lcg_cmap.g[index] >> (lcg_depth & 7);
    913 		lutaddr[index * 8 + 6] = 1;
    914 		lutaddr[index * 8 + 7] = lcg_cmap.b[index] >> (lcg_depth & 7);
    915 		++index;
    916 	}
    917 	splx(s);
    918 	return (0);
    919 }
    920 
    921 cons_decl(lcg);
    922 
    923 void
    924 lcgcninit(struct consdev *cndev)
    925 {
    926 	int i;
    927 	/* Clear screen */
    928 	memset(lcgaddr, LCG_BG_COLOR, lcg_xsize * lcg_ysize);
    929 
    930 	curscr = &lcg_conscreen;
    931 	for (i = 0; i < lcg_cols * lcg_rows; ++i)
    932 		lcg_conscreen.ss_image[i].attr =
    933 		    (LCG_BG_COLOR << 4) | LCG_FG_COLOR;
    934 	wsdisplay_cnattach(&lcg_stdscreen, &lcg_conscreen, 0, 0,
    935 	    (LCG_BG_COLOR << 4) | LCG_FG_COLOR);
    936 	cn_tab->cn_pri = CN_INTERNAL;
    937 
    938 
    939 #if NDZKBD > 0
    940 	dzkbd_cnattach(0); /* Connect keyboard and screen together */
    941 #endif
    942 }
    943 
    944 /*
    945  * Called very early to setup the glass tty as console.
    946  * Because it's called before the VM system is inited, virtual memory
    947  * for the framebuffer can be stolen directly without disturbing anything.
    948  */
    949 void
    950 lcgcnprobe(struct consdev *cndev)
    951 {
    952 	extern const struct cdevsw wsdisplay_cdevsw;
    953 
    954 	if ((vax_boardtype != VAX_BTYP_46) && (vax_boardtype != VAX_BTYP_48))
    955 		return; /* Only for VS 4000/60 and VLC */
    956 
    957 	if (vax_confdata & 0x100)
    958 		return; /* Diagnostic console */
    959 
    960 	lcg_init_common(NULL, NULL);
    961 
    962 	/* Set up default LUT */
    963 
    964 	cndev->cn_pri = CN_INTERNAL;
    965 	cndev->cn_dev = makedev(cdevsw_lookup_major(&wsdisplay_cdevsw), 0);
    966 }
    967 
    968 void
    969 lcg_init_common(struct device *self, struct vsbus_attach_args *va)
    970 {
    971 	u_int magic, *lcg_config;
    972 	int i;
    973 	extern vaddr_t virtual_avail;
    974 	long video_conf;
    975 	int cookie;
    976 	struct wsdisplay_font *wf;
    977 
    978 	struct lcg_softc *sc = (void *)self;
    979 	bus_dma_segment_t seg;
    980 	int rseg, err;
    981 	void *fifo_mem_vaddr;
    982 #ifndef LCG_NO_ACCEL
    983 	u_char line;
    984 	u_int ch, temp;
    985 #endif
    986 
    987 	if (regaddr != NULL)
    988 		return;
    989 
    990 	/* map LCG registers first */
    991 	if (self != NULL) {
    992 		regaddr = (long*)vax_map_physmem(LCG_REG_ADDR, (LCG_REG_SIZE/VAX_NBPG));
    993 		if (regaddr == 0) {
    994 			printf("%s: Couldn't allocate register memory.\n", self->dv_xname);
    995 			return;
    996 		}
    997 	} else {
    998 		regaddr = (long*)virtual_avail;
    999 		virtual_avail += LCG_REG_SIZE;
   1000 		ioaccess((vaddr_t)regaddr, LCG_REG_ADDR, (LCG_REG_SIZE/VAX_NBPG));
   1001 	}
   1002 
   1003 	/*
   1004 	 * v = *0x200f0010 & VLC ? 0x07 : 0xf0;
   1005 	 * switch(v) {
   1006 	 * 0x05: 1280x1024
   1007 	 * 0x06: conf & 0x80 ? 1024x768 : 640x480
   1008 	 * 0x07: conf & 0x80 ? 1024x768 ? 1024x864
   1009 	 * 0x20: 1024x864
   1010 	 * 0x40: 1024x768
   1011 	 * 0x60: 1024x864
   1012 	 * 0x80: 1280x1024 4BPN
   1013 	 * 0x90: 1280x1024 8BPN
   1014 	 * 0xb0: 1280x1024 8BPN 2HD
   1015 	 */
   1016 	if (self != NULL) {
   1017 		lcg_config = (u_int *)vax_map_physmem(LCG_CONFIG, 1);
   1018 	} else {
   1019 		lcg_config = (u_int *)virtual_avail;
   1020 		ioaccess((vaddr_t)lcg_config, LCG_CONFIG, 1);
   1021 	}
   1022 	magic = *lcg_config & (vax_boardtype == VAX_BTYP_46 ? 0xf0 : 0x07);
   1023 	if (self != NULL) {
   1024 		vax_unmap_physmem((vaddr_t)lcg_config, 1);
   1025 	} else {
   1026 		iounaccess((vaddr_t)lcg_config, 1);
   1027 	}
   1028 	lcg_depth = 8;
   1029 	switch(magic) {
   1030 	case 0x80:		/* KA46 HR 1280x1024 4BPLN */
   1031 		lcg_depth = 4;
   1032 	case 0x05:		/* KA48 HR 1280x1024 8BPLN */
   1033 	case 0x90:		/* KA46 HR 1280x1024 8BPLN */
   1034 	case 0xb0:		/* KA46 HR 1280x1024 8BPLN 2HD */
   1035 		lcg_xsize = 1280;
   1036 		lcg_ysize = 1024;
   1037 		break;
   1038 	case 0x06:		/* KA48 1024x768 or 640x480 */
   1039 		if (vax_confdata & 0x80) {
   1040 			lcg_xsize = 1024;
   1041 			lcg_ysize = 768;
   1042 		} else {
   1043 			lcg_xsize = 640;
   1044 			lcg_ysize = 480;
   1045 		}
   1046 		break;
   1047 	case 0x07:		/* KA48 1024x768 or 1024x864 */
   1048 		lcg_xsize = 1024;
   1049 		lcg_ysize = (vax_confdata & 0x80) ? 768 : 864;
   1050 		break;
   1051 	case 0x20:		/* KA46 1024x864 */
   1052 	case 0x60:		/* KA46 1024x864 */
   1053 		lcg_xsize = 1024;
   1054 		lcg_ysize = 864;
   1055 		break;
   1056 	case 0x40:		/* KA46 1024x768 */
   1057 		lcg_xsize = 1024;
   1058 		lcg_ysize = 768;
   1059 		break;
   1060 	default:
   1061 		panic("LCG model not supported");
   1062 	}
   1063 	if (self != NULL)
   1064 		aprint_normal("%s: framebuffer size %dx%d, depth %d (magic 0x%x)\n",
   1065 			self->dv_xname, lcg_xsize, lcg_ysize, lcg_depth, magic);
   1066 
   1067 	wsfont_init();
   1068 	cookie = wsfont_find(NULL, 12, 22, 0, WSDISPLAY_FONTORDER_R2L,
   1069 	    WSDISPLAY_FONTORDER_L2R, WSFONT_FIND_BITMAP);
   1070 	if (cookie == -1)
   1071 		cookie = wsfont_find(NULL, 8, 0, 0, WSDISPLAY_FONTORDER_R2L, 0,
   1072 				WSFONT_FIND_BITMAP);
   1073 	if (cookie == -1)
   1074 		cookie = wsfont_find(NULL, 0, 0, 0, WSDISPLAY_FONTORDER_R2L,
   1075 		    WSDISPLAY_FONTORDER_L2R, WSFONT_FIND_BITMAP);
   1076 	if (cookie == -1 || wsfont_lock(cookie, &wf))
   1077 		panic("lcg_common_init: can't load console font");
   1078 	lcg_font = *wf;
   1079 	lcg_cols = lcg_xsize / lcg_font.fontwidth;
   1080 	lcg_rows = lcg_ysize / lcg_font.fontheight;
   1081 	if (self != NULL) {
   1082 		aprint_normal("%s: using font %s (%dx%d), ", self->dv_xname, lcg_font.name,
   1083 				lcg_font.fontwidth, lcg_font.fontheight);
   1084 		aprint_normal("console size: %dx%d\n", lcg_cols, lcg_rows);
   1085 	}
   1086 	lcg_onerow = lcg_xsize * lcg_font.fontheight;
   1087 	lcg_fb_size = lcg_xsize * lcg_ysize;
   1088 	lcg_stdscreen.ncols = lcg_cols;
   1089 	lcg_stdscreen.nrows = lcg_rows;
   1090 	lcg_stdscreen.fontwidth = lcg_font.fontwidth;
   1091 	lcg_stdscreen.fontheight = lcg_font.fontheight;
   1092 	lcg_glyph_size = lcg_font.stride * lcg_font.fontheight;
   1093 	snprintf(lcg_stdscreen_name, sizeof(lcg_stdscreen_name), "%dx%d", lcg_cols, lcg_rows);
   1094 	qf = lcg_font.data;
   1095 	qf2 = (u_short *)lcg_font.data;
   1096 
   1097 	if (self != NULL) {
   1098 		lcgaddr = (void *)vax_map_physmem(va->va_paddr,
   1099 					((lcg_fb_size + LCG_FONT_STORAGE_SIZE)/VAX_NBPG));
   1100 		if (lcgaddr == 0) {
   1101 			printf("%s: unable to allocate framebuffer memory.\n", self->dv_xname);
   1102 			return;
   1103 		}
   1104 #ifndef LCG_NO_ACCEL
   1105 		fontaddr = lcgaddr + lcg_fb_size;
   1106 
   1107 		/* copy font bitmaps */
   1108 		for (ch = 0; ch < 256; ch++)
   1109 			for (line = 0; line < lcg_font.fontheight; line++) {
   1110 				temp = QFONT(ch, line);
   1111 				if (lcg_font.stride == 1)
   1112 					fontaddr[(ch * lcg_font.fontheight) + line] = temp;
   1113 				else {
   1114 					/* stride == 2 */
   1115 					fontaddr[(ch * lcg_font.stride * lcg_font.fontheight) + line] = temp & 0xff;
   1116 					fontaddr[(ch * lcg_font.stride * lcg_font.fontheight) + line + 1] = (temp >> 16) & 0xff;
   1117 				}
   1118 			}
   1119 #endif
   1120 
   1121 		lutaddr = (void *)vax_map_physmem(LCG_LUT_ADDR, (LCG_LUT_SIZE/VAX_NBPG));
   1122 		if (lutaddr == 0) {
   1123 			printf("%s: unable to allocate LUT memory.\n", self->dv_xname);
   1124 			return;
   1125 		}
   1126 		fifoaddr = (long*)vax_map_physmem(LCG_FIFO_WIN_ADDR, (LCG_FIFO_WIN_SIZE/VAX_NBPG));
   1127 		if (regaddr == 0) {
   1128 			printf("%s: unable to map FIFO window\n", self->dv_xname);
   1129 			return;
   1130 		}
   1131 
   1132 		/* allocate contiguous physical memory block for FIFO */
   1133 		err = bus_dmamem_alloc(va->va_dmat, LCG_FIFO_SIZE,
   1134 			LCG_FIFO_ALIGN, 0, &seg, 1, &rseg, BUS_DMA_NOWAIT);
   1135 		if (err) {
   1136 			printf("%s: unable to allocate FIFO memory block, err = %d\n",
   1137 				self->dv_xname, err);
   1138 			return;
   1139 		}
   1140 
   1141 		err = bus_dmamem_map(va->va_dmat, &seg, rseg, LCG_FIFO_SIZE,
   1142 			&fifo_mem_vaddr, BUS_DMA_NOWAIT);
   1143 		if (err) {
   1144 			printf("%s: unable to map FIFO memory block, err = %d\n",
   1145 				self->dv_xname, err);
   1146 			bus_dmamem_free(va->va_dmat, &seg, rseg);
   1147 			return;
   1148 		}
   1149 
   1150 		err = bus_dmamap_create(va->va_dmat, LCG_FIFO_SIZE, rseg,
   1151 			LCG_FIFO_SIZE, 0, BUS_DMA_NOWAIT, &sc->sc_dm);
   1152 		if (err) {
   1153 			printf("%s: unable to create DMA map, err = %d\n", self->dv_xname, err);
   1154 			bus_dmamem_unmap(va->va_dmat, fifo_mem_vaddr, LCG_FIFO_SIZE);
   1155 			bus_dmamem_free(va->va_dmat, &seg, rseg);
   1156 			return;
   1157 		}
   1158 
   1159 		err = bus_dmamap_load(va->va_dmat, sc->sc_dm, fifo_mem_vaddr,
   1160 			LCG_FIFO_SIZE, NULL, BUS_DMA_NOWAIT);
   1161 		if (err) {
   1162 			printf("%s: unable to load DMA map, err = %d\n", self->dv_xname, err);
   1163 			bus_dmamap_destroy(va->va_dmat, sc->sc_dm);
   1164 			bus_dmamem_unmap(va->va_dmat, fifo_mem_vaddr, LCG_FIFO_SIZE);
   1165 			bus_dmamem_free(va->va_dmat, &seg, rseg);
   1166 			return;
   1167 		}
   1168 
   1169 		/* initialize LCG hardware */
   1170 		LCG_REG(LCG_REG_GRAPHICS_CONTROL) = 0xd8000000; /* gfx reset, FIFO and AG enable */
   1171 //		LCG_REG(LCG_REG_WRITE_PROTECT_LOW_HIGH) = (((LCG_FB_ADDR + lcg_fb_size) & 0xffff0000) | (LCG_FB_ADDR >> 16));
   1172 		LCG_REG(LCG_REG_WRITE_PROTECT_LOW_HIGH) = 0xffff0000;
   1173 		LCG_REG(LCG_REG_FIFO_BASE) = sc->sc_dm->dm_segs[0].ds_addr;
   1174 		LCG_REG(LCG_REG_FIFO_BASE2) = sc->sc_dm->dm_segs[0].ds_addr;
   1175 		LCG_REG(LCG_REG_FIFO_MASKS) = 0xffff;
   1176 		LCG_REG(LCG_REG_FIFO_SAVE_HEAD_OFFSET) = sc->sc_dm->dm_segs[0].ds_addr;
   1177 //		LCG_REG(LCG_REG_GRAPHICS_INT_STATUS) = 0;
   1178 //		LCG_REG(LCG_REG_GRAPHICS_CONTROL) = 0x50000000; /* FIFO and AG enable */
   1179 		LCG_REG(LCG_REG_GRAPHICS_INT_STATUS) = 0xffffffff;
   1180 		LCG_REG(LCG_REG_GRAPHICS_INT_SET_ENABLE) = 0;
   1181 		LCG_REG(LCG_REG_GRAPHICS_INT_CLR_ENABLE) = 0xffffffff;
   1182 		LCG_REG(LCG_REG_LCG_GO) = 3; /* FIFO and AG go */
   1183 //		LCG_REG(LCG_REG_BREAKPT_ADDRESS) = 0x2fffffff;
   1184 
   1185 	} else {
   1186 		lcgaddr = (void *)virtual_avail;
   1187 		virtual_avail += lcg_fb_size + LCG_FONT_STORAGE_SIZE;
   1188 		ioaccess((vaddr_t)lcgaddr, LCG_FB_ADDR, (lcg_fb_size/VAX_NBPG));
   1189 
   1190 		lutaddr = (void *)virtual_avail;
   1191 		virtual_avail += LCG_LUT_SIZE;
   1192 		ioaccess((vaddr_t)lutaddr, LCG_LUT_ADDR, (LCG_LUT_SIZE/VAX_NBPG));
   1193 
   1194 		fifoaddr = (long*)virtual_avail;
   1195 		virtual_avail += LCG_FIFO_WIN_SIZE;
   1196 		ioaccess((vaddr_t)fifoaddr, LCG_FIFO_WIN_ADDR, (LCG_FIFO_WIN_SIZE/VAX_NBPG));
   1197 	}
   1198 
   1199 	bzero(lutaddr, LCG_LUT_SIZE);
   1200 	for (i = 0; i < 8; ++i) {
   1201 		lcg_cmap.r[i] = lcg_default_cmap.r[i];
   1202 		lcg_cmap.g[i] = lcg_default_cmap.g[i];
   1203 		lcg_cmap.b[i] = lcg_default_cmap.b[i];
   1204 		lutaddr[i * 8 + 1] = i;
   1205 		lutaddr[i * 8 + 2] = 1;
   1206 		lutaddr[i * 8 + 3] = lcg_cmap.r[i] >> (lcg_depth & 7);
   1207 		lutaddr[i * 8 + 4] = 1;
   1208 		lutaddr[i * 8 + 5] = lcg_cmap.g[i] >> (lcg_depth & 7);
   1209 		lutaddr[i * 8 + 6] = 1;
   1210 		lutaddr[i * 8 + 7] = lcg_cmap.b[i] >> (lcg_depth & 7);
   1211 	}
   1212 
   1213 	/*
   1214 	 * 0xf100165b 4000/60
   1215 	 * 1111 0001 0000 0000 0001 0110 0101 1011
   1216 	 * vvvv vvvv vvvv vvvv vvvv vvvv vvvv vvvv
   1217 	 * 3322 2222 2222 1111 1111 11
   1218 	 * 1098 7654 3210 9876 5432 1098 7654 3210
   1219 	 *
   1220  	 * 0xf1001d7b 4000/VLC
   1221 	 * 1111 0001 0000 0000 0001 1101 0111 1011
   1222 	 * vvvv vvvv vvvv vvvv vvvv vvvv vvvv vvvv
   1223 	 * 3322 2222 2222 1111 1111 11
   1224 	 * 1098 7654 3210 9876 5432 1098 7654 3210
   1225 	 *
   1226 	 * 31-30     11 Vertical state
   1227 	 * 29-38     11 Horizontal state
   1228 	 * 27-26     00
   1229 	 * 25         0 console LUT select
   1230 	 * 24         1 control LUT select
   1231 	 * 23         0
   1232 	 * 22         0 cursor active
   1233 	 * 21-16 000000
   1234 	 * 15         0 video subsystem reset
   1235 	 * 14         0
   1236 	 * 13         0 LUT load size 2KB
   1237 	 * 12         1 enable H sync
   1238 	 * 11         0 Full LUT load		 1
   1239 	 * 10         1 video clock select
   1240 	 *  9- 8     10 memory refresh rate	01
   1241 	 *  7- 6     01 video refresh rate
   1242 	 *  5         0 load select		 1
   1243 	 *  4         1 read cursor output
   1244 	 *  3         1 LUT load enable
   1245 	 *  2         0 cursor enable
   1246 	 *  1         1 video enable
   1247 	 *  0         1 refresh clock enable
   1248 	 */
   1249 	/* prepare video_config reg for LUT relaod */
   1250 	video_conf
   1251 		 = (3 << 30) /* vertical state */
   1252 		 | (3 << 28) /* horizontal state */
   1253 		 | (0 << 26) /* unused */
   1254 		 | (0 << 25) /* console LUT select */
   1255 		 | (0 << 24) /* control LUT select */
   1256 		 | (0 << 23) /* unused */
   1257 		 | (0 << 22) /* cursor active */
   1258 		 | (0 << 16) /* current cursor scanline showing */
   1259 		 | (0 << 15) /* video subsystem reset */
   1260 		 | (0 << 14) /* unused */
   1261 		 | (1 << 13) /* LUT load size 2 KB */
   1262 		 | (1 << 12) /* enable horizontal sync */
   1263 		 | (1 << 10) /* video clock select */
   1264 		 | (1 << 6) /* video refresh select */
   1265 		 | (1 << 4) /* read curosr output */
   1266 		 | (1 << 3) /* LUT load enable */
   1267 		 | (0 << 2) /* cursor enable */
   1268 		 | (1 << 1) /* video enable */
   1269 		 | (1 << 0); /* refresh clock enable */
   1270 	/* FIXME needs updating for all supported models */
   1271 	if (lcg_xsize == 1280) {		/* 4000/60 HR 4PLN */
   1272 		video_conf |= (0 << 11); /* split LUT load */
   1273 		video_conf |= (2 << 8); /* memory refresh select */
   1274 		video_conf |= (0 << 5); /* split shift register load */
   1275 	} else {				/* 4000/VLC LR 8PLN */
   1276 		video_conf |= (1 << 11); /* Full LUT load */
   1277 		video_conf |= (1 << 8); /* memory refresh select */
   1278 		video_conf |= (1 << 5); /* split shift register load */
   1279 	}
   1280 
   1281 	LCG_REG(LCG_REG_VIDEO_CONFIG) = video_conf;
   1282 	/* vital !!! */
   1283 	LCG_REG(LCG_REG_LUT_CONSOLE_SEL) = 1;
   1284 	LCG_REG(LCG_REG_LUT_COLOR_BASE_W) = LCG_LUT_OFFSET;
   1285 
   1286 	delay(1000);
   1287 	LCG_REG(LCG_REG_LUT_CONSOLE_SEL) = 0;
   1288 
   1289 #ifdef LCG_DEBUG
   1290 	if (self != NULL)
   1291 		printf("%s: video config register set 0x%08lx\n", video_conf, self->dv_xname);
   1292 #endif
   1293 }
   1294