Deleted Added
sdiff udiff text old ( 47640 ) new ( 48104 )
full compact
fb.c (47640) fb.c (48104)
1/*-
2 * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright

--- 11 unchanged lines hidden (view full) ---

20 * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
1/*-
2 * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright

--- 11 unchanged lines hidden (view full) ---

20 * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
28 * $Id: fb.c,v 1.4 1999/05/30 16:51:23 phk Exp $
28 * $Id: fb.c,v 1.5 1999/05/31 11:24:38 phk Exp $
29 */
30
31#include "fb.h"
32#include "opt_fb.h"
33
34#include <sys/param.h>
35#include <sys/systm.h>
36#include <sys/conf.h>
29 */
30
31#include "fb.h"
32#include "opt_fb.h"
33
34#include <sys/param.h>
35#include <sys/systm.h>
36#include <sys/conf.h>
37#include <sys/bus.h>
37#include <sys/kernel.h>
38#include <sys/malloc.h>
38#include <sys/kernel.h>
39#include <sys/malloc.h>
40#include <sys/uio.h>
41#include <sys/fbio.h>
39
42
40#include <machine/console.h>
43#include <vm/vm.h>
44#include <vm/pmap.h>
41
42#include <dev/fb/fbreg.h>
43
44/* local arrays */
45
46/*
47 * We need at least one entry each in order to initialize a video card
48 * for the kernel console. The arrays will be increased dynamically
49 * when necessary.
50 */
51
45
46#include <dev/fb/fbreg.h>
47
48/* local arrays */
49
50/*
51 * We need at least one entry each in order to initialize a video card
52 * for the kernel console. The arrays will be increased dynamically
53 * when necessary.
54 */
55
56static int vid_malloc;
52static int adapters = 1;
53static video_adapter_t *adp_ini;
54static video_adapter_t **adapter = &adp_ini;
55static video_switch_t *vidsw_ini;
56 video_switch_t **vidsw = &vidsw_ini;
57
58#ifdef FB_INSTALL_CDEV
57static int adapters = 1;
58static video_adapter_t *adp_ini;
59static video_adapter_t **adapter = &adp_ini;
60static video_switch_t *vidsw_ini;
61 video_switch_t **vidsw = &vidsw_ini;
62
63#ifdef FB_INSTALL_CDEV
59
60#define ARRAY_DELTA 4
61
62static struct cdevsw *vidcdevsw_ini;
63static struct cdevsw **vidcdevsw = &vidcdevsw_ini;
64static struct cdevsw *vidcdevsw_ini;
65static struct cdevsw **vidcdevsw = &vidcdevsw_ini;
66#endif
64
67
65static void
68#define ARRAY_DELTA 4
69
70static int
66vid_realloc_array(void)
67{
68 video_adapter_t **new_adp;
69 video_switch_t **new_vidsw;
71vid_realloc_array(void)
72{
73 video_adapter_t **new_adp;
74 video_switch_t **new_vidsw;
75#ifdef FB_INSTALL_CDEV
70 struct cdevsw **new_cdevsw;
76 struct cdevsw **new_cdevsw;
77#endif
71 int newsize;
72 int s;
73
78 int newsize;
79 int s;
80
81 if (!vid_malloc)
82 return ENOMEM;
83
74 s = spltty();
75 newsize = ((adapters + ARRAY_DELTA)/ARRAY_DELTA)*ARRAY_DELTA;
76 new_adp = malloc(sizeof(*new_adp)*newsize, M_DEVBUF, M_WAITOK);
77 new_vidsw = malloc(sizeof(*new_vidsw)*newsize, M_DEVBUF, M_WAITOK);
84 s = spltty();
85 newsize = ((adapters + ARRAY_DELTA)/ARRAY_DELTA)*ARRAY_DELTA;
86 new_adp = malloc(sizeof(*new_adp)*newsize, M_DEVBUF, M_WAITOK);
87 new_vidsw = malloc(sizeof(*new_vidsw)*newsize, M_DEVBUF, M_WAITOK);
88#ifdef FB_INSTALL_CDEV
78 new_cdevsw = malloc(sizeof(*new_cdevsw)*newsize, M_DEVBUF, M_WAITOK);
89 new_cdevsw = malloc(sizeof(*new_cdevsw)*newsize, M_DEVBUF, M_WAITOK);
90#endif
79 bzero(new_adp, sizeof(*new_adp)*newsize);
80 bzero(new_vidsw, sizeof(*new_vidsw)*newsize);
91 bzero(new_adp, sizeof(*new_adp)*newsize);
92 bzero(new_vidsw, sizeof(*new_vidsw)*newsize);
81 bzero(new_cdevsw, sizeof(*new_cdevsw)*newsize);
82 bcopy(adapter, new_adp, sizeof(*adapter)*adapters);
83 bcopy(vidsw, new_vidsw, sizeof(*vidsw)*adapters);
93 bcopy(adapter, new_adp, sizeof(*adapter)*adapters);
94 bcopy(vidsw, new_vidsw, sizeof(*vidsw)*adapters);
95#ifdef FB_INSTALL_CDEV
96 bzero(new_cdevsw, sizeof(*new_cdevsw)*newsize);
84 bcopy(vidcdevsw, new_cdevsw, sizeof(*vidcdevsw)*adapters);
97 bcopy(vidcdevsw, new_cdevsw, sizeof(*vidcdevsw)*adapters);
98#endif
85 if (adapters > 1) {
86 free(adapter, M_DEVBUF);
87 free(vidsw, M_DEVBUF);
99 if (adapters > 1) {
100 free(adapter, M_DEVBUF);
101 free(vidsw, M_DEVBUF);
102#ifdef FB_INSTALL_CDEV
88 free(vidcdevsw, M_DEVBUF);
103 free(vidcdevsw, M_DEVBUF);
104#endif
89 }
90 adapter = new_adp;
91 vidsw = new_vidsw;
105 }
106 adapter = new_adp;
107 vidsw = new_vidsw;
108#ifdef FB_INSTALL_CDEV
92 vidcdevsw = new_cdevsw;
109 vidcdevsw = new_cdevsw;
110#endif
93 adapters = newsize;
94 splx(s);
95
96 if (bootverbose)
97 printf("fb: new array size %d\n", adapters);
111 adapters = newsize;
112 splx(s);
113
114 if (bootverbose)
115 printf("fb: new array size %d\n", adapters);
116
117 return 0;
98}
99
118}
119
100#endif /* FB_INSTALL_CDEV */
120static void
121vid_malloc_init(void *arg)
122{
123 vid_malloc = TRUE;
124}
101
125
126SYSINIT(vid_mem, SI_SUB_KMEM, SI_ORDER_ANY, vid_malloc_init, NULL);
127
102/*
103 * Low-level frame buffer driver functions
104 * frame buffer subdrivers, such as the VGA driver, call these functions
105 * to initialize the video_adapter structure and register it to the virtual
106 * frame buffer driver `fb'.
107 */
108
109/* initialize the video_adapter_t structure */

--- 5 unchanged lines hidden (view full) ---

115 adp->va_type = type;
116 adp->va_unit = unit;
117}
118
119/* Register a video adapter */
120int
121vid_register(video_adapter_t *adp)
122{
128/*
129 * Low-level frame buffer driver functions
130 * frame buffer subdrivers, such as the VGA driver, call these functions
131 * to initialize the video_adapter structure and register it to the virtual
132 * frame buffer driver `fb'.
133 */
134
135/* initialize the video_adapter_t structure */

--- 5 unchanged lines hidden (view full) ---

141 adp->va_type = type;
142 adp->va_unit = unit;
143}
144
145/* Register a video adapter */
146int
147vid_register(video_adapter_t *adp)
148{
123 video_driver_t **list;
124 video_driver_t *p;
149 const video_driver_t **list;
150 const video_driver_t *p;
125 int index;
126
127 for (index = 0; index < adapters; ++index) {
128 if (adapter[index] == NULL)
129 break;
130 }
151 int index;
152
153 for (index = 0; index < adapters; ++index) {
154 if (adapter[index] == NULL)
155 break;
156 }
131 if (index >= adapters)
132 return -1;
157 if (index >= adapters) {
158 if (vid_realloc_array())
159 return -1;
160 }
133
134 adp->va_index = index;
135 adp->va_token = NULL;
161
162 adp->va_index = index;
163 adp->va_token = NULL;
136 list = (video_driver_t **)videodriver_set.ls_items;
164 list = (const video_driver_t **)videodriver_set.ls_items;
137 while ((p = *list++) != NULL) {
138 if (strcmp(p->name, adp->va_name) == 0) {
139 adapter[index] = adp;
140 vidsw[index] = p->vidsw;
141 return index;
142 }
143 }
144

--- 12 unchanged lines hidden (view full) ---

157 vidsw[adp->va_index] = NULL;
158 return 0;
159}
160
161/* Get video I/O function table */
162video_switch_t
163*vid_get_switch(char *name)
164{
165 while ((p = *list++) != NULL) {
166 if (strcmp(p->name, adp->va_name) == 0) {
167 adapter[index] = adp;
168 vidsw[index] = p->vidsw;
169 return index;
170 }
171 }
172

--- 12 unchanged lines hidden (view full) ---

185 vidsw[adp->va_index] = NULL;
186 return 0;
187}
188
189/* Get video I/O function table */
190video_switch_t
191*vid_get_switch(char *name)
192{
165 video_driver_t **list;
166 video_driver_t *p;
193 const video_driver_t **list;
194 const video_driver_t *p;
167
195
168 list = (video_driver_t **)videodriver_set.ls_items;
196 list = (const video_driver_t **)videodriver_set.ls_items;
169 while ((p = *list++) != NULL) {
170 if (strcmp(p->name, name) == 0)
171 return p->vidsw;
172 }
173
174 return NULL;
175}
176

--- 69 unchanged lines hidden (view full) ---

246 return NULL;
247 return adapter[index];
248}
249
250/* Configure drivers: this is a backdoor for the console driver XXX */
251int
252vid_configure(int flags)
253{
197 while ((p = *list++) != NULL) {
198 if (strcmp(p->name, name) == 0)
199 return p->vidsw;
200 }
201
202 return NULL;
203}
204

--- 69 unchanged lines hidden (view full) ---

274 return NULL;
275 return adapter[index];
276}
277
278/* Configure drivers: this is a backdoor for the console driver XXX */
279int
280vid_configure(int flags)
281{
254 video_driver_t **list;
255 video_driver_t *p;
282 const video_driver_t **list;
283 const video_driver_t *p;
256
284
257 list = (video_driver_t **)videodriver_set.ls_items;
285 list = (const video_driver_t **)videodriver_set.ls_items;
258 while ((p = *list++) != NULL) {
259 if (p->configure != NULL)
260 (*p->configure)(flags);
261 }
262
263 return 0;
264}
265
266/*
267 * Virtual frame buffer cdev driver functions
268 * The virtual frame buffer driver dispatches driver functions to
269 * appropriate subdrivers.
270 */
271
286 while ((p = *list++) != NULL) {
287 if (p->configure != NULL)
288 (*p->configure)(flags);
289 }
290
291 return 0;
292}
293
294/*
295 * Virtual frame buffer cdev driver functions
296 * The virtual frame buffer driver dispatches driver functions to
297 * appropriate subdrivers.
298 */
299
272#define DRIVER_NAME "fb"
300#define FB_DRIVER_NAME "fb"
273
274#ifdef FB_INSTALL_CDEV
275
301
302#ifdef FB_INSTALL_CDEV
303
304#if experimental
305
306static devclass_t fb_devclass;
307
308static int fbprobe(device_t dev);
309static int fbattach(device_t dev);
310
311static device_method_t fb_methods[] = {
312 DEVMETHOD(device_probe, fbprobe),
313 DEVMETHOD(device_attach, fbattach),
314
315 DEVMETHOD(bus_print_child, bus_generic_print_child),
316 { 0, 0 }
317};
318
319static driver_t fb_driver = {
320 FB_DRIVER_NAME,
321 fb_methods,
322 0,
323};
324
325static int
326fbprobe(device_t dev)
327{
328 int unit;
329
330 unit = device_get_unit(dev);
331 if (unit >= adapters)
332 return ENXIO;
333 if (adapter[unit] == NULL)
334 return ENXIO;
335
336 device_set_desc(dev, "generic frame buffer");
337 return 0;
338}
339
340static int
341fbattach(device_t dev)
342{
343 printf("fbattach: about to attach children\n");
344 bus_generic_attach(dev);
345 return 0;
346}
347
348#endif /* experimental */
349
276#define FB_UNIT(dev) minor(dev)
277#define FB_MKMINOR(unit) (u)
278
350#define FB_UNIT(dev) minor(dev)
351#define FB_MKMINOR(unit) (u)
352
279#if notyet
280
281static d_open_t fbopen;
282static d_close_t fbclose;
353static d_open_t fbopen;
354static d_close_t fbclose;
355static d_read_t fbread;
356static d_write_t fbwrite;
283static d_ioctl_t fbioctl;
284static d_mmap_t fbmmap;
285
357static d_ioctl_t fbioctl;
358static d_mmap_t fbmmap;
359
286#define CDEV_MAJOR 141 /* XXX */
360#define CDEV_MAJOR 123 /* XXX */
287
288static struct cdevsw fb_cdevsw = {
289 /* open */ fbopen,
290 /* close */ fbclose,
361
362static struct cdevsw fb_cdevsw = {
363 /* open */ fbopen,
364 /* close */ fbclose,
291 /* read */ noread,
292 /* write */ nowrite,
365 /* read */ fbread,
366 /* write */ fbwrite,
293 /* ioctl */ fbioctl,
294 /* stop */ nostop,
295 /* reset */ noreset,
296 /* devtotty */ nodevtotty,
297 /* poll */ nopoll,
298 /* mmap */ fbmmap,
299 /* strategy */ nostrategy,
367 /* ioctl */ fbioctl,
368 /* stop */ nostop,
369 /* reset */ noreset,
370 /* devtotty */ nodevtotty,
371 /* poll */ nopoll,
372 /* mmap */ fbmmap,
373 /* strategy */ nostrategy,
300 /* name */ DRIVER_NAME,
374 /* name */ FB_DRIVER_NAME,
301 /* parms */ noparms,
302 /* maj */ CDEV_MAJOR,
303 /* dump */ nodump,
304 /* psize */ nopsize,
305 /* flags */ 0,
306 /* maxio */ 0,
307 /* bmaj */ -1
308};

--- 6 unchanged lines hidden (view full) ---

315 if (!fb_devsw_installed) {
316 cdevsw_add(&fb_cdevsw);
317 fb_devsw_installed = TRUE;
318 }
319}
320
321PSEUDO_SET(vfbattach, fb);
322
375 /* parms */ noparms,
376 /* maj */ CDEV_MAJOR,
377 /* dump */ nodump,
378 /* psize */ nopsize,
379 /* flags */ 0,
380 /* maxio */ 0,
381 /* bmaj */ -1
382};

--- 6 unchanged lines hidden (view full) ---

389 if (!fb_devsw_installed) {
390 cdevsw_add(&fb_cdevsw);
391 fb_devsw_installed = TRUE;
392 }
393}
394
395PSEUDO_SET(vfbattach, fb);
396
323#endif /* notyet */
324
325int
397int
326fb_attach(dev_t dev, video_adapter *adp, struct cdevsw *cdevsw)
398fb_attach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
327{
328 int s;
329
330 if (adp->va_index >= adapters)
331 return EINVAL;
332 if (adapter[adp->va_index] != adp)
333 return EINVAL;
334
335 s = spltty();
336 adp->va_minor = minor(dev);
337 vidcdevsw[adp->va_index] = cdevsw;
338 splx(s);
339
340 /* XXX: DEVFS? */
341
399{
400 int s;
401
402 if (adp->va_index >= adapters)
403 return EINVAL;
404 if (adapter[adp->va_index] != adp)
405 return EINVAL;
406
407 s = spltty();
408 adp->va_minor = minor(dev);
409 vidcdevsw[adp->va_index] = cdevsw;
410 splx(s);
411
412 /* XXX: DEVFS? */
413
342 if (adp->va_index + 1 >= adapters)
343 vid_realloc_array();
344
345 printf("fb%d at %s%d\n", adp->va_index, adp->va_name, adp->va_unit);
346 return 0;
347}
348
349int
414 printf("fb%d at %s%d\n", adp->va_index, adp->va_name, adp->va_unit);
415 return 0;
416}
417
418int
350fb_detach(dev_t dev, video_adapter *adp, struct cdevsw *cdevsw)
419fb_detach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
351{
352 int s;
353
354 if (adp->va_index >= adapters)
355 return EINVAL;
356 if (adapter[adp->va_index] != adp)
357 return EINVAL;
358 if (vidcdevsw[adp->va_index] != cdevsw)
359 return EINVAL;
360
361 s = spltty();
362 vidcdevsw[adp->va_index] = NULL;
363 splx(s);
364 return 0;
365}
366
420{
421 int s;
422
423 if (adp->va_index >= adapters)
424 return EINVAL;
425 if (adapter[adp->va_index] != adp)
426 return EINVAL;
427 if (vidcdevsw[adp->va_index] != cdevsw)
428 return EINVAL;
429
430 s = spltty();
431 vidcdevsw[adp->va_index] = NULL;
432 splx(s);
433 return 0;
434}
435
436static int
437fbopen(dev_t dev, int flag, int mode, struct proc *p)
438{
439 int unit;
440
441 unit = FB_UNIT(dev);
442 if (unit >= adapters)
443 return ENXIO;
444 if (vidcdevsw[unit] == NULL)
445 return ENXIO;
446 return (*vidcdevsw[unit]->d_open)(makedev(0, adapter[unit]->va_minor),
447 flag, mode, p);
448}
449
450static int
451fbclose(dev_t dev, int flag, int mode, struct proc *p)
452{
453 int unit;
454
455 unit = FB_UNIT(dev);
456 if (vidcdevsw[unit] == NULL)
457 return ENXIO;
458 return (*vidcdevsw[unit]->d_close)(makedev(0, adapter[unit]->va_minor),
459 flag, mode, p);
460}
461
462static int
463fbread(dev_t dev, struct uio *uio, int flag)
464{
465 int unit;
466
467 unit = FB_UNIT(dev);
468 if (vidcdevsw[unit] == NULL)
469 return ENXIO;
470 return (*vidcdevsw[unit]->d_read)(makedev(0, adapter[unit]->va_minor),
471 uio, flag);
472}
473
474static int
475fbwrite(dev_t dev, struct uio *uio, int flag)
476{
477 int unit;
478
479 unit = FB_UNIT(dev);
480 if (vidcdevsw[unit] == NULL)
481 return ENXIO;
482 return (*vidcdevsw[unit]->d_write)(makedev(0, adapter[unit]->va_minor),
483 uio, flag);
484}
485
486static int
487fbioctl(dev_t dev, u_long cmd, caddr_t arg, int flag, struct proc *p)
488{
489 int unit;
490
491 unit = FB_UNIT(dev);
492 if (vidcdevsw[unit] == NULL)
493 return ENXIO;
494 return (*vidcdevsw[unit]->d_ioctl)(makedev(0, adapter[unit]->va_minor),
495 cmd, arg, flag, p);
496}
497
498static int
499fbmmap(dev_t dev, vm_offset_t offset, int nprot)
500{
501 int unit;
502
503 unit = FB_UNIT(dev);
504 if (vidcdevsw[unit] == NULL)
505 return ENXIO;
506 return (*vidcdevsw[unit]->d_mmap)(makedev(0, adapter[unit]->va_minor),
507 offset, nprot);
508}
509
510#if experimental
511DEV_DRIVER_MODULE(fb, ???, fb_driver, fb_devclass,
512 CDEV_MAJOR, NOMAJ, fb_cdevsw, 0, 0);
513#endif
514
515/*
516 * Generic frame buffer cdev driver functions
517 * Frame buffer subdrivers may call these functions to implement common
518 * driver functions.
519 */
520
521int genfbopen(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
522 struct proc *p)
523{
524 int s;
525
526 s = spltty();
527 if (!(sc->gfb_flags & FB_OPEN))
528 sc->gfb_flags |= FB_OPEN;
529 splx(s);
530 return 0;
531}
532
533int genfbclose(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
534 struct proc *p)
535{
536 int s;
537
538 s = spltty();
539 sc->gfb_flags &= ~FB_OPEN;
540 splx(s);
541 return 0;
542}
543
544int genfbread(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
545 int flag)
546{
547 int size;
548 int offset;
549 int error;
550 int len;
551
552 error = 0;
553 size = adp->va_buffer_size/adp->va_info.vi_planes;
554 while (uio->uio_resid > 0) {
555 if (uio->uio_offset >= size)
556 break;
557 offset = uio->uio_offset%adp->va_window_size;
558 len = imin(uio->uio_resid, size - uio->uio_offset);
559 len = imin(len, adp->va_window_size - offset);
560 if (len <= 0)
561 break;
562 (*vidsw[adp->va_index]->set_win_org)(adp, uio->uio_offset);
563 error = uiomove((caddr_t)(adp->va_window + offset), len, uio);
564 if (error)
565 break;
566 }
567 return error;
568}
569
570int genfbwrite(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
571 int flag)
572{
573 return ENODEV;
574}
575
576int genfbioctl(genfb_softc_t *sc, video_adapter_t *adp, u_long cmd,
577 caddr_t arg, int flag, struct proc *p)
578{
579 int error;
580
581 if (adp == NULL) /* XXX */
582 return ENXIO;
583 error = (*vidsw[adp->va_index]->ioctl)(adp, cmd, arg);
584 if (error == ENOIOCTL)
585 error = ENODEV;
586 return error;
587}
588
589int genfbmmap(genfb_softc_t *sc, video_adapter_t *adp, vm_offset_t offset,
590 int prot)
591{
592 return (*vidsw[adp->va_index]->mmap)(adp, offset, prot);
593}
594
367#endif /* FB_INSTALL_CDEV */
368
369static char
370*adapter_name(int type)
371{
372 static struct {
373 int type;
374 char *name;
375 } names[] = {
376 { KD_MONO, "MDA" },
377 { KD_HERCULES, "Hercules" },
378 { KD_CGA, "CGA" },
379 { KD_EGA, "EGA" },
380 { KD_VGA, "VGA" },
381 { KD_PC98, "PC-98x1" },
595#endif /* FB_INSTALL_CDEV */
596
597static char
598*adapter_name(int type)
599{
600 static struct {
601 int type;
602 char *name;
603 } names[] = {
604 { KD_MONO, "MDA" },
605 { KD_HERCULES, "Hercules" },
606 { KD_CGA, "CGA" },
607 { KD_EGA, "EGA" },
608 { KD_VGA, "VGA" },
609 { KD_PC98, "PC-98x1" },
610 { KD_TGA, "TGA" },
382 { -1, "Unknown" },
383 };
384 int i;
385
386 for (i = 0; names[i].type != -1; ++i)
387 if (names[i].type == type)
388 break;
389 return names[i].name;
390}
391
611 { -1, "Unknown" },
612 };
613 int i;
614
615 for (i = 0; names[i].type != -1; ++i)
616 if (names[i].type == type)
617 break;
618 return names[i].name;
619}
620
621/*
622 * Generic low-level frame buffer functions
623 * The low-level functions in the frame buffer subdriver may use these
624 * functions.
625 */
626
392void
393fb_dump_adp_info(char *driver, video_adapter_t *adp, int level)
394{
395 if (level <= 0)
396 return;
397
398 printf("%s%d: %s%d, %s, type:%s (%d), flags:0x%x\n",
627void
628fb_dump_adp_info(char *driver, video_adapter_t *adp, int level)
629{
630 if (level <= 0)
631 return;
632
633 printf("%s%d: %s%d, %s, type:%s (%d), flags:0x%x\n",
399 DRIVER_NAME, adp->va_index, driver, adp->va_unit, adp->va_name,
634 FB_DRIVER_NAME, adp->va_index, driver, adp->va_unit, adp->va_name,
400 adapter_name(adp->va_type), adp->va_type, adp->va_flags);
401 printf("%s%d: port:0x%x-0x%x, crtc:0x%x, mem:0x%x 0x%x\n",
635 adapter_name(adp->va_type), adp->va_type, adp->va_flags);
636 printf("%s%d: port:0x%x-0x%x, crtc:0x%x, mem:0x%x 0x%x\n",
402 DRIVER_NAME, adp->va_index,
637 FB_DRIVER_NAME, adp->va_index,
403 adp->va_io_base, adp->va_io_base + adp->va_io_size - 1,
404 adp->va_crtc_addr, adp->va_mem_base, adp->va_mem_size);
405 printf("%s%d: init mode:%d, bios mode:%d, current mode:%d\n",
638 adp->va_io_base, adp->va_io_base + adp->va_io_size - 1,
639 adp->va_crtc_addr, adp->va_mem_base, adp->va_mem_size);
640 printf("%s%d: init mode:%d, bios mode:%d, current mode:%d\n",
406 DRIVER_NAME, adp->va_index,
641 FB_DRIVER_NAME, adp->va_index,
407 adp->va_initial_mode, adp->va_initial_bios_mode, adp->va_mode);
642 adp->va_initial_mode, adp->va_initial_bios_mode, adp->va_mode);
408 printf("%s%d: window:0x%x size:%dk gran:%dk, buf:0x%x size:%dk\n",
409 DRIVER_NAME, adp->va_index,
410 adp->va_window, (int)adp->va_window_size/1024,
411 (int)adp->va_window_gran/1024, adp->va_buffer,
643 printf("%s%d: window:%p size:%dk gran:%dk, buf:%p size:%dk\n",
644 FB_DRIVER_NAME, adp->va_index,
645 (void *)adp->va_window, (int)adp->va_window_size/1024,
646 (int)adp->va_window_gran/1024, (void *)adp->va_buffer,
412 (int)adp->va_buffer_size/1024);
413}
414
415void
416fb_dump_mode_info(char *driver, video_adapter_t *adp, video_info_t *info,
417 int level)
418{
419 if (level <= 0)

--- 7 unchanged lines hidden (view full) ---

427 info->vi_depth, info->vi_planes,
428 info->vi_cwidth, info->vi_cheight);
429 else
430 printf("T %dx%d, font:%dx%d, ",
431 info->vi_width, info->vi_height,
432 info->vi_cwidth, info->vi_cheight);
433 printf("win:0x%x\n", info->vi_window);
434}
647 (int)adp->va_buffer_size/1024);
648}
649
650void
651fb_dump_mode_info(char *driver, video_adapter_t *adp, video_info_t *info,
652 int level)
653{
654 if (level <= 0)

--- 7 unchanged lines hidden (view full) ---

662 info->vi_depth, info->vi_planes,
663 info->vi_cwidth, info->vi_cheight);
664 else
665 printf("T %dx%d, font:%dx%d, ",
666 info->vi_width, info->vi_height,
667 info->vi_cwidth, info->vi_cheight);
668 printf("win:0x%x\n", info->vi_window);
669}
670
671int
672fb_type(int adp_type)
673{
674 static struct {
675 int fb_type;
676 int va_type;
677 } types[] = {
678 { FBTYPE_MDA, KD_MONO },
679 { FBTYPE_HERCULES, KD_HERCULES },
680 { FBTYPE_CGA, KD_CGA },
681 { FBTYPE_EGA, KD_EGA },
682 { FBTYPE_VGA, KD_VGA },
683 { FBTYPE_PC98, KD_PC98 },
684 { FBTYPE_TGA, KD_TGA },
685 };
686 int i;
687
688 for (i = 0; i < sizeof(types)/sizeof(types[0]); ++i) {
689 if (types[i].va_type == adp_type)
690 return types[i].fb_type;
691 }
692 return -1;
693}
694
695int
696fb_commonioctl(video_adapter_t *adp, u_long cmd, caddr_t arg)
697{
698 int error;
699 int s;
700
701 /* assert(adp != NULL) */
702
703 error = 0;
704 s = spltty();
705
706 switch (cmd) {
707
708 case FBIO_ADAPTER: /* get video adapter index */
709 *(int *)arg = adp->va_index;
710 break;
711
712 case FBIO_ADPTYPE: /* get video adapter type */
713 *(int *)arg = adp->va_type;
714 break;
715
716 case FBIO_ADPINFO: /* get video adapter info */
717 ((video_adapter_info_t *)arg)->va_index = adp->va_index;
718 ((video_adapter_info_t *)arg)->va_type = adp->va_type;
719 bcopy(adp->va_name, ((video_adapter_info_t *)arg)->va_name,
720 imin(strlen(adp->va_name) + 1,
721 sizeof(((video_adapter_info_t *)arg)->va_name)));
722 ((video_adapter_info_t *)arg)->va_unit = adp->va_unit;
723 ((video_adapter_info_t *)arg)->va_flags = adp->va_flags;
724 ((video_adapter_info_t *)arg)->va_io_base = adp->va_io_base;
725 ((video_adapter_info_t *)arg)->va_io_size = adp->va_io_size;
726 ((video_adapter_info_t *)arg)->va_crtc_addr = adp->va_crtc_addr;
727 ((video_adapter_info_t *)arg)->va_mem_base = adp->va_mem_base;
728 ((video_adapter_info_t *)arg)->va_mem_size = adp->va_mem_size;
729 ((video_adapter_info_t *)arg)->va_window
730 = vtophys(adp->va_window);
731 ((video_adapter_info_t *)arg)->va_window_size
732 = adp->va_window_size;
733 ((video_adapter_info_t *)arg)->va_window_gran
734 = adp->va_window_gran;
735 ((video_adapter_info_t *)arg)->va_window_orig
736 = adp->va_window_orig;
737 ((video_adapter_info_t *)arg)->va_unused0
738 = (adp->va_buffer) ? vtophys(adp->va_buffer) : 0;
739 ((video_adapter_info_t *)arg)->va_buffer_size
740 = adp->va_buffer_size;
741 ((video_adapter_info_t *)arg)->va_mode = adp->va_mode;
742 ((video_adapter_info_t *)arg)->va_initial_mode
743 = adp->va_initial_mode;
744 ((video_adapter_info_t *)arg)->va_initial_bios_mode
745 = adp->va_initial_bios_mode;
746 ((video_adapter_info_t *)arg)->va_line_width
747 = adp->va_line_width;
748 ((video_adapter_info_t *)arg)->va_disp_start.x
749 = adp->va_disp_start.x;
750 ((video_adapter_info_t *)arg)->va_disp_start.y
751 = adp->va_disp_start.y;
752 break;
753
754 case FBIO_MODEINFO: /* get mode information */
755 error = (*vidsw[adp->va_index]->get_info)(adp,
756 ((video_info_t *)arg)->vi_mode,
757 (video_info_t *)arg);
758 if (error)
759 error = ENODEV;
760 break;
761
762 case FBIO_FINDMODE: /* find a matching video mode */
763 error = (*vidsw[adp->va_index]->query_mode)(adp,
764 (video_info_t *)arg);
765 if (error < 0) {
766 error = EINVAL;
767 } else {
768 error = (*vidsw[adp->va_index]->get_info)(adp,
769 error, (video_info_t *)arg);
770 if (error)
771 error = ENODEV; /* shouldn't happen */
772 }
773 break;
774
775 case FBIO_GETMODE: /* get video mode */
776 *(int *)arg = adp->va_mode;
777 break;
778
779 case FBIO_SETMODE: /* set video mode */
780 error = (*vidsw[adp->va_index]->set_mode)(adp, *(int *)arg);
781 if (error)
782 error = ENODEV; /* EINVAL? */
783 break;
784
785 case FBIO_GETWINORG: /* get frame buffer window origin */
786 *(u_int *)arg = adp->va_window_orig;
787 break;
788
789 case FBIO_GETDISPSTART: /* get display start address */
790 ((video_display_start_t *)arg)->x = adp->va_disp_start.x;
791 ((video_display_start_t *)arg)->y = adp->va_disp_start.y;
792 break;
793
794 case FBIO_GETLINEWIDTH: /* get scan line width in bytes */
795 *(u_int *)arg = adp->va_line_width;
796 break;
797
798 case FBIO_GETPALETTE: /* get color palette */
799 case FBIO_SETPALETTE: /* set color palette */
800 /* XXX */
801
802 case FBIOPUTCMAP:
803 case FBIOGETCMAP:
804 /* XXX */
805
806 case FBIO_SETWINORG: /* set frame buffer window origin */
807 case FBIO_SETDISPSTART: /* set display start address */
808 case FBIO_SETLINEWIDTH: /* set scan line width in pixel */
809
810 case FBIOGTYPE:
811 case FBIOGATTR:
812 case FBIOSVIDEO:
813 case FBIOGVIDEO:
814 case FBIOSCURSOR:
815 case FBIOGCURSOR:
816 case FBIOSCURPOS:
817 case FBIOGCURPOS:
818 case FBIOGCURMAX:
819
820 default:
821 error = ENODEV;
822 break;
823 }
824
825 splx(s);
826 return error;
827}