i8259: Switch to per-PIC IRQ update
This converts pic_update_irq to work against a single PIC instead of the complete cascade. Along this change, the required update after pic_set_irq1 is now moved into that function. Signed-off-by: Jan Kiszka <jan.kiszka@siemens.com> Signed-off-by: Blue Swirl <blauwirbel@gmail.com>
This commit is contained in:
parent
86fbf97ceb
commit
b76750c1ab
59
hw/i8259.c
59
hw/i8259.c
@ -118,39 +118,19 @@ static int pic_get_irq(PicState *s)
|
||||
}
|
||||
}
|
||||
|
||||
static void pic_set_irq1(PicState *s, int irq, int level);
|
||||
|
||||
/* raise irq to CPU if necessary. must be called every time the active
|
||||
irq may change */
|
||||
static void pic_update_irq(PicState2 *s)
|
||||
/* Update INT output. Must be called every time the output may have changed. */
|
||||
static void pic_update_irq(PicState *s)
|
||||
{
|
||||
int irq2, irq;
|
||||
int irq;
|
||||
|
||||
/* first look at slave pic */
|
||||
irq2 = pic_get_irq(&s->pics[1]);
|
||||
if (irq2 >= 0) {
|
||||
/* if irq request by slave pic, signal master PIC */
|
||||
pic_set_irq1(&s->pics[0], 2, 1);
|
||||
pic_set_irq1(&s->pics[0], 2, 0);
|
||||
}
|
||||
/* look at requested irq */
|
||||
irq = pic_get_irq(&s->pics[0]);
|
||||
irq = pic_get_irq(s);
|
||||
if (irq >= 0) {
|
||||
#if defined(DEBUG_PIC)
|
||||
{
|
||||
int i;
|
||||
for(i = 0; i < 2; i++) {
|
||||
printf("pic%d: imr=%x irr=%x padd=%d\n",
|
||||
i, s->pics[i].imr, s->pics[i].irr,
|
||||
s->pics[i].priority_add);
|
||||
|
||||
}
|
||||
}
|
||||
printf("pic: cpu_interrupt\n");
|
||||
#endif
|
||||
qemu_irq_raise(s->pics[0].int_out);
|
||||
DPRINTF("pic%d: imr=%x irr=%x padd=%d\n",
|
||||
s == &s->pics_state->pics[0] ? 0 : 1, s->imr, s->irr,
|
||||
s->priority_add);
|
||||
qemu_irq_raise(s->int_out);
|
||||
} else {
|
||||
qemu_irq_lower(s->pics[0].int_out);
|
||||
qemu_irq_lower(s->int_out);
|
||||
}
|
||||
}
|
||||
|
||||
@ -179,6 +159,7 @@ static void pic_set_irq1(PicState *s, int irq, int level)
|
||||
s->last_irr &= ~mask;
|
||||
}
|
||||
}
|
||||
pic_update_irq(s);
|
||||
}
|
||||
|
||||
#ifdef DEBUG_IRQ_LATENCY
|
||||
@ -205,7 +186,6 @@ static void i8259_set_irq(void *opaque, int irq, int level)
|
||||
}
|
||||
#endif
|
||||
pic_set_irq1(&s->pics[irq >> 3], irq & 7, level);
|
||||
pic_update_irq(s);
|
||||
}
|
||||
|
||||
/* acknowledge interrupt 'irq' */
|
||||
@ -220,6 +200,7 @@ static void pic_intack(PicState *s, int irq)
|
||||
/* We don't clear a level sensitive interrupt here */
|
||||
if (!(s->elcr & (1 << irq)))
|
||||
s->irr &= ~(1 << irq);
|
||||
pic_update_irq(s);
|
||||
}
|
||||
|
||||
int pic_read_irq(PicState2 *s)
|
||||
@ -246,7 +227,6 @@ int pic_read_irq(PicState2 *s)
|
||||
irq = 7;
|
||||
intno = s->pics[0].irq_base + irq;
|
||||
}
|
||||
pic_update_irq(s);
|
||||
|
||||
#if defined(DEBUG_PIC) || defined(DEBUG_IRQ_LATENCY)
|
||||
if (irq == 2) {
|
||||
@ -281,7 +261,7 @@ static void pic_init_reset(PicState *s)
|
||||
s->init4 = 0;
|
||||
s->single_mode = 0;
|
||||
/* Note: ELCR is not reset */
|
||||
pic_update_irq(s->pics_state);
|
||||
pic_update_irq(s);
|
||||
}
|
||||
|
||||
static void pic_reset(void *opaque)
|
||||
@ -331,23 +311,23 @@ static void pic_ioport_write(void *opaque, target_phys_addr_t addr64,
|
||||
s->isr &= ~(1 << irq);
|
||||
if (cmd == 5)
|
||||
s->priority_add = (irq + 1) & 7;
|
||||
pic_update_irq(s->pics_state);
|
||||
pic_update_irq(s);
|
||||
}
|
||||
break;
|
||||
case 3:
|
||||
irq = val & 7;
|
||||
s->isr &= ~(1 << irq);
|
||||
pic_update_irq(s->pics_state);
|
||||
pic_update_irq(s);
|
||||
break;
|
||||
case 6:
|
||||
s->priority_add = (val + 1) & 7;
|
||||
pic_update_irq(s->pics_state);
|
||||
pic_update_irq(s);
|
||||
break;
|
||||
case 7:
|
||||
irq = val & 7;
|
||||
s->isr &= ~(1 << irq);
|
||||
s->priority_add = (irq + 1) & 7;
|
||||
pic_update_irq(s->pics_state);
|
||||
pic_update_irq(s);
|
||||
break;
|
||||
default:
|
||||
/* no operation */
|
||||
@ -359,7 +339,7 @@ static void pic_ioport_write(void *opaque, target_phys_addr_t addr64,
|
||||
case 0:
|
||||
/* normal mode */
|
||||
s->imr = val;
|
||||
pic_update_irq(s->pics_state);
|
||||
pic_update_irq(s);
|
||||
break;
|
||||
case 1:
|
||||
s->irq_base = val & 0xf8;
|
||||
@ -395,8 +375,9 @@ static uint32_t pic_poll_read(PicState *s)
|
||||
}
|
||||
s->irr &= ~(1 << ret);
|
||||
s->isr &= ~(1 << ret);
|
||||
if (slave || ret != 2)
|
||||
pic_update_irq(s->pics_state);
|
||||
if (slave || ret != 2) {
|
||||
pic_update_irq(s);
|
||||
}
|
||||
} else {
|
||||
ret = 0x07;
|
||||
}
|
||||
|
Loading…
Reference in New Issue
Block a user