xref: /qemu/target/ppc/misc_helper.c (revision 14192307ef6e63c9a0f3c7fe937e26bee95bc6a9)
1901c4eafSBlue Swirl /*
2901c4eafSBlue Swirl  * Miscellaneous PowerPC emulation helpers for QEMU.
3901c4eafSBlue Swirl  *
4901c4eafSBlue Swirl  *  Copyright (c) 2003-2007 Jocelyn Mayer
5901c4eafSBlue Swirl  *
6901c4eafSBlue Swirl  * This library is free software; you can redistribute it and/or
7901c4eafSBlue Swirl  * modify it under the terms of the GNU Lesser General Public
8901c4eafSBlue Swirl  * License as published by the Free Software Foundation; either
96bd039cdSChetan Pant  * version 2.1 of the License, or (at your option) any later version.
10901c4eafSBlue Swirl  *
11901c4eafSBlue Swirl  * This library is distributed in the hope that it will be useful,
12901c4eafSBlue Swirl  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13901c4eafSBlue Swirl  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14901c4eafSBlue Swirl  * Lesser General Public License for more details.
15901c4eafSBlue Swirl  *
16901c4eafSBlue Swirl  * You should have received a copy of the GNU Lesser General Public
17901c4eafSBlue Swirl  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
18901c4eafSBlue Swirl  */
19db725815SMarkus Armbruster 
200d75590dSPeter Maydell #include "qemu/osdep.h"
21cd617484SPhilippe Mathieu-Daudé #include "qemu/log.h"
22901c4eafSBlue Swirl #include "cpu.h"
2363c91552SPaolo Bonzini #include "exec/exec-all.h"
242ef6175aSRichard Henderson #include "exec/helper-proto.h"
256b375544SJoel Stanley #include "qemu/error-report.h"
26db725815SMarkus Armbruster #include "qemu/main-loop.h"
2722adb61fSBruno Larsen (billionai) #include "mmu-book3s-v3.h"
287b694df6SMatheus Ferst #include "hw/ppc/ppc.h"
29901c4eafSBlue Swirl 
30901c4eafSBlue Swirl #include "helper_regs.h"
31901c4eafSBlue Swirl 
32901c4eafSBlue Swirl /*****************************************************************************/
33901c4eafSBlue Swirl /* SPR accesses */
34d523dd00SBlue Swirl void helper_load_dump_spr(CPUPPCState *env, uint32_t sprn)
35901c4eafSBlue Swirl {
36901c4eafSBlue Swirl     qemu_log("Read SPR %d %03x => " TARGET_FMT_lx "\n", sprn, sprn,
37901c4eafSBlue Swirl              env->spr[sprn]);
38901c4eafSBlue Swirl }
39901c4eafSBlue Swirl 
40d523dd00SBlue Swirl void helper_store_dump_spr(CPUPPCState *env, uint32_t sprn)
41901c4eafSBlue Swirl {
42901c4eafSBlue Swirl     qemu_log("Write SPR %d %03x <= " TARGET_FMT_lx "\n", sprn, sprn,
43901c4eafSBlue Swirl              env->spr[sprn]);
44901c4eafSBlue Swirl }
457019cb3dSAlexey Kardashevskiy 
469cdfd1b9SNicholas Piggin void helper_spr_core_write_generic(CPUPPCState *env, uint32_t sprn,
479cdfd1b9SNicholas Piggin                                    target_ulong val)
489cdfd1b9SNicholas Piggin {
499cdfd1b9SNicholas Piggin     CPUState *cs = env_cpu(env);
509cdfd1b9SNicholas Piggin     CPUState *ccs;
519cdfd1b9SNicholas Piggin     uint32_t nr_threads = cs->nr_threads;
529cdfd1b9SNicholas Piggin     uint32_t core_id = env->spr[SPR_PIR] & ~(nr_threads - 1);
539cdfd1b9SNicholas Piggin 
549cdfd1b9SNicholas Piggin     assert(core_id == env->spr[SPR_PIR] - env->spr[SPR_TIR]);
559cdfd1b9SNicholas Piggin 
569cdfd1b9SNicholas Piggin     if (nr_threads == 1) {
579cdfd1b9SNicholas Piggin         env->spr[sprn] = val;
589cdfd1b9SNicholas Piggin         return;
599cdfd1b9SNicholas Piggin     }
609cdfd1b9SNicholas Piggin 
619cdfd1b9SNicholas Piggin     THREAD_SIBLING_FOREACH(cs, ccs) {
629cdfd1b9SNicholas Piggin         CPUPPCState *cenv = &POWERPC_CPU(ccs)->env;
639cdfd1b9SNicholas Piggin         cenv->spr[sprn] = val;
649cdfd1b9SNicholas Piggin     }
659cdfd1b9SNicholas Piggin }
669cdfd1b9SNicholas Piggin 
67c5d98a7bSNicholas Piggin void helper_spr_write_CTRL(CPUPPCState *env, uint32_t sprn,
68c5d98a7bSNicholas Piggin                            target_ulong val)
69c5d98a7bSNicholas Piggin {
70c5d98a7bSNicholas Piggin     CPUState *cs = env_cpu(env);
71c5d98a7bSNicholas Piggin     CPUState *ccs;
72c5d98a7bSNicholas Piggin     uint32_t run = val & 1;
73c5d98a7bSNicholas Piggin     uint32_t ts, ts_mask;
74c5d98a7bSNicholas Piggin 
75c5d98a7bSNicholas Piggin     assert(sprn == SPR_CTRL);
76c5d98a7bSNicholas Piggin 
77c5d98a7bSNicholas Piggin     env->spr[sprn] &= ~1U;
78c5d98a7bSNicholas Piggin     env->spr[sprn] |= run;
79c5d98a7bSNicholas Piggin 
80c5d98a7bSNicholas Piggin     ts_mask = ~(1U << (8 + env->spr[SPR_TIR]));
81c5d98a7bSNicholas Piggin     ts = run << (8 + env->spr[SPR_TIR]);
82c5d98a7bSNicholas Piggin 
83c5d98a7bSNicholas Piggin     THREAD_SIBLING_FOREACH(cs, ccs) {
84c5d98a7bSNicholas Piggin         CPUPPCState *cenv = &POWERPC_CPU(ccs)->env;
85c5d98a7bSNicholas Piggin 
86c5d98a7bSNicholas Piggin         cenv->spr[sprn] &= ts_mask;
87c5d98a7bSNicholas Piggin         cenv->spr[sprn] |= ts;
88c5d98a7bSNicholas Piggin     }
89c5d98a7bSNicholas Piggin }
90c5d98a7bSNicholas Piggin 
91c5d98a7bSNicholas Piggin 
927019cb3dSAlexey Kardashevskiy #ifdef TARGET_PPC64
93493028d8SCédric Le Goater static void raise_hv_fu_exception(CPUPPCState *env, uint32_t bit,
94493028d8SCédric Le Goater                                   const char *caller, uint32_t cause,
95493028d8SCédric Le Goater                                   uintptr_t raddr)
96493028d8SCédric Le Goater {
97493028d8SCédric Le Goater     qemu_log_mask(CPU_LOG_INT, "HV Facility %d is unavailable (%s)\n",
98493028d8SCédric Le Goater                   bit, caller);
99493028d8SCédric Le Goater 
100493028d8SCédric Le Goater     env->spr[SPR_HFSCR] &= ~((target_ulong)FSCR_IC_MASK << FSCR_IC_POS);
101493028d8SCédric Le Goater 
102493028d8SCédric Le Goater     raise_exception_err_ra(env, POWERPC_EXCP_HV_FU, cause, raddr);
103493028d8SCédric Le Goater }
104493028d8SCédric Le Goater 
1057019cb3dSAlexey Kardashevskiy static void raise_fu_exception(CPUPPCState *env, uint32_t bit,
10657a2988bSBenjamin Herrenschmidt                                uint32_t sprn, uint32_t cause,
10757a2988bSBenjamin Herrenschmidt                                uintptr_t raddr)
1087019cb3dSAlexey Kardashevskiy {
1097019cb3dSAlexey Kardashevskiy     qemu_log("Facility SPR %d is unavailable (SPR FSCR:%d)\n", sprn, bit);
1107019cb3dSAlexey Kardashevskiy 
1117019cb3dSAlexey Kardashevskiy     env->spr[SPR_FSCR] &= ~((target_ulong)FSCR_IC_MASK << FSCR_IC_POS);
1127019cb3dSAlexey Kardashevskiy     cause &= FSCR_IC_MASK;
1137019cb3dSAlexey Kardashevskiy     env->spr[SPR_FSCR] |= (target_ulong)cause << FSCR_IC_POS;
1147019cb3dSAlexey Kardashevskiy 
11557a2988bSBenjamin Herrenschmidt     raise_exception_err_ra(env, POWERPC_EXCP_FU, 0, raddr);
1167019cb3dSAlexey Kardashevskiy }
1177019cb3dSAlexey Kardashevskiy #endif
1187019cb3dSAlexey Kardashevskiy 
119493028d8SCédric Le Goater void helper_hfscr_facility_check(CPUPPCState *env, uint32_t bit,
120493028d8SCédric Le Goater                                  const char *caller, uint32_t cause)
121493028d8SCédric Le Goater {
122493028d8SCédric Le Goater #ifdef TARGET_PPC64
1239de754d3SVíctor Colombo     if ((env->msr_mask & MSR_HVB) && !FIELD_EX64(env->msr, MSR, HV) &&
124493028d8SCédric Le Goater                                      !(env->spr[SPR_HFSCR] & (1UL << bit))) {
125493028d8SCédric Le Goater         raise_hv_fu_exception(env, bit, caller, cause, GETPC());
126493028d8SCédric Le Goater     }
127493028d8SCédric Le Goater #endif
128493028d8SCédric Le Goater }
129493028d8SCédric Le Goater 
1307019cb3dSAlexey Kardashevskiy void helper_fscr_facility_check(CPUPPCState *env, uint32_t bit,
1317019cb3dSAlexey Kardashevskiy                                 uint32_t sprn, uint32_t cause)
1327019cb3dSAlexey Kardashevskiy {
1337019cb3dSAlexey Kardashevskiy #ifdef TARGET_PPC64
1347019cb3dSAlexey Kardashevskiy     if (env->spr[SPR_FSCR] & (1ULL << bit)) {
1357019cb3dSAlexey Kardashevskiy         /* Facility is enabled, continue */
1367019cb3dSAlexey Kardashevskiy         return;
1377019cb3dSAlexey Kardashevskiy     }
13857a2988bSBenjamin Herrenschmidt     raise_fu_exception(env, bit, sprn, cause, GETPC());
1397019cb3dSAlexey Kardashevskiy #endif
1407019cb3dSAlexey Kardashevskiy }
1417019cb3dSAlexey Kardashevskiy 
142cdcdda27SAlexey Kardashevskiy void helper_msr_facility_check(CPUPPCState *env, uint32_t bit,
143cdcdda27SAlexey Kardashevskiy                                uint32_t sprn, uint32_t cause)
144cdcdda27SAlexey Kardashevskiy {
145cdcdda27SAlexey Kardashevskiy #ifdef TARGET_PPC64
146cdcdda27SAlexey Kardashevskiy     if (env->msr & (1ULL << bit)) {
147cdcdda27SAlexey Kardashevskiy         /* Facility is enabled, continue */
148cdcdda27SAlexey Kardashevskiy         return;
149cdcdda27SAlexey Kardashevskiy     }
15057a2988bSBenjamin Herrenschmidt     raise_fu_exception(env, bit, sprn, cause, GETPC());
151cdcdda27SAlexey Kardashevskiy #endif
152cdcdda27SAlexey Kardashevskiy }
153cdcdda27SAlexey Kardashevskiy 
154901c4eafSBlue Swirl #if !defined(CONFIG_USER_ONLY)
155901c4eafSBlue Swirl 
156d523dd00SBlue Swirl void helper_store_sdr1(CPUPPCState *env, target_ulong val)
157901c4eafSBlue Swirl {
1582828c4cdSMark Cave-Ayland     if (env->spr[SPR_SDR1] != val) {
159901c4eafSBlue Swirl         ppc_store_sdr1(env, val);
160db70b311SRichard Henderson         tlb_flush(env_cpu(env));
1612828c4cdSMark Cave-Ayland     }
162901c4eafSBlue Swirl }
163901c4eafSBlue Swirl 
1644a7518e0SCédric Le Goater #if defined(TARGET_PPC64)
1654a7518e0SCédric Le Goater void helper_store_ptcr(CPUPPCState *env, target_ulong val)
1664a7518e0SCédric Le Goater {
1674a7518e0SCédric Le Goater     if (env->spr[SPR_PTCR] != val) {
16822adb61fSBruno Larsen (billionai)         PowerPCCPU *cpu = env_archcpu(env);
16922adb61fSBruno Larsen (billionai)         target_ulong ptcr_mask = PTCR_PATB | PTCR_PATS;
17022adb61fSBruno Larsen (billionai)         target_ulong patbsize = val & PTCR_PATS;
17122adb61fSBruno Larsen (billionai) 
17222adb61fSBruno Larsen (billionai)         qemu_log_mask(CPU_LOG_MMU, "%s: " TARGET_FMT_lx "\n", __func__, val);
17322adb61fSBruno Larsen (billionai) 
17422adb61fSBruno Larsen (billionai)         assert(!cpu->vhyp);
17522adb61fSBruno Larsen (billionai)         assert(env->mmu_model & POWERPC_MMU_3_00);
17622adb61fSBruno Larsen (billionai) 
17722adb61fSBruno Larsen (billionai)         if (val & ~ptcr_mask) {
17822adb61fSBruno Larsen (billionai)             error_report("Invalid bits 0x"TARGET_FMT_lx" set in PTCR",
17922adb61fSBruno Larsen (billionai)                          val & ~ptcr_mask);
18022adb61fSBruno Larsen (billionai)             val &= ptcr_mask;
18122adb61fSBruno Larsen (billionai)         }
18222adb61fSBruno Larsen (billionai) 
18322adb61fSBruno Larsen (billionai)         if (patbsize > 24) {
18422adb61fSBruno Larsen (billionai)             error_report("Invalid Partition Table size 0x" TARGET_FMT_lx
18522adb61fSBruno Larsen (billionai)                          " stored in PTCR", patbsize);
18622adb61fSBruno Larsen (billionai)             return;
18722adb61fSBruno Larsen (billionai)         }
18822adb61fSBruno Larsen (billionai) 
18922adb61fSBruno Larsen (billionai)         env->spr[SPR_PTCR] = val;
190db70b311SRichard Henderson         tlb_flush(env_cpu(env));
1914a7518e0SCédric Le Goater     }
1924a7518e0SCédric Le Goater }
1936b375544SJoel Stanley 
1946b375544SJoel Stanley void helper_store_pcr(CPUPPCState *env, target_ulong value)
1956b375544SJoel Stanley {
196db70b311SRichard Henderson     PowerPCCPU *cpu = env_archcpu(env);
1976b375544SJoel Stanley     PowerPCCPUClass *pcc = POWERPC_CPU_GET_CLASS(cpu);
1986b375544SJoel Stanley 
1996b375544SJoel Stanley     env->spr[SPR_PCR] = value & pcc->pcr_mask;
2006b375544SJoel Stanley }
2015ba7ba1dSCédric Le Goater 
202*14192307SNicholas Piggin void helper_store_ciabr(CPUPPCState *env, target_ulong value)
203*14192307SNicholas Piggin {
204*14192307SNicholas Piggin     ppc_store_ciabr(env, value);
205*14192307SNicholas Piggin }
206*14192307SNicholas Piggin 
2075ba7ba1dSCédric Le Goater /*
2085ba7ba1dSCédric Le Goater  * DPDES register is shared. Each bit reflects the state of the
2095ba7ba1dSCédric Le Goater  * doorbell interrupt of a thread of the same core.
2105ba7ba1dSCédric Le Goater  */
2115ba7ba1dSCédric Le Goater target_ulong helper_load_dpdes(CPUPPCState *env)
2125ba7ba1dSCédric Le Goater {
213d24e80b2SNicholas Piggin     CPUState *cs = env_cpu(env);
214d24e80b2SNicholas Piggin     CPUState *ccs;
215d24e80b2SNicholas Piggin     uint32_t nr_threads = cs->nr_threads;
2165ba7ba1dSCédric Le Goater     target_ulong dpdes = 0;
2175ba7ba1dSCédric Le Goater 
218493028d8SCédric Le Goater     helper_hfscr_facility_check(env, HFSCR_MSGP, "load DPDES", HFSCR_IC_MSGP);
219493028d8SCédric Le Goater 
2203401ea3cSNicholas Piggin     if (!(env->flags & POWERPC_FLAG_SMT_1LPAR)) {
2213401ea3cSNicholas Piggin         nr_threads = 1; /* DPDES behaves as 1-thread in LPAR-per-thread mode */
2223401ea3cSNicholas Piggin     }
2233401ea3cSNicholas Piggin 
224d24e80b2SNicholas Piggin     if (nr_threads == 1) {
225f003109fSMatheus Ferst         if (env->pending_interrupts & PPC_INTERRUPT_DOORBELL) {
2265ba7ba1dSCédric Le Goater             dpdes = 1;
2275ba7ba1dSCédric Le Goater         }
228d24e80b2SNicholas Piggin         return dpdes;
229d24e80b2SNicholas Piggin     }
230d24e80b2SNicholas Piggin 
231d24e80b2SNicholas Piggin     qemu_mutex_lock_iothread();
232d24e80b2SNicholas Piggin     THREAD_SIBLING_FOREACH(cs, ccs) {
233d24e80b2SNicholas Piggin         PowerPCCPU *ccpu = POWERPC_CPU(ccs);
234d24e80b2SNicholas Piggin         CPUPPCState *cenv = &ccpu->env;
235d24e80b2SNicholas Piggin         uint32_t thread_id = ppc_cpu_tir(ccpu);
236d24e80b2SNicholas Piggin 
237d24e80b2SNicholas Piggin         if (cenv->pending_interrupts & PPC_INTERRUPT_DOORBELL) {
238d24e80b2SNicholas Piggin             dpdes |= (0x1 << thread_id);
239d24e80b2SNicholas Piggin         }
240d24e80b2SNicholas Piggin     }
241d24e80b2SNicholas Piggin     qemu_mutex_unlock_iothread();
2425ba7ba1dSCédric Le Goater 
2435ba7ba1dSCédric Le Goater     return dpdes;
2445ba7ba1dSCédric Le Goater }
2455ba7ba1dSCédric Le Goater 
2465ba7ba1dSCédric Le Goater void helper_store_dpdes(CPUPPCState *env, target_ulong val)
2475ba7ba1dSCédric Le Goater {
2485ba7ba1dSCédric Le Goater     PowerPCCPU *cpu = env_archcpu(env);
249d24e80b2SNicholas Piggin     CPUState *cs = env_cpu(env);
250d24e80b2SNicholas Piggin     CPUState *ccs;
251d24e80b2SNicholas Piggin     uint32_t nr_threads = cs->nr_threads;
2525ba7ba1dSCédric Le Goater 
253493028d8SCédric Le Goater     helper_hfscr_facility_check(env, HFSCR_MSGP, "store DPDES", HFSCR_IC_MSGP);
254493028d8SCédric Le Goater 
2553401ea3cSNicholas Piggin     if (!(env->flags & POWERPC_FLAG_SMT_1LPAR)) {
2563401ea3cSNicholas Piggin         nr_threads = 1; /* DPDES behaves as 1-thread in LPAR-per-thread mode */
2573401ea3cSNicholas Piggin     }
2583401ea3cSNicholas Piggin 
259d24e80b2SNicholas Piggin     if (val & ~(nr_threads - 1)) {
2605ba7ba1dSCédric Le Goater         qemu_log_mask(LOG_GUEST_ERROR, "Invalid DPDES register value "
2615ba7ba1dSCédric Le Goater                       TARGET_FMT_lx"\n", val);
262d24e80b2SNicholas Piggin         val &= (nr_threads - 1); /* Ignore the invalid bits */
263d24e80b2SNicholas Piggin     }
264d24e80b2SNicholas Piggin 
265d24e80b2SNicholas Piggin     if (nr_threads == 1) {
266d24e80b2SNicholas Piggin         ppc_set_irq(cpu, PPC_INTERRUPT_DOORBELL, val & 0x1);
2675ba7ba1dSCédric Le Goater         return;
2685ba7ba1dSCédric Le Goater     }
2695ba7ba1dSCédric Le Goater 
270d24e80b2SNicholas Piggin     /* Does iothread need to be locked for walking CPU list? */
271d24e80b2SNicholas Piggin     qemu_mutex_lock_iothread();
272d24e80b2SNicholas Piggin     THREAD_SIBLING_FOREACH(cs, ccs) {
273d24e80b2SNicholas Piggin         PowerPCCPU *ccpu = POWERPC_CPU(ccs);
274d24e80b2SNicholas Piggin         uint32_t thread_id = ppc_cpu_tir(ccpu);
275d24e80b2SNicholas Piggin 
276d24e80b2SNicholas Piggin         ppc_set_irq(cpu, PPC_INTERRUPT_DOORBELL, val & (0x1 << thread_id));
277d24e80b2SNicholas Piggin     }
278d24e80b2SNicholas Piggin     qemu_mutex_unlock_iothread();
2795ba7ba1dSCédric Le Goater }
2804a7518e0SCédric Le Goater #endif /* defined(TARGET_PPC64) */
2814a7518e0SCédric Le Goater 
28231b2b0f8SSuraj Jitindar Singh void helper_store_pidr(CPUPPCState *env, target_ulong val)
28331b2b0f8SSuraj Jitindar Singh {
284fbda88f7SNicholas Piggin     env->spr[SPR_BOOKS_PID] = (uint32_t)val;
285db70b311SRichard Henderson     tlb_flush(env_cpu(env));
28631b2b0f8SSuraj Jitindar Singh }
28731b2b0f8SSuraj Jitindar Singh 
288c4dae9cdSBenjamin Herrenschmidt void helper_store_lpidr(CPUPPCState *env, target_ulong val)
289c4dae9cdSBenjamin Herrenschmidt {
290fbda88f7SNicholas Piggin     env->spr[SPR_LPIDR] = (uint32_t)val;
291c4dae9cdSBenjamin Herrenschmidt 
292c4dae9cdSBenjamin Herrenschmidt     /*
293c4dae9cdSBenjamin Herrenschmidt      * We need to flush the TLB on LPID changes as we only tag HV vs
294c4dae9cdSBenjamin Herrenschmidt      * guest in TCG TLB. Also the quadrants means the HV will
295c4dae9cdSBenjamin Herrenschmidt      * potentially access and cache entries for the current LPID as
296c4dae9cdSBenjamin Herrenschmidt      * well.
297c4dae9cdSBenjamin Herrenschmidt      */
298db70b311SRichard Henderson     tlb_flush(env_cpu(env));
299c4dae9cdSBenjamin Herrenschmidt }
300c4dae9cdSBenjamin Herrenschmidt 
301d523dd00SBlue Swirl void helper_store_40x_dbcr0(CPUPPCState *env, target_ulong val)
302901c4eafSBlue Swirl {
3037da31f26SRichard Henderson     /* Bits 26 & 27 affect single-stepping. */
3047da31f26SRichard Henderson     hreg_compute_hflags(env);
3057da31f26SRichard Henderson     /* Bits 28 & 29 affect reset or shutdown. */
306901c4eafSBlue Swirl     store_40x_dbcr0(env, val);
307901c4eafSBlue Swirl }
308901c4eafSBlue Swirl 
309d523dd00SBlue Swirl void helper_store_40x_sler(CPUPPCState *env, target_ulong val)
310901c4eafSBlue Swirl {
311901c4eafSBlue Swirl     store_40x_sler(env, val);
312901c4eafSBlue Swirl }
313901c4eafSBlue Swirl #endif
3148555f71dSBlue Swirl 
3158555f71dSBlue Swirl /*****************************************************************************/
3168555f71dSBlue Swirl /* Special registers manipulation */
3178555f71dSBlue Swirl 
318d81b4327SDavid Gibson /*
319d81b4327SDavid Gibson  * This code is lifted from MacOnLinux. It is called whenever THRM1,2
320d81b4327SDavid Gibson  * or 3 is read an fixes up the values in such a way that will make
321d81b4327SDavid Gibson  * MacOS not hang. These registers exist on some 75x and 74xx
322d81b4327SDavid Gibson  * processors.
323f0278900SBenjamin Herrenschmidt  */
324f0278900SBenjamin Herrenschmidt void helper_fixup_thrm(CPUPPCState *env)
325f0278900SBenjamin Herrenschmidt {
326f0278900SBenjamin Herrenschmidt     target_ulong v, t;
327f0278900SBenjamin Herrenschmidt     int i;
328f0278900SBenjamin Herrenschmidt 
329f0278900SBenjamin Herrenschmidt #define THRM1_TIN       (1 << 31)
330f0278900SBenjamin Herrenschmidt #define THRM1_TIV       (1 << 30)
331f0278900SBenjamin Herrenschmidt #define THRM1_THRES(x)  (((x) & 0x7f) << 23)
332f0278900SBenjamin Herrenschmidt #define THRM1_TID       (1 << 2)
333f0278900SBenjamin Herrenschmidt #define THRM1_TIE       (1 << 1)
334f0278900SBenjamin Herrenschmidt #define THRM1_V         (1 << 0)
335f0278900SBenjamin Herrenschmidt #define THRM3_E         (1 << 0)
336f0278900SBenjamin Herrenschmidt 
337f0278900SBenjamin Herrenschmidt     if (!(env->spr[SPR_THRM3] & THRM3_E)) {
338f0278900SBenjamin Herrenschmidt         return;
339f0278900SBenjamin Herrenschmidt     }
340f0278900SBenjamin Herrenschmidt 
341f0278900SBenjamin Herrenschmidt     /* Note: Thermal interrupts are unimplemented */
342f0278900SBenjamin Herrenschmidt     for (i = SPR_THRM1; i <= SPR_THRM2; i++) {
343f0278900SBenjamin Herrenschmidt         v = env->spr[i];
344f0278900SBenjamin Herrenschmidt         if (!(v & THRM1_V)) {
345f0278900SBenjamin Herrenschmidt             continue;
346f0278900SBenjamin Herrenschmidt         }
347f0278900SBenjamin Herrenschmidt         v |= THRM1_TIV;
348f0278900SBenjamin Herrenschmidt         v &= ~THRM1_TIN;
349f0278900SBenjamin Herrenschmidt         t = v & THRM1_THRES(127);
350f0278900SBenjamin Herrenschmidt         if ((v & THRM1_TID) && t < THRM1_THRES(24)) {
351f0278900SBenjamin Herrenschmidt             v |= THRM1_TIN;
352f0278900SBenjamin Herrenschmidt         }
353f0278900SBenjamin Herrenschmidt         if (!(v & THRM1_TID) && t > THRM1_THRES(24)) {
354f0278900SBenjamin Herrenschmidt             v |= THRM1_TIN;
355f0278900SBenjamin Herrenschmidt         }
356f0278900SBenjamin Herrenschmidt         env->spr[i] = v;
357f0278900SBenjamin Herrenschmidt     }
358f0278900SBenjamin Herrenschmidt }
359