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