KBC reset is now hard reset.

This commit is contained in:
OBattler
2021-09-17 02:55:43 +02:00
parent 626e8e58bb
commit b8a2fdfd0a
3 changed files with 79 additions and 24 deletions

View File

@@ -1181,6 +1181,8 @@ static void
write_output(atkbd_t *dev, uint8_t val)
{
uint8_t kbc_ven = dev->flags & KBC_VEN_MASK;
uint8_t old = dev->p2;
kbd_log("ATkbc: write output port: %02X (old: %02X)\n", val, dev->p2);
if (!(dev->flags & KBC_FLAG_PS2))
@@ -1189,36 +1191,43 @@ write_output(atkbd_t *dev, uint8_t val)
dev->kbd_inhibit = (val & 0x40);
dev->mouse_inhibit = (val & 0x08);
if ((dev->p2 ^ val) & 0x20) { /*IRQ 12*/
/* IRQ 12 */
if ((old ^ val) & 0x20) {
if (val & 0x20) {
kbd_log("ATkbc: write_output(): IRQ 12\n");
picint(1 << 12);
} else
picintc(1 << 12);
}
if ((dev->p2 ^ val) & 0x10) { /*IRQ 1*/
/* IRQ 1 */
if ((old ^ val) & 0x10) {
if (val & 0x10) {
kbd_log("ATkbc: write_output(): IRQ 1\n");
picint(1 << 1);
} else
picintc(1 << 1);
}
if ((dev->p2 ^ val) & 0x02) { /*A20 enable change*/
/* A20 enable change */
if ((old ^ val) & 0x02) {
mem_a20_key = val & 0x02;
mem_a20_recalc();
flushmmucache();
}
if ((dev->p2 ^ val) & 0x01) { /*Reset*/
if (! (val & 0x01)) {
/* Do this here to avoid an infinite reset loop. */
dev->p2 = val;
/* 0 holds the CPU in the RESET state, 1 releases it. To simply this,
we just do everything on release. */
if ((val & 0x01) && !(old & 0x01)) {
if (val & 0x01) {
/* Pin 0 selected. */
pclog("write_output(): Pulse reset!\n");
softresetx86(); /*Pulse reset!*/
cpu_set_edx();
smbase = is_am486dxl ? 0x00060000 : 0x00030000;
hardresetx86(); /*Pulse reset!*/
}
}
/* Mask off the A20 stuff because we use mem_a20_key directly for that. */
dev->p2 = val;
}
@@ -2315,8 +2324,8 @@ write64_ami(void *priv, uint8_t val)
case 0xa1: /* get controller version */
kbd_log("ATkbc: AMI - get controller version\n");
// kbc_transmit(dev, 'H');
kbc_transmit(dev, 'Z');
kbc_transmit(dev, 'H');
// kbc_transmit(dev, 'Z');
return 0;
case 0xa2: /* clear keyboard controller lines P22/P23 */
@@ -2928,13 +2937,14 @@ kbd_reset(void *priv)
{
atkbd_t *dev = (atkbd_t *)priv;
int i;
uint8_t kbc_ven = 0x0;
kbc_ven = dev->flags & KBC_VEN_MASK;
uint8_t kbc_ven;
dev->status = STAT_UNLOCKED;
dev->mem[0x20] = 0x01;
dev->mem[0x20] |= CCB_TRANSLATE;
write_output(dev, 0xcf);
if (dev == NULL)
return;
kbc_ven = dev->flags & KBC_VEN_MASK;
dev->status &= ~(STAT_IFULL | STAT_OFULL | STAT_CD);
dev->last_irq = 0;
dev->secr_phase = 0;
dev->kbd_in = 0;
@@ -2973,6 +2983,20 @@ kbd_reset(void *priv)
}
static void
kbd_power_on(atkbd_t *dev)
{
kbd_reset(dev);
dev->status = STAT_UNLOCKED;
/* Write the value here first, so that we don't hit a pulse reset. */
dev->p2 = 0xcf;
write_output(dev, 0xcf);
dev->mem[0x20] = 0x01;
dev->mem[0x20] |= CCB_TRANSLATE;
}
/* Reset the AT keyboard - this is needed for the PCI TRC and is done
until a better solution is found. */
void
@@ -3064,7 +3088,7 @@ kbd_init(const device_t *info)
break;
}
kbd_reset(dev);
kbd_power_on(dev);
/* We need this, sadly. */
SavedKbd = dev;