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