2 * QEMU Sun4u/Sun4v System Emulator common routines
4 * Copyright (c) 2005 Fabrice Bellard
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:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
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
26 #include "qemu/osdep.h"
28 #include "hw/char/serial.h"
29 #include "hw/sparc/sparc64.h"
30 #include "qemu/timer.h"
37 #define CPUIRQ_DPRINTF(fmt, ...) \
38 do { printf("CPUIRQ: " fmt , ## __VA_ARGS__); } while (0)
40 #define CPUIRQ_DPRINTF(fmt, ...)
44 #define TIMER_DPRINTF(fmt, ...) \
45 do { printf("TIMER: " fmt , ## __VA_ARGS__); } while (0)
47 #define TIMER_DPRINTF(fmt, ...)
50 #define TICK_MAX 0x7fffffffffffffffULL
52 void cpu_check_irqs(CPUSPARCState
*env
)
55 uint32_t pil
= env
->pil_in
|
56 (env
->softint
& ~(SOFTINT_TIMER
| SOFTINT_STIMER
));
58 /* We should be holding the BQL before we mess with IRQs */
59 g_assert(qemu_mutex_iothread_locked());
61 /* TT_IVEC has a higher priority (16) than TT_EXTINT (31..17) */
62 if (env
->ivec_status
& 0x20) {
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
)) {
72 /* The bit corresponding to psrpil is (1<< psrpil), the next bit
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
);
84 if (cpu_interrupts_enabled(env
)) {
88 for (i
= 15; i
> env
->psrpil
; i
--) {
90 int old_interrupt
= env
->interrupt_index
;
91 int new_interrupt
= TT_EXTINT
| i
;
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
);
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
);
116 static void cpu_kick_irq(SPARCCPU
*cpu
)
118 CPUState
*cs
= CPU(cpu
);
119 CPUSPARCState
*env
= &cpu
->env
;
126 void sparc64_cpu_set_ivec_irq(void *opaque
, int irq
, int level
)
128 SPARCCPU
*cpu
= opaque
;
129 CPUSPARCState
*env
= &cpu
->env
;
133 if (!(env
->ivec_status
& 0x20)) {
134 CPUIRQ_DPRINTF("Raise IVEC IRQ %d\n", irq
);
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
);
145 if (env
->ivec_status
& 0x20) {
146 CPUIRQ_DPRINTF("Lower IVEC IRQ %d\n", irq
);
148 env
->ivec_status
&= ~0x20;
149 cpu_reset_interrupt(cs
, CPU_INTERRUPT_HARD
);
154 typedef struct ResetData
{
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
)
163 CPUTimer
*timer
= g_malloc0(sizeof(CPUTimer
));
166 timer
->frequency
= frequency
;
167 timer
->disabled_mask
= disabled_mask
;
168 timer
->npt_mask
= npt_mask
;
172 timer
->clock_offset
= qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL
);
174 timer
->qtimer
= timer_new_ns(QEMU_CLOCK_VIRTUAL
, cb
, cpu
);
179 static void cpu_timer_reset(CPUTimer
*timer
)
182 timer
->clock_offset
= qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL
);
184 timer_del(timer
->qtimer
);
187 static void main_cpu_reset(void *opaque
)
189 ResetData
*s
= (ResetData
*)opaque
;
190 CPUSPARCState
*env
= &s
->cpu
->env
;
191 static unsigned int nr_resets
;
193 cpu_reset(CPU(s
->cpu
));
195 cpu_timer_reset(env
->tick
);
196 cpu_timer_reset(env
->stick
);
197 cpu_timer_reset(env
->hstick
);
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) {
204 env
->pc
= s
->prom_addr
+ 0x20ULL
;
206 env
->pc
= s
->prom_addr
+ 0x40ULL
;
208 env
->npc
= env
->pc
+ 4;
211 static void tick_irq(void *opaque
)
213 SPARCCPU
*cpu
= opaque
;
214 CPUSPARCState
*env
= &cpu
->env
;
216 CPUTimer
*timer
= env
->tick
;
218 if (timer
->disabled
) {
219 CPUIRQ_DPRINTF("tick_irq: softint disabled\n");
222 CPUIRQ_DPRINTF("tick: fire\n");
225 env
->softint
|= SOFTINT_TIMER
;
229 static void stick_irq(void *opaque
)
231 SPARCCPU
*cpu
= opaque
;
232 CPUSPARCState
*env
= &cpu
->env
;
234 CPUTimer
*timer
= env
->stick
;
236 if (timer
->disabled
) {
237 CPUIRQ_DPRINTF("stick_irq: softint disabled\n");
240 CPUIRQ_DPRINTF("stick: fire\n");
243 env
->softint
|= SOFTINT_STIMER
;
247 static void hstick_irq(void *opaque
)
249 SPARCCPU
*cpu
= opaque
;
250 CPUSPARCState
*env
= &cpu
->env
;
252 CPUTimer
*timer
= env
->hstick
;
254 if (timer
->disabled
) {
255 CPUIRQ_DPRINTF("hstick_irq: softint disabled\n");
258 CPUIRQ_DPRINTF("hstick: fire\n");
261 env
->softint
|= SOFTINT_STIMER
;
265 static int64_t cpu_to_timer_ticks(int64_t cpu_ticks
, uint32_t frequency
)
267 return muldiv64(cpu_ticks
, NANOSECONDS_PER_SECOND
, frequency
);
270 static uint64_t timer_to_cpu_ticks(int64_t timer_ticks
, uint32_t frequency
)
272 return muldiv64(timer_ticks
, frequency
, NANOSECONDS_PER_SECOND
);
275 void cpu_tick_set_count(CPUTimer
*timer
, uint64_t count
)
277 uint64_t real_count
= count
& ~timer
->npt_mask
;
278 uint64_t npt_bit
= count
& timer
->npt_mask
;
280 int64_t vm_clock_offset
= qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL
) -
281 cpu_to_timer_ticks(real_count
, timer
->frequency
);
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
);
287 timer
->npt
= npt_bit
? 1 : 0;
288 timer
->clock_offset
= vm_clock_offset
;
291 uint64_t cpu_tick_get_count(CPUTimer
*timer
)
293 uint64_t real_count
= timer_to_cpu_ticks(
294 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL
) - timer
->clock_offset
,
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
);
302 real_count
|= timer
->npt_mask
;
308 void cpu_tick_set_limit(CPUTimer
*timer
, uint64_t limit
)
310 int64_t now
= qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL
);
312 uint64_t real_limit
= limit
& ~timer
->disabled_mask
;
313 timer
->disabled
= (limit
& timer
->disabled_mask
) ? 1 : 0;
315 int64_t expires
= cpu_to_timer_ticks(real_limit
, timer
->frequency
) +
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",
327 timer_to_cpu_ticks(now
- timer
->clock_offset
,
329 timer_to_cpu_ticks(expires
- now
, timer
->frequency
));
332 TIMER_DPRINTF("%s set_limit limit=ZERO - not starting timer\n",
334 timer_del(timer
->qtimer
);
335 } else if (timer
->disabled
) {
336 timer_del(timer
->qtimer
);
338 timer_mod(timer
->qtimer
, expires
);
342 SPARCCPU
*sparc64_cpu_devinit(const char *cpu_model
,
343 const char *default_cpu_model
, uint64_t prom_addr
)
347 ResetData
*reset_info
;
349 uint32_t tick_frequency
= 100 * 1000000;
350 uint32_t stick_frequency
= 100 * 1000000;
351 uint32_t hstick_frequency
= 100 * 1000000;
353 if (cpu_model
== NULL
) {
354 cpu_model
= default_cpu_model
;
356 cpu
= SPARC_CPU(cpu_generic_init(TYPE_SPARC_CPU
, cpu_model
));
358 fprintf(stderr
, "Unable to find Sparc CPU definition\n");
363 env
->tick
= cpu_timer_create("tick", cpu
, tick_irq
,
364 tick_frequency
, TICK_INT_DIS
,
367 env
->stick
= cpu_timer_create("stick", cpu
, stick_irq
,
368 stick_frequency
, TICK_INT_DIS
,
371 env
->hstick
= cpu_timer_create("hstick", cpu
, hstick_irq
,
372 hstick_frequency
, TICK_INT_DIS
,
375 reset_info
= g_malloc0(sizeof(ResetData
));
376 reset_info
->cpu
= cpu
;
377 reset_info
->prom_addr
= prom_addr
;
378 qemu_register_reset(main_cpu_reset
, reset_info
);