148 lines
3.1 KiB
C
148 lines
3.1 KiB
C
#include "qemu/osdep.h"
|
|
#include "cpu.h"
|
|
#include "exec/helper-proto.h"
|
|
#include "qemu/host-utils.h"
|
|
#include "qemu/main-loop.h"
|
|
#include "sysemu/runstate.h"
|
|
|
|
#include "hw/lm32/lm32_pic.h"
|
|
#include "hw/char/lm32_juart.h"
|
|
|
|
#include "exec/exec-all.h"
|
|
#include "exec/cpu_ldst.h"
|
|
|
|
#ifndef CONFIG_USER_ONLY
|
|
#endif
|
|
|
|
#if !defined(CONFIG_USER_ONLY)
|
|
void raise_exception(CPULM32State *env, int index)
|
|
{
|
|
CPUState *cs = env_cpu(env);
|
|
|
|
cs->exception_index = index;
|
|
cpu_loop_exit(cs);
|
|
}
|
|
|
|
void HELPER(raise_exception)(CPULM32State *env, uint32_t index)
|
|
{
|
|
raise_exception(env, index);
|
|
}
|
|
|
|
void HELPER(hlt)(CPULM32State *env)
|
|
{
|
|
CPUState *cs = env_cpu(env);
|
|
|
|
cs->halted = 1;
|
|
cs->exception_index = EXCP_HLT;
|
|
cpu_loop_exit(cs);
|
|
}
|
|
|
|
void HELPER(ill)(CPULM32State *env)
|
|
{
|
|
#ifndef CONFIG_USER_ONLY
|
|
CPUState *cs = env_cpu(env);
|
|
fprintf(stderr, "VM paused due to illegal instruction. "
|
|
"Connect a debugger or switch to the monitor console "
|
|
"to find out more.\n");
|
|
vm_stop(RUN_STATE_PAUSED);
|
|
cs->halted = 1;
|
|
raise_exception(env, EXCP_HALTED);
|
|
#endif
|
|
}
|
|
|
|
void HELPER(wcsr_bp)(CPULM32State *env, uint32_t bp, uint32_t idx)
|
|
{
|
|
uint32_t addr = bp & ~1;
|
|
|
|
assert(idx < 4);
|
|
|
|
env->bp[idx] = bp;
|
|
lm32_breakpoint_remove(env, idx);
|
|
if (bp & 1) {
|
|
lm32_breakpoint_insert(env, idx, addr);
|
|
}
|
|
}
|
|
|
|
void HELPER(wcsr_wp)(CPULM32State *env, uint32_t wp, uint32_t idx)
|
|
{
|
|
lm32_wp_t wp_type;
|
|
|
|
assert(idx < 4);
|
|
|
|
env->wp[idx] = wp;
|
|
|
|
wp_type = lm32_wp_type(env->dc, idx);
|
|
lm32_watchpoint_remove(env, idx);
|
|
if (wp_type != LM32_WP_DISABLED) {
|
|
lm32_watchpoint_insert(env, idx, wp, wp_type);
|
|
}
|
|
}
|
|
|
|
void HELPER(wcsr_dc)(CPULM32State *env, uint32_t dc)
|
|
{
|
|
uint32_t old_dc;
|
|
int i;
|
|
lm32_wp_t old_type;
|
|
lm32_wp_t new_type;
|
|
|
|
old_dc = env->dc;
|
|
env->dc = dc;
|
|
|
|
for (i = 0; i < 4; i++) {
|
|
old_type = lm32_wp_type(old_dc, i);
|
|
new_type = lm32_wp_type(dc, i);
|
|
|
|
if (old_type != new_type) {
|
|
lm32_watchpoint_remove(env, i);
|
|
if (new_type != LM32_WP_DISABLED) {
|
|
lm32_watchpoint_insert(env, i, env->wp[i], new_type);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void HELPER(wcsr_im)(CPULM32State *env, uint32_t im)
|
|
{
|
|
qemu_mutex_lock_iothread();
|
|
lm32_pic_set_im(env->pic_state, im);
|
|
qemu_mutex_unlock_iothread();
|
|
}
|
|
|
|
void HELPER(wcsr_ip)(CPULM32State *env, uint32_t im)
|
|
{
|
|
qemu_mutex_lock_iothread();
|
|
lm32_pic_set_ip(env->pic_state, im);
|
|
qemu_mutex_unlock_iothread();
|
|
}
|
|
|
|
void HELPER(wcsr_jtx)(CPULM32State *env, uint32_t jtx)
|
|
{
|
|
lm32_juart_set_jtx(env->juart_state, jtx);
|
|
}
|
|
|
|
void HELPER(wcsr_jrx)(CPULM32State *env, uint32_t jrx)
|
|
{
|
|
lm32_juart_set_jrx(env->juart_state, jrx);
|
|
}
|
|
|
|
uint32_t HELPER(rcsr_im)(CPULM32State *env)
|
|
{
|
|
return lm32_pic_get_im(env->pic_state);
|
|
}
|
|
|
|
uint32_t HELPER(rcsr_ip)(CPULM32State *env)
|
|
{
|
|
return lm32_pic_get_ip(env->pic_state);
|
|
}
|
|
|
|
uint32_t HELPER(rcsr_jtx)(CPULM32State *env)
|
|
{
|
|
return lm32_juart_get_jtx(env->juart_state);
|
|
}
|
|
|
|
uint32_t HELPER(rcsr_jrx)(CPULM32State *env)
|
|
{
|
|
return lm32_juart_get_jrx(env->juart_state);
|
|
}
|
|
#endif
|
|
|