xref: /freebsd/sys/i386/i386/bios.c (revision ef73ae4b0ccbd4beded1e8cce7f528799a1ae5ed)
1d561028dSMike Smith /*-
2d561028dSMike Smith  * Copyright (c) 1997 Michael Smith
3496027bfSMike Smith  * Copyright (c) 1998 Jonathan Lemon
4d561028dSMike Smith  * All rights reserved.
5d561028dSMike Smith  *
6d561028dSMike Smith  * Redistribution and use in source and binary forms, with or without
7d561028dSMike Smith  * modification, are permitted provided that the following conditions
8d561028dSMike Smith  * are met:
9d561028dSMike Smith  * 1. Redistributions of source code must retain the above copyright
10d561028dSMike Smith  *    notice, this list of conditions and the following disclaimer.
11d561028dSMike Smith  * 2. Redistributions in binary form must reproduce the above copyright
12d561028dSMike Smith  *    notice, this list of conditions and the following disclaimer in the
13d561028dSMike Smith  *    documentation and/or other materials provided with the distribution.
14d561028dSMike Smith  *
15d561028dSMike Smith  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16d561028dSMike Smith  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17d561028dSMike Smith  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18d561028dSMike Smith  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19d561028dSMike Smith  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20d561028dSMike Smith  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21d561028dSMike Smith  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22d561028dSMike Smith  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23d561028dSMike Smith  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24d561028dSMike Smith  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25d561028dSMike Smith  * SUCH DAMAGE.
26d561028dSMike Smith  *
27c3aac50fSPeter Wemm  * $FreeBSD$
28d561028dSMike Smith  */
29d561028dSMike Smith 
30d561028dSMike Smith /*
31d561028dSMike Smith  * Code for dealing with the BIOS in x86 PC systems.
32d561028dSMike Smith  */
33d561028dSMike Smith 
349bcde22fSBruce Evans #include "isa.h"
359bcde22fSBruce Evans 
36d561028dSMike Smith #include <sys/param.h>
37d561028dSMike Smith #include <sys/systm.h>
38d561028dSMike Smith #include <sys/kernel.h>
39496027bfSMike Smith #include <sys/malloc.h>
40bb2b9030SDoug Rabson #include <sys/bus.h>
41d561028dSMike Smith #include <vm/vm.h>
42d561028dSMike Smith #include <vm/pmap.h>
434a3bb599SBruce Evans #include <machine/globals.h>
44d561028dSMike Smith #include <machine/md_var.h>
45496027bfSMike Smith #include <machine/segments.h>
46496027bfSMike Smith #include <machine/stdarg.h>
47496027bfSMike Smith #include <machine/vmparam.h>
48d561028dSMike Smith #include <machine/pc/bios.h>
49abe0ccd7SPeter Wemm #include <isa/isavar.h>
506c233a71SPeter Wemm #include <isa/pnpreg.h>
51bb2b9030SDoug Rabson #include <isa/pnpvar.h>
52d561028dSMike Smith 
53d561028dSMike Smith #define BIOS_START	0xe0000
54d561028dSMike Smith #define BIOS_SIZE	0x20000
55d561028dSMike Smith 
56d561028dSMike Smith /* exported lookup results */
57d561028dSMike Smith struct bios32_SDentry		PCIbios = {entry : 0};
58cb5f885bSMike Smith struct PnPBIOS_table		*PnPBIOStable = 0;
59d561028dSMike Smith 
60496027bfSMike Smith static u_int			bios32_SDCI = 0;
61d561028dSMike Smith 
62d561028dSMike Smith /* start fairly early */
63cb5f885bSMike Smith static void			bios32_init(void *junk);
64d561028dSMike Smith SYSINIT(bios32, SI_SUB_CPU, SI_ORDER_ANY, bios32_init, NULL);
65d561028dSMike Smith 
66d561028dSMike Smith /*
67d561028dSMike Smith  * bios32_init
68d561028dSMike Smith  *
69d561028dSMike Smith  * Locate various bios32 entities.
70d561028dSMike Smith  */
71d561028dSMike Smith static void
72d561028dSMike Smith bios32_init(void *junk)
73d561028dSMike Smith {
74d561028dSMike Smith     u_long			sigaddr;
75d561028dSMike Smith     struct bios32_SDheader	*sdh;
76cb5f885bSMike Smith     struct PnPBIOS_table	*pt;
77d561028dSMike Smith     u_int8_t			ck, *cv;
78d561028dSMike Smith     int				i;
79300451c4SMike Smith     char			*p;
80d561028dSMike Smith 
81d561028dSMike Smith     /*
82300451c4SMike Smith      * BIOS32 Service Directory, PCI BIOS
83d561028dSMike Smith      */
84d561028dSMike Smith 
85d561028dSMike Smith     /* look for the signature */
86d561028dSMike Smith     if ((sigaddr = bios_sigsearch(0, "_32_", 4, 16, 0)) != 0) {
87d561028dSMike Smith 
88d561028dSMike Smith 	/* get a virtual pointer to the structure */
89fc93c1bdSBruce Evans 	sdh = (struct bios32_SDheader *)(uintptr_t)BIOS_PADDRTOVADDR(sigaddr);
90d561028dSMike Smith 	for (cv = (u_int8_t *)sdh, ck = 0, i = 0; i < (sdh->len * 16); i++) {
91d561028dSMike Smith 	    ck += cv[i];
92d561028dSMike Smith 	}
93d561028dSMike Smith 	/* If checksum is OK, enable use of the entrypoint */
94d20358b3SMike Smith 	if ((ck == 0) && (sdh->entry < (BIOS_START + BIOS_SIZE))) {
95496027bfSMike Smith 	    bios32_SDCI = BIOS_PADDRTOVADDR(sdh->entry);
96d561028dSMike Smith 	    if (bootverbose) {
97cb5f885bSMike Smith 		printf("bios32: Found BIOS32 Service Directory header at %p\n", sdh);
98cb5f885bSMike Smith 		printf("bios32: Entry = 0x%x (%x)  Rev = %d  Len = %d\n",
99d561028dSMike Smith 		       sdh->entry, bios32_SDCI, sdh->revision, sdh->len);
100d561028dSMike Smith 	    }
101300451c4SMike Smith 
1025de4ba3cSYoshihiro Takahashi #ifndef PC98
103300451c4SMike Smith 	    /* Allow user override of PCI BIOS search */
104300451c4SMike Smith 	    if (((p = getenv("machdep.bios.pci")) == NULL) || strcmp(p, "disable")) {
105300451c4SMike Smith 
106d561028dSMike Smith 		/* See if there's a PCI BIOS entrypoint here */
107d561028dSMike Smith 		PCIbios.ident.id = 0x49435024;	/* PCI systems should have this */
108d561028dSMike Smith 		if (!bios32_SDlookup(&PCIbios) && bootverbose)
109300451c4SMike Smith 		    printf("pcibios: PCI BIOS entry at 0x%x+0x%x\n", PCIbios.base, PCIbios.entry);
110300451c4SMike Smith 	    }
1115de4ba3cSYoshihiro Takahashi #endif
112d561028dSMike Smith 	} else {
113cb5f885bSMike Smith 	    printf("bios32: Bad BIOS32 Service Directory\n");
114d561028dSMike Smith 	}
115d561028dSMike Smith     }
116d561028dSMike Smith 
117d561028dSMike Smith     /*
118cb5f885bSMike Smith      * PnP BIOS
119300451c4SMike Smith      *
120300451c4SMike Smith      * Allow user override of PnP BIOS search
121cb5f885bSMike Smith      */
122300451c4SMike Smith     if ((((p = getenv("machdep.bios.pnp")) == NULL) || strcmp(p, "disable")) &&
123300451c4SMike Smith 	((sigaddr = bios_sigsearch(0, "$PnP", 4, 16, 0)) != 0)) {
124d561028dSMike Smith 
125d561028dSMike Smith 	/* get a virtual pointer to the structure */
126cb5f885bSMike Smith 	pt = (struct PnPBIOS_table *)(uintptr_t)BIOS_PADDRTOVADDR(sigaddr);
127cb5f885bSMike Smith 	for (cv = (u_int8_t *)pt, ck = 0, i = 0; i < pt->len; i++) {
128d561028dSMike Smith 	    ck += cv[i];
129d561028dSMike Smith 	}
130cb5f885bSMike Smith 	/* If checksum is OK, enable use of the entrypoint */
131d561028dSMike Smith 	if (ck == 0) {
132cb5f885bSMike Smith 	    PnPBIOStable = pt;
133d561028dSMike Smith 	    if (bootverbose) {
134cb5f885bSMike Smith 		printf("pnpbios: Found PnP BIOS data at %p\n", pt);
135cb5f885bSMike Smith 		printf("pnpbios: Entry = %x:%x  Rev = %d.%d\n",
136cb5f885bSMike Smith 		       pt->pmentrybase, pt->pmentryoffset, pt->version >> 4, pt->version & 0xf);
137cb5f885bSMike Smith 		if ((pt->control & 0x3) == 0x01)
138cb5f885bSMike Smith 		    printf("pnpbios: Event flag at %x\n", pt->evflagaddr);
139cb5f885bSMike Smith 		if (pt->oemdevid != 0)
140cb5f885bSMike Smith 		    printf("pnpbios: OEM ID %x\n", pt->oemdevid);
141cb5f885bSMike Smith 
142d561028dSMike Smith 	    }
143d561028dSMike Smith 	} else {
144cb5f885bSMike Smith 	    printf("pnpbios: Bad PnP BIOS data checksum\n");
145d561028dSMike Smith 	}
146d561028dSMike Smith     }
14776cf257bSPoul-Henning Kamp     if (bootverbose) {
14876cf257bSPoul-Henning Kamp 	    /* look for other know signatures */
14976cf257bSPoul-Henning Kamp 	    printf("Other BIOS signatures found:\n");
15076cf257bSPoul-Henning Kamp     }
151d561028dSMike Smith }
152d561028dSMike Smith 
153d561028dSMike Smith /*
154d561028dSMike Smith  * bios32_SDlookup
155d561028dSMike Smith  *
156d561028dSMike Smith  * Query the BIOS32 Service Directory for the service named in (ent),
157d561028dSMike Smith  * returns nonzero if the lookup fails.  The caller must fill in
158d561028dSMike Smith  * (ent->ident), the remainder are populated on a successful lookup.
159d561028dSMike Smith  */
160d561028dSMike Smith int
161d561028dSMike Smith bios32_SDlookup(struct bios32_SDentry *ent)
162d561028dSMike Smith {
163496027bfSMike Smith     struct bios_regs args;
164d561028dSMike Smith 
165496027bfSMike Smith     if (bios32_SDCI == 0)
166496027bfSMike Smith 	return (1);
167d561028dSMike Smith 
168d561028dSMike Smith     args.eax = ent->ident.id;		/* set up arguments */
169d561028dSMike Smith     args.ebx = args.ecx = args.edx = 0;
170496027bfSMike Smith     bios32(&args, bios32_SDCI, GSEL(GCODE_SEL, SEL_KPL));
171d561028dSMike Smith     if ((args.eax & 0xff) == 0) {	/* success? */
172d561028dSMike Smith 	ent->base = args.ebx;
173d561028dSMike Smith 	ent->len = args.ecx;
174d561028dSMike Smith 	ent->entry = args.edx;
175300451c4SMike Smith 	ent->ventry = BIOS_PADDRTOVADDR(ent->base + ent->entry);
176d561028dSMike Smith 	return (0);			/* all OK */
177d561028dSMike Smith     }
178d561028dSMike Smith     return (1);				/* failed */
179d561028dSMike Smith }
180d561028dSMike Smith 
181496027bfSMike Smith 
182d561028dSMike Smith /*
183d561028dSMike Smith  * bios_sigsearch
184d561028dSMike Smith  *
185d561028dSMike Smith  * Search some or all of the BIOS region for a signature string.
186d561028dSMike Smith  *
187d561028dSMike Smith  * (start)	Optional offset returned from this function
188d561028dSMike Smith  *		(for searching for multiple matches), or NULL
189d561028dSMike Smith  *		to start the search from the base of the BIOS.
190d561028dSMike Smith  *		Note that this will be a _physical_ address in
191d561028dSMike Smith  *		the range 0xe0000 - 0xfffff.
192d561028dSMike Smith  * (sig)	is a pointer to the byte(s) of the signature.
193d561028dSMike Smith  * (siglen)	number of bytes in the signature.
194d561028dSMike Smith  * (paralen)	signature paragraph (alignment) size.
195d561028dSMike Smith  * (sigofs)	offset of the signature within the paragraph.
196d561028dSMike Smith  *
197d561028dSMike Smith  * Returns the _physical_ address of the found signature, 0 if the
198d561028dSMike Smith  * signature was not found.
199d561028dSMike Smith  */
200d561028dSMike Smith 
201d561028dSMike Smith u_int32_t
202d561028dSMike Smith bios_sigsearch(u_int32_t start, u_char *sig, int siglen, int paralen, int sigofs)
203d561028dSMike Smith {
204d561028dSMike Smith     u_char	*sp, *end;
205d561028dSMike Smith 
206d561028dSMike Smith     /* compute the starting address */
207d561028dSMike Smith     if ((start >= BIOS_START) && (start <= (BIOS_START + BIOS_SIZE))) {
208d561028dSMike Smith 	sp = (char *)BIOS_PADDRTOVADDR(start);
209d561028dSMike Smith     } else if (start == 0) {
210d561028dSMike Smith 	sp = (char *)BIOS_PADDRTOVADDR(BIOS_START);
211d561028dSMike Smith     } else {
212d561028dSMike Smith 	return 0;				/* bogus start address */
213d561028dSMike Smith     }
214d561028dSMike Smith 
215d561028dSMike Smith     /* compute the end address */
216d561028dSMike Smith     end = (u_char *)BIOS_PADDRTOVADDR(BIOS_START + BIOS_SIZE);
217d561028dSMike Smith 
218d561028dSMike Smith     /* loop searching */
219d561028dSMike Smith     while ((sp + sigofs + siglen) < end) {
220d561028dSMike Smith 
221d561028dSMike Smith 	/* compare here */
222c7a2b294SMike Smith 	if (!bcmp(sp + sigofs, sig, siglen)) {
223d561028dSMike Smith 	    /* convert back to physical address */
224d561028dSMike Smith 	    return((u_int32_t)BIOS_VADDRTOPADDR(sp));
225d561028dSMike Smith 	}
226d561028dSMike Smith 	sp += paralen;
227d561028dSMike Smith     }
228d561028dSMike Smith     return(0);
229d561028dSMike Smith }
230d561028dSMike Smith 
231496027bfSMike Smith /*
232496027bfSMike Smith  * do not staticize, used by bioscall.s
233496027bfSMike Smith  */
234496027bfSMike Smith union {
235496027bfSMike Smith     struct {
236496027bfSMike Smith 	u_short	offset;
237496027bfSMike Smith 	u_short	segment;
238496027bfSMike Smith     } vec16;
239496027bfSMike Smith     struct {
240496027bfSMike Smith 	u_int	offset;
241496027bfSMike Smith 	u_short	segment;
242496027bfSMike Smith     } vec32;
243496027bfSMike Smith } bioscall_vector;			/* bios jump vector */
244496027bfSMike Smith 
245496027bfSMike Smith void
246496027bfSMike Smith set_bios_selectors(struct bios_segments *seg, int flags)
247496027bfSMike Smith {
248496027bfSMike Smith     struct soft_segment_descriptor ssd = {
249496027bfSMike Smith 	0,			/* segment base address (overwritten) */
250496027bfSMike Smith 	0,			/* length (overwritten) */
251496027bfSMike Smith 	SDT_MEMERA,		/* segment type (overwritten) */
252496027bfSMike Smith 	0,			/* priority level */
253496027bfSMike Smith 	1,			/* descriptor present */
254496027bfSMike Smith 	0, 0,
255496027bfSMike Smith 	1,			/* descriptor size (overwritten) */
256496027bfSMike Smith 	0			/* granularity == byte units */
257496027bfSMike Smith     };
2587e42e2f8SJonathan Lemon     union descriptor *p_gdt;
259496027bfSMike Smith 
2607e42e2f8SJonathan Lemon #ifdef SMP
261ef73ae4bSJake Burkholder     p_gdt = &gdt[PCPU_GET(cpuid) * NGDT];
2627e42e2f8SJonathan Lemon #else
2637e42e2f8SJonathan Lemon     p_gdt = gdt;
2647e42e2f8SJonathan Lemon #endif
265496027bfSMike Smith 
266496027bfSMike Smith     ssd.ssd_base = seg->code32.base;
267496027bfSMike Smith     ssd.ssd_limit = seg->code32.limit;
2687e42e2f8SJonathan Lemon     ssdtosd(&ssd, &p_gdt[GBIOSCODE32_SEL].sd);
269496027bfSMike Smith 
270496027bfSMike Smith     ssd.ssd_def32 = 0;
271496027bfSMike Smith     if (flags & BIOSCODE_FLAG) {
272496027bfSMike Smith 	ssd.ssd_base = seg->code16.base;
273496027bfSMike Smith 	ssd.ssd_limit = seg->code16.limit;
2747e42e2f8SJonathan Lemon 	ssdtosd(&ssd, &p_gdt[GBIOSCODE16_SEL].sd);
275496027bfSMike Smith     }
276496027bfSMike Smith 
277496027bfSMike Smith     ssd.ssd_type = SDT_MEMRWA;
278496027bfSMike Smith     if (flags & BIOSDATA_FLAG) {
279496027bfSMike Smith 	ssd.ssd_base = seg->data.base;
280496027bfSMike Smith 	ssd.ssd_limit = seg->data.limit;
2817e42e2f8SJonathan Lemon 	ssdtosd(&ssd, &p_gdt[GBIOSDATA_SEL].sd);
282496027bfSMike Smith     }
283496027bfSMike Smith 
284496027bfSMike Smith     if (flags & BIOSUTIL_FLAG) {
285496027bfSMike Smith 	ssd.ssd_base = seg->util.base;
286496027bfSMike Smith 	ssd.ssd_limit = seg->util.limit;
2877e42e2f8SJonathan Lemon 	ssdtosd(&ssd, &p_gdt[GBIOSUTIL_SEL].sd);
288496027bfSMike Smith     }
289496027bfSMike Smith 
290496027bfSMike Smith     if (flags & BIOSARGS_FLAG) {
291496027bfSMike Smith 	ssd.ssd_base = seg->args.base;
292496027bfSMike Smith 	ssd.ssd_limit = seg->args.limit;
2937e42e2f8SJonathan Lemon 	ssdtosd(&ssd, &p_gdt[GBIOSARGS_SEL].sd);
294496027bfSMike Smith     }
295496027bfSMike Smith }
296496027bfSMike Smith 
297496027bfSMike Smith extern int vm86pa;
29868b7d21aSMike Smith extern void bios16_jmp(void);
299496027bfSMike Smith 
300496027bfSMike Smith /*
301496027bfSMike Smith  * this routine is really greedy with selectors, and uses 5:
302496027bfSMike Smith  *
303496027bfSMike Smith  * 32-bit code selector:	to return to kernel
304496027bfSMike Smith  * 16-bit code selector:	for running code
305496027bfSMike Smith  *        data selector:	for 16-bit data
306496027bfSMike Smith  *        util selector:	extra utility selector
307496027bfSMike Smith  *        args selector:	to handle pointers
308496027bfSMike Smith  *
309496027bfSMike Smith  * the util selector is set from the util16 entry in bios16_args, if a
310496027bfSMike Smith  * "U" specifier is seen.
311496027bfSMike Smith  *
312496027bfSMike Smith  * See <machine/pc/bios.h> for description of format specifiers
313496027bfSMike Smith  */
314496027bfSMike Smith int
315496027bfSMike Smith bios16(struct bios_args *args, char *fmt, ...)
316496027bfSMike Smith {
317496027bfSMike Smith     char	*p, *stack, *stack_top;
318496027bfSMike Smith     va_list 	ap;
319496027bfSMike Smith     int 	flags = BIOSCODE_FLAG | BIOSDATA_FLAG;
320496027bfSMike Smith     u_int 	i, arg_start, arg_end;
321496027bfSMike Smith     u_int 	*pte, *ptd;
322496027bfSMike Smith 
323496027bfSMike Smith     arg_start = 0xffffffff;
324496027bfSMike Smith     arg_end = 0;
325496027bfSMike Smith 
326e6a80efcSMike Smith     /*
327e6a80efcSMike Smith      * Some BIOS entrypoints attempt to copy the largest-case
328e6a80efcSMike Smith      * argument frame (in order to generalise handling for
329e6a80efcSMike Smith      * different entry types).  If our argument frame is
330e6a80efcSMike Smith      * smaller than this, the BIOS will reach off the top of
331e6a80efcSMike Smith      * our constructed stack segment.  Pad the top of the stack
332e6a80efcSMike Smith      * with some garbage to avoid this.
333e6a80efcSMike Smith      */
334e6a80efcSMike Smith     stack = (caddr_t)PAGE_SIZE - 32;
335e6a80efcSMike Smith 
336496027bfSMike Smith     va_start(ap, fmt);
337496027bfSMike Smith     for (p = fmt; p && *p; p++) {
338496027bfSMike Smith 	switch (*p) {
339496027bfSMike Smith 	case 'p':			/* 32-bit pointer */
340496027bfSMike Smith 	    i = va_arg(ap, u_int);
341496027bfSMike Smith 	    arg_start = min(arg_start, i);
342f996ef63SMike Smith 	    arg_end = max(arg_end, i);
343496027bfSMike Smith 	    flags |= BIOSARGS_FLAG;
344496027bfSMike Smith 	    stack -= 4;
345496027bfSMike Smith 	    break;
346496027bfSMike Smith 
347496027bfSMike Smith 	case 'i':			/* 32-bit integer */
348496027bfSMike Smith 	    i = va_arg(ap, u_int);
349496027bfSMike Smith 	    stack -= 4;
350496027bfSMike Smith 	    break;
351496027bfSMike Smith 
352496027bfSMike Smith 	case 'U':			/* 16-bit selector */
353496027bfSMike Smith 	    flags |= BIOSUTIL_FLAG;
354496027bfSMike Smith 	    /* FALLTHROUGH */
355496027bfSMike Smith 	case 'D':			/* 16-bit selector */
356496027bfSMike Smith 	case 'C':			/* 16-bit selector */
357cb5f885bSMike Smith 	    stack -= 2;
358cb5f885bSMike Smith 	    break;
359cb5f885bSMike Smith 
360496027bfSMike Smith 	case 's':			/* 16-bit integer */
361496027bfSMike Smith 	    i = va_arg(ap, u_short);
362496027bfSMike Smith 	    stack -= 2;
363496027bfSMike Smith 	    break;
364496027bfSMike Smith 
365496027bfSMike Smith 	default:
366496027bfSMike Smith 	    return (EINVAL);
367496027bfSMike Smith 	}
368496027bfSMike Smith     }
369496027bfSMike Smith 
370496027bfSMike Smith     if (flags & BIOSARGS_FLAG) {
371496027bfSMike Smith 	if (arg_end - arg_start > ctob(16))
372496027bfSMike Smith 	    return (EACCES);
373496027bfSMike Smith 	args->seg.args.base = arg_start;
374f996ef63SMike Smith 	args->seg.args.limit = 0xffff;
375496027bfSMike Smith     }
376496027bfSMike Smith 
37768b7d21aSMike Smith     args->seg.code32.base = (u_int)&bios16_jmp & PG_FRAME;
378496027bfSMike Smith     args->seg.code32.limit = 0xffff;
379496027bfSMike Smith 
380496027bfSMike Smith     ptd = (u_int *)rcr3();
3813cc31bc2SMike Smith     if (ptd == IdlePTD) {
382496027bfSMike Smith 	/*
383496027bfSMike Smith 	 * no page table, so create one and install it.
384496027bfSMike Smith 	 */
385496027bfSMike Smith 	pte = (u_int *)malloc(PAGE_SIZE, M_TEMP, M_WAITOK);
386496027bfSMike Smith 	ptd = (u_int *)((u_int)ptd + KERNBASE);
387496027bfSMike Smith 	*ptd = vtophys(pte) | PG_RW | PG_V;
388496027bfSMike Smith     } else {
389496027bfSMike Smith 	/*
390496027bfSMike Smith 	 * this is a user-level page table
391496027bfSMike Smith 	 */
392496027bfSMike Smith 	pte = (u_int *)&PTmap;
393496027bfSMike Smith     }
394496027bfSMike Smith     /*
395496027bfSMike Smith      * install pointer to page 0.  we don't need to flush the tlb,
396496027bfSMike Smith      * since there should not be a previous mapping for page 0.
397496027bfSMike Smith      */
398496027bfSMike Smith     *pte = (vm86pa - PAGE_SIZE) | PG_RW | PG_V;
399496027bfSMike Smith 
400496027bfSMike Smith     stack_top = stack;
401496027bfSMike Smith     va_start(ap, fmt);
402496027bfSMike Smith     for (p = fmt; p && *p; p++) {
403496027bfSMike Smith 	switch (*p) {
404496027bfSMike Smith 	case 'p':			/* 32-bit pointer */
405496027bfSMike Smith 	    i = va_arg(ap, u_int);
406496027bfSMike Smith 	    *(u_int *)stack = (i - arg_start) |
407496027bfSMike Smith 		(GSEL(GBIOSARGS_SEL, SEL_KPL) << 16);
408496027bfSMike Smith 	    stack += 4;
409496027bfSMike Smith 	    break;
410496027bfSMike Smith 
411496027bfSMike Smith 	case 'i':			/* 32-bit integer */
412496027bfSMike Smith 	    i = va_arg(ap, u_int);
413496027bfSMike Smith 	    *(u_int *)stack = i;
414496027bfSMike Smith 	    stack += 4;
415496027bfSMike Smith 	    break;
416496027bfSMike Smith 
417496027bfSMike Smith 	case 'U':			/* 16-bit selector */
418496027bfSMike Smith 	    *(u_short *)stack = GSEL(GBIOSUTIL_SEL, SEL_KPL);
419496027bfSMike Smith 	    stack += 2;
420496027bfSMike Smith 	    break;
421496027bfSMike Smith 
422496027bfSMike Smith 	case 'D':			/* 16-bit selector */
423496027bfSMike Smith 	    *(u_short *)stack = GSEL(GBIOSDATA_SEL, SEL_KPL);
424496027bfSMike Smith 	    stack += 2;
425496027bfSMike Smith 	    break;
426496027bfSMike Smith 
427496027bfSMike Smith 	case 'C':			/* 16-bit selector */
428496027bfSMike Smith 	    *(u_short *)stack = GSEL(GBIOSCODE16_SEL, SEL_KPL);
429496027bfSMike Smith 	    stack += 2;
430496027bfSMike Smith 	    break;
431496027bfSMike Smith 
432496027bfSMike Smith 	case 's':			/* 16-bit integer */
433496027bfSMike Smith 	    i = va_arg(ap, u_short);
434496027bfSMike Smith 	    *(u_short *)stack = i;
435496027bfSMike Smith 	    stack += 2;
436496027bfSMike Smith 	    break;
437496027bfSMike Smith 
438496027bfSMike Smith 	default:
439496027bfSMike Smith 	    return (EINVAL);
440496027bfSMike Smith 	}
441496027bfSMike Smith     }
442496027bfSMike Smith 
443496027bfSMike Smith     set_bios_selectors(&args->seg, flags);
444496027bfSMike Smith     bioscall_vector.vec16.offset = (u_short)args->entry;
445496027bfSMike Smith     bioscall_vector.vec16.segment = GSEL(GBIOSCODE16_SEL, SEL_KPL);
446496027bfSMike Smith 
447496027bfSMike Smith     i = bios16_call(&args->r, stack_top);
448496027bfSMike Smith 
449496027bfSMike Smith     if (pte == (u_int *)&PTmap) {
450496027bfSMike Smith 	*pte = 0;			/* remove entry */
451496027bfSMike Smith     } else {
452496027bfSMike Smith 	*ptd = 0;			/* remove page table */
453496027bfSMike Smith 	free(pte, M_TEMP);		/* ... and free it */
454496027bfSMike Smith     }
455d561028dSMike Smith 
456496027bfSMike Smith     /*
457496027bfSMike Smith      * XXX only needs to be invlpg(0) but that doesn't work on the 386
458496027bfSMike Smith      */
459496027bfSMike Smith     invltlb();
460496027bfSMike Smith 
461496027bfSMike Smith     return (i);
462496027bfSMike Smith }
463cb5f885bSMike Smith 
464cb5f885bSMike Smith /*
465cb5f885bSMike Smith  * PnP BIOS interface; enumerate devices only known to the system
466cb5f885bSMike Smith  * BIOS and save information about them for later use.
467cb5f885bSMike Smith  */
468cb5f885bSMike Smith 
469cb5f885bSMike Smith struct pnp_sysdev
470cb5f885bSMike Smith {
471cb5f885bSMike Smith     u_int16_t	size;
472cb5f885bSMike Smith     u_int8_t	handle;
473cb5f885bSMike Smith     u_int32_t	devid;
474cb5f885bSMike Smith     u_int8_t	type[3];
475cb5f885bSMike Smith     u_int16_t	attrib;
476cb5f885bSMike Smith #define PNPATTR_NODISABLE	(1<<0)	/* can't be disabled */
477cb5f885bSMike Smith #define PNPATTR_NOCONFIG	(1<<1)	/* can't be configured */
478cb5f885bSMike Smith #define PNPATTR_OUTPUT		(1<<2)	/* can be primary output */
479cb5f885bSMike Smith #define PNPATTR_INPUT		(1<<3)	/* can be primary input */
480cb5f885bSMike Smith #define PNPATTR_BOOTABLE	(1<<4)	/* can be booted from */
481cb5f885bSMike Smith #define PNPATTR_DOCK		(1<<5)	/* is a docking station */
482cb5f885bSMike Smith #define PNPATTR_REMOVEABLE	(1<<6)	/* device is removeable */
483cb5f885bSMike Smith #define PNPATTR_CONFIG_STATIC	0x00
484cb5f885bSMike Smith #define PNPATTR_CONFIG_DYNAMIC	0x07
485cb5f885bSMike Smith #define PNPATTR_CONFIG_DYNONLY	0x17
486cb5f885bSMike Smith     /* device-specific data comes here */
487cb5f885bSMike Smith     u_int8_t	devdata[0];
488cb5f885bSMike Smith } __attribute__ ((packed));
489cb5f885bSMike Smith 
490cb5f885bSMike Smith /* We have to cluster arguments within a 64k range for the bios16 call */
491cb5f885bSMike Smith struct pnp_sysdevargs
492cb5f885bSMike Smith {
493cb5f885bSMike Smith     u_int16_t	next;
494cb5f885bSMike Smith     struct pnp_sysdev node;
495cb5f885bSMike Smith };
496cb5f885bSMike Smith 
497cb5f885bSMike Smith /*
498bb2b9030SDoug Rabson  * This function is called after the bus has assigned resource
499bb2b9030SDoug Rabson  * locations for a logical device.
500bb2b9030SDoug Rabson  */
501bb2b9030SDoug Rabson static void
502bb2b9030SDoug Rabson pnpbios_set_config(void *arg, struct isa_config *config, int enable)
503bb2b9030SDoug Rabson {
504bb2b9030SDoug Rabson }
505bb2b9030SDoug Rabson 
506bb2b9030SDoug Rabson /*
507cb5f885bSMike Smith  * Quiz the PnP BIOS, build a list of PNP IDs and resource data.
508cb5f885bSMike Smith  */
509cb5f885bSMike Smith static void
510bb2b9030SDoug Rabson pnpbios_identify(driver_t *driver, device_t parent)
511cb5f885bSMike Smith {
512cb5f885bSMike Smith     struct PnPBIOS_table	*pt = PnPBIOStable;
513cb5f885bSMike Smith     struct bios_args		args;
514cb5f885bSMike Smith     struct pnp_sysdev		*pd;
515cb5f885bSMike Smith     struct pnp_sysdevargs	*pda;
516cb5f885bSMike Smith     u_int16_t			ndevs, bigdev;
517cb5f885bSMike Smith     int				error, currdev;
518cb5f885bSMike Smith     u_int8_t			*devnodebuf, tag;
519cb5f885bSMike Smith     u_int32_t			*devid, *compid;
520cb5f885bSMike Smith     int				idx, left;
521bb2b9030SDoug Rabson     device_t			dev;
522cb5f885bSMike Smith 
523cb5f885bSMike Smith     /* no PnP BIOS information */
524cb5f885bSMike Smith     if (pt == NULL)
525cb5f885bSMike Smith 	return;
526cb5f885bSMike Smith 
527cb5f885bSMike Smith     bzero(&args, sizeof(args));
528cb5f885bSMike Smith     args.seg.code16.base = BIOS_PADDRTOVADDR(pt->pmentrybase);
529cb5f885bSMike Smith     args.seg.code16.limit = 0xffff;		/* XXX ? */
530cb5f885bSMike Smith     args.seg.data.base = BIOS_PADDRTOVADDR(pt->pmdataseg);
531cb5f885bSMike Smith     args.seg.data.limit = 0xffff;
532cb5f885bSMike Smith     args.entry = pt->pmentryoffset;
533cb5f885bSMike Smith 
534cb5f885bSMike Smith     if ((error = bios16(&args, PNP_COUNT_DEVNODES, &ndevs, &bigdev)) || (args.r.eax & 0xff))
535cb5f885bSMike Smith 	printf("pnpbios: error %d/%x getting device count/size limit\n", error, args.r.eax);
53603c6be5cSMike Smith     ndevs &= 0xff;				/* clear high byte garbage */
537cb5f885bSMike Smith     if (bootverbose)
538cb5f885bSMike Smith 	printf("pnpbios: %d devices, largest %d bytes\n", ndevs, bigdev);
539cb5f885bSMike Smith 
540cb5f885bSMike Smith     devnodebuf = malloc(bigdev + (sizeof(struct pnp_sysdevargs) - sizeof(struct pnp_sysdev)),
541cb5f885bSMike Smith 			M_DEVBUF, M_NOWAIT);
542cb5f885bSMike Smith     pda = (struct pnp_sysdevargs *)devnodebuf;
543cb5f885bSMike Smith     pd = &pda->node;
544cb5f885bSMike Smith 
545cb5f885bSMike Smith     for (currdev = 0, left = ndevs; (currdev != 0xff) && (left > 0); left--) {
546cb5f885bSMike Smith 
547cb5f885bSMike Smith 	bzero(pd, bigdev);
548cb5f885bSMike Smith 	pda->next = currdev;
549cb5f885bSMike Smith 	/* get current configuration */
550cb5f885bSMike Smith 	if ((error = bios16(&args, PNP_GET_DEVNODE, &pda->next, &pda->node, (u_int16_t)1))) {
551cb5f885bSMike Smith 	    printf("pnpbios: error %d making BIOS16 call\n", error);
552cb5f885bSMike Smith 	    break;
553cb5f885bSMike Smith 	}
554cb5f885bSMike Smith 	if ((error = (args.r.eax & 0xff))) {
555cb5f885bSMike Smith 	    if (bootverbose)
556cb5f885bSMike Smith 		printf("pnpbios: %s 0x%x fetching node %d\n", error & 0x80 ? "error" : "warning", error, currdev);
557cb5f885bSMike Smith 	    if (error & 0x80)
558cb5f885bSMike Smith 		break;
559cb5f885bSMike Smith 	}
560cb5f885bSMike Smith 	currdev = pda->next;
561cb5f885bSMike Smith 	if (pd->size < sizeof(struct pnp_sysdev)) {
562cb5f885bSMike Smith 	    printf("pnpbios: bogus system node data, aborting scan\n");
563cb5f885bSMike Smith 	    break;
564cb5f885bSMike Smith 	}
565cb5f885bSMike Smith 
566642ba07aSMike Smith 	/*
567642ba07aSMike Smith 	 * If we are in APIC_IO mode, we should ignore the ISA PIC if it
568642ba07aSMike Smith 	 * shows up.  Likewise, in !APIC_IO mode, we should ignore the
569642ba07aSMike Smith 	 * APIC (less important).
570642ba07aSMike Smith 	 * This is significant because the ISA PIC will claim IRQ 2 (which
571642ba07aSMike Smith 	 * it uses for chaining), while in APIC mode this is a valid IRQ
572642ba07aSMike Smith 	 * available for general use.
573642ba07aSMike Smith 	 */
574642ba07aSMike Smith #ifdef APIC_IO
5756eb9d785SMike Smith 	if (!strcmp(pnp_eisaformat(pd->devid), "PNP0000"))	/* ISA PIC */
576642ba07aSMike Smith 	    continue;
577642ba07aSMike Smith #else
5786eb9d785SMike Smith 	if (!strcmp(pnp_eisaformat(pd->devid), "PNP0003"))	/* APIC */
579642ba07aSMike Smith 	    continue;
580642ba07aSMike Smith #endif
581642ba07aSMike Smith 
582bb2b9030SDoug Rabson 	/* Add the device and parse its resources */
583bb2b9030SDoug Rabson 	dev = BUS_ADD_CHILD(parent, ISA_ORDER_PNP, NULL, -1);
584bb2b9030SDoug Rabson 	isa_set_vendorid(dev, pd->devid);
585bb2b9030SDoug Rabson 	isa_set_logicalid(dev, pd->devid);
586bb2b9030SDoug Rabson 	ISA_SET_CONFIG_CALLBACK(parent, dev, pnpbios_set_config, 0);
587bb2b9030SDoug Rabson 	pnp_parse_resources(dev, &pd->devdata[0],
588fb0ef528SSeigo Tanimura 			    pd->size - sizeof(struct pnp_sysdev),
589fb0ef528SSeigo Tanimura 			    isa_get_vendorid(dev), isa_get_logicalid(dev), 0);
590bb2b9030SDoug Rabson 	if (!device_get_desc(dev))
591bb2b9030SDoug Rabson 	    device_set_desc_copy(dev, pnp_eisaformat(pd->devid));
592bb2b9030SDoug Rabson 
593cb5f885bSMike Smith 	/* Find device IDs */
594cb5f885bSMike Smith 	devid = &pd->devid;
595cb5f885bSMike Smith 	compid = NULL;
596cb5f885bSMike Smith 
597cb5f885bSMike Smith 	/* look for a compatible device ID too */
598cb5f885bSMike Smith 	left = pd->size - sizeof(struct pnp_sysdev);
599cb5f885bSMike Smith 	idx = 0;
600cb5f885bSMike Smith 	while (idx < left) {
601cb5f885bSMike Smith 	    tag = pd->devdata[idx++];
602cb5f885bSMike Smith 	    if (PNP_RES_TYPE(tag) == 0) {
603cb5f885bSMike Smith 		/* Small resource */
604cb5f885bSMike Smith 		switch (PNP_SRES_NUM(tag)) {
6056c233a71SPeter Wemm 		case PNP_TAG_COMPAT_DEVICE:
606cb5f885bSMike Smith 		    compid = (u_int32_t *)(pd->devdata + idx);
607cb5f885bSMike Smith 		    if (bootverbose)
608cb5f885bSMike Smith 			printf("pnpbios: node %d compat ID 0x%08x\n", pd->handle, *compid);
609cb5f885bSMike Smith 		    /* FALLTHROUGH */
6106c233a71SPeter Wemm 		case PNP_TAG_END:
611cb5f885bSMike Smith 		    idx = left;
612cb5f885bSMike Smith 		    break;
613cb5f885bSMike Smith 		default:
614cb5f885bSMike Smith 		    idx += PNP_SRES_LEN(tag);
615cb5f885bSMike Smith 		    break;
616cb5f885bSMike Smith 		}
617cb5f885bSMike Smith 	    } else
618cb5f885bSMike Smith 		/* Large resource, skip it */
619cb5f885bSMike Smith 		idx += *(u_int16_t *)(pd->devdata + idx) + 2;
620cb5f885bSMike Smith 	}
621cb5f885bSMike Smith 	if (bootverbose) {
622cb5f885bSMike Smith 	    printf("pnpbios: handle %d device ID %s (%08x)",
623bb2b9030SDoug Rabson 		   pd->handle, pnp_eisaformat(*devid), *devid);
624cb5f885bSMike Smith 	    if (compid != NULL)
625cb5f885bSMike Smith 		printf(" compat ID %s (%08x)",
626bb2b9030SDoug Rabson 		       pnp_eisaformat(*compid), *compid);
627cb5f885bSMike Smith 	    printf("\n");
628cb5f885bSMike Smith 	}
629cb5f885bSMike Smith     }
630cb5f885bSMike Smith }
631cb5f885bSMike Smith 
632bb2b9030SDoug Rabson static device_method_t pnpbios_methods[] = {
633bb2b9030SDoug Rabson 	/* Device interface */
634bb2b9030SDoug Rabson 	DEVMETHOD(device_identify,	pnpbios_identify),
635cb5f885bSMike Smith 
636bb2b9030SDoug Rabson 	{ 0, 0 }
637bb2b9030SDoug Rabson };
638bb2b9030SDoug Rabson 
639bb2b9030SDoug Rabson static driver_t pnpbios_driver = {
640bb2b9030SDoug Rabson 	"pnpbios",
641bb2b9030SDoug Rabson 	pnpbios_methods,
642bb2b9030SDoug Rabson 	1,			/* no softc */
643bb2b9030SDoug Rabson };
644bb2b9030SDoug Rabson 
645bb2b9030SDoug Rabson static devclass_t pnpbios_devclass;
646bb2b9030SDoug Rabson 
647bb2b9030SDoug Rabson DRIVER_MODULE(pnpbios, isa, pnpbios_driver, pnpbios_devclass, 0, 0);
648