xref: /netbsd-src/sys/arch/atari/dev/ite_et.c (revision 7f21db1c0118155e0dd40b75182e30c589d9f63e)
1 /*	$NetBSD: ite_et.c,v 1.28 2010/02/09 23:05:16 wiz Exp $	*/
2 
3 /*
4  * Copyright (c) 1996 Leo Weppelman.
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  *
16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26  */
27 
28 #include <sys/cdefs.h>
29 __KERNEL_RCSID(0, "$NetBSD: ite_et.c,v 1.28 2010/02/09 23:05:16 wiz Exp $");
30 
31 #include <sys/param.h>
32 #include <sys/systm.h>
33 #include <sys/conf.h>
34 #include <sys/ioctl.h>
35 #include <sys/malloc.h>
36 #include <sys/device.h>
37 #include <dev/cons.h>
38 
39 #include <machine/cpu.h>
40 
41 #include <atari/atari/device.h>
42 
43 #include <atari/dev/itevar.h>
44 #include <atari/dev/iteioctl.h>
45 #include <atari/dev/grfioctl.h>
46 #include <atari/dev/grf_etreg.h>
47 #include <atari/dev/grfabs_reg.h>
48 #include <atari/dev/grfabs_et.h>
49 #include <atari/dev/grfvar.h>
50 #include <atari/dev/font.h>
51 #include <atari/dev/viewioctl.h>
52 #include <atari/dev/viewvar.h>
53 
54 #include "grfet.h"
55 
56 /*
57  * This is what ip->priv points to;
58  * it contains local variables for custom-chip ites.
59  */
60 struct ite_priv {
61 	volatile u_char	*regkva;
62 };
63 
64 typedef struct ite_priv ipriv_t;
65 
66 static ipriv_t	con_ipriv;
67 
68 /* Console colors */
69 static u_char etconscolors[3][3] = {	/* background, foreground, hilite */
70 	{0x0, 0x0, 0x0}, {0x30, 0x30, 0x30}, { 0x3f,  0x3f,  0x3f}
71 };
72 
73 /* XXX: Shouldn't these be in font.h???? */
74 extern font_info	font_info_8x8;
75 extern font_info	font_info_8x16;
76 
77 static void grfet_iteinit(struct grf_softc *);
78 static void view_init(struct ite_softc *);
79 static void view_deinit(struct ite_softc *);
80 static int  iteet_ioctl(struct ite_softc *, u_long, void *, int,
81 							struct lwp *);
82 static int  ite_newsize(struct ite_softc *, struct itewinsize *);
83 static void et_inittextmode(struct ite_softc *, et_sv_reg_t *, int);
84 void et_cursor(struct ite_softc *ip, int flag);
85 void et_clear(struct ite_softc *ip, int sy, int sx, int h, int w);
86 void et_putc(struct ite_softc *ip, int c, int dy, int dx, int mode);
87 void et_scroll(struct ite_softc *ip, int sy, int sx, int count,
88     int dir);
89 
90 /*
91  * grfet config stuff
92  */
93 void grfetattach(struct device *, struct device *, void *);
94 int  grfetmatch(struct device *, struct cfdata *, void *);
95 int  grfetprint(void *, const char *);
96 
97 CFATTACH_DECL(grfet, sizeof(struct grf_softc),
98     grfetmatch, grfetattach, NULL, NULL);
99 
100 /*
101  * only used in console init.
102  */
103 static struct cfdata *cfdata_grf   = NULL;
104 
105 int
106 grfetmatch(struct device *pdp, struct cfdata *cfp, void *auxp)
107 {
108 	static int	card_probed  = -1;
109 	static int	did_consinit = 0;
110 	grf_auxp_t	*grf_auxp = auxp;
111 	extern const struct cdevsw view_cdevsw;
112 
113 	if (card_probed <= 0) {
114 		if (card_probed == 0) /* Probed but failed */
115 			return 0;
116 		card_probed = 0;
117 
118 		/*
119 		 * Check if the layers we depend on exist
120 		 */
121 		if(!(machineid & ATARI_HADES))
122 			return 0;
123 		if (!et_probe_card())
124 			return 0;
125 		if (grfabs_probe(&et_probe_video) == 0)
126 			return 0;
127 		viewprobe();
128 		card_probed = 1; /* Probed and found */
129 	}
130 
131 	if (atari_realconfig == 0) {
132 		/*
133 		 * Early console init. Only match first unit.
134 		 */
135 		if (did_consinit)
136 			return 0;
137 		if ((*view_cdevsw.d_open)(cfp->cf_unit, 0, 0, NULL))
138 			return 0;
139 		cfdata_grf = cfp;
140 		did_consinit = 1;
141 		return 1;
142 	}
143 
144 	/*
145 	 * Normal config. When we are called directly from the grfbus,
146 	 * we only match the first unit. The attach function will call us for
147 	 * the other configured units.
148 	 */
149 	if (grf_auxp->from_bus_match
150 	    && ((did_consinit > 1) || !et_probe_card()))
151 		return 0;
152 
153 	if (!grf_auxp->from_bus_match && (grf_auxp->unit != cfp->cf_unit))
154 		return 0;
155 
156 	/*
157 	 * Final constraint: each grf needs a view....
158 	 */
159 	if((cfdata_grf == NULL) || (did_consinit > 1)) {
160 	    if((*view_cdevsw.d_open)(cfp->cf_unit, 0, 0, NULL))
161 		return 0;
162 	}
163 	did_consinit = 2;
164 	return 1;
165 }
166 
167 /*
168  * attach: initialize the grf-structure and try to attach an ite to us.
169  * note  : dp is NULL during early console init.
170  */
171 void
172 grfetattach(struct device *pdp, struct device *dp, void *auxp)
173 {
174 	static struct grf_softc		congrf;
175 	static int			first_attach = 1;
176 	       grf_auxp_t		*grf_bus_auxp = auxp;
177 	       grf_auxp_t		grf_auxp;
178 	       struct grf_softc		*gp;
179 	       int			maj;
180 	extern const struct cdevsw grf_cdevsw;
181 
182 	/*
183 	 * find our major device number
184 	 */
185 	maj = cdevsw_lookup_major(&grf_cdevsw);
186 
187 	/*
188 	 * Handle exception case: early console init
189 	 */
190 	if(dp == NULL) {
191 		congrf.g_unit    = cfdata_grf->cf_unit;
192 		congrf.g_grfdev  = makedev(maj, congrf.g_unit);
193 		congrf.g_itedev  = (dev_t)-1;
194 		congrf.g_flags   = GF_ALIVE;
195 		congrf.g_mode    = grf_mode;
196 		congrf.g_conpri  = CN_INTERNAL;
197 		congrf.g_viewdev = congrf.g_unit;
198 		grfet_iteinit(&congrf);
199 		grf_viewsync(&congrf);
200 
201 		/* Attach console ite */
202 		atari_config_found(cfdata_grf, NULL, &congrf, grfetprint);
203 		return;
204 	}
205 
206 	gp = (struct grf_softc *)dp;
207 	gp->g_unit = device_unit(&gp->g_device);
208 	grfsp[gp->g_unit] = gp;
209 
210 	if((cfdata_grf != NULL) && (gp->g_unit == congrf.g_unit)) {
211 		/*
212 		 * We inited earlier just copy the info, take care
213 		 * not to copy the device struct though.
214 		 */
215 		memcpy(&gp->g_display, &congrf.g_display,
216 			(char *)&gp[1] - (char *)&gp->g_display);
217 	}
218 	else {
219 		gp->g_grfdev  = makedev(maj, gp->g_unit);
220 		gp->g_itedev  = (dev_t)-1;
221 		gp->g_flags   = GF_ALIVE;
222 		gp->g_mode    = grf_mode;
223 		gp->g_conpri  = 0;
224 		gp->g_viewdev = gp->g_unit;
225 		grfet_iteinit(gp);
226 		grf_viewsync(gp);
227 	}
228 
229 	printf(": %dx%d", gp->g_display.gd_dwidth, gp->g_display.gd_dheight);
230 	if(gp->g_display.gd_colors == 2)
231 		printf(" monochrome\n");
232 	else printf(" colors %d\n", gp->g_display.gd_colors);
233 
234 	/*
235 	 * try and attach an ite
236 	 */
237 	config_found(dp, gp, grfetprint);
238 
239 	/*
240 	 * If attaching the first unit, go ahead and 'find' the rest of us
241 	 */
242 	if (first_attach) {
243 		first_attach = 0;
244 		grf_auxp.from_bus_match = 0;
245 		for (grf_auxp.unit=0; grf_auxp.unit < NGRFET; grf_auxp.unit++) {
246 		    config_found(pdp, (void*)&grf_auxp, grf_bus_auxp->busprint);
247 		}
248 	}
249 }
250 
251 int
252 grfetprint(void *auxp, const char *pnp)
253 {
254 	if(pnp) /* XXX */
255 		aprint_normal("ite at %s", pnp);
256 	return(UNCONF);
257 }
258 
259 /*
260  * Init ite portion of grf_softc struct
261  */
262 static void
263 grfet_iteinit(struct grf_softc *gp)
264 {
265 
266 	gp->g_itecursor = et_cursor;
267 	gp->g_iteputc   = et_putc;
268 	gp->g_iteclear  = et_clear;
269 	gp->g_itescroll = et_scroll;
270 	gp->g_iteinit   = view_init;
271 	gp->g_itedeinit = view_deinit;
272 }
273 
274 static void
275 view_deinit(struct ite_softc *ip)
276 {
277 	ip->flags &= ~ITE_INITED;
278 }
279 
280 static void
281 view_init(register struct ite_softc *ip)
282 {
283 	struct itewinsize	wsz;
284 	ipriv_t			*cci;
285 	view_t			*view;
286 	save_area_t		*et_save;
287 
288 	if((cci = ip->priv) != NULL)
289 		return;
290 
291 	ip->itexx_ioctl = iteet_ioctl;
292 
293 #if defined(KFONT_8X8)
294 	ip->font = font_info_8x8;
295 #else
296 	ip->font = font_info_8x16;
297 #endif
298 
299 	/* Find the correct set of rendering routines for this font.  */
300 	if(ip->font.width != 8)
301 		panic("kernel font size not supported");
302 
303 	if(!atari_realconfig)
304 		ip->priv = cci = &con_ipriv;
305 	else ip->priv = cci = (ipriv_t*)malloc(sizeof(*cci), M_DEVBUF,M_WAITOK);
306 	if(cci == NULL)
307 		panic("No memory for ite-view");
308 	memset(cci, 0, sizeof(*cci));
309 
310 	wsz.x      = ite_default_x;
311 	wsz.y      = ite_default_y;
312 	wsz.width  = ite_default_width;
313 	wsz.height = ite_default_height;
314 	wsz.depth  = ite_default_depth;
315 
316 	ite_newsize (ip, &wsz);
317 
318 	view  = viewview(ip->grf->g_viewdev);
319 	cci->regkva = view->bitmap->regs;
320 
321 	/*
322 	 * Only console will be turned on by default..
323 	 */
324 	if(ip->flags & ITE_ISCONS)
325 		ip->grf->g_mode(ip->grf, GM_GRFON, NULL, 0, 0);
326 
327 	/*
328 	 * Activate text-mode settings
329 	 */
330 	et_save = (save_area_t *)view->save_area;
331 	if (et_save == NULL)
332 		et_inittextmode(ip, NULL, view->flags & VF_DISPLAY);
333 	else {
334 		et_inittextmode(ip, &et_save->sv_regs, view->flags&VF_DISPLAY);
335 		et_save->fb_size = ip->cols * ip->rows;
336 	}
337 }
338 
339 static int
340 ite_newsize(struct ite_softc *ip, struct itewinsize *winsz)
341 {
342 	struct view_size	vs;
343 	int			error = 0;
344 	save_area_t		*et_save;
345 	view_t			*view;
346 	extern const struct cdevsw view_cdevsw;
347 
348 	vs.x      = winsz->x;
349 	vs.y      = winsz->y;
350 	vs.width  = winsz->width;
351 	vs.height = winsz->height;
352 	vs.depth  = winsz->depth;
353 
354 	error = (*view_cdevsw.d_ioctl)(ip->grf->g_viewdev, VIOCSSIZE,
355 				       (void *)&vs, 0, NOLWP);
356 	view  = viewview(ip->grf->g_viewdev);
357 
358 	/*
359 	 * Reinitialize our structs
360 	 */
361 	ip->cols = view->display.width  / ip->font.width;
362 	ip->rows = view->display.height / ip->font.height;
363 
364 	/*
365 	 * save new values so that future opens use them
366 	 * this may not be correct when we implement Virtual Consoles
367 	 */
368 	ite_default_height = view->display.height;
369 	ite_default_width  = view->display.width;
370 	ite_default_x      = view->display.x;
371 	ite_default_y      = view->display.y;
372 	ite_default_depth  = view->bitmap->depth;
373 
374 	et_save = (save_area_t *)view->save_area;
375 	if (et_save == NULL)
376 	    et_inittextmode(ip, NULL, view->flags & VF_DISPLAY);
377 	else {
378 	    et_inittextmode(ip, &et_save->sv_regs, view->flags & VF_DISPLAY);
379 	    et_save->fb_size = ip->cols * ip->rows;
380 	}
381 	et_clear(ip, 0, 0, ip->rows, ip->cols);
382 
383 	return(error);
384 }
385 
386 int
387 iteet_ioctl(struct ite_softc *ip, u_long cmd, void * addr, int flag, struct lwp *l)
388 {
389 	struct winsize		ws;
390 	struct itewinsize	*is;
391 	int			error = 0;
392 	view_t			*view = viewview(ip->grf->g_viewdev);
393 	extern const struct cdevsw ite_cdevsw;
394 	extern const struct cdevsw view_cdevsw;
395 
396 	switch (cmd) {
397 	case ITEIOCSWINSZ:
398 		is = (struct itewinsize *)addr;
399 
400 		if(ite_newsize(ip, is))
401 			error = ENOMEM;
402 		else {
403 			view         = viewview(ip->grf->g_viewdev);
404 			ws.ws_row    = ip->rows;
405 			ws.ws_col    = ip->cols;
406 			ws.ws_xpixel = view->display.width;
407 			ws.ws_ypixel = view->display.height;
408 			ite_reset(ip);
409 			/*
410 			 * XXX tell tty about the change
411 			 * XXX this is messy, but works
412 			 */
413 			(*ite_cdevsw.d_ioctl)(ip->grf->g_itedev, TIOCSWINSZ,
414 					      (void *)&ws, 0, l);
415 		}
416 		break;
417 	case VIOCSCMAP:
418 	case VIOCGCMAP:
419 		/*
420 		 * XXX watchout for that NOLWP. its not really the kernel
421 		 * XXX talking these two commands don't use the proc pointer
422 		 * XXX though.
423 		 */
424 		error = (*view_cdevsw.d_ioctl)(ip->grf->g_viewdev, cmd, addr,
425 					       flag, NOLWP);
426 		break;
427 	default:
428 		error = EPASSTHROUGH;
429 		break;
430 	}
431 	return (error);
432 }
433 
434 void
435 et_cursor(struct ite_softc *ip, int flag)
436 {
437 	volatile u_char	*ba;
438 		 view_t	*v;
439 		 u_long cpos;
440 
441 	ba = ((ipriv_t*)ip->priv)->regkva;
442 	v  = viewview(ip->grf->g_viewdev);
443 
444 	/*
445 	 * Don't update the cursor when not on display
446 	 */
447 	if (!(v->flags & VF_DISPLAY))
448 		return;
449 
450 	switch (flag) {
451  	    case DRAW_CURSOR:
452 		/*WCrt(ba, CRT_ID_CURSOR_START, & ~0x20); */
453 	    case MOVE_CURSOR:
454 		cpos  =  RCrt(ba, CRT_ID_START_ADDR_LOW) & 0xff;
455 		cpos |= (RCrt(ba, CRT_ID_START_ADDR_HIGH) & 0xff) << 8;
456 		cpos += ip->curx + ip->cury * ip->cols;
457 		WCrt(ba, CRT_ID_CURSOR_LOC_LOW, cpos & 0xff);
458 		WCrt(ba, CRT_ID_CURSOR_LOC_HIGH, (cpos >> 8) & 0xff);
459 		WCrt(ba, CTR_ID_EXT_START, (cpos >> (16-2)) & 0x0c);
460 
461 		ip->cursorx = ip->curx;
462 		ip->cursory = ip->cury;
463 		break;
464 	    case ERASE_CURSOR:
465 		/*WCrt(ba, CRT_ID_CURSOR_START, | 0x20); */
466 	    case START_CURSOROPT:
467 	    case END_CURSOROPT:
468 	    default:
469 		break;
470     	}
471 }
472 
473 void
474 et_putc(struct ite_softc *ip, int c, int dy, int dx, int mode)
475 {
476 	view_t	*v   = viewview(ip->grf->g_viewdev);
477 	u_char	attr;
478 	u_short	*cp;
479 
480 	attr = (unsigned char) ((mode & ATTR_INV) ? (0x70) : (0x07));
481 	if (mode & ATTR_UL)     attr |= 0x01;
482 	if (mode & ATTR_BOLD)   attr |= 0x08;
483 	if (mode & ATTR_BLINK)  attr |= 0x80;
484 
485 	cp  = (u_short*)v->bitmap->plane;
486 	cp[(dy * ip->cols) + dx] = (c << 8) | attr;
487 }
488 
489 void
490 et_clear(struct ite_softc *ip, int sy, int sx, int h, int w)
491 {
492 	/* et_clear and et_scroll both rely on ite passing arguments
493 	 * which describe continuous regions.  For a VT200 terminal,
494 	 * this is safe behavior.
495 	 */
496 	view_t		*v   = viewview(ip->grf->g_viewdev);
497 	u_short		*dest;
498 	int		len;
499 
500 	dest = (u_short *)v->bitmap->plane + (sy * ip->cols) + sx;
501 	for(len = w * h; len-- ;)
502 		*dest++ = 0x2007;
503 }
504 
505 void
506 et_scroll(struct ite_softc *ip, int sy, int sx, int count, int dir)
507 {
508 	view_t	*v   = viewview(ip->grf->g_viewdev);
509 	u_short	*fb;
510 	u_short	*src, *dst;
511 	int	len;
512 
513 	fb = (u_short*)v->bitmap->plane + sy * ip->cols;
514 	switch (dir) {
515 	    case SCROLL_UP:
516 			src = fb;
517 			dst = fb - count * ip->cols;
518 			len = (ip->bottom_margin + 1 - sy) * ip->cols;
519 			break;
520 	    case SCROLL_DOWN:
521 			src = fb;
522 			dst = fb + count * ip->cols;
523 			len = (ip->bottom_margin + 1 - (sy + count)) * ip->cols;
524 			break;
525 	    case SCROLL_RIGHT:
526 			src = fb + sx;
527 			dst = fb + sx + count;
528 			len = ip->cols - sx + count;
529 			break;
530 	    case SCROLL_LEFT:
531 			src = fb + sx;
532 			dst = fb + sx - count;
533 			len = ip->cols - sx;
534 			break;
535 	    default:
536 			return;
537 	}
538 	if (src > dst) {
539 		while (len--)
540 			*dst++ = *src++;
541 	}
542 	else {
543 		src = &src[len];
544 		dst = &dst[len];
545 		while (len--)
546 			*--dst = *--src;
547 	}
548 }
549 
550 static void
551 et_inittextmode(struct ite_softc *ip, et_sv_reg_t *etregs, int loadfont)
552 {
553 	volatile u_char *ba;
554 	font_info	*fd;
555 	u_char		*fb;
556 	u_char		*c, *f, tmp;
557 	u_short		z, y;
558 	int		s;
559 	view_t		*v   = viewview(ip->grf->g_viewdev);
560 	et_sv_reg_t	loc_regs;
561 
562 	if (etregs == NULL) {
563 		etregs = &loc_regs;
564 		et_hwsave(etregs);
565 	}
566 
567 	ba = ((ipriv_t*)ip->priv)->regkva;
568 	fb = v->bitmap->plane;
569 
570 #if defined(KFONT_8X8)
571 	fd = &font_info_8x8;
572 #else
573 	fd = &font_info_8x16;
574 #endif
575 
576 	if (loadfont) { /* XXX: We should set the colormap */
577 		/*
578 		 * set colors (B&W)
579 		 */
580 		vgaw(ba, VDAC_ADDRESS_W, 0);
581 		for (z = 0; z < 256; z++) {
582 			y = (z & 1) ? ((z > 7) ? 2 : 1) : 0;
583 
584 			vgaw(ba, VDAC_DATA, etconscolors[y][0]);
585 			vgaw(ba, VDAC_DATA, etconscolors[y][1]);
586 			vgaw(ba, VDAC_DATA, etconscolors[y][2]);
587 		}
588 
589 		/*
590 		 * Enter a suitable mode to download the font. This
591 		 * basically means sequential addressing mode
592 		 */
593 		s = splhigh();
594 
595 		WAttr(ba, 0x20 | ACT_ID_ATTR_MODE_CNTL, 0x0a);
596 		WSeq(ba, SEQ_ID_MAP_MASK,	 0x04);
597 		WSeq(ba, SEQ_ID_MEMORY_MODE,	 0x06);
598 		WGfx(ba, GCT_ID_READ_MAP_SELECT, 0x02);
599 		WGfx(ba, GCT_ID_GRAPHICS_MODE,	 0x00);
600 		WGfx(ba, GCT_ID_MISC,		 0x04);
601 		splx(s);
602 
603 		/*
604 		 * load text font into beginning of display memory. Each
605 		 * character cell is 32 bytes long (enough for 4 planes)
606 		 */
607 		for (z = 0, c = fb; z < 256 * 32; z++)
608 			*c++ = 0;
609 
610 		c = (unsigned char *) (fb) + (32 * fd->font_lo);
611 		f = fd->font_p;
612 		z = fd->font_lo;
613 		for (; z <= fd->font_hi; z++, c += (32 - fd->height))
614 			for (y = 0; y < fd->height; y++) {
615 				*c++ = *f++;
616 			}
617 	}
618 
619 	/*
620 	 * Odd/Even addressing
621 	 */
622 	etregs->seq[SEQ_ID_MAP_MASK]        = 0x03;
623 	etregs->seq[SEQ_ID_MEMORY_MODE]     = 0x03;
624 	etregs->grf[GCT_ID_READ_MAP_SELECT] = 0x00;
625 	etregs->grf[GCT_ID_GRAPHICS_MODE]   = 0x10;
626 	etregs->grf[GCT_ID_MISC]            = 0x06;
627 
628 	/*
629 	 * Font height + underline location
630 	 */
631 	tmp = etregs->crt[CRT_ID_MAX_ROW_ADDRESS] & 0xe0;
632 	etregs->crt[CRT_ID_MAX_ROW_ADDRESS] = tmp | (fd->height - 1);
633 	tmp = etregs->crt[CRT_ID_UNDERLINE_LOC] & 0xe0;
634 	etregs->crt[CRT_ID_UNDERLINE_LOC] = tmp | (fd->height - 1);
635 
636 	/*
637 	 * Cursor setup
638 	 */
639 	etregs->crt[CRT_ID_CURSOR_START]    = 0x00;
640 	etregs->crt[CRT_ID_CURSOR_END]      = fd->height - 1;
641 	etregs->crt[CRT_ID_CURSOR_LOC_HIGH] = 0x00;
642 	etregs->crt[CRT_ID_CURSOR_LOC_LOW]  = 0x00;
643 
644 	/*
645 	 * Enter text mode
646 	 */
647 	etregs->crt[CRT_ID_MODE_CONTROL]    = 0xa3;
648 	etregs->attr[ACT_ID_ATTR_MODE_CNTL] = 0x0a;
649 
650 #if 1
651 	if (loadfont || (etregs == &loc_regs))
652 #else
653 	if (etregs == &loc_regs)
654 #endif
655 		et_hwrest(etregs);
656 }
657