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; 273*4ff7a27aSRajnesh Kanwal const target_ulong src_priv = env->priv; 274*4ff7a27aSRajnesh Kanwal const bool src_virt = env->virt_enabled; 275e3fba4baSAlistair Francis 2760c3e702aSMichael Clark if (!(env->priv >= PRV_S)) { 277fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 2780c3e702aSMichael Clark } 2790c3e702aSMichael Clark 2800c3e702aSMichael Clark target_ulong retpc = env->sepc; 2810c3e702aSMichael Clark if (!riscv_has_ext(env, RVC) && (retpc & 0x3)) { 282fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_INST_ADDR_MIS, GETPC()); 2830c3e702aSMichael Clark } 2840c3e702aSMichael Clark 2851a9540d1SAlistair Francis if (get_field(env->mstatus, MSTATUS_TSR) && !(env->priv >= PRV_M)) { 286fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 2877f2b5ff1SMichael Clark } 2887f2b5ff1SMichael Clark 28938256529SWeiwei Li if (env->virt_enabled && get_field(env->hstatus, HSTATUS_VTSR)) { 290e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 291e39a8320SAlistair Francis } 292e39a8320SAlistair Francis 293e3fba4baSAlistair Francis mstatus = env->mstatus; 2942bfec53bSBin Meng prev_priv = get_field(mstatus, MSTATUS_SPP); 2952bfec53bSBin Meng mstatus = set_field(mstatus, MSTATUS_SIE, 2962bfec53bSBin Meng get_field(mstatus, MSTATUS_SPIE)); 2972bfec53bSBin Meng mstatus = set_field(mstatus, MSTATUS_SPIE, 1); 2982bfec53bSBin Meng mstatus = set_field(mstatus, MSTATUS_SPP, PRV_U); 29972d71d87SClément Léger 30072d71d87SClément Léger if (riscv_cpu_cfg(env)->ext_ssdbltrp) { 30172d71d87SClément Léger if (riscv_has_ext(env, RVH)) { 30272d71d87SClément Léger target_ulong prev_vu = get_field(env->hstatus, HSTATUS_SPV) && 30372d71d87SClément Léger prev_priv == PRV_U; 30472d71d87SClément Léger /* Returning to VU from HS, vsstatus.sdt = 0 */ 30572d71d87SClément Léger if (!env->virt_enabled && prev_vu) { 30672d71d87SClément Léger env->vsstatus = set_field(env->vsstatus, MSTATUS_SDT, 0); 30772d71d87SClément Léger } 30872d71d87SClément Léger } 30972d71d87SClément Léger mstatus = set_field(mstatus, MSTATUS_SDT, 0); 31072d71d87SClément Léger } 311f2efb6e7SClément Léger if (riscv_cpu_cfg(env)->ext_smdbltrp && env->priv >= PRV_M) { 312f2efb6e7SClément Léger mstatus = set_field(mstatus, MSTATUS_MDT, 0); 313f2efb6e7SClément Léger } 3140ff430a5SBin Meng if (env->priv_ver >= PRIV_VERSION_1_12_0) { 3150ff430a5SBin Meng mstatus = set_field(mstatus, MSTATUS_MPRV, 0); 3160ff430a5SBin Meng } 3172bfec53bSBin Meng env->mstatus = mstatus; 318e3fba4baSAlistair Francis 31938256529SWeiwei Li if (riscv_has_ext(env, RVH) && !env->virt_enabled) { 320e3fba4baSAlistair Francis /* We support Hypervisor extensions and virtulisation is disabled */ 321e3fba4baSAlistair Francis target_ulong hstatus = env->hstatus; 322e3fba4baSAlistair Francis 323e3fba4baSAlistair Francis prev_virt = get_field(hstatus, HSTATUS_SPV); 324f2d5850fSAlistair Francis hstatus = set_field(hstatus, HSTATUS_SPV, 0); 325e3fba4baSAlistair Francis 326e3fba4baSAlistair Francis env->hstatus = hstatus; 327e3fba4baSAlistair Francis 328e3fba4baSAlistair Francis if (prev_virt) { 329e3fba4baSAlistair Francis riscv_cpu_swap_hypervisor_regs(env); 330e3fba4baSAlistair Francis } 331e3fba4baSAlistair Francis } 332e3fba4baSAlistair Francis 33368c05fb5SRajnesh Kanwal riscv_cpu_set_mode(env, prev_priv, prev_virt); 3340c3e702aSMichael Clark 33553309be1SDeepak Gupta /* 33653309be1SDeepak Gupta * If forward cfi enabled for new priv, restore elp status 33753309be1SDeepak Gupta * and clear spelp in mstatus 33853309be1SDeepak Gupta */ 33953309be1SDeepak Gupta if (cpu_get_fcfien(env)) { 34053309be1SDeepak Gupta env->elp = get_field(env->mstatus, MSTATUS_SPELP); 34153309be1SDeepak Gupta } 34253309be1SDeepak Gupta env->mstatus = set_field(env->mstatus, MSTATUS_SPELP, 0); 34353309be1SDeepak Gupta 344*4ff7a27aSRajnesh Kanwal if (riscv_cpu_cfg(env)->ext_smctr || riscv_cpu_cfg(env)->ext_ssctr) { 345*4ff7a27aSRajnesh Kanwal riscv_ctr_add_entry(env, env->pc, retpc, CTRDATA_TYPE_EXCEP_INT_RET, 346*4ff7a27aSRajnesh Kanwal src_priv, src_virt); 347*4ff7a27aSRajnesh Kanwal } 348*4ff7a27aSRajnesh Kanwal 3490c3e702aSMichael Clark return retpc; 3500c3e702aSMichael Clark } 3510c3e702aSMichael Clark 3523157a553STommy Wu static void check_ret_from_m_mode(CPURISCVState *env, target_ulong retpc, 3533157a553STommy Wu target_ulong prev_priv) 3540c3e702aSMichael Clark { 3550c3e702aSMichael Clark if (!(env->priv >= PRV_M)) { 356fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 3570c3e702aSMichael Clark } 3580c3e702aSMichael Clark 3590c3e702aSMichael Clark if (!riscv_has_ext(env, RVC) && (retpc & 0x3)) { 360fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_INST_ADDR_MIS, GETPC()); 3610c3e702aSMichael Clark } 3620c3e702aSMichael Clark 3633fe40ef5SDaniel Henrique Barboza if (riscv_cpu_cfg(env)->pmp && 3640fbb5d2dSNikita Shubin !pmp_get_num_rules(env) && (prev_priv != PRV_M)) { 3654c48aad1SBin Meng riscv_raise_exception(env, RISCV_EXCP_INST_ACCESS_FAULT, GETPC()); 366d102f19aSAtish Patra } 3673157a553STommy Wu } 36872d71d87SClément Léger static target_ulong ssdbltrp_mxret(CPURISCVState *env, target_ulong mstatus, 36972d71d87SClément Léger target_ulong prev_priv, 37072d71d87SClément Léger target_ulong prev_virt) 37172d71d87SClément Léger { 37272d71d87SClément Léger /* If returning to U, VS or VU, sstatus.sdt = 0 */ 37372d71d87SClément Léger if (prev_priv == PRV_U || (prev_virt && 37472d71d87SClément Léger (prev_priv == PRV_S || prev_priv == PRV_U))) { 37572d71d87SClément Léger mstatus = set_field(mstatus, MSTATUS_SDT, 0); 37672d71d87SClément Léger /* If returning to VU, vsstatus.sdt = 0 */ 37772d71d87SClément Léger if (prev_virt && prev_priv == PRV_U) { 37872d71d87SClément Léger env->vsstatus = set_field(env->vsstatus, MSTATUS_SDT, 0); 37972d71d87SClément Léger } 38072d71d87SClément Léger } 38172d71d87SClément Léger 38272d71d87SClément Léger return mstatus; 38372d71d87SClément Léger } 3843157a553STommy Wu 3853157a553STommy Wu target_ulong helper_mret(CPURISCVState *env) 3863157a553STommy Wu { 3873157a553STommy Wu target_ulong retpc = env->mepc; 3883157a553STommy Wu uint64_t mstatus = env->mstatus; 3893157a553STommy Wu target_ulong prev_priv = get_field(mstatus, MSTATUS_MPP); 3903157a553STommy Wu 3913157a553STommy Wu check_ret_from_m_mode(env, retpc, prev_priv); 392d102f19aSAtish Patra 393869d76f2SWeiwei Li target_ulong prev_virt = get_field(env->mstatus, MSTATUS_MPV) && 394869d76f2SWeiwei Li (prev_priv != PRV_M); 3951a9540d1SAlistair Francis mstatus = set_field(mstatus, MSTATUS_MIE, 3960c3e702aSMichael Clark get_field(mstatus, MSTATUS_MPIE)); 397a37f21c2SYiting Wang mstatus = set_field(mstatus, MSTATUS_MPIE, 1); 39804803c3dSWeiwei Li mstatus = set_field(mstatus, MSTATUS_MPP, 39904803c3dSWeiwei Li riscv_has_ext(env, RVU) ? PRV_U : PRV_M); 400e3fba4baSAlistair Francis mstatus = set_field(mstatus, MSTATUS_MPV, 0); 40172d71d87SClément Léger if (riscv_cpu_cfg(env)->ext_ssdbltrp) { 40272d71d87SClément Léger mstatus = ssdbltrp_mxret(env, mstatus, prev_priv, prev_virt); 40372d71d87SClément Léger } 404f2efb6e7SClément Léger if (riscv_cpu_cfg(env)->ext_smdbltrp) { 405f2efb6e7SClément Léger mstatus = set_field(mstatus, MSTATUS_MDT, 0); 406f2efb6e7SClément Léger } 4070ff430a5SBin Meng if ((env->priv_ver >= PRIV_VERSION_1_12_0) && (prev_priv != PRV_M)) { 4080ff430a5SBin Meng mstatus = set_field(mstatus, MSTATUS_MPRV, 0); 4090ff430a5SBin Meng } 410c7b95171SMichael Clark env->mstatus = mstatus; 411e3fba4baSAlistair Francis 41268c05fb5SRajnesh Kanwal if (riscv_has_ext(env, RVH) && prev_virt) { 413e3fba4baSAlistair Francis riscv_cpu_swap_hypervisor_regs(env); 414e3fba4baSAlistair Francis } 415e3fba4baSAlistair Francis 41668c05fb5SRajnesh Kanwal riscv_cpu_set_mode(env, prev_priv, prev_virt); 41753309be1SDeepak Gupta /* 41853309be1SDeepak Gupta * If forward cfi enabled for new priv, restore elp status 41953309be1SDeepak Gupta * and clear mpelp in mstatus 42053309be1SDeepak Gupta */ 42153309be1SDeepak Gupta if (cpu_get_fcfien(env)) { 42253309be1SDeepak Gupta env->elp = get_field(env->mstatus, MSTATUS_MPELP); 42353309be1SDeepak Gupta } 42453309be1SDeepak Gupta env->mstatus = set_field(env->mstatus, MSTATUS_MPELP, 0); 4250c3e702aSMichael Clark 426*4ff7a27aSRajnesh Kanwal if (riscv_cpu_cfg(env)->ext_smctr || riscv_cpu_cfg(env)->ext_ssctr) { 427*4ff7a27aSRajnesh Kanwal riscv_ctr_add_entry(env, env->pc, retpc, CTRDATA_TYPE_EXCEP_INT_RET, 428*4ff7a27aSRajnesh Kanwal PRV_M, false); 429*4ff7a27aSRajnesh Kanwal } 430*4ff7a27aSRajnesh Kanwal 4310c3e702aSMichael Clark return retpc; 4320c3e702aSMichael Clark } 4330c3e702aSMichael Clark 4343157a553STommy Wu target_ulong helper_mnret(CPURISCVState *env) 4353157a553STommy Wu { 4363157a553STommy Wu target_ulong retpc = env->mnepc; 4373157a553STommy Wu target_ulong prev_priv = get_field(env->mnstatus, MNSTATUS_MNPP); 4383157a553STommy Wu target_ulong prev_virt; 4393157a553STommy Wu 4403157a553STommy Wu check_ret_from_m_mode(env, retpc, prev_priv); 4413157a553STommy Wu 4423157a553STommy Wu prev_virt = get_field(env->mnstatus, MNSTATUS_MNPV) && 4433157a553STommy Wu (prev_priv != PRV_M); 4443157a553STommy Wu env->mnstatus = set_field(env->mnstatus, MNSTATUS_NMIE, true); 4453157a553STommy Wu 4463157a553STommy Wu /* 4473157a553STommy Wu * If MNRET changes the privilege mode to a mode 4483157a553STommy Wu * less privileged than M, it also sets mstatus.MPRV to 0. 4493157a553STommy Wu */ 4503157a553STommy Wu if (prev_priv < PRV_M) { 4513157a553STommy Wu env->mstatus = set_field(env->mstatus, MSTATUS_MPRV, false); 4523157a553STommy Wu } 45372d71d87SClément Léger if (riscv_cpu_cfg(env)->ext_ssdbltrp) { 45472d71d87SClément Léger env->mstatus = ssdbltrp_mxret(env, env->mstatus, prev_priv, prev_virt); 45572d71d87SClément Léger } 4563157a553STommy Wu 457f2efb6e7SClément Léger if (riscv_cpu_cfg(env)->ext_smdbltrp) { 458f2efb6e7SClément Léger if (prev_priv < PRV_M) { 459f2efb6e7SClément Léger env->mstatus = set_field(env->mstatus, MSTATUS_MDT, 0); 460f2efb6e7SClément Léger } 461f2efb6e7SClément Léger } 462f2efb6e7SClément Léger 4633157a553STommy Wu if (riscv_has_ext(env, RVH) && prev_virt) { 4643157a553STommy Wu riscv_cpu_swap_hypervisor_regs(env); 4653157a553STommy Wu } 4663157a553STommy Wu 4673157a553STommy Wu riscv_cpu_set_mode(env, prev_priv, prev_virt); 4683157a553STommy Wu 4690266fd8bSFrank Chang /* 4700266fd8bSFrank Chang * If forward cfi enabled for new priv, restore elp status 4710266fd8bSFrank Chang * and clear mnpelp in mnstatus 4720266fd8bSFrank Chang */ 4730266fd8bSFrank Chang if (cpu_get_fcfien(env)) { 4740266fd8bSFrank Chang env->elp = get_field(env->mnstatus, MNSTATUS_MNPELP); 4750266fd8bSFrank Chang } 4760266fd8bSFrank Chang env->mnstatus = set_field(env->mnstatus, MNSTATUS_MNPELP, 0); 4770266fd8bSFrank Chang 4783157a553STommy Wu return retpc; 4793157a553STommy Wu } 4803157a553STommy Wu 481*4ff7a27aSRajnesh Kanwal void helper_ctr_add_entry(CPURISCVState *env, target_ulong src, 482*4ff7a27aSRajnesh Kanwal target_ulong dest, target_ulong type) 483*4ff7a27aSRajnesh Kanwal { 484*4ff7a27aSRajnesh Kanwal riscv_ctr_add_entry(env, src, dest, (enum CTRType)type, 485*4ff7a27aSRajnesh Kanwal env->priv, env->virt_enabled); 486*4ff7a27aSRajnesh Kanwal } 487*4ff7a27aSRajnesh Kanwal 4880c3e702aSMichael Clark void helper_wfi(CPURISCVState *env) 4890c3e702aSMichael Clark { 4903109cd98SRichard Henderson CPUState *cs = env_cpu(env); 491719f0f60SJose Martins bool rvs = riscv_has_ext(env, RVS); 492719f0f60SJose Martins bool prv_u = env->priv == PRV_U; 493719f0f60SJose Martins bool prv_s = env->priv == PRV_S; 4940c3e702aSMichael Clark 495719f0f60SJose Martins if (((prv_s || (!rvs && prv_u)) && get_field(env->mstatus, MSTATUS_TW)) || 49638256529SWeiwei Li (rvs && prv_u && !env->virt_enabled)) { 497719f0f60SJose Martins riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 498c45eff30SWeiwei Li } else if (env->virt_enabled && 499c45eff30SWeiwei Li (prv_u || (prv_s && get_field(env->hstatus, HSTATUS_VTW)))) { 500e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 5017f2b5ff1SMichael Clark } else { 5020c3e702aSMichael Clark cs->halted = 1; 5030c3e702aSMichael Clark cs->exception_index = EXCP_HLT; 5040c3e702aSMichael Clark cpu_loop_exit(cs); 5050c3e702aSMichael Clark } 5067f2b5ff1SMichael Clark } 5070c3e702aSMichael Clark 508b62e0ce7SAndrew Jones void helper_wrs_nto(CPURISCVState *env) 509b62e0ce7SAndrew Jones { 510b62e0ce7SAndrew Jones if (env->virt_enabled && (env->priv == PRV_S || env->priv == PRV_U) && 511b62e0ce7SAndrew Jones get_field(env->hstatus, HSTATUS_VTW) && 512b62e0ce7SAndrew Jones !get_field(env->mstatus, MSTATUS_TW)) { 513b62e0ce7SAndrew Jones riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 514b62e0ce7SAndrew Jones } else if (env->priv != PRV_M && get_field(env->mstatus, MSTATUS_TW)) { 515b62e0ce7SAndrew Jones riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 516b62e0ce7SAndrew Jones } 517b62e0ce7SAndrew Jones } 518b62e0ce7SAndrew Jones 5190c3e702aSMichael Clark void helper_tlb_flush(CPURISCVState *env) 5200c3e702aSMichael Clark { 5213109cd98SRichard Henderson CPUState *cs = env_cpu(env); 522d6db7c97SYi Chen if (!env->virt_enabled && 523d6db7c97SYi Chen (env->priv == PRV_U || 524d6db7c97SYi Chen (env->priv == PRV_S && get_field(env->mstatus, MSTATUS_TVM)))) { 525fb738839SMichael Clark riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 526d6db7c97SYi Chen } else if (env->virt_enabled && 527d6db7c97SYi Chen (env->priv == PRV_U || get_field(env->hstatus, HSTATUS_VTVM))) { 528e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 5297f2b5ff1SMichael Clark } else { 5300c3e702aSMichael Clark tlb_flush(cs); 5310c3e702aSMichael Clark } 5327f2b5ff1SMichael Clark } 5330c3e702aSMichael Clark 534134c3ffaSChristoph Müllner void helper_tlb_flush_all(CPURISCVState *env) 535134c3ffaSChristoph Müllner { 536134c3ffaSChristoph Müllner CPUState *cs = env_cpu(env); 537134c3ffaSChristoph Müllner tlb_flush_all_cpus_synced(cs); 538134c3ffaSChristoph Müllner } 539134c3ffaSChristoph Müllner 5402761db5fSAlistair Francis void helper_hyp_tlb_flush(CPURISCVState *env) 5412761db5fSAlistair Francis { 5422761db5fSAlistair Francis CPUState *cs = env_cpu(env); 5432761db5fSAlistair Francis 544d6db7c97SYi Chen if (env->virt_enabled) { 545e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC()); 546e39a8320SAlistair Francis } 547e39a8320SAlistair Francis 5482761db5fSAlistair Francis if (env->priv == PRV_M || 54938256529SWeiwei Li (env->priv == PRV_S && !env->virt_enabled)) { 5502761db5fSAlistair Francis tlb_flush(cs); 5512761db5fSAlistair Francis return; 5522761db5fSAlistair Francis } 5532761db5fSAlistair Francis 5542761db5fSAlistair Francis riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 5552761db5fSAlistair Francis } 5562761db5fSAlistair Francis 557e39a8320SAlistair Francis void helper_hyp_gvma_tlb_flush(CPURISCVState *env) 558e39a8320SAlistair Francis { 55938256529SWeiwei Li if (env->priv == PRV_S && !env->virt_enabled && 560e39a8320SAlistair Francis get_field(env->mstatus, MSTATUS_TVM)) { 561e39a8320SAlistair Francis riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC()); 562e39a8320SAlistair Francis } 563e39a8320SAlistair Francis 564e39a8320SAlistair Francis helper_hyp_tlb_flush(env); 565e39a8320SAlistair Francis } 566e39a8320SAlistair Francis 5670f58cbbeSRichard Henderson static int check_access_hlsv(CPURISCVState *env, bool x, uintptr_t ra) 5680f58cbbeSRichard Henderson { 5690f58cbbeSRichard Henderson if (env->priv == PRV_M) { 5700f58cbbeSRichard Henderson /* always allowed */ 5710f58cbbeSRichard Henderson } else if (env->virt_enabled) { 5720f58cbbeSRichard Henderson riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, ra); 5730f58cbbeSRichard Henderson } else if (env->priv == PRV_U && !get_field(env->hstatus, HSTATUS_HU)) { 5740f58cbbeSRichard Henderson riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, ra); 5750f58cbbeSRichard Henderson } 5760f58cbbeSRichard Henderson 577eaecd473SRichard Henderson int mode = get_field(env->hstatus, HSTATUS_SPVP); 578eaecd473SRichard Henderson if (!x && mode == PRV_S && get_field(env->vsstatus, MSTATUS_SUM)) { 579eaecd473SRichard Henderson mode = MMUIdx_S_SUM; 580eaecd473SRichard Henderson } 581eaecd473SRichard Henderson return mode | MMU_2STAGE_BIT; 5820f58cbbeSRichard Henderson } 5830f58cbbeSRichard Henderson 5840f58cbbeSRichard Henderson target_ulong helper_hyp_hlv_bu(CPURISCVState *env, target_ulong addr) 5850f58cbbeSRichard Henderson { 5860f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 5870f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 5880f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_UB, mmu_idx); 5890f58cbbeSRichard Henderson 5904d160093SAlexey Baturo return cpu_ldb_mmu(env, adjust_addr_virt(env, addr), oi, ra); 5910f58cbbeSRichard Henderson } 5920f58cbbeSRichard Henderson 5930f58cbbeSRichard Henderson target_ulong helper_hyp_hlv_hu(CPURISCVState *env, target_ulong addr) 5940f58cbbeSRichard Henderson { 5950f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 5960f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 5970f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUW, mmu_idx); 5980f58cbbeSRichard Henderson 5994d160093SAlexey Baturo return cpu_ldw_mmu(env, adjust_addr_virt(env, addr), oi, ra); 6000f58cbbeSRichard Henderson } 6010f58cbbeSRichard Henderson 6020f58cbbeSRichard Henderson target_ulong helper_hyp_hlv_wu(CPURISCVState *env, target_ulong addr) 6030f58cbbeSRichard Henderson { 6040f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6050f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6060f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUL, mmu_idx); 6070f58cbbeSRichard Henderson 6084d160093SAlexey Baturo return cpu_ldl_mmu(env, adjust_addr_virt(env, addr), oi, ra); 6090f58cbbeSRichard Henderson } 6100f58cbbeSRichard Henderson 6110f58cbbeSRichard Henderson target_ulong helper_hyp_hlv_d(CPURISCVState *env, target_ulong addr) 6120f58cbbeSRichard Henderson { 6130f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6140f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6150f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUQ, mmu_idx); 6160f58cbbeSRichard Henderson 6174d160093SAlexey Baturo return cpu_ldq_mmu(env, adjust_addr_virt(env, addr), oi, ra); 6180f58cbbeSRichard Henderson } 6190f58cbbeSRichard Henderson 6200f58cbbeSRichard Henderson void helper_hyp_hsv_b(CPURISCVState *env, target_ulong addr, target_ulong val) 6210f58cbbeSRichard Henderson { 6220f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6230f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6240f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_UB, mmu_idx); 6250f58cbbeSRichard Henderson 6264d160093SAlexey Baturo cpu_stb_mmu(env, adjust_addr_virt(env, addr), val, oi, ra); 6270f58cbbeSRichard Henderson } 6280f58cbbeSRichard Henderson 6290f58cbbeSRichard Henderson void helper_hyp_hsv_h(CPURISCVState *env, target_ulong addr, target_ulong val) 6300f58cbbeSRichard Henderson { 6310f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6320f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6330f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUW, mmu_idx); 6340f58cbbeSRichard Henderson 6354d160093SAlexey Baturo cpu_stw_mmu(env, adjust_addr_virt(env, addr), val, oi, ra); 6360f58cbbeSRichard Henderson } 6370f58cbbeSRichard Henderson 6380f58cbbeSRichard Henderson void helper_hyp_hsv_w(CPURISCVState *env, target_ulong addr, target_ulong val) 6390f58cbbeSRichard Henderson { 6400f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6410f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6420f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUL, mmu_idx); 6430f58cbbeSRichard Henderson 6444d160093SAlexey Baturo cpu_stl_mmu(env, adjust_addr_virt(env, addr), val, oi, ra); 6450f58cbbeSRichard Henderson } 6460f58cbbeSRichard Henderson 6470f58cbbeSRichard Henderson void helper_hyp_hsv_d(CPURISCVState *env, target_ulong addr, target_ulong val) 6480f58cbbeSRichard Henderson { 6490f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6500f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, false, ra); 6510f58cbbeSRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUQ, mmu_idx); 6520f58cbbeSRichard Henderson 6534d160093SAlexey Baturo cpu_stq_mmu(env, adjust_addr_virt(env, addr), val, oi, ra); 6540f58cbbeSRichard Henderson } 6550f58cbbeSRichard Henderson 656a7f112c5SRichard Henderson /* 657a7f112c5SRichard Henderson * TODO: These implementations are not quite correct. They perform the 658a7f112c5SRichard Henderson * access using execute permission just fine, but the final PMP check 659a7f112c5SRichard Henderson * is supposed to have read permission as well. Without replicating 660a7f112c5SRichard Henderson * a fair fraction of cputlb.c, fixing this requires adding new mmu_idx 661a7f112c5SRichard Henderson * which would imply that exact check in tlb_fill. 662a7f112c5SRichard Henderson */ 6630f58cbbeSRichard Henderson target_ulong helper_hyp_hlvx_hu(CPURISCVState *env, target_ulong addr) 6648c5362acSAlistair Francis { 6650f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6660f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, true, ra); 667a7f112c5SRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUW, mmu_idx); 6688c5362acSAlistair Francis 6690f58cbbeSRichard Henderson return cpu_ldw_code_mmu(env, addr, oi, GETPC()); 6708c5362acSAlistair Francis } 6718c5362acSAlistair Francis 6720f58cbbeSRichard Henderson target_ulong helper_hyp_hlvx_wu(CPURISCVState *env, target_ulong addr) 6737687537aSAlistair Francis { 6740f58cbbeSRichard Henderson uintptr_t ra = GETPC(); 6750f58cbbeSRichard Henderson int mmu_idx = check_access_hlsv(env, true, ra); 676a7f112c5SRichard Henderson MemOpIdx oi = make_memop_idx(MO_TEUL, mmu_idx); 6778c5362acSAlistair Francis 6780f58cbbeSRichard Henderson return cpu_ldl_code_mmu(env, addr, oi, ra); 6798c5362acSAlistair Francis } 6808c5362acSAlistair Francis 6810c3e702aSMichael Clark #endif /* !CONFIG_USER_ONLY */ 682