target/xtensa: zero overhead loops rework/helpers split
- change xtensa zero overhead loops implementation to avoid invalidation of TBs corresponding to previous loop body when a new loop is encountered; - extract helper function groups from op_helper.c and move them into separate source files: exc_helper.c (exception helpers), win_helper.c (windowed registers helpers), fpu_helper.c (floating point helpers), mmu_helper.c (memory management helpers) and dbg_helper.c (native debug helpers). -----BEGIN PGP SIGNATURE----- iQJHBAABCAAxFiEEK2eFS5jlMn3N6xfYUfnMkfg/oEQFAlxHZIETHGpjbXZia2Jj QGdtYWlsLmNvbQAKCRBR+cyR+D+gREAmD/0XXCUljktusx5HRcFUOjGmEsYr2q1Y FEiS0dSepxnc1LH7gnAgPsMB6CaUi9+Bt08Qh1Cf48vjo0RA/GRU7YEMHANti+xo +3DX+fLcAyFZqiVLxUwPT5O2eOIUKvtO4BcPvhYoZc2CR+hZutt65XVF5eQsucoo paP/vOvelI5FZexLqrcytgzjPMI8WZWEANwKVb0ZzPetaOAlWunoME7E+XFYmEhA XU1MEiI6gJOgCpqInw7d6G/zjo4FTXp7kXlUXj8n1RP07gOQheE0kf6cxDRyPufp CRjqJJjT1Li5C+35aEJrYjIAGt0zxvNMz1qB9DycuRSzQnWcS7y1y/XbTyE0RtC7 zIGQ692c9DyO5vs+tpRBcYUIa898kixXLgC23nxRGB9IP1XkBT33/yqTfPj3LIWq KQYocxrNXe+PpDt3So81KA6v6w0xo21bnXgoFYx4Z/vG1r4njWPoNbyPckxbo8Vq zd/2gmnbORX7hqrTesggpGK6tfdOqH84QksO+sbdVDgQ+lwAUxYvxeG8+16rBn33 cENN5yXPymJ7jpAjnciqanWjdZpCmqlFZUtQmt9kre7icydpbfom/B4HyYiGtwHA NM5y6F+reFUuggvFYLQfg6yxdSKkHsb0sIKTPxMN06VWDBRANFN32ZIk7oLN6L4g r5J0JQDHpBbOLg== =oGcZ -----END PGP SIGNATURE----- Merge remote-tracking branch 'remotes/xtensa/tags/20190122-xtensa' into staging target/xtensa: zero overhead loops rework/helpers split - change xtensa zero overhead loops implementation to avoid invalidation of TBs corresponding to previous loop body when a new loop is encountered; - extract helper function groups from op_helper.c and move them into separate source files: exc_helper.c (exception helpers), win_helper.c (windowed registers helpers), fpu_helper.c (floating point helpers), mmu_helper.c (memory management helpers) and dbg_helper.c (native debug helpers). # gpg: Signature made Tue 22 Jan 2019 18:44:17 GMT # gpg: using RSA key 51F9CC91F83FA044 # gpg: Good signature from "Max Filippov <filippov@cadence.com>" # gpg: aka "Max Filippov <max.filippov@cogentembedded.com>" # gpg: aka "Max Filippov <jcmvbkbc@gmail.com>" # Primary key fingerprint: 2B67 854B 98E5 327D CDEB 17D8 51F9 CC91 F83F A044 * remotes/xtensa/tags/20190122-xtensa: target/xtensa: move non-HELPER functions to helper.c target/xtensa: drop dump_state helper target/xtensa: extract interrupt and exception helpers target/xtensa: extract debug helpers target/xtensa: extract MMU helpers target/xtensa: extract windowed registers helpers target/xtensa: extract FPU helpers target/xtensa: rework zero overhead loops implementation Signed-off-by: Peter Maydell <peter.maydell@linaro.org>
This commit is contained in:
Peter Maydell
commit
6d809e7da9
@ -7,4 +7,9 @@ obj-y += core-test_kc705_be.o
|
|||||||
obj-$(CONFIG_SOFTMMU) += monitor.o xtensa-semi.o
|
obj-$(CONFIG_SOFTMMU) += monitor.o xtensa-semi.o
|
||||||
obj-y += xtensa-isa.o
|
obj-y += xtensa-isa.o
|
||||||
obj-y += translate.o op_helper.o helper.o cpu.o
|
obj-y += translate.o op_helper.o helper.o cpu.o
|
||||||
|
obj-$(CONFIG_SOFTMMU) += dbg_helper.o
|
||||||
|
obj-y += exc_helper.o
|
||||||
|
obj-y += fpu_helper.o
|
||||||
obj-y += gdbstub.o
|
obj-y += gdbstub.o
|
||||||
|
obj-$(CONFIG_SOFTMMU) += mmu_helper.o
|
||||||
|
obj-y += win_helper.o
|
||||||
|
|||||||
@ -400,6 +400,7 @@ struct XtensaConfig {
|
|||||||
int excm_level;
|
int excm_level;
|
||||||
int ndepc;
|
int ndepc;
|
||||||
unsigned inst_fetch_width;
|
unsigned inst_fetch_width;
|
||||||
|
unsigned max_insn_size;
|
||||||
uint32_t vecbase;
|
uint32_t vecbase;
|
||||||
uint32_t exception_vector[EXC_MAX];
|
uint32_t exception_vector[EXC_MAX];
|
||||||
unsigned ninterrupt;
|
unsigned ninterrupt;
|
||||||
@ -695,6 +696,11 @@ static inline int cpu_mmu_index(CPUXtensaState *env, bool ifetch)
|
|||||||
#define XTENSA_TBFLAG_CALLINC_MASK 0x180000
|
#define XTENSA_TBFLAG_CALLINC_MASK 0x180000
|
||||||
#define XTENSA_TBFLAG_CALLINC_SHIFT 19
|
#define XTENSA_TBFLAG_CALLINC_SHIFT 19
|
||||||
|
|
||||||
|
#define XTENSA_CSBASE_LEND_MASK 0x0000ffff
|
||||||
|
#define XTENSA_CSBASE_LEND_SHIFT 0
|
||||||
|
#define XTENSA_CSBASE_LBEG_OFF_MASK 0x00ff0000
|
||||||
|
#define XTENSA_CSBASE_LBEG_OFF_SHIFT 16
|
||||||
|
|
||||||
static inline void cpu_get_tb_cpu_state(CPUXtensaState *env, target_ulong *pc,
|
static inline void cpu_get_tb_cpu_state(CPUXtensaState *env, target_ulong *pc,
|
||||||
target_ulong *cs_base, uint32_t *flags)
|
target_ulong *cs_base, uint32_t *flags)
|
||||||
{
|
{
|
||||||
@ -706,6 +712,32 @@ static inline void cpu_get_tb_cpu_state(CPUXtensaState *env, target_ulong *pc,
|
|||||||
*flags |= xtensa_get_ring(env);
|
*flags |= xtensa_get_ring(env);
|
||||||
if (env->sregs[PS] & PS_EXCM) {
|
if (env->sregs[PS] & PS_EXCM) {
|
||||||
*flags |= XTENSA_TBFLAG_EXCM;
|
*flags |= XTENSA_TBFLAG_EXCM;
|
||||||
|
} else if (xtensa_option_enabled(env->config, XTENSA_OPTION_LOOP)) {
|
||||||
|
target_ulong lend_dist =
|
||||||
|
env->sregs[LEND] - (env->pc & -(1u << TARGET_PAGE_BITS));
|
||||||
|
|
||||||
|
/*
|
||||||
|
* 0 in the csbase_lend field means that there may not be a loopback
|
||||||
|
* for any instruction that starts inside this page. Any other value
|
||||||
|
* means that an instruction that ends at this offset from the page
|
||||||
|
* start may loop back and will need loopback code to be generated.
|
||||||
|
*
|
||||||
|
* lend_dist is 0 when LEND points to the start of the page, but
|
||||||
|
* no instruction that starts inside this page may end at offset 0,
|
||||||
|
* so it's still correct.
|
||||||
|
*
|
||||||
|
* When an instruction ends at a page boundary it may only start in
|
||||||
|
* the previous page. lend_dist will be encoded as TARGET_PAGE_SIZE
|
||||||
|
* for the TB that contains this instruction.
|
||||||
|
*/
|
||||||
|
if (lend_dist < (1u << TARGET_PAGE_BITS) + env->config->max_insn_size) {
|
||||||
|
target_ulong lbeg_off = env->sregs[LEND] - env->sregs[LBEG];
|
||||||
|
|
||||||
|
*cs_base = lend_dist;
|
||||||
|
if (lbeg_off < 256) {
|
||||||
|
*cs_base |= lbeg_off << XTENSA_CSBASE_LBEG_OFF_SHIFT;
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
if (xtensa_option_enabled(env->config, XTENSA_OPTION_EXTENDED_L32R) &&
|
if (xtensa_option_enabled(env->config, XTENSA_OPTION_EXTENDED_L32R) &&
|
||||||
(env->sregs[LITBASE] & 1)) {
|
(env->sregs[LITBASE] & 1)) {
|
||||||
|
|||||||
129
target/xtensa/dbg_helper.c
Normal file
129
target/xtensa/dbg_helper.c
Normal file
@ -0,0 +1,129 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (c) 2011 - 2019, Max Filippov, Open Source and Linux Lab.
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions are met:
|
||||||
|
* * Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* * Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* * Neither the name of the Open Source and Linux Lab nor the
|
||||||
|
* names of its contributors may be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||||
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||||
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||||
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
|
||||||
|
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
||||||
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
||||||
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
|
||||||
|
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||||||
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "qemu/osdep.h"
|
||||||
|
#include "qemu/main-loop.h"
|
||||||
|
#include "cpu.h"
|
||||||
|
#include "exec/helper-proto.h"
|
||||||
|
#include "qemu/host-utils.h"
|
||||||
|
#include "exec/exec-all.h"
|
||||||
|
#include "exec/address-spaces.h"
|
||||||
|
|
||||||
|
static void tb_invalidate_virtual_addr(CPUXtensaState *env, uint32_t vaddr)
|
||||||
|
{
|
||||||
|
uint32_t paddr;
|
||||||
|
uint32_t page_size;
|
||||||
|
unsigned access;
|
||||||
|
int ret = xtensa_get_physical_addr(env, false, vaddr, 2, 0,
|
||||||
|
&paddr, &page_size, &access);
|
||||||
|
if (ret == 0) {
|
||||||
|
tb_invalidate_phys_addr(&address_space_memory, paddr,
|
||||||
|
MEMTXATTRS_UNSPECIFIED);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(wsr_ibreakenable)(CPUXtensaState *env, uint32_t v)
|
||||||
|
{
|
||||||
|
uint32_t change = v ^ env->sregs[IBREAKENABLE];
|
||||||
|
unsigned i;
|
||||||
|
|
||||||
|
for (i = 0; i < env->config->nibreak; ++i) {
|
||||||
|
if (change & (1 << i)) {
|
||||||
|
tb_invalidate_virtual_addr(env, env->sregs[IBREAKA + i]);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
env->sregs[IBREAKENABLE] = v & ((1 << env->config->nibreak) - 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(wsr_ibreaka)(CPUXtensaState *env, uint32_t i, uint32_t v)
|
||||||
|
{
|
||||||
|
if (env->sregs[IBREAKENABLE] & (1 << i) && env->sregs[IBREAKA + i] != v) {
|
||||||
|
tb_invalidate_virtual_addr(env, env->sregs[IBREAKA + i]);
|
||||||
|
tb_invalidate_virtual_addr(env, v);
|
||||||
|
}
|
||||||
|
env->sregs[IBREAKA + i] = v;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void set_dbreak(CPUXtensaState *env, unsigned i, uint32_t dbreaka,
|
||||||
|
uint32_t dbreakc)
|
||||||
|
{
|
||||||
|
CPUState *cs = CPU(xtensa_env_get_cpu(env));
|
||||||
|
int flags = BP_CPU | BP_STOP_BEFORE_ACCESS;
|
||||||
|
uint32_t mask = dbreakc | ~DBREAKC_MASK;
|
||||||
|
|
||||||
|
if (env->cpu_watchpoint[i]) {
|
||||||
|
cpu_watchpoint_remove_by_ref(cs, env->cpu_watchpoint[i]);
|
||||||
|
}
|
||||||
|
if (dbreakc & DBREAKC_SB) {
|
||||||
|
flags |= BP_MEM_WRITE;
|
||||||
|
}
|
||||||
|
if (dbreakc & DBREAKC_LB) {
|
||||||
|
flags |= BP_MEM_READ;
|
||||||
|
}
|
||||||
|
/* contiguous mask after inversion is one less than some power of 2 */
|
||||||
|
if ((~mask + 1) & ~mask) {
|
||||||
|
qemu_log_mask(LOG_GUEST_ERROR,
|
||||||
|
"DBREAKC mask is not contiguous: 0x%08x\n", dbreakc);
|
||||||
|
/* cut mask after the first zero bit */
|
||||||
|
mask = 0xffffffff << (32 - clo32(mask));
|
||||||
|
}
|
||||||
|
if (cpu_watchpoint_insert(cs, dbreaka & mask, ~mask + 1,
|
||||||
|
flags, &env->cpu_watchpoint[i])) {
|
||||||
|
env->cpu_watchpoint[i] = NULL;
|
||||||
|
qemu_log_mask(LOG_GUEST_ERROR,
|
||||||
|
"Failed to set data breakpoint at 0x%08x/%d\n",
|
||||||
|
dbreaka & mask, ~mask + 1);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(wsr_dbreaka)(CPUXtensaState *env, uint32_t i, uint32_t v)
|
||||||
|
{
|
||||||
|
uint32_t dbreakc = env->sregs[DBREAKC + i];
|
||||||
|
|
||||||
|
if ((dbreakc & DBREAKC_SB_LB) &&
|
||||||
|
env->sregs[DBREAKA + i] != v) {
|
||||||
|
set_dbreak(env, i, v, dbreakc);
|
||||||
|
}
|
||||||
|
env->sregs[DBREAKA + i] = v;
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(wsr_dbreakc)(CPUXtensaState *env, uint32_t i, uint32_t v)
|
||||||
|
{
|
||||||
|
if ((env->sregs[DBREAKC + i] ^ v) & (DBREAKC_SB_LB | DBREAKC_MASK)) {
|
||||||
|
if (v & DBREAKC_SB_LB) {
|
||||||
|
set_dbreak(env, i, env->sregs[DBREAKA + i], v);
|
||||||
|
} else {
|
||||||
|
if (env->cpu_watchpoint[i]) {
|
||||||
|
CPUState *cs = CPU(xtensa_env_get_cpu(env));
|
||||||
|
|
||||||
|
cpu_watchpoint_remove_by_ref(cs, env->cpu_watchpoint[i]);
|
||||||
|
env->cpu_watchpoint[i] = NULL;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
env->sregs[DBREAKC + i] = v;
|
||||||
|
}
|
||||||
258
target/xtensa/exc_helper.c
Normal file
258
target/xtensa/exc_helper.c
Normal file
@ -0,0 +1,258 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (c) 2011 - 2019, Max Filippov, Open Source and Linux Lab.
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions are met:
|
||||||
|
* * Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* * Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* * Neither the name of the Open Source and Linux Lab nor the
|
||||||
|
* names of its contributors may be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||||
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||||
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||||
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
|
||||||
|
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
||||||
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
||||||
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
|
||||||
|
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||||||
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "qemu/osdep.h"
|
||||||
|
#include "qemu/main-loop.h"
|
||||||
|
#include "cpu.h"
|
||||||
|
#include "exec/helper-proto.h"
|
||||||
|
#include "qemu/host-utils.h"
|
||||||
|
#include "exec/exec-all.h"
|
||||||
|
|
||||||
|
void HELPER(exception)(CPUXtensaState *env, uint32_t excp)
|
||||||
|
{
|
||||||
|
CPUState *cs = CPU(xtensa_env_get_cpu(env));
|
||||||
|
|
||||||
|
cs->exception_index = excp;
|
||||||
|
if (excp == EXCP_YIELD) {
|
||||||
|
env->yield_needed = 0;
|
||||||
|
}
|
||||||
|
if (excp == EXCP_DEBUG) {
|
||||||
|
env->exception_taken = 0;
|
||||||
|
}
|
||||||
|
cpu_loop_exit(cs);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(exception_cause)(CPUXtensaState *env, uint32_t pc, uint32_t cause)
|
||||||
|
{
|
||||||
|
uint32_t vector;
|
||||||
|
|
||||||
|
env->pc = pc;
|
||||||
|
if (env->sregs[PS] & PS_EXCM) {
|
||||||
|
if (env->config->ndepc) {
|
||||||
|
env->sregs[DEPC] = pc;
|
||||||
|
} else {
|
||||||
|
env->sregs[EPC1] = pc;
|
||||||
|
}
|
||||||
|
vector = EXC_DOUBLE;
|
||||||
|
} else {
|
||||||
|
env->sregs[EPC1] = pc;
|
||||||
|
vector = (env->sregs[PS] & PS_UM) ? EXC_USER : EXC_KERNEL;
|
||||||
|
}
|
||||||
|
|
||||||
|
env->sregs[EXCCAUSE] = cause;
|
||||||
|
env->sregs[PS] |= PS_EXCM;
|
||||||
|
|
||||||
|
HELPER(exception)(env, vector);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(exception_cause_vaddr)(CPUXtensaState *env,
|
||||||
|
uint32_t pc, uint32_t cause, uint32_t vaddr)
|
||||||
|
{
|
||||||
|
env->sregs[EXCVADDR] = vaddr;
|
||||||
|
HELPER(exception_cause)(env, pc, cause);
|
||||||
|
}
|
||||||
|
|
||||||
|
void debug_exception_env(CPUXtensaState *env, uint32_t cause)
|
||||||
|
{
|
||||||
|
if (xtensa_get_cintlevel(env) < env->config->debug_level) {
|
||||||
|
HELPER(debug_exception)(env, env->pc, cause);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(debug_exception)(CPUXtensaState *env, uint32_t pc, uint32_t cause)
|
||||||
|
{
|
||||||
|
unsigned level = env->config->debug_level;
|
||||||
|
|
||||||
|
env->pc = pc;
|
||||||
|
env->sregs[DEBUGCAUSE] = cause;
|
||||||
|
env->sregs[EPC1 + level - 1] = pc;
|
||||||
|
env->sregs[EPS2 + level - 2] = env->sregs[PS];
|
||||||
|
env->sregs[PS] = (env->sregs[PS] & ~PS_INTLEVEL) | PS_EXCM |
|
||||||
|
(level << PS_INTLEVEL_SHIFT);
|
||||||
|
HELPER(exception)(env, EXC_DEBUG);
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifndef CONFIG_USER_ONLY
|
||||||
|
|
||||||
|
void HELPER(waiti)(CPUXtensaState *env, uint32_t pc, uint32_t intlevel)
|
||||||
|
{
|
||||||
|
CPUState *cpu;
|
||||||
|
|
||||||
|
env->pc = pc;
|
||||||
|
env->sregs[PS] = (env->sregs[PS] & ~PS_INTLEVEL) |
|
||||||
|
(intlevel << PS_INTLEVEL_SHIFT);
|
||||||
|
|
||||||
|
qemu_mutex_lock_iothread();
|
||||||
|
check_interrupts(env);
|
||||||
|
qemu_mutex_unlock_iothread();
|
||||||
|
|
||||||
|
if (env->pending_irq_level) {
|
||||||
|
cpu_loop_exit(CPU(xtensa_env_get_cpu(env)));
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
cpu = CPU(xtensa_env_get_cpu(env));
|
||||||
|
cpu->halted = 1;
|
||||||
|
HELPER(exception)(env, EXCP_HLT);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(check_interrupts)(CPUXtensaState *env)
|
||||||
|
{
|
||||||
|
qemu_mutex_lock_iothread();
|
||||||
|
check_interrupts(env);
|
||||||
|
qemu_mutex_unlock_iothread();
|
||||||
|
}
|
||||||
|
|
||||||
|
static uint32_t relocated_vector(CPUXtensaState *env, uint32_t vector)
|
||||||
|
{
|
||||||
|
if (xtensa_option_enabled(env->config,
|
||||||
|
XTENSA_OPTION_RELOCATABLE_VECTOR)) {
|
||||||
|
return vector - env->config->vecbase + env->sregs[VECBASE];
|
||||||
|
} else {
|
||||||
|
return vector;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* Handle penging IRQ.
|
||||||
|
* For the high priority interrupt jump to the corresponding interrupt vector.
|
||||||
|
* For the level-1 interrupt convert it to either user, kernel or double
|
||||||
|
* exception with the 'level-1 interrupt' exception cause.
|
||||||
|
*/
|
||||||
|
static void handle_interrupt(CPUXtensaState *env)
|
||||||
|
{
|
||||||
|
int level = env->pending_irq_level;
|
||||||
|
|
||||||
|
if (level > xtensa_get_cintlevel(env) &&
|
||||||
|
level <= env->config->nlevel &&
|
||||||
|
(env->config->level_mask[level] &
|
||||||
|
env->sregs[INTSET] &
|
||||||
|
env->sregs[INTENABLE])) {
|
||||||
|
CPUState *cs = CPU(xtensa_env_get_cpu(env));
|
||||||
|
|
||||||
|
if (level > 1) {
|
||||||
|
env->sregs[EPC1 + level - 1] = env->pc;
|
||||||
|
env->sregs[EPS2 + level - 2] = env->sregs[PS];
|
||||||
|
env->sregs[PS] =
|
||||||
|
(env->sregs[PS] & ~PS_INTLEVEL) | level | PS_EXCM;
|
||||||
|
env->pc = relocated_vector(env,
|
||||||
|
env->config->interrupt_vector[level]);
|
||||||
|
} else {
|
||||||
|
env->sregs[EXCCAUSE] = LEVEL1_INTERRUPT_CAUSE;
|
||||||
|
|
||||||
|
if (env->sregs[PS] & PS_EXCM) {
|
||||||
|
if (env->config->ndepc) {
|
||||||
|
env->sregs[DEPC] = env->pc;
|
||||||
|
} else {
|
||||||
|
env->sregs[EPC1] = env->pc;
|
||||||
|
}
|
||||||
|
cs->exception_index = EXC_DOUBLE;
|
||||||
|
} else {
|
||||||
|
env->sregs[EPC1] = env->pc;
|
||||||
|
cs->exception_index =
|
||||||
|
(env->sregs[PS] & PS_UM) ? EXC_USER : EXC_KERNEL;
|
||||||
|
}
|
||||||
|
env->sregs[PS] |= PS_EXCM;
|
||||||
|
}
|
||||||
|
env->exception_taken = 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Called from cpu_handle_interrupt with BQL held */
|
||||||
|
void xtensa_cpu_do_interrupt(CPUState *cs)
|
||||||
|
{
|
||||||
|
XtensaCPU *cpu = XTENSA_CPU(cs);
|
||||||
|
CPUXtensaState *env = &cpu->env;
|
||||||
|
|
||||||
|
if (cs->exception_index == EXC_IRQ) {
|
||||||
|
qemu_log_mask(CPU_LOG_INT,
|
||||||
|
"%s(EXC_IRQ) level = %d, cintlevel = %d, "
|
||||||
|
"pc = %08x, a0 = %08x, ps = %08x, "
|
||||||
|
"intset = %08x, intenable = %08x, "
|
||||||
|
"ccount = %08x\n",
|
||||||
|
__func__, env->pending_irq_level,
|
||||||
|
xtensa_get_cintlevel(env),
|
||||||
|
env->pc, env->regs[0], env->sregs[PS],
|
||||||
|
env->sregs[INTSET], env->sregs[INTENABLE],
|
||||||
|
env->sregs[CCOUNT]);
|
||||||
|
handle_interrupt(env);
|
||||||
|
}
|
||||||
|
|
||||||
|
switch (cs->exception_index) {
|
||||||
|
case EXC_WINDOW_OVERFLOW4:
|
||||||
|
case EXC_WINDOW_UNDERFLOW4:
|
||||||
|
case EXC_WINDOW_OVERFLOW8:
|
||||||
|
case EXC_WINDOW_UNDERFLOW8:
|
||||||
|
case EXC_WINDOW_OVERFLOW12:
|
||||||
|
case EXC_WINDOW_UNDERFLOW12:
|
||||||
|
case EXC_KERNEL:
|
||||||
|
case EXC_USER:
|
||||||
|
case EXC_DOUBLE:
|
||||||
|
case EXC_DEBUG:
|
||||||
|
qemu_log_mask(CPU_LOG_INT, "%s(%d) "
|
||||||
|
"pc = %08x, a0 = %08x, ps = %08x, ccount = %08x\n",
|
||||||
|
__func__, cs->exception_index,
|
||||||
|
env->pc, env->regs[0], env->sregs[PS],
|
||||||
|
env->sregs[CCOUNT]);
|
||||||
|
if (env->config->exception_vector[cs->exception_index]) {
|
||||||
|
uint32_t vector;
|
||||||
|
|
||||||
|
vector = env->config->exception_vector[cs->exception_index];
|
||||||
|
env->pc = relocated_vector(env, vector);
|
||||||
|
env->exception_taken = 1;
|
||||||
|
} else {
|
||||||
|
qemu_log_mask(CPU_LOG_INT,
|
||||||
|
"%s(pc = %08x) bad exception_index: %d\n",
|
||||||
|
__func__, env->pc, cs->exception_index);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case EXC_IRQ:
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
qemu_log("%s(pc = %08x) unknown exception_index: %d\n",
|
||||||
|
__func__, env->pc, cs->exception_index);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
check_interrupts(env);
|
||||||
|
}
|
||||||
|
#else
|
||||||
|
void xtensa_cpu_do_interrupt(CPUState *cs)
|
||||||
|
{
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
bool xtensa_cpu_exec_interrupt(CPUState *cs, int interrupt_request)
|
||||||
|
{
|
||||||
|
if (interrupt_request & CPU_INTERRUPT_HARD) {
|
||||||
|
cs->exception_index = EXC_IRQ;
|
||||||
|
xtensa_cpu_do_interrupt(cs);
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
return false;
|
||||||
|
}
|
||||||
166
target/xtensa/fpu_helper.c
Normal file
166
target/xtensa/fpu_helper.c
Normal file
@ -0,0 +1,166 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (c) 2011 - 2019, Max Filippov, Open Source and Linux Lab.
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions are met:
|
||||||
|
* * Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* * Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* * Neither the name of the Open Source and Linux Lab nor the
|
||||||
|
* names of its contributors may be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||||
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||||
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||||
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
|
||||||
|
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
||||||
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
||||||
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
|
||||||
|
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||||||
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "qemu/osdep.h"
|
||||||
|
#include "qemu/main-loop.h"
|
||||||
|
#include "cpu.h"
|
||||||
|
#include "exec/helper-proto.h"
|
||||||
|
#include "qemu/host-utils.h"
|
||||||
|
#include "exec/exec-all.h"
|
||||||
|
#include "fpu/softfloat.h"
|
||||||
|
|
||||||
|
void HELPER(wur_fcr)(CPUXtensaState *env, uint32_t v)
|
||||||
|
{
|
||||||
|
static const int rounding_mode[] = {
|
||||||
|
float_round_nearest_even,
|
||||||
|
float_round_to_zero,
|
||||||
|
float_round_up,
|
||||||
|
float_round_down,
|
||||||
|
};
|
||||||
|
|
||||||
|
env->uregs[FCR] = v & 0xfffff07f;
|
||||||
|
set_float_rounding_mode(rounding_mode[v & 3], &env->fp_status);
|
||||||
|
}
|
||||||
|
|
||||||
|
float32 HELPER(abs_s)(float32 v)
|
||||||
|
{
|
||||||
|
return float32_abs(v);
|
||||||
|
}
|
||||||
|
|
||||||
|
float32 HELPER(neg_s)(float32 v)
|
||||||
|
{
|
||||||
|
return float32_chs(v);
|
||||||
|
}
|
||||||
|
|
||||||
|
float32 HELPER(add_s)(CPUXtensaState *env, float32 a, float32 b)
|
||||||
|
{
|
||||||
|
return float32_add(a, b, &env->fp_status);
|
||||||
|
}
|
||||||
|
|
||||||
|
float32 HELPER(sub_s)(CPUXtensaState *env, float32 a, float32 b)
|
||||||
|
{
|
||||||
|
return float32_sub(a, b, &env->fp_status);
|
||||||
|
}
|
||||||
|
|
||||||
|
float32 HELPER(mul_s)(CPUXtensaState *env, float32 a, float32 b)
|
||||||
|
{
|
||||||
|
return float32_mul(a, b, &env->fp_status);
|
||||||
|
}
|
||||||
|
|
||||||
|
float32 HELPER(madd_s)(CPUXtensaState *env, float32 a, float32 b, float32 c)
|
||||||
|
{
|
||||||
|
return float32_muladd(b, c, a, 0, &env->fp_status);
|
||||||
|
}
|
||||||
|
|
||||||
|
float32 HELPER(msub_s)(CPUXtensaState *env, float32 a, float32 b, float32 c)
|
||||||
|
{
|
||||||
|
return float32_muladd(b, c, a, float_muladd_negate_product,
|
||||||
|
&env->fp_status);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t HELPER(ftoi)(float32 v, uint32_t rounding_mode, uint32_t scale)
|
||||||
|
{
|
||||||
|
float_status fp_status = {0};
|
||||||
|
|
||||||
|
set_float_rounding_mode(rounding_mode, &fp_status);
|
||||||
|
return float32_to_int32(float32_scalbn(v, scale, &fp_status), &fp_status);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t HELPER(ftoui)(float32 v, uint32_t rounding_mode, uint32_t scale)
|
||||||
|
{
|
||||||
|
float_status fp_status = {0};
|
||||||
|
float32 res;
|
||||||
|
|
||||||
|
set_float_rounding_mode(rounding_mode, &fp_status);
|
||||||
|
|
||||||
|
res = float32_scalbn(v, scale, &fp_status);
|
||||||
|
|
||||||
|
if (float32_is_neg(v) && !float32_is_any_nan(v)) {
|
||||||
|
return float32_to_int32(res, &fp_status);
|
||||||
|
} else {
|
||||||
|
return float32_to_uint32(res, &fp_status);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
float32 HELPER(itof)(CPUXtensaState *env, uint32_t v, uint32_t scale)
|
||||||
|
{
|
||||||
|
return float32_scalbn(int32_to_float32(v, &env->fp_status),
|
||||||
|
(int32_t)scale, &env->fp_status);
|
||||||
|
}
|
||||||
|
|
||||||
|
float32 HELPER(uitof)(CPUXtensaState *env, uint32_t v, uint32_t scale)
|
||||||
|
{
|
||||||
|
return float32_scalbn(uint32_to_float32(v, &env->fp_status),
|
||||||
|
(int32_t)scale, &env->fp_status);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void set_br(CPUXtensaState *env, bool v, uint32_t br)
|
||||||
|
{
|
||||||
|
if (v) {
|
||||||
|
env->sregs[BR] |= br;
|
||||||
|
} else {
|
||||||
|
env->sregs[BR] &= ~br;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(un_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
||||||
|
{
|
||||||
|
set_br(env, float32_unordered_quiet(a, b, &env->fp_status), br);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(oeq_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
||||||
|
{
|
||||||
|
set_br(env, float32_eq_quiet(a, b, &env->fp_status), br);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(ueq_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
||||||
|
{
|
||||||
|
int v = float32_compare_quiet(a, b, &env->fp_status);
|
||||||
|
set_br(env, v == float_relation_equal || v == float_relation_unordered, br);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(olt_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
||||||
|
{
|
||||||
|
set_br(env, float32_lt_quiet(a, b, &env->fp_status), br);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(ult_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
||||||
|
{
|
||||||
|
int v = float32_compare_quiet(a, b, &env->fp_status);
|
||||||
|
set_br(env, v == float_relation_less || v == float_relation_unordered, br);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(ole_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
||||||
|
{
|
||||||
|
set_br(env, float32_le_quiet(a, b, &env->fp_status), br);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(ule_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
||||||
|
{
|
||||||
|
int v = float32_compare_quiet(a, b, &env->fp_status);
|
||||||
|
set_br(env, v != float_relation_greater, br);
|
||||||
|
}
|
||||||
@ -26,14 +26,11 @@
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
#include "qemu/osdep.h"
|
#include "qemu/osdep.h"
|
||||||
#include "qemu/units.h"
|
|
||||||
#include "cpu.h"
|
#include "cpu.h"
|
||||||
#include "exec/exec-all.h"
|
#include "exec/exec-all.h"
|
||||||
#include "exec/gdbstub.h"
|
#include "exec/gdbstub.h"
|
||||||
|
#include "exec/helper-proto.h"
|
||||||
#include "qemu/host-utils.h"
|
#include "qemu/host-utils.h"
|
||||||
#if !defined(CONFIG_USER_ONLY)
|
|
||||||
#include "hw/loader.h"
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static struct XtensaConfigList *xtensa_cores;
|
static struct XtensaConfigList *xtensa_cores;
|
||||||
|
|
||||||
@ -170,155 +167,6 @@ void xtensa_cpu_list(FILE *f, fprintf_function cpu_fprintf)
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
hwaddr xtensa_cpu_get_phys_page_debug(CPUState *cs, vaddr addr)
|
|
||||||
{
|
|
||||||
#ifndef CONFIG_USER_ONLY
|
|
||||||
XtensaCPU *cpu = XTENSA_CPU(cs);
|
|
||||||
uint32_t paddr;
|
|
||||||
uint32_t page_size;
|
|
||||||
unsigned access;
|
|
||||||
|
|
||||||
if (xtensa_get_physical_addr(&cpu->env, false, addr, 0, 0,
|
|
||||||
&paddr, &page_size, &access) == 0) {
|
|
||||||
return paddr;
|
|
||||||
}
|
|
||||||
if (xtensa_get_physical_addr(&cpu->env, false, addr, 2, 0,
|
|
||||||
&paddr, &page_size, &access) == 0) {
|
|
||||||
return paddr;
|
|
||||||
}
|
|
||||||
return ~0;
|
|
||||||
#else
|
|
||||||
return addr;
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifndef CONFIG_USER_ONLY
|
|
||||||
|
|
||||||
static uint32_t relocated_vector(CPUXtensaState *env, uint32_t vector)
|
|
||||||
{
|
|
||||||
if (xtensa_option_enabled(env->config,
|
|
||||||
XTENSA_OPTION_RELOCATABLE_VECTOR)) {
|
|
||||||
return vector - env->config->vecbase + env->sregs[VECBASE];
|
|
||||||
} else {
|
|
||||||
return vector;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* Handle penging IRQ.
|
|
||||||
* For the high priority interrupt jump to the corresponding interrupt vector.
|
|
||||||
* For the level-1 interrupt convert it to either user, kernel or double
|
|
||||||
* exception with the 'level-1 interrupt' exception cause.
|
|
||||||
*/
|
|
||||||
static void handle_interrupt(CPUXtensaState *env)
|
|
||||||
{
|
|
||||||
int level = env->pending_irq_level;
|
|
||||||
|
|
||||||
if (level > xtensa_get_cintlevel(env) &&
|
|
||||||
level <= env->config->nlevel &&
|
|
||||||
(env->config->level_mask[level] &
|
|
||||||
env->sregs[INTSET] &
|
|
||||||
env->sregs[INTENABLE])) {
|
|
||||||
CPUState *cs = CPU(xtensa_env_get_cpu(env));
|
|
||||||
|
|
||||||
if (level > 1) {
|
|
||||||
env->sregs[EPC1 + level - 1] = env->pc;
|
|
||||||
env->sregs[EPS2 + level - 2] = env->sregs[PS];
|
|
||||||
env->sregs[PS] =
|
|
||||||
(env->sregs[PS] & ~PS_INTLEVEL) | level | PS_EXCM;
|
|
||||||
env->pc = relocated_vector(env,
|
|
||||||
env->config->interrupt_vector[level]);
|
|
||||||
} else {
|
|
||||||
env->sregs[EXCCAUSE] = LEVEL1_INTERRUPT_CAUSE;
|
|
||||||
|
|
||||||
if (env->sregs[PS] & PS_EXCM) {
|
|
||||||
if (env->config->ndepc) {
|
|
||||||
env->sregs[DEPC] = env->pc;
|
|
||||||
} else {
|
|
||||||
env->sregs[EPC1] = env->pc;
|
|
||||||
}
|
|
||||||
cs->exception_index = EXC_DOUBLE;
|
|
||||||
} else {
|
|
||||||
env->sregs[EPC1] = env->pc;
|
|
||||||
cs->exception_index =
|
|
||||||
(env->sregs[PS] & PS_UM) ? EXC_USER : EXC_KERNEL;
|
|
||||||
}
|
|
||||||
env->sregs[PS] |= PS_EXCM;
|
|
||||||
}
|
|
||||||
env->exception_taken = 1;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Called from cpu_handle_interrupt with BQL held */
|
|
||||||
void xtensa_cpu_do_interrupt(CPUState *cs)
|
|
||||||
{
|
|
||||||
XtensaCPU *cpu = XTENSA_CPU(cs);
|
|
||||||
CPUXtensaState *env = &cpu->env;
|
|
||||||
|
|
||||||
if (cs->exception_index == EXC_IRQ) {
|
|
||||||
qemu_log_mask(CPU_LOG_INT,
|
|
||||||
"%s(EXC_IRQ) level = %d, cintlevel = %d, "
|
|
||||||
"pc = %08x, a0 = %08x, ps = %08x, "
|
|
||||||
"intset = %08x, intenable = %08x, "
|
|
||||||
"ccount = %08x\n",
|
|
||||||
__func__, env->pending_irq_level, xtensa_get_cintlevel(env),
|
|
||||||
env->pc, env->regs[0], env->sregs[PS],
|
|
||||||
env->sregs[INTSET], env->sregs[INTENABLE],
|
|
||||||
env->sregs[CCOUNT]);
|
|
||||||
handle_interrupt(env);
|
|
||||||
}
|
|
||||||
|
|
||||||
switch (cs->exception_index) {
|
|
||||||
case EXC_WINDOW_OVERFLOW4:
|
|
||||||
case EXC_WINDOW_UNDERFLOW4:
|
|
||||||
case EXC_WINDOW_OVERFLOW8:
|
|
||||||
case EXC_WINDOW_UNDERFLOW8:
|
|
||||||
case EXC_WINDOW_OVERFLOW12:
|
|
||||||
case EXC_WINDOW_UNDERFLOW12:
|
|
||||||
case EXC_KERNEL:
|
|
||||||
case EXC_USER:
|
|
||||||
case EXC_DOUBLE:
|
|
||||||
case EXC_DEBUG:
|
|
||||||
qemu_log_mask(CPU_LOG_INT, "%s(%d) "
|
|
||||||
"pc = %08x, a0 = %08x, ps = %08x, ccount = %08x\n",
|
|
||||||
__func__, cs->exception_index,
|
|
||||||
env->pc, env->regs[0], env->sregs[PS], env->sregs[CCOUNT]);
|
|
||||||
if (env->config->exception_vector[cs->exception_index]) {
|
|
||||||
env->pc = relocated_vector(env,
|
|
||||||
env->config->exception_vector[cs->exception_index]);
|
|
||||||
env->exception_taken = 1;
|
|
||||||
} else {
|
|
||||||
qemu_log_mask(CPU_LOG_INT, "%s(pc = %08x) bad exception_index: %d\n",
|
|
||||||
__func__, env->pc, cs->exception_index);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
case EXC_IRQ:
|
|
||||||
break;
|
|
||||||
|
|
||||||
default:
|
|
||||||
qemu_log("%s(pc = %08x) unknown exception_index: %d\n",
|
|
||||||
__func__, env->pc, cs->exception_index);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
check_interrupts(env);
|
|
||||||
}
|
|
||||||
#else
|
|
||||||
void xtensa_cpu_do_interrupt(CPUState *cs)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
bool xtensa_cpu_exec_interrupt(CPUState *cs, int interrupt_request)
|
|
||||||
{
|
|
||||||
if (interrupt_request & CPU_INTERRUPT_HARD) {
|
|
||||||
cs->exception_index = EXC_IRQ;
|
|
||||||
xtensa_cpu_do_interrupt(cs);
|
|
||||||
return true;
|
|
||||||
}
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifdef CONFIG_USER_ONLY
|
#ifdef CONFIG_USER_ONLY
|
||||||
|
|
||||||
int xtensa_cpu_handle_mmu_fault(CPUState *cs, vaddr address, int size, int rw,
|
int xtensa_cpu_handle_mmu_fault(CPUState *cs, vaddr address, int size, int rw,
|
||||||
@ -338,468 +186,61 @@ int xtensa_cpu_handle_mmu_fault(CPUState *cs, vaddr address, int size, int rw,
|
|||||||
|
|
||||||
#else
|
#else
|
||||||
|
|
||||||
static void reset_tlb_mmu_all_ways(CPUXtensaState *env,
|
void xtensa_cpu_do_unaligned_access(CPUState *cs,
|
||||||
const xtensa_tlb *tlb, xtensa_tlb_entry entry[][MAX_TLB_WAY_SIZE])
|
vaddr addr, MMUAccessType access_type,
|
||||||
|
int mmu_idx, uintptr_t retaddr)
|
||||||
{
|
{
|
||||||
unsigned wi, ei;
|
XtensaCPU *cpu = XTENSA_CPU(cs);
|
||||||
|
CPUXtensaState *env = &cpu->env;
|
||||||
|
|
||||||
for (wi = 0; wi < tlb->nways; ++wi) {
|
if (xtensa_option_enabled(env->config, XTENSA_OPTION_UNALIGNED_EXCEPTION) &&
|
||||||
for (ei = 0; ei < tlb->way_size[wi]; ++ei) {
|
!xtensa_option_enabled(env->config, XTENSA_OPTION_HW_ALIGNMENT)) {
|
||||||
entry[wi][ei].asid = 0;
|
cpu_restore_state(CPU(cpu), retaddr, true);
|
||||||
entry[wi][ei].variable = true;
|
HELPER(exception_cause_vaddr)(env,
|
||||||
}
|
env->pc, LOAD_STORE_ALIGNMENT_CAUSE,
|
||||||
|
addr);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static void reset_tlb_mmu_ways56(CPUXtensaState *env,
|
void tlb_fill(CPUState *cs, target_ulong vaddr, int size,
|
||||||
const xtensa_tlb *tlb, xtensa_tlb_entry entry[][MAX_TLB_WAY_SIZE])
|
MMUAccessType access_type, int mmu_idx, uintptr_t retaddr)
|
||||||
{
|
{
|
||||||
if (!tlb->varway56) {
|
XtensaCPU *cpu = XTENSA_CPU(cs);
|
||||||
static const xtensa_tlb_entry way5[] = {
|
CPUXtensaState *env = &cpu->env;
|
||||||
{
|
|
||||||
.vaddr = 0xd0000000,
|
|
||||||
.paddr = 0,
|
|
||||||
.asid = 1,
|
|
||||||
.attr = 7,
|
|
||||||
.variable = false,
|
|
||||||
}, {
|
|
||||||
.vaddr = 0xd8000000,
|
|
||||||
.paddr = 0,
|
|
||||||
.asid = 1,
|
|
||||||
.attr = 3,
|
|
||||||
.variable = false,
|
|
||||||
}
|
|
||||||
};
|
|
||||||
static const xtensa_tlb_entry way6[] = {
|
|
||||||
{
|
|
||||||
.vaddr = 0xe0000000,
|
|
||||||
.paddr = 0xf0000000,
|
|
||||||
.asid = 1,
|
|
||||||
.attr = 7,
|
|
||||||
.variable = false,
|
|
||||||
}, {
|
|
||||||
.vaddr = 0xf0000000,
|
|
||||||
.paddr = 0xf0000000,
|
|
||||||
.asid = 1,
|
|
||||||
.attr = 3,
|
|
||||||
.variable = false,
|
|
||||||
}
|
|
||||||
};
|
|
||||||
memcpy(entry[5], way5, sizeof(way5));
|
|
||||||
memcpy(entry[6], way6, sizeof(way6));
|
|
||||||
} else {
|
|
||||||
uint32_t ei;
|
|
||||||
for (ei = 0; ei < 8; ++ei) {
|
|
||||||
entry[6][ei].vaddr = ei << 29;
|
|
||||||
entry[6][ei].paddr = ei << 29;
|
|
||||||
entry[6][ei].asid = 1;
|
|
||||||
entry[6][ei].attr = 3;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static void reset_tlb_region_way0(CPUXtensaState *env,
|
|
||||||
xtensa_tlb_entry entry[][MAX_TLB_WAY_SIZE])
|
|
||||||
{
|
|
||||||
unsigned ei;
|
|
||||||
|
|
||||||
for (ei = 0; ei < 8; ++ei) {
|
|
||||||
entry[0][ei].vaddr = ei << 29;
|
|
||||||
entry[0][ei].paddr = ei << 29;
|
|
||||||
entry[0][ei].asid = 1;
|
|
||||||
entry[0][ei].attr = 2;
|
|
||||||
entry[0][ei].variable = true;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void reset_mmu(CPUXtensaState *env)
|
|
||||||
{
|
|
||||||
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
|
||||||
env->sregs[RASID] = 0x04030201;
|
|
||||||
env->sregs[ITLBCFG] = 0;
|
|
||||||
env->sregs[DTLBCFG] = 0;
|
|
||||||
env->autorefill_idx = 0;
|
|
||||||
reset_tlb_mmu_all_ways(env, &env->config->itlb, env->itlb);
|
|
||||||
reset_tlb_mmu_all_ways(env, &env->config->dtlb, env->dtlb);
|
|
||||||
reset_tlb_mmu_ways56(env, &env->config->itlb, env->itlb);
|
|
||||||
reset_tlb_mmu_ways56(env, &env->config->dtlb, env->dtlb);
|
|
||||||
} else {
|
|
||||||
reset_tlb_region_way0(env, env->itlb);
|
|
||||||
reset_tlb_region_way0(env, env->dtlb);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static unsigned get_ring(const CPUXtensaState *env, uint8_t asid)
|
|
||||||
{
|
|
||||||
unsigned i;
|
|
||||||
for (i = 0; i < 4; ++i) {
|
|
||||||
if (((env->sregs[RASID] >> i * 8) & 0xff) == asid) {
|
|
||||||
return i;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return 0xff;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* Lookup xtensa TLB for the given virtual address.
|
|
||||||
* See ISA, 4.6.2.2
|
|
||||||
*
|
|
||||||
* \param pwi: [out] way index
|
|
||||||
* \param pei: [out] entry index
|
|
||||||
* \param pring: [out] access ring
|
|
||||||
* \return 0 if ok, exception cause code otherwise
|
|
||||||
*/
|
|
||||||
int xtensa_tlb_lookup(const CPUXtensaState *env, uint32_t addr, bool dtlb,
|
|
||||||
uint32_t *pwi, uint32_t *pei, uint8_t *pring)
|
|
||||||
{
|
|
||||||
const xtensa_tlb *tlb = dtlb ?
|
|
||||||
&env->config->dtlb : &env->config->itlb;
|
|
||||||
const xtensa_tlb_entry (*entry)[MAX_TLB_WAY_SIZE] = dtlb ?
|
|
||||||
env->dtlb : env->itlb;
|
|
||||||
|
|
||||||
int nhits = 0;
|
|
||||||
unsigned wi;
|
|
||||||
|
|
||||||
for (wi = 0; wi < tlb->nways; ++wi) {
|
|
||||||
uint32_t vpn;
|
|
||||||
uint32_t ei;
|
|
||||||
split_tlb_entry_spec_way(env, addr, dtlb, &vpn, wi, &ei);
|
|
||||||
if (entry[wi][ei].vaddr == vpn && entry[wi][ei].asid) {
|
|
||||||
unsigned ring = get_ring(env, entry[wi][ei].asid);
|
|
||||||
if (ring < 4) {
|
|
||||||
if (++nhits > 1) {
|
|
||||||
return dtlb ?
|
|
||||||
LOAD_STORE_TLB_MULTI_HIT_CAUSE :
|
|
||||||
INST_TLB_MULTI_HIT_CAUSE;
|
|
||||||
}
|
|
||||||
*pwi = wi;
|
|
||||||
*pei = ei;
|
|
||||||
*pring = ring;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return nhits ? 0 :
|
|
||||||
(dtlb ? LOAD_STORE_TLB_MISS_CAUSE : INST_TLB_MISS_CAUSE);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* Convert MMU ATTR to PAGE_{READ,WRITE,EXEC} mask.
|
|
||||||
* See ISA, 4.6.5.10
|
|
||||||
*/
|
|
||||||
static unsigned mmu_attr_to_access(uint32_t attr)
|
|
||||||
{
|
|
||||||
unsigned access = 0;
|
|
||||||
|
|
||||||
if (attr < 12) {
|
|
||||||
access |= PAGE_READ;
|
|
||||||
if (attr & 0x1) {
|
|
||||||
access |= PAGE_EXEC;
|
|
||||||
}
|
|
||||||
if (attr & 0x2) {
|
|
||||||
access |= PAGE_WRITE;
|
|
||||||
}
|
|
||||||
|
|
||||||
switch (attr & 0xc) {
|
|
||||||
case 0:
|
|
||||||
access |= PAGE_CACHE_BYPASS;
|
|
||||||
break;
|
|
||||||
|
|
||||||
case 4:
|
|
||||||
access |= PAGE_CACHE_WB;
|
|
||||||
break;
|
|
||||||
|
|
||||||
case 8:
|
|
||||||
access |= PAGE_CACHE_WT;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
} else if (attr == 13) {
|
|
||||||
access |= PAGE_READ | PAGE_WRITE | PAGE_CACHE_ISOLATE;
|
|
||||||
}
|
|
||||||
return access;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* Convert region protection ATTR to PAGE_{READ,WRITE,EXEC} mask.
|
|
||||||
* See ISA, 4.6.3.3
|
|
||||||
*/
|
|
||||||
static unsigned region_attr_to_access(uint32_t attr)
|
|
||||||
{
|
|
||||||
static const unsigned access[16] = {
|
|
||||||
[0] = PAGE_READ | PAGE_WRITE | PAGE_CACHE_WT,
|
|
||||||
[1] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_WT,
|
|
||||||
[2] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_BYPASS,
|
|
||||||
[3] = PAGE_EXEC | PAGE_CACHE_WB,
|
|
||||||
[4] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_WB,
|
|
||||||
[5] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_WB,
|
|
||||||
[14] = PAGE_READ | PAGE_WRITE | PAGE_CACHE_ISOLATE,
|
|
||||||
};
|
|
||||||
|
|
||||||
return access[attr & 0xf];
|
|
||||||
}
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* Convert cacheattr to PAGE_{READ,WRITE,EXEC} mask.
|
|
||||||
* See ISA, A.2.14 The Cache Attribute Register
|
|
||||||
*/
|
|
||||||
static unsigned cacheattr_attr_to_access(uint32_t attr)
|
|
||||||
{
|
|
||||||
static const unsigned access[16] = {
|
|
||||||
[0] = PAGE_READ | PAGE_WRITE | PAGE_CACHE_WT,
|
|
||||||
[1] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_WT,
|
|
||||||
[2] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_BYPASS,
|
|
||||||
[3] = PAGE_EXEC | PAGE_CACHE_WB,
|
|
||||||
[4] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_WB,
|
|
||||||
[14] = PAGE_READ | PAGE_WRITE | PAGE_CACHE_ISOLATE,
|
|
||||||
};
|
|
||||||
|
|
||||||
return access[attr & 0xf];
|
|
||||||
}
|
|
||||||
|
|
||||||
static bool is_access_granted(unsigned access, int is_write)
|
|
||||||
{
|
|
||||||
switch (is_write) {
|
|
||||||
case 0:
|
|
||||||
return access & PAGE_READ;
|
|
||||||
|
|
||||||
case 1:
|
|
||||||
return access & PAGE_WRITE;
|
|
||||||
|
|
||||||
case 2:
|
|
||||||
return access & PAGE_EXEC;
|
|
||||||
|
|
||||||
default:
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static bool get_pte(CPUXtensaState *env, uint32_t vaddr, uint32_t *pte);
|
|
||||||
|
|
||||||
static int get_physical_addr_mmu(CPUXtensaState *env, bool update_tlb,
|
|
||||||
uint32_t vaddr, int is_write, int mmu_idx,
|
|
||||||
uint32_t *paddr, uint32_t *page_size, unsigned *access,
|
|
||||||
bool may_lookup_pt)
|
|
||||||
{
|
|
||||||
bool dtlb = is_write != 2;
|
|
||||||
uint32_t wi;
|
|
||||||
uint32_t ei;
|
|
||||||
uint8_t ring;
|
|
||||||
uint32_t vpn;
|
|
||||||
uint32_t pte;
|
|
||||||
const xtensa_tlb_entry *entry = NULL;
|
|
||||||
xtensa_tlb_entry tmp_entry;
|
|
||||||
int ret = xtensa_tlb_lookup(env, vaddr, dtlb, &wi, &ei, &ring);
|
|
||||||
|
|
||||||
if ((ret == INST_TLB_MISS_CAUSE || ret == LOAD_STORE_TLB_MISS_CAUSE) &&
|
|
||||||
may_lookup_pt && get_pte(env, vaddr, &pte)) {
|
|
||||||
ring = (pte >> 4) & 0x3;
|
|
||||||
wi = 0;
|
|
||||||
split_tlb_entry_spec_way(env, vaddr, dtlb, &vpn, wi, &ei);
|
|
||||||
|
|
||||||
if (update_tlb) {
|
|
||||||
wi = ++env->autorefill_idx & 0x3;
|
|
||||||
xtensa_tlb_set_entry(env, dtlb, wi, ei, vpn, pte);
|
|
||||||
env->sregs[EXCVADDR] = vaddr;
|
|
||||||
qemu_log_mask(CPU_LOG_MMU, "%s: autorefill(%08x): %08x -> %08x\n",
|
|
||||||
__func__, vaddr, vpn, pte);
|
|
||||||
} else {
|
|
||||||
xtensa_tlb_set_entry_mmu(env, &tmp_entry, dtlb, wi, ei, vpn, pte);
|
|
||||||
entry = &tmp_entry;
|
|
||||||
}
|
|
||||||
ret = 0;
|
|
||||||
}
|
|
||||||
if (ret != 0) {
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (entry == NULL) {
|
|
||||||
entry = xtensa_tlb_get_entry(env, dtlb, wi, ei);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (ring < mmu_idx) {
|
|
||||||
return dtlb ?
|
|
||||||
LOAD_STORE_PRIVILEGE_CAUSE :
|
|
||||||
INST_FETCH_PRIVILEGE_CAUSE;
|
|
||||||
}
|
|
||||||
|
|
||||||
*access = mmu_attr_to_access(entry->attr) &
|
|
||||||
~(dtlb ? PAGE_EXEC : PAGE_READ | PAGE_WRITE);
|
|
||||||
if (!is_access_granted(*access, is_write)) {
|
|
||||||
return dtlb ?
|
|
||||||
(is_write ?
|
|
||||||
STORE_PROHIBITED_CAUSE :
|
|
||||||
LOAD_PROHIBITED_CAUSE) :
|
|
||||||
INST_FETCH_PROHIBITED_CAUSE;
|
|
||||||
}
|
|
||||||
|
|
||||||
*paddr = entry->paddr | (vaddr & ~xtensa_tlb_get_addr_mask(env, dtlb, wi));
|
|
||||||
*page_size = ~xtensa_tlb_get_addr_mask(env, dtlb, wi) + 1;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static bool get_pte(CPUXtensaState *env, uint32_t vaddr, uint32_t *pte)
|
|
||||||
{
|
|
||||||
CPUState *cs = CPU(xtensa_env_get_cpu(env));
|
|
||||||
uint32_t paddr;
|
uint32_t paddr;
|
||||||
uint32_t page_size;
|
uint32_t page_size;
|
||||||
unsigned access;
|
unsigned access;
|
||||||
uint32_t pt_vaddr =
|
int ret = xtensa_get_physical_addr(env, true, vaddr, access_type, mmu_idx,
|
||||||
(env->sregs[PTEVADDR] | (vaddr >> 10)) & 0xfffffffc;
|
&paddr, &page_size, &access);
|
||||||
int ret = get_physical_addr_mmu(env, false, pt_vaddr, 0, 0,
|
|
||||||
&paddr, &page_size, &access, false);
|
qemu_log_mask(CPU_LOG_MMU, "%s(%08x, %d, %d) -> %08x, ret = %d\n",
|
||||||
|
__func__, vaddr, access_type, mmu_idx, paddr, ret);
|
||||||
|
|
||||||
if (ret == 0) {
|
if (ret == 0) {
|
||||||
qemu_log_mask(CPU_LOG_MMU,
|
tlb_set_page(cs,
|
||||||
"%s: autorefill(%08x): PTE va = %08x, pa = %08x\n",
|
vaddr & TARGET_PAGE_MASK,
|
||||||
__func__, vaddr, pt_vaddr, paddr);
|
paddr & TARGET_PAGE_MASK,
|
||||||
|
access, mmu_idx, page_size);
|
||||||
} else {
|
} else {
|
||||||
qemu_log_mask(CPU_LOG_MMU,
|
cpu_restore_state(cs, retaddr, true);
|
||||||
"%s: autorefill(%08x): PTE va = %08x, failed (%d)\n",
|
HELPER(exception_cause_vaddr)(env, env->pc, ret, vaddr);
|
||||||
__func__, vaddr, pt_vaddr, ret);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (ret == 0) {
|
|
||||||
MemTxResult result;
|
|
||||||
|
|
||||||
*pte = address_space_ldl(cs->as, paddr, MEMTXATTRS_UNSPECIFIED,
|
|
||||||
&result);
|
|
||||||
if (result != MEMTX_OK) {
|
|
||||||
qemu_log_mask(CPU_LOG_MMU,
|
|
||||||
"%s: couldn't load PTE: transaction failed (%u)\n",
|
|
||||||
__func__, (unsigned)result);
|
|
||||||
ret = 1;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return ret == 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int get_physical_addr_region(CPUXtensaState *env,
|
|
||||||
uint32_t vaddr, int is_write, int mmu_idx,
|
|
||||||
uint32_t *paddr, uint32_t *page_size, unsigned *access)
|
|
||||||
{
|
|
||||||
bool dtlb = is_write != 2;
|
|
||||||
uint32_t wi = 0;
|
|
||||||
uint32_t ei = (vaddr >> 29) & 0x7;
|
|
||||||
const xtensa_tlb_entry *entry =
|
|
||||||
xtensa_tlb_get_entry(env, dtlb, wi, ei);
|
|
||||||
|
|
||||||
*access = region_attr_to_access(entry->attr);
|
|
||||||
if (!is_access_granted(*access, is_write)) {
|
|
||||||
return dtlb ?
|
|
||||||
(is_write ?
|
|
||||||
STORE_PROHIBITED_CAUSE :
|
|
||||||
LOAD_PROHIBITED_CAUSE) :
|
|
||||||
INST_FETCH_PROHIBITED_CAUSE;
|
|
||||||
}
|
|
||||||
|
|
||||||
*paddr = entry->paddr | (vaddr & ~REGION_PAGE_MASK);
|
|
||||||
*page_size = ~REGION_PAGE_MASK + 1;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* Convert virtual address to physical addr.
|
|
||||||
* MMU may issue pagewalk and change xtensa autorefill TLB way entry.
|
|
||||||
*
|
|
||||||
* \return 0 if ok, exception cause code otherwise
|
|
||||||
*/
|
|
||||||
int xtensa_get_physical_addr(CPUXtensaState *env, bool update_tlb,
|
|
||||||
uint32_t vaddr, int is_write, int mmu_idx,
|
|
||||||
uint32_t *paddr, uint32_t *page_size, unsigned *access)
|
|
||||||
{
|
|
||||||
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
|
||||||
return get_physical_addr_mmu(env, update_tlb,
|
|
||||||
vaddr, is_write, mmu_idx, paddr, page_size, access, true);
|
|
||||||
} else if (xtensa_option_bits_enabled(env->config,
|
|
||||||
XTENSA_OPTION_BIT(XTENSA_OPTION_REGION_PROTECTION) |
|
|
||||||
XTENSA_OPTION_BIT(XTENSA_OPTION_REGION_TRANSLATION))) {
|
|
||||||
return get_physical_addr_region(env, vaddr, is_write, mmu_idx,
|
|
||||||
paddr, page_size, access);
|
|
||||||
} else {
|
|
||||||
*paddr = vaddr;
|
|
||||||
*page_size = TARGET_PAGE_SIZE;
|
|
||||||
*access = cacheattr_attr_to_access(
|
|
||||||
env->sregs[CACHEATTR] >> ((vaddr & 0xe0000000) >> 27));
|
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static void dump_tlb(FILE *f, fprintf_function cpu_fprintf,
|
void xtensa_cpu_do_transaction_failed(CPUState *cs, hwaddr physaddr, vaddr addr,
|
||||||
CPUXtensaState *env, bool dtlb)
|
unsigned size, MMUAccessType access_type,
|
||||||
|
int mmu_idx, MemTxAttrs attrs,
|
||||||
|
MemTxResult response, uintptr_t retaddr)
|
||||||
{
|
{
|
||||||
unsigned wi, ei;
|
XtensaCPU *cpu = XTENSA_CPU(cs);
|
||||||
const xtensa_tlb *conf =
|
CPUXtensaState *env = &cpu->env;
|
||||||
dtlb ? &env->config->dtlb : &env->config->itlb;
|
|
||||||
unsigned (*attr_to_access)(uint32_t) =
|
|
||||||
xtensa_option_enabled(env->config, XTENSA_OPTION_MMU) ?
|
|
||||||
mmu_attr_to_access : region_attr_to_access;
|
|
||||||
|
|
||||||
for (wi = 0; wi < conf->nways; ++wi) {
|
cpu_restore_state(cs, retaddr, true);
|
||||||
uint32_t sz = ~xtensa_tlb_get_addr_mask(env, dtlb, wi) + 1;
|
HELPER(exception_cause_vaddr)(env, env->pc,
|
||||||
const char *sz_text;
|
access_type == MMU_INST_FETCH ?
|
||||||
bool print_header = true;
|
INSTR_PIF_ADDR_ERROR_CAUSE :
|
||||||
|
LOAD_STORE_PIF_ADDR_ERROR_CAUSE,
|
||||||
if (sz >= 0x100000) {
|
addr);
|
||||||
sz /= MiB;
|
|
||||||
sz_text = "MB";
|
|
||||||
} else {
|
|
||||||
sz /= KiB;
|
|
||||||
sz_text = "KB";
|
|
||||||
}
|
|
||||||
|
|
||||||
for (ei = 0; ei < conf->way_size[wi]; ++ei) {
|
|
||||||
const xtensa_tlb_entry *entry =
|
|
||||||
xtensa_tlb_get_entry(env, dtlb, wi, ei);
|
|
||||||
|
|
||||||
if (entry->asid) {
|
|
||||||
static const char * const cache_text[8] = {
|
|
||||||
[PAGE_CACHE_BYPASS >> PAGE_CACHE_SHIFT] = "Bypass",
|
|
||||||
[PAGE_CACHE_WT >> PAGE_CACHE_SHIFT] = "WT",
|
|
||||||
[PAGE_CACHE_WB >> PAGE_CACHE_SHIFT] = "WB",
|
|
||||||
[PAGE_CACHE_ISOLATE >> PAGE_CACHE_SHIFT] = "Isolate",
|
|
||||||
};
|
|
||||||
unsigned access = attr_to_access(entry->attr);
|
|
||||||
unsigned cache_idx = (access & PAGE_CACHE_MASK) >>
|
|
||||||
PAGE_CACHE_SHIFT;
|
|
||||||
|
|
||||||
if (print_header) {
|
|
||||||
print_header = false;
|
|
||||||
cpu_fprintf(f, "Way %u (%d %s)\n", wi, sz, sz_text);
|
|
||||||
cpu_fprintf(f,
|
|
||||||
"\tVaddr Paddr ASID Attr RWX Cache\n"
|
|
||||||
"\t---------- ---------- ---- ---- --- -------\n");
|
|
||||||
}
|
|
||||||
cpu_fprintf(f,
|
|
||||||
"\t0x%08x 0x%08x 0x%02x 0x%02x %c%c%c %-7s\n",
|
|
||||||
entry->vaddr,
|
|
||||||
entry->paddr,
|
|
||||||
entry->asid,
|
|
||||||
entry->attr,
|
|
||||||
(access & PAGE_READ) ? 'R' : '-',
|
|
||||||
(access & PAGE_WRITE) ? 'W' : '-',
|
|
||||||
(access & PAGE_EXEC) ? 'X' : '-',
|
|
||||||
cache_text[cache_idx] ? cache_text[cache_idx] :
|
|
||||||
"Invalid");
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void dump_mmu(FILE *f, fprintf_function cpu_fprintf, CPUXtensaState *env)
|
|
||||||
{
|
|
||||||
if (xtensa_option_bits_enabled(env->config,
|
|
||||||
XTENSA_OPTION_BIT(XTENSA_OPTION_REGION_PROTECTION) |
|
|
||||||
XTENSA_OPTION_BIT(XTENSA_OPTION_REGION_TRANSLATION) |
|
|
||||||
XTENSA_OPTION_BIT(XTENSA_OPTION_MMU))) {
|
|
||||||
|
|
||||||
cpu_fprintf(f, "ITLB:\n");
|
|
||||||
dump_tlb(f, cpu_fprintf, env, false);
|
|
||||||
cpu_fprintf(f, "\nDTLB:\n");
|
|
||||||
dump_tlb(f, cpu_fprintf, env, true);
|
|
||||||
} else {
|
|
||||||
cpu_fprintf(f, "No TLB for this CPU core\n");
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void xtensa_runstall(CPUXtensaState *env, bool runstall)
|
void xtensa_runstall(CPUXtensaState *env, bool runstall)
|
||||||
|
|||||||
@ -12,12 +12,9 @@ DEF_HELPER_2(rotw, void, env, i32)
|
|||||||
DEF_HELPER_3(window_check, noreturn, env, i32, i32)
|
DEF_HELPER_3(window_check, noreturn, env, i32, i32)
|
||||||
DEF_HELPER_1(restore_owb, void, env)
|
DEF_HELPER_1(restore_owb, void, env)
|
||||||
DEF_HELPER_2(movsp, void, env, i32)
|
DEF_HELPER_2(movsp, void, env, i32)
|
||||||
DEF_HELPER_2(wsr_lbeg, void, env, i32)
|
|
||||||
DEF_HELPER_2(wsr_lend, void, env, i32)
|
|
||||||
#ifndef CONFIG_USER_ONLY
|
#ifndef CONFIG_USER_ONLY
|
||||||
DEF_HELPER_1(simcall, void, env)
|
DEF_HELPER_1(simcall, void, env)
|
||||||
#endif
|
#endif
|
||||||
DEF_HELPER_1(dump_state, void, env)
|
|
||||||
|
|
||||||
#ifndef CONFIG_USER_ONLY
|
#ifndef CONFIG_USER_ONLY
|
||||||
DEF_HELPER_3(waiti, void, env, i32, i32)
|
DEF_HELPER_3(waiti, void, env, i32, i32)
|
||||||
|
|||||||
818
target/xtensa/mmu_helper.c
Normal file
818
target/xtensa/mmu_helper.c
Normal file
@ -0,0 +1,818 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (c) 2011 - 2019, Max Filippov, Open Source and Linux Lab.
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions are met:
|
||||||
|
* * Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* * Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* * Neither the name of the Open Source and Linux Lab nor the
|
||||||
|
* names of its contributors may be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||||
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||||
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||||
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
|
||||||
|
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
||||||
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
||||||
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
|
||||||
|
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||||||
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "qemu/osdep.h"
|
||||||
|
#include "qemu/main-loop.h"
|
||||||
|
#include "qemu/units.h"
|
||||||
|
#include "cpu.h"
|
||||||
|
#include "exec/helper-proto.h"
|
||||||
|
#include "qemu/host-utils.h"
|
||||||
|
#include "exec/exec-all.h"
|
||||||
|
#include "exec/cpu_ldst.h"
|
||||||
|
|
||||||
|
void HELPER(itlb_hit_test)(CPUXtensaState *env, uint32_t vaddr)
|
||||||
|
{
|
||||||
|
/*
|
||||||
|
* Attempt the memory load; we don't care about the result but
|
||||||
|
* only the side-effects (ie any MMU or other exception)
|
||||||
|
*/
|
||||||
|
cpu_ldub_code_ra(env, vaddr, GETPC());
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(wsr_rasid)(CPUXtensaState *env, uint32_t v)
|
||||||
|
{
|
||||||
|
XtensaCPU *cpu = xtensa_env_get_cpu(env);
|
||||||
|
|
||||||
|
v = (v & 0xffffff00) | 0x1;
|
||||||
|
if (v != env->sregs[RASID]) {
|
||||||
|
env->sregs[RASID] = v;
|
||||||
|
tlb_flush(CPU(cpu));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static uint32_t get_page_size(const CPUXtensaState *env,
|
||||||
|
bool dtlb, uint32_t way)
|
||||||
|
{
|
||||||
|
uint32_t tlbcfg = env->sregs[dtlb ? DTLBCFG : ITLBCFG];
|
||||||
|
|
||||||
|
switch (way) {
|
||||||
|
case 4:
|
||||||
|
return (tlbcfg >> 16) & 0x3;
|
||||||
|
|
||||||
|
case 5:
|
||||||
|
return (tlbcfg >> 20) & 0x1;
|
||||||
|
|
||||||
|
case 6:
|
||||||
|
return (tlbcfg >> 24) & 0x1;
|
||||||
|
|
||||||
|
default:
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* Get bit mask for the virtual address bits translated by the TLB way
|
||||||
|
*/
|
||||||
|
uint32_t xtensa_tlb_get_addr_mask(const CPUXtensaState *env,
|
||||||
|
bool dtlb, uint32_t way)
|
||||||
|
{
|
||||||
|
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
||||||
|
bool varway56 = dtlb ?
|
||||||
|
env->config->dtlb.varway56 :
|
||||||
|
env->config->itlb.varway56;
|
||||||
|
|
||||||
|
switch (way) {
|
||||||
|
case 4:
|
||||||
|
return 0xfff00000 << get_page_size(env, dtlb, way) * 2;
|
||||||
|
|
||||||
|
case 5:
|
||||||
|
if (varway56) {
|
||||||
|
return 0xf8000000 << get_page_size(env, dtlb, way);
|
||||||
|
} else {
|
||||||
|
return 0xf8000000;
|
||||||
|
}
|
||||||
|
|
||||||
|
case 6:
|
||||||
|
if (varway56) {
|
||||||
|
return 0xf0000000 << (1 - get_page_size(env, dtlb, way));
|
||||||
|
} else {
|
||||||
|
return 0xf0000000;
|
||||||
|
}
|
||||||
|
|
||||||
|
default:
|
||||||
|
return 0xfffff000;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
return REGION_PAGE_MASK;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* Get bit mask for the 'VPN without index' field.
|
||||||
|
* See ISA, 4.6.5.6, data format for RxTLB0
|
||||||
|
*/
|
||||||
|
static uint32_t get_vpn_mask(const CPUXtensaState *env, bool dtlb, uint32_t way)
|
||||||
|
{
|
||||||
|
if (way < 4) {
|
||||||
|
bool is32 = (dtlb ?
|
||||||
|
env->config->dtlb.nrefillentries :
|
||||||
|
env->config->itlb.nrefillentries) == 32;
|
||||||
|
return is32 ? 0xffff8000 : 0xffffc000;
|
||||||
|
} else if (way == 4) {
|
||||||
|
return xtensa_tlb_get_addr_mask(env, dtlb, way) << 2;
|
||||||
|
} else if (way <= 6) {
|
||||||
|
uint32_t mask = xtensa_tlb_get_addr_mask(env, dtlb, way);
|
||||||
|
bool varway56 = dtlb ?
|
||||||
|
env->config->dtlb.varway56 :
|
||||||
|
env->config->itlb.varway56;
|
||||||
|
|
||||||
|
if (varway56) {
|
||||||
|
return mask << (way == 5 ? 2 : 3);
|
||||||
|
} else {
|
||||||
|
return mask << 1;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
return 0xfffff000;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* Split virtual address into VPN (with index) and entry index
|
||||||
|
* for the given TLB way
|
||||||
|
*/
|
||||||
|
void split_tlb_entry_spec_way(const CPUXtensaState *env, uint32_t v, bool dtlb,
|
||||||
|
uint32_t *vpn, uint32_t wi, uint32_t *ei)
|
||||||
|
{
|
||||||
|
bool varway56 = dtlb ?
|
||||||
|
env->config->dtlb.varway56 :
|
||||||
|
env->config->itlb.varway56;
|
||||||
|
|
||||||
|
if (!dtlb) {
|
||||||
|
wi &= 7;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (wi < 4) {
|
||||||
|
bool is32 = (dtlb ?
|
||||||
|
env->config->dtlb.nrefillentries :
|
||||||
|
env->config->itlb.nrefillentries) == 32;
|
||||||
|
*ei = (v >> 12) & (is32 ? 0x7 : 0x3);
|
||||||
|
} else {
|
||||||
|
switch (wi) {
|
||||||
|
case 4:
|
||||||
|
{
|
||||||
|
uint32_t eibase = 20 + get_page_size(env, dtlb, wi) * 2;
|
||||||
|
*ei = (v >> eibase) & 0x3;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case 5:
|
||||||
|
if (varway56) {
|
||||||
|
uint32_t eibase = 27 + get_page_size(env, dtlb, wi);
|
||||||
|
*ei = (v >> eibase) & 0x3;
|
||||||
|
} else {
|
||||||
|
*ei = (v >> 27) & 0x1;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case 6:
|
||||||
|
if (varway56) {
|
||||||
|
uint32_t eibase = 29 - get_page_size(env, dtlb, wi);
|
||||||
|
*ei = (v >> eibase) & 0x7;
|
||||||
|
} else {
|
||||||
|
*ei = (v >> 28) & 0x1;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
*ei = 0;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
*vpn = v & xtensa_tlb_get_addr_mask(env, dtlb, wi);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* Split TLB address into TLB way, entry index and VPN (with index).
|
||||||
|
* See ISA, 4.6.5.5 - 4.6.5.8 for the TLB addressing format
|
||||||
|
*/
|
||||||
|
static void split_tlb_entry_spec(CPUXtensaState *env, uint32_t v, bool dtlb,
|
||||||
|
uint32_t *vpn, uint32_t *wi, uint32_t *ei)
|
||||||
|
{
|
||||||
|
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
||||||
|
*wi = v & (dtlb ? 0xf : 0x7);
|
||||||
|
split_tlb_entry_spec_way(env, v, dtlb, vpn, *wi, ei);
|
||||||
|
} else {
|
||||||
|
*vpn = v & REGION_PAGE_MASK;
|
||||||
|
*wi = 0;
|
||||||
|
*ei = (v >> 29) & 0x7;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static xtensa_tlb_entry *get_tlb_entry(CPUXtensaState *env,
|
||||||
|
uint32_t v, bool dtlb, uint32_t *pwi)
|
||||||
|
{
|
||||||
|
uint32_t vpn;
|
||||||
|
uint32_t wi;
|
||||||
|
uint32_t ei;
|
||||||
|
|
||||||
|
split_tlb_entry_spec(env, v, dtlb, &vpn, &wi, &ei);
|
||||||
|
if (pwi) {
|
||||||
|
*pwi = wi;
|
||||||
|
}
|
||||||
|
return xtensa_tlb_get_entry(env, dtlb, wi, ei);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t HELPER(rtlb0)(CPUXtensaState *env, uint32_t v, uint32_t dtlb)
|
||||||
|
{
|
||||||
|
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
||||||
|
uint32_t wi;
|
||||||
|
const xtensa_tlb_entry *entry = get_tlb_entry(env, v, dtlb, &wi);
|
||||||
|
return (entry->vaddr & get_vpn_mask(env, dtlb, wi)) | entry->asid;
|
||||||
|
} else {
|
||||||
|
return v & REGION_PAGE_MASK;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t HELPER(rtlb1)(CPUXtensaState *env, uint32_t v, uint32_t dtlb)
|
||||||
|
{
|
||||||
|
const xtensa_tlb_entry *entry = get_tlb_entry(env, v, dtlb, NULL);
|
||||||
|
return entry->paddr | entry->attr;
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(itlb)(CPUXtensaState *env, uint32_t v, uint32_t dtlb)
|
||||||
|
{
|
||||||
|
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
||||||
|
uint32_t wi;
|
||||||
|
xtensa_tlb_entry *entry = get_tlb_entry(env, v, dtlb, &wi);
|
||||||
|
if (entry->variable && entry->asid) {
|
||||||
|
tlb_flush_page(CPU(xtensa_env_get_cpu(env)), entry->vaddr);
|
||||||
|
entry->asid = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t HELPER(ptlb)(CPUXtensaState *env, uint32_t v, uint32_t dtlb)
|
||||||
|
{
|
||||||
|
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
||||||
|
uint32_t wi;
|
||||||
|
uint32_t ei;
|
||||||
|
uint8_t ring;
|
||||||
|
int res = xtensa_tlb_lookup(env, v, dtlb, &wi, &ei, &ring);
|
||||||
|
|
||||||
|
switch (res) {
|
||||||
|
case 0:
|
||||||
|
if (ring >= xtensa_get_ring(env)) {
|
||||||
|
return (v & 0xfffff000) | wi | (dtlb ? 0x10 : 0x8);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case INST_TLB_MULTI_HIT_CAUSE:
|
||||||
|
case LOAD_STORE_TLB_MULTI_HIT_CAUSE:
|
||||||
|
HELPER(exception_cause_vaddr)(env, env->pc, res, v);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
} else {
|
||||||
|
return (v & REGION_PAGE_MASK) | 0x1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void xtensa_tlb_set_entry_mmu(const CPUXtensaState *env,
|
||||||
|
xtensa_tlb_entry *entry, bool dtlb,
|
||||||
|
unsigned wi, unsigned ei, uint32_t vpn,
|
||||||
|
uint32_t pte)
|
||||||
|
{
|
||||||
|
entry->vaddr = vpn;
|
||||||
|
entry->paddr = pte & xtensa_tlb_get_addr_mask(env, dtlb, wi);
|
||||||
|
entry->asid = (env->sregs[RASID] >> ((pte >> 1) & 0x18)) & 0xff;
|
||||||
|
entry->attr = pte & 0xf;
|
||||||
|
}
|
||||||
|
|
||||||
|
void xtensa_tlb_set_entry(CPUXtensaState *env, bool dtlb,
|
||||||
|
unsigned wi, unsigned ei, uint32_t vpn, uint32_t pte)
|
||||||
|
{
|
||||||
|
XtensaCPU *cpu = xtensa_env_get_cpu(env);
|
||||||
|
CPUState *cs = CPU(cpu);
|
||||||
|
xtensa_tlb_entry *entry = xtensa_tlb_get_entry(env, dtlb, wi, ei);
|
||||||
|
|
||||||
|
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
||||||
|
if (entry->variable) {
|
||||||
|
if (entry->asid) {
|
||||||
|
tlb_flush_page(cs, entry->vaddr);
|
||||||
|
}
|
||||||
|
xtensa_tlb_set_entry_mmu(env, entry, dtlb, wi, ei, vpn, pte);
|
||||||
|
tlb_flush_page(cs, entry->vaddr);
|
||||||
|
} else {
|
||||||
|
qemu_log_mask(LOG_GUEST_ERROR,
|
||||||
|
"%s %d, %d, %d trying to set immutable entry\n",
|
||||||
|
__func__, dtlb, wi, ei);
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
tlb_flush_page(cs, entry->vaddr);
|
||||||
|
if (xtensa_option_enabled(env->config,
|
||||||
|
XTENSA_OPTION_REGION_TRANSLATION)) {
|
||||||
|
entry->paddr = pte & REGION_PAGE_MASK;
|
||||||
|
}
|
||||||
|
entry->attr = pte & 0xf;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(wtlb)(CPUXtensaState *env, uint32_t p, uint32_t v, uint32_t dtlb)
|
||||||
|
{
|
||||||
|
uint32_t vpn;
|
||||||
|
uint32_t wi;
|
||||||
|
uint32_t ei;
|
||||||
|
split_tlb_entry_spec(env, v, dtlb, &vpn, &wi, &ei);
|
||||||
|
xtensa_tlb_set_entry(env, dtlb, wi, ei, vpn, p);
|
||||||
|
}
|
||||||
|
|
||||||
|
hwaddr xtensa_cpu_get_phys_page_debug(CPUState *cs, vaddr addr)
|
||||||
|
{
|
||||||
|
XtensaCPU *cpu = XTENSA_CPU(cs);
|
||||||
|
uint32_t paddr;
|
||||||
|
uint32_t page_size;
|
||||||
|
unsigned access;
|
||||||
|
|
||||||
|
if (xtensa_get_physical_addr(&cpu->env, false, addr, 0, 0,
|
||||||
|
&paddr, &page_size, &access) == 0) {
|
||||||
|
return paddr;
|
||||||
|
}
|
||||||
|
if (xtensa_get_physical_addr(&cpu->env, false, addr, 2, 0,
|
||||||
|
&paddr, &page_size, &access) == 0) {
|
||||||
|
return paddr;
|
||||||
|
}
|
||||||
|
return ~0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void reset_tlb_mmu_all_ways(CPUXtensaState *env,
|
||||||
|
const xtensa_tlb *tlb,
|
||||||
|
xtensa_tlb_entry entry[][MAX_TLB_WAY_SIZE])
|
||||||
|
{
|
||||||
|
unsigned wi, ei;
|
||||||
|
|
||||||
|
for (wi = 0; wi < tlb->nways; ++wi) {
|
||||||
|
for (ei = 0; ei < tlb->way_size[wi]; ++ei) {
|
||||||
|
entry[wi][ei].asid = 0;
|
||||||
|
entry[wi][ei].variable = true;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void reset_tlb_mmu_ways56(CPUXtensaState *env,
|
||||||
|
const xtensa_tlb *tlb,
|
||||||
|
xtensa_tlb_entry entry[][MAX_TLB_WAY_SIZE])
|
||||||
|
{
|
||||||
|
if (!tlb->varway56) {
|
||||||
|
static const xtensa_tlb_entry way5[] = {
|
||||||
|
{
|
||||||
|
.vaddr = 0xd0000000,
|
||||||
|
.paddr = 0,
|
||||||
|
.asid = 1,
|
||||||
|
.attr = 7,
|
||||||
|
.variable = false,
|
||||||
|
}, {
|
||||||
|
.vaddr = 0xd8000000,
|
||||||
|
.paddr = 0,
|
||||||
|
.asid = 1,
|
||||||
|
.attr = 3,
|
||||||
|
.variable = false,
|
||||||
|
}
|
||||||
|
};
|
||||||
|
static const xtensa_tlb_entry way6[] = {
|
||||||
|
{
|
||||||
|
.vaddr = 0xe0000000,
|
||||||
|
.paddr = 0xf0000000,
|
||||||
|
.asid = 1,
|
||||||
|
.attr = 7,
|
||||||
|
.variable = false,
|
||||||
|
}, {
|
||||||
|
.vaddr = 0xf0000000,
|
||||||
|
.paddr = 0xf0000000,
|
||||||
|
.asid = 1,
|
||||||
|
.attr = 3,
|
||||||
|
.variable = false,
|
||||||
|
}
|
||||||
|
};
|
||||||
|
memcpy(entry[5], way5, sizeof(way5));
|
||||||
|
memcpy(entry[6], way6, sizeof(way6));
|
||||||
|
} else {
|
||||||
|
uint32_t ei;
|
||||||
|
for (ei = 0; ei < 8; ++ei) {
|
||||||
|
entry[6][ei].vaddr = ei << 29;
|
||||||
|
entry[6][ei].paddr = ei << 29;
|
||||||
|
entry[6][ei].asid = 1;
|
||||||
|
entry[6][ei].attr = 3;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void reset_tlb_region_way0(CPUXtensaState *env,
|
||||||
|
xtensa_tlb_entry entry[][MAX_TLB_WAY_SIZE])
|
||||||
|
{
|
||||||
|
unsigned ei;
|
||||||
|
|
||||||
|
for (ei = 0; ei < 8; ++ei) {
|
||||||
|
entry[0][ei].vaddr = ei << 29;
|
||||||
|
entry[0][ei].paddr = ei << 29;
|
||||||
|
entry[0][ei].asid = 1;
|
||||||
|
entry[0][ei].attr = 2;
|
||||||
|
entry[0][ei].variable = true;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void reset_mmu(CPUXtensaState *env)
|
||||||
|
{
|
||||||
|
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
||||||
|
env->sregs[RASID] = 0x04030201;
|
||||||
|
env->sregs[ITLBCFG] = 0;
|
||||||
|
env->sregs[DTLBCFG] = 0;
|
||||||
|
env->autorefill_idx = 0;
|
||||||
|
reset_tlb_mmu_all_ways(env, &env->config->itlb, env->itlb);
|
||||||
|
reset_tlb_mmu_all_ways(env, &env->config->dtlb, env->dtlb);
|
||||||
|
reset_tlb_mmu_ways56(env, &env->config->itlb, env->itlb);
|
||||||
|
reset_tlb_mmu_ways56(env, &env->config->dtlb, env->dtlb);
|
||||||
|
} else {
|
||||||
|
reset_tlb_region_way0(env, env->itlb);
|
||||||
|
reset_tlb_region_way0(env, env->dtlb);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static unsigned get_ring(const CPUXtensaState *env, uint8_t asid)
|
||||||
|
{
|
||||||
|
unsigned i;
|
||||||
|
for (i = 0; i < 4; ++i) {
|
||||||
|
if (((env->sregs[RASID] >> i * 8) & 0xff) == asid) {
|
||||||
|
return i;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return 0xff;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* Lookup xtensa TLB for the given virtual address.
|
||||||
|
* See ISA, 4.6.2.2
|
||||||
|
*
|
||||||
|
* \param pwi: [out] way index
|
||||||
|
* \param pei: [out] entry index
|
||||||
|
* \param pring: [out] access ring
|
||||||
|
* \return 0 if ok, exception cause code otherwise
|
||||||
|
*/
|
||||||
|
int xtensa_tlb_lookup(const CPUXtensaState *env, uint32_t addr, bool dtlb,
|
||||||
|
uint32_t *pwi, uint32_t *pei, uint8_t *pring)
|
||||||
|
{
|
||||||
|
const xtensa_tlb *tlb = dtlb ?
|
||||||
|
&env->config->dtlb : &env->config->itlb;
|
||||||
|
const xtensa_tlb_entry (*entry)[MAX_TLB_WAY_SIZE] = dtlb ?
|
||||||
|
env->dtlb : env->itlb;
|
||||||
|
|
||||||
|
int nhits = 0;
|
||||||
|
unsigned wi;
|
||||||
|
|
||||||
|
for (wi = 0; wi < tlb->nways; ++wi) {
|
||||||
|
uint32_t vpn;
|
||||||
|
uint32_t ei;
|
||||||
|
split_tlb_entry_spec_way(env, addr, dtlb, &vpn, wi, &ei);
|
||||||
|
if (entry[wi][ei].vaddr == vpn && entry[wi][ei].asid) {
|
||||||
|
unsigned ring = get_ring(env, entry[wi][ei].asid);
|
||||||
|
if (ring < 4) {
|
||||||
|
if (++nhits > 1) {
|
||||||
|
return dtlb ?
|
||||||
|
LOAD_STORE_TLB_MULTI_HIT_CAUSE :
|
||||||
|
INST_TLB_MULTI_HIT_CAUSE;
|
||||||
|
}
|
||||||
|
*pwi = wi;
|
||||||
|
*pei = ei;
|
||||||
|
*pring = ring;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return nhits ? 0 :
|
||||||
|
(dtlb ? LOAD_STORE_TLB_MISS_CAUSE : INST_TLB_MISS_CAUSE);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* Convert MMU ATTR to PAGE_{READ,WRITE,EXEC} mask.
|
||||||
|
* See ISA, 4.6.5.10
|
||||||
|
*/
|
||||||
|
static unsigned mmu_attr_to_access(uint32_t attr)
|
||||||
|
{
|
||||||
|
unsigned access = 0;
|
||||||
|
|
||||||
|
if (attr < 12) {
|
||||||
|
access |= PAGE_READ;
|
||||||
|
if (attr & 0x1) {
|
||||||
|
access |= PAGE_EXEC;
|
||||||
|
}
|
||||||
|
if (attr & 0x2) {
|
||||||
|
access |= PAGE_WRITE;
|
||||||
|
}
|
||||||
|
|
||||||
|
switch (attr & 0xc) {
|
||||||
|
case 0:
|
||||||
|
access |= PAGE_CACHE_BYPASS;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case 4:
|
||||||
|
access |= PAGE_CACHE_WB;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case 8:
|
||||||
|
access |= PAGE_CACHE_WT;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
} else if (attr == 13) {
|
||||||
|
access |= PAGE_READ | PAGE_WRITE | PAGE_CACHE_ISOLATE;
|
||||||
|
}
|
||||||
|
return access;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* Convert region protection ATTR to PAGE_{READ,WRITE,EXEC} mask.
|
||||||
|
* See ISA, 4.6.3.3
|
||||||
|
*/
|
||||||
|
static unsigned region_attr_to_access(uint32_t attr)
|
||||||
|
{
|
||||||
|
static const unsigned access[16] = {
|
||||||
|
[0] = PAGE_READ | PAGE_WRITE | PAGE_CACHE_WT,
|
||||||
|
[1] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_WT,
|
||||||
|
[2] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_BYPASS,
|
||||||
|
[3] = PAGE_EXEC | PAGE_CACHE_WB,
|
||||||
|
[4] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_WB,
|
||||||
|
[5] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_WB,
|
||||||
|
[14] = PAGE_READ | PAGE_WRITE | PAGE_CACHE_ISOLATE,
|
||||||
|
};
|
||||||
|
|
||||||
|
return access[attr & 0xf];
|
||||||
|
}
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* Convert cacheattr to PAGE_{READ,WRITE,EXEC} mask.
|
||||||
|
* See ISA, A.2.14 The Cache Attribute Register
|
||||||
|
*/
|
||||||
|
static unsigned cacheattr_attr_to_access(uint32_t attr)
|
||||||
|
{
|
||||||
|
static const unsigned access[16] = {
|
||||||
|
[0] = PAGE_READ | PAGE_WRITE | PAGE_CACHE_WT,
|
||||||
|
[1] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_WT,
|
||||||
|
[2] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_BYPASS,
|
||||||
|
[3] = PAGE_EXEC | PAGE_CACHE_WB,
|
||||||
|
[4] = PAGE_READ | PAGE_WRITE | PAGE_EXEC | PAGE_CACHE_WB,
|
||||||
|
[14] = PAGE_READ | PAGE_WRITE | PAGE_CACHE_ISOLATE,
|
||||||
|
};
|
||||||
|
|
||||||
|
return access[attr & 0xf];
|
||||||
|
}
|
||||||
|
|
||||||
|
static bool is_access_granted(unsigned access, int is_write)
|
||||||
|
{
|
||||||
|
switch (is_write) {
|
||||||
|
case 0:
|
||||||
|
return access & PAGE_READ;
|
||||||
|
|
||||||
|
case 1:
|
||||||
|
return access & PAGE_WRITE;
|
||||||
|
|
||||||
|
case 2:
|
||||||
|
return access & PAGE_EXEC;
|
||||||
|
|
||||||
|
default:
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static bool get_pte(CPUXtensaState *env, uint32_t vaddr, uint32_t *pte);
|
||||||
|
|
||||||
|
static int get_physical_addr_mmu(CPUXtensaState *env, bool update_tlb,
|
||||||
|
uint32_t vaddr, int is_write, int mmu_idx,
|
||||||
|
uint32_t *paddr, uint32_t *page_size,
|
||||||
|
unsigned *access, bool may_lookup_pt)
|
||||||
|
{
|
||||||
|
bool dtlb = is_write != 2;
|
||||||
|
uint32_t wi;
|
||||||
|
uint32_t ei;
|
||||||
|
uint8_t ring;
|
||||||
|
uint32_t vpn;
|
||||||
|
uint32_t pte;
|
||||||
|
const xtensa_tlb_entry *entry = NULL;
|
||||||
|
xtensa_tlb_entry tmp_entry;
|
||||||
|
int ret = xtensa_tlb_lookup(env, vaddr, dtlb, &wi, &ei, &ring);
|
||||||
|
|
||||||
|
if ((ret == INST_TLB_MISS_CAUSE || ret == LOAD_STORE_TLB_MISS_CAUSE) &&
|
||||||
|
may_lookup_pt && get_pte(env, vaddr, &pte)) {
|
||||||
|
ring = (pte >> 4) & 0x3;
|
||||||
|
wi = 0;
|
||||||
|
split_tlb_entry_spec_way(env, vaddr, dtlb, &vpn, wi, &ei);
|
||||||
|
|
||||||
|
if (update_tlb) {
|
||||||
|
wi = ++env->autorefill_idx & 0x3;
|
||||||
|
xtensa_tlb_set_entry(env, dtlb, wi, ei, vpn, pte);
|
||||||
|
env->sregs[EXCVADDR] = vaddr;
|
||||||
|
qemu_log_mask(CPU_LOG_MMU, "%s: autorefill(%08x): %08x -> %08x\n",
|
||||||
|
__func__, vaddr, vpn, pte);
|
||||||
|
} else {
|
||||||
|
xtensa_tlb_set_entry_mmu(env, &tmp_entry, dtlb, wi, ei, vpn, pte);
|
||||||
|
entry = &tmp_entry;
|
||||||
|
}
|
||||||
|
ret = 0;
|
||||||
|
}
|
||||||
|
if (ret != 0) {
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (entry == NULL) {
|
||||||
|
entry = xtensa_tlb_get_entry(env, dtlb, wi, ei);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ring < mmu_idx) {
|
||||||
|
return dtlb ?
|
||||||
|
LOAD_STORE_PRIVILEGE_CAUSE :
|
||||||
|
INST_FETCH_PRIVILEGE_CAUSE;
|
||||||
|
}
|
||||||
|
|
||||||
|
*access = mmu_attr_to_access(entry->attr) &
|
||||||
|
~(dtlb ? PAGE_EXEC : PAGE_READ | PAGE_WRITE);
|
||||||
|
if (!is_access_granted(*access, is_write)) {
|
||||||
|
return dtlb ?
|
||||||
|
(is_write ?
|
||||||
|
STORE_PROHIBITED_CAUSE :
|
||||||
|
LOAD_PROHIBITED_CAUSE) :
|
||||||
|
INST_FETCH_PROHIBITED_CAUSE;
|
||||||
|
}
|
||||||
|
|
||||||
|
*paddr = entry->paddr | (vaddr & ~xtensa_tlb_get_addr_mask(env, dtlb, wi));
|
||||||
|
*page_size = ~xtensa_tlb_get_addr_mask(env, dtlb, wi) + 1;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static bool get_pte(CPUXtensaState *env, uint32_t vaddr, uint32_t *pte)
|
||||||
|
{
|
||||||
|
CPUState *cs = CPU(xtensa_env_get_cpu(env));
|
||||||
|
uint32_t paddr;
|
||||||
|
uint32_t page_size;
|
||||||
|
unsigned access;
|
||||||
|
uint32_t pt_vaddr =
|
||||||
|
(env->sregs[PTEVADDR] | (vaddr >> 10)) & 0xfffffffc;
|
||||||
|
int ret = get_physical_addr_mmu(env, false, pt_vaddr, 0, 0,
|
||||||
|
&paddr, &page_size, &access, false);
|
||||||
|
|
||||||
|
if (ret == 0) {
|
||||||
|
qemu_log_mask(CPU_LOG_MMU,
|
||||||
|
"%s: autorefill(%08x): PTE va = %08x, pa = %08x\n",
|
||||||
|
__func__, vaddr, pt_vaddr, paddr);
|
||||||
|
} else {
|
||||||
|
qemu_log_mask(CPU_LOG_MMU,
|
||||||
|
"%s: autorefill(%08x): PTE va = %08x, failed (%d)\n",
|
||||||
|
__func__, vaddr, pt_vaddr, ret);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ret == 0) {
|
||||||
|
MemTxResult result;
|
||||||
|
|
||||||
|
*pte = address_space_ldl(cs->as, paddr, MEMTXATTRS_UNSPECIFIED,
|
||||||
|
&result);
|
||||||
|
if (result != MEMTX_OK) {
|
||||||
|
qemu_log_mask(CPU_LOG_MMU,
|
||||||
|
"%s: couldn't load PTE: transaction failed (%u)\n",
|
||||||
|
__func__, (unsigned)result);
|
||||||
|
ret = 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return ret == 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int get_physical_addr_region(CPUXtensaState *env,
|
||||||
|
uint32_t vaddr, int is_write, int mmu_idx,
|
||||||
|
uint32_t *paddr, uint32_t *page_size,
|
||||||
|
unsigned *access)
|
||||||
|
{
|
||||||
|
bool dtlb = is_write != 2;
|
||||||
|
uint32_t wi = 0;
|
||||||
|
uint32_t ei = (vaddr >> 29) & 0x7;
|
||||||
|
const xtensa_tlb_entry *entry =
|
||||||
|
xtensa_tlb_get_entry(env, dtlb, wi, ei);
|
||||||
|
|
||||||
|
*access = region_attr_to_access(entry->attr);
|
||||||
|
if (!is_access_granted(*access, is_write)) {
|
||||||
|
return dtlb ?
|
||||||
|
(is_write ?
|
||||||
|
STORE_PROHIBITED_CAUSE :
|
||||||
|
LOAD_PROHIBITED_CAUSE) :
|
||||||
|
INST_FETCH_PROHIBITED_CAUSE;
|
||||||
|
}
|
||||||
|
|
||||||
|
*paddr = entry->paddr | (vaddr & ~REGION_PAGE_MASK);
|
||||||
|
*page_size = ~REGION_PAGE_MASK + 1;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* Convert virtual address to physical addr.
|
||||||
|
* MMU may issue pagewalk and change xtensa autorefill TLB way entry.
|
||||||
|
*
|
||||||
|
* \return 0 if ok, exception cause code otherwise
|
||||||
|
*/
|
||||||
|
int xtensa_get_physical_addr(CPUXtensaState *env, bool update_tlb,
|
||||||
|
uint32_t vaddr, int is_write, int mmu_idx,
|
||||||
|
uint32_t *paddr, uint32_t *page_size,
|
||||||
|
unsigned *access)
|
||||||
|
{
|
||||||
|
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
||||||
|
return get_physical_addr_mmu(env, update_tlb,
|
||||||
|
vaddr, is_write, mmu_idx, paddr,
|
||||||
|
page_size, access, true);
|
||||||
|
} else if (xtensa_option_bits_enabled(env->config,
|
||||||
|
XTENSA_OPTION_BIT(XTENSA_OPTION_REGION_PROTECTION) |
|
||||||
|
XTENSA_OPTION_BIT(XTENSA_OPTION_REGION_TRANSLATION))) {
|
||||||
|
return get_physical_addr_region(env, vaddr, is_write, mmu_idx,
|
||||||
|
paddr, page_size, access);
|
||||||
|
} else {
|
||||||
|
*paddr = vaddr;
|
||||||
|
*page_size = TARGET_PAGE_SIZE;
|
||||||
|
*access = cacheattr_attr_to_access(env->sregs[CACHEATTR] >>
|
||||||
|
((vaddr & 0xe0000000) >> 27));
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void dump_tlb(FILE *f, fprintf_function cpu_fprintf,
|
||||||
|
CPUXtensaState *env, bool dtlb)
|
||||||
|
{
|
||||||
|
unsigned wi, ei;
|
||||||
|
const xtensa_tlb *conf =
|
||||||
|
dtlb ? &env->config->dtlb : &env->config->itlb;
|
||||||
|
unsigned (*attr_to_access)(uint32_t) =
|
||||||
|
xtensa_option_enabled(env->config, XTENSA_OPTION_MMU) ?
|
||||||
|
mmu_attr_to_access : region_attr_to_access;
|
||||||
|
|
||||||
|
for (wi = 0; wi < conf->nways; ++wi) {
|
||||||
|
uint32_t sz = ~xtensa_tlb_get_addr_mask(env, dtlb, wi) + 1;
|
||||||
|
const char *sz_text;
|
||||||
|
bool print_header = true;
|
||||||
|
|
||||||
|
if (sz >= 0x100000) {
|
||||||
|
sz /= MiB;
|
||||||
|
sz_text = "MB";
|
||||||
|
} else {
|
||||||
|
sz /= KiB;
|
||||||
|
sz_text = "KB";
|
||||||
|
}
|
||||||
|
|
||||||
|
for (ei = 0; ei < conf->way_size[wi]; ++ei) {
|
||||||
|
const xtensa_tlb_entry *entry =
|
||||||
|
xtensa_tlb_get_entry(env, dtlb, wi, ei);
|
||||||
|
|
||||||
|
if (entry->asid) {
|
||||||
|
static const char * const cache_text[8] = {
|
||||||
|
[PAGE_CACHE_BYPASS >> PAGE_CACHE_SHIFT] = "Bypass",
|
||||||
|
[PAGE_CACHE_WT >> PAGE_CACHE_SHIFT] = "WT",
|
||||||
|
[PAGE_CACHE_WB >> PAGE_CACHE_SHIFT] = "WB",
|
||||||
|
[PAGE_CACHE_ISOLATE >> PAGE_CACHE_SHIFT] = "Isolate",
|
||||||
|
};
|
||||||
|
unsigned access = attr_to_access(entry->attr);
|
||||||
|
unsigned cache_idx = (access & PAGE_CACHE_MASK) >>
|
||||||
|
PAGE_CACHE_SHIFT;
|
||||||
|
|
||||||
|
if (print_header) {
|
||||||
|
print_header = false;
|
||||||
|
cpu_fprintf(f, "Way %u (%d %s)\n", wi, sz, sz_text);
|
||||||
|
cpu_fprintf(f,
|
||||||
|
"\tVaddr Paddr ASID Attr RWX Cache\n"
|
||||||
|
"\t---------- ---------- ---- ---- --- -------\n");
|
||||||
|
}
|
||||||
|
cpu_fprintf(f,
|
||||||
|
"\t0x%08x 0x%08x 0x%02x 0x%02x %c%c%c %-7s\n",
|
||||||
|
entry->vaddr,
|
||||||
|
entry->paddr,
|
||||||
|
entry->asid,
|
||||||
|
entry->attr,
|
||||||
|
(access & PAGE_READ) ? 'R' : '-',
|
||||||
|
(access & PAGE_WRITE) ? 'W' : '-',
|
||||||
|
(access & PAGE_EXEC) ? 'X' : '-',
|
||||||
|
cache_text[cache_idx] ?
|
||||||
|
cache_text[cache_idx] : "Invalid");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void dump_mmu(FILE *f, fprintf_function cpu_fprintf, CPUXtensaState *env)
|
||||||
|
{
|
||||||
|
if (xtensa_option_bits_enabled(env->config,
|
||||||
|
XTENSA_OPTION_BIT(XTENSA_OPTION_REGION_PROTECTION) |
|
||||||
|
XTENSA_OPTION_BIT(XTENSA_OPTION_REGION_TRANSLATION) |
|
||||||
|
XTENSA_OPTION_BIT(XTENSA_OPTION_MMU))) {
|
||||||
|
|
||||||
|
cpu_fprintf(f, "ITLB:\n");
|
||||||
|
dump_tlb(f, cpu_fprintf, env, false);
|
||||||
|
cpu_fprintf(f, "\nDTLB:\n");
|
||||||
|
dump_tlb(f, cpu_fprintf, env, true);
|
||||||
|
} else {
|
||||||
|
cpu_fprintf(f, "No TLB for this CPU core\n");
|
||||||
|
}
|
||||||
|
}
|
||||||
@ -34,390 +34,9 @@
|
|||||||
#include "exec/cpu_ldst.h"
|
#include "exec/cpu_ldst.h"
|
||||||
#include "exec/address-spaces.h"
|
#include "exec/address-spaces.h"
|
||||||
#include "qemu/timer.h"
|
#include "qemu/timer.h"
|
||||||
#include "fpu/softfloat.h"
|
|
||||||
|
|
||||||
#ifndef CONFIG_USER_ONLY
|
#ifndef CONFIG_USER_ONLY
|
||||||
|
|
||||||
void xtensa_cpu_do_unaligned_access(CPUState *cs,
|
|
||||||
vaddr addr, MMUAccessType access_type,
|
|
||||||
int mmu_idx, uintptr_t retaddr)
|
|
||||||
{
|
|
||||||
XtensaCPU *cpu = XTENSA_CPU(cs);
|
|
||||||
CPUXtensaState *env = &cpu->env;
|
|
||||||
|
|
||||||
if (xtensa_option_enabled(env->config, XTENSA_OPTION_UNALIGNED_EXCEPTION) &&
|
|
||||||
!xtensa_option_enabled(env->config, XTENSA_OPTION_HW_ALIGNMENT)) {
|
|
||||||
cpu_restore_state(CPU(cpu), retaddr, true);
|
|
||||||
HELPER(exception_cause_vaddr)(env,
|
|
||||||
env->pc, LOAD_STORE_ALIGNMENT_CAUSE, addr);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void tlb_fill(CPUState *cs, target_ulong vaddr, int size,
|
|
||||||
MMUAccessType access_type, int mmu_idx, uintptr_t retaddr)
|
|
||||||
{
|
|
||||||
XtensaCPU *cpu = XTENSA_CPU(cs);
|
|
||||||
CPUXtensaState *env = &cpu->env;
|
|
||||||
uint32_t paddr;
|
|
||||||
uint32_t page_size;
|
|
||||||
unsigned access;
|
|
||||||
int ret = xtensa_get_physical_addr(env, true, vaddr, access_type, mmu_idx,
|
|
||||||
&paddr, &page_size, &access);
|
|
||||||
|
|
||||||
qemu_log_mask(CPU_LOG_MMU, "%s(%08x, %d, %d) -> %08x, ret = %d\n",
|
|
||||||
__func__, vaddr, access_type, mmu_idx, paddr, ret);
|
|
||||||
|
|
||||||
if (ret == 0) {
|
|
||||||
tlb_set_page(cs,
|
|
||||||
vaddr & TARGET_PAGE_MASK,
|
|
||||||
paddr & TARGET_PAGE_MASK,
|
|
||||||
access, mmu_idx, page_size);
|
|
||||||
} else {
|
|
||||||
cpu_restore_state(cs, retaddr, true);
|
|
||||||
HELPER(exception_cause_vaddr)(env, env->pc, ret, vaddr);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void xtensa_cpu_do_transaction_failed(CPUState *cs, hwaddr physaddr, vaddr addr,
|
|
||||||
unsigned size, MMUAccessType access_type,
|
|
||||||
int mmu_idx, MemTxAttrs attrs,
|
|
||||||
MemTxResult response, uintptr_t retaddr)
|
|
||||||
{
|
|
||||||
XtensaCPU *cpu = XTENSA_CPU(cs);
|
|
||||||
CPUXtensaState *env = &cpu->env;
|
|
||||||
|
|
||||||
cpu_restore_state(cs, retaddr, true);
|
|
||||||
HELPER(exception_cause_vaddr)(env, env->pc,
|
|
||||||
access_type == MMU_INST_FETCH ?
|
|
||||||
INSTR_PIF_ADDR_ERROR_CAUSE :
|
|
||||||
LOAD_STORE_PIF_ADDR_ERROR_CAUSE,
|
|
||||||
addr);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void tb_invalidate_virtual_addr(CPUXtensaState *env, uint32_t vaddr)
|
|
||||||
{
|
|
||||||
uint32_t paddr;
|
|
||||||
uint32_t page_size;
|
|
||||||
unsigned access;
|
|
||||||
int ret = xtensa_get_physical_addr(env, false, vaddr, 2, 0,
|
|
||||||
&paddr, &page_size, &access);
|
|
||||||
if (ret == 0) {
|
|
||||||
tb_invalidate_phys_addr(&address_space_memory, paddr,
|
|
||||||
MEMTXATTRS_UNSPECIFIED);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
#else
|
|
||||||
|
|
||||||
static void tb_invalidate_virtual_addr(CPUXtensaState *env, uint32_t vaddr)
|
|
||||||
{
|
|
||||||
tb_invalidate_phys_addr(vaddr);
|
|
||||||
}
|
|
||||||
|
|
||||||
#endif
|
|
||||||
|
|
||||||
void HELPER(exception)(CPUXtensaState *env, uint32_t excp)
|
|
||||||
{
|
|
||||||
CPUState *cs = CPU(xtensa_env_get_cpu(env));
|
|
||||||
|
|
||||||
cs->exception_index = excp;
|
|
||||||
if (excp == EXCP_YIELD) {
|
|
||||||
env->yield_needed = 0;
|
|
||||||
}
|
|
||||||
if (excp == EXCP_DEBUG) {
|
|
||||||
env->exception_taken = 0;
|
|
||||||
}
|
|
||||||
cpu_loop_exit(cs);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(exception_cause)(CPUXtensaState *env, uint32_t pc, uint32_t cause)
|
|
||||||
{
|
|
||||||
uint32_t vector;
|
|
||||||
|
|
||||||
env->pc = pc;
|
|
||||||
if (env->sregs[PS] & PS_EXCM) {
|
|
||||||
if (env->config->ndepc) {
|
|
||||||
env->sregs[DEPC] = pc;
|
|
||||||
} else {
|
|
||||||
env->sregs[EPC1] = pc;
|
|
||||||
}
|
|
||||||
vector = EXC_DOUBLE;
|
|
||||||
} else {
|
|
||||||
env->sregs[EPC1] = pc;
|
|
||||||
vector = (env->sregs[PS] & PS_UM) ? EXC_USER : EXC_KERNEL;
|
|
||||||
}
|
|
||||||
|
|
||||||
env->sregs[EXCCAUSE] = cause;
|
|
||||||
env->sregs[PS] |= PS_EXCM;
|
|
||||||
|
|
||||||
HELPER(exception)(env, vector);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(exception_cause_vaddr)(CPUXtensaState *env,
|
|
||||||
uint32_t pc, uint32_t cause, uint32_t vaddr)
|
|
||||||
{
|
|
||||||
env->sregs[EXCVADDR] = vaddr;
|
|
||||||
HELPER(exception_cause)(env, pc, cause);
|
|
||||||
}
|
|
||||||
|
|
||||||
void debug_exception_env(CPUXtensaState *env, uint32_t cause)
|
|
||||||
{
|
|
||||||
if (xtensa_get_cintlevel(env) < env->config->debug_level) {
|
|
||||||
HELPER(debug_exception)(env, env->pc, cause);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(debug_exception)(CPUXtensaState *env, uint32_t pc, uint32_t cause)
|
|
||||||
{
|
|
||||||
unsigned level = env->config->debug_level;
|
|
||||||
|
|
||||||
env->pc = pc;
|
|
||||||
env->sregs[DEBUGCAUSE] = cause;
|
|
||||||
env->sregs[EPC1 + level - 1] = pc;
|
|
||||||
env->sregs[EPS2 + level - 2] = env->sregs[PS];
|
|
||||||
env->sregs[PS] = (env->sregs[PS] & ~PS_INTLEVEL) | PS_EXCM |
|
|
||||||
(level << PS_INTLEVEL_SHIFT);
|
|
||||||
HELPER(exception)(env, EXC_DEBUG);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void copy_window_from_phys(CPUXtensaState *env,
|
|
||||||
uint32_t window, uint32_t phys, uint32_t n)
|
|
||||||
{
|
|
||||||
assert(phys < env->config->nareg);
|
|
||||||
if (phys + n <= env->config->nareg) {
|
|
||||||
memcpy(env->regs + window, env->phys_regs + phys,
|
|
||||||
n * sizeof(uint32_t));
|
|
||||||
} else {
|
|
||||||
uint32_t n1 = env->config->nareg - phys;
|
|
||||||
memcpy(env->regs + window, env->phys_regs + phys,
|
|
||||||
n1 * sizeof(uint32_t));
|
|
||||||
memcpy(env->regs + window + n1, env->phys_regs,
|
|
||||||
(n - n1) * sizeof(uint32_t));
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static void copy_phys_from_window(CPUXtensaState *env,
|
|
||||||
uint32_t phys, uint32_t window, uint32_t n)
|
|
||||||
{
|
|
||||||
assert(phys < env->config->nareg);
|
|
||||||
if (phys + n <= env->config->nareg) {
|
|
||||||
memcpy(env->phys_regs + phys, env->regs + window,
|
|
||||||
n * sizeof(uint32_t));
|
|
||||||
} else {
|
|
||||||
uint32_t n1 = env->config->nareg - phys;
|
|
||||||
memcpy(env->phys_regs + phys, env->regs + window,
|
|
||||||
n1 * sizeof(uint32_t));
|
|
||||||
memcpy(env->phys_regs, env->regs + window + n1,
|
|
||||||
(n - n1) * sizeof(uint32_t));
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static inline unsigned windowbase_bound(unsigned a, const CPUXtensaState *env)
|
|
||||||
{
|
|
||||||
return a & (env->config->nareg / 4 - 1);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline unsigned windowstart_bit(unsigned a, const CPUXtensaState *env)
|
|
||||||
{
|
|
||||||
return 1 << windowbase_bound(a, env);
|
|
||||||
}
|
|
||||||
|
|
||||||
void xtensa_sync_window_from_phys(CPUXtensaState *env)
|
|
||||||
{
|
|
||||||
copy_window_from_phys(env, 0, env->sregs[WINDOW_BASE] * 4, 16);
|
|
||||||
}
|
|
||||||
|
|
||||||
void xtensa_sync_phys_from_window(CPUXtensaState *env)
|
|
||||||
{
|
|
||||||
copy_phys_from_window(env, env->sregs[WINDOW_BASE] * 4, 0, 16);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void xtensa_rotate_window_abs(CPUXtensaState *env, uint32_t position)
|
|
||||||
{
|
|
||||||
xtensa_sync_phys_from_window(env);
|
|
||||||
env->sregs[WINDOW_BASE] = windowbase_bound(position, env);
|
|
||||||
xtensa_sync_window_from_phys(env);
|
|
||||||
}
|
|
||||||
|
|
||||||
void xtensa_rotate_window(CPUXtensaState *env, uint32_t delta)
|
|
||||||
{
|
|
||||||
xtensa_rotate_window_abs(env, env->sregs[WINDOW_BASE] + delta);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(wsr_windowbase)(CPUXtensaState *env, uint32_t v)
|
|
||||||
{
|
|
||||||
xtensa_rotate_window_abs(env, v);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(entry)(CPUXtensaState *env, uint32_t pc, uint32_t s, uint32_t imm)
|
|
||||||
{
|
|
||||||
int callinc = (env->sregs[PS] & PS_CALLINC) >> PS_CALLINC_SHIFT;
|
|
||||||
|
|
||||||
env->regs[(callinc << 2) | (s & 3)] = env->regs[s] - imm;
|
|
||||||
xtensa_rotate_window(env, callinc);
|
|
||||||
env->sregs[WINDOW_START] |=
|
|
||||||
windowstart_bit(env->sregs[WINDOW_BASE], env);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(window_check)(CPUXtensaState *env, uint32_t pc, uint32_t w)
|
|
||||||
{
|
|
||||||
uint32_t windowbase = windowbase_bound(env->sregs[WINDOW_BASE], env);
|
|
||||||
uint32_t windowstart = xtensa_replicate_windowstart(env) >>
|
|
||||||
(env->sregs[WINDOW_BASE] + 1);
|
|
||||||
uint32_t n = ctz32(windowstart) + 1;
|
|
||||||
|
|
||||||
assert(n <= w);
|
|
||||||
|
|
||||||
xtensa_rotate_window(env, n);
|
|
||||||
env->sregs[PS] = (env->sregs[PS] & ~PS_OWB) |
|
|
||||||
(windowbase << PS_OWB_SHIFT) | PS_EXCM;
|
|
||||||
env->sregs[EPC1] = env->pc = pc;
|
|
||||||
|
|
||||||
switch (ctz32(windowstart >> n)) {
|
|
||||||
case 0:
|
|
||||||
HELPER(exception)(env, EXC_WINDOW_OVERFLOW4);
|
|
||||||
break;
|
|
||||||
case 1:
|
|
||||||
HELPER(exception)(env, EXC_WINDOW_OVERFLOW8);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
HELPER(exception)(env, EXC_WINDOW_OVERFLOW12);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(test_ill_retw)(CPUXtensaState *env, uint32_t pc)
|
|
||||||
{
|
|
||||||
int n = (env->regs[0] >> 30) & 0x3;
|
|
||||||
int m = 0;
|
|
||||||
uint32_t windowbase = windowbase_bound(env->sregs[WINDOW_BASE], env);
|
|
||||||
uint32_t windowstart = env->sregs[WINDOW_START];
|
|
||||||
|
|
||||||
if (windowstart & windowstart_bit(windowbase - 1, env)) {
|
|
||||||
m = 1;
|
|
||||||
} else if (windowstart & windowstart_bit(windowbase - 2, env)) {
|
|
||||||
m = 2;
|
|
||||||
} else if (windowstart & windowstart_bit(windowbase - 3, env)) {
|
|
||||||
m = 3;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (n == 0 || (m != 0 && m != n)) {
|
|
||||||
qemu_log_mask(LOG_GUEST_ERROR, "Illegal retw instruction(pc = %08x), "
|
|
||||||
"PS = %08x, m = %d, n = %d\n",
|
|
||||||
pc, env->sregs[PS], m, n);
|
|
||||||
HELPER(exception_cause)(env, pc, ILLEGAL_INSTRUCTION_CAUSE);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(test_underflow_retw)(CPUXtensaState *env, uint32_t pc)
|
|
||||||
{
|
|
||||||
int n = (env->regs[0] >> 30) & 0x3;
|
|
||||||
|
|
||||||
if (!(env->sregs[WINDOW_START] &
|
|
||||||
windowstart_bit(env->sregs[WINDOW_BASE] - n, env))) {
|
|
||||||
uint32_t windowbase = windowbase_bound(env->sregs[WINDOW_BASE], env);
|
|
||||||
|
|
||||||
xtensa_rotate_window(env, -n);
|
|
||||||
/* window underflow */
|
|
||||||
env->sregs[PS] = (env->sregs[PS] & ~PS_OWB) |
|
|
||||||
(windowbase << PS_OWB_SHIFT) | PS_EXCM;
|
|
||||||
env->sregs[EPC1] = env->pc = pc;
|
|
||||||
|
|
||||||
if (n == 1) {
|
|
||||||
HELPER(exception)(env, EXC_WINDOW_UNDERFLOW4);
|
|
||||||
} else if (n == 2) {
|
|
||||||
HELPER(exception)(env, EXC_WINDOW_UNDERFLOW8);
|
|
||||||
} else if (n == 3) {
|
|
||||||
HELPER(exception)(env, EXC_WINDOW_UNDERFLOW12);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
uint32_t HELPER(retw)(CPUXtensaState *env, uint32_t pc)
|
|
||||||
{
|
|
||||||
int n = (env->regs[0] >> 30) & 0x3;
|
|
||||||
uint32_t windowbase = windowbase_bound(env->sregs[WINDOW_BASE], env);
|
|
||||||
uint32_t ret_pc = (pc & 0xc0000000) | (env->regs[0] & 0x3fffffff);
|
|
||||||
|
|
||||||
xtensa_rotate_window(env, -n);
|
|
||||||
env->sregs[WINDOW_START] &= ~windowstart_bit(windowbase, env);
|
|
||||||
return ret_pc;
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(rotw)(CPUXtensaState *env, uint32_t imm4)
|
|
||||||
{
|
|
||||||
xtensa_rotate_window(env, imm4);
|
|
||||||
}
|
|
||||||
|
|
||||||
void xtensa_restore_owb(CPUXtensaState *env)
|
|
||||||
{
|
|
||||||
xtensa_rotate_window_abs(env, (env->sregs[PS] & PS_OWB) >> PS_OWB_SHIFT);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(restore_owb)(CPUXtensaState *env)
|
|
||||||
{
|
|
||||||
xtensa_restore_owb(env);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(movsp)(CPUXtensaState *env, uint32_t pc)
|
|
||||||
{
|
|
||||||
if ((env->sregs[WINDOW_START] &
|
|
||||||
(windowstart_bit(env->sregs[WINDOW_BASE] - 3, env) |
|
|
||||||
windowstart_bit(env->sregs[WINDOW_BASE] - 2, env) |
|
|
||||||
windowstart_bit(env->sregs[WINDOW_BASE] - 1, env))) == 0) {
|
|
||||||
HELPER(exception_cause)(env, pc, ALLOCA_CAUSE);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(wsr_lbeg)(CPUXtensaState *env, uint32_t v)
|
|
||||||
{
|
|
||||||
if (env->sregs[LBEG] != v) {
|
|
||||||
tb_invalidate_virtual_addr(env, env->sregs[LEND] - 1);
|
|
||||||
env->sregs[LBEG] = v;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(wsr_lend)(CPUXtensaState *env, uint32_t v)
|
|
||||||
{
|
|
||||||
if (env->sregs[LEND] != v) {
|
|
||||||
tb_invalidate_virtual_addr(env, env->sregs[LEND] - 1);
|
|
||||||
env->sregs[LEND] = v;
|
|
||||||
tb_invalidate_virtual_addr(env, env->sregs[LEND] - 1);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(dump_state)(CPUXtensaState *env)
|
|
||||||
{
|
|
||||||
XtensaCPU *cpu = xtensa_env_get_cpu(env);
|
|
||||||
|
|
||||||
cpu_dump_state(CPU(cpu), stderr, fprintf, 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifndef CONFIG_USER_ONLY
|
|
||||||
|
|
||||||
void HELPER(waiti)(CPUXtensaState *env, uint32_t pc, uint32_t intlevel)
|
|
||||||
{
|
|
||||||
CPUState *cpu;
|
|
||||||
|
|
||||||
env->pc = pc;
|
|
||||||
env->sregs[PS] = (env->sregs[PS] & ~PS_INTLEVEL) |
|
|
||||||
(intlevel << PS_INTLEVEL_SHIFT);
|
|
||||||
|
|
||||||
qemu_mutex_lock_iothread();
|
|
||||||
check_interrupts(env);
|
|
||||||
qemu_mutex_unlock_iothread();
|
|
||||||
|
|
||||||
if (env->pending_irq_level) {
|
|
||||||
cpu_loop_exit(CPU(xtensa_env_get_cpu(env)));
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
cpu = CPU(xtensa_env_get_cpu(env));
|
|
||||||
cpu->halted = 1;
|
|
||||||
HELPER(exception)(env, EXCP_HLT);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(update_ccount)(CPUXtensaState *env)
|
void HELPER(update_ccount)(CPUXtensaState *env)
|
||||||
{
|
{
|
||||||
uint64_t now = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
|
uint64_t now = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
|
||||||
@ -450,22 +69,6 @@ void HELPER(update_ccompare)(CPUXtensaState *env, uint32_t i)
|
|||||||
env->yield_needed = 1;
|
env->yield_needed = 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
void HELPER(check_interrupts)(CPUXtensaState *env)
|
|
||||||
{
|
|
||||||
qemu_mutex_lock_iothread();
|
|
||||||
check_interrupts(env);
|
|
||||||
qemu_mutex_unlock_iothread();
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(itlb_hit_test)(CPUXtensaState *env, uint32_t vaddr)
|
|
||||||
{
|
|
||||||
/*
|
|
||||||
* Attempt the memory load; we don't care about the result but
|
|
||||||
* only the side-effects (ie any MMU or other exception)
|
|
||||||
*/
|
|
||||||
cpu_ldub_code_ra(env, vaddr, GETPC());
|
|
||||||
}
|
|
||||||
|
|
||||||
/*!
|
/*!
|
||||||
* Check vaddr accessibility/cache attributes and raise an exception if
|
* Check vaddr accessibility/cache attributes and raise an exception if
|
||||||
* specified by the ATOMCTL SR.
|
* specified by the ATOMCTL SR.
|
||||||
@ -549,505 +152,8 @@ void HELPER(wsr_memctl)(CPUXtensaState *env, uint32_t v)
|
|||||||
env->sregs[MEMCTL] = v & env->config->memctl_mask;
|
env->sregs[MEMCTL] = v & env->config->memctl_mask;
|
||||||
}
|
}
|
||||||
|
|
||||||
void HELPER(wsr_rasid)(CPUXtensaState *env, uint32_t v)
|
|
||||||
{
|
|
||||||
XtensaCPU *cpu = xtensa_env_get_cpu(env);
|
|
||||||
|
|
||||||
v = (v & 0xffffff00) | 0x1;
|
|
||||||
if (v != env->sregs[RASID]) {
|
|
||||||
env->sregs[RASID] = v;
|
|
||||||
tlb_flush(CPU(cpu));
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static uint32_t get_page_size(const CPUXtensaState *env, bool dtlb, uint32_t way)
|
|
||||||
{
|
|
||||||
uint32_t tlbcfg = env->sregs[dtlb ? DTLBCFG : ITLBCFG];
|
|
||||||
|
|
||||||
switch (way) {
|
|
||||||
case 4:
|
|
||||||
return (tlbcfg >> 16) & 0x3;
|
|
||||||
|
|
||||||
case 5:
|
|
||||||
return (tlbcfg >> 20) & 0x1;
|
|
||||||
|
|
||||||
case 6:
|
|
||||||
return (tlbcfg >> 24) & 0x1;
|
|
||||||
|
|
||||||
default:
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* Get bit mask for the virtual address bits translated by the TLB way
|
|
||||||
*/
|
|
||||||
uint32_t xtensa_tlb_get_addr_mask(const CPUXtensaState *env, bool dtlb, uint32_t way)
|
|
||||||
{
|
|
||||||
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
|
||||||
bool varway56 = dtlb ?
|
|
||||||
env->config->dtlb.varway56 :
|
|
||||||
env->config->itlb.varway56;
|
|
||||||
|
|
||||||
switch (way) {
|
|
||||||
case 4:
|
|
||||||
return 0xfff00000 << get_page_size(env, dtlb, way) * 2;
|
|
||||||
|
|
||||||
case 5:
|
|
||||||
if (varway56) {
|
|
||||||
return 0xf8000000 << get_page_size(env, dtlb, way);
|
|
||||||
} else {
|
|
||||||
return 0xf8000000;
|
|
||||||
}
|
|
||||||
|
|
||||||
case 6:
|
|
||||||
if (varway56) {
|
|
||||||
return 0xf0000000 << (1 - get_page_size(env, dtlb, way));
|
|
||||||
} else {
|
|
||||||
return 0xf0000000;
|
|
||||||
}
|
|
||||||
|
|
||||||
default:
|
|
||||||
return 0xfffff000;
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
return REGION_PAGE_MASK;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* Get bit mask for the 'VPN without index' field.
|
|
||||||
* See ISA, 4.6.5.6, data format for RxTLB0
|
|
||||||
*/
|
|
||||||
static uint32_t get_vpn_mask(const CPUXtensaState *env, bool dtlb, uint32_t way)
|
|
||||||
{
|
|
||||||
if (way < 4) {
|
|
||||||
bool is32 = (dtlb ?
|
|
||||||
env->config->dtlb.nrefillentries :
|
|
||||||
env->config->itlb.nrefillentries) == 32;
|
|
||||||
return is32 ? 0xffff8000 : 0xffffc000;
|
|
||||||
} else if (way == 4) {
|
|
||||||
return xtensa_tlb_get_addr_mask(env, dtlb, way) << 2;
|
|
||||||
} else if (way <= 6) {
|
|
||||||
uint32_t mask = xtensa_tlb_get_addr_mask(env, dtlb, way);
|
|
||||||
bool varway56 = dtlb ?
|
|
||||||
env->config->dtlb.varway56 :
|
|
||||||
env->config->itlb.varway56;
|
|
||||||
|
|
||||||
if (varway56) {
|
|
||||||
return mask << (way == 5 ? 2 : 3);
|
|
||||||
} else {
|
|
||||||
return mask << 1;
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
return 0xfffff000;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* Split virtual address into VPN (with index) and entry index
|
|
||||||
* for the given TLB way
|
|
||||||
*/
|
|
||||||
void split_tlb_entry_spec_way(const CPUXtensaState *env, uint32_t v, bool dtlb,
|
|
||||||
uint32_t *vpn, uint32_t wi, uint32_t *ei)
|
|
||||||
{
|
|
||||||
bool varway56 = dtlb ?
|
|
||||||
env->config->dtlb.varway56 :
|
|
||||||
env->config->itlb.varway56;
|
|
||||||
|
|
||||||
if (!dtlb) {
|
|
||||||
wi &= 7;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (wi < 4) {
|
|
||||||
bool is32 = (dtlb ?
|
|
||||||
env->config->dtlb.nrefillentries :
|
|
||||||
env->config->itlb.nrefillentries) == 32;
|
|
||||||
*ei = (v >> 12) & (is32 ? 0x7 : 0x3);
|
|
||||||
} else {
|
|
||||||
switch (wi) {
|
|
||||||
case 4:
|
|
||||||
{
|
|
||||||
uint32_t eibase = 20 + get_page_size(env, dtlb, wi) * 2;
|
|
||||||
*ei = (v >> eibase) & 0x3;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
case 5:
|
|
||||||
if (varway56) {
|
|
||||||
uint32_t eibase = 27 + get_page_size(env, dtlb, wi);
|
|
||||||
*ei = (v >> eibase) & 0x3;
|
|
||||||
} else {
|
|
||||||
*ei = (v >> 27) & 0x1;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
case 6:
|
|
||||||
if (varway56) {
|
|
||||||
uint32_t eibase = 29 - get_page_size(env, dtlb, wi);
|
|
||||||
*ei = (v >> eibase) & 0x7;
|
|
||||||
} else {
|
|
||||||
*ei = (v >> 28) & 0x1;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
default:
|
|
||||||
*ei = 0;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
*vpn = v & xtensa_tlb_get_addr_mask(env, dtlb, wi);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* Split TLB address into TLB way, entry index and VPN (with index).
|
|
||||||
* See ISA, 4.6.5.5 - 4.6.5.8 for the TLB addressing format
|
|
||||||
*/
|
|
||||||
static void split_tlb_entry_spec(CPUXtensaState *env, uint32_t v, bool dtlb,
|
|
||||||
uint32_t *vpn, uint32_t *wi, uint32_t *ei)
|
|
||||||
{
|
|
||||||
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
|
||||||
*wi = v & (dtlb ? 0xf : 0x7);
|
|
||||||
split_tlb_entry_spec_way(env, v, dtlb, vpn, *wi, ei);
|
|
||||||
} else {
|
|
||||||
*vpn = v & REGION_PAGE_MASK;
|
|
||||||
*wi = 0;
|
|
||||||
*ei = (v >> 29) & 0x7;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static xtensa_tlb_entry *get_tlb_entry(CPUXtensaState *env,
|
|
||||||
uint32_t v, bool dtlb, uint32_t *pwi)
|
|
||||||
{
|
|
||||||
uint32_t vpn;
|
|
||||||
uint32_t wi;
|
|
||||||
uint32_t ei;
|
|
||||||
|
|
||||||
split_tlb_entry_spec(env, v, dtlb, &vpn, &wi, &ei);
|
|
||||||
if (pwi) {
|
|
||||||
*pwi = wi;
|
|
||||||
}
|
|
||||||
return xtensa_tlb_get_entry(env, dtlb, wi, ei);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint32_t HELPER(rtlb0)(CPUXtensaState *env, uint32_t v, uint32_t dtlb)
|
|
||||||
{
|
|
||||||
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
|
||||||
uint32_t wi;
|
|
||||||
const xtensa_tlb_entry *entry = get_tlb_entry(env, v, dtlb, &wi);
|
|
||||||
return (entry->vaddr & get_vpn_mask(env, dtlb, wi)) | entry->asid;
|
|
||||||
} else {
|
|
||||||
return v & REGION_PAGE_MASK;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
uint32_t HELPER(rtlb1)(CPUXtensaState *env, uint32_t v, uint32_t dtlb)
|
|
||||||
{
|
|
||||||
const xtensa_tlb_entry *entry = get_tlb_entry(env, v, dtlb, NULL);
|
|
||||||
return entry->paddr | entry->attr;
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(itlb)(CPUXtensaState *env, uint32_t v, uint32_t dtlb)
|
|
||||||
{
|
|
||||||
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
|
||||||
uint32_t wi;
|
|
||||||
xtensa_tlb_entry *entry = get_tlb_entry(env, v, dtlb, &wi);
|
|
||||||
if (entry->variable && entry->asid) {
|
|
||||||
tlb_flush_page(CPU(xtensa_env_get_cpu(env)), entry->vaddr);
|
|
||||||
entry->asid = 0;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
uint32_t HELPER(ptlb)(CPUXtensaState *env, uint32_t v, uint32_t dtlb)
|
|
||||||
{
|
|
||||||
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
|
||||||
uint32_t wi;
|
|
||||||
uint32_t ei;
|
|
||||||
uint8_t ring;
|
|
||||||
int res = xtensa_tlb_lookup(env, v, dtlb, &wi, &ei, &ring);
|
|
||||||
|
|
||||||
switch (res) {
|
|
||||||
case 0:
|
|
||||||
if (ring >= xtensa_get_ring(env)) {
|
|
||||||
return (v & 0xfffff000) | wi | (dtlb ? 0x10 : 0x8);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
case INST_TLB_MULTI_HIT_CAUSE:
|
|
||||||
case LOAD_STORE_TLB_MULTI_HIT_CAUSE:
|
|
||||||
HELPER(exception_cause_vaddr)(env, env->pc, res, v);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
} else {
|
|
||||||
return (v & REGION_PAGE_MASK) | 0x1;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void xtensa_tlb_set_entry_mmu(const CPUXtensaState *env,
|
|
||||||
xtensa_tlb_entry *entry, bool dtlb,
|
|
||||||
unsigned wi, unsigned ei, uint32_t vpn, uint32_t pte)
|
|
||||||
{
|
|
||||||
entry->vaddr = vpn;
|
|
||||||
entry->paddr = pte & xtensa_tlb_get_addr_mask(env, dtlb, wi);
|
|
||||||
entry->asid = (env->sregs[RASID] >> ((pte >> 1) & 0x18)) & 0xff;
|
|
||||||
entry->attr = pte & 0xf;
|
|
||||||
}
|
|
||||||
|
|
||||||
void xtensa_tlb_set_entry(CPUXtensaState *env, bool dtlb,
|
|
||||||
unsigned wi, unsigned ei, uint32_t vpn, uint32_t pte)
|
|
||||||
{
|
|
||||||
XtensaCPU *cpu = xtensa_env_get_cpu(env);
|
|
||||||
CPUState *cs = CPU(cpu);
|
|
||||||
xtensa_tlb_entry *entry = xtensa_tlb_get_entry(env, dtlb, wi, ei);
|
|
||||||
|
|
||||||
if (xtensa_option_enabled(env->config, XTENSA_OPTION_MMU)) {
|
|
||||||
if (entry->variable) {
|
|
||||||
if (entry->asid) {
|
|
||||||
tlb_flush_page(cs, entry->vaddr);
|
|
||||||
}
|
|
||||||
xtensa_tlb_set_entry_mmu(env, entry, dtlb, wi, ei, vpn, pte);
|
|
||||||
tlb_flush_page(cs, entry->vaddr);
|
|
||||||
} else {
|
|
||||||
qemu_log_mask(LOG_GUEST_ERROR, "%s %d, %d, %d trying to set immutable entry\n",
|
|
||||||
__func__, dtlb, wi, ei);
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
tlb_flush_page(cs, entry->vaddr);
|
|
||||||
if (xtensa_option_enabled(env->config,
|
|
||||||
XTENSA_OPTION_REGION_TRANSLATION)) {
|
|
||||||
entry->paddr = pte & REGION_PAGE_MASK;
|
|
||||||
}
|
|
||||||
entry->attr = pte & 0xf;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(wtlb)(CPUXtensaState *env, uint32_t p, uint32_t v, uint32_t dtlb)
|
|
||||||
{
|
|
||||||
uint32_t vpn;
|
|
||||||
uint32_t wi;
|
|
||||||
uint32_t ei;
|
|
||||||
split_tlb_entry_spec(env, v, dtlb, &vpn, &wi, &ei);
|
|
||||||
xtensa_tlb_set_entry(env, dtlb, wi, ei, vpn, p);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
void HELPER(wsr_ibreakenable)(CPUXtensaState *env, uint32_t v)
|
|
||||||
{
|
|
||||||
uint32_t change = v ^ env->sregs[IBREAKENABLE];
|
|
||||||
unsigned i;
|
|
||||||
|
|
||||||
for (i = 0; i < env->config->nibreak; ++i) {
|
|
||||||
if (change & (1 << i)) {
|
|
||||||
tb_invalidate_virtual_addr(env, env->sregs[IBREAKA + i]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
env->sregs[IBREAKENABLE] = v & ((1 << env->config->nibreak) - 1);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(wsr_ibreaka)(CPUXtensaState *env, uint32_t i, uint32_t v)
|
|
||||||
{
|
|
||||||
if (env->sregs[IBREAKENABLE] & (1 << i) && env->sregs[IBREAKA + i] != v) {
|
|
||||||
tb_invalidate_virtual_addr(env, env->sregs[IBREAKA + i]);
|
|
||||||
tb_invalidate_virtual_addr(env, v);
|
|
||||||
}
|
|
||||||
env->sregs[IBREAKA + i] = v;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void set_dbreak(CPUXtensaState *env, unsigned i, uint32_t dbreaka,
|
|
||||||
uint32_t dbreakc)
|
|
||||||
{
|
|
||||||
CPUState *cs = CPU(xtensa_env_get_cpu(env));
|
|
||||||
int flags = BP_CPU | BP_STOP_BEFORE_ACCESS;
|
|
||||||
uint32_t mask = dbreakc | ~DBREAKC_MASK;
|
|
||||||
|
|
||||||
if (env->cpu_watchpoint[i]) {
|
|
||||||
cpu_watchpoint_remove_by_ref(cs, env->cpu_watchpoint[i]);
|
|
||||||
}
|
|
||||||
if (dbreakc & DBREAKC_SB) {
|
|
||||||
flags |= BP_MEM_WRITE;
|
|
||||||
}
|
|
||||||
if (dbreakc & DBREAKC_LB) {
|
|
||||||
flags |= BP_MEM_READ;
|
|
||||||
}
|
|
||||||
/* contiguous mask after inversion is one less than some power of 2 */
|
|
||||||
if ((~mask + 1) & ~mask) {
|
|
||||||
qemu_log_mask(LOG_GUEST_ERROR, "DBREAKC mask is not contiguous: 0x%08x\n", dbreakc);
|
|
||||||
/* cut mask after the first zero bit */
|
|
||||||
mask = 0xffffffff << (32 - clo32(mask));
|
|
||||||
}
|
|
||||||
if (cpu_watchpoint_insert(cs, dbreaka & mask, ~mask + 1,
|
|
||||||
flags, &env->cpu_watchpoint[i])) {
|
|
||||||
env->cpu_watchpoint[i] = NULL;
|
|
||||||
qemu_log_mask(LOG_GUEST_ERROR, "Failed to set data breakpoint at 0x%08x/%d\n",
|
|
||||||
dbreaka & mask, ~mask + 1);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(wsr_dbreaka)(CPUXtensaState *env, uint32_t i, uint32_t v)
|
|
||||||
{
|
|
||||||
uint32_t dbreakc = env->sregs[DBREAKC + i];
|
|
||||||
|
|
||||||
if ((dbreakc & DBREAKC_SB_LB) &&
|
|
||||||
env->sregs[DBREAKA + i] != v) {
|
|
||||||
set_dbreak(env, i, v, dbreakc);
|
|
||||||
}
|
|
||||||
env->sregs[DBREAKA + i] = v;
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(wsr_dbreakc)(CPUXtensaState *env, uint32_t i, uint32_t v)
|
|
||||||
{
|
|
||||||
if ((env->sregs[DBREAKC + i] ^ v) & (DBREAKC_SB_LB | DBREAKC_MASK)) {
|
|
||||||
if (v & DBREAKC_SB_LB) {
|
|
||||||
set_dbreak(env, i, env->sregs[DBREAKA + i], v);
|
|
||||||
} else {
|
|
||||||
if (env->cpu_watchpoint[i]) {
|
|
||||||
CPUState *cs = CPU(xtensa_env_get_cpu(env));
|
|
||||||
|
|
||||||
cpu_watchpoint_remove_by_ref(cs, env->cpu_watchpoint[i]);
|
|
||||||
env->cpu_watchpoint[i] = NULL;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
env->sregs[DBREAKC + i] = v;
|
|
||||||
}
|
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
void HELPER(wur_fcr)(CPUXtensaState *env, uint32_t v)
|
|
||||||
{
|
|
||||||
static const int rounding_mode[] = {
|
|
||||||
float_round_nearest_even,
|
|
||||||
float_round_to_zero,
|
|
||||||
float_round_up,
|
|
||||||
float_round_down,
|
|
||||||
};
|
|
||||||
|
|
||||||
env->uregs[FCR] = v & 0xfffff07f;
|
|
||||||
set_float_rounding_mode(rounding_mode[v & 3], &env->fp_status);
|
|
||||||
}
|
|
||||||
|
|
||||||
float32 HELPER(abs_s)(float32 v)
|
|
||||||
{
|
|
||||||
return float32_abs(v);
|
|
||||||
}
|
|
||||||
|
|
||||||
float32 HELPER(neg_s)(float32 v)
|
|
||||||
{
|
|
||||||
return float32_chs(v);
|
|
||||||
}
|
|
||||||
|
|
||||||
float32 HELPER(add_s)(CPUXtensaState *env, float32 a, float32 b)
|
|
||||||
{
|
|
||||||
return float32_add(a, b, &env->fp_status);
|
|
||||||
}
|
|
||||||
|
|
||||||
float32 HELPER(sub_s)(CPUXtensaState *env, float32 a, float32 b)
|
|
||||||
{
|
|
||||||
return float32_sub(a, b, &env->fp_status);
|
|
||||||
}
|
|
||||||
|
|
||||||
float32 HELPER(mul_s)(CPUXtensaState *env, float32 a, float32 b)
|
|
||||||
{
|
|
||||||
return float32_mul(a, b, &env->fp_status);
|
|
||||||
}
|
|
||||||
|
|
||||||
float32 HELPER(madd_s)(CPUXtensaState *env, float32 a, float32 b, float32 c)
|
|
||||||
{
|
|
||||||
return float32_muladd(b, c, a, 0,
|
|
||||||
&env->fp_status);
|
|
||||||
}
|
|
||||||
|
|
||||||
float32 HELPER(msub_s)(CPUXtensaState *env, float32 a, float32 b, float32 c)
|
|
||||||
{
|
|
||||||
return float32_muladd(b, c, a, float_muladd_negate_product,
|
|
||||||
&env->fp_status);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint32_t HELPER(ftoi)(float32 v, uint32_t rounding_mode, uint32_t scale)
|
|
||||||
{
|
|
||||||
float_status fp_status = {0};
|
|
||||||
|
|
||||||
set_float_rounding_mode(rounding_mode, &fp_status);
|
|
||||||
return float32_to_int32(
|
|
||||||
float32_scalbn(v, scale, &fp_status), &fp_status);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint32_t HELPER(ftoui)(float32 v, uint32_t rounding_mode, uint32_t scale)
|
|
||||||
{
|
|
||||||
float_status fp_status = {0};
|
|
||||||
float32 res;
|
|
||||||
|
|
||||||
set_float_rounding_mode(rounding_mode, &fp_status);
|
|
||||||
|
|
||||||
res = float32_scalbn(v, scale, &fp_status);
|
|
||||||
|
|
||||||
if (float32_is_neg(v) && !float32_is_any_nan(v)) {
|
|
||||||
return float32_to_int32(res, &fp_status);
|
|
||||||
} else {
|
|
||||||
return float32_to_uint32(res, &fp_status);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
float32 HELPER(itof)(CPUXtensaState *env, uint32_t v, uint32_t scale)
|
|
||||||
{
|
|
||||||
return float32_scalbn(int32_to_float32(v, &env->fp_status),
|
|
||||||
(int32_t)scale, &env->fp_status);
|
|
||||||
}
|
|
||||||
|
|
||||||
float32 HELPER(uitof)(CPUXtensaState *env, uint32_t v, uint32_t scale)
|
|
||||||
{
|
|
||||||
return float32_scalbn(uint32_to_float32(v, &env->fp_status),
|
|
||||||
(int32_t)scale, &env->fp_status);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void set_br(CPUXtensaState *env, bool v, uint32_t br)
|
|
||||||
{
|
|
||||||
if (v) {
|
|
||||||
env->sregs[BR] |= br;
|
|
||||||
} else {
|
|
||||||
env->sregs[BR] &= ~br;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(un_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
|
||||||
{
|
|
||||||
set_br(env, float32_unordered_quiet(a, b, &env->fp_status), br);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(oeq_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
|
||||||
{
|
|
||||||
set_br(env, float32_eq_quiet(a, b, &env->fp_status), br);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(ueq_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
|
||||||
{
|
|
||||||
int v = float32_compare_quiet(a, b, &env->fp_status);
|
|
||||||
set_br(env, v == float_relation_equal || v == float_relation_unordered, br);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(olt_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
|
||||||
{
|
|
||||||
set_br(env, float32_lt_quiet(a, b, &env->fp_status), br);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(ult_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
|
||||||
{
|
|
||||||
int v = float32_compare_quiet(a, b, &env->fp_status);
|
|
||||||
set_br(env, v == float_relation_less || v == float_relation_unordered, br);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(ole_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
|
||||||
{
|
|
||||||
set_br(env, float32_le_quiet(a, b, &env->fp_status), br);
|
|
||||||
}
|
|
||||||
|
|
||||||
void HELPER(ule_s)(CPUXtensaState *env, uint32_t br, float32 a, float32 b)
|
|
||||||
{
|
|
||||||
int v = float32_compare_quiet(a, b, &env->fp_status);
|
|
||||||
set_br(env, v != float_relation_greater, br);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint32_t HELPER(rer)(CPUXtensaState *env, uint32_t addr)
|
uint32_t HELPER(rer)(CPUXtensaState *env, uint32_t addr)
|
||||||
{
|
{
|
||||||
#ifndef CONFIG_USER_ONLY
|
#ifndef CONFIG_USER_ONLY
|
||||||
|
|||||||
@ -457,6 +457,7 @@
|
|||||||
.nareg = XCHAL_NUM_AREGS, \
|
.nareg = XCHAL_NUM_AREGS, \
|
||||||
.ndepc = (XCHAL_XEA_VERSION >= 2), \
|
.ndepc = (XCHAL_XEA_VERSION >= 2), \
|
||||||
.inst_fetch_width = XCHAL_INST_FETCH_WIDTH, \
|
.inst_fetch_width = XCHAL_INST_FETCH_WIDTH, \
|
||||||
|
.max_insn_size = XCHAL_MAX_INSTRUCTION_SIZE, \
|
||||||
EXCEPTIONS_SECTION, \
|
EXCEPTIONS_SECTION, \
|
||||||
INTERRUPTS_SECTION, \
|
INTERRUPTS_SECTION, \
|
||||||
TLB_SECTION, \
|
TLB_SECTION, \
|
||||||
|
|||||||
@ -53,7 +53,7 @@ struct DisasContext {
|
|||||||
uint32_t pc;
|
uint32_t pc;
|
||||||
int cring;
|
int cring;
|
||||||
int ring;
|
int ring;
|
||||||
uint32_t lbeg;
|
uint32_t lbeg_off;
|
||||||
uint32_t lend;
|
uint32_t lend;
|
||||||
|
|
||||||
bool sar_5bit;
|
bool sar_5bit;
|
||||||
@ -390,11 +390,9 @@ static void gen_jump(DisasContext *dc, TCGv dest)
|
|||||||
static void gen_jumpi(DisasContext *dc, uint32_t dest, int slot)
|
static void gen_jumpi(DisasContext *dc, uint32_t dest, int slot)
|
||||||
{
|
{
|
||||||
TCGv_i32 tmp = tcg_const_i32(dest);
|
TCGv_i32 tmp = tcg_const_i32(dest);
|
||||||
#ifndef CONFIG_USER_ONLY
|
|
||||||
if (((dc->base.pc_first ^ dest) & TARGET_PAGE_MASK) != 0) {
|
if (((dc->base.pc_first ^ dest) & TARGET_PAGE_MASK) != 0) {
|
||||||
slot = -1;
|
slot = -1;
|
||||||
}
|
}
|
||||||
#endif
|
|
||||||
gen_jump_slot(dc, tmp, slot);
|
gen_jump_slot(dc, tmp, slot);
|
||||||
tcg_temp_free(tmp);
|
tcg_temp_free(tmp);
|
||||||
}
|
}
|
||||||
@ -420,25 +418,25 @@ static void gen_callw(DisasContext *dc, int callinc, TCGv_i32 dest)
|
|||||||
static void gen_callwi(DisasContext *dc, int callinc, uint32_t dest, int slot)
|
static void gen_callwi(DisasContext *dc, int callinc, uint32_t dest, int slot)
|
||||||
{
|
{
|
||||||
TCGv_i32 tmp = tcg_const_i32(dest);
|
TCGv_i32 tmp = tcg_const_i32(dest);
|
||||||
#ifndef CONFIG_USER_ONLY
|
|
||||||
if (((dc->base.pc_first ^ dest) & TARGET_PAGE_MASK) != 0) {
|
if (((dc->base.pc_first ^ dest) & TARGET_PAGE_MASK) != 0) {
|
||||||
slot = -1;
|
slot = -1;
|
||||||
}
|
}
|
||||||
#endif
|
|
||||||
gen_callw_slot(dc, callinc, tmp, slot);
|
gen_callw_slot(dc, callinc, tmp, slot);
|
||||||
tcg_temp_free(tmp);
|
tcg_temp_free(tmp);
|
||||||
}
|
}
|
||||||
|
|
||||||
static bool gen_check_loop_end(DisasContext *dc, int slot)
|
static bool gen_check_loop_end(DisasContext *dc, int slot)
|
||||||
{
|
{
|
||||||
if (option_enabled(dc, XTENSA_OPTION_LOOP) &&
|
if (dc->base.pc_next == dc->lend) {
|
||||||
!(dc->base.tb->flags & XTENSA_TBFLAG_EXCM) &&
|
|
||||||
dc->base.pc_next == dc->lend) {
|
|
||||||
TCGLabel *label = gen_new_label();
|
TCGLabel *label = gen_new_label();
|
||||||
|
|
||||||
tcg_gen_brcondi_i32(TCG_COND_EQ, cpu_SR[LCOUNT], 0, label);
|
tcg_gen_brcondi_i32(TCG_COND_EQ, cpu_SR[LCOUNT], 0, label);
|
||||||
tcg_gen_subi_i32(cpu_SR[LCOUNT], cpu_SR[LCOUNT], 1);
|
tcg_gen_subi_i32(cpu_SR[LCOUNT], cpu_SR[LCOUNT], 1);
|
||||||
gen_jumpi(dc, dc->lbeg, slot);
|
if (dc->lbeg_off) {
|
||||||
|
gen_jumpi(dc, dc->base.pc_next - dc->lbeg_off, slot);
|
||||||
|
} else {
|
||||||
|
gen_jump(dc, cpu_SR[LBEG]);
|
||||||
|
}
|
||||||
gen_set_label(label);
|
gen_set_label(label);
|
||||||
gen_jumpi(dc, dc->base.pc_next, -1);
|
gen_jumpi(dc, dc->base.pc_next, -1);
|
||||||
return true;
|
return true;
|
||||||
@ -534,16 +532,6 @@ static void gen_rsr(DisasContext *dc, TCGv_i32 d, uint32_t sr)
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static void gen_wsr_lbeg(DisasContext *dc, uint32_t sr, TCGv_i32 s)
|
|
||||||
{
|
|
||||||
gen_helper_wsr_lbeg(cpu_env, s);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void gen_wsr_lend(DisasContext *dc, uint32_t sr, TCGv_i32 s)
|
|
||||||
{
|
|
||||||
gen_helper_wsr_lend(cpu_env, s);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void gen_wsr_sar(DisasContext *dc, uint32_t sr, TCGv_i32 s)
|
static void gen_wsr_sar(DisasContext *dc, uint32_t sr, TCGv_i32 s)
|
||||||
{
|
{
|
||||||
tcg_gen_andi_i32(cpu_SR[sr], s, 0x3f);
|
tcg_gen_andi_i32(cpu_SR[sr], s, 0x3f);
|
||||||
@ -743,8 +731,6 @@ static void gen_wsr(DisasContext *dc, uint32_t sr, TCGv_i32 s)
|
|||||||
{
|
{
|
||||||
static void (* const wsr_handler[256])(DisasContext *dc,
|
static void (* const wsr_handler[256])(DisasContext *dc,
|
||||||
uint32_t sr, TCGv_i32 v) = {
|
uint32_t sr, TCGv_i32 v) = {
|
||||||
[LBEG] = gen_wsr_lbeg,
|
|
||||||
[LEND] = gen_wsr_lend,
|
|
||||||
[SAR] = gen_wsr_sar,
|
[SAR] = gen_wsr_sar,
|
||||||
[BR] = gen_wsr_br,
|
[BR] = gen_wsr_br,
|
||||||
[LITBASE] = gen_wsr_litbase,
|
[LITBASE] = gen_wsr_litbase,
|
||||||
@ -906,13 +892,6 @@ static void disas_xtensa_insn(CPUXtensaState *env, DisasContext *dc)
|
|||||||
}
|
}
|
||||||
|
|
||||||
dc->base.pc_next = dc->pc + len;
|
dc->base.pc_next = dc->pc + len;
|
||||||
if (xtensa_option_enabled(dc->config, XTENSA_OPTION_LOOP) &&
|
|
||||||
dc->lbeg == dc->pc &&
|
|
||||||
((dc->pc ^ (dc->base.pc_next - 1)) & -dc->config->inst_fetch_width)) {
|
|
||||||
qemu_log_mask(LOG_GUEST_ERROR,
|
|
||||||
"unaligned first instruction of a loop (pc = %08x)\n",
|
|
||||||
dc->pc);
|
|
||||||
}
|
|
||||||
for (i = 1; i < len; ++i) {
|
for (i = 1; i < len; ++i) {
|
||||||
b[i] = cpu_ldub_code(env, dc->pc + i);
|
b[i] = cpu_ldub_code(env, dc->pc + i);
|
||||||
}
|
}
|
||||||
@ -1097,8 +1076,10 @@ static void xtensa_tr_init_disas_context(DisasContextBase *dcbase,
|
|||||||
dc->pc = dc->base.pc_first;
|
dc->pc = dc->base.pc_first;
|
||||||
dc->ring = tb_flags & XTENSA_TBFLAG_RING_MASK;
|
dc->ring = tb_flags & XTENSA_TBFLAG_RING_MASK;
|
||||||
dc->cring = (tb_flags & XTENSA_TBFLAG_EXCM) ? 0 : dc->ring;
|
dc->cring = (tb_flags & XTENSA_TBFLAG_EXCM) ? 0 : dc->ring;
|
||||||
dc->lbeg = env->sregs[LBEG];
|
dc->lbeg_off = (dc->base.tb->cs_base & XTENSA_CSBASE_LBEG_OFF_MASK) >>
|
||||||
dc->lend = env->sregs[LEND];
|
XTENSA_CSBASE_LBEG_OFF_SHIFT;
|
||||||
|
dc->lend = (dc->base.tb->cs_base & XTENSA_CSBASE_LEND_MASK) +
|
||||||
|
(dc->base.pc_first & TARGET_PAGE_MASK);
|
||||||
dc->debug = tb_flags & XTENSA_TBFLAG_DEBUG;
|
dc->debug = tb_flags & XTENSA_TBFLAG_DEBUG;
|
||||||
dc->icount = tb_flags & XTENSA_TBFLAG_ICOUNT;
|
dc->icount = tb_flags & XTENSA_TBFLAG_ICOUNT;
|
||||||
dc->cpenable = (tb_flags & XTENSA_TBFLAG_CPENABLE_MASK) >>
|
dc->cpenable = (tb_flags & XTENSA_TBFLAG_CPENABLE_MASK) >>
|
||||||
@ -1712,12 +1693,10 @@ static void translate_loop(DisasContext *dc, const uint32_t arg[],
|
|||||||
const uint32_t par[])
|
const uint32_t par[])
|
||||||
{
|
{
|
||||||
uint32_t lend = arg[1];
|
uint32_t lend = arg[1];
|
||||||
TCGv_i32 tmp = tcg_const_i32(lend);
|
|
||||||
|
|
||||||
tcg_gen_subi_i32(cpu_SR[LCOUNT], cpu_R[arg[0]], 1);
|
tcg_gen_subi_i32(cpu_SR[LCOUNT], cpu_R[arg[0]], 1);
|
||||||
tcg_gen_movi_i32(cpu_SR[LBEG], dc->base.pc_next);
|
tcg_gen_movi_i32(cpu_SR[LBEG], dc->base.pc_next);
|
||||||
gen_helper_wsr_lend(cpu_env, tmp);
|
tcg_gen_movi_i32(cpu_SR[LEND], lend);
|
||||||
tcg_temp_free(tmp);
|
|
||||||
|
|
||||||
if (par[0] != TCG_COND_NEVER) {
|
if (par[0] != TCG_COND_NEVER) {
|
||||||
TCGLabel *label = gen_new_label();
|
TCGLabel *label = gen_new_label();
|
||||||
@ -4609,7 +4588,7 @@ static const XtensaOpcodeOps core_ops[] = {
|
|||||||
.translate = translate_wsr,
|
.translate = translate_wsr,
|
||||||
.test_ill = test_ill_wsr,
|
.test_ill = test_ill_wsr,
|
||||||
.par = (const uint32_t[]){LBEG},
|
.par = (const uint32_t[]){LBEG},
|
||||||
.op_flags = XTENSA_OP_EXIT_TB_0,
|
.op_flags = XTENSA_OP_EXIT_TB_M1,
|
||||||
.windowed_register_op = 0x1,
|
.windowed_register_op = 0x1,
|
||||||
}, {
|
}, {
|
||||||
.name = "wsr.lcount",
|
.name = "wsr.lcount",
|
||||||
@ -4622,7 +4601,7 @@ static const XtensaOpcodeOps core_ops[] = {
|
|||||||
.translate = translate_wsr,
|
.translate = translate_wsr,
|
||||||
.test_ill = test_ill_wsr,
|
.test_ill = test_ill_wsr,
|
||||||
.par = (const uint32_t[]){LEND},
|
.par = (const uint32_t[]){LEND},
|
||||||
.op_flags = XTENSA_OP_EXIT_TB_0,
|
.op_flags = XTENSA_OP_EXIT_TB_M1,
|
||||||
.windowed_register_op = 0x1,
|
.windowed_register_op = 0x1,
|
||||||
}, {
|
}, {
|
||||||
.name = "wsr.litbase",
|
.name = "wsr.litbase",
|
||||||
@ -5183,7 +5162,7 @@ static const XtensaOpcodeOps core_ops[] = {
|
|||||||
.translate = translate_xsr,
|
.translate = translate_xsr,
|
||||||
.test_ill = test_ill_xsr,
|
.test_ill = test_ill_xsr,
|
||||||
.par = (const uint32_t[]){LBEG},
|
.par = (const uint32_t[]){LBEG},
|
||||||
.op_flags = XTENSA_OP_EXIT_TB_0,
|
.op_flags = XTENSA_OP_EXIT_TB_M1,
|
||||||
.windowed_register_op = 0x1,
|
.windowed_register_op = 0x1,
|
||||||
}, {
|
}, {
|
||||||
.name = "xsr.lcount",
|
.name = "xsr.lcount",
|
||||||
@ -5196,7 +5175,7 @@ static const XtensaOpcodeOps core_ops[] = {
|
|||||||
.translate = translate_xsr,
|
.translate = translate_xsr,
|
||||||
.test_ill = test_ill_xsr,
|
.test_ill = test_ill_xsr,
|
||||||
.par = (const uint32_t[]){LEND},
|
.par = (const uint32_t[]){LEND},
|
||||||
.op_flags = XTENSA_OP_EXIT_TB_0,
|
.op_flags = XTENSA_OP_EXIT_TB_M1,
|
||||||
.windowed_register_op = 0x1,
|
.windowed_register_op = 0x1,
|
||||||
}, {
|
}, {
|
||||||
.name = "xsr.litbase",
|
.name = "xsr.litbase",
|
||||||
|
|||||||
222
target/xtensa/win_helper.c
Normal file
222
target/xtensa/win_helper.c
Normal file
@ -0,0 +1,222 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (c) 2011 - 2019, Max Filippov, Open Source and Linux Lab.
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions are met:
|
||||||
|
* * Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* * Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* * Neither the name of the Open Source and Linux Lab nor the
|
||||||
|
* names of its contributors may be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||||
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||||
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||||
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
|
||||||
|
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
||||||
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
||||||
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
|
||||||
|
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||||||
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "qemu/osdep.h"
|
||||||
|
#include "qemu/main-loop.h"
|
||||||
|
#include "cpu.h"
|
||||||
|
#include "exec/helper-proto.h"
|
||||||
|
#include "qemu/host-utils.h"
|
||||||
|
#include "exec/exec-all.h"
|
||||||
|
|
||||||
|
static void copy_window_from_phys(CPUXtensaState *env,
|
||||||
|
uint32_t window, uint32_t phys, uint32_t n)
|
||||||
|
{
|
||||||
|
assert(phys < env->config->nareg);
|
||||||
|
if (phys + n <= env->config->nareg) {
|
||||||
|
memcpy(env->regs + window, env->phys_regs + phys,
|
||||||
|
n * sizeof(uint32_t));
|
||||||
|
} else {
|
||||||
|
uint32_t n1 = env->config->nareg - phys;
|
||||||
|
memcpy(env->regs + window, env->phys_regs + phys,
|
||||||
|
n1 * sizeof(uint32_t));
|
||||||
|
memcpy(env->regs + window + n1, env->phys_regs,
|
||||||
|
(n - n1) * sizeof(uint32_t));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void copy_phys_from_window(CPUXtensaState *env,
|
||||||
|
uint32_t phys, uint32_t window, uint32_t n)
|
||||||
|
{
|
||||||
|
assert(phys < env->config->nareg);
|
||||||
|
if (phys + n <= env->config->nareg) {
|
||||||
|
memcpy(env->phys_regs + phys, env->regs + window,
|
||||||
|
n * sizeof(uint32_t));
|
||||||
|
} else {
|
||||||
|
uint32_t n1 = env->config->nareg - phys;
|
||||||
|
memcpy(env->phys_regs + phys, env->regs + window,
|
||||||
|
n1 * sizeof(uint32_t));
|
||||||
|
memcpy(env->phys_regs, env->regs + window + n1,
|
||||||
|
(n - n1) * sizeof(uint32_t));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline unsigned windowbase_bound(unsigned a, const CPUXtensaState *env)
|
||||||
|
{
|
||||||
|
return a & (env->config->nareg / 4 - 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline unsigned windowstart_bit(unsigned a, const CPUXtensaState *env)
|
||||||
|
{
|
||||||
|
return 1 << windowbase_bound(a, env);
|
||||||
|
}
|
||||||
|
|
||||||
|
void xtensa_sync_window_from_phys(CPUXtensaState *env)
|
||||||
|
{
|
||||||
|
copy_window_from_phys(env, 0, env->sregs[WINDOW_BASE] * 4, 16);
|
||||||
|
}
|
||||||
|
|
||||||
|
void xtensa_sync_phys_from_window(CPUXtensaState *env)
|
||||||
|
{
|
||||||
|
copy_phys_from_window(env, env->sregs[WINDOW_BASE] * 4, 0, 16);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void xtensa_rotate_window_abs(CPUXtensaState *env, uint32_t position)
|
||||||
|
{
|
||||||
|
xtensa_sync_phys_from_window(env);
|
||||||
|
env->sregs[WINDOW_BASE] = windowbase_bound(position, env);
|
||||||
|
xtensa_sync_window_from_phys(env);
|
||||||
|
}
|
||||||
|
|
||||||
|
void xtensa_rotate_window(CPUXtensaState *env, uint32_t delta)
|
||||||
|
{
|
||||||
|
xtensa_rotate_window_abs(env, env->sregs[WINDOW_BASE] + delta);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(wsr_windowbase)(CPUXtensaState *env, uint32_t v)
|
||||||
|
{
|
||||||
|
xtensa_rotate_window_abs(env, v);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(entry)(CPUXtensaState *env, uint32_t pc, uint32_t s, uint32_t imm)
|
||||||
|
{
|
||||||
|
int callinc = (env->sregs[PS] & PS_CALLINC) >> PS_CALLINC_SHIFT;
|
||||||
|
|
||||||
|
env->regs[(callinc << 2) | (s & 3)] = env->regs[s] - imm;
|
||||||
|
xtensa_rotate_window(env, callinc);
|
||||||
|
env->sregs[WINDOW_START] |=
|
||||||
|
windowstart_bit(env->sregs[WINDOW_BASE], env);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(window_check)(CPUXtensaState *env, uint32_t pc, uint32_t w)
|
||||||
|
{
|
||||||
|
uint32_t windowbase = windowbase_bound(env->sregs[WINDOW_BASE], env);
|
||||||
|
uint32_t windowstart = xtensa_replicate_windowstart(env) >>
|
||||||
|
(env->sregs[WINDOW_BASE] + 1);
|
||||||
|
uint32_t n = ctz32(windowstart) + 1;
|
||||||
|
|
||||||
|
assert(n <= w);
|
||||||
|
|
||||||
|
xtensa_rotate_window(env, n);
|
||||||
|
env->sregs[PS] = (env->sregs[PS] & ~PS_OWB) |
|
||||||
|
(windowbase << PS_OWB_SHIFT) | PS_EXCM;
|
||||||
|
env->sregs[EPC1] = env->pc = pc;
|
||||||
|
|
||||||
|
switch (ctz32(windowstart >> n)) {
|
||||||
|
case 0:
|
||||||
|
HELPER(exception)(env, EXC_WINDOW_OVERFLOW4);
|
||||||
|
break;
|
||||||
|
case 1:
|
||||||
|
HELPER(exception)(env, EXC_WINDOW_OVERFLOW8);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
HELPER(exception)(env, EXC_WINDOW_OVERFLOW12);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(test_ill_retw)(CPUXtensaState *env, uint32_t pc)
|
||||||
|
{
|
||||||
|
int n = (env->regs[0] >> 30) & 0x3;
|
||||||
|
int m = 0;
|
||||||
|
uint32_t windowbase = windowbase_bound(env->sregs[WINDOW_BASE], env);
|
||||||
|
uint32_t windowstart = env->sregs[WINDOW_START];
|
||||||
|
|
||||||
|
if (windowstart & windowstart_bit(windowbase - 1, env)) {
|
||||||
|
m = 1;
|
||||||
|
} else if (windowstart & windowstart_bit(windowbase - 2, env)) {
|
||||||
|
m = 2;
|
||||||
|
} else if (windowstart & windowstart_bit(windowbase - 3, env)) {
|
||||||
|
m = 3;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (n == 0 || (m != 0 && m != n)) {
|
||||||
|
qemu_log_mask(LOG_GUEST_ERROR, "Illegal retw instruction(pc = %08x), "
|
||||||
|
"PS = %08x, m = %d, n = %d\n",
|
||||||
|
pc, env->sregs[PS], m, n);
|
||||||
|
HELPER(exception_cause)(env, pc, ILLEGAL_INSTRUCTION_CAUSE);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(test_underflow_retw)(CPUXtensaState *env, uint32_t pc)
|
||||||
|
{
|
||||||
|
int n = (env->regs[0] >> 30) & 0x3;
|
||||||
|
|
||||||
|
if (!(env->sregs[WINDOW_START] &
|
||||||
|
windowstart_bit(env->sregs[WINDOW_BASE] - n, env))) {
|
||||||
|
uint32_t windowbase = windowbase_bound(env->sregs[WINDOW_BASE], env);
|
||||||
|
|
||||||
|
xtensa_rotate_window(env, -n);
|
||||||
|
/* window underflow */
|
||||||
|
env->sregs[PS] = (env->sregs[PS] & ~PS_OWB) |
|
||||||
|
(windowbase << PS_OWB_SHIFT) | PS_EXCM;
|
||||||
|
env->sregs[EPC1] = env->pc = pc;
|
||||||
|
|
||||||
|
if (n == 1) {
|
||||||
|
HELPER(exception)(env, EXC_WINDOW_UNDERFLOW4);
|
||||||
|
} else if (n == 2) {
|
||||||
|
HELPER(exception)(env, EXC_WINDOW_UNDERFLOW8);
|
||||||
|
} else if (n == 3) {
|
||||||
|
HELPER(exception)(env, EXC_WINDOW_UNDERFLOW12);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t HELPER(retw)(CPUXtensaState *env, uint32_t pc)
|
||||||
|
{
|
||||||
|
int n = (env->regs[0] >> 30) & 0x3;
|
||||||
|
uint32_t windowbase = windowbase_bound(env->sregs[WINDOW_BASE], env);
|
||||||
|
uint32_t ret_pc = (pc & 0xc0000000) | (env->regs[0] & 0x3fffffff);
|
||||||
|
|
||||||
|
xtensa_rotate_window(env, -n);
|
||||||
|
env->sregs[WINDOW_START] &= ~windowstart_bit(windowbase, env);
|
||||||
|
return ret_pc;
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(rotw)(CPUXtensaState *env, uint32_t imm4)
|
||||||
|
{
|
||||||
|
xtensa_rotate_window(env, imm4);
|
||||||
|
}
|
||||||
|
|
||||||
|
void xtensa_restore_owb(CPUXtensaState *env)
|
||||||
|
{
|
||||||
|
xtensa_rotate_window_abs(env, (env->sregs[PS] & PS_OWB) >> PS_OWB_SHIFT);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(restore_owb)(CPUXtensaState *env)
|
||||||
|
{
|
||||||
|
xtensa_restore_owb(env);
|
||||||
|
}
|
||||||
|
|
||||||
|
void HELPER(movsp)(CPUXtensaState *env, uint32_t pc)
|
||||||
|
{
|
||||||
|
if ((env->sregs[WINDOW_START] &
|
||||||
|
(windowstart_bit(env->sregs[WINDOW_BASE] - 3, env) |
|
||||||
|
windowstart_bit(env->sregs[WINDOW_BASE] - 2, env) |
|
||||||
|
windowstart_bit(env->sregs[WINDOW_BASE] - 1, env))) == 0) {
|
||||||
|
HELPER(exception_cause)(env, pc, ALLOCA_CAUSE);
|
||||||
|
}
|
||||||
|
}
|
||||||
Loading…
x
Reference in New Issue
Block a user