Annotation of qemu/hw/xilinx_intc.c, revision 1.1.1.1

1.1       root        1: /*
                      2:  * QEMU Xilinx OPB Interrupt Controller.
                      3:  *
                      4:  * Copyright (c) 2009 Edgar E. Iglesias.
                      5:  *
                      6:  * Permission is hereby granted, free of charge, to any person obtaining a copy
                      7:  * of this software and associated documentation files (the "Software"), to deal
                      8:  * in the Software without restriction, including without limitation the rights
                      9:  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
                     10:  * copies of the Software, and to permit persons to whom the Software is
                     11:  * furnished to do so, subject to the following conditions:
                     12:  *
                     13:  * The above copyright notice and this permission notice shall be included in
                     14:  * all copies or substantial portions of the Software.
                     15:  *
                     16:  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
                     17:  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
                     18:  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
                     19:  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
                     20:  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
                     21:  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
                     22:  * THE SOFTWARE.
                     23:  */
                     24: 
                     25: #include "sysbus.h"
                     26: #include "hw.h"
                     27: 
                     28: #define D(x)
                     29: 
                     30: #define R_ISR       0
                     31: #define R_IPR       1
                     32: #define R_IER       2
                     33: #define R_IAR       3
                     34: #define R_SIE       4
                     35: #define R_CIE       5
                     36: #define R_IVR       6
                     37: #define R_MER       7
                     38: #define R_MAX       8
                     39: 
                     40: struct xlx_pic
                     41: {
                     42:     SysBusDevice busdev;
                     43:     qemu_irq parent_irq;
                     44: 
                     45:     /* Configuration reg chosen at synthesis-time. QEMU populates
                     46:        the bits at board-setup.  */
                     47:     uint32_t c_kind_of_intr;
                     48: 
                     49:     /* Runtime control registers.  */
                     50:     uint32_t regs[R_MAX];
                     51: };
                     52: 
                     53: static void update_irq(struct xlx_pic *p)
                     54: {
                     55:     uint32_t i;
                     56:     /* Update the pending register.  */
                     57:     p->regs[R_IPR] = p->regs[R_ISR] & p->regs[R_IER];
                     58: 
                     59:     /* Update the vector register.  */
                     60:     for (i = 0; i < 32; i++) {
                     61:         if (p->regs[R_IPR] & (1 << i))
                     62:             break;
                     63:     }
                     64:     if (i == 32)
                     65:         i = ~0;
                     66: 
                     67:     p->regs[R_IVR] = i;
                     68:     if ((p->regs[R_MER] & 1) && p->regs[R_IPR]) {
                     69:         qemu_irq_raise(p->parent_irq);
                     70:     } else {
                     71:         qemu_irq_lower(p->parent_irq);
                     72:     }
                     73: }
                     74: 
                     75: static uint32_t pic_readl (void *opaque, target_phys_addr_t addr)
                     76: {
                     77:     struct xlx_pic *p = opaque;
                     78:     uint32_t r = 0;
                     79: 
                     80:     addr >>= 2;
                     81:     switch (addr)
                     82:     {
                     83:         default:
                     84:             if (addr < ARRAY_SIZE(p->regs))
                     85:                 r = p->regs[addr];
                     86:             break;
                     87: 
                     88:     }
                     89:     D(printf("%s %x=%x\n", __func__, addr * 4, r));
                     90:     return r;
                     91: }
                     92: 
                     93: static void
                     94: pic_writel (void *opaque, target_phys_addr_t addr, uint32_t value)
                     95: {
                     96:     struct xlx_pic *p = opaque;
                     97: 
                     98:     addr >>= 2;
                     99:     D(qemu_log("%s addr=%x val=%x\n", __func__, addr * 4, value));
                    100:     switch (addr) 
                    101:     {
                    102:         case R_IAR:
                    103:             p->regs[R_ISR] &= ~value; /* ACK.  */
                    104:             break;
                    105:         case R_SIE:
                    106:             p->regs[R_IER] |= value;  /* Atomic set ie.  */
                    107:             break;
                    108:         case R_CIE:
                    109:             p->regs[R_IER] &= ~value; /* Atomic clear ie.  */
                    110:             break;
                    111:         default:
                    112:             if (addr < ARRAY_SIZE(p->regs))
                    113:                 p->regs[addr] = value;
                    114:             break;
                    115:     }
                    116:     update_irq(p);
                    117: }
                    118: 
                    119: static CPUReadMemoryFunc *pic_read[] = {
                    120:     NULL, NULL,
                    121:     &pic_readl,
                    122: };
                    123: 
                    124: static CPUWriteMemoryFunc *pic_write[] = {
                    125:     NULL, NULL,
                    126:     &pic_writel,
                    127: };
                    128: 
                    129: static void irq_handler(void *opaque, int irq, int level)
                    130: {
                    131:     struct xlx_pic *p = opaque;
                    132: 
                    133:     if (!(p->regs[R_MER] & 2)) {
                    134:         qemu_irq_lower(p->parent_irq);
                    135:         return;
                    136:     }
                    137: 
                    138:     /* Update source flops. Don't clear unless level triggered.
                    139:        Edge triggered interrupts only go away when explicitely acked to
                    140:        the interrupt controller.  */
                    141:     if (!(p->c_kind_of_intr & (1 << irq)) || level) {
                    142:         p->regs[R_ISR] &= ~(1 << irq);
                    143:         p->regs[R_ISR] |= (level << irq);
                    144:     }
                    145:     update_irq(p);
                    146: }
                    147: 
                    148: static void xilinx_intc_init(SysBusDevice *dev)
                    149: {
                    150:     struct xlx_pic *p = FROM_SYSBUS(typeof (*p), dev);
                    151:     int pic_regs;
                    152: 
                    153:     qdev_init_gpio_in(&dev->qdev, irq_handler, 32);
                    154:     sysbus_init_irq(dev, &p->parent_irq);
                    155: 
                    156:     pic_regs = cpu_register_io_memory(pic_read, pic_write, p);
                    157:     sysbus_init_mmio(dev, R_MAX * 4, pic_regs);
                    158: }
                    159: 
                    160: static SysBusDeviceInfo xilinx_intc_info = {
                    161:     .init = xilinx_intc_init,
                    162:     .qdev.name  = "xilinx,intc",
                    163:     .qdev.size  = sizeof(struct xlx_pic),
                    164:     .qdev.props = (Property[]) {
                    165:         {
                    166:             .name   = "kind-of-intr",
                    167:             .info   = &qdev_prop_uint32,
                    168:             .offset = offsetof(struct xlx_pic, c_kind_of_intr),
                    169:         },
                    170:         {/* end of list */}
                    171:     }
                    172: };
                    173: 
                    174: static void xilinx_intc_register(void)
                    175: {
                    176:     sysbus_register_withprop(&xilinx_intc_info);
                    177: }
                    178: 
                    179: device_init(xilinx_intc_register)

unix.superglobalmegacorp.com

This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.