mirror of https://github.com/proxmox/mirror_qemu
sparc64: fix loosing interrupts
- clear interrupts only on writing to the interrupt clear registers - don't overwrite a currently active interrupt request - use the correct addresses for the interrupt clear registers (section 19.3.3.3 of the UltraSPARC™-IIi User’s Manual) Signed-off-by: Artyom Tarasenko <atar4qemu@gmail.com> Signed-off-by: Blue Swirl <blauwirbel@gmail.com>master
parent
852e82f303
commit
9625036d14
|
@ -2,6 +2,7 @@
|
||||||
* QEMU Ultrasparc APB PCI host
|
* QEMU Ultrasparc APB PCI host
|
||||||
*
|
*
|
||||||
* Copyright (c) 2006 Fabrice Bellard
|
* Copyright (c) 2006 Fabrice Bellard
|
||||||
|
* Copyright (c) 2012,2013 Artyom Tarasenko
|
||||||
*
|
*
|
||||||
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
||||||
* of this software and associated documentation files (the "Software"), to deal
|
* of this software and associated documentation files (the "Software"), to deal
|
||||||
|
@ -67,6 +68,7 @@ do { printf("APB: " fmt , ## __VA_ARGS__); } while (0)
|
||||||
#define RESET_WMASK 0x60000000
|
#define RESET_WMASK 0x60000000
|
||||||
|
|
||||||
#define MAX_IVEC 0x40
|
#define MAX_IVEC 0x40
|
||||||
|
#define NO_IRQ_REQUEST (MAX_IVEC + 1)
|
||||||
|
|
||||||
typedef struct APBState {
|
typedef struct APBState {
|
||||||
SysBusDevice busdev;
|
SysBusDevice busdev;
|
||||||
|
@ -75,17 +77,64 @@ typedef struct APBState {
|
||||||
MemoryRegion pci_config;
|
MemoryRegion pci_config;
|
||||||
MemoryRegion pci_mmio;
|
MemoryRegion pci_mmio;
|
||||||
MemoryRegion pci_ioport;
|
MemoryRegion pci_ioport;
|
||||||
|
uint64_t pci_irq_in;
|
||||||
uint32_t iommu[4];
|
uint32_t iommu[4];
|
||||||
uint32_t pci_control[16];
|
uint32_t pci_control[16];
|
||||||
uint32_t pci_irq_map[8];
|
uint32_t pci_irq_map[8];
|
||||||
uint32_t obio_irq_map[32];
|
uint32_t obio_irq_map[32];
|
||||||
qemu_irq *pbm_irqs;
|
qemu_irq *pbm_irqs;
|
||||||
qemu_irq *ivec_irqs;
|
qemu_irq *ivec_irqs;
|
||||||
|
unsigned int irq_request;
|
||||||
uint32_t reset_control;
|
uint32_t reset_control;
|
||||||
unsigned int nr_resets;
|
unsigned int nr_resets;
|
||||||
} APBState;
|
} APBState;
|
||||||
|
|
||||||
static void pci_apb_set_irq(void *opaque, int irq_num, int level);
|
static inline void pbm_set_request(APBState *s, unsigned int irq_num)
|
||||||
|
{
|
||||||
|
APB_DPRINTF("%s: request irq %d\n", __func__, irq_num);
|
||||||
|
|
||||||
|
s->irq_request = irq_num;
|
||||||
|
qemu_set_irq(s->ivec_irqs[irq_num], 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void pbm_check_irqs(APBState *s)
|
||||||
|
{
|
||||||
|
|
||||||
|
unsigned int i;
|
||||||
|
|
||||||
|
/* Previous request is not acknowledged, resubmit */
|
||||||
|
if (s->irq_request != NO_IRQ_REQUEST) {
|
||||||
|
pbm_set_request(s, s->irq_request);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
/* no request pending */
|
||||||
|
if (s->pci_irq_in == 0ULL) {
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
for (i = 0; i < 32; i++) {
|
||||||
|
if (s->pci_irq_in & (1ULL << i)) {
|
||||||
|
if (s->pci_irq_map[i >> 2] & PBM_PCI_IMR_ENABLED) {
|
||||||
|
pbm_set_request(s, i);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
for (i = 32; i < 64; i++) {
|
||||||
|
if (s->pci_irq_in & (1ULL << i)) {
|
||||||
|
if (s->obio_irq_map[i - 32] & PBM_PCI_IMR_ENABLED) {
|
||||||
|
pbm_set_request(s, i);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void pbm_clear_request(APBState *s, unsigned int irq_num)
|
||||||
|
{
|
||||||
|
APB_DPRINTF("%s: clear request irq %d\n", __func__, irq_num);
|
||||||
|
qemu_set_irq(s->ivec_irqs[irq_num], 0);
|
||||||
|
s->irq_request = NO_IRQ_REQUEST;
|
||||||
|
}
|
||||||
|
|
||||||
static void apb_config_writel (void *opaque, hwaddr addr,
|
static void apb_config_writel (void *opaque, hwaddr addr,
|
||||||
uint64_t val, unsigned size)
|
uint64_t val, unsigned size)
|
||||||
|
@ -105,24 +154,43 @@ static void apb_config_writel (void *opaque, hwaddr addr,
|
||||||
break;
|
break;
|
||||||
case 0xc00 ... 0xc3f: /* PCI interrupt control */
|
case 0xc00 ... 0xc3f: /* PCI interrupt control */
|
||||||
if (addr & 4) {
|
if (addr & 4) {
|
||||||
s->pci_irq_map[(addr & 0x3f) >> 3] &= PBM_PCI_IMR_MASK;
|
unsigned int ino = (addr & 0x3f) >> 3;
|
||||||
s->pci_irq_map[(addr & 0x3f) >> 3] |= val & ~PBM_PCI_IMR_MASK;
|
s->pci_irq_map[ino] &= PBM_PCI_IMR_MASK;
|
||||||
|
s->pci_irq_map[ino] |= val & ~PBM_PCI_IMR_MASK;
|
||||||
|
if ((s->irq_request == ino) && !(val & ~PBM_PCI_IMR_MASK)) {
|
||||||
|
pbm_clear_request(s, ino);
|
||||||
|
}
|
||||||
|
pbm_check_irqs(s);
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case 0x1000 ... 0x1080: /* OBIO interrupt control */
|
case 0x1000 ... 0x1080: /* OBIO interrupt control */
|
||||||
if (addr & 4) {
|
if (addr & 4) {
|
||||||
s->obio_irq_map[(addr & 0xff) >> 3] &= PBM_PCI_IMR_MASK;
|
unsigned int ino = ((addr & 0xff) >> 3);
|
||||||
s->obio_irq_map[(addr & 0xff) >> 3] |= val & ~PBM_PCI_IMR_MASK;
|
s->obio_irq_map[ino] &= PBM_PCI_IMR_MASK;
|
||||||
|
s->obio_irq_map[ino] |= val & ~PBM_PCI_IMR_MASK;
|
||||||
|
if ((s->irq_request == (ino | 0x20))
|
||||||
|
&& !(val & ~PBM_PCI_IMR_MASK)) {
|
||||||
|
pbm_clear_request(s, ino | 0x20);
|
||||||
|
}
|
||||||
|
pbm_check_irqs(s);
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case 0x1400 ... 0x143f: /* PCI interrupt clear */
|
case 0x1400 ... 0x14ff: /* PCI interrupt clear */
|
||||||
if (addr & 4) {
|
if (addr & 4) {
|
||||||
pci_apb_set_irq(s, (addr & 0x3f) >> 3, 0);
|
unsigned int ino = (addr & 0xff) >> 5;
|
||||||
|
if ((s->irq_request / 4) == ino) {
|
||||||
|
pbm_clear_request(s, s->irq_request);
|
||||||
|
pbm_check_irqs(s);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case 0x1800 ... 0x1860: /* OBIO interrupt clear */
|
case 0x1800 ... 0x1860: /* OBIO interrupt clear */
|
||||||
if (addr & 4) {
|
if (addr & 4) {
|
||||||
pci_apb_set_irq(s, 0x20 | ((addr & 0xff) >> 3), 0);
|
unsigned int ino = ((addr & 0xff) >> 3) | 0x20;
|
||||||
|
if (s->irq_request == ino) {
|
||||||
|
pbm_clear_request(s, ino);
|
||||||
|
pbm_check_irqs(s);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case 0x2000 ... 0x202f: /* PCI control */
|
case 0x2000 ... 0x202f: /* PCI control */
|
||||||
|
@ -304,23 +372,28 @@ static void pci_apb_set_irq(void *opaque, int irq_num, int level)
|
||||||
{
|
{
|
||||||
APBState *s = opaque;
|
APBState *s = opaque;
|
||||||
|
|
||||||
|
APB_DPRINTF("%s: set irq_in %d level %d\n", __func__, irq_num, level);
|
||||||
/* PCI IRQ map onto the first 32 INO. */
|
/* PCI IRQ map onto the first 32 INO. */
|
||||||
if (irq_num < 32) {
|
if (irq_num < 32) {
|
||||||
if (s->pci_irq_map[irq_num >> 2] & PBM_PCI_IMR_ENABLED) {
|
if (level) {
|
||||||
APB_DPRINTF("%s: set irq %d level %d\n", __func__, irq_num, level);
|
s->pci_irq_in |= 1ULL << irq_num;
|
||||||
qemu_set_irq(s->ivec_irqs[irq_num], level);
|
if (s->pci_irq_map[irq_num >> 2] & PBM_PCI_IMR_ENABLED) {
|
||||||
|
pbm_set_request(s, irq_num);
|
||||||
|
}
|
||||||
} else {
|
} else {
|
||||||
APB_DPRINTF("%s: not enabled: lower irq %d\n", __func__, irq_num);
|
s->pci_irq_in &= ~(1ULL << irq_num);
|
||||||
qemu_irq_lower(s->ivec_irqs[irq_num]);
|
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
/* OBIO IRQ map onto the next 16 INO. */
|
/* OBIO IRQ map onto the next 32 INO. */
|
||||||
if (s->obio_irq_map[irq_num - 32] & PBM_PCI_IMR_ENABLED) {
|
if (level) {
|
||||||
APB_DPRINTF("%s: set irq %d level %d\n", __func__, irq_num, level);
|
APB_DPRINTF("%s: set irq %d level %d\n", __func__, irq_num, level);
|
||||||
qemu_set_irq(s->ivec_irqs[irq_num], level);
|
s->pci_irq_in |= 1ULL << irq_num;
|
||||||
|
if ((s->irq_request == NO_IRQ_REQUEST)
|
||||||
|
&& (s->obio_irq_map[irq_num - 32] & PBM_PCI_IMR_ENABLED)) {
|
||||||
|
pbm_set_request(s, irq_num);
|
||||||
|
}
|
||||||
} else {
|
} else {
|
||||||
APB_DPRINTF("%s: not enabled: lower irq %d\n", __func__, irq_num);
|
s->pci_irq_in &= ~(1ULL << irq_num);
|
||||||
qemu_irq_lower(s->ivec_irqs[irq_num]);
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -420,6 +493,9 @@ static void pci_pbm_reset(DeviceState *d)
|
||||||
s->obio_irq_map[i] &= PBM_PCI_IMR_MASK;
|
s->obio_irq_map[i] &= PBM_PCI_IMR_MASK;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
s->irq_request = NO_IRQ_REQUEST;
|
||||||
|
s->pci_irq_in = 0ULL;
|
||||||
|
|
||||||
if (s->nr_resets++ == 0) {
|
if (s->nr_resets++ == 0) {
|
||||||
/* Power on reset */
|
/* Power on reset */
|
||||||
s->reset_control = POR;
|
s->reset_control = POR;
|
||||||
|
@ -445,6 +521,8 @@ static int pci_pbm_init_device(SysBusDevice *dev)
|
||||||
s->obio_irq_map[i] = ((0x1f << 6) | 0x20) + i;
|
s->obio_irq_map[i] = ((0x1f << 6) | 0x20) + i;
|
||||||
}
|
}
|
||||||
s->pbm_irqs = qemu_allocate_irqs(pci_apb_set_irq, s, MAX_IVEC);
|
s->pbm_irqs = qemu_allocate_irqs(pci_apb_set_irq, s, MAX_IVEC);
|
||||||
|
s->irq_request = NO_IRQ_REQUEST;
|
||||||
|
s->pci_irq_in = 0ULL;
|
||||||
|
|
||||||
/* apb_config */
|
/* apb_config */
|
||||||
memory_region_init_io(&s->apb_config, &apb_config_ops, s, "apb-config",
|
memory_region_init_io(&s->apb_config, &apb_config_ops, s, "apb-config",
|
||||||
|
|
Loading…
Reference in New Issue