1 /* 2 * QEMU Sun4u/Sun4v System Emulator common routines 3 * 4 * Copyright (c) 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 25 26 #include "qemu/osdep.h" 27 #include "cpu.h" 28 #include "hw/char/serial.h" 29 #include "hw/sparc/sparc64.h" 30 #include "qemu/timer.h" 31 32 33 //#define DEBUG_IRQ 34 //#define DEBUG_TIMER 35 36 #ifdef DEBUG_IRQ 37 #define CPUIRQ_DPRINTF(fmt, ...) \ 38 do { printf("CPUIRQ: " fmt , ## __VA_ARGS__); } while (0) 39 #else 40 #define CPUIRQ_DPRINTF(fmt, ...) 41 #endif 42 43 #ifdef DEBUG_TIMER 44 #define TIMER_DPRINTF(fmt, ...) \ 45 do { printf("TIMER: " fmt , ## __VA_ARGS__); } while (0) 46 #else 47 #define TIMER_DPRINTF(fmt, ...) 48 #endif 49 50 #define TICK_MAX 0x7fffffffffffffffULL 51 52 void cpu_check_irqs(CPUSPARCState *env) 53 { 54 CPUState *cs; 55 uint32_t pil = env->pil_in | 56 (env->softint & ~(SOFTINT_TIMER | SOFTINT_STIMER)); 57 58 /* We should be holding the BQL before we mess with IRQs */ 59 g_assert(qemu_mutex_iothread_locked()); 60 61 /* TT_IVEC has a higher priority (16) than TT_EXTINT (31..17) */ 62 if (env->ivec_status & 0x20) { 63 return; 64 } 65 cs = CPU(sparc_env_get_cpu(env)); 66 /* check if TM or SM in SOFTINT are set 67 setting these also causes interrupt 14 */ 68 if (env->softint & (SOFTINT_TIMER | SOFTINT_STIMER)) { 69 pil |= 1 << 14; 70 } 71 72 /* The bit corresponding to psrpil is (1<< psrpil), the next bit 73 is (2 << psrpil). */ 74 if (pil < (2 << env->psrpil)) { 75 if (cs->interrupt_request & CPU_INTERRUPT_HARD) { 76 CPUIRQ_DPRINTF("Reset CPU IRQ (current interrupt %x)\n", 77 env->interrupt_index); 78 env->interrupt_index = 0; 79 cpu_reset_interrupt(cs, CPU_INTERRUPT_HARD); 80 } 81 return; 82 } 83 84 if (cpu_interrupts_enabled(env)) { 85 86 unsigned int i; 87 88 for (i = 15; i > env->psrpil; i--) { 89 if (pil & (1 << i)) { 90 int old_interrupt = env->interrupt_index; 91 int new_interrupt = TT_EXTINT | i; 92 93 if (unlikely(env->tl > 0 && cpu_tsptr(env)->tt > new_interrupt 94 && ((cpu_tsptr(env)->tt & 0x1f0) == TT_EXTINT))) { 95 CPUIRQ_DPRINTF("Not setting CPU IRQ: TL=%d " 96 "current %x >= pending %x\n", 97 env->tl, cpu_tsptr(env)->tt, new_interrupt); 98 } else if (old_interrupt != new_interrupt) { 99 env->interrupt_index = new_interrupt; 100 CPUIRQ_DPRINTF("Set CPU IRQ %d old=%x new=%x\n", i, 101 old_interrupt, new_interrupt); 102 cpu_interrupt(cs, CPU_INTERRUPT_HARD); 103 } 104 break; 105 } 106 } 107 } else if (cs->interrupt_request & CPU_INTERRUPT_HARD) { 108 CPUIRQ_DPRINTF("Interrupts disabled, pil=%08x pil_in=%08x softint=%08x " 109 "current interrupt %x\n", 110 pil, env->pil_in, env->softint, env->interrupt_index); 111 env->interrupt_index = 0; 112 cpu_reset_interrupt(cs, CPU_INTERRUPT_HARD); 113 } 114 } 115 116 static void cpu_kick_irq(SPARCCPU *cpu) 117 { 118 CPUState *cs = CPU(cpu); 119 CPUSPARCState *env = &cpu->env; 120 121 cs->halted = 0; 122 cpu_check_irqs(env); 123 qemu_cpu_kick(cs); 124 } 125 126 void sparc64_cpu_set_ivec_irq(void *opaque, int irq, int level) 127 { 128 SPARCCPU *cpu = opaque; 129 CPUSPARCState *env = &cpu->env; 130 CPUState *cs; 131 132 if (level) { 133 if (!(env->ivec_status & 0x20)) { 134 CPUIRQ_DPRINTF("Raise IVEC IRQ %d\n", irq); 135 cs = CPU(cpu); 136 cs->halted = 0; 137 env->interrupt_index = TT_IVEC; 138 env->ivec_status |= 0x20; 139 env->ivec_data[0] = (0x1f << 6) | irq; 140 env->ivec_data[1] = 0; 141 env->ivec_data[2] = 0; 142 cpu_interrupt(cs, CPU_INTERRUPT_HARD); 143 } 144 } else { 145 if (env->ivec_status & 0x20) { 146 CPUIRQ_DPRINTF("Lower IVEC IRQ %d\n", irq); 147 cs = CPU(cpu); 148 env->ivec_status &= ~0x20; 149 cpu_reset_interrupt(cs, CPU_INTERRUPT_HARD); 150 } 151 } 152 } 153 154 typedef struct ResetData { 155 SPARCCPU *cpu; 156 uint64_t prom_addr; 157 } ResetData; 158 159 static CPUTimer *cpu_timer_create(const char *name, SPARCCPU *cpu, 160 QEMUBHFunc *cb, uint32_t frequency, 161 uint64_t disabled_mask, uint64_t npt_mask) 162 { 163 CPUTimer *timer = g_malloc0(sizeof(CPUTimer)); 164 165 timer->name = name; 166 timer->frequency = frequency; 167 timer->disabled_mask = disabled_mask; 168 timer->npt_mask = npt_mask; 169 170 timer->disabled = 1; 171 timer->npt = 1; 172 timer->clock_offset = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL); 173 174 timer->qtimer = timer_new_ns(QEMU_CLOCK_VIRTUAL, cb, cpu); 175 176 return timer; 177 } 178 179 static void cpu_timer_reset(CPUTimer *timer) 180 { 181 timer->disabled = 1; 182 timer->clock_offset = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL); 183 184 timer_del(timer->qtimer); 185 } 186 187 static void main_cpu_reset(void *opaque) 188 { 189 ResetData *s = (ResetData *)opaque; 190 CPUSPARCState *env = &s->cpu->env; 191 static unsigned int nr_resets; 192 193 cpu_reset(CPU(s->cpu)); 194 195 cpu_timer_reset(env->tick); 196 cpu_timer_reset(env->stick); 197 cpu_timer_reset(env->hstick); 198 199 env->gregs[1] = 0; /* Memory start */ 200 env->gregs[2] = ram_size; /* Memory size */ 201 env->gregs[3] = 0; /* Machine description XXX */ 202 if (nr_resets++ == 0) { 203 /* Power on reset */ 204 env->pc = s->prom_addr + 0x20ULL; 205 } else { 206 env->pc = s->prom_addr + 0x40ULL; 207 } 208 env->npc = env->pc + 4; 209 } 210 211 static void tick_irq(void *opaque) 212 { 213 SPARCCPU *cpu = opaque; 214 CPUSPARCState *env = &cpu->env; 215 216 CPUTimer *timer = env->tick; 217 218 if (timer->disabled) { 219 CPUIRQ_DPRINTF("tick_irq: softint disabled\n"); 220 return; 221 } else { 222 CPUIRQ_DPRINTF("tick: fire\n"); 223 } 224 225 env->softint |= SOFTINT_TIMER; 226 cpu_kick_irq(cpu); 227 } 228 229 static void stick_irq(void *opaque) 230 { 231 SPARCCPU *cpu = opaque; 232 CPUSPARCState *env = &cpu->env; 233 234 CPUTimer *timer = env->stick; 235 236 if (timer->disabled) { 237 CPUIRQ_DPRINTF("stick_irq: softint disabled\n"); 238 return; 239 } else { 240 CPUIRQ_DPRINTF("stick: fire\n"); 241 } 242 243 env->softint |= SOFTINT_STIMER; 244 cpu_kick_irq(cpu); 245 } 246 247 static void hstick_irq(void *opaque) 248 { 249 SPARCCPU *cpu = opaque; 250 CPUSPARCState *env = &cpu->env; 251 252 CPUTimer *timer = env->hstick; 253 254 if (timer->disabled) { 255 CPUIRQ_DPRINTF("hstick_irq: softint disabled\n"); 256 return; 257 } else { 258 CPUIRQ_DPRINTF("hstick: fire\n"); 259 } 260 261 env->softint |= SOFTINT_STIMER; 262 cpu_kick_irq(cpu); 263 } 264 265 static int64_t cpu_to_timer_ticks(int64_t cpu_ticks, uint32_t frequency) 266 { 267 return muldiv64(cpu_ticks, NANOSECONDS_PER_SECOND, frequency); 268 } 269 270 static uint64_t timer_to_cpu_ticks(int64_t timer_ticks, uint32_t frequency) 271 { 272 return muldiv64(timer_ticks, frequency, NANOSECONDS_PER_SECOND); 273 } 274 275 void cpu_tick_set_count(CPUTimer *timer, uint64_t count) 276 { 277 uint64_t real_count = count & ~timer->npt_mask; 278 uint64_t npt_bit = count & timer->npt_mask; 279 280 int64_t vm_clock_offset = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) - 281 cpu_to_timer_ticks(real_count, timer->frequency); 282 283 TIMER_DPRINTF("%s set_count count=0x%016lx (npt %s) p=%p\n", 284 timer->name, real_count, 285 timer->npt ? "disabled" : "enabled", timer); 286 287 timer->npt = npt_bit ? 1 : 0; 288 timer->clock_offset = vm_clock_offset; 289 } 290 291 uint64_t cpu_tick_get_count(CPUTimer *timer) 292 { 293 uint64_t real_count = timer_to_cpu_ticks( 294 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) - timer->clock_offset, 295 timer->frequency); 296 297 TIMER_DPRINTF("%s get_count count=0x%016lx (npt %s) p=%p\n", 298 timer->name, real_count, 299 timer->npt ? "disabled" : "enabled", timer); 300 301 if (timer->npt) { 302 real_count |= timer->npt_mask; 303 } 304 305 return real_count; 306 } 307 308 void cpu_tick_set_limit(CPUTimer *timer, uint64_t limit) 309 { 310 int64_t now = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL); 311 312 uint64_t real_limit = limit & ~timer->disabled_mask; 313 timer->disabled = (limit & timer->disabled_mask) ? 1 : 0; 314 315 int64_t expires = cpu_to_timer_ticks(real_limit, timer->frequency) + 316 timer->clock_offset; 317 318 if (expires < now) { 319 expires = now + 1; 320 } 321 322 TIMER_DPRINTF("%s set_limit limit=0x%016lx (%s) p=%p " 323 "called with limit=0x%016lx at 0x%016lx (delta=0x%016lx)\n", 324 timer->name, real_limit, 325 timer->disabled ? "disabled" : "enabled", 326 timer, limit, 327 timer_to_cpu_ticks(now - timer->clock_offset, 328 timer->frequency), 329 timer_to_cpu_ticks(expires - now, timer->frequency)); 330 331 if (!real_limit) { 332 TIMER_DPRINTF("%s set_limit limit=ZERO - not starting timer\n", 333 timer->name); 334 timer_del(timer->qtimer); 335 } else if (timer->disabled) { 336 timer_del(timer->qtimer); 337 } else { 338 timer_mod(timer->qtimer, expires); 339 } 340 } 341 342 SPARCCPU *sparc64_cpu_devinit(const char *cpu_model, 343 const char *default_cpu_model, uint64_t prom_addr) 344 { 345 SPARCCPU *cpu; 346 CPUSPARCState *env; 347 ResetData *reset_info; 348 349 uint32_t tick_frequency = 100 * 1000000; 350 uint32_t stick_frequency = 100 * 1000000; 351 uint32_t hstick_frequency = 100 * 1000000; 352 353 if (cpu_model == NULL) { 354 cpu_model = default_cpu_model; 355 } 356 cpu = SPARC_CPU(cpu_generic_init(TYPE_SPARC_CPU, cpu_model)); 357 env = &cpu->env; 358 359 env->tick = cpu_timer_create("tick", cpu, tick_irq, 360 tick_frequency, TICK_INT_DIS, 361 TICK_NPT_MASK); 362 363 env->stick = cpu_timer_create("stick", cpu, stick_irq, 364 stick_frequency, TICK_INT_DIS, 365 TICK_NPT_MASK); 366 367 env->hstick = cpu_timer_create("hstick", cpu, hstick_irq, 368 hstick_frequency, TICK_INT_DIS, 369 TICK_NPT_MASK); 370 371 reset_info = g_malloc0(sizeof(ResetData)); 372 reset_info->cpu = cpu; 373 reset_info->prom_addr = prom_addr; 374 qemu_register_reset(main_cpu_reset, reset_info); 375 376 return cpu; 377 } 378