1 /* $OpenBSD: vga_post.c,v 1.11 2021/01/03 02:29:28 jmatthew Exp $ */
2 /* $NetBSD: vga_post.c,v 1.12 2009/03/15 21:32:36 cegger Exp $ */
3
4 /*-
5 * Copyright (c) 2007 Joerg Sonnenberger <joerg@NetBSD.org>.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 *
12 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in
16 * the documentation and/or other materials provided with the
17 * distribution.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
21 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
22 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
23 * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
24 * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING,
25 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
26 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
27 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
28 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
29 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30 * SUCH DAMAGE.
31 */
32
33 #include <sys/param.h>
34 #include <sys/device.h>
35 #include <sys/malloc.h>
36
37 #include <uvm/uvm_extern.h>
38
39 #include <machine/pio.h>
40
41 #include <dev/x86emu/x86emu.h>
42 #include <dev/x86emu/x86emu_regs.h>
43
44 #define BASE_MEMORY 65536 /* How much memory to allocate in Real Mode */
45
46 struct vga_post {
47 struct x86emu emu;
48 vaddr_t sys_image;
49 uint32_t initial_eax;
50 uint8_t bios_data[PAGE_SIZE];
51 struct pglist ram_backing;
52 };
53
54 #ifdef DDB
55 static struct vga_post *ddb_vgapostp;
56 void ddb_vgapost(void);
57 #endif
58
59 static uint8_t
vm86_emu_inb(struct x86emu * emu,uint16_t port)60 vm86_emu_inb(struct x86emu *emu, uint16_t port)
61 {
62 if (port == 0xb2) /* APM scratch register */
63 return 0;
64
65 if (port >= 0x80 && port < 0x88) /* POST status register */
66 return 0;
67
68 return inb(port);
69 }
70
71 static uint16_t
vm86_emu_inw(struct x86emu * emu,uint16_t port)72 vm86_emu_inw(struct x86emu *emu, uint16_t port)
73 {
74 if (port >= 0x80 && port < 0x88) /* POST status register */
75 return 0;
76
77 return inw(port);
78 }
79
80 static uint32_t
vm86_emu_inl(struct x86emu * emu,uint16_t port)81 vm86_emu_inl(struct x86emu *emu, uint16_t port)
82 {
83 if (port >= 0x80 && port < 0x88) /* POST status register */
84 return 0;
85
86 return inl(port);
87 }
88
89 static void
vm86_emu_outb(struct x86emu * emu,uint16_t port,uint8_t val)90 vm86_emu_outb(struct x86emu *emu, uint16_t port, uint8_t val)
91 {
92 if (port == 0xb2) /* APM scratch register */
93 return;
94
95 if (port >= 0x80 && port < 0x88) /* POST status register */
96 return;
97
98 outb(port, val);
99 }
100
101 static void
vm86_emu_outw(struct x86emu * emu,uint16_t port,uint16_t val)102 vm86_emu_outw(struct x86emu *emu, uint16_t port, uint16_t val)
103 {
104 if (port >= 0x80 && port < 0x88) /* POST status register */
105 return;
106
107 outw(port, val);
108 }
109
110 static void
vm86_emu_outl(struct x86emu * emu,uint16_t port,uint32_t val)111 vm86_emu_outl(struct x86emu *emu, uint16_t port, uint32_t val)
112 {
113 if (port >= 0x80 && port < 0x88) /* POST status register */
114 return;
115
116 outl(port, val);
117 }
118
119 struct vga_post *
vga_post_init(int bus,int device,int function)120 vga_post_init(int bus, int device, int function)
121 {
122 struct vga_post *sc;
123 vaddr_t iter;
124 struct vm_page *pg;
125 vaddr_t sys_image, sys_bios_data;
126 int err;
127
128 sys_bios_data = (vaddr_t)km_alloc(PAGE_SIZE, &kv_any, &kp_none,
129 &kd_nowait);
130 if (sys_bios_data == 0)
131 return NULL;
132
133 sys_image = (vaddr_t)km_alloc(1024 * 1024, &kv_any, &kp_none,
134 &kd_nowait);
135 if (sys_image == 0) {
136 km_free((void *)sys_bios_data, PAGE_SIZE, &kv_any, &kp_none);
137 return NULL;
138 }
139 sc = malloc(sizeof(*sc), M_DEVBUF, M_WAITOK|M_ZERO);
140
141 TAILQ_INIT(&sc->ram_backing);
142 err = uvm_pglistalloc(BASE_MEMORY, 0, (paddr_t)-1, 0, 0,
143 &sc->ram_backing, BASE_MEMORY/PAGE_SIZE, UVM_PLA_WAITOK);
144 if (err) {
145 km_free((void *)sc->sys_image, 1024 * 1024, &kv_any, &kp_none);
146 free(sc, M_DEVBUF, sizeof(*sc));
147 return NULL;
148 }
149
150 sc->sys_image = sys_image;
151 sc->emu.sys_private = sc;
152
153 pmap_kenter_pa(sys_bios_data, 0, PROT_READ);
154 pmap_update(pmap_kernel());
155 memcpy((void *)sc->bios_data, (void *)sys_bios_data, PAGE_SIZE);
156 pmap_kremove(sys_bios_data, PAGE_SIZE);
157 km_free((void *)sys_bios_data, PAGE_SIZE, &kv_any, &kp_none);
158
159 iter = 0;
160 TAILQ_FOREACH(pg, &sc->ram_backing, pageq) {
161 pmap_kenter_pa(sc->sys_image + iter, VM_PAGE_TO_PHYS(pg),
162 PROT_READ | PROT_WRITE);
163 iter += PAGE_SIZE;
164 }
165 KASSERT(iter == BASE_MEMORY);
166
167 for (iter = 640 * 1024; iter < 1024 * 1024; iter += PAGE_SIZE)
168 pmap_kenter_pa(sc->sys_image + iter, iter,
169 PROT_READ | PROT_WRITE);
170 pmap_update(pmap_kernel());
171
172 memset(&sc->emu, 0, sizeof(sc->emu));
173 x86emu_init_default(&sc->emu);
174 sc->emu.emu_inb = vm86_emu_inb;
175 sc->emu.emu_inw = vm86_emu_inw;
176 sc->emu.emu_inl = vm86_emu_inl;
177 sc->emu.emu_outb = vm86_emu_outb;
178 sc->emu.emu_outw = vm86_emu_outw;
179 sc->emu.emu_outl = vm86_emu_outl;
180
181 sc->emu.mem_base = (char *)sc->sys_image;
182 sc->emu.mem_size = 1024 * 1024;
183
184 sc->initial_eax = bus * 256 + device * 8 + function;
185 #ifdef DDB
186 ddb_vgapostp = sc;
187 #endif
188 return sc;
189 }
190
191 void
vga_post_call(struct vga_post * sc)192 vga_post_call(struct vga_post *sc)
193 {
194 sc->emu.x86.R_EAX = sc->initial_eax;
195 sc->emu.x86.R_EDX = 0x00000080;
196 sc->emu.x86.R_DS = 0x0040;
197 sc->emu.x86.register_flags = 0x3200;
198
199 memcpy((void *)sc->sys_image, sc->bios_data, PAGE_SIZE);
200
201 /* stack is at the end of the first 64KB */
202 sc->emu.x86.R_SS = 0;
203 sc->emu.x86.R_ESP = 0;
204
205 /* Jump straight into the VGA BIOS POST code */
206 x86emu_exec_call(&sc->emu, 0xc000, 0x0003);
207 }
208
209 void
vga_post_free(struct vga_post * sc)210 vga_post_free(struct vga_post *sc)
211 {
212 uvm_pglistfree(&sc->ram_backing);
213 pmap_kremove(sc->sys_image, 1024 * 1024);
214 km_free((void *)sc->sys_image, 1024 * 1024, &kv_any, &kp_none)
215 pmap_update(pmap_kernel());
216 free(sc, M_DEVBUF, sizeof(*sc));
217 }
218
219 #ifdef DDB
220 void
ddb_vgapost(void)221 ddb_vgapost(void)
222 {
223
224 if (ddb_vgapostp)
225 vga_post_call(ddb_vgapostp);
226 else
227 printf("ddb_vgapost: vga_post not initialized\n");
228 }
229 #endif
230