hw/imx_avic.c

   1 /*
   2  * i.MX31 Vectored Interrupt Controller
   3  *
   4  * Note this is NOT the PL192 provided by ARM, but
   5  * a custom implementation by Freescale.
   6  *
   7  * Copyright (c) 2008 OKL
   8  * Copyright (c) 2011 NICTA Pty Ltd
   9  * Originally written by Hans Jiang
  10  *
  11  * This code is licensed under the GPL version 2 or later.  See
  12  * the COPYING file in the top-level directory.
  13  *
  14  * TODO: implement vectors.
  15  */
  16
  17 #include "hw.h"
  18 #include "sysbus.h"
  19 #include "qemu/host-utils.h"
  20
  21 #define DEBUG_INT 1
  22 #undef DEBUG_INT /* comment out for debugging */
  23
  24 #ifdef DEBUG_INT
  25 #define DPRINTF(fmt, args...) \
  26 do { printf("imx_avic: " fmt , ##args); } while (0)
  27 #else
  28 #define DPRINTF(fmt, args...) do {} while (0)
  29 #endif
  30
  31 /*
  32  * Define to 1 for messages about attempts to
  33  * access unimplemented registers or similar.
  34  */
  35 #define DEBUG_IMPLEMENTATION 1
  36 #if DEBUG_IMPLEMENTATION
  37 #  define IPRINTF(fmt, args...) \
  38     do  { fprintf(stderr, "imx_avic: " fmt, ##args); } while (0)
  39 #else
  40 #  define IPRINTF(fmt, args...) do {} while (0)
  41 #endif
  42
  43 #define IMX_AVIC_NUM_IRQS 64
  44
  45 /* Interrupt Control Bits */
  46 #define ABFLAG (1<<25)
  47 #define ABFEN (1<<24)
  48 #define NIDIS (1<<22) /* Normal Interrupt disable */
  49 #define FIDIS (1<<21) /* Fast interrupt disable */
  50 #define NIAD  (1<<20) /* Normal Interrupt Arbiter Rise ARM level */
  51 #define FIAD  (1<<19) /* Fast Interrupt Arbiter Rise ARM level */
  52 #define NM    (1<<18) /* Normal interrupt mode */
  53
  54
  55 #define PRIO_PER_WORD (sizeof(uint32_t) * 8 / 4)
  56 #define PRIO_WORDS (IMX_AVIC_NUM_IRQS/PRIO_PER_WORD)
  57
  58 typedef struct {
  59     SysBusDevice busdev;
  60     MemoryRegion iomem;
  61     uint64_t pending;
  62     uint64_t enabled;
  63     uint64_t is_fiq;
  64     uint32_t intcntl;
  65     uint32_t intmask;
  66     qemu_irq irq;
  67     qemu_irq fiq;
  68     uint32_t prio[PRIO_WORDS]; /* Priorities are 4-bits each */
  69 } IMXAVICState;
  70
  71 static const VMStateDescription vmstate_imx_avic = {
  72     .name = "imx-avic",
  73     .version_id = 1,
  74     .minimum_version_id = 1,
  75     .minimum_version_id_old = 1,
  76     .fields = (VMStateField[]) {
  77         VMSTATE_UINT64(pending, IMXAVICState),
  78         VMSTATE_UINT64(enabled, IMXAVICState),
  79         VMSTATE_UINT64(is_fiq, IMXAVICState),
  80         VMSTATE_UINT32(intcntl, IMXAVICState),
  81         VMSTATE_UINT32(intmask, IMXAVICState),
  82         VMSTATE_UINT32_ARRAY(prio, IMXAVICState, PRIO_WORDS),
  83         VMSTATE_END_OF_LIST()
  84     },
  85 };
  86
  87
  88
  89 static inline int imx_avic_prio(IMXAVICState *s, int irq)
  90 {
  91     uint32_t word = irq / PRIO_PER_WORD;
  92     uint32_t part = 4 * (irq % PRIO_PER_WORD);
  93     return 0xf & (s->prio[word] >> part);
  94 }
  95
  96 static inline void imx_avic_set_prio(IMXAVICState *s, int irq, int prio)
  97 {
  98     uint32_t word = irq / PRIO_PER_WORD;
  99     uint32_t part = 4 * (irq % PRIO_PER_WORD);
 100     uint32_t mask = ~(0xf << part);
 101     s->prio[word] &= mask;
 102     s->prio[word] |= prio << part;
 103 }
 104
 105 /* Update interrupts.  */
 106 static void imx_avic_update(IMXAVICState *s)
 107 {
 108     int i;
 109     uint64_t new = s->pending & s->enabled;
 110     uint64_t flags;
 111
 112     flags = new & s->is_fiq;
 113     qemu_set_irq(s->fiq, !!flags);
 114
 115     flags = new & ~s->is_fiq;
 116     if (!flags || (s->intmask == 0x1f)) {
 117         qemu_set_irq(s->irq, !!flags);
 118         return;
 119     }
 120
 121     /*
 122      * Take interrupt if there's a pending interrupt with
 123      * priority higher than the value of intmask
 124      */
 125     for (i = 0; i < IMX_AVIC_NUM_IRQS; i++) {
 126         if (flags & (1UL << i)) {
 127             if (imx_avic_prio(s, i) > s->intmask) {
 128                 qemu_set_irq(s->irq, 1);
 129                 return;
 130             }
 131         }
 132     }
 133     qemu_set_irq(s->irq, 0);
 134 }
 135
 136 static void imx_avic_set_irq(void *opaque, int irq, int level)
 137 {
 138     IMXAVICState *s = (IMXAVICState *)opaque;
 139
 140     if (level) {
 141         DPRINTF("Raising IRQ %d, prio %d\n",
 142                 irq, imx_avic_prio(s, irq));
 143         s->pending |= (1ULL << irq);
 144     } else {
 145         DPRINTF("Clearing IRQ %d, prio %d\n",
 146                 irq, imx_avic_prio(s, irq));
 147         s->pending &= ~(1ULL << irq);
 148     }
 149
 150     imx_avic_update(s);
 151 }
 152
 153
 154 static uint64_t imx_avic_read(void *opaque,
 155                              hwaddr offset, unsigned size)
 156 {
 157     IMXAVICState *s = (IMXAVICState *)opaque;
 158
 159
 160     DPRINTF("read(offset = 0x%x)\n", offset >> 2);
 161     switch (offset >> 2) {
 162     case 0: /* INTCNTL */
 163         return s->intcntl;
 164
 165     case 1: /* Normal Interrupt Mask Register, NIMASK */
 166         return s->intmask;
 167
 168     case 2: /* Interrupt Enable Number Register, INTENNUM */
 169     case 3: /* Interrupt Disable Number Register, INTDISNUM */
 170         return 0;
 171
 172     case 4: /* Interrupt Enabled Number Register High */
 173         return s->enabled >> 32;
 174
 175     case 5: /* Interrupt Enabled Number Register Low */
 176         return s->enabled & 0xffffffffULL;
 177
 178     case 6: /* Interrupt Type Register High */
 179         return s->is_fiq >> 32;
 180
 181     case 7: /* Interrupt Type Register Low */
 182         return s->is_fiq & 0xffffffffULL;
 183
 184     case 8: /* Normal Interrupt Priority Register 7 */
 185     case 9: /* Normal Interrupt Priority Register 6 */
 186     case 10:/* Normal Interrupt Priority Register 5 */
 187     case 11:/* Normal Interrupt Priority Register 4 */
 188     case 12:/* Normal Interrupt Priority Register 3 */
 189     case 13:/* Normal Interrupt Priority Register 2 */
 190     case 14:/* Normal Interrupt Priority Register 1 */
 191     case 15:/* Normal Interrupt Priority Register 0 */
 192         return s->prio[15-(offset>>2)];
 193
 194     case 16: /* Normal interrupt vector and status register */
 195     {
 196         /*
 197          * This returns the highest priority
 198          * outstanding interrupt.  Where there is more than
 199          * one pending IRQ with the same priority,
 200          * take the highest numbered one.
 201          */
 202         uint64_t flags = s->pending & s->enabled & ~s->is_fiq;
 203         int i;
 204         int prio = -1;
 205         int irq = -1;
 206         for (i = 63; i >= 0; --i) {
 207             if (flags & (1ULL<<i)) {
 208                 int irq_prio = imx_avic_prio(s, i);
 209                 if (irq_prio > prio) {
 210                     irq = i;
 211                     prio = irq_prio;
 212                 }
 213             }
 214         }
 215         if (irq >= 0) {
 216             imx_avic_set_irq(s, irq, 0);
 217             return irq << 16 | prio;
 218         }
 219         return 0xffffffffULL;
 220     }
 221     case 17:/* Fast Interrupt vector and status register */
 222     {
 223         uint64_t flags = s->pending & s->enabled & s->is_fiq;
 224         int i = ctz64(flags);
 225         if (i < 64) {
 226             imx_avic_set_irq(opaque, i, 0);
 227             return i;
 228         }
 229         return 0xffffffffULL;
 230     }
 231     case 18:/* Interrupt source register high */
 232         return s->pending >> 32;
 233
 234     case 19:/* Interrupt source register low */
 235         return s->pending & 0xffffffffULL;
 236
 237     case 20:/* Interrupt Force Register high */
 238     case 21:/* Interrupt Force Register low */
 239         return 0;
 240
 241     case 22:/* Normal Interrupt Pending Register High */
 242         return (s->pending & s->enabled & ~s->is_fiq) >> 32;
 243
 244     case 23:/* Normal Interrupt Pending Register Low */
 245         return (s->pending & s->enabled & ~s->is_fiq) & 0xffffffffULL;
 246
 247     case 24: /* Fast Interrupt Pending Register High  */
 248         return (s->pending & s->enabled & s->is_fiq) >> 32;
 249
 250     case 25: /* Fast Interrupt Pending Register Low  */
 251         return (s->pending & s->enabled & s->is_fiq) & 0xffffffffULL;
 252
 253     case 0x40:            /* AVIC vector 0, use for WFI WAR */
 254         return 0x4;
 255
 256     default:
 257         IPRINTF("imx_avic_read: Bad offset 0x%x\n", (int)offset);
 258         return 0;
 259     }
 260 }
 261
 262 static void imx_avic_write(void *opaque, hwaddr offset,
 263                           uint64_t val, unsigned size)
 264 {
 265     IMXAVICState *s = (IMXAVICState *)opaque;
 266
 267     /* Vector Registers not yet supported */
 268     if (offset >= 0x100 && offset <= 0x2fc) {
 269         IPRINTF("imx_avic_write to vector register %d ignored\n",
 270                 (unsigned int)((offset - 0x100) >> 2));
 271         return;
 272     }
 273
 274     DPRINTF("imx_avic_write(0x%x) = %x\n",
 275             (unsigned int)offset>>2, (unsigned int)val);
 276     switch (offset >> 2) {
 277     case 0: /* Interrupt Control Register, INTCNTL */
 278         s->intcntl = val & (ABFEN | NIDIS | FIDIS | NIAD | FIAD | NM);
 279         if (s->intcntl & ABFEN) {
 280             s->intcntl &= ~(val & ABFLAG);
 281         }
 282         break;
 283
 284     case 1: /* Normal Interrupt Mask Register, NIMASK */
 285         s->intmask = val & 0x1f;
 286         break;
 287
 288     case 2: /* Interrupt Enable Number Register, INTENNUM */
 289         DPRINTF("enable(%d)\n", (int)val);
 290         val &= 0x3f;
 291         s->enabled |= (1ULL << val);
 292         break;
 293
 294     case 3: /* Interrupt Disable Number Register, INTDISNUM */
 295         DPRINTF("disable(%d)\n", (int)val);
 296         val &= 0x3f;
 297         s->enabled &= ~(1ULL << val);
 298         break;
 299
 300     case 4: /* Interrupt Enable Number Register High */
 301         s->enabled = (s->enabled & 0xffffffffULL) | (val << 32);
 302         break;
 303
 304     case 5: /* Interrupt Enable Number Register Low */
 305         s->enabled = (s->enabled & 0xffffffff00000000ULL) | val;
 306         break;
 307
 308     case 6: /* Interrupt Type Register High */
 309         s->is_fiq = (s->is_fiq & 0xffffffffULL) | (val << 32);
 310         break;
 311
 312     case 7: /* Interrupt Type Register Low */
 313         s->is_fiq = (s->is_fiq & 0xffffffff00000000ULL) | val;
 314         break;
 315
 316     case 8: /* Normal Interrupt Priority Register 7 */
 317     case 9: /* Normal Interrupt Priority Register 6 */
 318     case 10:/* Normal Interrupt Priority Register 5 */
 319     case 11:/* Normal Interrupt Priority Register 4 */
 320     case 12:/* Normal Interrupt Priority Register 3 */
 321     case 13:/* Normal Interrupt Priority Register 2 */
 322     case 14:/* Normal Interrupt Priority Register 1 */
 323     case 15:/* Normal Interrupt Priority Register 0 */
 324         s->prio[15-(offset>>2)] = val;
 325         break;
 326
 327         /* Read-only registers, writes ignored */
 328     case 16:/* Normal Interrupt Vector and Status register */
 329     case 17:/* Fast Interrupt vector and status register */
 330     case 18:/* Interrupt source register high */
 331     case 19:/* Interrupt source register low */
 332         return;
 333
 334     case 20:/* Interrupt Force Register high */
 335         s->pending = (s->pending & 0xffffffffULL) | (val << 32);
 336         break;
 337
 338     case 21:/* Interrupt Force Register low */
 339         s->pending = (s->pending & 0xffffffff00000000ULL) | val;
 340         break;
 341
 342     case 22:/* Normal Interrupt Pending Register High */
 343     case 23:/* Normal Interrupt Pending Register Low */
 344     case 24: /* Fast Interrupt Pending Register High  */
 345     case 25: /* Fast Interrupt Pending Register Low  */
 346         return;
 347
 348     default:
 349         IPRINTF("imx_avic_write: Bad offset %x\n", (int)offset);
 350     }
 351     imx_avic_update(s);
 352 }
 353
 354 static const MemoryRegionOps imx_avic_ops = {
 355     .read = imx_avic_read,
 356     .write = imx_avic_write,
 357     .endianness = DEVICE_NATIVE_ENDIAN,
 358 };
 359
 360 static void imx_avic_reset(DeviceState *dev)
 361 {
 362     IMXAVICState *s = container_of(dev, IMXAVICState, busdev.qdev);
 363     s->pending = 0;
 364     s->enabled = 0;
 365     s->is_fiq = 0;
 366     s->intmask = 0x1f;
 367     s->intcntl = 0;
 368     memset(s->prio, 0, sizeof s->prio);
 369 }
 370
 371 static int imx_avic_init(SysBusDevice *dev)
 372 {
 373     IMXAVICState *s = FROM_SYSBUS(IMXAVICState, dev);;
 374
 375     memory_region_init_io(&s->iomem, &imx_avic_ops, s, "imx_avic", 0x1000);
 376     sysbus_init_mmio(dev, &s->iomem);
 377
 378     qdev_init_gpio_in(&dev->qdev, imx_avic_set_irq, IMX_AVIC_NUM_IRQS);
 379     sysbus_init_irq(dev, &s->irq);
 380     sysbus_init_irq(dev, &s->fiq);
 381
 382     return 0;
 383 }
 384
 385
 386 static void imx_avic_class_init(ObjectClass *klass, void *data)
 387 {
 388     DeviceClass *dc = DEVICE_CLASS(klass);
 389     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
 390     k->init = imx_avic_init;
 391     dc->vmsd = &vmstate_imx_avic;
 392     dc->reset = imx_avic_reset;
 393     dc->desc = "i.MX Advanced Vector Interrupt Controller";
 394 }
 395
 396 static const TypeInfo imx_avic_info = {
 397     .name = "imx_avic",
 398     .parent = TYPE_SYS_BUS_DEVICE,
 399     .instance_size = sizeof(IMXAVICState),
 400     .class_init = imx_avic_class_init,
 401 };
 402
 403 static void imx_avic_register_types(void)
 404 {
 405     type_register_static(&imx_avic_info);
 406 }
 407
 408 type_init(imx_avic_register_types)