heathrow: QOMify heathrow PIC

Signed-off-by: Mark Cave-Ayland <mark.cave-ayland@ilande.co.uk>
Signed-off-by: David Gibson <david@gibson.dropbear.id.au>
This commit is contained in:
Mark Cave-Ayland 2018-02-28 20:32:34 +00:00 committed by David Gibson
parent 343bd85a40
commit 086df4f30a
2 changed files with 120 additions and 57 deletions

View File

@ -25,6 +25,7 @@
#include "qemu/osdep.h" #include "qemu/osdep.h"
#include "hw/hw.h" #include "hw/hw.h"
#include "hw/ppc/mac.h" #include "hw/ppc/mac.h"
#include "hw/intc/heathrow_pic.h"
/* debug PIC */ /* debug PIC */
//#define DEBUG_PIC //#define DEBUG_PIC
@ -36,39 +37,27 @@
#define PIC_DPRINTF(fmt, ...) #define PIC_DPRINTF(fmt, ...)
#endif #endif
typedef struct HeathrowPIC { static inline int heathrow_check_irq(HeathrowPICState *pic)
uint32_t events;
uint32_t mask;
uint32_t levels;
uint32_t level_triggered;
} HeathrowPIC;
typedef struct HeathrowPICS {
MemoryRegion mem;
HeathrowPIC pics[2];
qemu_irq *irqs;
} HeathrowPICS;
static inline int check_irq(HeathrowPIC *pic)
{ {
return (pic->events | (pic->levels & pic->level_triggered)) & pic->mask; return (pic->events | (pic->levels & pic->level_triggered)) & pic->mask;
} }
/* update the CPU irq state */ /* update the CPU irq state */
static void heathrow_pic_update(HeathrowPICS *s) static void heathrow_update_irq(HeathrowState *s)
{ {
if (check_irq(&s->pics[0]) || check_irq(&s->pics[1])) { if (heathrow_check_irq(&s->pics[0]) ||
heathrow_check_irq(&s->pics[1])) {
qemu_irq_raise(s->irqs[0]); qemu_irq_raise(s->irqs[0]);
} else { } else {
qemu_irq_lower(s->irqs[0]); qemu_irq_lower(s->irqs[0]);
} }
} }
static void pic_write(void *opaque, hwaddr addr, static void heathrow_write(void *opaque, hwaddr addr,
uint64_t value, unsigned size) uint64_t value, unsigned size)
{ {
HeathrowPICS *s = opaque; HeathrowState *s = opaque;
HeathrowPIC *pic; HeathrowPICState *pic;
unsigned int n; unsigned int n;
n = ((addr & 0xfff) - 0x10) >> 4; n = ((addr & 0xfff) - 0x10) >> 4;
@ -79,24 +68,24 @@ static void pic_write(void *opaque, hwaddr addr,
switch(addr & 0xf) { switch(addr & 0xf) {
case 0x04: case 0x04:
pic->mask = value; pic->mask = value;
heathrow_pic_update(s); heathrow_update_irq(s);
break; break;
case 0x08: case 0x08:
/* do not reset level triggered IRQs */ /* do not reset level triggered IRQs */
value &= ~pic->level_triggered; value &= ~pic->level_triggered;
pic->events &= ~value; pic->events &= ~value;
heathrow_pic_update(s); heathrow_update_irq(s);
break; break;
default: default:
break; break;
} }
} }
static uint64_t pic_read(void *opaque, hwaddr addr, static uint64_t heathrow_read(void *opaque, hwaddr addr,
unsigned size) unsigned size)
{ {
HeathrowPICS *s = opaque; HeathrowState *s = opaque;
HeathrowPIC *pic; HeathrowPICState *pic;
unsigned int n; unsigned int n;
uint32_t value; uint32_t value;
@ -124,16 +113,16 @@ static uint64_t pic_read(void *opaque, hwaddr addr,
return value; return value;
} }
static const MemoryRegionOps heathrow_pic_ops = { static const MemoryRegionOps heathrow_ops = {
.read = pic_read, .read = heathrow_read,
.write = pic_write, .write = heathrow_write,
.endianness = DEVICE_LITTLE_ENDIAN, .endianness = DEVICE_LITTLE_ENDIAN,
}; };
static void heathrow_pic_set_irq(void *opaque, int num, int level) static void heathrow_set_irq(void *opaque, int num, int level)
{ {
HeathrowPICS *s = opaque; HeathrowState *s = opaque;
HeathrowPIC *pic; HeathrowPICState *pic;
unsigned int irq_bit; unsigned int irq_bit;
#if defined(DEBUG) #if defined(DEBUG)
@ -153,7 +142,7 @@ static void heathrow_pic_set_irq(void *opaque, int num, int level)
} else { } else {
pic->levels &= ~irq_bit; pic->levels &= ~irq_bit;
} }
heathrow_pic_update(s); heathrow_update_irq(s);
} }
static const VMStateDescription vmstate_heathrow_pic_one = { static const VMStateDescription vmstate_heathrow_pic_one = {
@ -161,54 +150,79 @@ static const VMStateDescription vmstate_heathrow_pic_one = {
.version_id = 0, .version_id = 0,
.minimum_version_id = 0, .minimum_version_id = 0,
.fields = (VMStateField[]) { .fields = (VMStateField[]) {
VMSTATE_UINT32(events, HeathrowPIC), VMSTATE_UINT32(events, HeathrowPICState),
VMSTATE_UINT32(mask, HeathrowPIC), VMSTATE_UINT32(mask, HeathrowPICState),
VMSTATE_UINT32(levels, HeathrowPIC), VMSTATE_UINT32(levels, HeathrowPICState),
VMSTATE_UINT32(level_triggered, HeathrowPIC), VMSTATE_UINT32(level_triggered, HeathrowPICState),
VMSTATE_END_OF_LIST() VMSTATE_END_OF_LIST()
} }
}; };
static const VMStateDescription vmstate_heathrow_pic = { static const VMStateDescription vmstate_heathrow = {
.name = "heathrow_pic", .name = "heathrow_pic",
.version_id = 1, .version_id = 1,
.minimum_version_id = 1, .minimum_version_id = 1,
.fields = (VMStateField[]) { .fields = (VMStateField[]) {
VMSTATE_STRUCT_ARRAY(pics, HeathrowPICS, 2, 1, VMSTATE_STRUCT_ARRAY(pics, HeathrowState, 2, 1,
vmstate_heathrow_pic_one, HeathrowPIC), vmstate_heathrow_pic_one, HeathrowPICState),
VMSTATE_END_OF_LIST() VMSTATE_END_OF_LIST()
} }
}; };
static void heathrow_pic_reset_one(HeathrowPIC *s) static void heathrow_reset(DeviceState *d)
{ {
memset(s, '\0', sizeof(HeathrowPIC)); HeathrowState *s = HEATHROW(d);
}
static void heathrow_pic_reset(void *opaque)
{
HeathrowPICS *s = opaque;
heathrow_pic_reset_one(&s->pics[0]);
heathrow_pic_reset_one(&s->pics[1]);
s->pics[0].level_triggered = 0; s->pics[0].level_triggered = 0;
s->pics[1].level_triggered = 0x1ff00000; s->pics[1].level_triggered = 0x1ff00000;
} }
static void heathrow_init(Object *obj)
{
HeathrowState *s = HEATHROW(obj);
memory_region_init_io(&s->mem, OBJECT(s), &heathrow_ops, s,
"heathrow-pic", 0x1000);
}
qemu_irq *heathrow_pic_init(MemoryRegion **pmem, qemu_irq *heathrow_pic_init(MemoryRegion **pmem,
int nb_cpus, qemu_irq **irqs) int nb_cpus, qemu_irq **irqs)
{ {
HeathrowPICS *s; DeviceState *d;
HeathrowState *s;
s = g_malloc0(sizeof(HeathrowPICS)); d = qdev_create(NULL, TYPE_HEATHROW);
qdev_init_nofail(d);
s = HEATHROW(d);
/* only 1 CPU */ /* only 1 CPU */
s->irqs = irqs[0]; s->irqs = irqs[0];
memory_region_init_io(&s->mem, NULL, &heathrow_pic_ops, s,
"heathrow-pic", 0x1000);
*pmem = &s->mem; *pmem = &s->mem;
vmstate_register(NULL, -1, &vmstate_heathrow_pic, s); return qemu_allocate_irqs(heathrow_set_irq, s, HEATHROW_NUM_IRQS);
qemu_register_reset(heathrow_pic_reset, s);
return qemu_allocate_irqs(heathrow_pic_set_irq, s, 64);
} }
static void heathrow_class_init(ObjectClass *oc, void *data)
{
DeviceClass *dc = DEVICE_CLASS(oc);
dc->reset = heathrow_reset;
dc->vmsd = &vmstate_heathrow;
set_bit(DEVICE_CATEGORY_MISC, dc->categories);
}
static const TypeInfo heathrow_type_info = {
.name = TYPE_HEATHROW,
.parent = TYPE_SYS_BUS_DEVICE,
.instance_size = sizeof(HeathrowState),
.instance_init = heathrow_init,
.class_init = heathrow_class_init,
};
static void heathrow_register_types(void)
{
type_register_static(&heathrow_type_info);
}
type_init(heathrow_register_types)

View File

@ -0,0 +1,49 @@
/*
* Heathrow PIC support (OldWorld PowerMac)
*
* Copyright (c) 2005-2007 Fabrice Bellard
* Copyright (c) 2007 Jocelyn Mayer
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#ifndef HEATHROW_H
#define HEATHROW_H
#define TYPE_HEATHROW "heathrow"
#define HEATHROW(obj) OBJECT_CHECK(HeathrowState, (obj), TYPE_HEATHROW)
typedef struct HeathrowPICState {
uint32_t events;
uint32_t mask;
uint32_t levels;
uint32_t level_triggered;
} HeathrowPICState;
typedef struct HeathrowState {
SysBusDevice parent_obj;
MemoryRegion mem;
HeathrowPICState pics[2];
qemu_irq *irqs;
} HeathrowState;
#define HEATHROW_NUM_IRQS 64
#endif /* HEATHROW_H */