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 20214192307SNicholas Piggin void helper_store_ciabr(CPUPPCState *env, target_ulong value) 20314192307SNicholas Piggin { 20414192307SNicholas Piggin ppc_store_ciabr(env, value); 20514192307SNicholas Piggin } 20614192307SNicholas Piggin 207*d5ee641cSNicholas Piggin void helper_store_dawr0(CPUPPCState *env, target_ulong value) 208*d5ee641cSNicholas Piggin { 209*d5ee641cSNicholas Piggin ppc_store_dawr0(env, value); 210*d5ee641cSNicholas Piggin } 211*d5ee641cSNicholas Piggin 212*d5ee641cSNicholas Piggin void helper_store_dawrx0(CPUPPCState *env, target_ulong value) 213*d5ee641cSNicholas Piggin { 214*d5ee641cSNicholas Piggin ppc_store_dawrx0(env, value); 215*d5ee641cSNicholas Piggin } 216*d5ee641cSNicholas Piggin 2175ba7ba1dSCédric Le Goater /* 2185ba7ba1dSCédric Le Goater * DPDES register is shared. Each bit reflects the state of the 2195ba7ba1dSCédric Le Goater * doorbell interrupt of a thread of the same core. 2205ba7ba1dSCédric Le Goater */ 2215ba7ba1dSCédric Le Goater target_ulong helper_load_dpdes(CPUPPCState *env) 2225ba7ba1dSCédric Le Goater { 223d24e80b2SNicholas Piggin CPUState *cs = env_cpu(env); 224d24e80b2SNicholas Piggin CPUState *ccs; 225d24e80b2SNicholas Piggin uint32_t nr_threads = cs->nr_threads; 2265ba7ba1dSCédric Le Goater target_ulong dpdes = 0; 2275ba7ba1dSCédric Le Goater 228493028d8SCédric Le Goater helper_hfscr_facility_check(env, HFSCR_MSGP, "load DPDES", HFSCR_IC_MSGP); 229493028d8SCédric Le Goater 2303401ea3cSNicholas Piggin if (!(env->flags & POWERPC_FLAG_SMT_1LPAR)) { 2313401ea3cSNicholas Piggin nr_threads = 1; /* DPDES behaves as 1-thread in LPAR-per-thread mode */ 2323401ea3cSNicholas Piggin } 2333401ea3cSNicholas Piggin 234d24e80b2SNicholas Piggin if (nr_threads == 1) { 235f003109fSMatheus Ferst if (env->pending_interrupts & PPC_INTERRUPT_DOORBELL) { 2365ba7ba1dSCédric Le Goater dpdes = 1; 2375ba7ba1dSCédric Le Goater } 238d24e80b2SNicholas Piggin return dpdes; 239d24e80b2SNicholas Piggin } 240d24e80b2SNicholas Piggin 241d24e80b2SNicholas Piggin qemu_mutex_lock_iothread(); 242d24e80b2SNicholas Piggin THREAD_SIBLING_FOREACH(cs, ccs) { 243d24e80b2SNicholas Piggin PowerPCCPU *ccpu = POWERPC_CPU(ccs); 244d24e80b2SNicholas Piggin CPUPPCState *cenv = &ccpu->env; 245d24e80b2SNicholas Piggin uint32_t thread_id = ppc_cpu_tir(ccpu); 246d24e80b2SNicholas Piggin 247d24e80b2SNicholas Piggin if (cenv->pending_interrupts & PPC_INTERRUPT_DOORBELL) { 248d24e80b2SNicholas Piggin dpdes |= (0x1 << thread_id); 249d24e80b2SNicholas Piggin } 250d24e80b2SNicholas Piggin } 251d24e80b2SNicholas Piggin qemu_mutex_unlock_iothread(); 2525ba7ba1dSCédric Le Goater 2535ba7ba1dSCédric Le Goater return dpdes; 2545ba7ba1dSCédric Le Goater } 2555ba7ba1dSCédric Le Goater 2565ba7ba1dSCédric Le Goater void helper_store_dpdes(CPUPPCState *env, target_ulong val) 2575ba7ba1dSCédric Le Goater { 2585ba7ba1dSCédric Le Goater PowerPCCPU *cpu = env_archcpu(env); 259d24e80b2SNicholas Piggin CPUState *cs = env_cpu(env); 260d24e80b2SNicholas Piggin CPUState *ccs; 261d24e80b2SNicholas Piggin uint32_t nr_threads = cs->nr_threads; 2625ba7ba1dSCédric Le Goater 263493028d8SCédric Le Goater helper_hfscr_facility_check(env, HFSCR_MSGP, "store DPDES", HFSCR_IC_MSGP); 264493028d8SCédric Le Goater 2653401ea3cSNicholas Piggin if (!(env->flags & POWERPC_FLAG_SMT_1LPAR)) { 2663401ea3cSNicholas Piggin nr_threads = 1; /* DPDES behaves as 1-thread in LPAR-per-thread mode */ 2673401ea3cSNicholas Piggin } 2683401ea3cSNicholas Piggin 269d24e80b2SNicholas Piggin if (val & ~(nr_threads - 1)) { 2705ba7ba1dSCédric Le Goater qemu_log_mask(LOG_GUEST_ERROR, "Invalid DPDES register value " 2715ba7ba1dSCédric Le Goater TARGET_FMT_lx"\n", val); 272d24e80b2SNicholas Piggin val &= (nr_threads - 1); /* Ignore the invalid bits */ 273d24e80b2SNicholas Piggin } 274d24e80b2SNicholas Piggin 275d24e80b2SNicholas Piggin if (nr_threads == 1) { 276d24e80b2SNicholas Piggin ppc_set_irq(cpu, PPC_INTERRUPT_DOORBELL, val & 0x1); 2775ba7ba1dSCédric Le Goater return; 2785ba7ba1dSCédric Le Goater } 2795ba7ba1dSCédric Le Goater 280d24e80b2SNicholas Piggin /* Does iothread need to be locked for walking CPU list? */ 281d24e80b2SNicholas Piggin qemu_mutex_lock_iothread(); 282d24e80b2SNicholas Piggin THREAD_SIBLING_FOREACH(cs, ccs) { 283d24e80b2SNicholas Piggin PowerPCCPU *ccpu = POWERPC_CPU(ccs); 284d24e80b2SNicholas Piggin uint32_t thread_id = ppc_cpu_tir(ccpu); 285d24e80b2SNicholas Piggin 286d24e80b2SNicholas Piggin ppc_set_irq(cpu, PPC_INTERRUPT_DOORBELL, val & (0x1 << thread_id)); 287d24e80b2SNicholas Piggin } 288d24e80b2SNicholas Piggin qemu_mutex_unlock_iothread(); 2895ba7ba1dSCédric Le Goater } 2904a7518e0SCédric Le Goater #endif /* defined(TARGET_PPC64) */ 2914a7518e0SCédric Le Goater 29231b2b0f8SSuraj Jitindar Singh void helper_store_pidr(CPUPPCState *env, target_ulong val) 29331b2b0f8SSuraj Jitindar Singh { 294fbda88f7SNicholas Piggin env->spr[SPR_BOOKS_PID] = (uint32_t)val; 295db70b311SRichard Henderson tlb_flush(env_cpu(env)); 29631b2b0f8SSuraj Jitindar Singh } 29731b2b0f8SSuraj Jitindar Singh 298c4dae9cdSBenjamin Herrenschmidt void helper_store_lpidr(CPUPPCState *env, target_ulong val) 299c4dae9cdSBenjamin Herrenschmidt { 300fbda88f7SNicholas Piggin env->spr[SPR_LPIDR] = (uint32_t)val; 301c4dae9cdSBenjamin Herrenschmidt 302c4dae9cdSBenjamin Herrenschmidt /* 303c4dae9cdSBenjamin Herrenschmidt * We need to flush the TLB on LPID changes as we only tag HV vs 304c4dae9cdSBenjamin Herrenschmidt * guest in TCG TLB. Also the quadrants means the HV will 305c4dae9cdSBenjamin Herrenschmidt * potentially access and cache entries for the current LPID as 306c4dae9cdSBenjamin Herrenschmidt * well. 307c4dae9cdSBenjamin Herrenschmidt */ 308db70b311SRichard Henderson tlb_flush(env_cpu(env)); 309c4dae9cdSBenjamin Herrenschmidt } 310c4dae9cdSBenjamin Herrenschmidt 311d523dd00SBlue Swirl void helper_store_40x_dbcr0(CPUPPCState *env, target_ulong val) 312901c4eafSBlue Swirl { 3137da31f26SRichard Henderson /* Bits 26 & 27 affect single-stepping. */ 3147da31f26SRichard Henderson hreg_compute_hflags(env); 3157da31f26SRichard Henderson /* Bits 28 & 29 affect reset or shutdown. */ 316901c4eafSBlue Swirl store_40x_dbcr0(env, val); 317901c4eafSBlue Swirl } 318901c4eafSBlue Swirl 319d523dd00SBlue Swirl void helper_store_40x_sler(CPUPPCState *env, target_ulong val) 320901c4eafSBlue Swirl { 321901c4eafSBlue Swirl store_40x_sler(env, val); 322901c4eafSBlue Swirl } 323901c4eafSBlue Swirl #endif 3248555f71dSBlue Swirl 3258555f71dSBlue Swirl /*****************************************************************************/ 3268555f71dSBlue Swirl /* Special registers manipulation */ 3278555f71dSBlue Swirl 328d81b4327SDavid Gibson /* 329d81b4327SDavid Gibson * This code is lifted from MacOnLinux. It is called whenever THRM1,2 330d81b4327SDavid Gibson * or 3 is read an fixes up the values in such a way that will make 331d81b4327SDavid Gibson * MacOS not hang. These registers exist on some 75x and 74xx 332d81b4327SDavid Gibson * processors. 333f0278900SBenjamin Herrenschmidt */ 334f0278900SBenjamin Herrenschmidt void helper_fixup_thrm(CPUPPCState *env) 335f0278900SBenjamin Herrenschmidt { 336f0278900SBenjamin Herrenschmidt target_ulong v, t; 337f0278900SBenjamin Herrenschmidt int i; 338f0278900SBenjamin Herrenschmidt 339f0278900SBenjamin Herrenschmidt #define THRM1_TIN (1 << 31) 340f0278900SBenjamin Herrenschmidt #define THRM1_TIV (1 << 30) 341f0278900SBenjamin Herrenschmidt #define THRM1_THRES(x) (((x) & 0x7f) << 23) 342f0278900SBenjamin Herrenschmidt #define THRM1_TID (1 << 2) 343f0278900SBenjamin Herrenschmidt #define THRM1_TIE (1 << 1) 344f0278900SBenjamin Herrenschmidt #define THRM1_V (1 << 0) 345f0278900SBenjamin Herrenschmidt #define THRM3_E (1 << 0) 346f0278900SBenjamin Herrenschmidt 347f0278900SBenjamin Herrenschmidt if (!(env->spr[SPR_THRM3] & THRM3_E)) { 348f0278900SBenjamin Herrenschmidt return; 349f0278900SBenjamin Herrenschmidt } 350f0278900SBenjamin Herrenschmidt 351f0278900SBenjamin Herrenschmidt /* Note: Thermal interrupts are unimplemented */ 352f0278900SBenjamin Herrenschmidt for (i = SPR_THRM1; i <= SPR_THRM2; i++) { 353f0278900SBenjamin Herrenschmidt v = env->spr[i]; 354f0278900SBenjamin Herrenschmidt if (!(v & THRM1_V)) { 355f0278900SBenjamin Herrenschmidt continue; 356f0278900SBenjamin Herrenschmidt } 357f0278900SBenjamin Herrenschmidt v |= THRM1_TIV; 358f0278900SBenjamin Herrenschmidt v &= ~THRM1_TIN; 359f0278900SBenjamin Herrenschmidt t = v & THRM1_THRES(127); 360f0278900SBenjamin Herrenschmidt if ((v & THRM1_TID) && t < THRM1_THRES(24)) { 361f0278900SBenjamin Herrenschmidt v |= THRM1_TIN; 362f0278900SBenjamin Herrenschmidt } 363f0278900SBenjamin Herrenschmidt if (!(v & THRM1_TID) && t > THRM1_THRES(24)) { 364f0278900SBenjamin Herrenschmidt v |= THRM1_TIN; 365f0278900SBenjamin Herrenschmidt } 366f0278900SBenjamin Herrenschmidt env->spr[i] = v; 367f0278900SBenjamin Herrenschmidt } 368f0278900SBenjamin Herrenschmidt } 369