Set cpuid definition to 0 before initializing it
[qemu/mdroth.git] / ioport.c
blobec3dc65cdd46b8048149d89c6a0e27a504d80176
1 /*
2 * QEMU System Emulator
4 * Copyright (c) 2003-2008 Fabrice Bellard
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:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
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.
25 * splitted out ioport related stuffs from vl.c.
28 #include "ioport.h"
29 #include "trace.h"
31 /***********************************************************/
32 /* IO Port */
34 //#define DEBUG_UNUSED_IOPORT
35 //#define DEBUG_IOPORT
37 #ifdef DEBUG_UNUSED_IOPORT
38 # define LOG_UNUSED_IOPORT(fmt, ...) fprintf(stderr, fmt, ## __VA_ARGS__)
39 #else
40 # define LOG_UNUSED_IOPORT(fmt, ...) do{ } while (0)
41 #endif
43 #ifdef DEBUG_IOPORT
44 # define LOG_IOPORT(...) qemu_log_mask(CPU_LOG_IOPORT, ## __VA_ARGS__)
45 #else
46 # define LOG_IOPORT(...) do { } while (0)
47 #endif
49 /* XXX: use a two level table to limit memory usage */
51 static void *ioport_opaque[MAX_IOPORTS];
52 static IOPortReadFunc *ioport_read_table[3][MAX_IOPORTS];
53 static IOPortWriteFunc *ioport_write_table[3][MAX_IOPORTS];
55 static IOPortReadFunc default_ioport_readb, default_ioport_readw, default_ioport_readl;
56 static IOPortWriteFunc default_ioport_writeb, default_ioport_writew, default_ioport_writel;
58 static uint32_t ioport_read(int index, uint32_t address)
60 static IOPortReadFunc * const default_func[3] = {
61 default_ioport_readb,
62 default_ioport_readw,
63 default_ioport_readl
65 IOPortReadFunc *func = ioport_read_table[index][address];
66 if (!func)
67 func = default_func[index];
68 return func(ioport_opaque[address], address);
71 static void ioport_write(int index, uint32_t address, uint32_t data)
73 static IOPortWriteFunc * const default_func[3] = {
74 default_ioport_writeb,
75 default_ioport_writew,
76 default_ioport_writel
78 IOPortWriteFunc *func = ioport_write_table[index][address];
79 if (!func)
80 func = default_func[index];
81 func(ioport_opaque[address], address, data);
84 static uint32_t default_ioport_readb(void *opaque, uint32_t address)
86 LOG_UNUSED_IOPORT("unused inb: port=0x%04"PRIx32"\n", address);
87 return 0xff;
90 static void default_ioport_writeb(void *opaque, uint32_t address, uint32_t data)
92 LOG_UNUSED_IOPORT("unused outb: port=0x%04"PRIx32" data=0x%02"PRIx32"\n",
93 address, data);
96 /* default is to make two byte accesses */
97 static uint32_t default_ioport_readw(void *opaque, uint32_t address)
99 uint32_t data;
100 data = ioport_read(0, address);
101 address = (address + 1) & IOPORTS_MASK;
102 data |= ioport_read(0, address) << 8;
103 return data;
106 static void default_ioport_writew(void *opaque, uint32_t address, uint32_t data)
108 ioport_write(0, address, data & 0xff);
109 address = (address + 1) & IOPORTS_MASK;
110 ioport_write(0, address, (data >> 8) & 0xff);
113 static uint32_t default_ioport_readl(void *opaque, uint32_t address)
115 LOG_UNUSED_IOPORT("unused inl: port=0x%04"PRIx32"\n", address);
116 return 0xffffffff;
119 static void default_ioport_writel(void *opaque, uint32_t address, uint32_t data)
121 LOG_UNUSED_IOPORT("unused outl: port=0x%04"PRIx32" data=0x%02"PRIx32"\n",
122 address, data);
125 static int ioport_bsize(int size, int *bsize)
127 if (size == 1) {
128 *bsize = 0;
129 } else if (size == 2) {
130 *bsize = 1;
131 } else if (size == 4) {
132 *bsize = 2;
133 } else {
134 return -1;
136 return 0;
139 /* size is the word size in byte */
140 int register_ioport_read(pio_addr_t start, int length, int size,
141 IOPortReadFunc *func, void *opaque)
143 int i, bsize;
145 if (ioport_bsize(size, &bsize)) {
146 hw_error("register_ioport_read: invalid size");
147 return -1;
149 for(i = start; i < start + length; i += size) {
150 ioport_read_table[bsize][i] = func;
151 if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque)
152 hw_error("register_ioport_read: invalid opaque");
153 ioport_opaque[i] = opaque;
155 return 0;
158 /* size is the word size in byte */
159 int register_ioport_write(pio_addr_t start, int length, int size,
160 IOPortWriteFunc *func, void *opaque)
162 int i, bsize;
164 if (ioport_bsize(size, &bsize)) {
165 hw_error("register_ioport_write: invalid size");
166 return -1;
168 for(i = start; i < start + length; i += size) {
169 ioport_write_table[bsize][i] = func;
170 if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque)
171 hw_error("register_ioport_write: invalid opaque");
172 ioport_opaque[i] = opaque;
174 return 0;
177 void isa_unassign_ioport(pio_addr_t start, int length)
179 int i;
181 for(i = start; i < start + length; i++) {
182 ioport_read_table[0][i] = default_ioport_readb;
183 ioport_read_table[1][i] = default_ioport_readw;
184 ioport_read_table[2][i] = default_ioport_readl;
186 ioport_write_table[0][i] = default_ioport_writeb;
187 ioport_write_table[1][i] = default_ioport_writew;
188 ioport_write_table[2][i] = default_ioport_writel;
190 ioport_opaque[i] = NULL;
194 /***********************************************************/
196 void cpu_outb(pio_addr_t addr, uint8_t val)
198 LOG_IOPORT("outb: %04"FMT_pioaddr" %02"PRIx8"\n", addr, val);
199 trace_cpu_out(addr, val);
200 ioport_write(0, addr, val);
203 void cpu_outw(pio_addr_t addr, uint16_t val)
205 LOG_IOPORT("outw: %04"FMT_pioaddr" %04"PRIx16"\n", addr, val);
206 trace_cpu_out(addr, val);
207 ioport_write(1, addr, val);
210 void cpu_outl(pio_addr_t addr, uint32_t val)
212 LOG_IOPORT("outl: %04"FMT_pioaddr" %08"PRIx32"\n", addr, val);
213 trace_cpu_out(addr, val);
214 ioport_write(2, addr, val);
217 uint8_t cpu_inb(pio_addr_t addr)
219 uint8_t val;
220 val = ioport_read(0, addr);
221 trace_cpu_in(addr, val);
222 LOG_IOPORT("inb : %04"FMT_pioaddr" %02"PRIx8"\n", addr, val);
223 return val;
226 uint16_t cpu_inw(pio_addr_t addr)
228 uint16_t val;
229 val = ioport_read(1, addr);
230 trace_cpu_in(addr, val);
231 LOG_IOPORT("inw : %04"FMT_pioaddr" %04"PRIx16"\n", addr, val);
232 return val;
235 uint32_t cpu_inl(pio_addr_t addr)
237 uint32_t val;
238 val = ioport_read(2, addr);
239 trace_cpu_in(addr, val);
240 LOG_IOPORT("inl : %04"FMT_pioaddr" %08"PRIx32"\n", addr, val);
241 return val;