FreeBSD/Linux Kernel Cross Reference
sys/i386/i386/bios.c
1 /*-
2 * Copyright (c) 1997 Michael Smith
3 * Copyright (c) 1998 Jonathan Lemon
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25 * SUCH DAMAGE.
26 */
27
28 #include <sys/cdefs.h>
29 __FBSDID("$FreeBSD: releng/11.2/sys/i386/i386/bios.c 331722 2018-03-29 02:50:57Z eadler $");
30
31 /*
32 * Code for dealing with the BIOS in x86 PC systems.
33 */
34
35 #include "opt_isa.h"
36
37 #include <sys/param.h>
38 #include <sys/systm.h>
39 #include <sys/kernel.h>
40 #include <sys/malloc.h>
41 #include <sys/module.h>
42 #include <sys/bus.h>
43 #include <sys/pcpu.h>
44 #include <vm/vm.h>
45 #include <vm/pmap.h>
46 #include <machine/md_var.h>
47 #include <machine/segments.h>
48 #include <machine/stdarg.h>
49 #include <machine/vmparam.h>
50 #include <machine/pc/bios.h>
51 #ifdef DEV_ISA
52 #include <isa/isavar.h>
53 #include <isa/pnpreg.h>
54 #include <isa/pnpvar.h>
55 #endif
56
57 #define BIOS_START 0xe0000
58 #define BIOS_SIZE 0x20000
59
60 /* exported lookup results */
61 struct bios32_SDentry PCIbios;
62
63 static struct PnPBIOS_table *PnPBIOStable;
64
65 static u_int bios32_SDCI;
66
67 /* start fairly early */
68 static void bios32_init(void *junk);
69 SYSINIT(bios32, SI_SUB_CPU, SI_ORDER_ANY, bios32_init, NULL);
70
71 /*
72 * bios32_init
73 *
74 * Locate various bios32 entities.
75 */
76 static void
77 bios32_init(void *junk)
78 {
79 u_long sigaddr;
80 struct bios32_SDheader *sdh;
81 struct PnPBIOS_table *pt;
82 u_int8_t ck, *cv;
83 int i;
84 char *p;
85
86 /*
87 * BIOS32 Service Directory, PCI BIOS
88 */
89
90 /* look for the signature */
91 if ((sigaddr = bios_sigsearch(0, "_32_", 4, 16, 0)) != 0) {
92
93 /* get a virtual pointer to the structure */
94 sdh = (struct bios32_SDheader *)(uintptr_t)BIOS_PADDRTOVADDR(sigaddr);
95 for (cv = (u_int8_t *)sdh, ck = 0, i = 0; i < (sdh->len * 16); i++) {
96 ck += cv[i];
97 }
98 /* If checksum is OK, enable use of the entrypoint */
99 if ((ck == 0) && (BIOS_START <= sdh->entry ) &&
100 (sdh->entry < (BIOS_START + BIOS_SIZE))) {
101 bios32_SDCI = BIOS_PADDRTOVADDR(sdh->entry);
102 if (bootverbose) {
103 printf("bios32: Found BIOS32 Service Directory header at %p\n", sdh);
104 printf("bios32: Entry = 0x%x (%x) Rev = %d Len = %d\n",
105 sdh->entry, bios32_SDCI, sdh->revision, sdh->len);
106 }
107
108 /* Allow user override of PCI BIOS search */
109 if (((p = kern_getenv("machdep.bios.pci")) == NULL) || strcmp(p, "disable")) {
110
111 /* See if there's a PCI BIOS entrypoint here */
112 PCIbios.ident.id = 0x49435024; /* PCI systems should have this */
113 if (!bios32_SDlookup(&PCIbios) && bootverbose)
114 printf("pcibios: PCI BIOS entry at 0x%x+0x%x\n", PCIbios.base, PCIbios.entry);
115 }
116 if (p != NULL)
117 freeenv(p);
118 } else {
119 printf("bios32: Bad BIOS32 Service Directory\n");
120 }
121 }
122
123 /*
124 * PnP BIOS
125 *
126 * Allow user override of PnP BIOS search
127 */
128 if ((((p = kern_getenv("machdep.bios.pnp")) == NULL) || strcmp(p, "disable")) &&
129 ((sigaddr = bios_sigsearch(0, "$PnP", 4, 16, 0)) != 0)) {
130
131 /* get a virtual pointer to the structure */
132 pt = (struct PnPBIOS_table *)(uintptr_t)BIOS_PADDRTOVADDR(sigaddr);
133 for (cv = (u_int8_t *)pt, ck = 0, i = 0; i < pt->len; i++) {
134 ck += cv[i];
135 }
136 /* If checksum is OK, enable use of the entrypoint */
137 if (ck == 0) {
138 PnPBIOStable = pt;
139 if (bootverbose) {
140 printf("pnpbios: Found PnP BIOS data at %p\n", pt);
141 printf("pnpbios: Entry = %x:%x Rev = %d.%d\n",
142 pt->pmentrybase, pt->pmentryoffset, pt->version >> 4, pt->version & 0xf);
143 if ((pt->control & 0x3) == 0x01)
144 printf("pnpbios: Event flag at %x\n", pt->evflagaddr);
145 if (pt->oemdevid != 0)
146 printf("pnpbios: OEM ID %x\n", pt->oemdevid);
147
148 }
149 } else {
150 printf("pnpbios: Bad PnP BIOS data checksum\n");
151 }
152 }
153 if (p != NULL)
154 freeenv(p);
155 if (bootverbose) {
156 /* look for other know signatures */
157 printf("Other BIOS signatures found:\n");
158 }
159 }
160
161 /*
162 * bios32_SDlookup
163 *
164 * Query the BIOS32 Service Directory for the service named in (ent),
165 * returns nonzero if the lookup fails. The caller must fill in
166 * (ent->ident), the remainder are populated on a successful lookup.
167 */
168 int
169 bios32_SDlookup(struct bios32_SDentry *ent)
170 {
171 struct bios_regs args;
172
173 if (bios32_SDCI == 0)
174 return (1);
175
176 args.eax = ent->ident.id; /* set up arguments */
177 args.ebx = args.ecx = args.edx = 0;
178 bios32(&args, bios32_SDCI, GSEL(GCODE_SEL, SEL_KPL));
179 if ((args.eax & 0xff) == 0) { /* success? */
180 ent->base = args.ebx;
181 ent->len = args.ecx;
182 ent->entry = args.edx;
183 ent->ventry = BIOS_PADDRTOVADDR(ent->base + ent->entry);
184 return (0); /* all OK */
185 }
186 return (1); /* failed */
187 }
188
189
190 /*
191 * bios_sigsearch
192 *
193 * Search some or all of the BIOS region for a signature string.
194 *
195 * (start) Optional offset returned from this function
196 * (for searching for multiple matches), or NULL
197 * to start the search from the base of the BIOS.
198 * Note that this will be a _physical_ address in
199 * the range 0xe0000 - 0xfffff.
200 * (sig) is a pointer to the byte(s) of the signature.
201 * (siglen) number of bytes in the signature.
202 * (paralen) signature paragraph (alignment) size.
203 * (sigofs) offset of the signature within the paragraph.
204 *
205 * Returns the _physical_ address of the found signature, 0 if the
206 * signature was not found.
207 */
208
209 u_int32_t
210 bios_sigsearch(u_int32_t start, u_char *sig, int siglen, int paralen, int sigofs)
211 {
212 u_char *sp, *end;
213
214 /* compute the starting address */
215 if ((start >= BIOS_START) && (start <= (BIOS_START + BIOS_SIZE))) {
216 sp = (char *)BIOS_PADDRTOVADDR(start);
217 } else if (start == 0) {
218 sp = (char *)BIOS_PADDRTOVADDR(BIOS_START);
219 } else {
220 return 0; /* bogus start address */
221 }
222
223 /* compute the end address */
224 end = (u_char *)BIOS_PADDRTOVADDR(BIOS_START + BIOS_SIZE);
225
226 /* loop searching */
227 while ((sp + sigofs + siglen) < end) {
228
229 /* compare here */
230 if (!bcmp(sp + sigofs, sig, siglen)) {
231 /* convert back to physical address */
232 return((u_int32_t)BIOS_VADDRTOPADDR(sp));
233 }
234 sp += paralen;
235 }
236 return(0);
237 }
238
239 /*
240 * do not staticize, used by bioscall.s
241 */
242 union {
243 struct {
244 u_short offset;
245 u_short segment;
246 } vec16;
247 struct {
248 u_int offset;
249 u_short segment;
250 } vec32;
251 } bioscall_vector; /* bios jump vector */
252
253 void
254 set_bios_selectors(struct bios_segments *seg, int flags)
255 {
256 struct soft_segment_descriptor ssd = {
257 0, /* segment base address (overwritten) */
258 0, /* length (overwritten) */
259 SDT_MEMERA, /* segment type (overwritten) */
260 0, /* priority level */
261 1, /* descriptor present */
262 0, 0,
263 1, /* descriptor size (overwritten) */
264 0 /* granularity == byte units */
265 };
266 union descriptor *p_gdt;
267
268 #ifdef SMP
269 p_gdt = &gdt[PCPU_GET(cpuid) * NGDT];
270 #else
271 p_gdt = gdt;
272 #endif
273
274 ssd.ssd_base = seg->code32.base;
275 ssd.ssd_limit = seg->code32.limit;
276 ssdtosd(&ssd, &p_gdt[GBIOSCODE32_SEL].sd);
277
278 ssd.ssd_def32 = 0;
279 if (flags & BIOSCODE_FLAG) {
280 ssd.ssd_base = seg->code16.base;
281 ssd.ssd_limit = seg->code16.limit;
282 ssdtosd(&ssd, &p_gdt[GBIOSCODE16_SEL].sd);
283 }
284
285 ssd.ssd_type = SDT_MEMRWA;
286 if (flags & BIOSDATA_FLAG) {
287 ssd.ssd_base = seg->data.base;
288 ssd.ssd_limit = seg->data.limit;
289 ssdtosd(&ssd, &p_gdt[GBIOSDATA_SEL].sd);
290 }
291
292 if (flags & BIOSUTIL_FLAG) {
293 ssd.ssd_base = seg->util.base;
294 ssd.ssd_limit = seg->util.limit;
295 ssdtosd(&ssd, &p_gdt[GBIOSUTIL_SEL].sd);
296 }
297
298 if (flags & BIOSARGS_FLAG) {
299 ssd.ssd_base = seg->args.base;
300 ssd.ssd_limit = seg->args.limit;
301 ssdtosd(&ssd, &p_gdt[GBIOSARGS_SEL].sd);
302 }
303 }
304
305 extern int vm86pa;
306 extern void bios16_jmp(void);
307
308 /*
309 * this routine is really greedy with selectors, and uses 5:
310 *
311 * 32-bit code selector: to return to kernel
312 * 16-bit code selector: for running code
313 * data selector: for 16-bit data
314 * util selector: extra utility selector
315 * args selector: to handle pointers
316 *
317 * the util selector is set from the util16 entry in bios16_args, if a
318 * "U" specifier is seen.
319 *
320 * See <machine/pc/bios.h> for description of format specifiers
321 */
322 int
323 bios16(struct bios_args *args, char *fmt, ...)
324 {
325 char *p, *stack, *stack_top;
326 va_list ap;
327 int flags = BIOSCODE_FLAG | BIOSDATA_FLAG;
328 u_int i, arg_start, arg_end;
329 pt_entry_t *pte;
330 pd_entry_t *ptd;
331
332 arg_start = 0xffffffff;
333 arg_end = 0;
334
335 /*
336 * Some BIOS entrypoints attempt to copy the largest-case
337 * argument frame (in order to generalise handling for
338 * different entry types). If our argument frame is
339 * smaller than this, the BIOS will reach off the top of
340 * our constructed stack segment. Pad the top of the stack
341 * with some garbage to avoid this.
342 */
343 stack = (caddr_t)PAGE_SIZE - 32;
344
345 va_start(ap, fmt);
346 for (p = fmt; p && *p; p++) {
347 switch (*p) {
348 case 'p': /* 32-bit pointer */
349 i = va_arg(ap, u_int);
350 arg_start = min(arg_start, i);
351 arg_end = max(arg_end, i);
352 flags |= BIOSARGS_FLAG;
353 stack -= 4;
354 break;
355
356 case 'i': /* 32-bit integer */
357 i = va_arg(ap, u_int);
358 stack -= 4;
359 break;
360
361 case 'U': /* 16-bit selector */
362 flags |= BIOSUTIL_FLAG;
363 /* FALLTHROUGH */
364 case 'D': /* 16-bit selector */
365 case 'C': /* 16-bit selector */
366 stack -= 2;
367 break;
368
369 case 's': /* 16-bit integer passed as an int */
370 i = va_arg(ap, int);
371 stack -= 2;
372 break;
373
374 default:
375 va_end(ap);
376 return (EINVAL);
377 }
378 }
379 va_end(ap);
380
381 if (flags & BIOSARGS_FLAG) {
382 if (arg_end - arg_start > ctob(16))
383 return (EACCES);
384 args->seg.args.base = arg_start;
385 args->seg.args.limit = 0xffff;
386 }
387
388 args->seg.code32.base = (u_int)&bios16_jmp & PG_FRAME;
389 args->seg.code32.limit = 0xffff;
390
391 ptd = (pd_entry_t *)rcr3();
392 #if defined(PAE) || defined(PAE_TABLES)
393 if (ptd == IdlePDPT)
394 #else
395 if (ptd == IdlePTD)
396 #endif
397 {
398 /*
399 * no page table, so create one and install it.
400 */
401 pte = (pt_entry_t *)malloc(PAGE_SIZE, M_TEMP, M_WAITOK);
402 ptd = (pd_entry_t *)((u_int)IdlePTD + KERNBASE);
403 *pte = (vm86pa - PAGE_SIZE) | PG_RW | PG_V;
404 *ptd = vtophys(pte) | PG_RW | PG_V;
405 } else {
406 /*
407 * this is a user-level page table
408 */
409 pte = PTmap;
410 *pte = (vm86pa - PAGE_SIZE) | PG_RW | PG_V;
411 }
412 pmap_invalidate_all(kernel_pmap); /* XXX insurance for now */
413
414 stack_top = stack;
415 va_start(ap, fmt);
416 for (p = fmt; p && *p; p++) {
417 switch (*p) {
418 case 'p': /* 32-bit pointer */
419 i = va_arg(ap, u_int);
420 *(u_int *)stack = (i - arg_start) |
421 (GSEL(GBIOSARGS_SEL, SEL_KPL) << 16);
422 stack += 4;
423 break;
424
425 case 'i': /* 32-bit integer */
426 i = va_arg(ap, u_int);
427 *(u_int *)stack = i;
428 stack += 4;
429 break;
430
431 case 'U': /* 16-bit selector */
432 *(u_short *)stack = GSEL(GBIOSUTIL_SEL, SEL_KPL);
433 stack += 2;
434 break;
435
436 case 'D': /* 16-bit selector */
437 *(u_short *)stack = GSEL(GBIOSDATA_SEL, SEL_KPL);
438 stack += 2;
439 break;
440
441 case 'C': /* 16-bit selector */
442 *(u_short *)stack = GSEL(GBIOSCODE16_SEL, SEL_KPL);
443 stack += 2;
444 break;
445
446 case 's': /* 16-bit integer passed as an int */
447 i = va_arg(ap, int);
448 *(u_short *)stack = i;
449 stack += 2;
450 break;
451
452 default:
453 va_end(ap);
454 return (EINVAL);
455 }
456 }
457 va_end(ap);
458
459 set_bios_selectors(&args->seg, flags);
460 bioscall_vector.vec16.offset = (u_short)args->entry;
461 bioscall_vector.vec16.segment = GSEL(GBIOSCODE16_SEL, SEL_KPL);
462
463 i = bios16_call(&args->r, stack_top);
464
465 if (pte == PTmap) {
466 *pte = 0; /* remove entry */
467 /*
468 * XXX only needs to be invlpg(0) but that doesn't work on the 386
469 */
470 pmap_invalidate_all(kernel_pmap);
471 } else {
472 *ptd = 0; /* remove page table */
473 /*
474 * XXX only needs to be invlpg(0) but that doesn't work on the 386
475 */
476 pmap_invalidate_all(kernel_pmap);
477 free(pte, M_TEMP); /* ... and free it */
478 }
479 return (i);
480 }
481
482 int
483 bios_oem_strings(struct bios_oem *oem, u_char *buffer, size_t maxlen)
484 {
485 size_t idx = 0;
486 struct bios_oem_signature *sig;
487 u_int from, to;
488 u_char c, *s, *se, *str, *bios_str;
489 size_t i, off, len, tot;
490
491 if ( !oem || !buffer || maxlen<2 )
492 return(-1);
493
494 sig = oem->signature;
495 if (!sig)
496 return(-2);
497
498 from = oem->range.from;
499 to = oem->range.to;
500 if ( (to<=from) || (from<BIOS_START) || (to>(BIOS_START+BIOS_SIZE)) )
501 return(-3);
502
503 while (sig->anchor != NULL) {
504 str = sig->anchor;
505 len = strlen(str);
506 off = sig->offset;
507 tot = sig->totlen;
508 /* make sure offset doesn't go beyond bios area */
509 if ( (to+off)>(BIOS_START+BIOS_SIZE) ||
510 ((from+off)<BIOS_START) ) {
511 printf("sys/i386/i386/bios.c: sig '%s' "
512 "from 0x%0x to 0x%0x offset %d "
513 "out of BIOS bounds 0x%0x - 0x%0x\n",
514 str, from, to, off,
515 BIOS_START, BIOS_START+BIOS_SIZE);
516 return(-4);
517 }
518 /* make sure we don't overrun return buffer */
519 if (idx + tot > maxlen - 1) {
520 printf("sys/i386/i386/bios.c: sig '%s' "
521 "idx %d + tot %d = %d > maxlen-1 %d\n",
522 str, idx, tot, idx+tot, maxlen-1);
523 return(-5);
524 }
525 bios_str = NULL;
526 s = (u_char *)BIOS_PADDRTOVADDR(from);
527 se = (u_char *)BIOS_PADDRTOVADDR(to-len);
528 for (; s<se; s++) {
529 if (!bcmp(str, s, len)) {
530 bios_str = s;
531 break;
532 }
533 }
534 /*
535 * store pretty version of totlen bytes of bios string with
536 * given offset; 0x20 - 0x7E are printable; uniquify spaces
537 */
538 if (bios_str) {
539 for (i=0; i<tot; i++) {
540 c = bios_str[i+off];
541 if ( (c < 0x20) || (c > 0x7E) )
542 c = ' ';
543 if (idx == 0) {
544 if (c != ' ')
545 buffer[idx++] = c;
546 } else if ( (c != ' ') ||
547 ((c == ' ') && (buffer[idx-1] != ' ')) )
548 buffer[idx++] = c;
549 }
550 }
551 sig++;
552 }
553 /* remove a final trailing space */
554 if ( (idx > 1) && (buffer[idx-1] == ' ') )
555 idx--;
556 buffer[idx] = '\0';
557 return (idx);
558 }
559
560 #ifdef DEV_ISA
561 /*
562 * PnP BIOS interface; enumerate devices only known to the system
563 * BIOS and save information about them for later use.
564 */
565
566 struct pnp_sysdev
567 {
568 u_int16_t size;
569 u_int8_t handle;
570 u_int32_t devid;
571 u_int8_t type[3];
572 u_int16_t attrib;
573 #define PNPATTR_NODISABLE (1<<0) /* can't be disabled */
574 #define PNPATTR_NOCONFIG (1<<1) /* can't be configured */
575 #define PNPATTR_OUTPUT (1<<2) /* can be primary output */
576 #define PNPATTR_INPUT (1<<3) /* can be primary input */
577 #define PNPATTR_BOOTABLE (1<<4) /* can be booted from */
578 #define PNPATTR_DOCK (1<<5) /* is a docking station */
579 #define PNPATTR_REMOVEABLE (1<<6) /* device is removeable */
580 #define PNPATTR_CONFIG_STATIC (0)
581 #define PNPATTR_CONFIG_DYNAMIC (1)
582 #define PNPATTR_CONFIG_DYNONLY (3)
583 #define PNPATTR_CONFIG(a) (((a) >> 7) & 0x3)
584 /* device-specific data comes here */
585 u_int8_t devdata[0];
586 } __packed;
587
588 /* We have to cluster arguments within a 64k range for the bios16 call */
589 struct pnp_sysdevargs
590 {
591 u_int16_t next;
592 struct pnp_sysdev node;
593 };
594
595 /*
596 * This function is called after the bus has assigned resource
597 * locations for a logical device.
598 */
599 static void
600 pnpbios_set_config(void *arg, struct isa_config *config, int enable)
601 {
602 }
603
604 /*
605 * Quiz the PnP BIOS, build a list of PNP IDs and resource data.
606 */
607 static void
608 pnpbios_identify(driver_t *driver, device_t parent)
609 {
610 struct PnPBIOS_table *pt = PnPBIOStable;
611 struct bios_args args;
612 struct pnp_sysdev *pd;
613 struct pnp_sysdevargs *pda;
614 u_int16_t ndevs, bigdev;
615 int error, currdev;
616 u_int8_t *devnodebuf, tag;
617 u_int32_t *devid, *compid;
618 int idx, left;
619 device_t dev;
620
621 /* no PnP BIOS information */
622 if (pt == NULL)
623 return;
624
625 /* Check to see if ACPI is already active. */
626 dev = devclass_get_device(devclass_find("acpi"), 0);
627 if (dev != NULL && device_is_attached(dev))
628 return;
629
630 /* get count of PnP devices */
631 bzero(&args, sizeof(args));
632 args.seg.code16.base = BIOS_PADDRTOVADDR(pt->pmentrybase);
633 args.seg.code16.limit = 0xffff; /* XXX ? */
634 args.seg.data.base = BIOS_PADDRTOVADDR(pt->pmdataseg);
635 args.seg.data.limit = 0xffff;
636 args.entry = pt->pmentryoffset;
637
638 if ((error = bios16(&args, PNP_COUNT_DEVNODES, &ndevs, &bigdev)) || (args.r.eax & 0xff)) {
639 printf("pnpbios: error %d/%x getting device count/size limit\n", error, args.r.eax);
640 return;
641 }
642 ndevs &= 0xff; /* clear high byte garbage */
643 if (bootverbose)
644 printf("pnpbios: %d devices, largest %d bytes\n", ndevs, bigdev);
645
646 devnodebuf = malloc(bigdev + (sizeof(struct pnp_sysdevargs) - sizeof(struct pnp_sysdev)),
647 M_DEVBUF, M_NOWAIT);
648 if (devnodebuf == NULL) {
649 printf("pnpbios: cannot allocate memory, bailing\n");
650 return;
651 }
652 pda = (struct pnp_sysdevargs *)devnodebuf;
653 pd = &pda->node;
654
655 for (currdev = 0, left = ndevs; (currdev != 0xff) && (left > 0); left--) {
656
657 bzero(pd, bigdev);
658 pda->next = currdev;
659 /* get current configuration */
660 if ((error = bios16(&args, PNP_GET_DEVNODE, &pda->next, &pda->node, 1))) {
661 printf("pnpbios: error %d making BIOS16 call\n", error);
662 break;
663 }
664 if ((error = (args.r.eax & 0xff))) {
665 if (bootverbose)
666 printf("pnpbios: %s 0x%x fetching node %d\n", error & 0x80 ? "error" : "warning", error, currdev);
667 if (error & 0x80)
668 break;
669 }
670 currdev = pda->next;
671 if (pd->size < sizeof(struct pnp_sysdev)) {
672 printf("pnpbios: bogus system node data, aborting scan\n");
673 break;
674 }
675
676 /*
677 * Ignore PICs so that we don't have to worry about the PICs
678 * claiming IRQs to prevent their use. The PIC drivers
679 * already ensure that invalid IRQs are not used.
680 */
681 if (!strcmp(pnp_eisaformat(pd->devid), "PNP0000")) /* ISA PIC */
682 continue;
683 if (!strcmp(pnp_eisaformat(pd->devid), "PNP0003")) /* APIC */
684 continue;
685
686 /* Add the device and parse its resources */
687 dev = BUS_ADD_CHILD(parent, ISA_ORDER_PNPBIOS, NULL, -1);
688 isa_set_vendorid(dev, pd->devid);
689 isa_set_logicalid(dev, pd->devid);
690 /*
691 * It appears that some PnP BIOS doesn't allow us to re-enable
692 * the embedded system device once it is disabled. We shall
693 * mark all system device nodes as "cannot be disabled", regardless
694 * of actual settings in the device attribute byte.
695 * XXX
696 isa_set_configattr(dev,
697 ((pd->attrib & PNPATTR_NODISABLE) ? 0 : ISACFGATTR_CANDISABLE) |
698 ((!(pd->attrib & PNPATTR_NOCONFIG) &&
699 PNPATTR_CONFIG(pd->attrib) != PNPATTR_CONFIG_STATIC)
700 ? ISACFGATTR_DYNAMIC : 0));
701 */
702 isa_set_configattr(dev,
703 (!(pd->attrib & PNPATTR_NOCONFIG) &&
704 PNPATTR_CONFIG(pd->attrib) != PNPATTR_CONFIG_STATIC)
705 ? ISACFGATTR_DYNAMIC : 0);
706 isa_set_pnpbios_handle(dev, pd->handle);
707 ISA_SET_CONFIG_CALLBACK(parent, dev, pnpbios_set_config, 0);
708 pnp_parse_resources(dev, &pd->devdata[0],
709 pd->size - sizeof(struct pnp_sysdev), 0);
710 if (!device_get_desc(dev))
711 device_set_desc_copy(dev, pnp_eisaformat(pd->devid));
712
713 /* Find device IDs */
714 devid = &pd->devid;
715 compid = NULL;
716
717 /* look for a compatible device ID too */
718 left = pd->size - sizeof(struct pnp_sysdev);
719 idx = 0;
720 while (idx < left) {
721 tag = pd->devdata[idx++];
722 if (PNP_RES_TYPE(tag) == 0) {
723 /* Small resource */
724 switch (PNP_SRES_NUM(tag)) {
725 case PNP_TAG_COMPAT_DEVICE:
726 compid = (u_int32_t *)(pd->devdata + idx);
727 if (bootverbose)
728 printf("pnpbios: node %d compat ID 0x%08x\n", pd->handle, *compid);
729 /* FALLTHROUGH */
730 case PNP_TAG_END:
731 idx = left;
732 break;
733 default:
734 idx += PNP_SRES_LEN(tag);
735 break;
736 }
737 } else
738 /* Large resource, skip it */
739 idx += *(u_int16_t *)(pd->devdata + idx) + 2;
740 }
741 if (bootverbose) {
742 printf("pnpbios: handle %d device ID %s (%08x)",
743 pd->handle, pnp_eisaformat(*devid), *devid);
744 if (compid != NULL)
745 printf(" compat ID %s (%08x)",
746 pnp_eisaformat(*compid), *compid);
747 printf("\n");
748 }
749 }
750 }
751
752 static device_method_t pnpbios_methods[] = {
753 /* Device interface */
754 DEVMETHOD(device_identify, pnpbios_identify),
755
756 { 0, 0 }
757 };
758
759 static driver_t pnpbios_driver = {
760 "pnpbios",
761 pnpbios_methods,
762 1, /* no softc */
763 };
764
765 static devclass_t pnpbios_devclass;
766
767 DRIVER_MODULE(pnpbios, isa, pnpbios_driver, pnpbios_devclass, 0, 0);
768 #endif /* DEV_ISA */
Cache object: b14c9c72e24a5bf3c7712f90e78948eb
|