10c3e702aSMichael Clark /* 20c3e702aSMichael Clark * RISC-V Emulation Helpers for QEMU. 30c3e702aSMichael Clark * 40c3e702aSMichael Clark * Copyright (c) 2016-2017 Sagar Karandikar, sagark@eecs.berkeley.edu 50c3e702aSMichael Clark * Copyright (c) 2017-2018 SiFive, Inc. 6a939c500SChristoph Muellner * Copyright (c) 2022 VRULL GmbH 70c3e702aSMichael Clark * 80c3e702aSMichael Clark * This program is free software; you can redistribute it and/or modify it 90c3e702aSMichael Clark * under the terms and conditions of the GNU General Public License, 100c3e702aSMichael Clark * version 2 or later, as published by the Free Software Foundation. 110c3e702aSMichael Clark * 120c3e702aSMichael Clark * This program is distributed in the hope it will be useful, but WITHOUT 130c3e702aSMichael Clark * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 140c3e702aSMichael Clark * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 150c3e702aSMichael Clark * more details. 160c3e702aSMichael Clark * 170c3e702aSMichael Clark * You should have received a copy of the GNU General Public License along with 180c3e702aSMichael Clark * this program. If not, see <http://www.gnu.org/licenses/>. 190c3e702aSMichael Clark */ 200c3e702aSMichael Clark 210c3e702aSMichael Clark #include "qemu/osdep.h" 220c3e702aSMichael Clark #include "cpu.h" 23c8f8a995SFei Wu #include "internals.h" 240c3e702aSMichael Clark #include "exec/exec-all.h" 2509b07f28SPhilippe Mathieu-Daudé #include "exec/cpu_ldst.h" 260c3e702aSMichael Clark #include "exec/helper-proto.h" 278f1a1289SDaniel Henrique Barboza #include "trace.h" 280c3e702aSMichael Clark 290c3e702aSMichael Clark /* Exceptions processing helpers */ 308905770bSMarc-André Lureau G_NORETURN void riscv_raise_exception(CPURISCVState *env, 31e2dca2dcSDaniel Henrique Barboza RISCVException exception, 32e2dca2dcSDaniel Henrique Barboza uintptr_t pc) 330c3e702aSMichael Clark { 343109cd98SRichard Henderson CPUState *cs = env_cpu(env); 358f1a1289SDaniel Henrique Barboza 368f1a1289SDaniel Henrique Barboza trace_riscv_exception(exception, 378f1a1289SDaniel Henrique Barboza riscv_cpu_get_trap_name(exception, false), 388f1a1289SDaniel Henrique Barboza env->pc); 398f1a1289SDaniel Henrique Barboza 400c3e702aSMichael Clark cs->exception_index = exception; 410c3e702aSMichael Clark cpu_loop_exit_restore(cs, pc); 420c3e702aSMichael Clark } 430c3e702aSMichael Clark 440c3e702aSMichael Clark void helper_raise_exception(CPURISCVState *env, uint32_t exception) 450c3e702aSMichael Clark { 46fb738839SMichael Clark riscv_raise_exception(env, exception, 0); 470c3e702aSMichael Clark } 480c3e702aSMichael Clark 49a974879bSRichard Henderson target_ulong helper_csrr(CPURISCVState *env, int csr) 500c3e702aSMichael Clark { 5177442380SWeiwei Li /* 5277442380SWeiwei Li * The seed CSR must be accessed with a read-write instruction. A 5377442380SWeiwei Li * read-only instruction such as CSRRS/CSRRC with rs1=x0 or CSRRSI/ 5477442380SWeiwei Li * CSRRCI with uimm=0 will raise an illegal instruction exception. 5577442380SWeiwei Li */ 5677442380SWeiwei Li if (csr == CSR_SEED) { 5777442380SWeiwei Li riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 5877442380SWeiwei Li } 5977442380SWeiwei Li 60c7b95171SMichael Clark target_ulong val = 0; 6138c83e8dSYu-Ming Chang RISCVException ret = riscv_csrr(env, csr, &val); 6257cb2083SAlistair Francis 63533c91e8SAlistair Francis if (ret != RISCV_EXCP_NONE) { 64533c91e8SAlistair Francis riscv_raise_exception(env, ret, GETPC()); 65c7b95171SMichael Clark } 66c7b95171SMichael Clark return val; 670c3e702aSMichael Clark } 680c3e702aSMichael Clark 69a974879bSRichard Henderson void helper_csrw(CPURISCVState *env, int csr, target_ulong src) 700c3e702aSMichael Clark { 7183b519b8SLIU Zhiwei target_ulong mask = env->xl == MXL_RV32 ? UINT32_MAX : (target_ulong)-1; 7283b519b8SLIU Zhiwei RISCVException ret = riscv_csrrw(env, csr, NULL, src, mask); 7357cb2083SAlistair Francis 74533c91e8SAlistair Francis if (ret != RISCV_EXCP_NONE) { 75533c91e8SAlistair Francis riscv_raise_exception(env, ret, GETPC()); 760c3e702aSMichael Clark } 770c3e702aSMichael Clark } 780c3e702aSMichael Clark 79a974879bSRichard Henderson target_ulong helper_csrrw(CPURISCVState *env, int csr, 80a974879bSRichard Henderson target_ulong src, target_ulong write_mask) 810c3e702aSMichael Clark { 82c7b95171SMichael Clark target_ulong val = 0; 83a974879bSRichard Henderson RISCVException ret = riscv_csrrw(env, csr, &val, src, write_mask); 8457cb2083SAlistair Francis 85533c91e8SAlistair Francis if (ret != RISCV_EXCP_NONE) { 86533c91e8SAlistair Francis riscv_raise_exception(env, ret, GETPC()); 870c3e702aSMichael Clark } 88c7b95171SMichael Clark return val; 890c3e702aSMichael Clark } 900c3e702aSMichael Clark 91961738ffSFrédéric Pétrot target_ulong helper_csrr_i128(CPURISCVState *env, int csr) 92961738ffSFrédéric Pétrot { 93961738ffSFrédéric Pétrot Int128 rv = int128_zero(); 9438c83e8dSYu-Ming Chang RISCVException ret = riscv_csrr_i128(env, csr, &rv); 95961738ffSFrédéric Pétrot 96961738ffSFrédéric Pétrot if (ret != RISCV_EXCP_NONE) { 97961738ffSFrédéric Pétrot riscv_raise_exception(env, ret, GETPC()); 98961738ffSFrédéric Pétrot } 99961738ffSFrédéric Pétrot 100961738ffSFrédéric Pétrot env->retxh = int128_gethi(rv); 101961738ffSFrédéric Pétrot return int128_getlo(rv); 102961738ffSFrédéric Pétrot } 103961738ffSFrédéric Pétrot 104961738ffSFrédéric Pétrot void helper_csrw_i128(CPURISCVState *env, int csr, 105961738ffSFrédéric Pétrot target_ulong srcl, target_ulong srch) 106961738ffSFrédéric Pétrot { 107961738ffSFrédéric Pétrot RISCVException ret = riscv_csrrw_i128(env, csr, NULL, 108961738ffSFrédéric Pétrot int128_make128(srcl, srch), 109961738ffSFrédéric Pétrot UINT128_MAX); 110961738ffSFrédéric Pétrot 111961738ffSFrédéric Pétrot if (ret != RISCV_EXCP_NONE) { 112961738ffSFrédéric Pétrot riscv_raise_exception(env, ret, GETPC()); 113961738ffSFrédéric Pétrot } 114961738ffSFrédéric Pétrot } 115961738ffSFrédéric Pétrot 116961738ffSFrédéric Pétrot target_ulong helper_csrrw_i128(CPURISCVState *env, int csr, 117961738ffSFrédéric Pétrot target_ulong srcl, target_ulong srch, 118961738ffSFrédéric Pétrot target_ulong maskl, target_ulong maskh) 119961738ffSFrédéric Pétrot { 120961738ffSFrédéric Pétrot Int128 rv = int128_zero(); 121961738ffSFrédéric Pétrot RISCVException ret = riscv_csrrw_i128(env, csr, &rv, 122961738ffSFrédéric Pétrot int128_make128(srcl, srch), 123961738ffSFrédéric Pétrot int128_make128(maskl, maskh)); 124961738ffSFrédéric Pétrot 125961738ffSFrédéric Pétrot if (ret != RISCV_EXCP_NONE) { 126961738ffSFrédéric Pétrot riscv_raise_exception(env, ret, GETPC()); 127961738ffSFrédéric Pétrot } 128961738ffSFrédéric Pétrot 129961738ffSFrédéric Pétrot env->retxh = int128_gethi(rv); 130961738ffSFrédéric Pétrot return int128_getlo(rv); 131961738ffSFrédéric Pétrot } 132961738ffSFrédéric Pétrot 133a939c500SChristoph Muellner 134a939c500SChristoph Muellner /* 135a939c500SChristoph Muellner * check_zicbo_envcfg 136a939c500SChristoph Muellner * 137a939c500SChristoph Muellner * Raise virtual exceptions and illegal instruction exceptions for 138a939c500SChristoph Muellner * Zicbo[mz] instructions based on the settings of [mhs]envcfg as 139a939c500SChristoph Muellner * specified in section 2.5.1 of the CMO specification. 140a939c500SChristoph Muellner */ 141a939c500SChristoph Muellner static void check_zicbo_envcfg(CPURISCVState *env, target_ulong envbits, 142a939c500SChristoph Muellner uintptr_t ra) 143a939c500SChristoph Muellner { 144a939c500SChristoph Muellner #ifndef CONFIG_USER_ONLY 145a939c500SChristoph Muellner if ((env->priv < PRV_M) && !get_field(env->menvcfg, envbits)) { 146a939c500SChristoph Muellner riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, ra); 147a939c500SChristoph Muellner } 148a939c500SChristoph Muellner 14938256529SWeiwei Li if (env->virt_enabled && 15044b8f74bSWeiwei Li (((env->priv <= PRV_S) && !get_field(env->henvcfg, envbits)) || 151a939c500SChristoph Muellner ((env->priv < PRV_S) && !get_field(env->senvcfg, envbits)))) { 152a939c500SChristoph Muellner riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, ra); 153a939c500SChristoph Muellner } 154a939c500SChristoph Muellner 155a939c500SChristoph Muellner if ((env->priv < PRV_S) && !get_field(env->senvcfg, envbits)) { 156a939c500SChristoph Muellner riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, ra); 157a939c500SChristoph Muellner } 158a939c500SChristoph Muellner #endif 159a939c500SChristoph Muellner } 160a939c500SChristoph Muellner 161a939c500SChristoph Muellner void helper_cbo_zero(CPURISCVState *env, target_ulong address) 162a939c500SChristoph Muellner { 163a939c500SChristoph Muellner RISCVCPU *cpu = env_archcpu(env); 164a939c500SChristoph Muellner uint16_t cbozlen = cpu->cfg.cboz_blocksize; 165d9996d09SRichard Henderson int mmu_idx = riscv_env_mmu_index(env, false); 166a939c500SChristoph Muellner uintptr_t ra = GETPC(); 167a939c500SChristoph Muellner void *mem; 168a939c500SChristoph Muellner 169a939c500SChristoph Muellner check_zicbo_envcfg(env, MENVCFG_CBZE, ra); 170a939c500SChristoph Muellner 171a939c500SChristoph Muellner /* Mask off low-bits to align-down to the cache-block. */ 172a939c500SChristoph Muellner address &= ~(cbozlen - 1); 173a939c500SChristoph Muellner 174a939c500SChristoph Muellner /* 175a939c500SChristoph Muellner * cbo.zero requires MMU_DATA_STORE access. Do a probe_write() 176a939c500SChristoph Muellner * to raise any exceptions, including PMP. 177a939c500SChristoph Muellner */ 178a939c500SChristoph Muellner mem = probe_write(env, address, cbozlen, mmu_idx, ra); 179a939c500SChristoph Muellner 180a939c500SChristoph Muellner if (likely(mem)) { 181a939c500SChristoph Muellner memset(mem, 0, cbozlen); 182a939c500SChristoph Muellner } else { 183a939c500SChristoph Muellner /* 184a939c500SChristoph Muellner * This means that we're dealing with an I/O page. Section 4.2 185a939c500SChristoph Muellner * of cmobase v1.0.1 says: 186a939c500SChristoph Muellner * 187a939c500SChristoph Muellner * "Cache-block zero instructions store zeros independently 188a939c500SChristoph Muellner * of whether data from the underlying memory locations are 189a939c500SChristoph Muellner * cacheable." 190a939c500SChristoph Muellner * 191a939c500SChristoph Muellner * Write zeros in address + cbozlen regardless of not being 192a939c500SChristoph Muellner * a RAM page. 193a939c500SChristoph Muellner */ 194a939c500SChristoph Muellner for (int i = 0; i < cbozlen; i++) { 195a939c500SChristoph Muellner cpu_stb_mmuidx_ra(env, address + i, 0, mmu_idx, ra); 196a939c500SChristoph Muellner } 197a939c500SChristoph Muellner } 198a939c500SChristoph Muellner } 199a939c500SChristoph Muellner 200e05da09bSChristoph Muellner /* 201e05da09bSChristoph Muellner * check_zicbom_access 202e05da09bSChristoph Muellner * 203e05da09bSChristoph Muellner * Check access permissions (LOAD, STORE or FETCH as specified in 204e05da09bSChristoph Muellner * section 2.5.2 of the CMO specification) for Zicbom, raising 205e05da09bSChristoph Muellner * either store page-fault (non-virtualized) or store guest-page 206e05da09bSChristoph Muellner * fault (virtualized). 207e05da09bSChristoph Muellner */ 208e05da09bSChristoph Muellner static void check_zicbom_access(CPURISCVState *env, 209e05da09bSChristoph Muellner target_ulong address, 210e05da09bSChristoph Muellner uintptr_t ra) 211e05da09bSChristoph Muellner { 212e05da09bSChristoph Muellner RISCVCPU *cpu = env_archcpu(env); 213d9996d09SRichard Henderson int mmu_idx = riscv_env_mmu_index(env, false); 214e05da09bSChristoph Muellner uint16_t cbomlen = cpu->cfg.cbom_blocksize; 215e05da09bSChristoph Muellner void *phost; 216e05da09bSChristoph Muellner int ret; 217e05da09bSChristoph Muellner 218e05da09bSChristoph Muellner /* Mask off low-bits to align-down to the cache-block. */ 219e05da09bSChristoph Muellner address &= ~(cbomlen - 1); 220e05da09bSChristoph Muellner 221e05da09bSChristoph Muellner /* 222e05da09bSChristoph Muellner * Section 2.5.2 of cmobase v1.0.1: 223e05da09bSChristoph Muellner * 224e05da09bSChristoph Muellner * "A cache-block management instruction is permitted to 225e05da09bSChristoph Muellner * access the specified cache block whenever a load instruction 226e05da09bSChristoph Muellner * or store instruction is permitted to access the corresponding 227e05da09bSChristoph Muellner * physical addresses. If neither a load instruction nor store 228e05da09bSChristoph Muellner * instruction is permitted to access the physical addresses, 229e05da09bSChristoph Muellner * but an instruction fetch is permitted to access the physical 230e05da09bSChristoph Muellner * addresses, whether a cache-block management instruction is 231e05da09bSChristoph Muellner * permitted to access the cache block is UNSPECIFIED." 232e05da09bSChristoph Muellner */ 233e05da09bSChristoph Muellner ret = probe_access_flags(env, address, cbomlen, MMU_DATA_LOAD, 234e05da09bSChristoph Muellner mmu_idx, true, &phost, ra); 235e05da09bSChristoph Muellner if (ret != TLB_INVALID_MASK) { 236e05da09bSChristoph Muellner /* Success: readable */ 237e05da09bSChristoph Muellner return; 238e05da09bSChristoph Muellner } 239e05da09bSChristoph Muellner 240e05da09bSChristoph Muellner /* 241e05da09bSChristoph Muellner * Since not readable, must be writable. On failure, store 242e05da09bSChristoph Muellner * fault/store guest amo fault will be raised by 243e05da09bSChristoph Muellner * riscv_cpu_tlb_fill(). PMP exceptions will be caught 244e05da09bSChristoph Muellner * there as well. 245e05da09bSChristoph Muellner */ 246e05da09bSChristoph Muellner probe_write(env, address, cbomlen, mmu_idx, ra); 247e05da09bSChristoph Muellner } 248e05da09bSChristoph Muellner 249e05da09bSChristoph Muellner void helper_cbo_clean_flush(CPURISCVState *env, target_ulong address) 250e05da09bSChristoph Muellner { 251e05da09bSChristoph Muellner uintptr_t ra = GETPC(); 252e05da09bSChristoph Muellner check_zicbo_envcfg(env, MENVCFG_CBCFE, ra); 253e05da09bSChristoph Muellner check_zicbom_access(env, address, ra); 254e05da09bSChristoph Muellner 255e05da09bSChristoph Muellner /* We don't emulate the cache-hierarchy, so we're done. */ 256e05da09bSChristoph Muellner } 257e05da09bSChristoph Muellner 258e05da09bSChristoph Muellner void helper_cbo_inval(CPURISCVState *env, target_ulong address) 259e05da09bSChristoph Muellner { 260e05da09bSChristoph Muellner uintptr_t ra = GETPC(); 261e05da09bSChristoph Muellner check_zicbo_envcfg(env, MENVCFG_CBIE, ra); 262e05da09bSChristoph Muellner check_zicbom_access(env, address, ra); 263e05da09bSChristoph Muellner 264e05da09bSChristoph Muellner /* We don't emulate the cache-hierarchy, so we're done. */ 265e05da09bSChristoph Muellner } 266e05da09bSChristoph Muellner 2670c3e702aSMichael Clark #ifndef CONFIG_USER_ONLY 2680c3e702aSMichael Clark 269b655dc7cSLIU Zhiwei target_ulong helper_sret(CPURISCVState *env) 2700c3e702aSMichael Clark { 271284d697cSYifei Jiang uint64_t mstatus; 27268c05fb5SRajnesh Kanwal target_ulong prev_priv, prev_virt = env->virt_enabled; 273e3fba4baSAlistair Francis 2740c3e702aSMichael Clark if (!(env->priv >= PRV_S)) { 275fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 2760c3e702aSMichael Clark } 2770c3e702aSMichael Clark 2780c3e702aSMichael Clark target_ulong retpc = env->sepc; 2790c3e702aSMichael Clark if (!riscv_has_ext(env, RVC) && (retpc & 0x3)) { 280fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_INST_ADDR_MIS, GETPC()); 2810c3e702aSMichael Clark } 2820c3e702aSMichael Clark 2831a9540d1SAlistair Francis if (get_field(env->mstatus, MSTATUS_TSR) && !(env->priv >= PRV_M)) { 284fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 2857f2b5ff1SMichael Clark } 2867f2b5ff1SMichael Clark 28738256529SWeiwei Li if (env->virt_enabled && get_field(env->hstatus, HSTATUS_VTSR)) { 288e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 289e39a8320SAlistair Francis } 290e39a8320SAlistair Francis 291e3fba4baSAlistair Francis mstatus = env->mstatus; 2922bfec53bSBin Meng prev_priv = get_field(mstatus, MSTATUS_SPP); 2932bfec53bSBin Meng mstatus = set_field(mstatus, MSTATUS_SIE, 2942bfec53bSBin Meng get_field(mstatus, MSTATUS_SPIE)); 2952bfec53bSBin Meng mstatus = set_field(mstatus, MSTATUS_SPIE, 1); 2962bfec53bSBin Meng mstatus = set_field(mstatus, MSTATUS_SPP, PRV_U); 29772d71d87SClément Léger 29872d71d87SClément Léger if (riscv_cpu_cfg(env)->ext_ssdbltrp) { 29972d71d87SClément Léger if (riscv_has_ext(env, RVH)) { 30072d71d87SClément Léger target_ulong prev_vu = get_field(env->hstatus, HSTATUS_SPV) && 30172d71d87SClément Léger prev_priv == PRV_U; 30272d71d87SClément Léger /* Returning to VU from HS, vsstatus.sdt = 0 */ 30372d71d87SClément Léger if (!env->virt_enabled && prev_vu) { 30472d71d87SClément Léger env->vsstatus = set_field(env->vsstatus, MSTATUS_SDT, 0); 30572d71d87SClément Léger } 30672d71d87SClément Léger } 30772d71d87SClément Léger mstatus = set_field(mstatus, MSTATUS_SDT, 0); 30872d71d87SClément Léger } 309*f2efb6e7SClément Léger if (riscv_cpu_cfg(env)->ext_smdbltrp && env->priv >= PRV_M) { 310*f2efb6e7SClément Léger mstatus = set_field(mstatus, MSTATUS_MDT, 0); 311*f2efb6e7SClément Léger } 3120ff430a5SBin Meng if (env->priv_ver >= PRIV_VERSION_1_12_0) { 3130ff430a5SBin Meng mstatus = set_field(mstatus, MSTATUS_MPRV, 0); 3140ff430a5SBin Meng } 3152bfec53bSBin Meng env->mstatus = mstatus; 316e3fba4baSAlistair Francis 31738256529SWeiwei Li if (riscv_has_ext(env, RVH) && !env->virt_enabled) { 318e3fba4baSAlistair Francis /* We support Hypervisor extensions and virtulisation is disabled */ 319e3fba4baSAlistair Francis target_ulong hstatus = env->hstatus; 320e3fba4baSAlistair Francis 321e3fba4baSAlistair Francis prev_virt = get_field(hstatus, HSTATUS_SPV); 322f2d5850fSAlistair Francis hstatus = set_field(hstatus, HSTATUS_SPV, 0); 323e3fba4baSAlistair Francis 324e3fba4baSAlistair Francis env->hstatus = hstatus; 325e3fba4baSAlistair Francis 326e3fba4baSAlistair Francis if (prev_virt) { 327e3fba4baSAlistair Francis riscv_cpu_swap_hypervisor_regs(env); 328e3fba4baSAlistair Francis } 329e3fba4baSAlistair Francis } 330e3fba4baSAlistair Francis 33168c05fb5SRajnesh Kanwal riscv_cpu_set_mode(env, prev_priv, prev_virt); 3320c3e702aSMichael Clark 33353309be1SDeepak Gupta /* 33453309be1SDeepak Gupta * If forward cfi enabled for new priv, restore elp status 33553309be1SDeepak Gupta * and clear spelp in mstatus 33653309be1SDeepak Gupta */ 33753309be1SDeepak Gupta if (cpu_get_fcfien(env)) { 33853309be1SDeepak Gupta env->elp = get_field(env->mstatus, MSTATUS_SPELP); 33953309be1SDeepak Gupta } 34053309be1SDeepak Gupta env->mstatus = set_field(env->mstatus, MSTATUS_SPELP, 0); 34153309be1SDeepak Gupta 3420c3e702aSMichael Clark return retpc; 3430c3e702aSMichael Clark } 3440c3e702aSMichael Clark 3453157a553STommy Wu static void check_ret_from_m_mode(CPURISCVState *env, target_ulong retpc, 3463157a553STommy Wu target_ulong prev_priv) 3470c3e702aSMichael Clark { 3480c3e702aSMichael Clark if (!(env->priv >= PRV_M)) { 349fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 3500c3e702aSMichael Clark } 3510c3e702aSMichael Clark 3520c3e702aSMichael Clark if (!riscv_has_ext(env, RVC) && (retpc & 0x3)) { 353fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_INST_ADDR_MIS, GETPC()); 3540c3e702aSMichael Clark } 3550c3e702aSMichael Clark 3563fe40ef5SDaniel Henrique Barboza if (riscv_cpu_cfg(env)->pmp && 3570fbb5d2dSNikita Shubin !pmp_get_num_rules(env) && (prev_priv != PRV_M)) { 3584c48aad1SBin Meng riscv_raise_exception(env, RISCV_EXCP_INST_ACCESS_FAULT, GETPC()); 359d102f19aSAtish Patra } 3603157a553STommy Wu } 36172d71d87SClément Léger static target_ulong ssdbltrp_mxret(CPURISCVState *env, target_ulong mstatus, 36272d71d87SClément Léger target_ulong prev_priv, 36372d71d87SClément Léger target_ulong prev_virt) 36472d71d87SClément Léger { 36572d71d87SClément Léger /* If returning to U, VS or VU, sstatus.sdt = 0 */ 36672d71d87SClément Léger if (prev_priv == PRV_U || (prev_virt && 36772d71d87SClément Léger (prev_priv == PRV_S || prev_priv == PRV_U))) { 36872d71d87SClément Léger mstatus = set_field(mstatus, MSTATUS_SDT, 0); 36972d71d87SClément Léger /* If returning to VU, vsstatus.sdt = 0 */ 37072d71d87SClément Léger if (prev_virt && prev_priv == PRV_U) { 37172d71d87SClément Léger env->vsstatus = set_field(env->vsstatus, MSTATUS_SDT, 0); 37272d71d87SClément Léger } 37372d71d87SClément Léger } 37472d71d87SClément Léger 37572d71d87SClément Léger return mstatus; 37672d71d87SClément Léger } 3773157a553STommy Wu 3783157a553STommy Wu target_ulong helper_mret(CPURISCVState *env) 3793157a553STommy Wu { 3803157a553STommy Wu target_ulong retpc = env->mepc; 3813157a553STommy Wu uint64_t mstatus = env->mstatus; 3823157a553STommy Wu target_ulong prev_priv = get_field(mstatus, MSTATUS_MPP); 3833157a553STommy Wu 3843157a553STommy Wu check_ret_from_m_mode(env, retpc, prev_priv); 385d102f19aSAtish Patra 386869d76f2SWeiwei Li target_ulong prev_virt = get_field(env->mstatus, MSTATUS_MPV) && 387869d76f2SWeiwei Li (prev_priv != PRV_M); 3881a9540d1SAlistair Francis mstatus = set_field(mstatus, MSTATUS_MIE, 3890c3e702aSMichael Clark get_field(mstatus, MSTATUS_MPIE)); 390a37f21c2SYiting Wang mstatus = set_field(mstatus, MSTATUS_MPIE, 1); 39104803c3dSWeiwei Li mstatus = set_field(mstatus, MSTATUS_MPP, 39204803c3dSWeiwei Li riscv_has_ext(env, RVU) ? PRV_U : PRV_M); 393e3fba4baSAlistair Francis mstatus = set_field(mstatus, MSTATUS_MPV, 0); 39472d71d87SClément Léger if (riscv_cpu_cfg(env)->ext_ssdbltrp) { 39572d71d87SClément Léger mstatus = ssdbltrp_mxret(env, mstatus, prev_priv, prev_virt); 39672d71d87SClément Léger } 397*f2efb6e7SClément Léger if (riscv_cpu_cfg(env)->ext_smdbltrp) { 398*f2efb6e7SClément Léger mstatus = set_field(mstatus, MSTATUS_MDT, 0); 399*f2efb6e7SClément Léger } 4000ff430a5SBin Meng if ((env->priv_ver >= PRIV_VERSION_1_12_0) && (prev_priv != PRV_M)) { 4010ff430a5SBin Meng mstatus = set_field(mstatus, MSTATUS_MPRV, 0); 4020ff430a5SBin Meng } 403c7b95171SMichael Clark env->mstatus = mstatus; 404e3fba4baSAlistair Francis 40568c05fb5SRajnesh Kanwal if (riscv_has_ext(env, RVH) && prev_virt) { 406e3fba4baSAlistair Francis riscv_cpu_swap_hypervisor_regs(env); 407e3fba4baSAlistair Francis } 408e3fba4baSAlistair Francis 40968c05fb5SRajnesh Kanwal riscv_cpu_set_mode(env, prev_priv, prev_virt); 41053309be1SDeepak Gupta /* 41153309be1SDeepak Gupta * If forward cfi enabled for new priv, restore elp status 41253309be1SDeepak Gupta * and clear mpelp in mstatus 41353309be1SDeepak Gupta */ 41453309be1SDeepak Gupta if (cpu_get_fcfien(env)) { 41553309be1SDeepak Gupta env->elp = get_field(env->mstatus, MSTATUS_MPELP); 41653309be1SDeepak Gupta } 41753309be1SDeepak Gupta env->mstatus = set_field(env->mstatus, MSTATUS_MPELP, 0); 4180c3e702aSMichael Clark 4190c3e702aSMichael Clark return retpc; 4200c3e702aSMichael Clark } 4210c3e702aSMichael Clark 4223157a553STommy Wu target_ulong helper_mnret(CPURISCVState *env) 4233157a553STommy Wu { 4243157a553STommy Wu target_ulong retpc = env->mnepc; 4253157a553STommy Wu target_ulong prev_priv = get_field(env->mnstatus, MNSTATUS_MNPP); 4263157a553STommy Wu target_ulong prev_virt; 4273157a553STommy Wu 4283157a553STommy Wu check_ret_from_m_mode(env, retpc, prev_priv); 4293157a553STommy Wu 4303157a553STommy Wu prev_virt = get_field(env->mnstatus, MNSTATUS_MNPV) && 4313157a553STommy Wu (prev_priv != PRV_M); 4323157a553STommy Wu env->mnstatus = set_field(env->mnstatus, MNSTATUS_NMIE, true); 4333157a553STommy Wu 4343157a553STommy Wu /* 4353157a553STommy Wu * If MNRET changes the privilege mode to a mode 4363157a553STommy Wu * less privileged than M, it also sets mstatus.MPRV to 0. 4373157a553STommy Wu */ 4383157a553STommy Wu if (prev_priv < PRV_M) { 4393157a553STommy Wu env->mstatus = set_field(env->mstatus, MSTATUS_MPRV, false); 4403157a553STommy Wu } 44172d71d87SClément Léger if (riscv_cpu_cfg(env)->ext_ssdbltrp) { 44272d71d87SClément Léger env->mstatus = ssdbltrp_mxret(env, env->mstatus, prev_priv, prev_virt); 44372d71d87SClément Léger } 4443157a553STommy Wu 445*f2efb6e7SClément Léger if (riscv_cpu_cfg(env)->ext_smdbltrp) { 446*f2efb6e7SClément Léger if (prev_priv < PRV_M) { 447*f2efb6e7SClément Léger env->mstatus = set_field(env->mstatus, MSTATUS_MDT, 0); 448*f2efb6e7SClément Léger } 449*f2efb6e7SClément Léger } 450*f2efb6e7SClément Léger 4513157a553STommy Wu if (riscv_has_ext(env, RVH) && prev_virt) { 4523157a553STommy Wu riscv_cpu_swap_hypervisor_regs(env); 4533157a553STommy Wu } 4543157a553STommy Wu 4553157a553STommy Wu riscv_cpu_set_mode(env, prev_priv, prev_virt); 4563157a553STommy Wu 4570266fd8bSFrank Chang /* 4580266fd8bSFrank Chang * If forward cfi enabled for new priv, restore elp status 4590266fd8bSFrank Chang * and clear mnpelp in mnstatus 4600266fd8bSFrank Chang */ 4610266fd8bSFrank Chang if (cpu_get_fcfien(env)) { 4620266fd8bSFrank Chang env->elp = get_field(env->mnstatus, MNSTATUS_MNPELP); 4630266fd8bSFrank Chang } 4640266fd8bSFrank Chang env->mnstatus = set_field(env->mnstatus, MNSTATUS_MNPELP, 0); 4650266fd8bSFrank Chang 4663157a553STommy Wu return retpc; 4673157a553STommy Wu } 4683157a553STommy Wu 4690c3e702aSMichael Clark void helper_wfi(CPURISCVState *env) 4700c3e702aSMichael Clark { 4713109cd98SRichard Henderson CPUState *cs = env_cpu(env); 472719f0f60SJose Martins bool rvs = riscv_has_ext(env, RVS); 473719f0f60SJose Martins bool prv_u = env->priv == PRV_U; 474719f0f60SJose Martins bool prv_s = env->priv == PRV_S; 4750c3e702aSMichael Clark 476719f0f60SJose Martins if (((prv_s || (!rvs && prv_u)) && get_field(env->mstatus, MSTATUS_TW)) || 47738256529SWeiwei Li (rvs && prv_u && !env->virt_enabled)) { 478719f0f60SJose Martins riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 479c45eff30SWeiwei Li } else if (env->virt_enabled && 480c45eff30SWeiwei Li (prv_u || (prv_s && get_field(env->hstatus, HSTATUS_VTW)))) { 481e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 4827f2b5ff1SMichael Clark } else { 4830c3e702aSMichael Clark cs->halted = 1; 4840c3e702aSMichael Clark cs->exception_index = EXCP_HLT; 4850c3e702aSMichael Clark cpu_loop_exit(cs); 4860c3e702aSMichael Clark } 4877f2b5ff1SMichael Clark } 4880c3e702aSMichael Clark 489b62e0ce7SAndrew Jones void helper_wrs_nto(CPURISCVState *env) 490b62e0ce7SAndrew Jones { 491b62e0ce7SAndrew Jones if (env->virt_enabled && (env->priv == PRV_S || env->priv == PRV_U) && 492b62e0ce7SAndrew Jones get_field(env->hstatus, HSTATUS_VTW) && 493b62e0ce7SAndrew Jones !get_field(env->mstatus, MSTATUS_TW)) { 494b62e0ce7SAndrew Jones riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 495b62e0ce7SAndrew Jones } else if (env->priv != PRV_M && get_field(env->mstatus, MSTATUS_TW)) { 496b62e0ce7SAndrew Jones riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 497b62e0ce7SAndrew Jones } 498b62e0ce7SAndrew Jones } 499b62e0ce7SAndrew Jones 5000c3e702aSMichael Clark void helper_tlb_flush(CPURISCVState *env) 5010c3e702aSMichael Clark { 5023109cd98SRichard Henderson CPUState *cs = env_cpu(env); 503d6db7c97SYi Chen if (!env->virt_enabled && 504d6db7c97SYi Chen (env->priv == PRV_U || 505d6db7c97SYi Chen (env->priv == PRV_S && get_field(env->mstatus, MSTATUS_TVM)))) { 506fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 507d6db7c97SYi Chen } else if (env->virt_enabled && 508d6db7c97SYi Chen (env->priv == PRV_U || get_field(env->hstatus, HSTATUS_VTVM))) { 509e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 5107f2b5ff1SMichael Clark } else { 5110c3e702aSMichael Clark tlb_flush(cs); 5120c3e702aSMichael Clark } 5137f2b5ff1SMichael Clark } 5140c3e702aSMichael Clark 515134c3ffaSChristoph Müllner void helper_tlb_flush_all(CPURISCVState *env) 516134c3ffaSChristoph Müllner { 517134c3ffaSChristoph Müllner CPUState *cs = env_cpu(env); 518134c3ffaSChristoph Müllner tlb_flush_all_cpus_synced(cs); 519134c3ffaSChristoph Müllner } 520134c3ffaSChristoph Müllner 5212761db5fSAlistair Francis void helper_hyp_tlb_flush(CPURISCVState *env) 5222761db5fSAlistair Francis { 5232761db5fSAlistair Francis CPUState *cs = env_cpu(env); 5242761db5fSAlistair Francis 525d6db7c97SYi Chen if (env->virt_enabled) { 526e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 527e39a8320SAlistair Francis } 528e39a8320SAlistair Francis 5292761db5fSAlistair Francis if (env->priv == PRV_M || 53038256529SWeiwei Li (env->priv == PRV_S && !env->virt_enabled)) { 5312761db5fSAlistair Francis tlb_flush(cs); 5322761db5fSAlistair Francis return; 5332761db5fSAlistair Francis } 5342761db5fSAlistair Francis 5352761db5fSAlistair Francis riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 5362761db5fSAlistair Francis } 5372761db5fSAlistair Francis 538e39a8320SAlistair Francis void helper_hyp_gvma_tlb_flush(CPURISCVState *env) 539e39a8320SAlistair Francis { 54038256529SWeiwei Li if (env->priv == PRV_S && !env->virt_enabled && 541e39a8320SAlistair Francis get_field(env->mstatus, MSTATUS_TVM)) { 542e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 543e39a8320SAlistair Francis } 544e39a8320SAlistair Francis 545e39a8320SAlistair Francis helper_hyp_tlb_flush(env); 546e39a8320SAlistair Francis } 547e39a8320SAlistair Francis 5480f58cbbeSRichard Henderson static int check_access_hlsv(CPURISCVState *env, bool x, uintptr_t ra) 5490f58cbbeSRichard Henderson { 5500f58cbbeSRichard Henderson if (env->priv == PRV_M) { 5510f58cbbeSRichard Henderson /* always allowed */ 5520f58cbbeSRichard Henderson } else if (env->virt_enabled) { 5530f58cbbeSRichard Henderson riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, ra); 5540f58cbbeSRichard Henderson } else if (env->priv == PRV_U && !get_field(env->hstatus, HSTATUS_HU)) { 5550f58cbbeSRichard Henderson riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, ra); 5560f58cbbeSRichard Henderson } 5570f58cbbeSRichard Henderson 558eaecd473SRichard Henderson int mode = get_field(env->hstatus, HSTATUS_SPVP); 559eaecd473SRichard Henderson if (!x && mode == PRV_S && get_field(env->vsstatus, MSTATUS_SUM)) { 560eaecd473SRichard Henderson mode = MMUIdx_S_SUM; 561eaecd473SRichard Henderson } 562eaecd473SRichard Henderson return mode | MMU_2STAGE_BIT; 5630f58cbbeSRichard Henderson } 5640f58cbbeSRichard Henderson 5650f58cbbeSRichard Henderson target_ulong helper_hyp_hlv_bu(CPURISCVState *env, target_ulong addr) 5660f58cbbeSRichard Henderson { 5670f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 5680f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 5690f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_UB, mmu_idx); 5700f58cbbeSRichard Henderson 5714d160093SAlexey Baturo return cpu_ldb_mmu(env, adjust_addr_virt(env, addr), oi, ra); 5720f58cbbeSRichard Henderson } 5730f58cbbeSRichard Henderson 5740f58cbbeSRichard Henderson target_ulong helper_hyp_hlv_hu(CPURISCVState *env, target_ulong addr) 5750f58cbbeSRichard Henderson { 5760f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 5770f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 5780f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUW, mmu_idx); 5790f58cbbeSRichard Henderson 5804d160093SAlexey Baturo return cpu_ldw_mmu(env, adjust_addr_virt(env, addr), oi, ra); 5810f58cbbeSRichard Henderson } 5820f58cbbeSRichard Henderson 5830f58cbbeSRichard Henderson target_ulong helper_hyp_hlv_wu(CPURISCVState *env, target_ulong addr) 5840f58cbbeSRichard Henderson { 5850f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 5860f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 5870f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUL, mmu_idx); 5880f58cbbeSRichard Henderson 5894d160093SAlexey Baturo return cpu_ldl_mmu(env, adjust_addr_virt(env, addr), oi, ra); 5900f58cbbeSRichard Henderson } 5910f58cbbeSRichard Henderson 5920f58cbbeSRichard Henderson target_ulong helper_hyp_hlv_d(CPURISCVState *env, target_ulong addr) 5930f58cbbeSRichard Henderson { 5940f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 5950f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 5960f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUQ, mmu_idx); 5970f58cbbeSRichard Henderson 5984d160093SAlexey Baturo return cpu_ldq_mmu(env, adjust_addr_virt(env, addr), oi, ra); 5990f58cbbeSRichard Henderson } 6000f58cbbeSRichard Henderson 6010f58cbbeSRichard Henderson void helper_hyp_hsv_b(CPURISCVState *env, target_ulong addr, target_ulong val) 6020f58cbbeSRichard Henderson { 6030f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6040f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6050f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_UB, mmu_idx); 6060f58cbbeSRichard Henderson 6074d160093SAlexey Baturo cpu_stb_mmu(env, adjust_addr_virt(env, addr), val, oi, ra); 6080f58cbbeSRichard Henderson } 6090f58cbbeSRichard Henderson 6100f58cbbeSRichard Henderson void helper_hyp_hsv_h(CPURISCVState *env, target_ulong addr, target_ulong val) 6110f58cbbeSRichard Henderson { 6120f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6130f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6140f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUW, mmu_idx); 6150f58cbbeSRichard Henderson 6164d160093SAlexey Baturo cpu_stw_mmu(env, adjust_addr_virt(env, addr), val, oi, ra); 6170f58cbbeSRichard Henderson } 6180f58cbbeSRichard Henderson 6190f58cbbeSRichard Henderson void helper_hyp_hsv_w(CPURISCVState *env, target_ulong addr, target_ulong val) 6200f58cbbeSRichard Henderson { 6210f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6220f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6230f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUL, mmu_idx); 6240f58cbbeSRichard Henderson 6254d160093SAlexey Baturo cpu_stl_mmu(env, adjust_addr_virt(env, addr), val, oi, ra); 6260f58cbbeSRichard Henderson } 6270f58cbbeSRichard Henderson 6280f58cbbeSRichard Henderson void helper_hyp_hsv_d(CPURISCVState *env, target_ulong addr, target_ulong val) 6290f58cbbeSRichard Henderson { 6300f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6310f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6320f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUQ, mmu_idx); 6330f58cbbeSRichard Henderson 6344d160093SAlexey Baturo cpu_stq_mmu(env, adjust_addr_virt(env, addr), val, oi, ra); 6350f58cbbeSRichard Henderson } 6360f58cbbeSRichard Henderson 637a7f112c5SRichard Henderson /* 638a7f112c5SRichard Henderson * TODO: These implementations are not quite correct. They perform the 639a7f112c5SRichard Henderson * access using execute permission just fine, but the final PMP check 640a7f112c5SRichard Henderson * is supposed to have read permission as well. Without replicating 641a7f112c5SRichard Henderson * a fair fraction of cputlb.c, fixing this requires adding new mmu_idx 642a7f112c5SRichard Henderson * which would imply that exact check in tlb_fill. 643a7f112c5SRichard Henderson */ 6440f58cbbeSRichard Henderson target_ulong helper_hyp_hlvx_hu(CPURISCVState *env, target_ulong addr) 6458c5362acSAlistair Francis { 6460f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6470f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, true, ra); 648a7f112c5SRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUW, mmu_idx); 6498c5362acSAlistair Francis 6500f58cbbeSRichard Henderson return cpu_ldw_code_mmu(env, addr, oi, GETPC()); 6518c5362acSAlistair Francis } 6528c5362acSAlistair Francis 6530f58cbbeSRichard Henderson target_ulong helper_hyp_hlvx_wu(CPURISCVState *env, target_ulong addr) 6547687537aSAlistair Francis { 6550f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6560f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, true, ra); 657a7f112c5SRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUL, mmu_idx); 6588c5362acSAlistair Francis 6590f58cbbeSRichard Henderson return cpu_ldl_code_mmu(env, addr, oi, ra); 6608c5362acSAlistair Francis } 6618c5362acSAlistair Francis 6620c3e702aSMichael Clark #endif /* !CONFIG_USER_ONLY */ 663