]> CyberLeo.Net >> Repos - FreeBSD/releng/9.2.git/blob - sys/i386/i386/bios.c
- Copy stable/9 to releng/9.2 as part of the 9.2-RELEASE cycle.
[FreeBSD/releng/9.2.git] / 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$");
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 = 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 = 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             return (EINVAL);
376         }
377     }
378
379     if (flags & BIOSARGS_FLAG) {
380         if (arg_end - arg_start > ctob(16))
381             return (EACCES);
382         args->seg.args.base = arg_start;
383         args->seg.args.limit = 0xffff;
384     }
385
386     args->seg.code32.base = (u_int)&bios16_jmp & PG_FRAME;
387     args->seg.code32.limit = 0xffff;    
388
389     ptd = (pd_entry_t *)rcr3();
390 #ifdef PAE
391     if (ptd == IdlePDPT)
392 #else
393     if (ptd == IdlePTD)
394 #endif
395     {
396         /*
397          * no page table, so create one and install it.
398          */
399         pte = (pt_entry_t *)malloc(PAGE_SIZE, M_TEMP, M_WAITOK);
400         ptd = (pd_entry_t *)((u_int)IdlePTD + KERNBASE);
401         *pte = (vm86pa - PAGE_SIZE) | PG_RW | PG_V;
402         *ptd = vtophys(pte) | PG_RW | PG_V;
403     } else {
404         /*
405          * this is a user-level page table 
406          */
407         pte = PTmap;
408         *pte = (vm86pa - PAGE_SIZE) | PG_RW | PG_V;
409     }
410     pmap_invalidate_all(kernel_pmap);   /* XXX insurance for now */
411
412     stack_top = stack;
413     va_start(ap, fmt);
414     for (p = fmt; p && *p; p++) {
415         switch (*p) {
416         case 'p':                       /* 32-bit pointer */
417             i = va_arg(ap, u_int);
418             *(u_int *)stack = (i - arg_start) |
419                 (GSEL(GBIOSARGS_SEL, SEL_KPL) << 16);
420             stack += 4;
421             break;
422
423         case 'i':                       /* 32-bit integer */
424             i = va_arg(ap, u_int);
425             *(u_int *)stack = i;
426             stack += 4;
427             break;
428
429         case 'U':                       /* 16-bit selector */
430             *(u_short *)stack = GSEL(GBIOSUTIL_SEL, SEL_KPL);
431             stack += 2;
432             break;
433
434         case 'D':                       /* 16-bit selector */
435             *(u_short *)stack = GSEL(GBIOSDATA_SEL, SEL_KPL);
436             stack += 2;
437             break;
438
439         case 'C':                       /* 16-bit selector */
440             *(u_short *)stack = GSEL(GBIOSCODE16_SEL, SEL_KPL);
441             stack += 2;
442             break;
443
444         case 's':                       /* 16-bit integer passed as an int */
445             i = va_arg(ap, int);
446             *(u_short *)stack = i;
447             stack += 2;
448             break;
449
450         default:
451             return (EINVAL);
452         }
453     }
454
455     set_bios_selectors(&args->seg, flags);
456     bioscall_vector.vec16.offset = (u_short)args->entry;
457     bioscall_vector.vec16.segment = GSEL(GBIOSCODE16_SEL, SEL_KPL);
458
459     i = bios16_call(&args->r, stack_top);
460
461     if (pte == PTmap) {
462         *pte = 0;                       /* remove entry */
463         /*
464          * XXX only needs to be invlpg(0) but that doesn't work on the 386 
465          */
466         pmap_invalidate_all(kernel_pmap);
467     } else {
468         *ptd = 0;                       /* remove page table */
469         /*
470          * XXX only needs to be invlpg(0) but that doesn't work on the 386 
471          */
472         pmap_invalidate_all(kernel_pmap);
473         free(pte, M_TEMP);              /* ... and free it */
474     }
475     return (i);
476 }
477
478 int
479 bios_oem_strings(struct bios_oem *oem, u_char *buffer, size_t maxlen)
480 {
481         size_t idx = 0;
482         struct bios_oem_signature *sig;
483         u_int from, to;
484         u_char c, *s, *se, *str, *bios_str;
485         size_t i, off, len, tot;
486
487         if ( !oem || !buffer || maxlen<2 )
488                 return(-1);
489
490         sig = oem->signature;
491         if (!sig)
492                 return(-2);
493
494         from = oem->range.from;
495         to = oem->range.to;
496         if ( (to<=from) || (from<BIOS_START) || (to>(BIOS_START+BIOS_SIZE)) )
497                 return(-3);
498
499         while (sig->anchor != NULL) {
500                 str = sig->anchor;
501                 len = strlen(str);
502                 off = sig->offset;
503                 tot = sig->totlen;
504                 /* make sure offset doesn't go beyond bios area */
505                 if ( (to+off)>(BIOS_START+BIOS_SIZE) ||
506                                         ((from+off)<BIOS_START) ) {
507                         printf("sys/i386/i386/bios.c: sig '%s' "
508                                 "from 0x%0x to 0x%0x offset %d "
509                                 "out of BIOS bounds 0x%0x - 0x%0x\n",
510                                 str, from, to, off,
511                                 BIOS_START, BIOS_START+BIOS_SIZE);
512                         return(-4);
513                 }
514                 /* make sure we don't overrun return buffer */
515                 if (idx + tot > maxlen - 1) {
516                         printf("sys/i386/i386/bios.c: sig '%s' "
517                                 "idx %d + tot %d = %d > maxlen-1 %d\n",
518                                 str, idx, tot, idx+tot, maxlen-1);
519                         return(-5);
520                 }
521                 bios_str = NULL;
522                 s = (u_char *)BIOS_PADDRTOVADDR(from);
523                 se = (u_char *)BIOS_PADDRTOVADDR(to-len);
524                 for (; s<se; s++) {
525                         if (!bcmp(str, s, len)) {
526                                 bios_str = s;
527                                 break;
528                         }
529                 }
530                 /*
531                 *  store pretty version of totlen bytes of bios string with
532                 *  given offset; 0x20 - 0x7E are printable; uniquify spaces
533                 */
534                 if (bios_str) {
535                         for (i=0; i<tot; i++) {
536                                 c = bios_str[i+off];
537                                 if ( (c < 0x20) || (c > 0x7E) )
538                                         c = ' ';
539                                 if (idx == 0) {
540                                         if (c != ' ')
541                                                 buffer[idx++] = c;
542                                 } else if ( (c != ' ') ||
543                                         ((c == ' ') && (buffer[idx-1] != ' ')) )
544                                                 buffer[idx++] = c;
545                         }
546                 }
547                 sig++;
548         }
549         /* remove a final trailing space */
550         if ( (idx > 1) && (buffer[idx-1] == ' ') )
551                 idx--;
552         buffer[idx] = '\0';
553         return (idx);
554 }
555
556 #ifdef DEV_ISA
557 /*
558  * PnP BIOS interface; enumerate devices only known to the system
559  * BIOS and save information about them for later use.
560  */
561
562 struct pnp_sysdev 
563 {
564     u_int16_t   size;
565     u_int8_t    handle;
566     u_int32_t   devid;
567     u_int8_t    type[3];
568     u_int16_t   attrib;
569 #define PNPATTR_NODISABLE       (1<<0)  /* can't be disabled */
570 #define PNPATTR_NOCONFIG        (1<<1)  /* can't be configured */
571 #define PNPATTR_OUTPUT          (1<<2)  /* can be primary output */
572 #define PNPATTR_INPUT           (1<<3)  /* can be primary input */
573 #define PNPATTR_BOOTABLE        (1<<4)  /* can be booted from */
574 #define PNPATTR_DOCK            (1<<5)  /* is a docking station */
575 #define PNPATTR_REMOVEABLE      (1<<6)  /* device is removeable */
576 #define PNPATTR_CONFIG_STATIC   (0)
577 #define PNPATTR_CONFIG_DYNAMIC  (1)
578 #define PNPATTR_CONFIG_DYNONLY  (3)
579 #define PNPATTR_CONFIG(a)       (((a) >> 7) & 0x3)
580     /* device-specific data comes here */
581     u_int8_t    devdata[0];
582 } __packed;
583
584 /* We have to cluster arguments within a 64k range for the bios16 call */
585 struct pnp_sysdevargs
586 {
587     u_int16_t   next;
588     struct pnp_sysdev node;
589 };
590
591 /*
592  * This function is called after the bus has assigned resource
593  * locations for a logical device.
594  */
595 static void
596 pnpbios_set_config(void *arg, struct isa_config *config, int enable)
597 {
598 }
599
600 /*
601  * Quiz the PnP BIOS, build a list of PNP IDs and resource data.
602  */
603 static void
604 pnpbios_identify(driver_t *driver, device_t parent)
605 {
606     struct PnPBIOS_table        *pt = PnPBIOStable;
607     struct bios_args            args;
608     struct pnp_sysdev           *pd;
609     struct pnp_sysdevargs       *pda;
610     u_int16_t                   ndevs, bigdev;
611     int                         error, currdev;
612     u_int8_t                    *devnodebuf, tag;
613     u_int32_t                   *devid, *compid;
614     int                         idx, left;
615     device_t                    dev;
616         
617     /* no PnP BIOS information */
618     if (pt == NULL)
619         return;
620
621     /* Check to see if ACPI is already active. */
622     dev = devclass_get_device(devclass_find("acpi"), 0);
623     if (dev != NULL && device_is_attached(dev)) 
624         return;
625
626     /* get count of PnP devices */
627     bzero(&args, sizeof(args));
628     args.seg.code16.base = BIOS_PADDRTOVADDR(pt->pmentrybase);
629     args.seg.code16.limit = 0xffff;             /* XXX ? */
630     args.seg.data.base = BIOS_PADDRTOVADDR(pt->pmdataseg);
631     args.seg.data.limit = 0xffff;
632     args.entry = pt->pmentryoffset;
633     
634     if ((error = bios16(&args, PNP_COUNT_DEVNODES, &ndevs, &bigdev)) || (args.r.eax & 0xff)) {
635         printf("pnpbios: error %d/%x getting device count/size limit\n", error, args.r.eax);
636         return;
637     }
638     ndevs &= 0xff;                              /* clear high byte garbage */
639     if (bootverbose)
640         printf("pnpbios: %d devices, largest %d bytes\n", ndevs, bigdev);
641
642     devnodebuf = malloc(bigdev + (sizeof(struct pnp_sysdevargs) - sizeof(struct pnp_sysdev)),
643                         M_DEVBUF, M_NOWAIT);
644     if (devnodebuf == NULL) {
645         printf("pnpbios: cannot allocate memory, bailing\n");
646         return;
647     }
648     pda = (struct pnp_sysdevargs *)devnodebuf;
649     pd = &pda->node;
650
651     for (currdev = 0, left = ndevs; (currdev != 0xff) && (left > 0); left--) {
652
653         bzero(pd, bigdev);
654         pda->next = currdev;
655         /* get current configuration */
656         if ((error = bios16(&args, PNP_GET_DEVNODE, &pda->next, &pda->node, 1))) {
657             printf("pnpbios: error %d making BIOS16 call\n", error);
658             break;
659         }
660         if ((error = (args.r.eax & 0xff))) {
661             if (bootverbose)
662                 printf("pnpbios: %s 0x%x fetching node %d\n", error & 0x80 ? "error" : "warning", error, currdev);
663             if (error & 0x80) 
664                 break;
665         }
666         currdev = pda->next;
667         if (pd->size < sizeof(struct pnp_sysdev)) {
668             printf("pnpbios: bogus system node data, aborting scan\n");
669             break;
670         }
671
672         /*
673          * Ignore PICs so that we don't have to worry about the PICs
674          * claiming IRQs to prevent their use.  The PIC drivers
675          * already ensure that invalid IRQs are not used.
676          */
677         if (!strcmp(pnp_eisaformat(pd->devid), "PNP0000"))      /* ISA PIC */
678             continue;
679         if (!strcmp(pnp_eisaformat(pd->devid), "PNP0003"))      /* APIC */
680             continue;
681         
682         /* Add the device and parse its resources */
683         dev = BUS_ADD_CHILD(parent, ISA_ORDER_PNPBIOS, NULL, -1);
684         isa_set_vendorid(dev, pd->devid);
685         isa_set_logicalid(dev, pd->devid);
686         /*
687          * It appears that some PnP BIOS doesn't allow us to re-enable
688          * the embedded system device once it is disabled.  We shall
689          * mark all system device nodes as "cannot be disabled", regardless
690          * of actual settings in the device attribute byte.
691          * XXX
692         isa_set_configattr(dev, 
693             ((pd->attrib & PNPATTR_NODISABLE) ?  0 : ISACFGATTR_CANDISABLE) |
694             ((!(pd->attrib & PNPATTR_NOCONFIG) && 
695                 PNPATTR_CONFIG(pd->attrib) != PNPATTR_CONFIG_STATIC)
696                 ? ISACFGATTR_DYNAMIC : 0));
697          */
698         isa_set_configattr(dev, 
699             (!(pd->attrib & PNPATTR_NOCONFIG) && 
700                 PNPATTR_CONFIG(pd->attrib) != PNPATTR_CONFIG_STATIC)
701                 ? ISACFGATTR_DYNAMIC : 0);
702         isa_set_pnpbios_handle(dev, pd->handle);
703         ISA_SET_CONFIG_CALLBACK(parent, dev, pnpbios_set_config, 0);
704         pnp_parse_resources(dev, &pd->devdata[0],
705             pd->size - sizeof(struct pnp_sysdev), 0);
706         if (!device_get_desc(dev))
707             device_set_desc_copy(dev, pnp_eisaformat(pd->devid));
708
709         /* Find device IDs */
710         devid = &pd->devid;
711         compid = NULL;
712
713         /* look for a compatible device ID too */
714         left = pd->size - sizeof(struct pnp_sysdev);
715         idx = 0;
716         while (idx < left) {
717             tag = pd->devdata[idx++];
718             if (PNP_RES_TYPE(tag) == 0) {
719                 /* Small resource */
720                 switch (PNP_SRES_NUM(tag)) {
721                 case PNP_TAG_COMPAT_DEVICE:
722                     compid = (u_int32_t *)(pd->devdata + idx);
723                     if (bootverbose)
724                         printf("pnpbios: node %d compat ID 0x%08x\n", pd->handle, *compid);
725                     /* FALLTHROUGH */
726                 case PNP_TAG_END:
727                     idx = left;
728                     break;
729                 default:
730                     idx += PNP_SRES_LEN(tag);
731                     break;
732                 }
733             } else
734                 /* Large resource, skip it */
735                 idx += *(u_int16_t *)(pd->devdata + idx) + 2;
736         }
737         if (bootverbose) {
738             printf("pnpbios: handle %d device ID %s (%08x)", 
739                    pd->handle, pnp_eisaformat(*devid), *devid);
740             if (compid != NULL)
741                 printf(" compat ID %s (%08x)",
742                        pnp_eisaformat(*compid), *compid);
743             printf("\n");
744         }
745     }
746 }
747
748 static device_method_t pnpbios_methods[] = {
749         /* Device interface */
750         DEVMETHOD(device_identify,      pnpbios_identify),
751
752         { 0, 0 }
753 };
754
755 static driver_t pnpbios_driver = {
756         "pnpbios",
757         pnpbios_methods,
758         1,                      /* no softc */
759 };
760
761 static devclass_t pnpbios_devclass;
762
763 DRIVER_MODULE(pnpbios, isa, pnpbios_driver, pnpbios_devclass, 0, 0);
764 #endif /* DEV_ISA */