target/mips: Move CP0 helpers to sysemu/cp0.c
Opcodes accessing Coprocessor 0 are privileged. Move the CP0 helpers to sysemu/ and simplify the #ifdef'ry. Reviewed-by: Richard Henderson <richard.henderson@linaro.org> Signed-off-by: Philippe Mathieu-Daudé <f4bug@amsat.org> Message-Id: <20210428170410.479308-28-f4bug@amsat.org>
This commit is contained in:
		| @@ -42,109 +42,6 @@ const char regnames[32][4] = { | ||||
|     "t8", "t9", "k0", "k1", "gp", "sp", "s8", "ra", | ||||
| }; | ||||
|  | ||||
| #if !defined(CONFIG_USER_ONLY) | ||||
|  | ||||
| /* Called for updates to CP0_Status.  */ | ||||
| void sync_c0_status(CPUMIPSState *env, CPUMIPSState *cpu, int tc) | ||||
| { | ||||
|     int32_t tcstatus, *tcst; | ||||
|     uint32_t v = cpu->CP0_Status; | ||||
|     uint32_t cu, mx, asid, ksu; | ||||
|     uint32_t mask = ((1 << CP0TCSt_TCU3) | ||||
|                        | (1 << CP0TCSt_TCU2) | ||||
|                        | (1 << CP0TCSt_TCU1) | ||||
|                        | (1 << CP0TCSt_TCU0) | ||||
|                        | (1 << CP0TCSt_TMX) | ||||
|                        | (3 << CP0TCSt_TKSU) | ||||
|                        | (0xff << CP0TCSt_TASID)); | ||||
|  | ||||
|     cu = (v >> CP0St_CU0) & 0xf; | ||||
|     mx = (v >> CP0St_MX) & 0x1; | ||||
|     ksu = (v >> CP0St_KSU) & 0x3; | ||||
|     asid = env->CP0_EntryHi & env->CP0_EntryHi_ASID_mask; | ||||
|  | ||||
|     tcstatus = cu << CP0TCSt_TCU0; | ||||
|     tcstatus |= mx << CP0TCSt_TMX; | ||||
|     tcstatus |= ksu << CP0TCSt_TKSU; | ||||
|     tcstatus |= asid; | ||||
|  | ||||
|     if (tc == cpu->current_tc) { | ||||
|         tcst = &cpu->active_tc.CP0_TCStatus; | ||||
|     } else { | ||||
|         tcst = &cpu->tcs[tc].CP0_TCStatus; | ||||
|     } | ||||
|  | ||||
|     *tcst &= ~mask; | ||||
|     *tcst |= tcstatus; | ||||
|     compute_hflags(cpu); | ||||
| } | ||||
|  | ||||
| void cpu_mips_store_status(CPUMIPSState *env, target_ulong val) | ||||
| { | ||||
|     uint32_t mask = env->CP0_Status_rw_bitmask; | ||||
|     target_ulong old = env->CP0_Status; | ||||
|  | ||||
|     if (env->insn_flags & ISA_MIPS_R6) { | ||||
|         bool has_supervisor = extract32(mask, CP0St_KSU, 2) == 0x3; | ||||
| #if defined(TARGET_MIPS64) | ||||
|         uint32_t ksux = (1 << CP0St_KX) & val; | ||||
|         ksux |= (ksux >> 1) & val; /* KX = 0 forces SX to be 0 */ | ||||
|         ksux |= (ksux >> 1) & val; /* SX = 0 forces UX to be 0 */ | ||||
|         val = (val & ~(7 << CP0St_UX)) | ksux; | ||||
| #endif | ||||
|         if (has_supervisor && extract32(val, CP0St_KSU, 2) == 0x3) { | ||||
|             mask &= ~(3 << CP0St_KSU); | ||||
|         } | ||||
|         mask &= ~(((1 << CP0St_SR) | (1 << CP0St_NMI)) & val); | ||||
|     } | ||||
|  | ||||
|     env->CP0_Status = (old & ~mask) | (val & mask); | ||||
| #if defined(TARGET_MIPS64) | ||||
|     if ((env->CP0_Status ^ old) & (old & (7 << CP0St_UX))) { | ||||
|         /* Access to at least one of the 64-bit segments has been disabled */ | ||||
|         tlb_flush(env_cpu(env)); | ||||
|     } | ||||
| #endif | ||||
|     if (ase_mt_available(env)) { | ||||
|         sync_c0_status(env, env, env->current_tc); | ||||
|     } else { | ||||
|         compute_hflags(env); | ||||
|     } | ||||
| } | ||||
|  | ||||
| void cpu_mips_store_cause(CPUMIPSState *env, target_ulong val) | ||||
| { | ||||
|     uint32_t mask = 0x00C00300; | ||||
|     uint32_t old = env->CP0_Cause; | ||||
|     int i; | ||||
|  | ||||
|     if (env->insn_flags & ISA_MIPS_R2) { | ||||
|         mask |= 1 << CP0Ca_DC; | ||||
|     } | ||||
|     if (env->insn_flags & ISA_MIPS_R6) { | ||||
|         mask &= ~((1 << CP0Ca_WP) & val); | ||||
|     } | ||||
|  | ||||
|     env->CP0_Cause = (env->CP0_Cause & ~mask) | (val & mask); | ||||
|  | ||||
|     if ((old ^ env->CP0_Cause) & (1 << CP0Ca_DC)) { | ||||
|         if (env->CP0_Cause & (1 << CP0Ca_DC)) { | ||||
|             cpu_mips_stop_count(env); | ||||
|         } else { | ||||
|             cpu_mips_start_count(env); | ||||
|         } | ||||
|     } | ||||
|  | ||||
|     /* Set/reset software interrupts */ | ||||
|     for (i = 0 ; i < 2 ; i++) { | ||||
|         if ((old ^ env->CP0_Cause) & (1 << (CP0Ca_IP + i))) { | ||||
|             cpu_mips_soft_irq(env, i, env->CP0_Cause & (1 << (CP0Ca_IP + i))); | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| #endif /* !CONFIG_USER_ONLY */ | ||||
|  | ||||
| static void fpu_dump_fpr(fpr_t *fpr, FILE *f, bool is_fpu64) | ||||
| { | ||||
|     if (is_fpu64) { | ||||
|   | ||||
| @@ -156,6 +156,11 @@ void mips_cpu_do_transaction_failed(CPUState *cs, hwaddr physaddr, | ||||
|                                     MMUAccessType access_type, | ||||
|                                     int mmu_idx, MemTxAttrs attrs, | ||||
|                                     MemTxResult response, uintptr_t retaddr); | ||||
|  | ||||
| void sync_c0_status(CPUMIPSState *env, CPUMIPSState *cpu, int tc); | ||||
| void cpu_mips_store_status(CPUMIPSState *env, target_ulong val); | ||||
| void cpu_mips_store_cause(CPUMIPSState *env, target_ulong val); | ||||
|  | ||||
| extern const VMStateDescription vmstate_mips_cpu; | ||||
|  | ||||
| #endif /* !CONFIG_USER_ONLY */ | ||||
| @@ -405,8 +410,4 @@ static inline void compute_hflags(CPUMIPSState *env) | ||||
|     } | ||||
| } | ||||
|  | ||||
| void sync_c0_status(CPUMIPSState *env, CPUMIPSState *cpu, int tc); | ||||
| void cpu_mips_store_status(CPUMIPSState *env, target_ulong val); | ||||
| void cpu_mips_store_cause(CPUMIPSState *env, target_ulong val); | ||||
|  | ||||
| #endif | ||||
|   | ||||
							
								
								
									
										123
									
								
								target/mips/sysemu/cp0.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										123
									
								
								target/mips/sysemu/cp0.c
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,123 @@ | ||||
| /* | ||||
|  * QEMU MIPS CPU | ||||
|  * | ||||
|  * Copyright (c) 2012 SUSE LINUX Products GmbH | ||||
|  * | ||||
|  * This library is free software; you can redistribute it and/or | ||||
|  * modify it under the terms of the GNU Lesser General Public | ||||
|  * License as published by the Free Software Foundation; either | ||||
|  * version 2.1 of the License, or (at your option) any later version. | ||||
|  * | ||||
|  * This library is distributed in the hope that it will be useful, | ||||
|  * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||||
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU | ||||
|  * Lesser General Public License for more details. | ||||
|  * | ||||
|  * You should have received a copy of the GNU Lesser General Public | ||||
|  * License along with this library; if not, see | ||||
|  * <http://www.gnu.org/licenses/lgpl-2.1.html> | ||||
|  */ | ||||
|  | ||||
| #include "qemu/osdep.h" | ||||
| #include "cpu.h" | ||||
| #include "internal.h" | ||||
| #include "exec/exec-all.h" | ||||
|  | ||||
| /* Called for updates to CP0_Status.  */ | ||||
| void sync_c0_status(CPUMIPSState *env, CPUMIPSState *cpu, int tc) | ||||
| { | ||||
|     int32_t tcstatus, *tcst; | ||||
|     uint32_t v = cpu->CP0_Status; | ||||
|     uint32_t cu, mx, asid, ksu; | ||||
|     uint32_t mask = ((1 << CP0TCSt_TCU3) | ||||
|                        | (1 << CP0TCSt_TCU2) | ||||
|                        | (1 << CP0TCSt_TCU1) | ||||
|                        | (1 << CP0TCSt_TCU0) | ||||
|                        | (1 << CP0TCSt_TMX) | ||||
|                        | (3 << CP0TCSt_TKSU) | ||||
|                        | (0xff << CP0TCSt_TASID)); | ||||
|  | ||||
|     cu = (v >> CP0St_CU0) & 0xf; | ||||
|     mx = (v >> CP0St_MX) & 0x1; | ||||
|     ksu = (v >> CP0St_KSU) & 0x3; | ||||
|     asid = env->CP0_EntryHi & env->CP0_EntryHi_ASID_mask; | ||||
|  | ||||
|     tcstatus = cu << CP0TCSt_TCU0; | ||||
|     tcstatus |= mx << CP0TCSt_TMX; | ||||
|     tcstatus |= ksu << CP0TCSt_TKSU; | ||||
|     tcstatus |= asid; | ||||
|  | ||||
|     if (tc == cpu->current_tc) { | ||||
|         tcst = &cpu->active_tc.CP0_TCStatus; | ||||
|     } else { | ||||
|         tcst = &cpu->tcs[tc].CP0_TCStatus; | ||||
|     } | ||||
|  | ||||
|     *tcst &= ~mask; | ||||
|     *tcst |= tcstatus; | ||||
|     compute_hflags(cpu); | ||||
| } | ||||
|  | ||||
| void cpu_mips_store_status(CPUMIPSState *env, target_ulong val) | ||||
| { | ||||
|     uint32_t mask = env->CP0_Status_rw_bitmask; | ||||
|     target_ulong old = env->CP0_Status; | ||||
|  | ||||
|     if (env->insn_flags & ISA_MIPS_R6) { | ||||
|         bool has_supervisor = extract32(mask, CP0St_KSU, 2) == 0x3; | ||||
| #if defined(TARGET_MIPS64) | ||||
|         uint32_t ksux = (1 << CP0St_KX) & val; | ||||
|         ksux |= (ksux >> 1) & val; /* KX = 0 forces SX to be 0 */ | ||||
|         ksux |= (ksux >> 1) & val; /* SX = 0 forces UX to be 0 */ | ||||
|         val = (val & ~(7 << CP0St_UX)) | ksux; | ||||
| #endif | ||||
|         if (has_supervisor && extract32(val, CP0St_KSU, 2) == 0x3) { | ||||
|             mask &= ~(3 << CP0St_KSU); | ||||
|         } | ||||
|         mask &= ~(((1 << CP0St_SR) | (1 << CP0St_NMI)) & val); | ||||
|     } | ||||
|  | ||||
|     env->CP0_Status = (old & ~mask) | (val & mask); | ||||
| #if defined(TARGET_MIPS64) | ||||
|     if ((env->CP0_Status ^ old) & (old & (7 << CP0St_UX))) { | ||||
|         /* Access to at least one of the 64-bit segments has been disabled */ | ||||
|         tlb_flush(env_cpu(env)); | ||||
|     } | ||||
| #endif | ||||
|     if (ase_mt_available(env)) { | ||||
|         sync_c0_status(env, env, env->current_tc); | ||||
|     } else { | ||||
|         compute_hflags(env); | ||||
|     } | ||||
| } | ||||
|  | ||||
| void cpu_mips_store_cause(CPUMIPSState *env, target_ulong val) | ||||
| { | ||||
|     uint32_t mask = 0x00C00300; | ||||
|     uint32_t old = env->CP0_Cause; | ||||
|     int i; | ||||
|  | ||||
|     if (env->insn_flags & ISA_MIPS_R2) { | ||||
|         mask |= 1 << CP0Ca_DC; | ||||
|     } | ||||
|     if (env->insn_flags & ISA_MIPS_R6) { | ||||
|         mask &= ~((1 << CP0Ca_WP) & val); | ||||
|     } | ||||
|  | ||||
|     env->CP0_Cause = (env->CP0_Cause & ~mask) | (val & mask); | ||||
|  | ||||
|     if ((old ^ env->CP0_Cause) & (1 << CP0Ca_DC)) { | ||||
|         if (env->CP0_Cause & (1 << CP0Ca_DC)) { | ||||
|             cpu_mips_stop_count(env); | ||||
|         } else { | ||||
|             cpu_mips_start_count(env); | ||||
|         } | ||||
|     } | ||||
|  | ||||
|     /* Set/reset software interrupts */ | ||||
|     for (i = 0 ; i < 2 ; i++) { | ||||
|         if ((old ^ env->CP0_Cause) & (1 << (CP0Ca_IP + i))) { | ||||
|             cpu_mips_soft_irq(env, i, env->CP0_Cause & (1 << (CP0Ca_IP + i))); | ||||
|         } | ||||
|     } | ||||
| } | ||||
| @@ -1,5 +1,6 @@ | ||||
| mips_softmmu_ss.add(files( | ||||
|   'addr.c', | ||||
|   'cp0.c', | ||||
|   'cp0_timer.c', | ||||
|   'machine.c', | ||||
|   'physaddr.c', | ||||
|   | ||||
		Reference in New Issue
	
	Block a user