root / hw / parallel.c @ 78971d57
History | View | Annotate | Download (17.5 kB)
1 | 6508fe59 | bellard | /*
|
---|---|---|---|
2 | 6508fe59 | bellard | * QEMU Parallel PORT emulation
|
3 | 5fafdf24 | ths | *
|
4 | e57a8c0e | bellard | * Copyright (c) 2003-2005 Fabrice Bellard
|
5 | 5867c88a | ths | * Copyright (c) 2007 Marko Kohtala
|
6 | 5fafdf24 | ths | *
|
7 | 6508fe59 | bellard | * Permission is hereby granted, free of charge, to any person obtaining a copy
|
8 | 6508fe59 | bellard | * of this software and associated documentation files (the "Software"), to deal
|
9 | 6508fe59 | bellard | * in the Software without restriction, including without limitation the rights
|
10 | 6508fe59 | bellard | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
11 | 6508fe59 | bellard | * copies of the Software, and to permit persons to whom the Software is
|
12 | 6508fe59 | bellard | * furnished to do so, subject to the following conditions:
|
13 | 6508fe59 | bellard | *
|
14 | 6508fe59 | bellard | * The above copyright notice and this permission notice shall be included in
|
15 | 6508fe59 | bellard | * all copies or substantial portions of the Software.
|
16 | 6508fe59 | bellard | *
|
17 | 6508fe59 | bellard | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
18 | 6508fe59 | bellard | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
19 | 6508fe59 | bellard | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
20 | 6508fe59 | bellard | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
21 | 6508fe59 | bellard | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
22 | 6508fe59 | bellard | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
23 | 6508fe59 | bellard | * THE SOFTWARE.
|
24 | 6508fe59 | bellard | */
|
25 | 87ecb68b | pbrook | #include "hw.h" |
26 | 87ecb68b | pbrook | #include "qemu-char.h" |
27 | 87ecb68b | pbrook | #include "isa.h" |
28 | 87ecb68b | pbrook | #include "pc.h" |
29 | 6508fe59 | bellard | |
30 | 6508fe59 | bellard | //#define DEBUG_PARALLEL
|
31 | 6508fe59 | bellard | |
32 | 5867c88a | ths | #ifdef DEBUG_PARALLEL
|
33 | 001faf32 | Blue Swirl | #define pdebug(fmt, ...) printf("pp: " fmt, ## __VA_ARGS__) |
34 | 5867c88a | ths | #else
|
35 | 001faf32 | Blue Swirl | #define pdebug(fmt, ...) ((void)0) |
36 | 5867c88a | ths | #endif
|
37 | 5867c88a | ths | |
38 | 5867c88a | ths | #define PARA_REG_DATA 0 |
39 | 5867c88a | ths | #define PARA_REG_STS 1 |
40 | 5867c88a | ths | #define PARA_REG_CTR 2 |
41 | 5867c88a | ths | #define PARA_REG_EPP_ADDR 3 |
42 | 5867c88a | ths | #define PARA_REG_EPP_DATA 4 |
43 | 5867c88a | ths | |
44 | 6508fe59 | bellard | /*
|
45 | 6508fe59 | bellard | * These are the definitions for the Printer Status Register
|
46 | 6508fe59 | bellard | */
|
47 | 6508fe59 | bellard | #define PARA_STS_BUSY 0x80 /* Busy complement */ |
48 | 6508fe59 | bellard | #define PARA_STS_ACK 0x40 /* Acknowledge */ |
49 | 6508fe59 | bellard | #define PARA_STS_PAPER 0x20 /* Out of paper */ |
50 | 6508fe59 | bellard | #define PARA_STS_ONLINE 0x10 /* Online */ |
51 | 6508fe59 | bellard | #define PARA_STS_ERROR 0x08 /* Error complement */ |
52 | 5867c88a | ths | #define PARA_STS_TMOUT 0x01 /* EPP timeout */ |
53 | 6508fe59 | bellard | |
54 | 6508fe59 | bellard | /*
|
55 | 6508fe59 | bellard | * These are the definitions for the Printer Control Register
|
56 | 6508fe59 | bellard | */
|
57 | 5867c88a | ths | #define PARA_CTR_DIR 0x20 /* Direction (1=read, 0=write) */ |
58 | 6508fe59 | bellard | #define PARA_CTR_INTEN 0x10 /* IRQ Enable */ |
59 | 6508fe59 | bellard | #define PARA_CTR_SELECT 0x08 /* Select In complement */ |
60 | 6508fe59 | bellard | #define PARA_CTR_INIT 0x04 /* Initialize Printer complement */ |
61 | 6508fe59 | bellard | #define PARA_CTR_AUTOLF 0x02 /* Auto linefeed complement */ |
62 | 6508fe59 | bellard | #define PARA_CTR_STROBE 0x01 /* Strobe complement */ |
63 | 6508fe59 | bellard | |
64 | 5867c88a | ths | #define PARA_CTR_SIGNAL (PARA_CTR_SELECT|PARA_CTR_INIT|PARA_CTR_AUTOLF|PARA_CTR_STROBE)
|
65 | 5867c88a | ths | |
66 | 6508fe59 | bellard | struct ParallelState {
|
67 | 5867c88a | ths | uint8_t dataw; |
68 | 5867c88a | ths | uint8_t datar; |
69 | 5867c88a | ths | uint8_t status; |
70 | 6508fe59 | bellard | uint8_t control; |
71 | d537cf6c | pbrook | qemu_irq irq; |
72 | 6508fe59 | bellard | int irq_pending;
|
73 | 6508fe59 | bellard | CharDriverState *chr; |
74 | e57a8c0e | bellard | int hw_driver;
|
75 | 5867c88a | ths | int epp_timeout;
|
76 | 5867c88a | ths | uint32_t last_read_offset; /* For debugging */
|
77 | d60532ca | ths | /* Memory-mapped interface */
|
78 | d60532ca | ths | int it_shift;
|
79 | 6508fe59 | bellard | }; |
80 | 6508fe59 | bellard | |
81 | 021f0674 | Gerd Hoffmann | typedef struct ISAParallelState { |
82 | 021f0674 | Gerd Hoffmann | ISADevice dev; |
83 | 021f0674 | Gerd Hoffmann | uint32_t iobase; |
84 | 021f0674 | Gerd Hoffmann | uint32_t isairq; |
85 | 021f0674 | Gerd Hoffmann | ParallelState state; |
86 | 021f0674 | Gerd Hoffmann | } ISAParallelState; |
87 | 021f0674 | Gerd Hoffmann | |
88 | 6508fe59 | bellard | static void parallel_update_irq(ParallelState *s) |
89 | 6508fe59 | bellard | { |
90 | 6508fe59 | bellard | if (s->irq_pending)
|
91 | d537cf6c | pbrook | qemu_irq_raise(s->irq); |
92 | 6508fe59 | bellard | else
|
93 | d537cf6c | pbrook | qemu_irq_lower(s->irq); |
94 | 6508fe59 | bellard | } |
95 | 6508fe59 | bellard | |
96 | 5867c88a | ths | static void |
97 | 5867c88a | ths | parallel_ioport_write_sw(void *opaque, uint32_t addr, uint32_t val)
|
98 | 6508fe59 | bellard | { |
99 | 6508fe59 | bellard | ParallelState *s = opaque; |
100 | 3b46e624 | ths | |
101 | 5867c88a | ths | pdebug("write addr=0x%02x val=0x%02x\n", addr, val);
|
102 | 5867c88a | ths | |
103 | 5867c88a | ths | addr &= 7;
|
104 | 5867c88a | ths | switch(addr) {
|
105 | 5867c88a | ths | case PARA_REG_DATA:
|
106 | 0fa7f157 | ths | s->dataw = val; |
107 | 0fa7f157 | ths | parallel_update_irq(s); |
108 | 5867c88a | ths | break;
|
109 | 5867c88a | ths | case PARA_REG_CTR:
|
110 | 52ccc5e0 | balrog | val |= 0xc0;
|
111 | 0fa7f157 | ths | if ((val & PARA_CTR_INIT) == 0 ) { |
112 | 0fa7f157 | ths | s->status = PARA_STS_BUSY; |
113 | 0fa7f157 | ths | s->status |= PARA_STS_ACK; |
114 | 0fa7f157 | ths | s->status |= PARA_STS_ONLINE; |
115 | 0fa7f157 | ths | s->status |= PARA_STS_ERROR; |
116 | 0fa7f157 | ths | } |
117 | 0fa7f157 | ths | else if (val & PARA_CTR_SELECT) { |
118 | 0fa7f157 | ths | if (val & PARA_CTR_STROBE) {
|
119 | 0fa7f157 | ths | s->status &= ~PARA_STS_BUSY; |
120 | 0fa7f157 | ths | if ((s->control & PARA_CTR_STROBE) == 0) |
121 | 0fa7f157 | ths | qemu_chr_write(s->chr, &s->dataw, 1);
|
122 | 0fa7f157 | ths | } else {
|
123 | 0fa7f157 | ths | if (s->control & PARA_CTR_INTEN) {
|
124 | 0fa7f157 | ths | s->irq_pending = 1;
|
125 | 0fa7f157 | ths | } |
126 | 0fa7f157 | ths | } |
127 | 0fa7f157 | ths | } |
128 | 0fa7f157 | ths | parallel_update_irq(s); |
129 | 0fa7f157 | ths | s->control = val; |
130 | 5867c88a | ths | break;
|
131 | 5867c88a | ths | } |
132 | 5867c88a | ths | } |
133 | 5867c88a | ths | |
134 | 5867c88a | ths | static void parallel_ioport_write_hw(void *opaque, uint32_t addr, uint32_t val) |
135 | 5867c88a | ths | { |
136 | 5867c88a | ths | ParallelState *s = opaque; |
137 | 5867c88a | ths | uint8_t parm = val; |
138 | 563e3c6e | aurel32 | int dir;
|
139 | 5867c88a | ths | |
140 | 5867c88a | ths | /* Sometimes programs do several writes for timing purposes on old
|
141 | 5867c88a | ths | HW. Take care not to waste time on writes that do nothing. */
|
142 | 5867c88a | ths | |
143 | 5867c88a | ths | s->last_read_offset = ~0U;
|
144 | 5867c88a | ths | |
145 | 6508fe59 | bellard | addr &= 7;
|
146 | 6508fe59 | bellard | switch(addr) {
|
147 | 5867c88a | ths | case PARA_REG_DATA:
|
148 | 5867c88a | ths | if (s->dataw == val)
|
149 | 0fa7f157 | ths | return;
|
150 | 0fa7f157 | ths | pdebug("wd%02x\n", val);
|
151 | 0fa7f157 | ths | qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_WRITE_DATA, &parm); |
152 | 0fa7f157 | ths | s->dataw = val; |
153 | 6508fe59 | bellard | break;
|
154 | 5867c88a | ths | case PARA_REG_STS:
|
155 | 0fa7f157 | ths | pdebug("ws%02x\n", val);
|
156 | 0fa7f157 | ths | if (val & PARA_STS_TMOUT)
|
157 | 0fa7f157 | ths | s->epp_timeout = 0;
|
158 | 0fa7f157 | ths | break;
|
159 | 5867c88a | ths | case PARA_REG_CTR:
|
160 | 5867c88a | ths | val |= 0xc0;
|
161 | 5867c88a | ths | if (s->control == val)
|
162 | 0fa7f157 | ths | return;
|
163 | 0fa7f157 | ths | pdebug("wc%02x\n", val);
|
164 | 563e3c6e | aurel32 | |
165 | 563e3c6e | aurel32 | if ((val & PARA_CTR_DIR) != (s->control & PARA_CTR_DIR)) {
|
166 | 563e3c6e | aurel32 | if (val & PARA_CTR_DIR) {
|
167 | 563e3c6e | aurel32 | dir = 1;
|
168 | 563e3c6e | aurel32 | } else {
|
169 | 563e3c6e | aurel32 | dir = 0;
|
170 | 563e3c6e | aurel32 | } |
171 | 563e3c6e | aurel32 | qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_DATA_DIR, &dir); |
172 | 563e3c6e | aurel32 | parm &= ~PARA_CTR_DIR; |
173 | 563e3c6e | aurel32 | } |
174 | 563e3c6e | aurel32 | |
175 | 0fa7f157 | ths | qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_WRITE_CONTROL, &parm); |
176 | 0fa7f157 | ths | s->control = val; |
177 | 6508fe59 | bellard | break;
|
178 | 5867c88a | ths | case PARA_REG_EPP_ADDR:
|
179 | 0fa7f157 | ths | if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != PARA_CTR_INIT)
|
180 | 0fa7f157 | ths | /* Controls not correct for EPP address cycle, so do nothing */
|
181 | 0fa7f157 | ths | pdebug("wa%02x s\n", val);
|
182 | 0fa7f157 | ths | else {
|
183 | 0fa7f157 | ths | struct ParallelIOArg ioarg = { .buffer = &parm, .count = 1 }; |
184 | 0fa7f157 | ths | if (qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_WRITE_ADDR, &ioarg)) {
|
185 | 0fa7f157 | ths | s->epp_timeout = 1;
|
186 | 0fa7f157 | ths | pdebug("wa%02x t\n", val);
|
187 | 0fa7f157 | ths | } |
188 | 0fa7f157 | ths | else
|
189 | 0fa7f157 | ths | pdebug("wa%02x\n", val);
|
190 | 0fa7f157 | ths | } |
191 | 0fa7f157 | ths | break;
|
192 | 5867c88a | ths | case PARA_REG_EPP_DATA:
|
193 | 0fa7f157 | ths | if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != PARA_CTR_INIT)
|
194 | 0fa7f157 | ths | /* Controls not correct for EPP data cycle, so do nothing */
|
195 | 0fa7f157 | ths | pdebug("we%02x s\n", val);
|
196 | 0fa7f157 | ths | else {
|
197 | 0fa7f157 | ths | struct ParallelIOArg ioarg = { .buffer = &parm, .count = 1 }; |
198 | 0fa7f157 | ths | if (qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_WRITE, &ioarg)) {
|
199 | 0fa7f157 | ths | s->epp_timeout = 1;
|
200 | 0fa7f157 | ths | pdebug("we%02x t\n", val);
|
201 | 0fa7f157 | ths | } |
202 | 0fa7f157 | ths | else
|
203 | 0fa7f157 | ths | pdebug("we%02x\n", val);
|
204 | 0fa7f157 | ths | } |
205 | 0fa7f157 | ths | break;
|
206 | 5867c88a | ths | } |
207 | 5867c88a | ths | } |
208 | 5867c88a | ths | |
209 | 5867c88a | ths | static void |
210 | 5867c88a | ths | parallel_ioport_eppdata_write_hw2(void *opaque, uint32_t addr, uint32_t val)
|
211 | 5867c88a | ths | { |
212 | 5867c88a | ths | ParallelState *s = opaque; |
213 | 5867c88a | ths | uint16_t eppdata = cpu_to_le16(val); |
214 | 5867c88a | ths | int err;
|
215 | 5867c88a | ths | struct ParallelIOArg ioarg = {
|
216 | 0fa7f157 | ths | .buffer = &eppdata, .count = sizeof(eppdata)
|
217 | 5867c88a | ths | }; |
218 | 5867c88a | ths | if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != PARA_CTR_INIT) {
|
219 | 0fa7f157 | ths | /* Controls not correct for EPP data cycle, so do nothing */
|
220 | 0fa7f157 | ths | pdebug("we%04x s\n", val);
|
221 | 0fa7f157 | ths | return;
|
222 | 5867c88a | ths | } |
223 | 5867c88a | ths | err = qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_WRITE, &ioarg); |
224 | 5867c88a | ths | if (err) {
|
225 | 0fa7f157 | ths | s->epp_timeout = 1;
|
226 | 0fa7f157 | ths | pdebug("we%04x t\n", val);
|
227 | 5867c88a | ths | } |
228 | 5867c88a | ths | else
|
229 | 0fa7f157 | ths | pdebug("we%04x\n", val);
|
230 | 5867c88a | ths | } |
231 | 5867c88a | ths | |
232 | 5867c88a | ths | static void |
233 | 5867c88a | ths | parallel_ioport_eppdata_write_hw4(void *opaque, uint32_t addr, uint32_t val)
|
234 | 5867c88a | ths | { |
235 | 5867c88a | ths | ParallelState *s = opaque; |
236 | 5867c88a | ths | uint32_t eppdata = cpu_to_le32(val); |
237 | 5867c88a | ths | int err;
|
238 | 5867c88a | ths | struct ParallelIOArg ioarg = {
|
239 | 0fa7f157 | ths | .buffer = &eppdata, .count = sizeof(eppdata)
|
240 | 5867c88a | ths | }; |
241 | 5867c88a | ths | if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != PARA_CTR_INIT) {
|
242 | 0fa7f157 | ths | /* Controls not correct for EPP data cycle, so do nothing */
|
243 | 0fa7f157 | ths | pdebug("we%08x s\n", val);
|
244 | 0fa7f157 | ths | return;
|
245 | 5867c88a | ths | } |
246 | 5867c88a | ths | err = qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_WRITE, &ioarg); |
247 | 5867c88a | ths | if (err) {
|
248 | 0fa7f157 | ths | s->epp_timeout = 1;
|
249 | 0fa7f157 | ths | pdebug("we%08x t\n", val);
|
250 | 6508fe59 | bellard | } |
251 | 5867c88a | ths | else
|
252 | 0fa7f157 | ths | pdebug("we%08x\n", val);
|
253 | 6508fe59 | bellard | } |
254 | 6508fe59 | bellard | |
255 | 5867c88a | ths | static uint32_t parallel_ioport_read_sw(void *opaque, uint32_t addr) |
256 | 6508fe59 | bellard | { |
257 | 6508fe59 | bellard | ParallelState *s = opaque; |
258 | 6508fe59 | bellard | uint32_t ret = 0xff;
|
259 | 6508fe59 | bellard | |
260 | 6508fe59 | bellard | addr &= 7;
|
261 | 6508fe59 | bellard | switch(addr) {
|
262 | 5867c88a | ths | case PARA_REG_DATA:
|
263 | 0fa7f157 | ths | if (s->control & PARA_CTR_DIR)
|
264 | 0fa7f157 | ths | ret = s->datar; |
265 | 0fa7f157 | ths | else
|
266 | 0fa7f157 | ths | ret = s->dataw; |
267 | 6508fe59 | bellard | break;
|
268 | 5867c88a | ths | case PARA_REG_STS:
|
269 | 0fa7f157 | ths | ret = s->status; |
270 | 0fa7f157 | ths | s->irq_pending = 0;
|
271 | 0fa7f157 | ths | if ((s->status & PARA_STS_BUSY) == 0 && (s->control & PARA_CTR_STROBE) == 0) { |
272 | 0fa7f157 | ths | /* XXX Fixme: wait 5 microseconds */
|
273 | 0fa7f157 | ths | if (s->status & PARA_STS_ACK)
|
274 | 0fa7f157 | ths | s->status &= ~PARA_STS_ACK; |
275 | 0fa7f157 | ths | else {
|
276 | 0fa7f157 | ths | /* XXX Fixme: wait 5 microseconds */
|
277 | 0fa7f157 | ths | s->status |= PARA_STS_ACK; |
278 | 0fa7f157 | ths | s->status |= PARA_STS_BUSY; |
279 | 0fa7f157 | ths | } |
280 | 0fa7f157 | ths | } |
281 | 0fa7f157 | ths | parallel_update_irq(s); |
282 | 6508fe59 | bellard | break;
|
283 | 5867c88a | ths | case PARA_REG_CTR:
|
284 | 6508fe59 | bellard | ret = s->control; |
285 | 6508fe59 | bellard | break;
|
286 | 6508fe59 | bellard | } |
287 | 5867c88a | ths | pdebug("read addr=0x%02x val=0x%02x\n", addr, ret);
|
288 | 5867c88a | ths | return ret;
|
289 | 5867c88a | ths | } |
290 | 5867c88a | ths | |
291 | 5867c88a | ths | static uint32_t parallel_ioport_read_hw(void *opaque, uint32_t addr) |
292 | 5867c88a | ths | { |
293 | 5867c88a | ths | ParallelState *s = opaque; |
294 | 5867c88a | ths | uint8_t ret = 0xff;
|
295 | 5867c88a | ths | addr &= 7;
|
296 | 5867c88a | ths | switch(addr) {
|
297 | 5867c88a | ths | case PARA_REG_DATA:
|
298 | 0fa7f157 | ths | qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_READ_DATA, &ret); |
299 | 0fa7f157 | ths | if (s->last_read_offset != addr || s->datar != ret)
|
300 | 0fa7f157 | ths | pdebug("rd%02x\n", ret);
|
301 | 5867c88a | ths | s->datar = ret; |
302 | 5867c88a | ths | break;
|
303 | 5867c88a | ths | case PARA_REG_STS:
|
304 | 0fa7f157 | ths | qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_READ_STATUS, &ret); |
305 | 0fa7f157 | ths | ret &= ~PARA_STS_TMOUT; |
306 | 0fa7f157 | ths | if (s->epp_timeout)
|
307 | 0fa7f157 | ths | ret |= PARA_STS_TMOUT; |
308 | 0fa7f157 | ths | if (s->last_read_offset != addr || s->status != ret)
|
309 | 0fa7f157 | ths | pdebug("rs%02x\n", ret);
|
310 | 0fa7f157 | ths | s->status = ret; |
311 | 5867c88a | ths | break;
|
312 | 5867c88a | ths | case PARA_REG_CTR:
|
313 | 5867c88a | ths | /* s->control has some bits fixed to 1. It is zero only when
|
314 | 0fa7f157 | ths | it has not been yet written to. */
|
315 | 0fa7f157 | ths | if (s->control == 0) { |
316 | 0fa7f157 | ths | qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_READ_CONTROL, &ret); |
317 | 0fa7f157 | ths | if (s->last_read_offset != addr)
|
318 | 0fa7f157 | ths | pdebug("rc%02x\n", ret);
|
319 | 0fa7f157 | ths | s->control = ret; |
320 | 0fa7f157 | ths | } |
321 | 0fa7f157 | ths | else {
|
322 | 0fa7f157 | ths | ret = s->control; |
323 | 0fa7f157 | ths | if (s->last_read_offset != addr)
|
324 | 0fa7f157 | ths | pdebug("rc%02x\n", ret);
|
325 | 0fa7f157 | ths | } |
326 | 5867c88a | ths | break;
|
327 | 5867c88a | ths | case PARA_REG_EPP_ADDR:
|
328 | 0fa7f157 | ths | if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != (PARA_CTR_DIR|PARA_CTR_INIT))
|
329 | 0fa7f157 | ths | /* Controls not correct for EPP addr cycle, so do nothing */
|
330 | 0fa7f157 | ths | pdebug("ra%02x s\n", ret);
|
331 | 0fa7f157 | ths | else {
|
332 | 0fa7f157 | ths | struct ParallelIOArg ioarg = { .buffer = &ret, .count = 1 }; |
333 | 0fa7f157 | ths | if (qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_READ_ADDR, &ioarg)) {
|
334 | 0fa7f157 | ths | s->epp_timeout = 1;
|
335 | 0fa7f157 | ths | pdebug("ra%02x t\n", ret);
|
336 | 0fa7f157 | ths | } |
337 | 0fa7f157 | ths | else
|
338 | 0fa7f157 | ths | pdebug("ra%02x\n", ret);
|
339 | 0fa7f157 | ths | } |
340 | 0fa7f157 | ths | break;
|
341 | 5867c88a | ths | case PARA_REG_EPP_DATA:
|
342 | 0fa7f157 | ths | if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != (PARA_CTR_DIR|PARA_CTR_INIT))
|
343 | 0fa7f157 | ths | /* Controls not correct for EPP data cycle, so do nothing */
|
344 | 0fa7f157 | ths | pdebug("re%02x s\n", ret);
|
345 | 0fa7f157 | ths | else {
|
346 | 0fa7f157 | ths | struct ParallelIOArg ioarg = { .buffer = &ret, .count = 1 }; |
347 | 0fa7f157 | ths | if (qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_READ, &ioarg)) {
|
348 | 0fa7f157 | ths | s->epp_timeout = 1;
|
349 | 0fa7f157 | ths | pdebug("re%02x t\n", ret);
|
350 | 0fa7f157 | ths | } |
351 | 0fa7f157 | ths | else
|
352 | 0fa7f157 | ths | pdebug("re%02x\n", ret);
|
353 | 0fa7f157 | ths | } |
354 | 0fa7f157 | ths | break;
|
355 | 5867c88a | ths | } |
356 | 5867c88a | ths | s->last_read_offset = addr; |
357 | 5867c88a | ths | return ret;
|
358 | 5867c88a | ths | } |
359 | 5867c88a | ths | |
360 | 5867c88a | ths | static uint32_t
|
361 | 5867c88a | ths | parallel_ioport_eppdata_read_hw2(void *opaque, uint32_t addr)
|
362 | 5867c88a | ths | { |
363 | 5867c88a | ths | ParallelState *s = opaque; |
364 | 5867c88a | ths | uint32_t ret; |
365 | 5867c88a | ths | uint16_t eppdata = ~0;
|
366 | 5867c88a | ths | int err;
|
367 | 5867c88a | ths | struct ParallelIOArg ioarg = {
|
368 | 0fa7f157 | ths | .buffer = &eppdata, .count = sizeof(eppdata)
|
369 | 5867c88a | ths | }; |
370 | 5867c88a | ths | if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != (PARA_CTR_DIR|PARA_CTR_INIT)) {
|
371 | 0fa7f157 | ths | /* Controls not correct for EPP data cycle, so do nothing */
|
372 | 0fa7f157 | ths | pdebug("re%04x s\n", eppdata);
|
373 | 0fa7f157 | ths | return eppdata;
|
374 | 5867c88a | ths | } |
375 | 5867c88a | ths | err = qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_READ, &ioarg); |
376 | 5867c88a | ths | ret = le16_to_cpu(eppdata); |
377 | 5867c88a | ths | |
378 | 5867c88a | ths | if (err) {
|
379 | 0fa7f157 | ths | s->epp_timeout = 1;
|
380 | 0fa7f157 | ths | pdebug("re%04x t\n", ret);
|
381 | 5867c88a | ths | } |
382 | 5867c88a | ths | else
|
383 | 0fa7f157 | ths | pdebug("re%04x\n", ret);
|
384 | 5867c88a | ths | return ret;
|
385 | 5867c88a | ths | } |
386 | 5867c88a | ths | |
387 | 5867c88a | ths | static uint32_t
|
388 | 5867c88a | ths | parallel_ioport_eppdata_read_hw4(void *opaque, uint32_t addr)
|
389 | 5867c88a | ths | { |
390 | 5867c88a | ths | ParallelState *s = opaque; |
391 | 5867c88a | ths | uint32_t ret; |
392 | 5867c88a | ths | uint32_t eppdata = ~0U;
|
393 | 5867c88a | ths | int err;
|
394 | 5867c88a | ths | struct ParallelIOArg ioarg = {
|
395 | 0fa7f157 | ths | .buffer = &eppdata, .count = sizeof(eppdata)
|
396 | 5867c88a | ths | }; |
397 | 5867c88a | ths | if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != (PARA_CTR_DIR|PARA_CTR_INIT)) {
|
398 | 0fa7f157 | ths | /* Controls not correct for EPP data cycle, so do nothing */
|
399 | 0fa7f157 | ths | pdebug("re%08x s\n", eppdata);
|
400 | 0fa7f157 | ths | return eppdata;
|
401 | 5867c88a | ths | } |
402 | 5867c88a | ths | err = qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_READ, &ioarg); |
403 | 5867c88a | ths | ret = le32_to_cpu(eppdata); |
404 | 5867c88a | ths | |
405 | 5867c88a | ths | if (err) {
|
406 | 0fa7f157 | ths | s->epp_timeout = 1;
|
407 | 0fa7f157 | ths | pdebug("re%08x t\n", ret);
|
408 | 5867c88a | ths | } |
409 | 5867c88a | ths | else
|
410 | 0fa7f157 | ths | pdebug("re%08x\n", ret);
|
411 | 5867c88a | ths | return ret;
|
412 | 5867c88a | ths | } |
413 | 5867c88a | ths | |
414 | 5867c88a | ths | static void parallel_ioport_ecp_write(void *opaque, uint32_t addr, uint32_t val) |
415 | 5867c88a | ths | { |
416 | 5867c88a | ths | addr &= 7;
|
417 | 5867c88a | ths | pdebug("wecp%d=%02x\n", addr, val);
|
418 | 5867c88a | ths | } |
419 | 5867c88a | ths | |
420 | 5867c88a | ths | static uint32_t parallel_ioport_ecp_read(void *opaque, uint32_t addr) |
421 | 5867c88a | ths | { |
422 | 5867c88a | ths | uint8_t ret = 0xff;
|
423 | 5867c88a | ths | addr &= 7;
|
424 | 5867c88a | ths | pdebug("recp%d:%02x\n", addr, ret);
|
425 | 6508fe59 | bellard | return ret;
|
426 | 6508fe59 | bellard | } |
427 | 6508fe59 | bellard | |
428 | 33093a0a | aurel32 | static void parallel_reset(void *opaque) |
429 | 6508fe59 | bellard | { |
430 | 33093a0a | aurel32 | ParallelState *s = opaque; |
431 | 33093a0a | aurel32 | |
432 | 5867c88a | ths | s->datar = ~0;
|
433 | 5867c88a | ths | s->dataw = ~0;
|
434 | 6508fe59 | bellard | s->status = PARA_STS_BUSY; |
435 | 6508fe59 | bellard | s->status |= PARA_STS_ACK; |
436 | 6508fe59 | bellard | s->status |= PARA_STS_ONLINE; |
437 | 6508fe59 | bellard | s->status |= PARA_STS_ERROR; |
438 | 52ccc5e0 | balrog | s->status |= PARA_STS_TMOUT; |
439 | 6508fe59 | bellard | s->control = PARA_CTR_SELECT; |
440 | 6508fe59 | bellard | s->control |= PARA_CTR_INIT; |
441 | 52ccc5e0 | balrog | s->control |= 0xc0;
|
442 | 5867c88a | ths | s->irq_pending = 0;
|
443 | 5867c88a | ths | s->hw_driver = 0;
|
444 | 5867c88a | ths | s->epp_timeout = 0;
|
445 | 5867c88a | ths | s->last_read_offset = ~0U;
|
446 | d60532ca | ths | } |
447 | d60532ca | ths | |
448 | 021f0674 | Gerd Hoffmann | static int parallel_isa_initfn(ISADevice *dev) |
449 | d60532ca | ths | { |
450 | 021f0674 | Gerd Hoffmann | ISAParallelState *isa = DO_UPCAST(ISAParallelState, dev, dev); |
451 | 021f0674 | Gerd Hoffmann | ParallelState *s = &isa->state; |
452 | 021f0674 | Gerd Hoffmann | int base = isa->iobase;
|
453 | d60532ca | ths | uint8_t dummy; |
454 | d60532ca | ths | |
455 | 021f0674 | Gerd Hoffmann | if (!s->chr) {
|
456 | 021f0674 | Gerd Hoffmann | fprintf(stderr, "Can't create parallel device, empty char device\n");
|
457 | 021f0674 | Gerd Hoffmann | exit(1);
|
458 | 021f0674 | Gerd Hoffmann | } |
459 | 021f0674 | Gerd Hoffmann | |
460 | 021f0674 | Gerd Hoffmann | isa_init_irq(dev, &s->irq, isa->isairq); |
461 | 33093a0a | aurel32 | parallel_reset(s); |
462 | a08d4367 | Jan Kiszka | qemu_register_reset(parallel_reset, s); |
463 | 6508fe59 | bellard | |
464 | 021f0674 | Gerd Hoffmann | if (qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_READ_STATUS, &dummy) == 0) { |
465 | 5867c88a | ths | s->hw_driver = 1;
|
466 | 0fa7f157 | ths | s->status = dummy; |
467 | 5867c88a | ths | } |
468 | 5867c88a | ths | |
469 | 5867c88a | ths | if (s->hw_driver) {
|
470 | 0fa7f157 | ths | register_ioport_write(base, 8, 1, parallel_ioport_write_hw, s); |
471 | 0fa7f157 | ths | register_ioport_read(base, 8, 1, parallel_ioport_read_hw, s); |
472 | 0fa7f157 | ths | register_ioport_write(base+4, 1, 2, parallel_ioport_eppdata_write_hw2, s); |
473 | 0fa7f157 | ths | register_ioport_read(base+4, 1, 2, parallel_ioport_eppdata_read_hw2, s); |
474 | 0fa7f157 | ths | register_ioport_write(base+4, 1, 4, parallel_ioport_eppdata_write_hw4, s); |
475 | 0fa7f157 | ths | register_ioport_read(base+4, 1, 4, parallel_ioport_eppdata_read_hw4, s); |
476 | 0fa7f157 | ths | register_ioport_write(base+0x400, 8, 1, parallel_ioport_ecp_write, s); |
477 | 0fa7f157 | ths | register_ioport_read(base+0x400, 8, 1, parallel_ioport_ecp_read, s); |
478 | 5867c88a | ths | } |
479 | 5867c88a | ths | else {
|
480 | 0fa7f157 | ths | register_ioport_write(base, 8, 1, parallel_ioport_write_sw, s); |
481 | 0fa7f157 | ths | register_ioport_read(base, 8, 1, parallel_ioport_read_sw, s); |
482 | 5867c88a | ths | } |
483 | 021f0674 | Gerd Hoffmann | return 0; |
484 | 021f0674 | Gerd Hoffmann | } |
485 | 021f0674 | Gerd Hoffmann | |
486 | 021f0674 | Gerd Hoffmann | static const int isa_parallel_io[MAX_PARALLEL_PORTS] = { 0x378, 0x278, 0x3bc }; |
487 | 021f0674 | Gerd Hoffmann | |
488 | 021f0674 | Gerd Hoffmann | ParallelState *parallel_init(int index, CharDriverState *chr)
|
489 | 021f0674 | Gerd Hoffmann | { |
490 | 021f0674 | Gerd Hoffmann | ISADevice *dev; |
491 | 021f0674 | Gerd Hoffmann | |
492 | 021f0674 | Gerd Hoffmann | dev = isa_create("isa-parallel");
|
493 | 021f0674 | Gerd Hoffmann | qdev_prop_set_uint32(&dev->qdev, "iobase", isa_parallel_io[index]);
|
494 | 021f0674 | Gerd Hoffmann | qdev_prop_set_uint32(&dev->qdev, "irq", 7); |
495 | 021f0674 | Gerd Hoffmann | qdev_prop_set_chr(&dev->qdev, "chardev", chr);
|
496 | 5c17ca25 | Markus Armbruster | if (qdev_init(&dev->qdev) < 0) |
497 | 021f0674 | Gerd Hoffmann | return NULL; |
498 | 021f0674 | Gerd Hoffmann | return &DO_UPCAST(ISAParallelState, dev, dev)->state;
|
499 | 6508fe59 | bellard | } |
500 | d60532ca | ths | |
501 | d60532ca | ths | /* Memory mapped interface */
|
502 | c227f099 | Anthony Liguori | static uint32_t parallel_mm_readb (void *opaque, target_phys_addr_t addr) |
503 | d60532ca | ths | { |
504 | d60532ca | ths | ParallelState *s = opaque; |
505 | d60532ca | ths | |
506 | 8da3ff18 | pbrook | return parallel_ioport_read_sw(s, addr >> s->it_shift) & 0xFF; |
507 | d60532ca | ths | } |
508 | d60532ca | ths | |
509 | 9596ebb7 | pbrook | static void parallel_mm_writeb (void *opaque, |
510 | c227f099 | Anthony Liguori | target_phys_addr_t addr, uint32_t value) |
511 | d60532ca | ths | { |
512 | d60532ca | ths | ParallelState *s = opaque; |
513 | d60532ca | ths | |
514 | 8da3ff18 | pbrook | parallel_ioport_write_sw(s, addr >> s->it_shift, value & 0xFF);
|
515 | d60532ca | ths | } |
516 | d60532ca | ths | |
517 | c227f099 | Anthony Liguori | static uint32_t parallel_mm_readw (void *opaque, target_phys_addr_t addr) |
518 | d60532ca | ths | { |
519 | d60532ca | ths | ParallelState *s = opaque; |
520 | d60532ca | ths | |
521 | 8da3ff18 | pbrook | return parallel_ioport_read_sw(s, addr >> s->it_shift) & 0xFFFF; |
522 | d60532ca | ths | } |
523 | d60532ca | ths | |
524 | 9596ebb7 | pbrook | static void parallel_mm_writew (void *opaque, |
525 | c227f099 | Anthony Liguori | target_phys_addr_t addr, uint32_t value) |
526 | d60532ca | ths | { |
527 | d60532ca | ths | ParallelState *s = opaque; |
528 | d60532ca | ths | |
529 | 8da3ff18 | pbrook | parallel_ioport_write_sw(s, addr >> s->it_shift, value & 0xFFFF);
|
530 | d60532ca | ths | } |
531 | d60532ca | ths | |
532 | c227f099 | Anthony Liguori | static uint32_t parallel_mm_readl (void *opaque, target_phys_addr_t addr) |
533 | d60532ca | ths | { |
534 | d60532ca | ths | ParallelState *s = opaque; |
535 | d60532ca | ths | |
536 | 8da3ff18 | pbrook | return parallel_ioport_read_sw(s, addr >> s->it_shift);
|
537 | d60532ca | ths | } |
538 | d60532ca | ths | |
539 | 9596ebb7 | pbrook | static void parallel_mm_writel (void *opaque, |
540 | c227f099 | Anthony Liguori | target_phys_addr_t addr, uint32_t value) |
541 | d60532ca | ths | { |
542 | d60532ca | ths | ParallelState *s = opaque; |
543 | d60532ca | ths | |
544 | 8da3ff18 | pbrook | parallel_ioport_write_sw(s, addr >> s->it_shift, value); |
545 | d60532ca | ths | } |
546 | d60532ca | ths | |
547 | d60efc6b | Blue Swirl | static CPUReadMemoryFunc * const parallel_mm_read_sw[] = { |
548 | d60532ca | ths | ¶llel_mm_readb, |
549 | d60532ca | ths | ¶llel_mm_readw, |
550 | d60532ca | ths | ¶llel_mm_readl, |
551 | d60532ca | ths | }; |
552 | d60532ca | ths | |
553 | d60efc6b | Blue Swirl | static CPUWriteMemoryFunc * const parallel_mm_write_sw[] = { |
554 | d60532ca | ths | ¶llel_mm_writeb, |
555 | d60532ca | ths | ¶llel_mm_writew, |
556 | d60532ca | ths | ¶llel_mm_writel, |
557 | d60532ca | ths | }; |
558 | d60532ca | ths | |
559 | d60532ca | ths | /* If fd is zero, it means that the parallel device uses the console */
|
560 | c227f099 | Anthony Liguori | ParallelState *parallel_mm_init(target_phys_addr_t base, int it_shift, qemu_irq irq, CharDriverState *chr)
|
561 | d60532ca | ths | { |
562 | d60532ca | ths | ParallelState *s; |
563 | d60532ca | ths | int io_sw;
|
564 | d60532ca | ths | |
565 | d60532ca | ths | s = qemu_mallocz(sizeof(ParallelState));
|
566 | 33093a0a | aurel32 | s->irq = irq; |
567 | 33093a0a | aurel32 | s->chr = chr; |
568 | d60532ca | ths | s->it_shift = it_shift; |
569 | 33093a0a | aurel32 | parallel_reset(s); |
570 | a08d4367 | Jan Kiszka | qemu_register_reset(parallel_reset, s); |
571 | d60532ca | ths | |
572 | 1eed09cb | Avi Kivity | io_sw = cpu_register_io_memory(parallel_mm_read_sw, parallel_mm_write_sw, s); |
573 | d60532ca | ths | cpu_register_physical_memory(base, 8 << it_shift, io_sw);
|
574 | d60532ca | ths | return s;
|
575 | d60532ca | ths | } |
576 | 021f0674 | Gerd Hoffmann | |
577 | 021f0674 | Gerd Hoffmann | static ISADeviceInfo parallel_isa_info = {
|
578 | 021f0674 | Gerd Hoffmann | .qdev.name = "isa-parallel",
|
579 | 021f0674 | Gerd Hoffmann | .qdev.size = sizeof(ISAParallelState),
|
580 | 021f0674 | Gerd Hoffmann | .init = parallel_isa_initfn, |
581 | 021f0674 | Gerd Hoffmann | .qdev.props = (Property[]) { |
582 | 021f0674 | Gerd Hoffmann | DEFINE_PROP_HEX32("iobase", ISAParallelState, iobase, 0x378), |
583 | 021f0674 | Gerd Hoffmann | DEFINE_PROP_UINT32("irq", ISAParallelState, isairq, 7), |
584 | 021f0674 | Gerd Hoffmann | DEFINE_PROP_CHR("chardev", ISAParallelState, state.chr),
|
585 | 021f0674 | Gerd Hoffmann | DEFINE_PROP_END_OF_LIST(), |
586 | 021f0674 | Gerd Hoffmann | }, |
587 | 021f0674 | Gerd Hoffmann | }; |
588 | 021f0674 | Gerd Hoffmann | |
589 | 021f0674 | Gerd Hoffmann | static void parallel_register_devices(void) |
590 | 021f0674 | Gerd Hoffmann | { |
591 | 021f0674 | Gerd Hoffmann | isa_qdev_register(¶llel_isa_info); |
592 | 021f0674 | Gerd Hoffmann | } |
593 | 021f0674 | Gerd Hoffmann | |
594 | 021f0674 | Gerd Hoffmann | device_init(parallel_register_devices) |