diff options
author | bellard <bellard@c046a42c-6fe2-441c-8c8c-71466251a162> | 2004-04-29 22:23:55 +0000 |
---|---|---|
committer | bellard <bellard@c046a42c-6fe2-441c-8c8c-71466251a162> | 2004-04-29 22:23:55 +0000 |
commit | 6f51f6b593e0a0065f83bcebb6f9e4aa05a4c8b3 (patch) | |
tree | 6629b0fc0ffb6ae7f0d25add547e1e42eab2741d /hw/pckbd.c | |
parent | 0294ffb9c848ed411c40cb0074ee5e16b7706f53 (diff) | |
download | qemu-6f51f6b593e0a0065f83bcebb6f9e4aa05a4c8b3.zip qemu-6f51f6b593e0a0065f83bcebb6f9e4aa05a4c8b3.tar.gz qemu-6f51f6b593e0a0065f83bcebb6f9e4aa05a4c8b3.tar.bz2 |
keyboard irq generation fix
git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@778 c046a42c-6fe2-441c-8c8c-71466251a162
Diffstat (limited to 'hw/pckbd.c')
-rw-r--r-- | hw/pckbd.c | 39 |
1 files changed, 18 insertions, 21 deletions
@@ -111,12 +111,13 @@ #define KBD_QUEUE_SIZE 256 typedef struct { + uint8_t aux[KBD_QUEUE_SIZE]; uint8_t data[KBD_QUEUE_SIZE]; int rptr, wptr, count; } KBDQueue; typedef struct KBDState { - KBDQueue queues[2]; + KBDQueue queue; uint8_t write_cmd; /* if non zero, write data to port 60 is expected */ uint8_t status; uint8_t mode; @@ -145,15 +146,15 @@ int reset_requested; incorrect, but it avoids having to simulate exact delays */ static void kbd_update_irq(KBDState *s) { + KBDQueue *q = &s->queue; int irq12_level, irq1_level; irq1_level = 0; irq12_level = 0; s->status &= ~(KBD_STAT_OBF | KBD_STAT_MOUSE_OBF); - if (s->queues[0].count != 0 || - s->queues[1].count != 0) { + if (q->count != 0) { s->status |= KBD_STAT_OBF; - if (s->queues[1].count != 0) { + if (q->aux[q->rptr]) { s->status |= KBD_STAT_MOUSE_OBF; if (s->mode & KBD_MODE_MOUSE_INT) irq12_level = 1; @@ -169,7 +170,7 @@ static void kbd_update_irq(KBDState *s) static void kbd_queue(KBDState *s, int b, int aux) { - KBDQueue *q = &s->queues[aux]; + KBDQueue *q = &s->queue; #if defined(DEBUG_MOUSE) || defined(DEBUG_KBD) if (aux) @@ -181,6 +182,7 @@ static void kbd_queue(KBDState *s, int b, int aux) #endif if (q->count >= KBD_QUEUE_SIZE) return; + q->aux[q->wptr] = aux; q->data[q->wptr] = b; if (++q->wptr == KBD_QUEUE_SIZE) q->wptr = 0; @@ -288,30 +290,28 @@ static uint32_t kbd_read_data(void *opaque, uint32_t addr) { KBDState *s = opaque; KBDQueue *q; - int val, index; + int val, index, aux; - q = &s->queues[1]; /* first check AUX data */ - if (q->count == 0) - q = &s->queues[0]; /* then check KBD data */ + q = &s->queue; if (q->count == 0) { /* NOTE: if no data left, we return the last keyboard one (needed for EMM386) */ /* XXX: need a timer to do things correctly */ - q = &s->queues[0]; index = q->rptr - 1; if (index < 0) index = KBD_QUEUE_SIZE - 1; val = q->data[index]; } else { + aux = q->aux[q->rptr]; val = q->data[q->rptr]; if (++q->rptr == KBD_QUEUE_SIZE) q->rptr = 0; q->count--; /* reading deasserts IRQ */ - if (q == &s->queues[0]) - pic_set_irq(1, 0); - else + if (aux) pic_set_irq(12, 0); + else + pic_set_irq(1, 0); } /* reassert IRQs if data left */ kbd_update_irq(s); @@ -452,7 +452,7 @@ void kbd_mouse_event(int dx, int dy, int dz, int buttons_state) s->mouse_buttons = buttons_state; if (!(s->mouse_status & MOUSE_STATUS_REMOTE) && - (s->queues[1].count < (KBD_QUEUE_SIZE - 16))) { + (s->queue.count < (KBD_QUEUE_SIZE - 16))) { for(;;) { /* if not remote, send event. Multiple events are sent if too big deltas */ @@ -632,18 +632,15 @@ void kbd_write_data(void *opaque, uint32_t addr, uint32_t val) void kbd_reset(KBDState *s) { KBDQueue *q; - int i; s->kbd_write_cmd = -1; s->mouse_write_cmd = -1; s->mode = KBD_MODE_KBD_INT | KBD_MODE_MOUSE_INT; s->status = KBD_STAT_CMD | KBD_STAT_UNLOCKED; - for(i = 0; i < 2; i++) { - q = &s->queues[i]; - q->rptr = 0; - q->wptr = 0; - q->count = 0; - } + q = &s->queue; + q->rptr = 0; + q->wptr = 0; + q->count = 0; } void kbd_init(void) |