Commit 979d98ca904bcad59f83908a540fa3a8ce56982d
1 parent
3b1fd90e
ETRAX-PIC: Untabify.
Signed-off-by: Edgar E. Iglesias <edgar.iglesias@gmail.com>
Showing
1 changed file
with
88 additions
and
88 deletions
hw/etraxfs_pic.c
| @@ -29,85 +29,85 @@ | @@ -29,85 +29,85 @@ | ||
| 29 | 29 | ||
| 30 | #define D(x) | 30 | #define D(x) |
| 31 | 31 | ||
| 32 | -#define R_RW_MASK 0 | ||
| 33 | -#define R_R_VECT 1 | ||
| 34 | -#define R_R_MASKED_VECT 2 | ||
| 35 | -#define R_R_NMI 3 | ||
| 36 | -#define R_R_GURU 4 | ||
| 37 | -#define R_MAX 5 | 32 | +#define R_RW_MASK 0 |
| 33 | +#define R_R_VECT 1 | ||
| 34 | +#define R_R_MASKED_VECT 2 | ||
| 35 | +#define R_R_NMI 3 | ||
| 36 | +#define R_R_GURU 4 | ||
| 37 | +#define R_MAX 5 | ||
| 38 | 38 | ||
| 39 | struct fs_pic_state | 39 | struct fs_pic_state |
| 40 | { | 40 | { |
| 41 | - CPUState *env; | ||
| 42 | - uint32_t regs[R_MAX]; | 41 | + CPUState *env; |
| 42 | + uint32_t regs[R_MAX]; | ||
| 43 | }; | 43 | }; |
| 44 | 44 | ||
| 45 | static void pic_update(struct fs_pic_state *fs) | 45 | static void pic_update(struct fs_pic_state *fs) |
| 46 | -{ | ||
| 47 | - CPUState *env = fs->env; | ||
| 48 | - uint32_t vector = 0; | ||
| 49 | - int i; | ||
| 50 | - | ||
| 51 | - fs->regs[R_R_MASKED_VECT] = fs->regs[R_R_VECT] & fs->regs[R_RW_MASK]; | ||
| 52 | - | ||
| 53 | - /* The ETRAX interrupt controller signals interrupts to teh core | ||
| 54 | - through an interrupt request wire and an irq vector bus. If | ||
| 55 | - multiple interrupts are simultaneously active it chooses vector | ||
| 56 | - 0x30 and lets the sw choose the priorities. */ | ||
| 57 | - if (fs->regs[R_R_MASKED_VECT]) { | ||
| 58 | - uint32_t mv = fs->regs[R_R_MASKED_VECT]; | ||
| 59 | - for (i = 0; i < 31; i++) { | ||
| 60 | - if (mv & 1) { | ||
| 61 | - vector = 0x31 + i; | ||
| 62 | - /* Check for multiple interrupts. */ | ||
| 63 | - if (mv > 1) | ||
| 64 | - vector = 0x30; | ||
| 65 | - break; | ||
| 66 | - } | ||
| 67 | - mv >>= 1; | ||
| 68 | - } | ||
| 69 | - if (vector) { | ||
| 70 | - env->interrupt_vector = vector; | ||
| 71 | - D(printf("%s vector=%x\n", __func__, vector)); | ||
| 72 | - cpu_interrupt(env, CPU_INTERRUPT_HARD); | ||
| 73 | - } | ||
| 74 | - } else { | ||
| 75 | - env->interrupt_vector = 0; | ||
| 76 | - cpu_reset_interrupt(env, CPU_INTERRUPT_HARD); | ||
| 77 | - D(printf("%s reset irqs\n", __func__)); | ||
| 78 | - } | 46 | +{ |
| 47 | + CPUState *env = fs->env; | ||
| 48 | + uint32_t vector = 0; | ||
| 49 | + int i; | ||
| 50 | + | ||
| 51 | + fs->regs[R_R_MASKED_VECT] = fs->regs[R_R_VECT] & fs->regs[R_RW_MASK]; | ||
| 52 | + | ||
| 53 | + /* The ETRAX interrupt controller signals interrupts to teh core | ||
| 54 | + through an interrupt request wire and an irq vector bus. If | ||
| 55 | + multiple interrupts are simultaneously active it chooses vector | ||
| 56 | + 0x30 and lets the sw choose the priorities. */ | ||
| 57 | + if (fs->regs[R_R_MASKED_VECT]) { | ||
| 58 | + uint32_t mv = fs->regs[R_R_MASKED_VECT]; | ||
| 59 | + for (i = 0; i < 31; i++) { | ||
| 60 | + if (mv & 1) { | ||
| 61 | + vector = 0x31 + i; | ||
| 62 | + /* Check for multiple interrupts. */ | ||
| 63 | + if (mv > 1) | ||
| 64 | + vector = 0x30; | ||
| 65 | + break; | ||
| 66 | + } | ||
| 67 | + mv >>= 1; | ||
| 68 | + } | ||
| 69 | + if (vector) { | ||
| 70 | + env->interrupt_vector = vector; | ||
| 71 | + D(printf("%s vector=%x\n", __func__, vector)); | ||
| 72 | + cpu_interrupt(env, CPU_INTERRUPT_HARD); | ||
| 73 | + } | ||
| 74 | + } else { | ||
| 75 | + env->interrupt_vector = 0; | ||
| 76 | + cpu_reset_interrupt(env, CPU_INTERRUPT_HARD); | ||
| 77 | + D(printf("%s reset irqs\n", __func__)); | ||
| 78 | + } | ||
| 79 | } | 79 | } |
| 80 | 80 | ||
| 81 | static uint32_t pic_readl (void *opaque, target_phys_addr_t addr) | 81 | static uint32_t pic_readl (void *opaque, target_phys_addr_t addr) |
| 82 | { | 82 | { |
| 83 | - struct fs_pic_state *fs = opaque; | ||
| 84 | - uint32_t rval; | 83 | + struct fs_pic_state *fs = opaque; |
| 84 | + uint32_t rval; | ||
| 85 | 85 | ||
| 86 | - rval = fs->regs[addr >> 2]; | ||
| 87 | - D(printf("%s %x=%x\n", __func__, addr, rval)); | ||
| 88 | - return rval; | 86 | + rval = fs->regs[addr >> 2]; |
| 87 | + D(printf("%s %x=%x\n", __func__, addr, rval)); | ||
| 88 | + return rval; | ||
| 89 | } | 89 | } |
| 90 | 90 | ||
| 91 | static void | 91 | static void |
| 92 | pic_writel (void *opaque, target_phys_addr_t addr, uint32_t value) | 92 | pic_writel (void *opaque, target_phys_addr_t addr, uint32_t value) |
| 93 | { | 93 | { |
| 94 | - struct fs_pic_state *fs = opaque; | ||
| 95 | - D(printf("%s addr=%x val=%x\n", __func__, addr, value)); | 94 | + struct fs_pic_state *fs = opaque; |
| 95 | + D(printf("%s addr=%x val=%x\n", __func__, addr, value)); | ||
| 96 | 96 | ||
| 97 | - if (addr == R_RW_MASK) { | ||
| 98 | - fs->regs[R_RW_MASK] = value; | ||
| 99 | - pic_update(fs); | ||
| 100 | - } | 97 | + if (addr == R_RW_MASK) { |
| 98 | + fs->regs[R_RW_MASK] = value; | ||
| 99 | + pic_update(fs); | ||
| 100 | + } | ||
| 101 | } | 101 | } |
| 102 | 102 | ||
| 103 | static CPUReadMemoryFunc *pic_read[] = { | 103 | static CPUReadMemoryFunc *pic_read[] = { |
| 104 | - NULL, NULL, | ||
| 105 | - &pic_readl, | 104 | + NULL, NULL, |
| 105 | + &pic_readl, | ||
| 106 | }; | 106 | }; |
| 107 | 107 | ||
| 108 | static CPUWriteMemoryFunc *pic_write[] = { | 108 | static CPUWriteMemoryFunc *pic_write[] = { |
| 109 | - NULL, NULL, | ||
| 110 | - &pic_writel, | 109 | + NULL, NULL, |
| 110 | + &pic_writel, | ||
| 111 | }; | 111 | }; |
| 112 | 112 | ||
| 113 | void pic_info(Monitor *mon) | 113 | void pic_info(Monitor *mon) |
| @@ -119,47 +119,47 @@ void irq_info(Monitor *mon) | @@ -119,47 +119,47 @@ void irq_info(Monitor *mon) | ||
| 119 | } | 119 | } |
| 120 | 120 | ||
| 121 | static void nmi_handler(void *opaque, int irq, int level) | 121 | static void nmi_handler(void *opaque, int irq, int level) |
| 122 | -{ | ||
| 123 | - struct fs_pic_state *fs = (void *)opaque; | ||
| 124 | - CPUState *env = fs->env; | ||
| 125 | - uint32_t mask; | ||
| 126 | - | ||
| 127 | - mask = 1 << irq; | ||
| 128 | - if (level) | ||
| 129 | - fs->regs[R_R_NMI] |= mask; | ||
| 130 | - else | ||
| 131 | - fs->regs[R_R_NMI] &= ~mask; | ||
| 132 | - | ||
| 133 | - if (fs->regs[R_R_NMI]) | ||
| 134 | - cpu_interrupt(env, CPU_INTERRUPT_NMI); | ||
| 135 | - else | ||
| 136 | - cpu_reset_interrupt(env, CPU_INTERRUPT_NMI); | 122 | +{ |
| 123 | + struct fs_pic_state *fs = (void *)opaque; | ||
| 124 | + CPUState *env = fs->env; | ||
| 125 | + uint32_t mask; | ||
| 126 | + | ||
| 127 | + mask = 1 << irq; | ||
| 128 | + if (level) | ||
| 129 | + fs->regs[R_R_NMI] |= mask; | ||
| 130 | + else | ||
| 131 | + fs->regs[R_R_NMI] &= ~mask; | ||
| 132 | + | ||
| 133 | + if (fs->regs[R_R_NMI]) | ||
| 134 | + cpu_interrupt(env, CPU_INTERRUPT_NMI); | ||
| 135 | + else | ||
| 136 | + cpu_reset_interrupt(env, CPU_INTERRUPT_NMI); | ||
| 137 | } | 137 | } |
| 138 | 138 | ||
| 139 | static void irq_handler(void *opaque, int irq, int level) | 139 | static void irq_handler(void *opaque, int irq, int level) |
| 140 | -{ | ||
| 141 | - struct fs_pic_state *fs = (void *)opaque; | 140 | +{ |
| 141 | + struct fs_pic_state *fs = (void *)opaque; | ||
| 142 | 142 | ||
| 143 | - if (irq >= 30) | ||
| 144 | - return nmi_handler(opaque, irq, level); | 143 | + if (irq >= 30) |
| 144 | + return nmi_handler(opaque, irq, level); | ||
| 145 | 145 | ||
| 146 | - irq -= 1; | ||
| 147 | - fs->regs[R_R_VECT] &= ~(1 << irq); | ||
| 148 | - fs->regs[R_R_VECT] |= (!!level << irq); | ||
| 149 | - pic_update(fs); | 146 | + irq -= 1; |
| 147 | + fs->regs[R_R_VECT] &= ~(1 << irq); | ||
| 148 | + fs->regs[R_R_VECT] |= (!!level << irq); | ||
| 149 | + pic_update(fs); | ||
| 150 | } | 150 | } |
| 151 | 151 | ||
| 152 | qemu_irq *etraxfs_pic_init(CPUState *env, target_phys_addr_t base) | 152 | qemu_irq *etraxfs_pic_init(CPUState *env, target_phys_addr_t base) |
| 153 | { | 153 | { |
| 154 | - struct fs_pic_state *fs = NULL; | ||
| 155 | - qemu_irq *irq; | ||
| 156 | - int intr_vect_regs; | 154 | + struct fs_pic_state *fs = NULL; |
| 155 | + qemu_irq *irq; | ||
| 156 | + int intr_vect_regs; | ||
| 157 | 157 | ||
| 158 | - fs = qemu_mallocz(sizeof *fs); | ||
| 159 | - fs->env = env; | ||
| 160 | - irq = qemu_allocate_irqs(irq_handler, fs, 32); | 158 | + fs = qemu_mallocz(sizeof *fs); |
| 159 | + fs->env = env; | ||
| 160 | + irq = qemu_allocate_irqs(irq_handler, fs, 32); | ||
| 161 | 161 | ||
| 162 | - intr_vect_regs = cpu_register_io_memory(0, pic_read, pic_write, fs); | ||
| 163 | - cpu_register_physical_memory(base, R_MAX * 4, intr_vect_regs); | ||
| 164 | - return irq; | 162 | + intr_vect_regs = cpu_register_io_memory(0, pic_read, pic_write, fs); |
| 163 | + cpu_register_physical_memory(base, R_MAX * 4, intr_vect_regs); | ||
| 164 | + return irq; | ||
| 165 | } | 165 | } |