]>
git.proxmox.com Git - mirror_qemu.git/blob - hw/slavio_serial.c
2 * QEMU Sparc SLAVIO serial port emulation
4 * Copyright (c) 2003-2005 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
26 //#define DEBUG_SERIAL
35 * This is the serial port, mouse and keyboard part of chip STP2001
36 * (Slave I/O), also produced as NCR89C105. See
37 * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR89C105.txt
39 * The serial ports implement full AMD AM8530 or Zilog Z8530 chips,
40 * mouse and keyboard ports don't implement all functions and they are
41 * only asynchronous. There is no DMA.
47 * 2006-Aug-10 Igor Kovalenko : Renamed KBDQueue to SERIOQueue, implemented
49 * Implemented serial mouse protocol.
53 #define SER_DPRINTF(fmt, args...) \
54 do { printf("SER: " fmt , ##args); } while (0)
55 #define pic_set_irq(irq, level) \
56 do { printf("SER: set_irq(%d): %d\n", (irq), (level)); pic_set_irq((irq),(level));} while (0)
58 #define SER_DPRINTF(fmt, args...)
61 #define KBD_DPRINTF(fmt, args...) \
62 do { printf("KBD: " fmt , ##args); } while (0)
64 #define KBD_DPRINTF(fmt, args...)
67 #define MS_DPRINTF(fmt, args...) \
68 do { printf("MSC: " fmt , ##args); } while (0)
70 #define MS_DPRINTF(fmt, args...)
81 #define SERIO_QUEUE_SIZE 256
84 uint8_t data
[SERIO_QUEUE_SIZE
];
85 int rptr
, wptr
, count
;
88 typedef struct ChannelState
{
92 chn_id_t chn
; // this channel, A (base+4) or B (base+0)
94 struct ChannelState
*otherchn
;
95 uint8_t rx
, tx
, wregs
[16], rregs
[16];
101 struct ChannelState chn
[2];
104 #define SERIAL_MAXADDR 7
106 static void handle_kbd_command(ChannelState
*s
, int val
);
107 static int serial_can_receive(void *opaque
);
108 static void serial_receive_byte(ChannelState
*s
, int ch
);
110 static void put_queue(void *opaque
, int b
)
112 ChannelState
*s
= opaque
;
113 SERIOQueue
*q
= &s
->queue
;
115 SER_DPRINTF("put: 0x%02x\n", b
);
116 if (q
->count
>= SERIO_QUEUE_SIZE
)
118 q
->data
[q
->wptr
] = b
;
119 if (++q
->wptr
== SERIO_QUEUE_SIZE
)
122 serial_receive_byte(s
, 0);
125 static uint32_t get_queue(void *opaque
)
127 ChannelState
*s
= opaque
;
128 SERIOQueue
*q
= &s
->queue
;
134 val
= q
->data
[q
->rptr
];
135 if (++q
->rptr
== SERIO_QUEUE_SIZE
)
139 KBD_DPRINTF("get 0x%02x\n", val
);
141 serial_receive_byte(s
, 0);
145 static void slavio_serial_update_irq(ChannelState
*s
)
147 if ((s
->wregs
[1] & 1) && // interrupts enabled
148 (((s
->wregs
[1] & 2) && s
->txint
== 1) || // tx ints enabled, pending
149 ((((s
->wregs
[1] & 0x18) == 8) || ((s
->wregs
[1] & 0x18) == 0x10)) &&
150 s
->rxint
== 1) || // rx ints enabled, pending
151 ((s
->wregs
[15] & 0x80) && (s
->rregs
[0] & 0x80)))) { // break int e&p
152 pic_set_irq(s
->irq
, 1);
154 pic_set_irq(s
->irq
, 0);
158 static void slavio_serial_reset_chn(ChannelState
*s
)
163 for (i
= 0; i
< SERIAL_MAXADDR
; i
++) {
176 s
->rxint
= s
->txint
= 0;
179 static void slavio_serial_reset(void *opaque
)
181 SerialState
*s
= opaque
;
182 slavio_serial_reset_chn(&s
->chn
[0]);
183 slavio_serial_reset_chn(&s
->chn
[1]);
186 static inline void clr_rxint(ChannelState
*s
)
190 s
->rregs
[3] &= ~0x20;
192 s
->otherchn
->rregs
[3] &= ~4;
194 slavio_serial_update_irq(s
);
197 static inline void set_rxint(ChannelState
*s
)
203 s
->otherchn
->rregs
[3] |= 4;
205 slavio_serial_update_irq(s
);
208 static inline void clr_txint(ChannelState
*s
)
212 s
->rregs
[3] &= ~0x10;
214 s
->otherchn
->rregs
[3] &= ~2;
216 slavio_serial_update_irq(s
);
219 static inline void set_txint(ChannelState
*s
)
225 s
->otherchn
->rregs
[3] |= 2;
227 slavio_serial_update_irq(s
);
230 static void slavio_serial_mem_writeb(void *opaque
, target_phys_addr_t addr
, uint32_t val
)
232 SerialState
*ser
= opaque
;
238 saddr
= (addr
& 3) >> 1;
239 channel
= (addr
& SERIAL_MAXADDR
) >> 2;
240 s
= &ser
->chn
[channel
];
243 SER_DPRINTF("Write channel %c, reg[%d] = %2.2x\n", channel
? 'b' : 'a', s
->reg
, val
& 0xff);
269 s
->wregs
[s
->reg
] = val
;
272 switch (val
& 0xc0) {
277 slavio_serial_reset_chn(&ser
->chn
[1]);
280 slavio_serial_reset_chn(&ser
->chn
[0]);
283 slavio_serial_reset(ser
);
296 SER_DPRINTF("Write channel %c, ch %d\n", channel
? 'b' : 'a', val
);
297 if (s
->wregs
[5] & 8) { // tx enabled
300 qemu_chr_write(s
->chr
, &s
->tx
, 1);
301 else if (s
->type
== kbd
) {
302 handle_kbd_command(s
, val
);
305 s
->rregs
[0] |= 4; // Tx buffer empty
306 s
->rregs
[1] |= 1; // All sent
308 slavio_serial_update_irq(s
);
316 static uint32_t slavio_serial_mem_readb(void *opaque
, target_phys_addr_t addr
)
318 SerialState
*ser
= opaque
;
324 saddr
= (addr
& 3) >> 1;
325 channel
= (addr
& SERIAL_MAXADDR
) >> 2;
326 s
= &ser
->chn
[channel
];
329 SER_DPRINTF("Read channel %c, reg[%d] = %2.2x\n", channel
? 'b' : 'a', s
->reg
, s
->rregs
[s
->reg
]);
330 ret
= s
->rregs
[s
->reg
];
336 if (s
->type
== kbd
|| s
->type
== mouse
)
340 SER_DPRINTF("Read channel %c, ch %d\n", channel
? 'b' : 'a', ret
);
348 static int serial_can_receive(void *opaque
)
350 ChannelState
*s
= opaque
;
351 if (((s
->wregs
[3] & 1) == 0) // Rx not enabled
352 || ((s
->rregs
[0] & 1) == 1)) // char already available
358 static void serial_receive_byte(ChannelState
*s
, int ch
)
360 SER_DPRINTF("put ch %d\n", ch
);
366 static void serial_receive_break(ChannelState
*s
)
369 slavio_serial_update_irq(s
);
372 static void serial_receive1(void *opaque
, const uint8_t *buf
, int size
)
374 ChannelState
*s
= opaque
;
375 serial_receive_byte(s
, buf
[0]);
378 static void serial_event(void *opaque
, int event
)
380 ChannelState
*s
= opaque
;
381 if (event
== CHR_EVENT_BREAK
)
382 serial_receive_break(s
);
385 static CPUReadMemoryFunc
*slavio_serial_mem_read
[3] = {
386 slavio_serial_mem_readb
,
387 slavio_serial_mem_readb
,
388 slavio_serial_mem_readb
,
391 static CPUWriteMemoryFunc
*slavio_serial_mem_write
[3] = {
392 slavio_serial_mem_writeb
,
393 slavio_serial_mem_writeb
,
394 slavio_serial_mem_writeb
,
397 static void slavio_serial_save_chn(QEMUFile
*f
, ChannelState
*s
)
399 qemu_put_be32s(f
, &s
->irq
);
400 qemu_put_be32s(f
, &s
->reg
);
401 qemu_put_be32s(f
, &s
->rxint
);
402 qemu_put_be32s(f
, &s
->txint
);
403 qemu_put_8s(f
, &s
->rx
);
404 qemu_put_8s(f
, &s
->tx
);
405 qemu_put_buffer(f
, s
->wregs
, 16);
406 qemu_put_buffer(f
, s
->rregs
, 16);
409 static void slavio_serial_save(QEMUFile
*f
, void *opaque
)
411 SerialState
*s
= opaque
;
413 slavio_serial_save_chn(f
, &s
->chn
[0]);
414 slavio_serial_save_chn(f
, &s
->chn
[1]);
417 static int slavio_serial_load_chn(QEMUFile
*f
, ChannelState
*s
, int version_id
)
422 qemu_get_be32s(f
, &s
->irq
);
423 qemu_get_be32s(f
, &s
->reg
);
424 qemu_get_be32s(f
, &s
->rxint
);
425 qemu_get_be32s(f
, &s
->txint
);
426 qemu_get_8s(f
, &s
->rx
);
427 qemu_get_8s(f
, &s
->tx
);
428 qemu_get_buffer(f
, s
->wregs
, 16);
429 qemu_get_buffer(f
, s
->rregs
, 16);
433 static int slavio_serial_load(QEMUFile
*f
, void *opaque
, int version_id
)
435 SerialState
*s
= opaque
;
438 ret
= slavio_serial_load_chn(f
, &s
->chn
[0], version_id
);
441 ret
= slavio_serial_load_chn(f
, &s
->chn
[1], version_id
);
446 SerialState
*slavio_serial_init(int base
, int irq
, CharDriverState
*chr1
, CharDriverState
*chr2
)
448 int slavio_serial_io_memory
, i
;
451 s
= qemu_mallocz(sizeof(SerialState
));
455 slavio_serial_io_memory
= cpu_register_io_memory(0, slavio_serial_mem_read
, slavio_serial_mem_write
, s
);
456 cpu_register_physical_memory(base
, SERIAL_MAXADDR
, slavio_serial_io_memory
);
458 s
->chn
[0].chr
= chr1
;
459 s
->chn
[1].chr
= chr2
;
461 for (i
= 0; i
< 2; i
++) {
463 s
->chn
[i
].chn
= 1 - i
;
464 s
->chn
[i
].type
= ser
;
466 qemu_chr_add_read_handler(s
->chn
[i
].chr
, serial_can_receive
, serial_receive1
, &s
->chn
[i
]);
467 qemu_chr_add_event_handler(s
->chn
[i
].chr
, serial_event
);
470 s
->chn
[0].otherchn
= &s
->chn
[1];
471 s
->chn
[1].otherchn
= &s
->chn
[0];
472 register_savevm("slavio_serial", base
, 1, slavio_serial_save
, slavio_serial_load
, s
);
473 qemu_register_reset(slavio_serial_reset
, s
);
474 slavio_serial_reset(s
);
478 static const uint8_t keycodes
[128] = {
479 127, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 43, 53,
480 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 89, 76, 77, 78,
481 79, 80, 81, 82, 83, 84, 85, 86, 87, 42, 99, 88, 100, 101, 102, 103,
482 104, 105, 106, 107, 108, 109, 110, 47, 19, 121, 119, 5, 6, 8, 10, 12,
483 14, 16, 17, 18, 7, 98, 23, 68, 69, 70, 71, 91, 92, 93, 125, 112,
484 113, 114, 94, 50, 0, 0, 124, 9, 11, 0, 0, 0, 0, 0, 0, 0,
485 90, 0, 46, 22, 13, 111, 52, 20, 96, 24, 28, 74, 27, 123, 44, 66,
486 0, 45, 2, 4, 48, 0, 0, 21, 0, 0, 0, 0, 0, 120, 122, 67,
489 static void sunkbd_event(void *opaque
, int ch
)
491 ChannelState
*s
= opaque
;
492 int release
= ch
& 0x80;
494 ch
= keycodes
[ch
& 0x7f];
495 KBD_DPRINTF("Keycode %d (%s)\n", ch
, release
? "release" : "press");
496 put_queue(s
, ch
| release
);
499 static void handle_kbd_command(ChannelState
*s
, int val
)
501 KBD_DPRINTF("Command %d\n", val
);
503 case 1: // Reset, return type code
505 put_queue(s
, 5); // Type 5
507 case 7: // Query layout
509 put_queue(s
, 0x20); // XXX, layout?
516 static void sunmouse_event(void *opaque
,
517 int dx
, int dy
, int dz
, int buttons_state
)
519 ChannelState
*s
= opaque
;
522 MS_DPRINTF("dx=%d dy=%d buttons=%01x\n", dx
, dy
, buttons_state
);
524 ch
= 0x80 | 0x7; /* protocol start byte, no buttons pressed */
526 if (buttons_state
& MOUSE_EVENT_LBUTTON
)
528 if (buttons_state
& MOUSE_EVENT_MBUTTON
)
530 if (buttons_state
& MOUSE_EVENT_RBUTTON
)
542 put_queue(s
, ch
& 0xff);
551 put_queue(s
, ch
& 0xff);
553 // MSC protocol specify two extra motion bytes
559 void slavio_serial_ms_kbd_init(int base
, int irq
)
561 int slavio_serial_io_memory
, i
;
564 s
= qemu_mallocz(sizeof(SerialState
));
567 for (i
= 0; i
< 2; i
++) {
569 s
->chn
[i
].chn
= 1 - i
;
570 s
->chn
[i
].chr
= NULL
;
572 s
->chn
[0].otherchn
= &s
->chn
[1];
573 s
->chn
[1].otherchn
= &s
->chn
[0];
574 s
->chn
[0].type
= mouse
;
575 s
->chn
[1].type
= kbd
;
577 slavio_serial_io_memory
= cpu_register_io_memory(0, slavio_serial_mem_read
, slavio_serial_mem_write
, s
);
578 cpu_register_physical_memory(base
, SERIAL_MAXADDR
, slavio_serial_io_memory
);
580 qemu_add_mouse_event_handler(sunmouse_event
, &s
->chn
[0], 0);
581 qemu_add_kbd_event_handler(sunkbd_event
, &s
->chn
[1]);
582 qemu_register_reset(slavio_serial_reset
, s
);
583 slavio_serial_reset(s
);