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