microblaze: Dont segfault when singlestepping first insn.
[qemu/agraf.git] / hw / parallel.c
blob12693d40d29fe2cff5509399201decbe3b60aa87
1 /*
2 * QEMU Parallel PORT emulation
4 * Copyright (c) 2003-2005 Fabrice Bellard
5 * Copyright (c) 2007 Marko Kohtala
7 * Permission is hereby granted, free of charge, to any person obtaining a copy
8 * of this software and associated documentation files (the "Software"), to deal
9 * in the Software without restriction, including without limitation the rights
10 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
11 * copies of the Software, and to permit persons to whom the Software is
12 * furnished to do so, subject to the following conditions:
14 * The above copyright notice and this permission notice shall be included in
15 * all copies or substantial portions of the Software.
17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
19 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
20 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
21 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
22 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
23 * THE SOFTWARE.
25 #include "hw.h"
26 #include "qemu-char.h"
27 #include "isa.h"
28 #include "pc.h"
30 //#define DEBUG_PARALLEL
32 #ifdef DEBUG_PARALLEL
33 #define pdebug(fmt, ...) printf("pp: " fmt, ## __VA_ARGS__)
34 #else
35 #define pdebug(fmt, ...) ((void)0)
36 #endif
38 #define PARA_REG_DATA 0
39 #define PARA_REG_STS 1
40 #define PARA_REG_CTR 2
41 #define PARA_REG_EPP_ADDR 3
42 #define PARA_REG_EPP_DATA 4
45 * These are the definitions for the Printer Status Register
47 #define PARA_STS_BUSY 0x80 /* Busy complement */
48 #define PARA_STS_ACK 0x40 /* Acknowledge */
49 #define PARA_STS_PAPER 0x20 /* Out of paper */
50 #define PARA_STS_ONLINE 0x10 /* Online */
51 #define PARA_STS_ERROR 0x08 /* Error complement */
52 #define PARA_STS_TMOUT 0x01 /* EPP timeout */
55 * These are the definitions for the Printer Control Register
57 #define PARA_CTR_DIR 0x20 /* Direction (1=read, 0=write) */
58 #define PARA_CTR_INTEN 0x10 /* IRQ Enable */
59 #define PARA_CTR_SELECT 0x08 /* Select In complement */
60 #define PARA_CTR_INIT 0x04 /* Initialize Printer complement */
61 #define PARA_CTR_AUTOLF 0x02 /* Auto linefeed complement */
62 #define PARA_CTR_STROBE 0x01 /* Strobe complement */
64 #define PARA_CTR_SIGNAL (PARA_CTR_SELECT|PARA_CTR_INIT|PARA_CTR_AUTOLF|PARA_CTR_STROBE)
66 struct ParallelState {
67 uint8_t dataw;
68 uint8_t datar;
69 uint8_t status;
70 uint8_t control;
71 qemu_irq irq;
72 int irq_pending;
73 CharDriverState *chr;
74 int hw_driver;
75 int epp_timeout;
76 uint32_t last_read_offset; /* For debugging */
77 /* Memory-mapped interface */
78 int it_shift;
81 typedef struct ISAParallelState {
82 ISADevice dev;
83 uint32_t index;
84 uint32_t iobase;
85 uint32_t isairq;
86 ParallelState state;
87 } ISAParallelState;
89 static void parallel_update_irq(ParallelState *s)
91 if (s->irq_pending)
92 qemu_irq_raise(s->irq);
93 else
94 qemu_irq_lower(s->irq);
97 static void
98 parallel_ioport_write_sw(void *opaque, uint32_t addr, uint32_t val)
100 ParallelState *s = opaque;
102 pdebug("write addr=0x%02x val=0x%02x\n", addr, val);
104 addr &= 7;
105 switch(addr) {
106 case PARA_REG_DATA:
107 s->dataw = val;
108 parallel_update_irq(s);
109 break;
110 case PARA_REG_CTR:
111 val |= 0xc0;
112 if ((val & PARA_CTR_INIT) == 0 ) {
113 s->status = PARA_STS_BUSY;
114 s->status |= PARA_STS_ACK;
115 s->status |= PARA_STS_ONLINE;
116 s->status |= PARA_STS_ERROR;
118 else if (val & PARA_CTR_SELECT) {
119 if (val & PARA_CTR_STROBE) {
120 s->status &= ~PARA_STS_BUSY;
121 if ((s->control & PARA_CTR_STROBE) == 0)
122 qemu_chr_write(s->chr, &s->dataw, 1);
123 } else {
124 if (s->control & PARA_CTR_INTEN) {
125 s->irq_pending = 1;
129 parallel_update_irq(s);
130 s->control = val;
131 break;
135 static void parallel_ioport_write_hw(void *opaque, uint32_t addr, uint32_t val)
137 ParallelState *s = opaque;
138 uint8_t parm = val;
139 int dir;
141 /* Sometimes programs do several writes for timing purposes on old
142 HW. Take care not to waste time on writes that do nothing. */
144 s->last_read_offset = ~0U;
146 addr &= 7;
147 switch(addr) {
148 case PARA_REG_DATA:
149 if (s->dataw == val)
150 return;
151 pdebug("wd%02x\n", val);
152 qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_WRITE_DATA, &parm);
153 s->dataw = val;
154 break;
155 case PARA_REG_STS:
156 pdebug("ws%02x\n", val);
157 if (val & PARA_STS_TMOUT)
158 s->epp_timeout = 0;
159 break;
160 case PARA_REG_CTR:
161 val |= 0xc0;
162 if (s->control == val)
163 return;
164 pdebug("wc%02x\n", val);
166 if ((val & PARA_CTR_DIR) != (s->control & PARA_CTR_DIR)) {
167 if (val & PARA_CTR_DIR) {
168 dir = 1;
169 } else {
170 dir = 0;
172 qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_DATA_DIR, &dir);
173 parm &= ~PARA_CTR_DIR;
176 qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_WRITE_CONTROL, &parm);
177 s->control = val;
178 break;
179 case PARA_REG_EPP_ADDR:
180 if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != PARA_CTR_INIT)
181 /* Controls not correct for EPP address cycle, so do nothing */
182 pdebug("wa%02x s\n", val);
183 else {
184 struct ParallelIOArg ioarg = { .buffer = &parm, .count = 1 };
185 if (qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_WRITE_ADDR, &ioarg)) {
186 s->epp_timeout = 1;
187 pdebug("wa%02x t\n", val);
189 else
190 pdebug("wa%02x\n", val);
192 break;
193 case PARA_REG_EPP_DATA:
194 if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != PARA_CTR_INIT)
195 /* Controls not correct for EPP data cycle, so do nothing */
196 pdebug("we%02x s\n", val);
197 else {
198 struct ParallelIOArg ioarg = { .buffer = &parm, .count = 1 };
199 if (qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_WRITE, &ioarg)) {
200 s->epp_timeout = 1;
201 pdebug("we%02x t\n", val);
203 else
204 pdebug("we%02x\n", val);
206 break;
210 static void
211 parallel_ioport_eppdata_write_hw2(void *opaque, uint32_t addr, uint32_t val)
213 ParallelState *s = opaque;
214 uint16_t eppdata = cpu_to_le16(val);
215 int err;
216 struct ParallelIOArg ioarg = {
217 .buffer = &eppdata, .count = sizeof(eppdata)
219 if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != PARA_CTR_INIT) {
220 /* Controls not correct for EPP data cycle, so do nothing */
221 pdebug("we%04x s\n", val);
222 return;
224 err = qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_WRITE, &ioarg);
225 if (err) {
226 s->epp_timeout = 1;
227 pdebug("we%04x t\n", val);
229 else
230 pdebug("we%04x\n", val);
233 static void
234 parallel_ioport_eppdata_write_hw4(void *opaque, uint32_t addr, uint32_t val)
236 ParallelState *s = opaque;
237 uint32_t eppdata = cpu_to_le32(val);
238 int err;
239 struct ParallelIOArg ioarg = {
240 .buffer = &eppdata, .count = sizeof(eppdata)
242 if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != PARA_CTR_INIT) {
243 /* Controls not correct for EPP data cycle, so do nothing */
244 pdebug("we%08x s\n", val);
245 return;
247 err = qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_WRITE, &ioarg);
248 if (err) {
249 s->epp_timeout = 1;
250 pdebug("we%08x t\n", val);
252 else
253 pdebug("we%08x\n", val);
256 static uint32_t parallel_ioport_read_sw(void *opaque, uint32_t addr)
258 ParallelState *s = opaque;
259 uint32_t ret = 0xff;
261 addr &= 7;
262 switch(addr) {
263 case PARA_REG_DATA:
264 if (s->control & PARA_CTR_DIR)
265 ret = s->datar;
266 else
267 ret = s->dataw;
268 break;
269 case PARA_REG_STS:
270 ret = s->status;
271 s->irq_pending = 0;
272 if ((s->status & PARA_STS_BUSY) == 0 && (s->control & PARA_CTR_STROBE) == 0) {
273 /* XXX Fixme: wait 5 microseconds */
274 if (s->status & PARA_STS_ACK)
275 s->status &= ~PARA_STS_ACK;
276 else {
277 /* XXX Fixme: wait 5 microseconds */
278 s->status |= PARA_STS_ACK;
279 s->status |= PARA_STS_BUSY;
282 parallel_update_irq(s);
283 break;
284 case PARA_REG_CTR:
285 ret = s->control;
286 break;
288 pdebug("read addr=0x%02x val=0x%02x\n", addr, ret);
289 return ret;
292 static uint32_t parallel_ioport_read_hw(void *opaque, uint32_t addr)
294 ParallelState *s = opaque;
295 uint8_t ret = 0xff;
296 addr &= 7;
297 switch(addr) {
298 case PARA_REG_DATA:
299 qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_READ_DATA, &ret);
300 if (s->last_read_offset != addr || s->datar != ret)
301 pdebug("rd%02x\n", ret);
302 s->datar = ret;
303 break;
304 case PARA_REG_STS:
305 qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_READ_STATUS, &ret);
306 ret &= ~PARA_STS_TMOUT;
307 if (s->epp_timeout)
308 ret |= PARA_STS_TMOUT;
309 if (s->last_read_offset != addr || s->status != ret)
310 pdebug("rs%02x\n", ret);
311 s->status = ret;
312 break;
313 case PARA_REG_CTR:
314 /* s->control has some bits fixed to 1. It is zero only when
315 it has not been yet written to. */
316 if (s->control == 0) {
317 qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_READ_CONTROL, &ret);
318 if (s->last_read_offset != addr)
319 pdebug("rc%02x\n", ret);
320 s->control = ret;
322 else {
323 ret = s->control;
324 if (s->last_read_offset != addr)
325 pdebug("rc%02x\n", ret);
327 break;
328 case PARA_REG_EPP_ADDR:
329 if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != (PARA_CTR_DIR|PARA_CTR_INIT))
330 /* Controls not correct for EPP addr cycle, so do nothing */
331 pdebug("ra%02x s\n", ret);
332 else {
333 struct ParallelIOArg ioarg = { .buffer = &ret, .count = 1 };
334 if (qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_READ_ADDR, &ioarg)) {
335 s->epp_timeout = 1;
336 pdebug("ra%02x t\n", ret);
338 else
339 pdebug("ra%02x\n", ret);
341 break;
342 case PARA_REG_EPP_DATA:
343 if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != (PARA_CTR_DIR|PARA_CTR_INIT))
344 /* Controls not correct for EPP data cycle, so do nothing */
345 pdebug("re%02x s\n", ret);
346 else {
347 struct ParallelIOArg ioarg = { .buffer = &ret, .count = 1 };
348 if (qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_READ, &ioarg)) {
349 s->epp_timeout = 1;
350 pdebug("re%02x t\n", ret);
352 else
353 pdebug("re%02x\n", ret);
355 break;
357 s->last_read_offset = addr;
358 return ret;
361 static uint32_t
362 parallel_ioport_eppdata_read_hw2(void *opaque, uint32_t addr)
364 ParallelState *s = opaque;
365 uint32_t ret;
366 uint16_t eppdata = ~0;
367 int err;
368 struct ParallelIOArg ioarg = {
369 .buffer = &eppdata, .count = sizeof(eppdata)
371 if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != (PARA_CTR_DIR|PARA_CTR_INIT)) {
372 /* Controls not correct for EPP data cycle, so do nothing */
373 pdebug("re%04x s\n", eppdata);
374 return eppdata;
376 err = qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_READ, &ioarg);
377 ret = le16_to_cpu(eppdata);
379 if (err) {
380 s->epp_timeout = 1;
381 pdebug("re%04x t\n", ret);
383 else
384 pdebug("re%04x\n", ret);
385 return ret;
388 static uint32_t
389 parallel_ioport_eppdata_read_hw4(void *opaque, uint32_t addr)
391 ParallelState *s = opaque;
392 uint32_t ret;
393 uint32_t eppdata = ~0U;
394 int err;
395 struct ParallelIOArg ioarg = {
396 .buffer = &eppdata, .count = sizeof(eppdata)
398 if ((s->control & (PARA_CTR_DIR|PARA_CTR_SIGNAL)) != (PARA_CTR_DIR|PARA_CTR_INIT)) {
399 /* Controls not correct for EPP data cycle, so do nothing */
400 pdebug("re%08x s\n", eppdata);
401 return eppdata;
403 err = qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_EPP_READ, &ioarg);
404 ret = le32_to_cpu(eppdata);
406 if (err) {
407 s->epp_timeout = 1;
408 pdebug("re%08x t\n", ret);
410 else
411 pdebug("re%08x\n", ret);
412 return ret;
415 static void parallel_ioport_ecp_write(void *opaque, uint32_t addr, uint32_t val)
417 addr &= 7;
418 pdebug("wecp%d=%02x\n", addr, val);
421 static uint32_t parallel_ioport_ecp_read(void *opaque, uint32_t addr)
423 uint8_t ret = 0xff;
424 addr &= 7;
425 pdebug("recp%d:%02x\n", addr, ret);
426 return ret;
429 static void parallel_reset(void *opaque)
431 ParallelState *s = opaque;
433 s->datar = ~0;
434 s->dataw = ~0;
435 s->status = PARA_STS_BUSY;
436 s->status |= PARA_STS_ACK;
437 s->status |= PARA_STS_ONLINE;
438 s->status |= PARA_STS_ERROR;
439 s->status |= PARA_STS_TMOUT;
440 s->control = PARA_CTR_SELECT;
441 s->control |= PARA_CTR_INIT;
442 s->control |= 0xc0;
443 s->irq_pending = 0;
444 s->hw_driver = 0;
445 s->epp_timeout = 0;
446 s->last_read_offset = ~0U;
449 static const int isa_parallel_io[MAX_PARALLEL_PORTS] = { 0x378, 0x278, 0x3bc };
451 static int parallel_isa_initfn(ISADevice *dev)
453 static int index;
454 ISAParallelState *isa = DO_UPCAST(ISAParallelState, dev, dev);
455 ParallelState *s = &isa->state;
456 int base;
457 uint8_t dummy;
459 if (!s->chr) {
460 fprintf(stderr, "Can't create parallel device, empty char device\n");
461 exit(1);
464 if (isa->index == -1)
465 isa->index = index;
466 if (isa->index >= MAX_PARALLEL_PORTS)
467 return -1;
468 if (isa->iobase == -1)
469 isa->iobase = isa_parallel_io[isa->index];
470 index++;
472 base = isa->iobase;
473 isa_init_irq(dev, &s->irq, isa->isairq);
474 qemu_register_reset(parallel_reset, s);
476 if (qemu_chr_ioctl(s->chr, CHR_IOCTL_PP_READ_STATUS, &dummy) == 0) {
477 s->hw_driver = 1;
478 s->status = dummy;
481 if (s->hw_driver) {
482 register_ioport_write(base, 8, 1, parallel_ioport_write_hw, s);
483 register_ioport_read(base, 8, 1, parallel_ioport_read_hw, s);
484 register_ioport_write(base+4, 1, 2, parallel_ioport_eppdata_write_hw2, s);
485 register_ioport_read(base+4, 1, 2, parallel_ioport_eppdata_read_hw2, s);
486 register_ioport_write(base+4, 1, 4, parallel_ioport_eppdata_write_hw4, s);
487 register_ioport_read(base+4, 1, 4, parallel_ioport_eppdata_read_hw4, s);
488 register_ioport_write(base+0x400, 8, 1, parallel_ioport_ecp_write, s);
489 register_ioport_read(base+0x400, 8, 1, parallel_ioport_ecp_read, s);
491 else {
492 register_ioport_write(base, 8, 1, parallel_ioport_write_sw, s);
493 register_ioport_read(base, 8, 1, parallel_ioport_read_sw, s);
495 return 0;
498 ParallelState *parallel_init(int index, CharDriverState *chr)
500 ISADevice *dev;
502 dev = isa_create("isa-parallel");
503 qdev_prop_set_uint32(&dev->qdev, "index", index);
504 qdev_prop_set_chr(&dev->qdev, "chardev", chr);
505 if (qdev_init(&dev->qdev) < 0)
506 return NULL;
507 return &DO_UPCAST(ISAParallelState, dev, dev)->state;
510 /* Memory mapped interface */
511 static uint32_t parallel_mm_readb (void *opaque, target_phys_addr_t addr)
513 ParallelState *s = opaque;
515 return parallel_ioport_read_sw(s, addr >> s->it_shift) & 0xFF;
518 static void parallel_mm_writeb (void *opaque,
519 target_phys_addr_t addr, uint32_t value)
521 ParallelState *s = opaque;
523 parallel_ioport_write_sw(s, addr >> s->it_shift, value & 0xFF);
526 static uint32_t parallel_mm_readw (void *opaque, target_phys_addr_t addr)
528 ParallelState *s = opaque;
530 return parallel_ioport_read_sw(s, addr >> s->it_shift) & 0xFFFF;
533 static void parallel_mm_writew (void *opaque,
534 target_phys_addr_t addr, uint32_t value)
536 ParallelState *s = opaque;
538 parallel_ioport_write_sw(s, addr >> s->it_shift, value & 0xFFFF);
541 static uint32_t parallel_mm_readl (void *opaque, target_phys_addr_t addr)
543 ParallelState *s = opaque;
545 return parallel_ioport_read_sw(s, addr >> s->it_shift);
548 static void parallel_mm_writel (void *opaque,
549 target_phys_addr_t addr, uint32_t value)
551 ParallelState *s = opaque;
553 parallel_ioport_write_sw(s, addr >> s->it_shift, value);
556 static CPUReadMemoryFunc * const parallel_mm_read_sw[] = {
557 &parallel_mm_readb,
558 &parallel_mm_readw,
559 &parallel_mm_readl,
562 static CPUWriteMemoryFunc * const parallel_mm_write_sw[] = {
563 &parallel_mm_writeb,
564 &parallel_mm_writew,
565 &parallel_mm_writel,
568 /* If fd is zero, it means that the parallel device uses the console */
569 ParallelState *parallel_mm_init(target_phys_addr_t base, int it_shift, qemu_irq irq, CharDriverState *chr)
571 ParallelState *s;
572 int io_sw;
574 s = qemu_mallocz(sizeof(ParallelState));
575 s->irq = irq;
576 s->chr = chr;
577 s->it_shift = it_shift;
578 qemu_register_reset(parallel_reset, s);
580 io_sw = cpu_register_io_memory(parallel_mm_read_sw, parallel_mm_write_sw, s);
581 cpu_register_physical_memory(base, 8 << it_shift, io_sw);
582 return s;
585 static ISADeviceInfo parallel_isa_info = {
586 .qdev.name = "isa-parallel",
587 .qdev.size = sizeof(ISAParallelState),
588 .init = parallel_isa_initfn,
589 .qdev.props = (Property[]) {
590 DEFINE_PROP_UINT32("index", ISAParallelState, index, -1),
591 DEFINE_PROP_HEX32("iobase", ISAParallelState, iobase, -1),
592 DEFINE_PROP_UINT32("irq", ISAParallelState, isairq, 7),
593 DEFINE_PROP_CHR("chardev", ISAParallelState, state.chr),
594 DEFINE_PROP_END_OF_LIST(),
598 static void parallel_register_devices(void)
600 isa_qdev_register(&parallel_isa_info);
603 device_init(parallel_register_devices)