xref: /qemu/target/riscv/op_helper.c (revision 72d71d87327f47dc878683f4ff6a21472d5dcfdc)
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