op_helper.c 3.49 KB
Newer Older
Peter Maydell's avatar
Peter Maydell committed
1
#include "qemu/osdep.h"
Blue Swirl's avatar
Blue Swirl committed
2
#include "cpu.h"
3
#include "exec/helper-proto.h"
4
#include "qemu/host-utils.h"
5

6
#include "hw/lm32/lm32_pic.h"
7
#include "hw/char/lm32_juart.h"
8

9
#include "exec/exec-all.h"
10
#include "exec/cpu_ldst.h"
11

12 13 14 15
#ifndef CONFIG_USER_ONLY
#include "sysemu/sysemu.h"
#endif

16
#if !defined(CONFIG_USER_ONLY)
17
void raise_exception(CPULM32State *env, int index)
18
{
19 20 21
    CPUState *cs = CPU(lm32_env_get_cpu(env));

    cs->exception_index = index;
22
    cpu_loop_exit(cs);
23 24
}

25 26 27 28 29
void HELPER(raise_exception)(CPULM32State *env, uint32_t index)
{
    raise_exception(env, index);
}

30
void HELPER(hlt)(CPULM32State *env)
31
{
32 33 34
    CPUState *cs = CPU(lm32_env_get_cpu(env));

    cs->halted = 1;
35
    cs->exception_index = EXCP_HLT;
36
    cpu_loop_exit(cs);
37 38
}

39 40 41 42 43 44 45
void HELPER(ill)(CPULM32State *env)
{
#ifndef CONFIG_USER_ONLY
    CPUState *cs = CPU(lm32_env_get_cpu(env));
    fprintf(stderr, "VM paused due to illegal instruction. "
            "Connect a debugger or switch to the monitor console "
            "to find out more.\n");
46
    vm_stop(RUN_STATE_PAUSED);
47 48 49 50 51
    cs->halted = 1;
    raise_exception(env, EXCP_HALTED);
#endif
}

52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102
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);
            }
        }
    }
}

103
void HELPER(wcsr_im)(CPULM32State *env, uint32_t im)
104 105 106 107
{
    lm32_pic_set_im(env->pic_state, im);
}

108
void HELPER(wcsr_ip)(CPULM32State *env, uint32_t im)
109 110 111 112
{
    lm32_pic_set_ip(env->pic_state, im);
}

113
void HELPER(wcsr_jtx)(CPULM32State *env, uint32_t jtx)
114 115 116 117
{
    lm32_juart_set_jtx(env->juart_state, jtx);
}

118
void HELPER(wcsr_jrx)(CPULM32State *env, uint32_t jrx)
119 120 121 122
{
    lm32_juart_set_jrx(env->juart_state, jrx);
}

123
uint32_t HELPER(rcsr_im)(CPULM32State *env)
124 125 126 127
{
    return lm32_pic_get_im(env->pic_state);
}

128
uint32_t HELPER(rcsr_ip)(CPULM32State *env)
129 130 131 132
{
    return lm32_pic_get_ip(env->pic_state);
}

133
uint32_t HELPER(rcsr_jtx)(CPULM32State *env)
134 135 136 137
{
    return lm32_juart_get_jtx(env->juart_state);
}

138
uint32_t HELPER(rcsr_jrx)(CPULM32State *env)
139 140 141 142 143
{
    return lm32_juart_get_jrx(env->juart_state);
}

/* Try to fill the TLB and return an exception if error. If retaddr is
144 145 146 147
 * NULL, it means that the function was called in C code (i.e. not
 * from generated code or from helper.c)
 */
void tlb_fill(CPUState *cs, target_ulong addr, int is_write, int mmu_idx,
148
              uintptr_t retaddr)
149 150 151
{
    int ret;

152
    ret = lm32_cpu_handle_mmu_fault(cs, addr, is_write, mmu_idx);
153 154 155
    if (unlikely(ret)) {
        if (retaddr) {
            /* now we have a real cpu fault */
156
            cpu_restore_state(cs, retaddr);
157
        }
158
        cpu_loop_exit(cs);
159 160 161 162
    }
}
#endif