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); 297*72d71d87SClément Léger 298*72d71d87SClément Léger if (riscv_cpu_cfg(env)->ext_ssdbltrp) { 299*72d71d87SClément Léger if (riscv_has_ext(env, RVH)) { 300*72d71d87SClément Léger target_ulong prev_vu = get_field(env->hstatus, HSTATUS_SPV) && 301*72d71d87SClément Léger prev_priv == PRV_U; 302*72d71d87SClément Léger /* Returning to VU from HS, vsstatus.sdt = 0 */ 303*72d71d87SClément Léger if (!env->virt_enabled && prev_vu) { 304*72d71d87SClément Léger env->vsstatus = set_field(env->vsstatus, MSTATUS_SDT, 0); 305*72d71d87SClément Léger } 306*72d71d87SClément Léger } 307*72d71d87SClément Léger mstatus = set_field(mstatus, MSTATUS_SDT, 0); 308*72d71d87SClément Léger } 3090ff430a5SBin Meng if (env->priv_ver >= PRIV_VERSION_1_12_0) { 3100ff430a5SBin Meng mstatus = set_field(mstatus, MSTATUS_MPRV, 0); 3110ff430a5SBin Meng } 3122bfec53bSBin Meng env->mstatus = mstatus; 313e3fba4baSAlistair Francis 31438256529SWeiwei Li if (riscv_has_ext(env, RVH) && !env->virt_enabled) { 315e3fba4baSAlistair Francis /* We support Hypervisor extensions and virtulisation is disabled */ 316e3fba4baSAlistair Francis target_ulong hstatus = env->hstatus; 317e3fba4baSAlistair Francis 318e3fba4baSAlistair Francis prev_virt = get_field(hstatus, HSTATUS_SPV); 319f2d5850fSAlistair Francis hstatus = set_field(hstatus, HSTATUS_SPV, 0); 320e3fba4baSAlistair Francis 321e3fba4baSAlistair Francis env->hstatus = hstatus; 322e3fba4baSAlistair Francis 323e3fba4baSAlistair Francis if (prev_virt) { 324e3fba4baSAlistair Francis riscv_cpu_swap_hypervisor_regs(env); 325e3fba4baSAlistair Francis } 326e3fba4baSAlistair Francis } 327e3fba4baSAlistair Francis 32868c05fb5SRajnesh Kanwal riscv_cpu_set_mode(env, prev_priv, prev_virt); 3290c3e702aSMichael Clark 33053309be1SDeepak Gupta /* 33153309be1SDeepak Gupta * If forward cfi enabled for new priv, restore elp status 33253309be1SDeepak Gupta * and clear spelp in mstatus 33353309be1SDeepak Gupta */ 33453309be1SDeepak Gupta if (cpu_get_fcfien(env)) { 33553309be1SDeepak Gupta env->elp = get_field(env->mstatus, MSTATUS_SPELP); 33653309be1SDeepak Gupta } 33753309be1SDeepak Gupta env->mstatus = set_field(env->mstatus, MSTATUS_SPELP, 0); 33853309be1SDeepak Gupta 3390c3e702aSMichael Clark return retpc; 3400c3e702aSMichael Clark } 3410c3e702aSMichael Clark 3423157a553STommy Wu static void check_ret_from_m_mode(CPURISCVState *env, target_ulong retpc, 3433157a553STommy Wu target_ulong prev_priv) 3440c3e702aSMichael Clark { 3450c3e702aSMichael Clark if (!(env->priv >= PRV_M)) { 346fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 3470c3e702aSMichael Clark } 3480c3e702aSMichael Clark 3490c3e702aSMichael Clark if (!riscv_has_ext(env, RVC) && (retpc & 0x3)) { 350fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_INST_ADDR_MIS, GETPC()); 3510c3e702aSMichael Clark } 3520c3e702aSMichael Clark 3533fe40ef5SDaniel Henrique Barboza if (riscv_cpu_cfg(env)->pmp && 3540fbb5d2dSNikita Shubin !pmp_get_num_rules(env) && (prev_priv != PRV_M)) { 3554c48aad1SBin Meng riscv_raise_exception(env, RISCV_EXCP_INST_ACCESS_FAULT, GETPC()); 356d102f19aSAtish Patra } 3573157a553STommy Wu } 358*72d71d87SClément Léger static target_ulong ssdbltrp_mxret(CPURISCVState *env, target_ulong mstatus, 359*72d71d87SClément Léger target_ulong prev_priv, 360*72d71d87SClément Léger target_ulong prev_virt) 361*72d71d87SClément Léger { 362*72d71d87SClément Léger /* If returning to U, VS or VU, sstatus.sdt = 0 */ 363*72d71d87SClément Léger if (prev_priv == PRV_U || (prev_virt && 364*72d71d87SClément Léger (prev_priv == PRV_S || prev_priv == PRV_U))) { 365*72d71d87SClément Léger mstatus = set_field(mstatus, MSTATUS_SDT, 0); 366*72d71d87SClément Léger /* If returning to VU, vsstatus.sdt = 0 */ 367*72d71d87SClément Léger if (prev_virt && prev_priv == PRV_U) { 368*72d71d87SClément Léger env->vsstatus = set_field(env->vsstatus, MSTATUS_SDT, 0); 369*72d71d87SClément Léger } 370*72d71d87SClément Léger } 371*72d71d87SClément Léger 372*72d71d87SClément Léger return mstatus; 373*72d71d87SClément Léger } 3743157a553STommy Wu 3753157a553STommy Wu target_ulong helper_mret(CPURISCVState *env) 3763157a553STommy Wu { 3773157a553STommy Wu target_ulong retpc = env->mepc; 3783157a553STommy Wu uint64_t mstatus = env->mstatus; 3793157a553STommy Wu target_ulong prev_priv = get_field(mstatus, MSTATUS_MPP); 3803157a553STommy Wu 3813157a553STommy Wu check_ret_from_m_mode(env, retpc, prev_priv); 382d102f19aSAtish Patra 383869d76f2SWeiwei Li target_ulong prev_virt = get_field(env->mstatus, MSTATUS_MPV) && 384869d76f2SWeiwei Li (prev_priv != PRV_M); 3851a9540d1SAlistair Francis mstatus = set_field(mstatus, MSTATUS_MIE, 3860c3e702aSMichael Clark get_field(mstatus, MSTATUS_MPIE)); 387a37f21c2SYiting Wang mstatus = set_field(mstatus, MSTATUS_MPIE, 1); 38804803c3dSWeiwei Li mstatus = set_field(mstatus, MSTATUS_MPP, 38904803c3dSWeiwei Li riscv_has_ext(env, RVU) ? PRV_U : PRV_M); 390e3fba4baSAlistair Francis mstatus = set_field(mstatus, MSTATUS_MPV, 0); 391*72d71d87SClément Léger if (riscv_cpu_cfg(env)->ext_ssdbltrp) { 392*72d71d87SClément Léger mstatus = ssdbltrp_mxret(env, mstatus, prev_priv, prev_virt); 393*72d71d87SClément Léger } 3940ff430a5SBin Meng if ((env->priv_ver >= PRIV_VERSION_1_12_0) && (prev_priv != PRV_M)) { 3950ff430a5SBin Meng mstatus = set_field(mstatus, MSTATUS_MPRV, 0); 3960ff430a5SBin Meng } 397c7b95171SMichael Clark env->mstatus = mstatus; 398e3fba4baSAlistair Francis 39968c05fb5SRajnesh Kanwal if (riscv_has_ext(env, RVH) && prev_virt) { 400e3fba4baSAlistair Francis riscv_cpu_swap_hypervisor_regs(env); 401e3fba4baSAlistair Francis } 402e3fba4baSAlistair Francis 40368c05fb5SRajnesh Kanwal riscv_cpu_set_mode(env, prev_priv, prev_virt); 40453309be1SDeepak Gupta /* 40553309be1SDeepak Gupta * If forward cfi enabled for new priv, restore elp status 40653309be1SDeepak Gupta * and clear mpelp in mstatus 40753309be1SDeepak Gupta */ 40853309be1SDeepak Gupta if (cpu_get_fcfien(env)) { 40953309be1SDeepak Gupta env->elp = get_field(env->mstatus, MSTATUS_MPELP); 41053309be1SDeepak Gupta } 41153309be1SDeepak Gupta env->mstatus = set_field(env->mstatus, MSTATUS_MPELP, 0); 4120c3e702aSMichael Clark 4130c3e702aSMichael Clark return retpc; 4140c3e702aSMichael Clark } 4150c3e702aSMichael Clark 4163157a553STommy Wu target_ulong helper_mnret(CPURISCVState *env) 4173157a553STommy Wu { 4183157a553STommy Wu target_ulong retpc = env->mnepc; 4193157a553STommy Wu target_ulong prev_priv = get_field(env->mnstatus, MNSTATUS_MNPP); 4203157a553STommy Wu target_ulong prev_virt; 4213157a553STommy Wu 4223157a553STommy Wu check_ret_from_m_mode(env, retpc, prev_priv); 4233157a553STommy Wu 4243157a553STommy Wu prev_virt = get_field(env->mnstatus, MNSTATUS_MNPV) && 4253157a553STommy Wu (prev_priv != PRV_M); 4263157a553STommy Wu env->mnstatus = set_field(env->mnstatus, MNSTATUS_NMIE, true); 4273157a553STommy Wu 4283157a553STommy Wu /* 4293157a553STommy Wu * If MNRET changes the privilege mode to a mode 4303157a553STommy Wu * less privileged than M, it also sets mstatus.MPRV to 0. 4313157a553STommy Wu */ 4323157a553STommy Wu if (prev_priv < PRV_M) { 4333157a553STommy Wu env->mstatus = set_field(env->mstatus, MSTATUS_MPRV, false); 4343157a553STommy Wu } 435*72d71d87SClément Léger if (riscv_cpu_cfg(env)->ext_ssdbltrp) { 436*72d71d87SClément Léger env->mstatus = ssdbltrp_mxret(env, env->mstatus, prev_priv, prev_virt); 437*72d71d87SClément Léger } 4383157a553STommy Wu 4393157a553STommy Wu if (riscv_has_ext(env, RVH) && prev_virt) { 4403157a553STommy Wu riscv_cpu_swap_hypervisor_regs(env); 4413157a553STommy Wu } 4423157a553STommy Wu 4433157a553STommy Wu riscv_cpu_set_mode(env, prev_priv, prev_virt); 4443157a553STommy Wu 4450266fd8bSFrank Chang /* 4460266fd8bSFrank Chang * If forward cfi enabled for new priv, restore elp status 4470266fd8bSFrank Chang * and clear mnpelp in mnstatus 4480266fd8bSFrank Chang */ 4490266fd8bSFrank Chang if (cpu_get_fcfien(env)) { 4500266fd8bSFrank Chang env->elp = get_field(env->mnstatus, MNSTATUS_MNPELP); 4510266fd8bSFrank Chang } 4520266fd8bSFrank Chang env->mnstatus = set_field(env->mnstatus, MNSTATUS_MNPELP, 0); 4530266fd8bSFrank Chang 4543157a553STommy Wu return retpc; 4553157a553STommy Wu } 4563157a553STommy Wu 4570c3e702aSMichael Clark void helper_wfi(CPURISCVState *env) 4580c3e702aSMichael Clark { 4593109cd98SRichard Henderson CPUState *cs = env_cpu(env); 460719f0f60SJose Martins bool rvs = riscv_has_ext(env, RVS); 461719f0f60SJose Martins bool prv_u = env->priv == PRV_U; 462719f0f60SJose Martins bool prv_s = env->priv == PRV_S; 4630c3e702aSMichael Clark 464719f0f60SJose Martins if (((prv_s || (!rvs && prv_u)) && get_field(env->mstatus, MSTATUS_TW)) || 46538256529SWeiwei Li (rvs && prv_u && !env->virt_enabled)) { 466719f0f60SJose Martins riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 467c45eff30SWeiwei Li } else if (env->virt_enabled && 468c45eff30SWeiwei Li (prv_u || (prv_s && get_field(env->hstatus, HSTATUS_VTW)))) { 469e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 4707f2b5ff1SMichael Clark } else { 4710c3e702aSMichael Clark cs->halted = 1; 4720c3e702aSMichael Clark cs->exception_index = EXCP_HLT; 4730c3e702aSMichael Clark cpu_loop_exit(cs); 4740c3e702aSMichael Clark } 4757f2b5ff1SMichael Clark } 4760c3e702aSMichael Clark 477b62e0ce7SAndrew Jones void helper_wrs_nto(CPURISCVState *env) 478b62e0ce7SAndrew Jones { 479b62e0ce7SAndrew Jones if (env->virt_enabled && (env->priv == PRV_S || env->priv == PRV_U) && 480b62e0ce7SAndrew Jones get_field(env->hstatus, HSTATUS_VTW) && 481b62e0ce7SAndrew Jones !get_field(env->mstatus, MSTATUS_TW)) { 482b62e0ce7SAndrew Jones riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 483b62e0ce7SAndrew Jones } else if (env->priv != PRV_M && get_field(env->mstatus, MSTATUS_TW)) { 484b62e0ce7SAndrew Jones riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 485b62e0ce7SAndrew Jones } 486b62e0ce7SAndrew Jones } 487b62e0ce7SAndrew Jones 4880c3e702aSMichael Clark void helper_tlb_flush(CPURISCVState *env) 4890c3e702aSMichael Clark { 4903109cd98SRichard Henderson CPUState *cs = env_cpu(env); 491d6db7c97SYi Chen if (!env->virt_enabled && 492d6db7c97SYi Chen (env->priv == PRV_U || 493d6db7c97SYi Chen (env->priv == PRV_S && get_field(env->mstatus, MSTATUS_TVM)))) { 494fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 495d6db7c97SYi Chen } else if (env->virt_enabled && 496d6db7c97SYi Chen (env->priv == PRV_U || get_field(env->hstatus, HSTATUS_VTVM))) { 497e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 4987f2b5ff1SMichael Clark } else { 4990c3e702aSMichael Clark tlb_flush(cs); 5000c3e702aSMichael Clark } 5017f2b5ff1SMichael Clark } 5020c3e702aSMichael Clark 503134c3ffaSChristoph Müllner void helper_tlb_flush_all(CPURISCVState *env) 504134c3ffaSChristoph Müllner { 505134c3ffaSChristoph Müllner CPUState *cs = env_cpu(env); 506134c3ffaSChristoph Müllner tlb_flush_all_cpus_synced(cs); 507134c3ffaSChristoph Müllner } 508134c3ffaSChristoph Müllner 5092761db5fSAlistair Francis void helper_hyp_tlb_flush(CPURISCVState *env) 5102761db5fSAlistair Francis { 5112761db5fSAlistair Francis CPUState *cs = env_cpu(env); 5122761db5fSAlistair Francis 513d6db7c97SYi Chen if (env->virt_enabled) { 514e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 515e39a8320SAlistair Francis } 516e39a8320SAlistair Francis 5172761db5fSAlistair Francis if (env->priv == PRV_M || 51838256529SWeiwei Li (env->priv == PRV_S && !env->virt_enabled)) { 5192761db5fSAlistair Francis tlb_flush(cs); 5202761db5fSAlistair Francis return; 5212761db5fSAlistair Francis } 5222761db5fSAlistair Francis 5232761db5fSAlistair Francis riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 5242761db5fSAlistair Francis } 5252761db5fSAlistair Francis 526e39a8320SAlistair Francis void helper_hyp_gvma_tlb_flush(CPURISCVState *env) 527e39a8320SAlistair Francis { 52838256529SWeiwei Li if (env->priv == PRV_S && !env->virt_enabled && 529e39a8320SAlistair Francis get_field(env->mstatus, MSTATUS_TVM)) { 530e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 531e39a8320SAlistair Francis } 532e39a8320SAlistair Francis 533e39a8320SAlistair Francis helper_hyp_tlb_flush(env); 534e39a8320SAlistair Francis } 535e39a8320SAlistair Francis 5360f58cbbeSRichard Henderson static int check_access_hlsv(CPURISCVState *env, bool x, uintptr_t ra) 5370f58cbbeSRichard Henderson { 5380f58cbbeSRichard Henderson if (env->priv == PRV_M) { 5390f58cbbeSRichard Henderson /* always allowed */ 5400f58cbbeSRichard Henderson } else if (env->virt_enabled) { 5410f58cbbeSRichard Henderson riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, ra); 5420f58cbbeSRichard Henderson } else if (env->priv == PRV_U && !get_field(env->hstatus, HSTATUS_HU)) { 5430f58cbbeSRichard Henderson riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, ra); 5440f58cbbeSRichard Henderson } 5450f58cbbeSRichard Henderson 546eaecd473SRichard Henderson int mode = get_field(env->hstatus, HSTATUS_SPVP); 547eaecd473SRichard Henderson if (!x && mode == PRV_S && get_field(env->vsstatus, MSTATUS_SUM)) { 548eaecd473SRichard Henderson mode = MMUIdx_S_SUM; 549eaecd473SRichard Henderson } 550eaecd473SRichard Henderson return mode | MMU_2STAGE_BIT; 5510f58cbbeSRichard Henderson } 5520f58cbbeSRichard Henderson 5530f58cbbeSRichard Henderson target_ulong helper_hyp_hlv_bu(CPURISCVState *env, target_ulong addr) 5540f58cbbeSRichard Henderson { 5550f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 5560f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 5570f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_UB, mmu_idx); 5580f58cbbeSRichard Henderson 5594d160093SAlexey Baturo return cpu_ldb_mmu(env, adjust_addr_virt(env, addr), oi, ra); 5600f58cbbeSRichard Henderson } 5610f58cbbeSRichard Henderson 5620f58cbbeSRichard Henderson target_ulong helper_hyp_hlv_hu(CPURISCVState *env, target_ulong addr) 5630f58cbbeSRichard Henderson { 5640f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 5650f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 5660f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUW, mmu_idx); 5670f58cbbeSRichard Henderson 5684d160093SAlexey Baturo return cpu_ldw_mmu(env, adjust_addr_virt(env, addr), oi, ra); 5690f58cbbeSRichard Henderson } 5700f58cbbeSRichard Henderson 5710f58cbbeSRichard Henderson target_ulong helper_hyp_hlv_wu(CPURISCVState *env, target_ulong addr) 5720f58cbbeSRichard Henderson { 5730f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 5740f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 5750f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUL, mmu_idx); 5760f58cbbeSRichard Henderson 5774d160093SAlexey Baturo return cpu_ldl_mmu(env, adjust_addr_virt(env, addr), oi, ra); 5780f58cbbeSRichard Henderson } 5790f58cbbeSRichard Henderson 5800f58cbbeSRichard Henderson target_ulong helper_hyp_hlv_d(CPURISCVState *env, target_ulong addr) 5810f58cbbeSRichard Henderson { 5820f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 5830f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 5840f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUQ, mmu_idx); 5850f58cbbeSRichard Henderson 5864d160093SAlexey Baturo return cpu_ldq_mmu(env, adjust_addr_virt(env, addr), oi, ra); 5870f58cbbeSRichard Henderson } 5880f58cbbeSRichard Henderson 5890f58cbbeSRichard Henderson void helper_hyp_hsv_b(CPURISCVState *env, target_ulong addr, target_ulong val) 5900f58cbbeSRichard Henderson { 5910f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 5920f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 5930f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_UB, mmu_idx); 5940f58cbbeSRichard Henderson 5954d160093SAlexey Baturo cpu_stb_mmu(env, adjust_addr_virt(env, addr), val, oi, ra); 5960f58cbbeSRichard Henderson } 5970f58cbbeSRichard Henderson 5980f58cbbeSRichard Henderson void helper_hyp_hsv_h(CPURISCVState *env, target_ulong addr, target_ulong val) 5990f58cbbeSRichard Henderson { 6000f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6010f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6020f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUW, mmu_idx); 6030f58cbbeSRichard Henderson 6044d160093SAlexey Baturo cpu_stw_mmu(env, adjust_addr_virt(env, addr), val, oi, ra); 6050f58cbbeSRichard Henderson } 6060f58cbbeSRichard Henderson 6070f58cbbeSRichard Henderson void helper_hyp_hsv_w(CPURISCVState *env, target_ulong addr, target_ulong val) 6080f58cbbeSRichard Henderson { 6090f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6100f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6110f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUL, mmu_idx); 6120f58cbbeSRichard Henderson 6134d160093SAlexey Baturo cpu_stl_mmu(env, adjust_addr_virt(env, addr), val, oi, ra); 6140f58cbbeSRichard Henderson } 6150f58cbbeSRichard Henderson 6160f58cbbeSRichard Henderson void helper_hyp_hsv_d(CPURISCVState *env, target_ulong addr, target_ulong val) 6170f58cbbeSRichard Henderson { 6180f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6190f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6200f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUQ, mmu_idx); 6210f58cbbeSRichard Henderson 6224d160093SAlexey Baturo cpu_stq_mmu(env, adjust_addr_virt(env, addr), val, oi, ra); 6230f58cbbeSRichard Henderson } 6240f58cbbeSRichard Henderson 625a7f112c5SRichard Henderson /* 626a7f112c5SRichard Henderson * TODO: These implementations are not quite correct. They perform the 627a7f112c5SRichard Henderson * access using execute permission just fine, but the final PMP check 628a7f112c5SRichard Henderson * is supposed to have read permission as well. Without replicating 629a7f112c5SRichard Henderson * a fair fraction of cputlb.c, fixing this requires adding new mmu_idx 630a7f112c5SRichard Henderson * which would imply that exact check in tlb_fill. 631a7f112c5SRichard Henderson */ 6320f58cbbeSRichard Henderson target_ulong helper_hyp_hlvx_hu(CPURISCVState *env, target_ulong addr) 6338c5362acSAlistair Francis { 6340f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6350f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, true, ra); 636a7f112c5SRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUW, mmu_idx); 6378c5362acSAlistair Francis 6380f58cbbeSRichard Henderson return cpu_ldw_code_mmu(env, addr, oi, GETPC()); 6398c5362acSAlistair Francis } 6408c5362acSAlistair Francis 6410f58cbbeSRichard Henderson target_ulong helper_hyp_hlvx_wu(CPURISCVState *env, target_ulong addr) 6427687537aSAlistair Francis { 6430f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6440f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, true, ra); 645a7f112c5SRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUL, mmu_idx); 6468c5362acSAlistair Francis 6470f58cbbeSRichard Henderson return cpu_ldl_code_mmu(env, addr, oi, ra); 6488c5362acSAlistair Francis } 6498c5362acSAlistair Francis 6500c3e702aSMichael Clark #endif /* !CONFIG_USER_ONLY */ 651