helper.c 6.53 KB
Newer Older
1 2 3
/*
 *  LatticeMico32 helper routines.
 *
4
 *  Copyright (c) 2010-2014 Michael Walle <michael@walle.cc>
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
 */

Peter Maydell's avatar
Peter Maydell committed
20
#include "qemu/osdep.h"
21
#include "cpu.h"
22
#include "exec/exec-all.h"
23
#include "qemu/host-utils.h"
24
#include "sysemu/sysemu.h"
25
#include "exec/semihost.h"
26
#include "exec/log.h"
27

28
int lm32_cpu_handle_mmu_fault(CPUState *cs, vaddr address, int rw,
29
                              int mmu_idx)
30
{
31 32
    LM32CPU *cpu = LM32_CPU(cs);
    CPULM32State *env = &cpu->env;
33 34 35 36 37
    int prot;

    address &= TARGET_PAGE_MASK;
    prot = PAGE_BITS;
    if (env->flags & LM32_FLAG_IGNORE_MSB) {
38 39
        tlb_set_page(cs, address, address & 0x7fffffff, prot, mmu_idx,
                     TARGET_PAGE_SIZE);
40
    } else {
41
        tlb_set_page(cs, address, address, prot, mmu_idx, TARGET_PAGE_SIZE);
42 43 44 45 46
    }

    return 0;
}

47
hwaddr lm32_cpu_get_phys_page_debug(CPUState *cs, vaddr addr)
48
{
49 50
    LM32CPU *cpu = LM32_CPU(cs);

51
    addr &= TARGET_PAGE_MASK;
52
    if (cpu->env.flags & LM32_FLAG_IGNORE_MSB) {
53 54 55 56
        return addr & 0x7fffffff;
    } else {
        return addr;
    }
57 58
}

59 60
void lm32_breakpoint_insert(CPULM32State *env, int idx, target_ulong address)
{
61 62 63 64
    LM32CPU *cpu = lm32_env_get_cpu(env);

    cpu_breakpoint_insert(CPU(cpu), address, BP_CPU,
                          &env->cpu_breakpoint[idx]);
65 66 67 68
}

void lm32_breakpoint_remove(CPULM32State *env, int idx)
{
69 70
    LM32CPU *cpu = lm32_env_get_cpu(env);

71 72 73 74
    if (!env->cpu_breakpoint[idx]) {
        return;
    }

75
    cpu_breakpoint_remove_by_ref(CPU(cpu), env->cpu_breakpoint[idx]);
76 77 78 79 80 81
    env->cpu_breakpoint[idx] = NULL;
}

void lm32_watchpoint_insert(CPULM32State *env, int idx, target_ulong address,
                            lm32_wp_t wp_type)
{
82
    LM32CPU *cpu = lm32_env_get_cpu(env);
83 84 85 86
    int flags = 0;

    switch (wp_type) {
    case LM32_WP_DISABLED:
87
        /* nothing to do */
88 89 90 91 92 93 94 95 96 97 98 99 100
        break;
    case LM32_WP_READ:
        flags = BP_CPU | BP_STOP_BEFORE_ACCESS | BP_MEM_READ;
        break;
    case LM32_WP_WRITE:
        flags = BP_CPU | BP_STOP_BEFORE_ACCESS | BP_MEM_WRITE;
        break;
    case LM32_WP_READ_WRITE:
        flags = BP_CPU | BP_STOP_BEFORE_ACCESS | BP_MEM_ACCESS;
        break;
    }

    if (flags != 0) {
101
        cpu_watchpoint_insert(CPU(cpu), address, 1, flags,
102 103 104 105 106 107
                &env->cpu_watchpoint[idx]);
    }
}

void lm32_watchpoint_remove(CPULM32State *env, int idx)
{
108 109
    LM32CPU *cpu = lm32_env_get_cpu(env);

110 111 112 113
    if (!env->cpu_watchpoint[idx]) {
        return;
    }

114
    cpu_watchpoint_remove_by_ref(CPU(cpu), env->cpu_watchpoint[idx]);
115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131
    env->cpu_watchpoint[idx] = NULL;
}

static bool check_watchpoints(CPULM32State *env)
{
    LM32CPU *cpu = lm32_env_get_cpu(env);
    int i;

    for (i = 0; i < cpu->num_watchpoints; i++) {
        if (env->cpu_watchpoint[i] &&
                env->cpu_watchpoint[i]->flags & BP_WATCHPOINT_HIT) {
            return true;
        }
    }
    return false;
}

132
void lm32_debug_excp_handler(CPUState *cs)
133
{
134 135
    LM32CPU *cpu = LM32_CPU(cs);
    CPULM32State *env = &cpu->env;
136 137
    CPUBreakpoint *bp;

138 139 140
    if (cs->watchpoint_hit) {
        if (cs->watchpoint_hit->flags & BP_CPU) {
            cs->watchpoint_hit = NULL;
141 142 143
            if (check_watchpoints(env)) {
                raise_exception(env, EXCP_WATCHPOINT);
            } else {
144
                cpu_loop_exit_noexc(cs);
145 146 147
            }
        }
    } else {
148
        QTAILQ_FOREACH(bp, &cs->breakpoints, entry) {
149 150 151 152 153 154 155 156 157 158
            if (bp->pc == env->pc) {
                if (bp->flags & BP_CPU) {
                    raise_exception(env, EXCP_BREAKPOINT);
                }
                break;
            }
        }
    }
}

159
void lm32_cpu_do_interrupt(CPUState *cs)
160
{
161 162 163
    LM32CPU *cpu = LM32_CPU(cs);
    CPULM32State *env = &cpu->env;

164
    qemu_log_mask(CPU_LOG_INT,
165
            "exception at pc=%x type=%x\n", env->pc, cs->exception_index);
166

167
    switch (cs->exception_index) {
168
    case EXCP_SYSTEMCALL:
169
        if (unlikely(semihosting_enabled())) {
170 171 172 173 174 175 176 177
            /* do_semicall() returns true if call was handled. Otherwise
             * do the normal exception handling. */
            if (lm32_cpu_do_semihosting(cs)) {
                env->pc += 4;
                break;
            }
        }
        /* fall through */
178 179 180 181 182 183 184 185 186
    case EXCP_INSN_BUS_ERROR:
    case EXCP_DATA_BUS_ERROR:
    case EXCP_DIVIDE_BY_ZERO:
    case EXCP_IRQ:
        /* non-debug exceptions */
        env->regs[R_EA] = env->pc;
        env->ie |= (env->ie & IE_IE) ? IE_EIE : 0;
        env->ie &= ~IE_IE;
        if (env->dc & DC_RE) {
187
            env->pc = env->deba + (cs->exception_index * 32);
188
        } else {
189
            env->pc = env->eba + (cs->exception_index * 32);
190
        }
191
        log_cpu_state_mask(CPU_LOG_INT, cs, 0);
192 193 194 195 196 197 198
        break;
    case EXCP_BREAKPOINT:
    case EXCP_WATCHPOINT:
        /* debug exceptions */
        env->regs[R_BA] = env->pc;
        env->ie |= (env->ie & IE_IE) ? IE_BIE : 0;
        env->ie &= ~IE_IE;
199
        env->pc = env->deba + (cs->exception_index * 32);
200
        log_cpu_state_mask(CPU_LOG_INT, cs, 0);
201 202
        break;
    default:
203
        cpu_abort(cs, "unhandled exception type=%d\n",
204
                  cs->exception_index);
205 206 207 208
        break;
    }
}

209 210 211 212 213 214 215 216 217 218 219 220 221
bool lm32_cpu_exec_interrupt(CPUState *cs, int interrupt_request)
{
    LM32CPU *cpu = LM32_CPU(cs);
    CPULM32State *env = &cpu->env;

    if ((interrupt_request & CPU_INTERRUPT_HARD) && (env->ie & IE_IE)) {
        cs->exception_index = EXCP_IRQ;
        lm32_cpu_do_interrupt(cs);
        return true;
    }
    return false;
}

222
LM32CPU *cpu_lm32_init(const char *cpu_model)
223
{
224
    return LM32_CPU(cpu_generic_init(TYPE_LM32_CPU, cpu_model));
225 226 227 228 229
}

/* Some soc ignores the MSB on the address bus. Thus creating a shadow memory
 * area. As a general rule, 0x00000000-0x7fffffff is cached, whereas
 * 0x80000000-0xffffffff is not cached and used to access IO devices. */
230
void cpu_lm32_set_phys_msb_ignore(CPULM32State *env, int value)
231 232 233 234 235 236 237
{
    if (value) {
        env->flags |= LM32_FLAG_IGNORE_MSB;
    } else {
        env->flags &= ~LM32_FLAG_IGNORE_MSB;
    }
}