2 * ColdFire Interrupt Controller emulation.
4 * Copyright (c) 2007 CodeSourcery.
6 * This code is licensed under the GPL
9 #include "qemu/osdep.h"
10 #include "qapi/error.h"
11 #include "qemu/module.h"
16 #include "hw/sysbus.h"
17 #include "hw/m68k/mcf.h"
18 #include "qom/object.h"
20 #define TYPE_MCF_INTC "mcf-intc"
21 typedef struct mcf_intc_state mcf_intc_state
;
22 #define MCF_INTC(obj) OBJECT_CHECK(mcf_intc_state, (obj), TYPE_MCF_INTC)
24 struct mcf_intc_state
{
25 SysBusDevice parent_obj
;
37 static void mcf_intc_update(mcf_intc_state
*s
)
44 active
= (s
->ipr
| s
->ifr
) & s
->enabled
& ~s
->imr
;
48 for (i
= 0; i
< 64; i
++) {
49 if ((active
& 1) != 0 && s
->icr
[i
] >= best_level
) {
50 best_level
= s
->icr
[i
];
56 s
->active_vector
= ((best
== 64) ? 24 : (best
+ 64));
57 m68k_set_irq_level(s
->cpu
, best_level
, s
->active_vector
);
60 static uint64_t mcf_intc_read(void *opaque
, hwaddr addr
,
64 mcf_intc_state
*s
= (mcf_intc_state
*)opaque
;
66 if (offset
>= 0x40 && offset
< 0x80) {
67 return s
->icr
[offset
- 0x40];
71 return (uint32_t)(s
->ipr
>> 32);
73 return (uint32_t)s
->ipr
;
75 return (uint32_t)(s
->imr
>> 32);
77 return (uint32_t)s
->imr
;
79 return (uint32_t)(s
->ifr
>> 32);
81 return (uint32_t)s
->ifr
;
82 case 0xe0: /* SWIACK. */
83 return s
->active_vector
;
84 case 0xe1: case 0xe2: case 0xe3: case 0xe4:
85 case 0xe5: case 0xe6: case 0xe7:
87 qemu_log_mask(LOG_UNIMP
, "%s: LnIACK not implemented (offset 0x%02x)\n",
95 static void mcf_intc_write(void *opaque
, hwaddr addr
,
96 uint64_t val
, unsigned size
)
99 mcf_intc_state
*s
= (mcf_intc_state
*)opaque
;
100 offset
= addr
& 0xff;
101 if (offset
>= 0x40 && offset
< 0x80) {
102 int n
= offset
- 0x40;
105 s
->enabled
&= ~(1ull << n
);
107 s
->enabled
|= (1ull << n
);
112 case 0x00: case 0x04:
113 /* Ignore IPR writes. */
116 s
->imr
= (s
->imr
& 0xffffffff) | ((uint64_t)val
<< 32);
119 s
->imr
= (s
->imr
& 0xffffffff00000000ull
) | (uint32_t)val
;
125 s
->imr
|= (0x1ull
<< (val
& 0x3f));
132 s
->imr
&= ~(0x1ull
<< (val
& 0x3f));
136 qemu_log_mask(LOG_GUEST_ERROR
, "%s: Bad offset 0x%02x\n",
143 static void mcf_intc_set_irq(void *opaque
, int irq
, int level
)
145 mcf_intc_state
*s
= (mcf_intc_state
*)opaque
;
149 s
->ipr
|= 1ull << irq
;
151 s
->ipr
&= ~(1ull << irq
);
155 static void mcf_intc_reset(DeviceState
*dev
)
157 mcf_intc_state
*s
= MCF_INTC(dev
);
163 memset(s
->icr
, 0, 64);
164 s
->active_vector
= 24;
167 static const MemoryRegionOps mcf_intc_ops
= {
168 .read
= mcf_intc_read
,
169 .write
= mcf_intc_write
,
170 .endianness
= DEVICE_NATIVE_ENDIAN
,
173 static void mcf_intc_instance_init(Object
*obj
)
175 mcf_intc_state
*s
= MCF_INTC(obj
);
177 memory_region_init_io(&s
->iomem
, obj
, &mcf_intc_ops
, s
, "mcf", 0x100);
180 static void mcf_intc_class_init(ObjectClass
*oc
, void *data
)
182 DeviceClass
*dc
= DEVICE_CLASS(oc
);
184 set_bit(DEVICE_CATEGORY_MISC
, dc
->categories
);
185 dc
->reset
= mcf_intc_reset
;
188 static const TypeInfo mcf_intc_gate_info
= {
189 .name
= TYPE_MCF_INTC
,
190 .parent
= TYPE_SYS_BUS_DEVICE
,
191 .instance_size
= sizeof(mcf_intc_state
),
192 .instance_init
= mcf_intc_instance_init
,
193 .class_init
= mcf_intc_class_init
,
196 static void mcf_intc_register_types(void)
198 type_register_static(&mcf_intc_gate_info
);
201 type_init(mcf_intc_register_types
)
203 qemu_irq
*mcf_intc_init(MemoryRegion
*sysmem
,
210 dev
= qdev_new(TYPE_MCF_INTC
);
211 sysbus_realize_and_unref(SYS_BUS_DEVICE(dev
), &error_fatal
);
216 memory_region_add_subregion(sysmem
, base
, &s
->iomem
);
218 return qemu_allocate_irqs(mcf_intc_set_irq
, s
, 64);