1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
|
// PNP BIOS calls
//
// Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net>
//
// This file may be distributed under the terms of the GNU LGPLv3 license.
#include "config.h" // BUILD_BIOS_ADDR
#include "farptr.h" // SET_FARVAR
#include "output.h" // dprintf
#include "std/pnpbios.h" // PNP_SIGNATURE
#include "string.h" // checksum
#include "util.h" // pnp_init
extern struct pnpheader PNPHEADER;
extern char pnp_string[];
#if CONFIG_PNPBIOS
struct pnpheader PNPHEADER __aligned(16) VARFSEG = {
.signature = PNP_SIGNATURE,
.version = 0x10,
.length = sizeof(PNPHEADER),
.real_cs = SEG_BIOS,
.prot_base = BUILD_BIOS_ADDR,
.real_ds = SEG_BIOS,
.prot_database = BUILD_BIOS_ADDR,
};
#else
// We need a copy of this string in the 0xf000 segment, but we are not
// actually a PnP BIOS, so make sure it is *not* aligned, so OSes will
// not see it if they scan.
char pnp_string[] __aligned(2) VARFSEG = " $PnP";
#endif
// BBS - Get Version and Installation Check
static u16
handle_pnp60(u16 *args)
{
u16 version_ptr = args[1];
u16 version_seg = args[2];
SET_FARVAR(version_seg, *(u16*)(version_ptr+0), 0x0101);
return 0;
}
static u16
handle_pnpXX(u16 *args)
{
return FUNCTION_NOT_SUPPORTED;
}
u16 VISIBLE16
handle_pnp(u16 *args)
{
if (! CONFIG_PNPBIOS)
return FUNCTION_NOT_SUPPORTED;
u16 arg1 = args[0];
dprintf(DEBUG_HDL_pnp, "pnp call arg1=%x\n", arg1);
switch (arg1) {
case 0x60: return handle_pnp60(args);
default: return handle_pnpXX(args);
}
}
u16
get_pnp_offset(void)
{
if (! CONFIG_PNPBIOS)
return (u32)pnp_string + 1 - BUILD_BIOS_ADDR;
return (u32)&PNPHEADER - BUILD_BIOS_ADDR;
}
// romlayout.S
extern void entry_pnp_real(void);
extern void entry_pnp_prot(void);
void
pnp_init(void)
{
if (! CONFIG_PNPBIOS)
return;
dprintf(3, "init PNPBIOS table\n");
PNPHEADER.real_ip = (u32)entry_pnp_real - BUILD_BIOS_ADDR;
PNPHEADER.prot_ip = (u32)entry_pnp_prot - BUILD_BIOS_ADDR;
PNPHEADER.checksum -= checksum(&PNPHEADER, sizeof(PNPHEADER));
}
|
