#include <sys/cdefs.h>
#include "opt_isa.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/module.h>
#include <sys/bus.h>
#include <sys/pcpu.h>
#include <sys/stdarg.h>
#include <vm/vm.h>
#include <vm/pmap.h>
#include <machine/md_var.h>
#include <machine/segments.h>
#include <machine/vmparam.h>
#include <machine/pc/bios.h>
#ifdef DEV_ISA
#include <isa/isavar.h>
#include <isa/pnpreg.h>
#include <isa/pnpvar.h>
#endif
#define BIOS_START 0xe0000
#define BIOS_SIZE 0x20000
struct bios32_SDentry PCIbios;
static struct PnPBIOS_table *PnPBIOStable;
static u_int bios32_SDCI;
static void bios32_init(void *junk);
SYSINIT(bios32, SI_SUB_CPU, SI_ORDER_ANY, bios32_init, NULL);
static void
bios32_init(void *junk)
{
u_long sigaddr;
struct bios32_SDheader *sdh;
struct PnPBIOS_table *pt;
u_int8_t ck, *cv;
int i;
char *p;
if ((sigaddr = bios_sigsearch(0, "_32_", 4, 16, 0)) != 0) {
sdh = (struct bios32_SDheader *)(uintptr_t)BIOS_PADDRTOVADDR(sigaddr);
for (cv = (u_int8_t *)sdh, ck = 0, i = 0; i < (sdh->len * 16); i++) {
ck += cv[i];
}
if ((ck == 0) && (BIOS_START <= sdh->entry ) &&
(sdh->entry < (BIOS_START + BIOS_SIZE))) {
bios32_SDCI = BIOS_PADDRTOVADDR(sdh->entry);
if (bootverbose) {
printf("bios32: Found BIOS32 Service Directory header at %p\n", sdh);
printf("bios32: Entry = 0x%x (%x) Rev = %d Len = %d\n",
sdh->entry, bios32_SDCI, sdh->revision, sdh->len);
}
if (((p = kern_getenv("machdep.bios.pci")) == NULL) || strcmp(p, "disable")) {
PCIbios.ident.id = 0x49435024;
if (!bios32_SDlookup(&PCIbios) && bootverbose)
printf("pcibios: PCI BIOS entry at 0x%x+0x%x\n", PCIbios.base, PCIbios.entry);
}
if (p != NULL)
freeenv(p);
} else {
printf("bios32: Bad BIOS32 Service Directory\n");
}
}
if ((((p = kern_getenv("machdep.bios.pnp")) == NULL) || strcmp(p, "disable")) &&
((sigaddr = bios_sigsearch(0, "$PnP", 4, 16, 0)) != 0)) {
pt = (struct PnPBIOS_table *)(uintptr_t)BIOS_PADDRTOVADDR(sigaddr);
for (cv = (u_int8_t *)pt, ck = 0, i = 0; i < pt->len; i++) {
ck += cv[i];
}
if (ck == 0) {
PnPBIOStable = pt;
if (bootverbose) {
printf("pnpbios: Found PnP BIOS data at %p\n", pt);
printf("pnpbios: Entry = %x:%x Rev = %d.%d\n",
pt->pmentrybase, pt->pmentryoffset, pt->version >> 4, pt->version & 0xf);
if ((pt->control & 0x3) == 0x01)
printf("pnpbios: Event flag at %x\n", pt->evflagaddr);
if (pt->oemdevid != 0)
printf("pnpbios: OEM ID %x\n", pt->oemdevid);
}
} else {
printf("pnpbios: Bad PnP BIOS data checksum\n");
}
}
if (p != NULL)
freeenv(p);
if (bootverbose) {
printf("Other BIOS signatures found:\n");
}
}
int
bios32_SDlookup(struct bios32_SDentry *ent)
{
struct bios_regs args;
if (bios32_SDCI == 0)
return (1);
args.eax = ent->ident.id;
args.ebx = args.ecx = args.edx = 0;
bios32(&args, bios32_SDCI, GSEL(GCODE_SEL, SEL_KPL));
if ((args.eax & 0xff) == 0) {
ent->base = args.ebx;
ent->len = args.ecx;
ent->entry = args.edx;
ent->ventry = BIOS_PADDRTOVADDR(ent->base + ent->entry);
return (0);
}
return (1);
}
u_int32_t
bios_sigsearch(u_int32_t start, u_char *sig, int siglen, int paralen, int sigofs)
{
u_char *sp, *end;
if ((start >= BIOS_START) && (start <= (BIOS_START + BIOS_SIZE))) {
sp = (char *)BIOS_PADDRTOVADDR(start);
} else if (start == 0) {
sp = (char *)BIOS_PADDRTOVADDR(BIOS_START);
} else {
return 0;
}
end = (u_char *)BIOS_PADDRTOVADDR(BIOS_START + BIOS_SIZE);
while ((sp + sigofs + siglen) < end) {
if (!bcmp(sp + sigofs, sig, siglen)) {
return((u_int32_t)BIOS_VADDRTOPADDR(sp));
}
sp += paralen;
}
return(0);
}
union {
struct {
u_short offset;
u_short segment;
} vec16;
struct {
u_int offset;
u_short segment;
} vec32;
} bioscall_vector;
void
set_bios_selectors(struct bios_segments *seg, int flags)
{
struct soft_segment_descriptor ssd = {
0,
0,
SDT_MEMERA,
0,
1,
0, 0,
1,
0
};
union descriptor *p_gdt;
#ifdef SMP
p_gdt = &gdt[PCPU_GET(cpuid) * NGDT];
#else
p_gdt = gdt;
#endif
ssd.ssd_base = seg->code32.base;
ssd.ssd_limit = seg->code32.limit;
ssdtosd(&ssd, &p_gdt[GBIOSCODE32_SEL].sd);
ssd.ssd_def32 = 0;
if (flags & BIOSCODE_FLAG) {
ssd.ssd_base = seg->code16.base;
ssd.ssd_limit = seg->code16.limit;
ssdtosd(&ssd, &p_gdt[GBIOSCODE16_SEL].sd);
}
ssd.ssd_type = SDT_MEMRWA;
if (flags & BIOSDATA_FLAG) {
ssd.ssd_base = seg->data.base;
ssd.ssd_limit = seg->data.limit;
ssdtosd(&ssd, &p_gdt[GBIOSDATA_SEL].sd);
}
if (flags & BIOSUTIL_FLAG) {
ssd.ssd_base = seg->util.base;
ssd.ssd_limit = seg->util.limit;
ssdtosd(&ssd, &p_gdt[GBIOSUTIL_SEL].sd);
}
if (flags & BIOSARGS_FLAG) {
ssd.ssd_base = seg->args.base;
ssd.ssd_limit = seg->args.limit;
ssdtosd(&ssd, &p_gdt[GBIOSARGS_SEL].sd);
}
}
extern int vm86pa;
extern u_long vm86phystk;
extern void bios16_jmp(void);
int
bios16(struct bios_args *args, char *fmt, ...)
{
char *p, *stack, *stack_top;
va_list ap;
int flags = BIOSCODE_FLAG | BIOSDATA_FLAG;
u_int i, arg_start, arg_end;
void *bios16_pmap_handle;
arg_start = 0xffffffff;
arg_end = 0;
stack = (caddr_t)PAGE_SIZE - 32;
va_start(ap, fmt);
for (p = fmt; p && *p; p++) {
switch (*p) {
case 'p':
i = va_arg(ap, u_int);
arg_start = min(arg_start, i);
arg_end = max(arg_end, i);
flags |= BIOSARGS_FLAG;
stack -= 4;
break;
case 'i':
i = va_arg(ap, u_int);
stack -= 4;
break;
case 'U':
flags |= BIOSUTIL_FLAG;
case 'D':
case 'C':
stack -= 2;
break;
case 's':
i = va_arg(ap, int);
stack -= 2;
break;
default:
va_end(ap);
return (EINVAL);
}
}
va_end(ap);
if (flags & BIOSARGS_FLAG) {
if (arg_end - arg_start > ctob(16))
return (EACCES);
args->seg.args.base = arg_start;
args->seg.args.limit = 0xffff;
}
args->seg.code32.base = pmap_pg_frame((u_int)&bios16_jmp);
args->seg.code32.limit = 0xffff;
bios16_pmap_handle = pmap_bios16_enter();
stack_top = stack;
va_start(ap, fmt);
for (p = fmt; p && *p; p++) {
switch (*p) {
case 'p':
i = va_arg(ap, u_int);
*(u_int *)stack = (i - arg_start) |
(GSEL(GBIOSARGS_SEL, SEL_KPL) << 16);
stack += 4;
break;
case 'i':
i = va_arg(ap, u_int);
*(u_int *)stack = i;
stack += 4;
break;
case 'U':
*(u_short *)stack = GSEL(GBIOSUTIL_SEL, SEL_KPL);
stack += 2;
break;
case 'D':
*(u_short *)stack = GSEL(GBIOSDATA_SEL, SEL_KPL);
stack += 2;
break;
case 'C':
*(u_short *)stack = GSEL(GBIOSCODE16_SEL, SEL_KPL);
stack += 2;
break;
case 's':
i = va_arg(ap, int);
*(u_short *)stack = i;
stack += 2;
break;
default:
va_end(ap);
return (EINVAL);
}
}
va_end(ap);
set_bios_selectors(&args->seg, flags);
bioscall_vector.vec16.offset = (u_short)args->entry;
bioscall_vector.vec16.segment = GSEL(GBIOSCODE16_SEL, SEL_KPL);
i = bios16_call(&args->r, stack_top);
pmap_bios16_leave(bios16_pmap_handle);
return (i);
}
int
bios_oem_strings(struct bios_oem *oem, u_char *buffer, size_t maxlen)
{
size_t idx = 0;
struct bios_oem_signature *sig;
u_int from, to;
u_char c, *s, *se, *str, *bios_str;
size_t i, off, len, tot;
if ( !oem || !buffer || maxlen<2 )
return(-1);
sig = oem->signature;
if (!sig)
return(-2);
from = oem->range.from;
to = oem->range.to;
if ( (to<=from) || (from<BIOS_START) || (to>(BIOS_START+BIOS_SIZE)) )
return(-3);
while (sig->anchor != NULL) {
str = sig->anchor;
len = strlen(str);
off = sig->offset;
tot = sig->totlen;
if ( (to+off)>(BIOS_START+BIOS_SIZE) ||
((from+off)<BIOS_START) ) {
printf("sys/i386/i386/bios.c: sig '%s' "
"from 0x%0x to 0x%0x offset %d "
"out of BIOS bounds 0x%0x - 0x%0x\n",
str, from, to, off,
BIOS_START, BIOS_START+BIOS_SIZE);
return(-4);
}
if (idx + tot > maxlen - 1) {
printf("sys/i386/i386/bios.c: sig '%s' "
"idx %d + tot %d = %d > maxlen-1 %d\n",
str, idx, tot, idx+tot, maxlen-1);
return(-5);
}
bios_str = NULL;
s = (u_char *)BIOS_PADDRTOVADDR(from);
se = (u_char *)BIOS_PADDRTOVADDR(to-len);
for (; s<se; s++) {
if (!bcmp(str, s, len)) {
bios_str = s;
break;
}
}
if (bios_str) {
for (i=0; i<tot; i++) {
c = bios_str[i+off];
if ( (c < 0x20) || (c > 0x7E) )
c = ' ';
if (idx == 0) {
if (c != ' ')
buffer[idx++] = c;
} else if ( (c != ' ') ||
((c == ' ') && (buffer[idx-1] != ' ')) )
buffer[idx++] = c;
}
}
sig++;
}
if ( (idx > 1) && (buffer[idx-1] == ' ') )
idx--;
buffer[idx] = '\0';
return (idx);
}
#ifdef DEV_ISA
struct pnp_sysdev
{
u_int16_t size;
u_int8_t handle;
u_int32_t devid;
u_int8_t type[3];
u_int16_t attrib;
#define PNPATTR_NODISABLE (1<<0)
#define PNPATTR_NOCONFIG (1<<1)
#define PNPATTR_OUTPUT (1<<2)
#define PNPATTR_INPUT (1<<3)
#define PNPATTR_BOOTABLE (1<<4)
#define PNPATTR_DOCK (1<<5)
#define PNPATTR_REMOVEABLE (1<<6)
#define PNPATTR_CONFIG_STATIC (0)
#define PNPATTR_CONFIG_DYNAMIC (1)
#define PNPATTR_CONFIG_DYNONLY (3)
#define PNPATTR_CONFIG(a) (((a) >> 7) & 0x3)
u_int8_t devdata[0];
} __packed;
struct pnp_sysdevargs
{
u_int16_t next;
struct pnp_sysdev node;
};
static void
pnpbios_set_config(void *arg, struct isa_config *config, int enable)
{
}
static void
pnpbios_identify(driver_t *driver, device_t parent)
{
struct PnPBIOS_table *pt = PnPBIOStable;
struct bios_args args;
struct pnp_sysdev *pd;
struct pnp_sysdevargs *pda;
u_int16_t ndevs, bigdev;
int error, currdev;
u_int8_t *devnodebuf, tag;
u_int32_t *devid, *compid;
int idx, left;
device_t dev;
if (pt == NULL)
return;
dev = devclass_get_device(devclass_find("acpi"), 0);
if (dev != NULL && device_is_attached(dev))
return;
bzero(&args, sizeof(args));
args.seg.code16.base = BIOS_PADDRTOVADDR(pt->pmentrybase);
args.seg.code16.limit = 0xffff;
args.seg.data.base = BIOS_PADDRTOVADDR(pt->pmdataseg);
args.seg.data.limit = 0xffff;
args.entry = pt->pmentryoffset;
if ((error = bios16(&args, PNP_COUNT_DEVNODES, &ndevs, &bigdev)) || (args.r.eax & 0xff)) {
printf("pnpbios: error %d/%x getting device count/size limit\n", error, args.r.eax);
return;
}
ndevs &= 0xff;
if (bootverbose)
printf("pnpbios: %d devices, largest %d bytes\n", ndevs, bigdev);
devnodebuf = malloc(bigdev + (sizeof(struct pnp_sysdevargs) - sizeof(struct pnp_sysdev)),
M_DEVBUF, M_NOWAIT);
if (devnodebuf == NULL) {
printf("pnpbios: cannot allocate memory, bailing\n");
return;
}
pda = (struct pnp_sysdevargs *)devnodebuf;
pd = &pda->node;
for (currdev = 0, left = ndevs; (currdev != 0xff) && (left > 0); left--) {
bzero(pd, bigdev);
pda->next = currdev;
if ((error = bios16(&args, PNP_GET_DEVNODE, &pda->next, &pda->node, 1))) {
printf("pnpbios: error %d making BIOS16 call\n", error);
break;
}
if ((error = (args.r.eax & 0xff))) {
if (bootverbose)
printf("pnpbios: %s 0x%x fetching node %d\n", error & 0x80 ? "error" : "warning", error, currdev);
if (error & 0x80)
break;
}
currdev = pda->next;
if (pd->size < sizeof(struct pnp_sysdev)) {
printf("pnpbios: bogus system node data, aborting scan\n");
break;
}
if (!strcmp(pnp_eisaformat(pd->devid), "PNP0000"))
continue;
if (!strcmp(pnp_eisaformat(pd->devid), "PNP0003"))
continue;
dev = BUS_ADD_CHILD(parent, ISA_ORDER_PNPBIOS, NULL, DEVICE_UNIT_ANY);
isa_set_vendorid(dev, pd->devid);
isa_set_logicalid(dev, pd->devid);
isa_set_configattr(dev,
(!(pd->attrib & PNPATTR_NOCONFIG) &&
PNPATTR_CONFIG(pd->attrib) != PNPATTR_CONFIG_STATIC)
? ISACFGATTR_DYNAMIC : 0);
isa_set_pnpbios_handle(dev, pd->handle);
ISA_SET_CONFIG_CALLBACK(parent, dev, pnpbios_set_config, 0);
pnp_parse_resources(dev, &pd->devdata[0],
pd->size - sizeof(struct pnp_sysdev), 0);
if (!device_get_desc(dev))
device_set_desc_copy(dev, pnp_eisaformat(pd->devid));
devid = &pd->devid;
compid = NULL;
left = pd->size - sizeof(struct pnp_sysdev);
idx = 0;
while (idx < left) {
tag = pd->devdata[idx++];
if (PNP_RES_TYPE(tag) == 0) {
switch (PNP_SRES_NUM(tag)) {
case PNP_TAG_COMPAT_DEVICE:
compid = (u_int32_t *)(pd->devdata + idx);
if (bootverbose)
printf("pnpbios: node %d compat ID 0x%08x\n", pd->handle, *compid);
case PNP_TAG_END:
idx = left;
break;
default:
idx += PNP_SRES_LEN(tag);
break;
}
} else
idx += *(u_int16_t *)(pd->devdata + idx) + 2;
}
if (bootverbose) {
printf("pnpbios: handle %d device ID %s (%08x)",
pd->handle, pnp_eisaformat(*devid), *devid);
if (compid != NULL)
printf(" compat ID %s (%08x)",
pnp_eisaformat(*compid), *compid);
printf("\n");
}
}
}
static device_method_t pnpbios_methods[] = {
DEVMETHOD(device_identify, pnpbios_identify),
{ 0, 0 }
};
static driver_t pnpbios_driver = {
"pnpbios",
pnpbios_methods,
1,
};
DRIVER_MODULE(pnpbios, isa, pnpbios_driver, 0, 0);
#endif