xref: /qemu/target/riscv/op_helper.c (revision a7f112c5fd1ac22732e523c8e933728fca681a0a)
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 "qemu/main-loop.h"
250c3e702aSMichael Clark #include "exec/exec-all.h"
260c3e702aSMichael Clark #include "exec/helper-proto.h"
270c3e702aSMichael Clark 
280c3e702aSMichael Clark /* Exceptions processing helpers */
298905770bSMarc-André Lureau G_NORETURN void riscv_raise_exception(CPURISCVState *env,
300c3e702aSMichael Clark                                       uint32_t exception, uintptr_t pc)
310c3e702aSMichael Clark {
323109cd98SRichard Henderson     CPUState *cs = env_cpu(env);
330c3e702aSMichael Clark     cs->exception_index = exception;
340c3e702aSMichael Clark     cpu_loop_exit_restore(cs, pc);
350c3e702aSMichael Clark }
360c3e702aSMichael Clark 
370c3e702aSMichael Clark void helper_raise_exception(CPURISCVState *env, uint32_t exception)
380c3e702aSMichael Clark {
39fb738839SMichael Clark     riscv_raise_exception(env, exception, 0);
400c3e702aSMichael Clark }
410c3e702aSMichael Clark 
42a974879bSRichard Henderson target_ulong helper_csrr(CPURISCVState *env, int csr)
430c3e702aSMichael Clark {
4477442380SWeiwei Li     /*
4577442380SWeiwei Li      * The seed CSR must be accessed with a read-write instruction. A
4677442380SWeiwei Li      * read-only instruction such as CSRRS/CSRRC with rs1=x0 or CSRRSI/
4777442380SWeiwei Li      * CSRRCI with uimm=0 will raise an illegal instruction exception.
4877442380SWeiwei Li      */
4977442380SWeiwei Li     if (csr == CSR_SEED) {
5077442380SWeiwei Li         riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC());
5177442380SWeiwei Li     }
5277442380SWeiwei Li 
53c7b95171SMichael Clark     target_ulong val = 0;
54a974879bSRichard Henderson     RISCVException ret = riscv_csrrw(env, csr, &val, 0, 0);
5557cb2083SAlistair Francis 
56533c91e8SAlistair Francis     if (ret != RISCV_EXCP_NONE) {
57533c91e8SAlistair Francis         riscv_raise_exception(env, ret, GETPC());
58c7b95171SMichael Clark     }
59c7b95171SMichael Clark     return val;
600c3e702aSMichael Clark }
610c3e702aSMichael Clark 
62a974879bSRichard Henderson void helper_csrw(CPURISCVState *env, int csr, target_ulong src)
630c3e702aSMichael Clark {
6483b519b8SLIU Zhiwei     target_ulong mask = env->xl == MXL_RV32 ? UINT32_MAX : (target_ulong)-1;
6583b519b8SLIU Zhiwei     RISCVException ret = riscv_csrrw(env, csr, NULL, src, mask);
6657cb2083SAlistair Francis 
67533c91e8SAlistair Francis     if (ret != RISCV_EXCP_NONE) {
68533c91e8SAlistair Francis         riscv_raise_exception(env, ret, GETPC());
690c3e702aSMichael Clark     }
700c3e702aSMichael Clark }
710c3e702aSMichael Clark 
72a974879bSRichard Henderson target_ulong helper_csrrw(CPURISCVState *env, int csr,
73a974879bSRichard Henderson                           target_ulong src, target_ulong write_mask)
740c3e702aSMichael Clark {
75c7b95171SMichael Clark     target_ulong val = 0;
76a974879bSRichard Henderson     RISCVException ret = riscv_csrrw(env, csr, &val, src, write_mask);
7757cb2083SAlistair Francis 
78533c91e8SAlistair Francis     if (ret != RISCV_EXCP_NONE) {
79533c91e8SAlistair Francis         riscv_raise_exception(env, ret, GETPC());
800c3e702aSMichael Clark     }
81c7b95171SMichael Clark     return val;
820c3e702aSMichael Clark }
830c3e702aSMichael Clark 
84961738ffSFrédéric Pétrot target_ulong helper_csrr_i128(CPURISCVState *env, int csr)
85961738ffSFrédéric Pétrot {
86961738ffSFrédéric Pétrot     Int128 rv = int128_zero();
87961738ffSFrédéric Pétrot     RISCVException ret = riscv_csrrw_i128(env, csr, &rv,
88961738ffSFrédéric Pétrot                                           int128_zero(),
89961738ffSFrédéric Pétrot                                           int128_zero());
90961738ffSFrédéric Pétrot 
91961738ffSFrédéric Pétrot     if (ret != RISCV_EXCP_NONE) {
92961738ffSFrédéric Pétrot         riscv_raise_exception(env, ret, GETPC());
93961738ffSFrédéric Pétrot     }
94961738ffSFrédéric Pétrot 
95961738ffSFrédéric Pétrot     env->retxh = int128_gethi(rv);
96961738ffSFrédéric Pétrot     return int128_getlo(rv);
97961738ffSFrédéric Pétrot }
98961738ffSFrédéric Pétrot 
99961738ffSFrédéric Pétrot void helper_csrw_i128(CPURISCVState *env, int csr,
100961738ffSFrédéric Pétrot                       target_ulong srcl, target_ulong srch)
101961738ffSFrédéric Pétrot {
102961738ffSFrédéric Pétrot     RISCVException ret = riscv_csrrw_i128(env, csr, NULL,
103961738ffSFrédéric Pétrot                                           int128_make128(srcl, srch),
104961738ffSFrédéric Pétrot                                           UINT128_MAX);
105961738ffSFrédéric Pétrot 
106961738ffSFrédéric Pétrot     if (ret != RISCV_EXCP_NONE) {
107961738ffSFrédéric Pétrot         riscv_raise_exception(env, ret, GETPC());
108961738ffSFrédéric Pétrot     }
109961738ffSFrédéric Pétrot }
110961738ffSFrédéric Pétrot 
111961738ffSFrédéric Pétrot target_ulong helper_csrrw_i128(CPURISCVState *env, int csr,
112961738ffSFrédéric Pétrot                        target_ulong srcl, target_ulong srch,
113961738ffSFrédéric Pétrot                        target_ulong maskl, target_ulong maskh)
114961738ffSFrédéric Pétrot {
115961738ffSFrédéric Pétrot     Int128 rv = int128_zero();
116961738ffSFrédéric Pétrot     RISCVException ret = riscv_csrrw_i128(env, csr, &rv,
117961738ffSFrédéric Pétrot                                           int128_make128(srcl, srch),
118961738ffSFrédéric Pétrot                                           int128_make128(maskl, maskh));
119961738ffSFrédéric Pétrot 
120961738ffSFrédéric Pétrot     if (ret != RISCV_EXCP_NONE) {
121961738ffSFrédéric Pétrot         riscv_raise_exception(env, ret, GETPC());
122961738ffSFrédéric Pétrot     }
123961738ffSFrédéric Pétrot 
124961738ffSFrédéric Pétrot     env->retxh = int128_gethi(rv);
125961738ffSFrédéric Pétrot     return int128_getlo(rv);
126961738ffSFrédéric Pétrot }
127961738ffSFrédéric Pétrot 
128a939c500SChristoph Muellner 
129a939c500SChristoph Muellner /*
130a939c500SChristoph Muellner  * check_zicbo_envcfg
131a939c500SChristoph Muellner  *
132a939c500SChristoph Muellner  * Raise virtual exceptions and illegal instruction exceptions for
133a939c500SChristoph Muellner  * Zicbo[mz] instructions based on the settings of [mhs]envcfg as
134a939c500SChristoph Muellner  * specified in section 2.5.1 of the CMO specification.
135a939c500SChristoph Muellner  */
136a939c500SChristoph Muellner static void check_zicbo_envcfg(CPURISCVState *env, target_ulong envbits,
137a939c500SChristoph Muellner                                 uintptr_t ra)
138a939c500SChristoph Muellner {
139a939c500SChristoph Muellner #ifndef CONFIG_USER_ONLY
140a939c500SChristoph Muellner     if ((env->priv < PRV_M) && !get_field(env->menvcfg, envbits)) {
141a939c500SChristoph Muellner         riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, ra);
142a939c500SChristoph Muellner     }
143a939c500SChristoph Muellner 
14438256529SWeiwei Li     if (env->virt_enabled &&
14544b8f74bSWeiwei Li         (((env->priv <= PRV_S) && !get_field(env->henvcfg, envbits)) ||
146a939c500SChristoph Muellner          ((env->priv < PRV_S) && !get_field(env->senvcfg, envbits)))) {
147a939c500SChristoph Muellner         riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, ra);
148a939c500SChristoph Muellner     }
149a939c500SChristoph Muellner 
150a939c500SChristoph Muellner     if ((env->priv < PRV_S) && !get_field(env->senvcfg, envbits)) {
151a939c500SChristoph Muellner         riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, ra);
152a939c500SChristoph Muellner     }
153a939c500SChristoph Muellner #endif
154a939c500SChristoph Muellner }
155a939c500SChristoph Muellner 
156a939c500SChristoph Muellner void helper_cbo_zero(CPURISCVState *env, target_ulong address)
157a939c500SChristoph Muellner {
158a939c500SChristoph Muellner     RISCVCPU *cpu = env_archcpu(env);
159a939c500SChristoph Muellner     uint16_t cbozlen = cpu->cfg.cboz_blocksize;
160a939c500SChristoph Muellner     int mmu_idx = cpu_mmu_index(env, false);
161a939c500SChristoph Muellner     uintptr_t ra = GETPC();
162a939c500SChristoph Muellner     void *mem;
163a939c500SChristoph Muellner 
164a939c500SChristoph Muellner     check_zicbo_envcfg(env, MENVCFG_CBZE, ra);
165a939c500SChristoph Muellner 
166a939c500SChristoph Muellner     /* Mask off low-bits to align-down to the cache-block. */
167a939c500SChristoph Muellner     address &= ~(cbozlen - 1);
168a939c500SChristoph Muellner 
169a939c500SChristoph Muellner     /*
170a939c500SChristoph Muellner      * cbo.zero requires MMU_DATA_STORE access. Do a probe_write()
171a939c500SChristoph Muellner      * to raise any exceptions, including PMP.
172a939c500SChristoph Muellner      */
173a939c500SChristoph Muellner     mem = probe_write(env, address, cbozlen, mmu_idx, ra);
174a939c500SChristoph Muellner 
175a939c500SChristoph Muellner     if (likely(mem)) {
176a939c500SChristoph Muellner         memset(mem, 0, cbozlen);
177a939c500SChristoph Muellner     } else {
178a939c500SChristoph Muellner         /*
179a939c500SChristoph Muellner          * This means that we're dealing with an I/O page. Section 4.2
180a939c500SChristoph Muellner          * of cmobase v1.0.1 says:
181a939c500SChristoph Muellner          *
182a939c500SChristoph Muellner          * "Cache-block zero instructions store zeros independently
183a939c500SChristoph Muellner          * of whether data from the underlying memory locations are
184a939c500SChristoph Muellner          * cacheable."
185a939c500SChristoph Muellner          *
186a939c500SChristoph Muellner          * Write zeros in address + cbozlen regardless of not being
187a939c500SChristoph Muellner          * a RAM page.
188a939c500SChristoph Muellner          */
189a939c500SChristoph Muellner         for (int i = 0; i < cbozlen; i++) {
190a939c500SChristoph Muellner             cpu_stb_mmuidx_ra(env, address + i, 0, mmu_idx, ra);
191a939c500SChristoph Muellner         }
192a939c500SChristoph Muellner     }
193a939c500SChristoph Muellner }
194a939c500SChristoph Muellner 
195e05da09bSChristoph Muellner /*
196e05da09bSChristoph Muellner  * check_zicbom_access
197e05da09bSChristoph Muellner  *
198e05da09bSChristoph Muellner  * Check access permissions (LOAD, STORE or FETCH as specified in
199e05da09bSChristoph Muellner  * section 2.5.2 of the CMO specification) for Zicbom, raising
200e05da09bSChristoph Muellner  * either store page-fault (non-virtualized) or store guest-page
201e05da09bSChristoph Muellner  * fault (virtualized).
202e05da09bSChristoph Muellner  */
203e05da09bSChristoph Muellner static void check_zicbom_access(CPURISCVState *env,
204e05da09bSChristoph Muellner                                 target_ulong address,
205e05da09bSChristoph Muellner                                 uintptr_t ra)
206e05da09bSChristoph Muellner {
207e05da09bSChristoph Muellner     RISCVCPU *cpu = env_archcpu(env);
208e05da09bSChristoph Muellner     int mmu_idx = cpu_mmu_index(env, false);
209e05da09bSChristoph Muellner     uint16_t cbomlen = cpu->cfg.cbom_blocksize;
210e05da09bSChristoph Muellner     void *phost;
211e05da09bSChristoph Muellner     int ret;
212e05da09bSChristoph Muellner 
213e05da09bSChristoph Muellner     /* Mask off low-bits to align-down to the cache-block. */
214e05da09bSChristoph Muellner     address &= ~(cbomlen - 1);
215e05da09bSChristoph Muellner 
216e05da09bSChristoph Muellner     /*
217e05da09bSChristoph Muellner      * Section 2.5.2 of cmobase v1.0.1:
218e05da09bSChristoph Muellner      *
219e05da09bSChristoph Muellner      * "A cache-block management instruction is permitted to
220e05da09bSChristoph Muellner      * access the specified cache block whenever a load instruction
221e05da09bSChristoph Muellner      * or store instruction is permitted to access the corresponding
222e05da09bSChristoph Muellner      * physical addresses. If neither a load instruction nor store
223e05da09bSChristoph Muellner      * instruction is permitted to access the physical addresses,
224e05da09bSChristoph Muellner      * but an instruction fetch is permitted to access the physical
225e05da09bSChristoph Muellner      * addresses, whether a cache-block management instruction is
226e05da09bSChristoph Muellner      * permitted to access the cache block is UNSPECIFIED."
227e05da09bSChristoph Muellner      */
228e05da09bSChristoph Muellner     ret = probe_access_flags(env, address, cbomlen, MMU_DATA_LOAD,
229e05da09bSChristoph Muellner                              mmu_idx, true, &phost, ra);
230e05da09bSChristoph Muellner     if (ret != TLB_INVALID_MASK) {
231e05da09bSChristoph Muellner         /* Success: readable */
232e05da09bSChristoph Muellner         return;
233e05da09bSChristoph Muellner     }
234e05da09bSChristoph Muellner 
235e05da09bSChristoph Muellner     /*
236e05da09bSChristoph Muellner      * Since not readable, must be writable. On failure, store
237e05da09bSChristoph Muellner      * fault/store guest amo fault will be raised by
238e05da09bSChristoph Muellner      * riscv_cpu_tlb_fill(). PMP exceptions will be caught
239e05da09bSChristoph Muellner      * there as well.
240e05da09bSChristoph Muellner      */
241e05da09bSChristoph Muellner     probe_write(env, address, cbomlen, mmu_idx, ra);
242e05da09bSChristoph Muellner }
243e05da09bSChristoph Muellner 
244e05da09bSChristoph Muellner void helper_cbo_clean_flush(CPURISCVState *env, target_ulong address)
245e05da09bSChristoph Muellner {
246e05da09bSChristoph Muellner     uintptr_t ra = GETPC();
247e05da09bSChristoph Muellner     check_zicbo_envcfg(env, MENVCFG_CBCFE, ra);
248e05da09bSChristoph Muellner     check_zicbom_access(env, address, ra);
249e05da09bSChristoph Muellner 
250e05da09bSChristoph Muellner     /* We don't emulate the cache-hierarchy, so we're done. */
251e05da09bSChristoph Muellner }
252e05da09bSChristoph Muellner 
253e05da09bSChristoph Muellner void helper_cbo_inval(CPURISCVState *env, target_ulong address)
254e05da09bSChristoph Muellner {
255e05da09bSChristoph Muellner     uintptr_t ra = GETPC();
256e05da09bSChristoph Muellner     check_zicbo_envcfg(env, MENVCFG_CBIE, ra);
257e05da09bSChristoph Muellner     check_zicbom_access(env, address, ra);
258e05da09bSChristoph Muellner 
259e05da09bSChristoph Muellner     /* We don't emulate the cache-hierarchy, so we're done. */
260e05da09bSChristoph Muellner }
261e05da09bSChristoph Muellner 
2620c3e702aSMichael Clark #ifndef CONFIG_USER_ONLY
2630c3e702aSMichael Clark 
264b655dc7cSLIU Zhiwei target_ulong helper_sret(CPURISCVState *env)
2650c3e702aSMichael Clark {
266284d697cSYifei Jiang     uint64_t mstatus;
267284d697cSYifei Jiang     target_ulong prev_priv, prev_virt;
268e3fba4baSAlistair Francis 
2690c3e702aSMichael Clark     if (!(env->priv >= PRV_S)) {
270fb738839SMichael Clark         riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC());
2710c3e702aSMichael Clark     }
2720c3e702aSMichael Clark 
2730c3e702aSMichael Clark     target_ulong retpc = env->sepc;
2740c3e702aSMichael Clark     if (!riscv_has_ext(env, RVC) && (retpc & 0x3)) {
275fb738839SMichael Clark         riscv_raise_exception(env, RISCV_EXCP_INST_ADDR_MIS, GETPC());
2760c3e702aSMichael Clark     }
2770c3e702aSMichael Clark 
2781a9540d1SAlistair Francis     if (get_field(env->mstatus, MSTATUS_TSR) && !(env->priv >= PRV_M)) {
279fb738839SMichael Clark         riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC());
2807f2b5ff1SMichael Clark     }
2817f2b5ff1SMichael Clark 
28238256529SWeiwei Li     if (env->virt_enabled && get_field(env->hstatus, HSTATUS_VTSR)) {
283e39a8320SAlistair Francis         riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC());
284e39a8320SAlistair Francis     }
285e39a8320SAlistair Francis 
286e3fba4baSAlistair Francis     mstatus = env->mstatus;
2872bfec53bSBin Meng     prev_priv = get_field(mstatus, MSTATUS_SPP);
2882bfec53bSBin Meng     mstatus = set_field(mstatus, MSTATUS_SIE,
2892bfec53bSBin Meng                         get_field(mstatus, MSTATUS_SPIE));
2902bfec53bSBin Meng     mstatus = set_field(mstatus, MSTATUS_SPIE, 1);
2912bfec53bSBin Meng     mstatus = set_field(mstatus, MSTATUS_SPP, PRV_U);
2920ff430a5SBin Meng     if (env->priv_ver >= PRIV_VERSION_1_12_0) {
2930ff430a5SBin Meng         mstatus = set_field(mstatus, MSTATUS_MPRV, 0);
2940ff430a5SBin Meng     }
2952bfec53bSBin Meng     env->mstatus = mstatus;
296e3fba4baSAlistair Francis 
29738256529SWeiwei Li     if (riscv_has_ext(env, RVH) && !env->virt_enabled) {
298e3fba4baSAlistair Francis         /* We support Hypervisor extensions and virtulisation is disabled */
299e3fba4baSAlistair Francis         target_ulong hstatus = env->hstatus;
300e3fba4baSAlistair Francis 
301e3fba4baSAlistair Francis         prev_virt = get_field(hstatus, HSTATUS_SPV);
302e3fba4baSAlistair Francis 
303f2d5850fSAlistair Francis         hstatus = set_field(hstatus, HSTATUS_SPV, 0);
304e3fba4baSAlistair Francis 
305e3fba4baSAlistair Francis         env->hstatus = hstatus;
306e3fba4baSAlistair Francis 
307e3fba4baSAlistair Francis         if (prev_virt) {
308e3fba4baSAlistair Francis             riscv_cpu_swap_hypervisor_regs(env);
309e3fba4baSAlistair Francis         }
310e3fba4baSAlistair Francis 
311e3fba4baSAlistair Francis         riscv_cpu_set_virt_enabled(env, prev_virt);
312e3fba4baSAlistair Francis     }
313e3fba4baSAlistair Francis 
314e3fba4baSAlistair Francis     riscv_cpu_set_mode(env, prev_priv);
3150c3e702aSMichael Clark 
3160c3e702aSMichael Clark     return retpc;
3170c3e702aSMichael Clark }
3180c3e702aSMichael Clark 
319b655dc7cSLIU Zhiwei target_ulong helper_mret(CPURISCVState *env)
3200c3e702aSMichael Clark {
3210c3e702aSMichael Clark     if (!(env->priv >= PRV_M)) {
322fb738839SMichael Clark         riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC());
3230c3e702aSMichael Clark     }
3240c3e702aSMichael Clark 
3250c3e702aSMichael Clark     target_ulong retpc = env->mepc;
3260c3e702aSMichael Clark     if (!riscv_has_ext(env, RVC) && (retpc & 0x3)) {
327fb738839SMichael Clark         riscv_raise_exception(env, RISCV_EXCP_INST_ADDR_MIS, GETPC());
3280c3e702aSMichael Clark     }
3290c3e702aSMichael Clark 
330284d697cSYifei Jiang     uint64_t mstatus = env->mstatus;
3310c3e702aSMichael Clark     target_ulong prev_priv = get_field(mstatus, MSTATUS_MPP);
332d102f19aSAtish Patra 
3333fe40ef5SDaniel Henrique Barboza     if (riscv_cpu_cfg(env)->pmp &&
3340fbb5d2dSNikita Shubin         !pmp_get_num_rules(env) && (prev_priv != PRV_M)) {
3354c48aad1SBin Meng         riscv_raise_exception(env, RISCV_EXCP_INST_ACCESS_FAULT, GETPC());
336d102f19aSAtish Patra     }
337d102f19aSAtish Patra 
338284d697cSYifei Jiang     target_ulong prev_virt = get_field(env->mstatus, MSTATUS_MPV);
3391a9540d1SAlistair Francis     mstatus = set_field(mstatus, MSTATUS_MIE,
3400c3e702aSMichael Clark                         get_field(mstatus, MSTATUS_MPIE));
341a37f21c2SYiting Wang     mstatus = set_field(mstatus, MSTATUS_MPIE, 1);
34204803c3dSWeiwei Li     mstatus = set_field(mstatus, MSTATUS_MPP,
34304803c3dSWeiwei Li                         riscv_has_ext(env, RVU) ? PRV_U : PRV_M);
344e3fba4baSAlistair Francis     mstatus = set_field(mstatus, MSTATUS_MPV, 0);
3450ff430a5SBin Meng     if ((env->priv_ver >= PRIV_VERSION_1_12_0) && (prev_priv != PRV_M)) {
3460ff430a5SBin Meng         mstatus = set_field(mstatus, MSTATUS_MPRV, 0);
3470ff430a5SBin Meng     }
348c7b95171SMichael Clark     env->mstatus = mstatus;
349e3fba4baSAlistair Francis     riscv_cpu_set_mode(env, prev_priv);
350e3fba4baSAlistair Francis 
351e3fba4baSAlistair Francis     if (riscv_has_ext(env, RVH)) {
352e3fba4baSAlistair Francis         if (prev_virt) {
353e3fba4baSAlistair Francis             riscv_cpu_swap_hypervisor_regs(env);
354e3fba4baSAlistair Francis         }
355e3fba4baSAlistair Francis 
356e3fba4baSAlistair Francis         riscv_cpu_set_virt_enabled(env, prev_virt);
357e3fba4baSAlistair Francis     }
3580c3e702aSMichael Clark 
3590c3e702aSMichael Clark     return retpc;
3600c3e702aSMichael Clark }
3610c3e702aSMichael Clark 
3620c3e702aSMichael Clark void helper_wfi(CPURISCVState *env)
3630c3e702aSMichael Clark {
3643109cd98SRichard Henderson     CPUState *cs = env_cpu(env);
365719f0f60SJose Martins     bool rvs = riscv_has_ext(env, RVS);
366719f0f60SJose Martins     bool prv_u = env->priv == PRV_U;
367719f0f60SJose Martins     bool prv_s = env->priv == PRV_S;
3680c3e702aSMichael Clark 
369719f0f60SJose Martins     if (((prv_s || (!rvs && prv_u)) && get_field(env->mstatus, MSTATUS_TW)) ||
37038256529SWeiwei Li         (rvs && prv_u && !env->virt_enabled)) {
371719f0f60SJose Martins         riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC());
372c45eff30SWeiwei Li     } else if (env->virt_enabled &&
373c45eff30SWeiwei Li                (prv_u || (prv_s && get_field(env->hstatus, HSTATUS_VTW)))) {
374e39a8320SAlistair Francis         riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC());
3757f2b5ff1SMichael Clark     } else {
3760c3e702aSMichael Clark         cs->halted = 1;
3770c3e702aSMichael Clark         cs->exception_index = EXCP_HLT;
3780c3e702aSMichael Clark         cpu_loop_exit(cs);
3790c3e702aSMichael Clark     }
3807f2b5ff1SMichael Clark }
3810c3e702aSMichael Clark 
3820c3e702aSMichael Clark void helper_tlb_flush(CPURISCVState *env)
3830c3e702aSMichael Clark {
3843109cd98SRichard Henderson     CPUState *cs = env_cpu(env);
385d6db7c97SYi Chen     if (!env->virt_enabled &&
386d6db7c97SYi Chen         (env->priv == PRV_U ||
387d6db7c97SYi Chen          (env->priv == PRV_S && get_field(env->mstatus, MSTATUS_TVM)))) {
388fb738839SMichael Clark         riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC());
389d6db7c97SYi Chen     } else if (env->virt_enabled &&
390d6db7c97SYi Chen                (env->priv == PRV_U || get_field(env->hstatus, HSTATUS_VTVM))) {
391e39a8320SAlistair Francis         riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC());
3927f2b5ff1SMichael Clark     } else {
3930c3e702aSMichael Clark         tlb_flush(cs);
3940c3e702aSMichael Clark     }
3957f2b5ff1SMichael Clark }
3960c3e702aSMichael Clark 
397134c3ffaSChristoph Müllner void helper_tlb_flush_all(CPURISCVState *env)
398134c3ffaSChristoph Müllner {
399134c3ffaSChristoph Müllner     CPUState *cs = env_cpu(env);
400134c3ffaSChristoph Müllner     tlb_flush_all_cpus_synced(cs);
401134c3ffaSChristoph Müllner }
402134c3ffaSChristoph Müllner 
4032761db5fSAlistair Francis void helper_hyp_tlb_flush(CPURISCVState *env)
4042761db5fSAlistair Francis {
4052761db5fSAlistair Francis     CPUState *cs = env_cpu(env);
4062761db5fSAlistair Francis 
407d6db7c97SYi Chen     if (env->virt_enabled) {
408e39a8320SAlistair Francis         riscv_raise_exception(env, RISCV_EXCP_VIRT_INSTRUCTION_FAULT, GETPC());
409e39a8320SAlistair Francis     }
410e39a8320SAlistair Francis 
4112761db5fSAlistair Francis     if (env->priv == PRV_M ||
41238256529SWeiwei Li         (env->priv == PRV_S && !env->virt_enabled)) {
4132761db5fSAlistair Francis         tlb_flush(cs);
4142761db5fSAlistair Francis         return;
4152761db5fSAlistair Francis     }
4162761db5fSAlistair Francis 
4172761db5fSAlistair Francis     riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC());
4182761db5fSAlistair Francis }
4192761db5fSAlistair Francis 
420e39a8320SAlistair Francis void helper_hyp_gvma_tlb_flush(CPURISCVState *env)
421e39a8320SAlistair Francis {
42238256529SWeiwei Li     if (env->priv == PRV_S && !env->virt_enabled &&
423e39a8320SAlistair Francis         get_field(env->mstatus, MSTATUS_TVM)) {
424e39a8320SAlistair Francis         riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC());
425e39a8320SAlistair Francis     }
426e39a8320SAlistair Francis 
427e39a8320SAlistair Francis     helper_hyp_tlb_flush(env);
428e39a8320SAlistair Francis }
429e39a8320SAlistair Francis 
430*a7f112c5SRichard Henderson /*
431*a7f112c5SRichard Henderson  * TODO: These implementations are not quite correct.  They perform the
432*a7f112c5SRichard Henderson  * access using execute permission just fine, but the final PMP check
433*a7f112c5SRichard Henderson  * is supposed to have read permission as well.  Without replicating
434*a7f112c5SRichard Henderson  * a fair fraction of cputlb.c, fixing this requires adding new mmu_idx
435*a7f112c5SRichard Henderson  * which would imply that exact check in tlb_fill.
436*a7f112c5SRichard Henderson  */
4377687537aSAlistair Francis target_ulong helper_hyp_hlvx_hu(CPURISCVState *env, target_ulong address)
4388c5362acSAlistair Francis {
439c8f8a995SFei Wu     int mmu_idx = cpu_mmu_index(env, true) | MMU_HYP_ACCESS_BIT;
440*a7f112c5SRichard Henderson     MemOpIdx oi = make_memop_idx(MO_TEUW, mmu_idx);
4418c5362acSAlistair Francis 
442*a7f112c5SRichard Henderson     return cpu_ldw_code_mmu(env, address, oi, GETPC());
4438c5362acSAlistair Francis }
4448c5362acSAlistair Francis 
4457687537aSAlistair Francis target_ulong helper_hyp_hlvx_wu(CPURISCVState *env, target_ulong address)
4467687537aSAlistair Francis {
447c8f8a995SFei Wu     int mmu_idx = cpu_mmu_index(env, true) | MMU_HYP_ACCESS_BIT;
448*a7f112c5SRichard Henderson     MemOpIdx oi = make_memop_idx(MO_TEUL, mmu_idx);
4498c5362acSAlistair Francis 
450*a7f112c5SRichard Henderson     return cpu_ldl_code_mmu(env, address, oi, GETPC());
4518c5362acSAlistair Francis }
4528c5362acSAlistair Francis 
4530c3e702aSMichael Clark #endif /* !CONFIG_USER_ONLY */
454