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_UNUSED_IOPORT
37 # define LOG_UNUSED_IOPORT(fmt, ...) fprintf(stderr, fmt, ## __VA_ARGS__)
38 #else
39 # define LOG_UNUSED_IOPORT(fmt, ...) do{ } while (0)
40 #endif
41
42 #ifdef DEBUG_IOPORT
43 # define LOG_IOPORT(...) qemu_log_mask(CPU_LOG_IOPORT, ## __VA_ARGS__)
44 #else
45 # define LOG_IOPORT(...) do { } while (0)
46 #endif
47
48 /* XXX: use a two level table to limit memory usage */
49
50 static void *ioport_opaque[MAX_IOPORTS];
51 static IOPortReadFunc *ioport_read_table[3][MAX_IOPORTS];
52 static IOPortWriteFunc *ioport_write_table[3][MAX_IOPORTS];
53
54 static IOPortReadFunc default_ioport_readb, default_ioport_readw, default_ioport_readl;
55 static IOPortWriteFunc default_ioport_writeb, default_ioport_writew, default_ioport_writel;
56
ioport_read(int index,uint32_t address)57 static uint32_t ioport_read(int index, uint32_t address)
58 {
59 static IOPortReadFunc * const default_func[3] = {
60 default_ioport_readb,
61 default_ioport_readw,
62 default_ioport_readl
63 };
64 IOPortReadFunc *func = ioport_read_table[index][address];
65 if (!func)
66 func = default_func[index];
67 return func(ioport_opaque[address], address);
68 }
69
ioport_write(int index,uint32_t address,uint32_t data)70 static void ioport_write(int index, uint32_t address, uint32_t data)
71 {
72 static IOPortWriteFunc * const default_func[3] = {
73 default_ioport_writeb,
74 default_ioport_writew,
75 default_ioport_writel
76 };
77 IOPortWriteFunc *func = ioport_write_table[index][address];
78 if (!func)
79 func = default_func[index];
80 func(ioport_opaque[address], address, data);
81 }
82
default_ioport_readb(void * opaque,uint32_t address)83 static uint32_t default_ioport_readb(void *opaque, uint32_t address)
84 {
85 LOG_UNUSED_IOPORT("unused inb: port=0x%04"PRIx32"\n", address);
86 return 0xff;
87 }
88
default_ioport_writeb(void * opaque,uint32_t address,uint32_t data)89 static void default_ioport_writeb(void *opaque, uint32_t address, uint32_t data)
90 {
91 LOG_UNUSED_IOPORT("unused outb: port=0x%04"PRIx32" data=0x%02"PRIx32"\n",
92 address, data);
93 }
94
95 /* default is to make two byte accesses */
default_ioport_readw(void * opaque,uint32_t address)96 static uint32_t default_ioport_readw(void *opaque, uint32_t address)
97 {
98 uint32_t data;
99 data = ioport_read(0, address);
100 address = (address + 1) & IOPORTS_MASK;
101 data |= ioport_read(0, address) << 8;
102 return data;
103 }
104
default_ioport_writew(void * opaque,uint32_t address,uint32_t data)105 static void default_ioport_writew(void *opaque, uint32_t address, uint32_t data)
106 {
107 ioport_write(0, address, data & 0xff);
108 address = (address + 1) & IOPORTS_MASK;
109 ioport_write(0, address, (data >> 8) & 0xff);
110 }
111
default_ioport_readl(void * opaque,uint32_t address)112 static uint32_t default_ioport_readl(void *opaque, uint32_t address)
113 {
114 LOG_UNUSED_IOPORT("unused inl: port=0x%04"PRIx32"\n", address);
115 return 0xffffffff;
116 }
117
default_ioport_writel(void * opaque,uint32_t address,uint32_t data)118 static void default_ioport_writel(void *opaque, uint32_t address, uint32_t data)
119 {
120 LOG_UNUSED_IOPORT("unused outl: port=0x%04"PRIx32" data=0x%02"PRIx32"\n",
121 address, data);
122 }
123
ioport_bsize(int size,int * bsize)124 static int ioport_bsize(int size, int *bsize)
125 {
126 if (size == 1) {
127 *bsize = 0;
128 } else if (size == 2) {
129 *bsize = 1;
130 } else if (size == 4) {
131 *bsize = 2;
132 } else {
133 return -1;
134 }
135 return 0;
136 }
137
138 /* size is the word size in byte */
register_ioport_read(pio_addr_t start,int length,int size,IOPortReadFunc * func,void * opaque)139 int register_ioport_read(pio_addr_t start, int length, int size,
140 IOPortReadFunc *func, void *opaque)
141 {
142 int i, bsize;
143
144 if (ioport_bsize(size, &bsize)) {
145 hw_error("register_ioport_read: invalid size");
146 return -1;
147 }
148 for(i = start; i < start + length; i += size) {
149 ioport_read_table[bsize][i] = func;
150 if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque)
151 hw_error("register_ioport_read: invalid opaque");
152 ioport_opaque[i] = opaque;
153 }
154 return 0;
155 }
156
157 /* size is the word size in byte */
register_ioport_write(pio_addr_t start,int length,int size,IOPortWriteFunc * func,void * opaque)158 int register_ioport_write(pio_addr_t start, int length, int size,
159 IOPortWriteFunc *func, void *opaque)
160 {
161 int i, bsize;
162
163 if (ioport_bsize(size, &bsize)) {
164 hw_error("register_ioport_write: invalid size");
165 return -1;
166 }
167 for(i = start; i < start + length; i += size) {
168 ioport_write_table[bsize][i] = func;
169 if (ioport_opaque[i] != NULL && ioport_opaque[i] != opaque)
170 hw_error("register_ioport_write: invalid opaque");
171 ioport_opaque[i] = opaque;
172 }
173 return 0;
174 }
175
isa_unassign_ioport(pio_addr_t start,int length)176 void isa_unassign_ioport(pio_addr_t start, int length)
177 {
178 int i;
179
180 for(i = start; i < start + length; i++) {
181 ioport_read_table[0][i] = default_ioport_readb;
182 ioport_read_table[1][i] = default_ioport_readw;
183 ioport_read_table[2][i] = default_ioport_readl;
184
185 ioport_write_table[0][i] = default_ioport_writeb;
186 ioport_write_table[1][i] = default_ioport_writew;
187 ioport_write_table[2][i] = default_ioport_writel;
188
189 ioport_opaque[i] = NULL;
190 }
191 }
192
193 /***********************************************************/
194
cpu_outb(pio_addr_t addr,uint8_t val)195 void cpu_outb(pio_addr_t addr, uint8_t val)
196 {
197 LOG_IOPORT("outb: %04"FMT_pioaddr" %02"PRIx8"\n", addr, val);
198 ioport_write(0, addr, val);
199 }
200
cpu_outw(pio_addr_t addr,uint16_t val)201 void cpu_outw(pio_addr_t addr, uint16_t val)
202 {
203 LOG_IOPORT("outw: %04"FMT_pioaddr" %04"PRIx16"\n", addr, val);
204 ioport_write(1, addr, val);
205 }
206
cpu_outl(pio_addr_t addr,uint32_t val)207 void cpu_outl(pio_addr_t addr, uint32_t val)
208 {
209 LOG_IOPORT("outl: %04"FMT_pioaddr" %08"PRIx32"\n", addr, val);
210 ioport_write(2, addr, val);
211 }
212
cpu_inb(pio_addr_t addr)213 uint8_t cpu_inb(pio_addr_t addr)
214 {
215 uint8_t val;
216 val = ioport_read(0, addr);
217 LOG_IOPORT("inb : %04"FMT_pioaddr" %02"PRIx8"\n", addr, val);
218 return val;
219 }
220
cpu_inw(pio_addr_t addr)221 uint16_t cpu_inw(pio_addr_t addr)
222 {
223 uint16_t val;
224 val = ioport_read(1, addr);
225 LOG_IOPORT("inw : %04"FMT_pioaddr" %04"PRIx16"\n", addr, val);
226 return val;
227 }
228
cpu_inl(pio_addr_t addr)229 uint32_t cpu_inl(pio_addr_t addr)
230 {
231 uint32_t val;
232 val = ioport_read(2, addr);
233 LOG_IOPORT("inl : %04"FMT_pioaddr" %08"PRIx32"\n", addr, val);
234 return val;
235 }
236