Commit 329939776005fad213086e54b038ccd39054e2bc
Committed by
Anthony Liguori
1 parent
89e671e3
split out ioport related stuffs from vl.c into ioport.c.
Signed-off-by: Isaku Yamahata <yamahata@valinux.co.jp> Signed-off-by: Anthony Liguori <aliguori@us.ibm.com>
Showing
7 changed files
with
317 additions
and
248 deletions
Makefile.target
... | ... | @@ -489,7 +489,7 @@ endif #CONFIG_BSD_USER |
489 | 489 | ifndef CONFIG_USER_ONLY |
490 | 490 | |
491 | 491 | obj-y = vl.o osdep.o monitor.o pci.o loader.o isa_mmio.o machine.o \ |
492 | - gdbstub.o gdbstub-xml.o msix.o | |
492 | + gdbstub.o gdbstub-xml.o msix.o ioport.o | |
493 | 493 | # virtio has to be here due to weird dependency between PCI and virtio-net. |
494 | 494 | # need to fix this properly |
495 | 495 | obj-y += virtio-blk.o virtio-balloon.o virtio-net.o virtio-console.o | ... | ... |
cpu-all.h
... | ... | @@ -837,17 +837,7 @@ void cpu_set_log_filename(const char *filename); |
837 | 837 | int cpu_str_to_log_mask(const char *str); |
838 | 838 | |
839 | 839 | /* IO ports API */ |
840 | - | |
841 | -/* NOTE: as these functions may be even used when there is an isa | |
842 | - brige on non x86 targets, we always defined them */ | |
843 | -#ifndef NO_CPU_IO_DEFS | |
844 | -void cpu_outb(CPUState *env, int addr, int val); | |
845 | -void cpu_outw(CPUState *env, int addr, int val); | |
846 | -void cpu_outl(CPUState *env, int addr, int val); | |
847 | -int cpu_inb(CPUState *env, int addr); | |
848 | -int cpu_inw(CPUState *env, int addr); | |
849 | -int cpu_inl(CPUState *env, int addr); | |
850 | -#endif | |
840 | +#include "ioport.h" | |
851 | 841 | |
852 | 842 | /* memory API */ |
853 | 843 | ... | ... |
hw/hw.h
... | ... | @@ -10,6 +10,7 @@ |
10 | 10 | #include "cpu-common.h" |
11 | 11 | #endif |
12 | 12 | |
13 | +#include "ioport.h" | |
13 | 14 | #include "irq.h" |
14 | 15 | |
15 | 16 | /* VM Load/Save */ |
... | ... | @@ -266,8 +267,4 @@ void qemu_register_reset(QEMUResetHandler *func, void *opaque); |
266 | 267 | typedef int QEMUBootSetHandler(void *opaque, const char *boot_device); |
267 | 268 | void qemu_register_boot_set(QEMUBootSetHandler *func, void *opaque); |
268 | 269 | |
269 | -/* These should really be in isa.h, but are here to make pc.h happy. */ | |
270 | -typedef void (IOPortWriteFunc)(void *opaque, uint32_t address, uint32_t data); | |
271 | -typedef uint32_t (IOPortReadFunc)(void *opaque, uint32_t address); | |
272 | - | |
273 | 270 | #endif | ... | ... |
hw/isa.h
... | ... | @@ -2,13 +2,9 @@ |
2 | 2 | #define HW_ISA_H |
3 | 3 | /* ISA bus */ |
4 | 4 | |
5 | -extern target_phys_addr_t isa_mem_base; | |
5 | +#include "ioport.h" | |
6 | 6 | |
7 | -int register_ioport_read(int start, int length, int size, | |
8 | - IOPortReadFunc *func, void *opaque); | |
9 | -int register_ioport_write(int start, int length, int size, | |
10 | - IOPortWriteFunc *func, void *opaque); | |
11 | -void isa_unassign_ioport(int start, int length); | |
7 | +extern target_phys_addr_t isa_mem_base; | |
12 | 8 | |
13 | 9 | void isa_mmio_init(target_phys_addr_t base, target_phys_addr_t size); |
14 | 10 | ... | ... |
ioport.c
0 → 100644
1 | +/* | |
2 | + * QEMU System Emulator | |
3 | + * | |
4 | + * Copyright (c) 2003-2008 Fabrice Bellard | |
5 | + * | |
6 | + * Permission is hereby granted, free of charge, to any person obtaining a copy | |
7 | + * of this software and associated documentation files (the "Software"), to deal | |
8 | + * in the Software without restriction, including without limitation the rights | |
9 | + * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell | |
10 | + * copies of the Software, and to permit persons to whom the Software is | |
11 | + * furnished to do so, subject to the following conditions: | |
12 | + * | |
13 | + * The above copyright notice and this permission notice shall be included in | |
14 | + * all copies or substantial portions of the Software. | |
15 | + * | |
16 | + * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
17 | + * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
18 | + * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | |
19 | + * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | |
20 | + * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | |
21 | + * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN | |
22 | + * THE SOFTWARE. | |
23 | + */ | |
24 | +/* | |
25 | + * splitted out ioport related stuffs from vl.c. | |
26 | + */ | |
27 | + | |
28 | +#include "ioport.h" | |
29 | + | |
30 | +/***********************************************************/ | |
31 | +/* IO Port */ | |
32 | + | |
33 | +//#define DEBUG_UNUSED_IOPORT | |
34 | +//#define DEBUG_IOPORT | |
35 | + | |
36 | +#ifdef DEBUG_IOPORT | |
37 | +# define LOG_IOPORT(...) qemu_log_mask(CPU_LOG_IOPORT, ## __VA_ARGS__) | |
38 | +#else | |
39 | +# define LOG_IOPORT(...) do { } while (0) | |
40 | +#endif | |
41 | + | |
42 | +/* XXX: use a two level table to limit memory usage */ | |
43 | + | |
44 | +static void *ioport_opaque[MAX_IOPORTS]; | |
45 | +static IOPortReadFunc *ioport_read_table[3][MAX_IOPORTS]; | |
46 | +static IOPortWriteFunc *ioport_write_table[3][MAX_IOPORTS]; | |
47 | + | |
48 | +static IOPortReadFunc default_ioport_readb, default_ioport_readw, default_ioport_readl; | |
49 | +static IOPortWriteFunc default_ioport_writeb, default_ioport_writew, default_ioport_writel; | |
50 | + | |
51 | +static uint32_t ioport_read(int index, uint32_t address) | |
52 | +{ | |
53 | + static IOPortReadFunc *default_func[3] = { | |
54 | + default_ioport_readb, | |
55 | + default_ioport_readw, | |
56 | + default_ioport_readl | |
57 | + }; | |
58 | + IOPortReadFunc *func = ioport_read_table[index][address]; | |
59 | + if (!func) | |
60 | + func = default_func[index]; | |
61 | + return func(ioport_opaque[address], address); | |
62 | +} | |
63 | + | |
64 | +static void ioport_write(int index, uint32_t address, uint32_t data) | |
65 | +{ | |
66 | + static IOPortWriteFunc *default_func[3] = { | |
67 | + default_ioport_writeb, | |
68 | + default_ioport_writew, | |
69 | + default_ioport_writel | |
70 | + }; | |
71 | + IOPortWriteFunc *func = ioport_write_table[index][address]; | |
72 | + if (!func) | |
73 | + func = default_func[index]; | |
74 | + func(ioport_opaque[address], address, data); | |
75 | +} | |
76 | + | |
77 | +static uint32_t default_ioport_readb(void *opaque, uint32_t address) | |
78 | +{ | |
79 | +#ifdef DEBUG_UNUSED_IOPORT | |
80 | + fprintf(stderr, "unused inb: port=0x%04x\n", address); | |
81 | +#endif | |
82 | + return 0xff; | |
83 | +} | |
84 | + | |
85 | +static void default_ioport_writeb(void *opaque, uint32_t address, uint32_t data) | |
86 | +{ | |
87 | +#ifdef DEBUG_UNUSED_IOPORT | |
88 | + fprintf(stderr, "unused outb: port=0x%04x data=0x%02x\n", address, data); | |
89 | +#endif | |
90 | +} | |
91 | + | |
92 | +/* default is to make two byte accesses */ | |
93 | +static uint32_t default_ioport_readw(void *opaque, uint32_t address) | |
94 | +{ | |
95 | + uint32_t data; | |
96 | + data = ioport_read(0, address); | |
97 | + address = (address + 1) & (MAX_IOPORTS - 1); | |
98 | + data |= ioport_read(0, address) << 8; | |
99 | + return data; | |
100 | +} | |
101 | + | |
102 | +static void default_ioport_writew(void *opaque, uint32_t address, uint32_t data) | |
103 | +{ | |
104 | + ioport_write(0, address, data & 0xff); | |
105 | + address = (address + 1) & (MAX_IOPORTS - 1); | |
106 | + ioport_write(0, address, (data >> 8) & 0xff); | |
107 | +} | |
108 | + | |
109 | +static uint32_t default_ioport_readl(void *opaque, uint32_t address) | |
110 | +{ | |
111 | +#ifdef DEBUG_UNUSED_IOPORT | |
112 | + fprintf(stderr, "unused inl: port=0x%04x\n", address); | |
113 | +#endif | |
114 | + return 0xffffffff; | |
115 | +} | |
116 | + | |
117 | +static void default_ioport_writel(void *opaque, uint32_t address, uint32_t data) | |
118 | +{ | |
119 | +#ifdef DEBUG_UNUSED_IOPORT | |
120 | + fprintf(stderr, "unused outl: port=0x%04x data=0x%02x\n", address, data); | |
121 | +#endif | |
122 | +} | |
123 | + | |
124 | +/* size is the word size in byte */ | |
125 | +int register_ioport_read(int start, int length, int size, | |
126 | + IOPortReadFunc *func, void *opaque) | |
127 | +{ | |
128 | + int i, bsize; | |
129 | + | |
130 | + if (size == 1) { | |
131 | + bsize = 0; | |
132 | + } else if (size == 2) { | |
133 | + bsize = 1; | |
134 | + } else if (size == 4) { | |
135 | + bsize = 2; | |
136 | + } else { | |
137 | + hw_error("register_ioport_read: invalid size"); | |
138 | + return -1; | |
139 | + } | |
140 | + for(i = start; i < start + length; i += size) { | |
141 | + ioport_read_table[bsize][i] = func; | |
142 | + if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque) | |
143 | + hw_error("register_ioport_read: invalid opaque"); | |
144 | + ioport_opaque[i] = opaque; | |
145 | + } | |
146 | + return 0; | |
147 | +} | |
148 | + | |
149 | +/* size is the word size in byte */ | |
150 | +int register_ioport_write(int start, int length, int size, | |
151 | + IOPortWriteFunc *func, void *opaque) | |
152 | +{ | |
153 | + int i, bsize; | |
154 | + | |
155 | + if (size == 1) { | |
156 | + bsize = 0; | |
157 | + } else if (size == 2) { | |
158 | + bsize = 1; | |
159 | + } else if (size == 4) { | |
160 | + bsize = 2; | |
161 | + } else { | |
162 | + hw_error("register_ioport_write: invalid size"); | |
163 | + return -1; | |
164 | + } | |
165 | + for(i = start; i < start + length; i += size) { | |
166 | + ioport_write_table[bsize][i] = func; | |
167 | + if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque) | |
168 | + hw_error("register_ioport_write: invalid opaque"); | |
169 | + ioport_opaque[i] = opaque; | |
170 | + } | |
171 | + return 0; | |
172 | +} | |
173 | + | |
174 | +void isa_unassign_ioport(int start, int length) | |
175 | +{ | |
176 | + int i; | |
177 | + | |
178 | + for(i = start; i < start + length; i++) { | |
179 | + ioport_read_table[0][i] = default_ioport_readb; | |
180 | + ioport_read_table[1][i] = default_ioport_readw; | |
181 | + ioport_read_table[2][i] = default_ioport_readl; | |
182 | + | |
183 | + ioport_write_table[0][i] = default_ioport_writeb; | |
184 | + ioport_write_table[1][i] = default_ioport_writew; | |
185 | + ioport_write_table[2][i] = default_ioport_writel; | |
186 | + | |
187 | + ioport_opaque[i] = NULL; | |
188 | + } | |
189 | +} | |
190 | + | |
191 | +/***********************************************************/ | |
192 | + | |
193 | +void cpu_outb(CPUState *env, int addr, int val) | |
194 | +{ | |
195 | + LOG_IOPORT("outb: %04x %02x\n", addr, val); | |
196 | + ioport_write(0, addr, val); | |
197 | +#ifdef CONFIG_KQEMU | |
198 | + if (env) | |
199 | + env->last_io_time = cpu_get_time_fast(); | |
200 | +#endif | |
201 | +} | |
202 | + | |
203 | +void cpu_outw(CPUState *env, int addr, int val) | |
204 | +{ | |
205 | + LOG_IOPORT("outw: %04x %04x\n", addr, val); | |
206 | + ioport_write(1, addr, val); | |
207 | +#ifdef CONFIG_KQEMU | |
208 | + if (env) | |
209 | + env->last_io_time = cpu_get_time_fast(); | |
210 | +#endif | |
211 | +} | |
212 | + | |
213 | +void cpu_outl(CPUState *env, int addr, int val) | |
214 | +{ | |
215 | + LOG_IOPORT("outl: %04x %08x\n", addr, val); | |
216 | + ioport_write(2, addr, val); | |
217 | +#ifdef CONFIG_KQEMU | |
218 | + if (env) | |
219 | + env->last_io_time = cpu_get_time_fast(); | |
220 | +#endif | |
221 | +} | |
222 | + | |
223 | +int cpu_inb(CPUState *env, int addr) | |
224 | +{ | |
225 | + int val; | |
226 | + val = ioport_read(0, addr); | |
227 | + LOG_IOPORT("inb : %04x %02x\n", addr, val); | |
228 | +#ifdef CONFIG_KQEMU | |
229 | + if (env) | |
230 | + env->last_io_time = cpu_get_time_fast(); | |
231 | +#endif | |
232 | + return val; | |
233 | +} | |
234 | + | |
235 | +int cpu_inw(CPUState *env, int addr) | |
236 | +{ | |
237 | + int val; | |
238 | + val = ioport_read(1, addr); | |
239 | + LOG_IOPORT("inw : %04x %04x\n", addr, val); | |
240 | +#ifdef CONFIG_KQEMU | |
241 | + if (env) | |
242 | + env->last_io_time = cpu_get_time_fast(); | |
243 | +#endif | |
244 | + return val; | |
245 | +} | |
246 | + | |
247 | +int cpu_inl(CPUState *env, int addr) | |
248 | +{ | |
249 | + int val; | |
250 | + val = ioport_read(2, addr); | |
251 | + LOG_IOPORT("inl : %04x %08x\n", addr, val); | |
252 | +#ifdef CONFIG_KQEMU | |
253 | + if (env) | |
254 | + env->last_io_time = cpu_get_time_fast(); | |
255 | +#endif | |
256 | + return val; | |
257 | +} | |
258 | + | ... | ... |
ioport.h
0 → 100644
1 | +/* | |
2 | + * defines ioport related functions | |
3 | + * | |
4 | + * Copyright (c) 2003 Fabrice Bellard | |
5 | + * | |
6 | + * This library is free software; you can redistribute it and/or | |
7 | + * modify it under the terms of the GNU Lesser General Public | |
8 | + * License as published by the Free Software Foundation; either | |
9 | + * version 2 of the License, or (at your option) any later version. | |
10 | + * | |
11 | + * This library is distributed in the hope that it will be useful, | |
12 | + * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
14 | + * Lesser General Public License for more details. | |
15 | + * | |
16 | + * You should have received a copy of the GNU Lesser General Public | |
17 | + * License along with this library; if not, write to the Free Software | |
18 | + * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301 USA | |
19 | + */ | |
20 | + | |
21 | +/************************************************************************** | |
22 | + * IO ports API | |
23 | + */ | |
24 | + | |
25 | +#ifndef IOPORT_H | |
26 | +#define IOPORT_H | |
27 | + | |
28 | +#include "qemu-common.h" | |
29 | + | |
30 | +#define MAX_IOPORTS (64 * 1024) | |
31 | + | |
32 | +/* These should really be in isa.h, but are here to make pc.h happy. */ | |
33 | +typedef void (IOPortWriteFunc)(void *opaque, uint32_t address, uint32_t data); | |
34 | +typedef uint32_t (IOPortReadFunc)(void *opaque, uint32_t address); | |
35 | + | |
36 | +int register_ioport_read(int start, int length, int size, | |
37 | + IOPortReadFunc *func, void *opaque); | |
38 | +int register_ioport_write(int start, int length, int size, | |
39 | + IOPortWriteFunc *func, void *opaque); | |
40 | +void isa_unassign_ioport(int start, int length); | |
41 | + | |
42 | + | |
43 | +/* NOTE: as these functions may be even used when there is an isa | |
44 | + brige on non x86 targets, we always defined them */ | |
45 | +#if !defined(NO_CPU_IO_DEFS) && defined(NEED_CPU_H) | |
46 | +void cpu_outb(CPUState *env, int addr, int val); | |
47 | +void cpu_outw(CPUState *env, int addr, int val); | |
48 | +void cpu_outl(CPUState *env, int addr, int val); | |
49 | +int cpu_inb(CPUState *env, int addr); | |
50 | +int cpu_inw(CPUState *env, int addr); | |
51 | +int cpu_inl(CPUState *env, int addr); | |
52 | +#endif | |
53 | + | |
54 | +#endif /* IOPORT_H */ | ... | ... |
vl.c
... | ... | @@ -167,18 +167,9 @@ int main(int argc, char **argv) |
167 | 167 | |
168 | 168 | #include "slirp/libslirp.h" |
169 | 169 | |
170 | -//#define DEBUG_UNUSED_IOPORT | |
171 | -//#define DEBUG_IOPORT | |
172 | 170 | //#define DEBUG_NET |
173 | 171 | //#define DEBUG_SLIRP |
174 | 172 | |
175 | - | |
176 | -#ifdef DEBUG_IOPORT | |
177 | -# define LOG_IOPORT(...) qemu_log_mask(CPU_LOG_IOPORT, ## __VA_ARGS__) | |
178 | -#else | |
179 | -# define LOG_IOPORT(...) do { } while (0) | |
180 | -#endif | |
181 | - | |
182 | 173 | #define DEFAULT_RAM_SIZE 128 |
183 | 174 | |
184 | 175 | /* Max number of USB devices that can be specified on the commandline. */ |
... | ... | @@ -187,14 +178,8 @@ int main(int argc, char **argv) |
187 | 178 | /* Max number of bluetooth switches on the commandline. */ |
188 | 179 | #define MAX_BT_CMDLINE 10 |
189 | 180 | |
190 | -/* XXX: use a two level table to limit memory usage */ | |
191 | -#define MAX_IOPORTS 65536 | |
192 | - | |
193 | 181 | static const char *data_dir; |
194 | 182 | const char *bios_name = NULL; |
195 | -static void *ioport_opaque[MAX_IOPORTS]; | |
196 | -static IOPortReadFunc *ioport_read_table[3][MAX_IOPORTS]; | |
197 | -static IOPortWriteFunc *ioport_write_table[3][MAX_IOPORTS]; | |
198 | 183 | /* Note: drives_table[MAX_DRIVES] is a dummy block driver if none available |
199 | 184 | to store the VM snapshots */ |
200 | 185 | DriveInfo drives_table[MAX_DRIVES+1]; |
... | ... | @@ -294,217 +279,6 @@ uint8_t qemu_uuid[16]; |
294 | 279 | target_phys_addr_t isa_mem_base = 0; |
295 | 280 | PicState2 *isa_pic; |
296 | 281 | |
297 | -static IOPortReadFunc default_ioport_readb, default_ioport_readw, default_ioport_readl; | |
298 | -static IOPortWriteFunc default_ioport_writeb, default_ioport_writew, default_ioport_writel; | |
299 | - | |
300 | -static uint32_t ioport_read(int index, uint32_t address) | |
301 | -{ | |
302 | - static IOPortReadFunc *default_func[3] = { | |
303 | - default_ioport_readb, | |
304 | - default_ioport_readw, | |
305 | - default_ioport_readl | |
306 | - }; | |
307 | - IOPortReadFunc *func = ioport_read_table[index][address]; | |
308 | - if (!func) | |
309 | - func = default_func[index]; | |
310 | - return func(ioport_opaque[address], address); | |
311 | -} | |
312 | - | |
313 | -static void ioport_write(int index, uint32_t address, uint32_t data) | |
314 | -{ | |
315 | - static IOPortWriteFunc *default_func[3] = { | |
316 | - default_ioport_writeb, | |
317 | - default_ioport_writew, | |
318 | - default_ioport_writel | |
319 | - }; | |
320 | - IOPortWriteFunc *func = ioport_write_table[index][address]; | |
321 | - if (!func) | |
322 | - func = default_func[index]; | |
323 | - func(ioport_opaque[address], address, data); | |
324 | -} | |
325 | - | |
326 | -static uint32_t default_ioport_readb(void *opaque, uint32_t address) | |
327 | -{ | |
328 | -#ifdef DEBUG_UNUSED_IOPORT | |
329 | - fprintf(stderr, "unused inb: port=0x%04x\n", address); | |
330 | -#endif | |
331 | - return 0xff; | |
332 | -} | |
333 | - | |
334 | -static void default_ioport_writeb(void *opaque, uint32_t address, uint32_t data) | |
335 | -{ | |
336 | -#ifdef DEBUG_UNUSED_IOPORT | |
337 | - fprintf(stderr, "unused outb: port=0x%04x data=0x%02x\n", address, data); | |
338 | -#endif | |
339 | -} | |
340 | - | |
341 | -/* default is to make two byte accesses */ | |
342 | -static uint32_t default_ioport_readw(void *opaque, uint32_t address) | |
343 | -{ | |
344 | - uint32_t data; | |
345 | - data = ioport_read(0, address); | |
346 | - address = (address + 1) & (MAX_IOPORTS - 1); | |
347 | - data |= ioport_read(0, address) << 8; | |
348 | - return data; | |
349 | -} | |
350 | - | |
351 | -static void default_ioport_writew(void *opaque, uint32_t address, uint32_t data) | |
352 | -{ | |
353 | - ioport_write(0, address, data & 0xff); | |
354 | - address = (address + 1) & (MAX_IOPORTS - 1); | |
355 | - ioport_write(0, address, (data >> 8) & 0xff); | |
356 | -} | |
357 | - | |
358 | -static uint32_t default_ioport_readl(void *opaque, uint32_t address) | |
359 | -{ | |
360 | -#ifdef DEBUG_UNUSED_IOPORT | |
361 | - fprintf(stderr, "unused inl: port=0x%04x\n", address); | |
362 | -#endif | |
363 | - return 0xffffffff; | |
364 | -} | |
365 | - | |
366 | -static void default_ioport_writel(void *opaque, uint32_t address, uint32_t data) | |
367 | -{ | |
368 | -#ifdef DEBUG_UNUSED_IOPORT | |
369 | - fprintf(stderr, "unused outl: port=0x%04x data=0x%02x\n", address, data); | |
370 | -#endif | |
371 | -} | |
372 | - | |
373 | -/* size is the word size in byte */ | |
374 | -int register_ioport_read(int start, int length, int size, | |
375 | - IOPortReadFunc *func, void *opaque) | |
376 | -{ | |
377 | - int i, bsize; | |
378 | - | |
379 | - if (size == 1) { | |
380 | - bsize = 0; | |
381 | - } else if (size == 2) { | |
382 | - bsize = 1; | |
383 | - } else if (size == 4) { | |
384 | - bsize = 2; | |
385 | - } else { | |
386 | - hw_error("register_ioport_read: invalid size"); | |
387 | - return -1; | |
388 | - } | |
389 | - for(i = start; i < start + length; i += size) { | |
390 | - ioport_read_table[bsize][i] = func; | |
391 | - if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque) | |
392 | - hw_error("register_ioport_read: invalid opaque"); | |
393 | - ioport_opaque[i] = opaque; | |
394 | - } | |
395 | - return 0; | |
396 | -} | |
397 | - | |
398 | -/* size is the word size in byte */ | |
399 | -int register_ioport_write(int start, int length, int size, | |
400 | - IOPortWriteFunc *func, void *opaque) | |
401 | -{ | |
402 | - int i, bsize; | |
403 | - | |
404 | - if (size == 1) { | |
405 | - bsize = 0; | |
406 | - } else if (size == 2) { | |
407 | - bsize = 1; | |
408 | - } else if (size == 4) { | |
409 | - bsize = 2; | |
410 | - } else { | |
411 | - hw_error("register_ioport_write: invalid size"); | |
412 | - return -1; | |
413 | - } | |
414 | - for(i = start; i < start + length; i += size) { | |
415 | - ioport_write_table[bsize][i] = func; | |
416 | - if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque) | |
417 | - hw_error("register_ioport_write: invalid opaque"); | |
418 | - ioport_opaque[i] = opaque; | |
419 | - } | |
420 | - return 0; | |
421 | -} | |
422 | - | |
423 | -void isa_unassign_ioport(int start, int length) | |
424 | -{ | |
425 | - int i; | |
426 | - | |
427 | - for(i = start; i < start + length; i++) { | |
428 | - ioport_read_table[0][i] = default_ioport_readb; | |
429 | - ioport_read_table[1][i] = default_ioport_readw; | |
430 | - ioport_read_table[2][i] = default_ioport_readl; | |
431 | - | |
432 | - ioport_write_table[0][i] = default_ioport_writeb; | |
433 | - ioport_write_table[1][i] = default_ioport_writew; | |
434 | - ioport_write_table[2][i] = default_ioport_writel; | |
435 | - | |
436 | - ioport_opaque[i] = NULL; | |
437 | - } | |
438 | -} | |
439 | - | |
440 | -/***********************************************************/ | |
441 | - | |
442 | -void cpu_outb(CPUState *env, int addr, int val) | |
443 | -{ | |
444 | - LOG_IOPORT("outb: %04x %02x\n", addr, val); | |
445 | - ioport_write(0, addr, val); | |
446 | -#ifdef CONFIG_KQEMU | |
447 | - if (env) | |
448 | - env->last_io_time = cpu_get_time_fast(); | |
449 | -#endif | |
450 | -} | |
451 | - | |
452 | -void cpu_outw(CPUState *env, int addr, int val) | |
453 | -{ | |
454 | - LOG_IOPORT("outw: %04x %04x\n", addr, val); | |
455 | - ioport_write(1, addr, val); | |
456 | -#ifdef CONFIG_KQEMU | |
457 | - if (env) | |
458 | - env->last_io_time = cpu_get_time_fast(); | |
459 | -#endif | |
460 | -} | |
461 | - | |
462 | -void cpu_outl(CPUState *env, int addr, int val) | |
463 | -{ | |
464 | - LOG_IOPORT("outl: %04x %08x\n", addr, val); | |
465 | - ioport_write(2, addr, val); | |
466 | -#ifdef CONFIG_KQEMU | |
467 | - if (env) | |
468 | - env->last_io_time = cpu_get_time_fast(); | |
469 | -#endif | |
470 | -} | |
471 | - | |
472 | -int cpu_inb(CPUState *env, int addr) | |
473 | -{ | |
474 | - int val; | |
475 | - val = ioport_read(0, addr); | |
476 | - LOG_IOPORT("inb : %04x %02x\n", addr, val); | |
477 | -#ifdef CONFIG_KQEMU | |
478 | - if (env) | |
479 | - env->last_io_time = cpu_get_time_fast(); | |
480 | -#endif | |
481 | - return val; | |
482 | -} | |
483 | - | |
484 | -int cpu_inw(CPUState *env, int addr) | |
485 | -{ | |
486 | - int val; | |
487 | - val = ioport_read(1, addr); | |
488 | - LOG_IOPORT("inw : %04x %04x\n", addr, val); | |
489 | -#ifdef CONFIG_KQEMU | |
490 | - if (env) | |
491 | - env->last_io_time = cpu_get_time_fast(); | |
492 | -#endif | |
493 | - return val; | |
494 | -} | |
495 | - | |
496 | -int cpu_inl(CPUState *env, int addr) | |
497 | -{ | |
498 | - int val; | |
499 | - val = ioport_read(2, addr); | |
500 | - LOG_IOPORT("inl : %04x %08x\n", addr, val); | |
501 | -#ifdef CONFIG_KQEMU | |
502 | - if (env) | |
503 | - env->last_io_time = cpu_get_time_fast(); | |
504 | -#endif | |
505 | - return val; | |
506 | -} | |
507 | - | |
508 | 282 | /***********************************************************/ |
509 | 283 | void hw_error(const char *fmt, ...) |
510 | 284 | { | ... | ... |