Annotation of qemu/hw/sun4c_intctl.c, revision 1.1.1.3

1.1       root        1: /*
                      2:  * QEMU Sparc Sun4c interrupt controller emulation
                      3:  *
                      4:  * Based on slavio_intctl, copyright (c) 2003-2005 Fabrice Bellard
                      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: #include "hw.h"
                     25: #include "sun4m.h"
1.1.1.3 ! root       26: #include "monitor.h"
1.1       root       27: //#define DEBUG_IRQ_COUNT
                     28: //#define DEBUG_IRQ
                     29: 
                     30: #ifdef DEBUG_IRQ
1.1.1.3 ! root       31: #define DPRINTF(fmt, ...)                                       \
        !            32:     do { printf("IRQ: " fmt , ## __VA_ARGS__); } while (0)
1.1       root       33: #else
1.1.1.3 ! root       34: #define DPRINTF(fmt, ...)
1.1       root       35: #endif
                     36: 
                     37: /*
                     38:  * Registers of interrupt controller in sun4c.
                     39:  *
                     40:  */
                     41: 
                     42: #define MAX_PILS 16
                     43: 
                     44: typedef struct Sun4c_INTCTLState {
                     45: #ifdef DEBUG_IRQ_COUNT
                     46:     uint64_t irq_count;
                     47: #endif
                     48:     qemu_irq *cpu_irqs;
                     49:     const uint32_t *intbit_to_level;
                     50:     uint32_t pil_out;
                     51:     uint8_t reg;
                     52:     uint8_t pending;
                     53: } Sun4c_INTCTLState;
                     54: 
1.1.1.2   root       55: #define INTCTL_SIZE 1
1.1       root       56: 
                     57: static void sun4c_check_interrupts(void *opaque);
                     58: 
                     59: static uint32_t sun4c_intctl_mem_readb(void *opaque, target_phys_addr_t addr)
                     60: {
                     61:     Sun4c_INTCTLState *s = opaque;
                     62:     uint32_t ret;
                     63: 
                     64:     ret = s->reg;
                     65:     DPRINTF("read reg 0x" TARGET_FMT_plx " = %x\n", addr, ret);
                     66: 
                     67:     return ret;
                     68: }
                     69: 
1.1.1.2   root       70: static void sun4c_intctl_mem_writeb(void *opaque, target_phys_addr_t addr,
                     71:                                     uint32_t val)
1.1       root       72: {
                     73:     Sun4c_INTCTLState *s = opaque;
                     74: 
                     75:     DPRINTF("write reg 0x" TARGET_FMT_plx " = %x\n", addr, val);
                     76:     val &= 0xbf;
                     77:     s->reg = val;
                     78:     sun4c_check_interrupts(s);
                     79: }
                     80: 
                     81: static CPUReadMemoryFunc *sun4c_intctl_mem_read[3] = {
                     82:     sun4c_intctl_mem_readb,
                     83:     NULL,
                     84:     NULL,
                     85: };
                     86: 
                     87: static CPUWriteMemoryFunc *sun4c_intctl_mem_write[3] = {
                     88:     sun4c_intctl_mem_writeb,
                     89:     NULL,
                     90:     NULL,
                     91: };
                     92: 
1.1.1.3 ! root       93: void sun4c_pic_info(Monitor *mon, void *opaque)
1.1       root       94: {
                     95:     Sun4c_INTCTLState *s = opaque;
                     96: 
1.1.1.3 ! root       97:     monitor_printf(mon, "master: pending 0x%2.2x, enabled 0x%2.2x\n",
        !            98:                    s->pending, s->reg);
1.1       root       99: }
                    100: 
1.1.1.3 ! root      101: void sun4c_irq_info(Monitor *mon, void *opaque)
1.1       root      102: {
                    103: #ifndef DEBUG_IRQ_COUNT
1.1.1.3 ! root      104:     monitor_printf(mon, "irq statistic code not compiled.\n");
1.1       root      105: #else
                    106:     Sun4c_INTCTLState *s = opaque;
                    107:     int64_t count;
                    108: 
1.1.1.3 ! root      109:     monitor_printf(mon, "IRQ statistics:\n");
        !           110:     count = s->irq_count;
1.1       root      111:     if (count > 0)
1.1.1.3 ! root      112:         monitor_printf(mon, " %" PRId64 "\n", count);
1.1       root      113: #endif
                    114: }
                    115: 
                    116: static const uint32_t intbit_to_level[] = { 0, 1, 4, 6, 8, 10, 0, 14, };
                    117: 
                    118: static void sun4c_check_interrupts(void *opaque)
                    119: {
                    120:     Sun4c_INTCTLState *s = opaque;
                    121:     uint32_t pil_pending;
                    122:     unsigned int i;
                    123: 
                    124:     pil_pending = 0;
                    125:     if (s->pending && !(s->reg & 0x80000000)) {
                    126:         for (i = 0; i < 8; i++) {
                    127:             if (s->pending & (1 << i))
                    128:                 pil_pending |= 1 << intbit_to_level[i];
                    129:         }
                    130:     }
                    131: 
                    132:     for (i = 0; i < MAX_PILS; i++) {
                    133:         if (pil_pending & (1 << i)) {
                    134:             if (!(s->pil_out & (1 << i)))
                    135:                 qemu_irq_raise(s->cpu_irqs[i]);
                    136:         } else {
                    137:             if (s->pil_out & (1 << i))
                    138:                 qemu_irq_lower(s->cpu_irqs[i]);
                    139:         }
                    140:     }
                    141:     s->pil_out = pil_pending;
                    142: }
                    143: 
                    144: /*
                    145:  * "irq" here is the bit number in the system interrupt register
                    146:  */
                    147: static void sun4c_set_irq(void *opaque, int irq, int level)
                    148: {
                    149:     Sun4c_INTCTLState *s = opaque;
                    150:     uint32_t mask = 1 << irq;
                    151:     uint32_t pil = intbit_to_level[irq];
                    152: 
                    153:     DPRINTF("Set irq %d -> pil %d level %d\n", irq, pil,
                    154:             level);
                    155:     if (pil > 0) {
                    156:         if (level) {
                    157: #ifdef DEBUG_IRQ_COUNT
1.1.1.3 ! root      158:             s->irq_count++;
1.1       root      159: #endif
                    160:             s->pending |= mask;
                    161:         } else {
                    162:             s->pending &= ~mask;
                    163:         }
                    164:         sun4c_check_interrupts(s);
                    165:     }
                    166: }
                    167: 
                    168: static void sun4c_intctl_save(QEMUFile *f, void *opaque)
                    169: {
                    170:     Sun4c_INTCTLState *s = opaque;
                    171: 
                    172:     qemu_put_8s(f, &s->reg);
                    173:     qemu_put_8s(f, &s->pending);
                    174: }
                    175: 
                    176: static int sun4c_intctl_load(QEMUFile *f, void *opaque, int version_id)
                    177: {
                    178:     Sun4c_INTCTLState *s = opaque;
                    179: 
                    180:     if (version_id != 1)
                    181:         return -EINVAL;
                    182: 
                    183:     qemu_get_8s(f, &s->reg);
                    184:     qemu_get_8s(f, &s->pending);
                    185: 
                    186:     return 0;
                    187: }
                    188: 
                    189: static void sun4c_intctl_reset(void *opaque)
                    190: {
                    191:     Sun4c_INTCTLState *s = opaque;
                    192: 
                    193:     s->reg = 1;
                    194:     s->pending = 0;
                    195: }
                    196: 
                    197: void *sun4c_intctl_init(target_phys_addr_t addr, qemu_irq **irq,
                    198:                         qemu_irq *parent_irq)
                    199: {
                    200:     int sun4c_intctl_io_memory;
                    201:     Sun4c_INTCTLState *s;
                    202: 
                    203:     s = qemu_mallocz(sizeof(Sun4c_INTCTLState));
                    204: 
1.1.1.3 ! root      205:     sun4c_intctl_io_memory = cpu_register_io_memory(sun4c_intctl_mem_read,
1.1       root      206:                                                     sun4c_intctl_mem_write, s);
                    207:     cpu_register_physical_memory(addr, INTCTL_SIZE, sun4c_intctl_io_memory);
                    208:     s->cpu_irqs = parent_irq;
                    209: 
                    210:     register_savevm("sun4c_intctl", addr, 1, sun4c_intctl_save,
                    211:                     sun4c_intctl_load, s);
                    212: 
                    213:     qemu_register_reset(sun4c_intctl_reset, s);
                    214:     *irq = qemu_allocate_irqs(sun4c_set_irq, s, 8);
                    215: 
                    216:     sun4c_intctl_reset(s);
                    217:     return s;
                    218: }

unix.superglobalmegacorp.com

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