mirror of https://github.com/xqemu/xqemu.git
PS/2 interface - Allow custom IO ports + IRQ, by Herve Poussineau.
git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@2431 c046a42c-6fe2-441c-8c8c-71466251a162
This commit is contained in:
parent
5867c88a82
commit
b7678d96c5
35
hw/pckbd.c
35
hw/pckbd.c
|
@ -121,6 +121,9 @@ typedef struct KBDState {
|
||||||
uint8_t pending;
|
uint8_t pending;
|
||||||
void *kbd;
|
void *kbd;
|
||||||
void *mouse;
|
void *mouse;
|
||||||
|
|
||||||
|
int irq_kbd;
|
||||||
|
int irq_mouse;
|
||||||
} KBDState;
|
} KBDState;
|
||||||
|
|
||||||
KBDState kbd_state;
|
KBDState kbd_state;
|
||||||
|
@ -130,10 +133,10 @@ KBDState kbd_state;
|
||||||
incorrect, but it avoids having to simulate exact delays */
|
incorrect, but it avoids having to simulate exact delays */
|
||||||
static void kbd_update_irq(KBDState *s)
|
static void kbd_update_irq(KBDState *s)
|
||||||
{
|
{
|
||||||
int irq12_level, irq1_level;
|
int irq_kbd_level, irq_mouse_level;
|
||||||
|
|
||||||
irq1_level = 0;
|
irq_kbd_level = 0;
|
||||||
irq12_level = 0;
|
irq_mouse_level = 0;
|
||||||
s->status &= ~(KBD_STAT_OBF | KBD_STAT_MOUSE_OBF);
|
s->status &= ~(KBD_STAT_OBF | KBD_STAT_MOUSE_OBF);
|
||||||
if (s->pending) {
|
if (s->pending) {
|
||||||
s->status |= KBD_STAT_OBF;
|
s->status |= KBD_STAT_OBF;
|
||||||
|
@ -141,15 +144,15 @@ static void kbd_update_irq(KBDState *s)
|
||||||
if (s->pending == KBD_PENDING_AUX) {
|
if (s->pending == KBD_PENDING_AUX) {
|
||||||
s->status |= KBD_STAT_MOUSE_OBF;
|
s->status |= KBD_STAT_MOUSE_OBF;
|
||||||
if (s->mode & KBD_MODE_MOUSE_INT)
|
if (s->mode & KBD_MODE_MOUSE_INT)
|
||||||
irq12_level = 1;
|
irq_mouse_level = 1;
|
||||||
} else {
|
} else {
|
||||||
if ((s->mode & KBD_MODE_KBD_INT) &&
|
if ((s->mode & KBD_MODE_KBD_INT) &&
|
||||||
!(s->mode & KBD_MODE_DISABLE_KBD))
|
!(s->mode & KBD_MODE_DISABLE_KBD))
|
||||||
irq1_level = 1;
|
irq_kbd_level = 1;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
pic_set_irq(1, irq1_level);
|
pic_set_irq(s->irq_kbd, irq_kbd_level);
|
||||||
pic_set_irq(12, irq12_level);
|
pic_set_irq(s->irq_mouse, irq_mouse_level);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void kbd_update_kbd_irq(void *opaque, int level)
|
static void kbd_update_kbd_irq(void *opaque, int level)
|
||||||
|
@ -353,18 +356,26 @@ static int kbd_load(QEMUFile* f, void* opaque, int version_id)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
void kbd_init(void)
|
void i8042_init(int kbd_irq_lvl, int mouse_irq_lvl, uint32_t io_base)
|
||||||
{
|
{
|
||||||
KBDState *s = &kbd_state;
|
KBDState *s = &kbd_state;
|
||||||
|
|
||||||
|
s->irq_kbd = kbd_irq_lvl;
|
||||||
|
s->irq_mouse = mouse_irq_lvl;
|
||||||
|
|
||||||
kbd_reset(s);
|
kbd_reset(s);
|
||||||
register_savevm("pckbd", 0, 3, kbd_save, kbd_load, s);
|
register_savevm("pckbd", 0, 3, kbd_save, kbd_load, s);
|
||||||
register_ioport_read(0x60, 1, 1, kbd_read_data, s);
|
register_ioport_read(io_base, 1, 1, kbd_read_data, s);
|
||||||
register_ioport_write(0x60, 1, 1, kbd_write_data, s);
|
register_ioport_write(io_base, 1, 1, kbd_write_data, s);
|
||||||
register_ioport_read(0x64, 1, 1, kbd_read_status, s);
|
register_ioport_read(io_base + 4, 1, 1, kbd_read_status, s);
|
||||||
register_ioport_write(0x64, 1, 1, kbd_write_command, s);
|
register_ioport_write(io_base + 4, 1, 1, kbd_write_command, s);
|
||||||
|
|
||||||
s->kbd = ps2_kbd_init(kbd_update_kbd_irq, s);
|
s->kbd = ps2_kbd_init(kbd_update_kbd_irq, s);
|
||||||
s->mouse = ps2_mouse_init(kbd_update_aux_irq, s);
|
s->mouse = ps2_mouse_init(kbd_update_aux_irq, s);
|
||||||
qemu_register_reset(kbd_reset, s);
|
qemu_register_reset(kbd_reset, s);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void kbd_init(void)
|
||||||
|
{
|
||||||
|
return i8042_init(1, 12, 0x60);
|
||||||
|
}
|
||||||
|
|
Loading…
Reference in New Issue