Revision 17c0fa3d

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

  
20
#include <stdio.h>
21
#include <string.h>
22
#include <assert.h>
23

  
24
#include "config.h"
25
#include "cpu.h"
26
#include "exec-all.h"
27
#include "host-utils.h"
28

  
29
int cpu_lm32_handle_mmu_fault(CPUState *env, target_ulong address, int rw,
30
                               int mmu_idx, int is_softmmu)
31
{
32
    int prot;
33

  
34
    address &= TARGET_PAGE_MASK;
35
    prot = PAGE_BITS;
36
    if (env->flags & LM32_FLAG_IGNORE_MSB) {
37
        tlb_set_page(env, address, address & 0x7fffffff, prot, mmu_idx,
38
                TARGET_PAGE_SIZE);
39
    } else {
40
        tlb_set_page(env, address, address, prot, mmu_idx, TARGET_PAGE_SIZE);
41
    }
42

  
43
    return 0;
44
}
45

  
46
target_phys_addr_t cpu_get_phys_page_debug(CPUState *env, target_ulong addr)
47
{
48
    return addr & TARGET_PAGE_MASK;
49
}
50

  
51
void do_interrupt(CPUState *env)
52
{
53
    qemu_log_mask(CPU_LOG_INT,
54
            "exception at pc=%x type=%x\n", env->pc, env->exception_index);
55

  
56
    switch (env->exception_index) {
57
    case EXCP_INSN_BUS_ERROR:
58
    case EXCP_DATA_BUS_ERROR:
59
    case EXCP_DIVIDE_BY_ZERO:
60
    case EXCP_IRQ:
61
    case EXCP_SYSTEMCALL:
62
        /* non-debug exceptions */
63
        env->regs[R_EA] = env->pc;
64
        env->ie |= (env->ie & IE_IE) ? IE_EIE : 0;
65
        env->ie &= ~IE_IE;
66
        if (env->dc & DC_RE) {
67
            env->pc = env->deba + (env->exception_index * 32);
68
        } else {
69
            env->pc = env->eba + (env->exception_index * 32);
70
        }
71
        log_cpu_state_mask(CPU_LOG_INT, env, 0);
72
        break;
73
    case EXCP_BREAKPOINT:
74
    case EXCP_WATCHPOINT:
75
        /* debug exceptions */
76
        env->regs[R_BA] = env->pc;
77
        env->ie |= (env->ie & IE_IE) ? IE_BIE : 0;
78
        env->ie &= ~IE_IE;
79
        if (env->dc & DC_RE) {
80
            env->pc = env->deba + (env->exception_index * 32);
81
        } else {
82
            env->pc = env->eba + (env->exception_index * 32);
83
        }
84
        log_cpu_state_mask(CPU_LOG_INT, env, 0);
85
        break;
86
    default:
87
        cpu_abort(env, "unhandled exception type=%d\n",
88
                  env->exception_index);
89
        break;
90
    }
91
}
92

  
93
typedef struct {
94
    const char *name;
95
    uint32_t revision;
96
    uint8_t num_interrupts;
97
    uint8_t num_breakpoints;
98
    uint8_t num_watchpoints;
99
    uint32_t features;
100
} LM32Def;
101

  
102
static const LM32Def lm32_defs[] = {
103
    {
104
        .name = "lm32-basic",
105
        .revision = 3,
106
        .num_interrupts = 32,
107
        .num_breakpoints = 4,
108
        .num_watchpoints = 4,
109
        .features = (LM32_FEATURE_SHIFT
110
                     | LM32_FEATURE_SIGN_EXTEND
111
                     | LM32_FEATURE_CYCLE_COUNT),
112
    },
113
    {
114
        .name = "lm32-standard",
115
        .revision = 3,
116
        .num_interrupts = 32,
117
        .num_breakpoints = 4,
118
        .num_watchpoints = 4,
119
        .features = (LM32_FEATURE_MULTIPLY
120
                     | LM32_FEATURE_DIVIDE
121
                     | LM32_FEATURE_SHIFT
122
                     | LM32_FEATURE_SIGN_EXTEND
123
                     | LM32_FEATURE_I_CACHE
124
                     | LM32_FEATURE_CYCLE_COUNT),
125
    },
126
    {
127
        .name = "lm32-full",
128
        .revision = 3,
129
        .num_interrupts = 32,
130
        .num_breakpoints = 4,
131
        .num_watchpoints = 4,
132
        .features = (LM32_FEATURE_MULTIPLY
133
                     | LM32_FEATURE_DIVIDE
134
                     | LM32_FEATURE_SHIFT
135
                     | LM32_FEATURE_SIGN_EXTEND
136
                     | LM32_FEATURE_I_CACHE
137
                     | LM32_FEATURE_D_CACHE
138
                     | LM32_FEATURE_CYCLE_COUNT),
139
    }
140
};
141

  
142
void cpu_lm32_list(FILE *f, fprintf_function cpu_fprintf)
143
{
144
    int i;
145

  
146
    cpu_fprintf(f, "Available CPUs:\n");
147
    for (i = 0; i < ARRAY_SIZE(lm32_defs); i++) {
148
        cpu_fprintf(f, "  %s\n", lm32_defs[i].name);
149
    }
150
}
151

  
152
static const LM32Def *cpu_lm32_find_by_name(const char *name)
153
{
154
    int i;
155

  
156
    for (i = 0; i < ARRAY_SIZE(lm32_defs); i++) {
157
        if (strcasecmp(name, lm32_defs[i].name) == 0) {
158
            return &lm32_defs[i];
159
        }
160
    }
161

  
162
    return NULL;
163
}
164

  
165
static uint32_t cfg_by_def(const LM32Def *def)
166
{
167
    uint32_t cfg = 0;
168

  
169
    if (def->features & LM32_FEATURE_MULTIPLY) {
170
        cfg |= CFG_M;
171
    }
172

  
173
    if (def->features & LM32_FEATURE_DIVIDE) {
174
        cfg |= CFG_D;
175
    }
176

  
177
    if (def->features & LM32_FEATURE_SHIFT) {
178
        cfg |= CFG_S;
179
    }
180

  
181
    if (def->features & LM32_FEATURE_SIGN_EXTEND) {
182
        cfg |= CFG_X;
183
    }
184

  
185
    if (def->features & LM32_FEATURE_I_CACHE) {
186
        cfg |= CFG_IC;
187
    }
188

  
189
    if (def->features & LM32_FEATURE_D_CACHE) {
190
        cfg |= CFG_DC;
191
    }
192

  
193
    if (def->features & LM32_FEATURE_CYCLE_COUNT) {
194
        cfg |= CFG_CC;
195
    }
196

  
197
    cfg |= (def->num_interrupts << CFG_INT_SHIFT);
198
    cfg |= (def->num_breakpoints << CFG_BP_SHIFT);
199
    cfg |= (def->num_watchpoints << CFG_WP_SHIFT);
200
    cfg |= (def->revision << CFG_REV_SHIFT);
201

  
202
    return cfg;
203
}
204

  
205
CPUState *cpu_lm32_init(const char *cpu_model)
206
{
207
    CPUState *env;
208
    const LM32Def *def;
209
    static int tcg_initialized;
210

  
211
    def = cpu_lm32_find_by_name(cpu_model);
212
    if (!def) {
213
        return NULL;
214
    }
215

  
216
    env = qemu_mallocz(sizeof(CPUState));
217

  
218
    env->features = def->features;
219
    env->num_bps = def->num_breakpoints;
220
    env->num_wps = def->num_watchpoints;
221
    env->cfg = cfg_by_def(def);
222
    env->flags = 0;
223

  
224
    cpu_exec_init(env);
225
    cpu_reset(env);
226

  
227
    if (!tcg_initialized) {
228
        tcg_initialized = 1;
229
        lm32_translate_init();
230
    }
231

  
232
    return env;
233
}
234

  
235
/* Some soc ignores the MSB on the address bus. Thus creating a shadow memory
236
 * area. As a general rule, 0x00000000-0x7fffffff is cached, whereas
237
 * 0x80000000-0xffffffff is not cached and used to access IO devices. */
238
void cpu_lm32_set_phys_msb_ignore(CPUState *env, int value)
239
{
240
    if (value) {
241
        env->flags |= LM32_FLAG_IGNORE_MSB;
242
    } else {
243
        env->flags &= ~LM32_FLAG_IGNORE_MSB;
244
    }
245
}
246

  
247
void cpu_reset(CPUState *env)
248
{
249
    if (qemu_loglevel_mask(CPU_LOG_RESET)) {
250
        qemu_log("CPU Reset (CPU %d)\n", env->cpu_index);
251
        log_cpu_state(env, 0);
252
    }
253

  
254
    tlb_flush(env, 1);
255

  
256
    /* reset cpu state */
257
    memset(env, 0, offsetof(CPULM32State, breakpoints));
258
}
259

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

  
20
/* Convenient binary macros */
21
#define HEX__(n) 0x##n##LU
22
#define B8__(x) (((x&0x0000000FLU) ? 1 : 0) \
23
                  + ((x&0x000000F0LU) ? 2 : 0) \
24
                  + ((x&0x00000F00LU) ? 4 : 0) \
25
                  + ((x&0x0000F000LU) ? 8 : 0) \
26
                  + ((x&0x000F0000LU) ? 16 : 0) \
27
                  + ((x&0x00F00000LU) ? 32 : 0) \
28
                  + ((x&0x0F000000LU) ? 64 : 0) \
29
                  + ((x&0xF0000000LU) ? 128 : 0))
30
#define B8(d) ((unsigned char)B8__(HEX__(d)))
31

  
32
/* Decode logic, value and mask.  */
33
#define DEC_ADD     {B8(00001101), B8(00011111)}
34
#define DEC_AND     {B8(00001000), B8(00011111)}
35
#define DEC_ANDHI   {B8(00011000), B8(00111111)}
36
#define DEC_B       {B8(00110000), B8(00111111)}
37
#define DEC_BI      {B8(00111000), B8(00111111)}
38
#define DEC_BE      {B8(00010001), B8(00111111)}
39
#define DEC_BG      {B8(00010010), B8(00111111)}
40
#define DEC_BGE     {B8(00010011), B8(00111111)}
41
#define DEC_BGEU    {B8(00010100), B8(00111111)}
42
#define DEC_BGU     {B8(00010101), B8(00111111)}
43
#define DEC_BNE     {B8(00010111), B8(00111111)}
44
#define DEC_CALL    {B8(00110110), B8(00111111)}
45
#define DEC_CALLI   {B8(00111110), B8(00111111)}
46
#define DEC_CMPE    {B8(00011001), B8(00011111)}
47
#define DEC_CMPG    {B8(00011010), B8(00011111)}
48
#define DEC_CMPGE   {B8(00011011), B8(00011111)}
49
#define DEC_CMPGEU  {B8(00011100), B8(00011111)}
50
#define DEC_CMPGU   {B8(00011101), B8(00011111)}
51
#define DEC_CMPNE   {B8(00011111), B8(00011111)}
52
#define DEC_DIVU    {B8(00100011), B8(00111111)}
53
#define DEC_LB      {B8(00000100), B8(00111111)}
54
#define DEC_LBU     {B8(00010000), B8(00111111)}
55
#define DEC_LH      {B8(00000111), B8(00111111)}
56
#define DEC_LHU     {B8(00001011), B8(00111111)}
57
#define DEC_LW      {B8(00001010), B8(00111111)}
58
#define DEC_MODU    {B8(00110001), B8(00111111)}
59
#define DEC_MUL     {B8(00000010), B8(00011111)}
60
#define DEC_NOR     {B8(00000001), B8(00011111)}
61
#define DEC_OR      {B8(00001110), B8(00011111)}
62
#define DEC_ORHI    {B8(00011110), B8(00111111)}
63
#define DEC_RAISE   {B8(00101011), B8(00111111)}
64
#define DEC_RCSR    {B8(00100100), B8(00111111)}
65
#define DEC_SB      {B8(00001100), B8(00111111)}
66
#define DEC_SEXTB   {B8(00101100), B8(00111111)}
67
#define DEC_SEXTH   {B8(00110111), B8(00111111)}
68
#define DEC_SH      {B8(00000011), B8(00111111)}
69
#define DEC_SL      {B8(00001111), B8(00011111)}
70
#define DEC_SR      {B8(00000101), B8(00011111)}
71
#define DEC_SRU     {B8(00000000), B8(00011111)}
72
#define DEC_SUB     {B8(00110010), B8(00111111)}
73
#define DEC_SW      {B8(00010110), B8(00111111)}
74
#define DEC_USER    {B8(00110011), B8(00111111)}
75
#define DEC_WCSR    {B8(00110100), B8(00111111)}
76
#define DEC_XNOR    {B8(00001001), B8(00011111)}
77
#define DEC_XOR     {B8(00000110), B8(00011111)}
78

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

  
20
#include <stdarg.h>
21
#include <stdlib.h>
22
#include <stdio.h>
23
#include <string.h>
24
#include <inttypes.h>
25
#include <assert.h>
26

  
27
#include "cpu.h"
28
#include "exec-all.h"
29
#include "disas.h"
30
#include "helper.h"
31
#include "tcg-op.h"
32
#include "lm32-decode.h"
33
#include "qemu-common.h"
34

  
35
#include "hw/lm32_pic.h"
36

  
37
#define GEN_HELPER 1
38
#include "helper.h"
39

  
40
#define DISAS_LM32 1
41
#if DISAS_LM32
42
#  define LOG_DIS(...) qemu_log_mask(CPU_LOG_TB_IN_ASM, ## __VA_ARGS__)
43
#else
44
#  define LOG_DIS(...) do { } while (0)
45
#endif
46

  
47
#define EXTRACT_FIELD(src, start, end) \
48
            (((src) >> start) & ((1 << (end - start + 1)) - 1))
49

  
50
#define MEM_INDEX 0
51

  
52
static TCGv_ptr cpu_env;
53
static TCGv cpu_R[32];
54
static TCGv cpu_pc;
55
static TCGv cpu_ie;
56
static TCGv cpu_icc;
57
static TCGv cpu_dcc;
58
static TCGv cpu_cc;
59
static TCGv cpu_cfg;
60
static TCGv cpu_eba;
61
static TCGv cpu_dc;
62
static TCGv cpu_deba;
63
static TCGv cpu_bp[4];
64
static TCGv cpu_wp[4];
65

  
66
#include "gen-icount.h"
67

  
68
enum {
69
    OP_FMT_RI,
70
    OP_FMT_RR,
71
    OP_FMT_CR,
72
    OP_FMT_I
73
};
74

  
75
/* This is the state at translation time.  */
76
typedef struct DisasContext {
77
    CPUState *env;
78
    target_ulong pc;
79

  
80
    /* Decoder.  */
81
    int format;
82
    uint32_t ir;
83
    uint8_t opcode;
84
    uint8_t r0, r1, r2, csr;
85
    uint16_t imm5;
86
    uint16_t imm16;
87
    uint32_t imm26;
88

  
89
    unsigned int delayed_branch;
90
    unsigned int tb_flags, synced_flags; /* tb dependent flags.  */
91
    int is_jmp;
92

  
93
    int nr_nops;
94
    struct TranslationBlock *tb;
95
    int singlestep_enabled;
96
} DisasContext;
97

  
98
static const char *regnames[] = {
99
    "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
100
    "r8", "r9", "r10", "r11", "r12", "r13", "r14", "r15",
101
    "r16", "r17", "r18", "r19", "r20", "r21", "r22", "r23",
102
    "r24", "r25", "r26/gp", "r27/fp", "r28/sp", "r29/ra",
103
    "r30/ea", "r31/ba", "bp0", "bp1", "bp2", "bp3", "wp0",
104
    "wp1", "wp2", "wp3"
105
};
106

  
107
static inline int zero_extend(unsigned int val, int width)
108
{
109
    return val & ((1 << width) - 1);
110
}
111

  
112
static inline int sign_extend(unsigned int val, int width)
113
{
114
    int sval;
115

  
116
    /* LSL.  */
117
    val <<= 32 - width;
118
    sval = val;
119
    /* ASR.  */
120
    sval >>= 32 - width;
121

  
122
    return sval;
123
}
124

  
125
static inline void t_gen_raise_exception(DisasContext *dc, uint32_t index)
126
{
127
    TCGv_i32 tmp = tcg_const_i32(index);
128

  
129
    gen_helper_raise_exception(tmp);
130
    tcg_temp_free_i32(tmp);
131
}
132

  
133
static void gen_goto_tb(DisasContext *dc, int n, target_ulong dest)
134
{
135
    TranslationBlock *tb;
136

  
137
    tb = dc->tb;
138
    if ((tb->pc & TARGET_PAGE_MASK) == (dest & TARGET_PAGE_MASK) &&
139
            likely(!dc->singlestep_enabled)) {
140
        tcg_gen_goto_tb(n);
141
        tcg_gen_movi_tl(cpu_pc, dest);
142
        tcg_gen_exit_tb((long)tb + n);
143
    } else {
144
        tcg_gen_movi_tl(cpu_pc, dest);
145
        if (dc->singlestep_enabled) {
146
            t_gen_raise_exception(dc, EXCP_DEBUG);
147
        }
148
        tcg_gen_exit_tb(0);
149
    }
150
}
151

  
152
static void dec_add(DisasContext *dc)
153
{
154
    if (dc->format == OP_FMT_RI) {
155
        if (dc->r0 == R_R0) {
156
            if (dc->r1 == R_R0 && dc->imm16 == 0) {
157
                LOG_DIS("nop\n");
158
            } else {
159
                LOG_DIS("mvi r%d, %d\n", dc->r1, sign_extend(dc->imm16, 16));
160
            }
161
        } else {
162
            LOG_DIS("addi r%d, r%d, %d\n", dc->r1, dc->r0,
163
                    sign_extend(dc->imm16, 16));
164
        }
165
    } else {
166
        LOG_DIS("add r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
167
    }
168

  
169
    if (dc->format == OP_FMT_RI) {
170
        tcg_gen_addi_tl(cpu_R[dc->r1], cpu_R[dc->r0],
171
                sign_extend(dc->imm16, 16));
172
    } else {
173
        tcg_gen_add_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
174
    }
175
}
176

  
177
static void dec_and(DisasContext *dc)
178
{
179
    if (dc->format == OP_FMT_RI) {
180
        LOG_DIS("andi r%d, r%d, %d\n", dc->r1, dc->r0,
181
                zero_extend(dc->imm16, 16));
182
    } else {
183
        LOG_DIS("and r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
184
    }
185

  
186
    if (dc->format == OP_FMT_RI) {
187
        tcg_gen_andi_tl(cpu_R[dc->r1], cpu_R[dc->r0],
188
                zero_extend(dc->imm16, 16));
189
    } else  {
190
        if (dc->r0 == 0 && dc->r1 == 0 && dc->r2 == 0) {
191
            tcg_gen_movi_tl(cpu_pc, dc->pc + 4);
192
            gen_helper_hlt();
193
        } else {
194
            tcg_gen_and_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
195
        }
196
    }
197
}
198

  
199
static void dec_andhi(DisasContext *dc)
200
{
201
    LOG_DIS("andhi r%d, r%d, %d\n", dc->r2, dc->r0, dc->imm16);
202

  
203
    tcg_gen_andi_tl(cpu_R[dc->r1], cpu_R[dc->r0], (dc->imm16 << 16));
204
}
205

  
206
static void dec_b(DisasContext *dc)
207
{
208
    if (dc->r0 == R_RA) {
209
        LOG_DIS("ret\n");
210
    } else if (dc->r0 == R_EA) {
211
        LOG_DIS("eret\n");
212
    } else if (dc->r0 == R_BA) {
213
        LOG_DIS("bret\n");
214
    } else {
215
        LOG_DIS("b r%d\n", dc->r0);
216
    }
217

  
218
    /* restore IE.IE in case of an eret */
219
    if (dc->r0 == R_EA) {
220
        TCGv t0 = tcg_temp_new();
221
        int l1 = gen_new_label();
222
        tcg_gen_andi_tl(t0, cpu_ie, IE_EIE);
223
        tcg_gen_ori_tl(cpu_ie, cpu_ie, IE_IE);
224
        tcg_gen_brcondi_tl(TCG_COND_EQ, t0, IE_EIE, l1);
225
        tcg_gen_andi_tl(cpu_ie, cpu_ie, ~IE_IE);
226
        gen_set_label(l1);
227
        tcg_temp_free(t0);
228
    } else if (dc->r0 == R_BA) {
229
        TCGv t0 = tcg_temp_new();
230
        int l1 = gen_new_label();
231
        tcg_gen_andi_tl(t0, cpu_ie, IE_BIE);
232
        tcg_gen_ori_tl(cpu_ie, cpu_ie, IE_IE);
233
        tcg_gen_brcondi_tl(TCG_COND_EQ, t0, IE_BIE, l1);
234
        tcg_gen_andi_tl(cpu_ie, cpu_ie, ~IE_IE);
235
        gen_set_label(l1);
236
        tcg_temp_free(t0);
237
    }
238
    tcg_gen_mov_tl(cpu_pc, cpu_R[dc->r0]);
239

  
240
    dc->is_jmp = DISAS_JUMP;
241
}
242

  
243
static void dec_bi(DisasContext *dc)
244
{
245
    LOG_DIS("bi %d\n", sign_extend(dc->imm26 << 2, 26));
246

  
247
    gen_goto_tb(dc, 0, dc->pc + (sign_extend(dc->imm26 << 2, 26)));
248

  
249
    dc->is_jmp = DISAS_TB_JUMP;
250
}
251

  
252
static inline void gen_cond_branch(DisasContext *dc, int cond)
253
{
254
    int l1;
255

  
256
    l1 = gen_new_label();
257
    tcg_gen_brcond_tl(cond, cpu_R[dc->r0], cpu_R[dc->r1], l1);
258
    gen_goto_tb(dc, 0, dc->pc + 4);
259
    gen_set_label(l1);
260
    gen_goto_tb(dc, 1, dc->pc + (sign_extend(dc->imm16 << 2, 16)));
261
    dc->is_jmp = DISAS_TB_JUMP;
262
}
263

  
264
static void dec_be(DisasContext *dc)
265
{
266
    LOG_DIS("be r%d, r%d, %d\n", dc->r0, dc->r1,
267
            sign_extend(dc->imm16, 16) * 4);
268

  
269
    gen_cond_branch(dc, TCG_COND_EQ);
270
}
271

  
272
static void dec_bg(DisasContext *dc)
273
{
274
    LOG_DIS("bg r%d, r%d, %d\n", dc->r0, dc->r1,
275
            sign_extend(dc->imm16, 16 * 4));
276

  
277
    gen_cond_branch(dc, TCG_COND_GT);
278
}
279

  
280
static void dec_bge(DisasContext *dc)
281
{
282
    LOG_DIS("bge r%d, r%d, %d\n", dc->r0, dc->r1,
283
            sign_extend(dc->imm16, 16) * 4);
284

  
285
    gen_cond_branch(dc, TCG_COND_GE);
286
}
287

  
288
static void dec_bgeu(DisasContext *dc)
289
{
290
    LOG_DIS("bgeu r%d, r%d, %d\n", dc->r0, dc->r1,
291
            sign_extend(dc->imm16, 16) * 4);
292

  
293
    gen_cond_branch(dc, TCG_COND_GEU);
294
}
295

  
296
static void dec_bgu(DisasContext *dc)
297
{
298
    LOG_DIS("bgu r%d, r%d, %d\n", dc->r0, dc->r1,
299
            sign_extend(dc->imm16, 16) * 4);
300

  
301
    gen_cond_branch(dc, TCG_COND_GTU);
302
}
303

  
304
static void dec_bne(DisasContext *dc)
305
{
306
    LOG_DIS("bne r%d, r%d, %d\n", dc->r0, dc->r1,
307
            sign_extend(dc->imm16, 16) * 4);
308

  
309
    gen_cond_branch(dc, TCG_COND_NE);
310
}
311

  
312
static void dec_call(DisasContext *dc)
313
{
314
    LOG_DIS("call r%d\n", dc->r0);
315

  
316
    tcg_gen_movi_tl(cpu_R[R_RA], dc->pc + 4);
317
    tcg_gen_mov_tl(cpu_pc, cpu_R[dc->r0]);
318

  
319
    dc->is_jmp = DISAS_JUMP;
320
}
321

  
322
static void dec_calli(DisasContext *dc)
323
{
324
    LOG_DIS("calli %d\n", sign_extend(dc->imm26, 26) * 4);
325

  
326
    tcg_gen_movi_tl(cpu_R[R_RA], dc->pc + 4);
327
    gen_goto_tb(dc, 0, dc->pc + (sign_extend(dc->imm26 << 2, 26)));
328

  
329
    dc->is_jmp = DISAS_TB_JUMP;
330
}
331

  
332
static inline void gen_compare(DisasContext *dc, int cond)
333
{
334
    int rX = (dc->format == OP_FMT_RR) ? dc->r2 : dc->r1;
335
    int rY = (dc->format == OP_FMT_RR) ? dc->r0 : dc->r0;
336
    int rZ = (dc->format == OP_FMT_RR) ? dc->r1 : -1;
337

  
338
    if (dc->format == OP_FMT_RI) {
339
        tcg_gen_setcondi_tl(cond, cpu_R[rX], cpu_R[rY],
340
                sign_extend(dc->imm16, 16));
341
    } else {
342
        tcg_gen_setcond_tl(cond, cpu_R[rX], cpu_R[rY], cpu_R[rZ]);
343
    }
344
}
345

  
346
static void dec_cmpe(DisasContext *dc)
347
{
348
    if (dc->format == OP_FMT_RI) {
349
        LOG_DIS("cmpei r%d, r%d, %d\n", dc->r0, dc->r1,
350
                sign_extend(dc->imm16, 16));
351
    } else {
352
        LOG_DIS("cmpe r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
353
    }
354

  
355
    gen_compare(dc, TCG_COND_EQ);
356
}
357

  
358
static void dec_cmpg(DisasContext *dc)
359
{
360
    if (dc->format == OP_FMT_RI) {
361
        LOG_DIS("cmpgi r%d, r%d, %d\n", dc->r0, dc->r1,
362
                sign_extend(dc->imm16, 16));
363
    } else {
364
        LOG_DIS("cmpg r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
365
    }
366

  
367
    gen_compare(dc, TCG_COND_GT);
368
}
369

  
370
static void dec_cmpge(DisasContext *dc)
371
{
372
    if (dc->format == OP_FMT_RI) {
373
        LOG_DIS("cmpgei r%d, r%d, %d\n", dc->r0, dc->r1,
374
                sign_extend(dc->imm16, 16));
375
    } else {
376
        LOG_DIS("cmpge r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
377
    }
378

  
379
    gen_compare(dc, TCG_COND_GE);
380
}
381

  
382
static void dec_cmpgeu(DisasContext *dc)
383
{
384
    if (dc->format == OP_FMT_RI) {
385
        LOG_DIS("cmpgeui r%d, r%d, %d\n", dc->r0, dc->r1,
386
                sign_extend(dc->imm16, 16));
387
    } else {
388
        LOG_DIS("cmpgeu r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
389
    }
390

  
391
    gen_compare(dc, TCG_COND_GEU);
392
}
393

  
394
static void dec_cmpgu(DisasContext *dc)
395
{
396
    if (dc->format == OP_FMT_RI) {
397
        LOG_DIS("cmpgui r%d, r%d, %d\n", dc->r0, dc->r1,
398
                sign_extend(dc->imm16, 16));
399
    } else {
400
        LOG_DIS("cmpgu r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
401
    }
402

  
403
    gen_compare(dc, TCG_COND_GTU);
404
}
405

  
406
static void dec_cmpne(DisasContext *dc)
407
{
408
    if (dc->format == OP_FMT_RI) {
409
        LOG_DIS("cmpnei r%d, r%d, %d\n", dc->r0, dc->r1,
410
                sign_extend(dc->imm16, 16));
411
    } else {
412
        LOG_DIS("cmpne r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
413
    }
414

  
415
    gen_compare(dc, TCG_COND_NE);
416
}
417

  
418
static void dec_divu(DisasContext *dc)
419
{
420
    int l1;
421

  
422
    LOG_DIS("divu r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
423

  
424
    if (!(dc->env->features & LM32_FEATURE_DIVIDE)) {
425
        cpu_abort(dc->env, "hardware divider is not available\n");
426
    }
427

  
428
    l1 = gen_new_label();
429
    tcg_gen_brcondi_tl(TCG_COND_NE, cpu_R[dc->r1], 0, l1);
430
    tcg_gen_movi_tl(cpu_pc, dc->pc);
431
    t_gen_raise_exception(dc, EXCP_DIVIDE_BY_ZERO);
432
    gen_set_label(l1);
433
    tcg_gen_divu_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
434
}
435

  
436
static void dec_lb(DisasContext *dc)
437
{
438
    TCGv t0;
439

  
440
    LOG_DIS("lb r%d, (r%d+%d)\n", dc->r1, dc->r0, dc->imm16);
441

  
442
    t0 = tcg_temp_new();
443
    tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
444
    tcg_gen_qemu_ld8s(cpu_R[dc->r1], t0, MEM_INDEX);
445
    tcg_temp_free(t0);
446
}
447

  
448
static void dec_lbu(DisasContext *dc)
449
{
450
    TCGv t0;
451

  
452
    LOG_DIS("lbu r%d, (r%d+%d)\n", dc->r1, dc->r0, dc->imm16);
453

  
454
    t0 = tcg_temp_new();
455
    tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
456
    tcg_gen_qemu_ld8u(cpu_R[dc->r1], t0, MEM_INDEX);
457
    tcg_temp_free(t0);
458
}
459

  
460
static void dec_lh(DisasContext *dc)
461
{
462
    TCGv t0;
463

  
464
    LOG_DIS("lh r%d, (r%d+%d)\n", dc->r1, dc->r0, dc->imm16);
465

  
466
    t0 = tcg_temp_new();
467
    tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
468
    tcg_gen_qemu_ld16s(cpu_R[dc->r1], t0, MEM_INDEX);
469
    tcg_temp_free(t0);
470
}
471

  
472
static void dec_lhu(DisasContext *dc)
473
{
474
    TCGv t0;
475

  
476
    LOG_DIS("lhu r%d, (r%d+%d)\n", dc->r1, dc->r0, dc->imm16);
477

  
478
    t0 = tcg_temp_new();
479
    tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
480
    tcg_gen_qemu_ld16u(cpu_R[dc->r1], t0, MEM_INDEX);
481
    tcg_temp_free(t0);
482
}
483

  
484
static void dec_lw(DisasContext *dc)
485
{
486
    TCGv t0;
487

  
488
    LOG_DIS("lw r%d, (r%d+%d)\n", dc->r1, dc->r0, sign_extend(dc->imm16, 16));
489

  
490
    t0 = tcg_temp_new();
491
    tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
492
    tcg_gen_qemu_ld32s(cpu_R[dc->r1], t0, MEM_INDEX);
493
    tcg_temp_free(t0);
494
}
495

  
496
static void dec_modu(DisasContext *dc)
497
{
498
    int l1;
499

  
500
    LOG_DIS("modu r%d, r%d, %d\n", dc->r2, dc->r0, dc->r1);
501

  
502
    if (!(dc->env->features & LM32_FEATURE_DIVIDE)) {
503
        cpu_abort(dc->env, "hardware divider is not available\n");
504
    }
505

  
506
    l1 = gen_new_label();
507
    tcg_gen_brcondi_tl(TCG_COND_NE, cpu_R[dc->r1], 0, l1);
508
    tcg_gen_movi_tl(cpu_pc, dc->pc);
509
    t_gen_raise_exception(dc, EXCP_DIVIDE_BY_ZERO);
510
    gen_set_label(l1);
511
    tcg_gen_remu_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
512
}
513

  
514
static void dec_mul(DisasContext *dc)
515
{
516
    if (dc->format == OP_FMT_RI) {
517
        LOG_DIS("muli r%d, r%d, %d\n", dc->r0, dc->r1,
518
                sign_extend(dc->imm16, 16));
519
    } else {
520
        LOG_DIS("mul r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
521
    }
522

  
523
    if (!(dc->env->features & LM32_FEATURE_MULTIPLY)) {
524
        cpu_abort(dc->env, "hardware multiplier is not available\n");
525
    }
526

  
527
    if (dc->format == OP_FMT_RI) {
528
        tcg_gen_muli_tl(cpu_R[dc->r1], cpu_R[dc->r0],
529
                sign_extend(dc->imm16, 16));
530
    } else {
531
        tcg_gen_mul_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
532
    }
533
}
534

  
535
static void dec_nor(DisasContext *dc)
536
{
537
    if (dc->format == OP_FMT_RI) {
538
        LOG_DIS("nori r%d, r%d, %d\n", dc->r0, dc->r1,
539
                zero_extend(dc->imm16, 16));
540
    } else {
541
        LOG_DIS("nor r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
542
    }
543

  
544
    if (dc->format == OP_FMT_RI) {
545
        TCGv t0 = tcg_temp_new();
546
        tcg_gen_movi_tl(t0, zero_extend(dc->imm16, 16));
547
        tcg_gen_nor_tl(cpu_R[dc->r1], cpu_R[dc->r0], t0);
548
        tcg_temp_free(t0);
549
    } else {
550
        tcg_gen_nor_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
551
    }
552
}
553

  
554
static void dec_or(DisasContext *dc)
555
{
556
    if (dc->format == OP_FMT_RI) {
557
        LOG_DIS("ori r%d, r%d, %d\n", dc->r1, dc->r0,
558
                zero_extend(dc->imm16, 16));
559
    } else {
560
        if (dc->r1 == R_R0) {
561
            LOG_DIS("mv r%d, r%d\n", dc->r2, dc->r0);
562
        } else {
563
            LOG_DIS("or r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
564
        }
565
    }
566

  
567
    if (dc->format == OP_FMT_RI) {
568
        tcg_gen_ori_tl(cpu_R[dc->r1], cpu_R[dc->r0],
569
                zero_extend(dc->imm16, 16));
570
    } else {
571
        tcg_gen_or_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
572
    }
573
}
574

  
575
static void dec_orhi(DisasContext *dc)
576
{
577
    if (dc->r0 == R_R0) {
578
        LOG_DIS("mvhi r%d, %d\n", dc->r1, dc->imm16);
579
    } else {
580
        LOG_DIS("orhi r%d, r%d, %d\n", dc->r1, dc->r0, dc->imm16);
581
    }
582

  
583
    tcg_gen_ori_tl(cpu_R[dc->r1], cpu_R[dc->r0], (dc->imm16 << 16));
584
}
585

  
586
static void dec_raise(DisasContext *dc)
587
{
588
    TCGv t0;
589
    int l1;
590

  
591
    if (dc->imm5 == 7) {
592
        LOG_DIS("scall\n");
593
    } else if (dc->imm5 == 2) {
594
        LOG_DIS("break\n");
595
    } else {
596
        cpu_abort(dc->env, "invalid opcode\n");
597
    }
598

  
599
    t0 = tcg_temp_new();
600
    l1 = gen_new_label();
601

  
602
    /* save IE.IE */
603
    tcg_gen_andi_tl(t0, cpu_ie, IE_IE);
604

  
605
    /* IE.IE = 0 */
606
    tcg_gen_andi_tl(cpu_ie, cpu_ie, ~IE_IE);
607

  
608
    if (dc->imm5 == 7) {
609
        /* IE.EIE = IE.IE */
610
        tcg_gen_ori_tl(cpu_ie, cpu_ie, IE_EIE);
611
        tcg_gen_brcondi_tl(TCG_COND_EQ, t0, IE_IE, l1);
612
        tcg_gen_andi_tl(cpu_ie, cpu_ie, ~IE_EIE);
613
        gen_set_label(l1);
614

  
615
        /* gpr[ea] = PC */
616
        tcg_gen_movi_tl(cpu_R[R_EA], dc->pc);
617
        tcg_temp_free(t0);
618

  
619
        tcg_gen_movi_tl(cpu_pc, dc->pc);
620
        t_gen_raise_exception(dc, EXCP_SYSTEMCALL);
621
    } else {
622
        /* IE.BIE = IE.IE */
623
        tcg_gen_ori_tl(cpu_ie, cpu_ie, IE_BIE);
624
        tcg_gen_brcondi_tl(TCG_COND_EQ, t0, IE_IE, l1);
625
        tcg_gen_andi_tl(cpu_ie, cpu_ie, ~IE_BIE);
626
        gen_set_label(l1);
627

  
628
        /* gpr[ba] = PC */
629
        tcg_gen_movi_tl(cpu_R[R_BA], dc->pc);
630
        tcg_temp_free(t0);
631

  
632
        tcg_gen_movi_tl(cpu_pc, dc->pc);
633
        t_gen_raise_exception(dc, EXCP_BREAKPOINT);
634
    }
635
}
636

  
637
static void dec_rcsr(DisasContext *dc)
638
{
639
    LOG_DIS("rcsr r%d, %d\n", dc->r2, dc->csr);
640

  
641
    switch (dc->csr) {
642
    case CSR_IE:
643
        tcg_gen_mov_tl(cpu_R[dc->r2], cpu_ie);
644
        break;
645
    case CSR_IM:
646
        gen_helper_rcsr_im(cpu_R[dc->r2]);
647
        break;
648
    case CSR_IP:
649
        gen_helper_rcsr_ip(cpu_R[dc->r2]);
650
        break;
651
    case CSR_CC:
652
        tcg_gen_mov_tl(cpu_R[dc->r2], cpu_cc);
653
        break;
654
    case CSR_CFG:
655
        tcg_gen_mov_tl(cpu_R[dc->r2], cpu_cfg);
656
        break;
657
    case CSR_EBA:
658
        tcg_gen_mov_tl(cpu_R[dc->r2], cpu_eba);
659
        break;
660
    case CSR_DC:
661
        tcg_gen_mov_tl(cpu_R[dc->r2], cpu_dc);
662
        break;
663
    case CSR_DEBA:
664
        tcg_gen_mov_tl(cpu_R[dc->r2], cpu_deba);
665
        break;
666
    case CSR_JTX:
667
        gen_helper_rcsr_jtx(cpu_R[dc->r2]);
668
        break;
669
    case CSR_JRX:
670
        gen_helper_rcsr_jrx(cpu_R[dc->r2]);
671
        break;
672
    case CSR_ICC:
673
    case CSR_DCC:
674
    case CSR_BP0:
675
    case CSR_BP1:
676
    case CSR_BP2:
677
    case CSR_BP3:
678
    case CSR_WP0:
679
    case CSR_WP1:
680
    case CSR_WP2:
681
    case CSR_WP3:
682
        cpu_abort(dc->env, "invalid read access csr=%x\n", dc->csr);
683
        break;
684
    default:
685
        cpu_abort(dc->env, "read_csr: unknown csr=%x\n", dc->csr);
686
        break;
687
    }
688
}
689

  
690
static void dec_sb(DisasContext *dc)
691
{
692
    TCGv t0;
693

  
694
    LOG_DIS("sb (r%d+%d), r%d\n", dc->r0, dc->imm16, dc->r1);
695

  
696
    t0 = tcg_temp_new();
697
    tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
698
    tcg_gen_qemu_st8(cpu_R[dc->r1], t0, MEM_INDEX);
699
    tcg_temp_free(t0);
700
}
701

  
702
static void dec_sextb(DisasContext *dc)
703
{
704
    LOG_DIS("sextb r%d, r%d\n", dc->r2, dc->r0);
705

  
706
    if (!(dc->env->features & LM32_FEATURE_SIGN_EXTEND)) {
707
        cpu_abort(dc->env, "hardware sign extender is not available\n");
708
    }
709

  
710
    tcg_gen_ext8s_tl(cpu_R[dc->r2], cpu_R[dc->r0]);
711
}
712

  
713
static void dec_sexth(DisasContext *dc)
714
{
715
    LOG_DIS("sexth r%d, r%d\n", dc->r2, dc->r0);
716

  
717
    if (!(dc->env->features & LM32_FEATURE_SIGN_EXTEND)) {
718
        cpu_abort(dc->env, "hardware sign extender is not available\n");
719
    }
720

  
721
    tcg_gen_ext16s_tl(cpu_R[dc->r2], cpu_R[dc->r0]);
722
}
723

  
724
static void dec_sh(DisasContext *dc)
725
{
726
    TCGv t0;
727

  
728
    LOG_DIS("sh (r%d+%d), r%d\n", dc->r0, dc->imm16, dc->r1);
729

  
730
    t0 = tcg_temp_new();
731
    tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
732
    tcg_gen_qemu_st16(cpu_R[dc->r1], t0, MEM_INDEX);
733
    tcg_temp_free(t0);
734
}
735

  
736
static void dec_sl(DisasContext *dc)
737
{
738
    if (dc->format == OP_FMT_RI) {
739
        LOG_DIS("sli r%d, r%d, %d\n", dc->r1, dc->r0, dc->imm5);
740
    } else {
741
        LOG_DIS("sl r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
742
    }
743

  
744
    if (!(dc->env->features & LM32_FEATURE_SHIFT)) {
745
        cpu_abort(dc->env, "hardware shifter is not available\n");
746
    }
747

  
748
    if (dc->format == OP_FMT_RI) {
749
        tcg_gen_shli_tl(cpu_R[dc->r1], cpu_R[dc->r0], dc->imm5);
750
    } else {
751
        TCGv t0 = tcg_temp_new();
752
        tcg_gen_andi_tl(t0, cpu_R[dc->r1], 0x1f);
753
        tcg_gen_shl_tl(cpu_R[dc->r2], cpu_R[dc->r0], t0);
754
        tcg_temp_free(t0);
755
    }
756
}
757

  
758
static void dec_sr(DisasContext *dc)
759
{
760
    if (dc->format == OP_FMT_RI) {
761
        LOG_DIS("sri r%d, r%d, %d\n", dc->r1, dc->r0, dc->imm5);
762
    } else {
763
        LOG_DIS("sr r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
764
    }
765

  
766
    if (!(dc->env->features & LM32_FEATURE_SHIFT)) {
767
        if (dc->format == OP_FMT_RI) {
768
            /* TODO: check r1 == 1 during runtime */
769
        } else {
770
            if (dc->imm5 != 1) {
771
                cpu_abort(dc->env, "hardware shifter is not available\n");
772
            }
773
        }
774
    }
775

  
776
    if (dc->format == OP_FMT_RI) {
777
        tcg_gen_sari_tl(cpu_R[dc->r1], cpu_R[dc->r0], dc->imm5);
778
    } else {
779
        TCGv t0 = tcg_temp_new();
780
        tcg_gen_andi_tl(t0, cpu_R[dc->r1], 0x1f);
781
        tcg_gen_sar_tl(cpu_R[dc->r2], cpu_R[dc->r0], t0);
782
        tcg_temp_free(t0);
783
    }
784
}
785

  
786
static void dec_sru(DisasContext *dc)
787
{
788
    if (dc->format == OP_FMT_RI) {
789
        LOG_DIS("srui r%d, r%d, %d\n", dc->r1, dc->r0, dc->imm5);
790
    } else {
791
        LOG_DIS("sru r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
792
    }
793

  
794
    if (!(dc->env->features & LM32_FEATURE_SHIFT)) {
795
        if (dc->format == OP_FMT_RI) {
796
            /* TODO: check r1 == 1 during runtime */
797
        } else {
798
            if (dc->imm5 != 1) {
799
                cpu_abort(dc->env, "hardware shifter is not available\n");
800
            }
801
        }
802
    }
803

  
804
    if (dc->format == OP_FMT_RI) {
805
        tcg_gen_shri_tl(cpu_R[dc->r1], cpu_R[dc->r0], dc->imm5);
806
    } else {
807
        TCGv t0 = tcg_temp_new();
808
        tcg_gen_andi_tl(t0, cpu_R[dc->r1], 0x1f);
809
        tcg_gen_shr_tl(cpu_R[dc->r2], cpu_R[dc->r0], t0);
810
        tcg_temp_free(t0);
811
    }
812
}
813

  
814
static void dec_sub(DisasContext *dc)
815
{
816
    LOG_DIS("sub r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
817

  
818
    tcg_gen_sub_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
819
}
820

  
821
static void dec_sw(DisasContext *dc)
822
{
823
    TCGv t0;
824

  
825
    LOG_DIS("sw (r%d+%d), r%d\n", dc->r0, sign_extend(dc->imm16, 16), dc->r1);
826

  
827
    t0 = tcg_temp_new();
828
    tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
829
    tcg_gen_qemu_st32(cpu_R[dc->r1], t0, MEM_INDEX);
830
    tcg_temp_free(t0);
831
}
832

  
833
static void dec_user(DisasContext *dc)
834
{
835
    LOG_DIS("user");
836

  
837
    cpu_abort(dc->env, "user insn undefined\n");
838
}
839

  
840
static void dec_wcsr(DisasContext *dc)
841
{
842
    int no;
843

  
844
    LOG_DIS("wcsr r%d, %d\n", dc->r1, dc->csr);
845

  
846
    switch (dc->csr) {
847
    case CSR_IE:
848
        tcg_gen_mov_tl(cpu_ie, cpu_R[dc->r1]);
849
        tcg_gen_movi_tl(cpu_pc, dc->pc + 4);
850
        dc->is_jmp = DISAS_UPDATE;
851
        break;
852
    case CSR_IM:
853
        /* mark as an io operation because it could cause an interrupt */
854
        if (use_icount) {
855
            gen_io_start();
856
        }
857
        gen_helper_wcsr_im(cpu_R[dc->r1]);
858
        tcg_gen_movi_tl(cpu_pc, dc->pc + 4);
859
        if (use_icount) {
860
            gen_io_end();
861
        }
862
        dc->is_jmp = DISAS_UPDATE;
863
        break;
864
    case CSR_IP:
865
        /* mark as an io operation because it could cause an interrupt */
866
        if (use_icount) {
867
            gen_io_start();
868
        }
869
        gen_helper_wcsr_ip(cpu_R[dc->r1]);
870
        tcg_gen_movi_tl(cpu_pc, dc->pc + 4);
871
        if (use_icount) {
872
            gen_io_end();
873
        }
874
        dc->is_jmp = DISAS_UPDATE;
875
        break;
876
    case CSR_ICC:
877
        /* TODO */
878
        break;
879
    case CSR_DCC:
880
        /* TODO */
881
        break;
882
    case CSR_EBA:
883
        tcg_gen_mov_tl(cpu_eba, cpu_R[dc->r1]);
884
        break;
885
    case CSR_DEBA:
886
        tcg_gen_mov_tl(cpu_deba, cpu_R[dc->r1]);
887
        break;
888
    case CSR_JTX:
889
        gen_helper_wcsr_jtx(cpu_R[dc->r1]);
890
        break;
891
    case CSR_JRX:
892
        gen_helper_wcsr_jrx(cpu_R[dc->r1]);
893
        break;
894
    case CSR_DC:
895
        tcg_gen_mov_tl(cpu_dc, cpu_R[dc->r1]);
896
        break;
897
    case CSR_BP0:
898
    case CSR_BP1:
899
    case CSR_BP2:
900
    case CSR_BP3:
901
        no = dc->csr - CSR_BP0;
902
        if (dc->env->num_bps <= no) {
903
            cpu_abort(dc->env, "breakpoint #%i is not available\n", no);
904
        }
905
        tcg_gen_mov_tl(cpu_bp[no], cpu_R[dc->r1]);
906
        break;
907
    case CSR_WP0:
908
    case CSR_WP1:
909
    case CSR_WP2:
910
    case CSR_WP3:
911
        no = dc->csr - CSR_WP0;
912
        if (dc->env->num_wps <= no) {
913
            cpu_abort(dc->env, "watchpoint #%i is not available\n", no);
914
        }
915
        tcg_gen_mov_tl(cpu_wp[no], cpu_R[dc->r1]);
916
        break;
917
    case CSR_CC:
918
    case CSR_CFG:
919
        cpu_abort(dc->env, "invalid write access csr=%x\n", dc->csr);
920
        break;
921
    default:
922
        cpu_abort(dc->env, "write_csr unknown csr=%x\n", dc->csr);
923
        break;
924
    }
925
}
926

  
927
static void dec_xnor(DisasContext *dc)
928
{
929
    if (dc->format == OP_FMT_RI) {
930
        LOG_DIS("xnori r%d, r%d, %d\n", dc->r0, dc->r1,
931
                zero_extend(dc->imm16, 16));
932
    } else {
933
        if (dc->r1 == R_R0) {
934
            LOG_DIS("not r%d, r%d\n", dc->r2, dc->r0);
935
        } else {
936
            LOG_DIS("xnor r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
937
        }
938
    }
939

  
940
    if (dc->format == OP_FMT_RI) {
941
        tcg_gen_xori_tl(cpu_R[dc->r1], cpu_R[dc->r0],
942
                zero_extend(dc->imm16, 16));
943
        tcg_gen_not_tl(cpu_R[dc->r1], cpu_R[dc->r1]);
944
    } else {
945
        tcg_gen_eqv_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
946
    }
947
}
948

  
949
static void dec_xor(DisasContext *dc)
950
{
951
    if (dc->format == OP_FMT_RI) {
952
        LOG_DIS("xori r%d, r%d, %d\n", dc->r0, dc->r1,
953
                zero_extend(dc->imm16, 16));
954
    } else {
955
        LOG_DIS("xor r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
956
    }
957

  
958
    if (dc->format == OP_FMT_RI) {
959
        tcg_gen_xori_tl(cpu_R[dc->r1], cpu_R[dc->r0],
960
                zero_extend(dc->imm16, 16));
961
    } else {
962
        tcg_gen_xor_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
963
    }
964
}
965

  
966
typedef struct {
967
    struct {
968
        uint32_t bits;
969
        uint32_t mask;
970
    };
971
    void (*dec)(DisasContext *dc);
972
} DecoderInfo;
973

  
974
static const DecoderInfo decinfo[] = {
975
    {DEC_ADD, dec_add},
976
    {DEC_AND, dec_and},
977
    {DEC_ANDHI, dec_andhi},
978
    {DEC_B, dec_b},
979
    {DEC_BI, dec_bi},
980
    {DEC_BE, dec_be},
981
    {DEC_BG, dec_bg},
982
    {DEC_BGE, dec_bge},
983
    {DEC_BGEU, dec_bgeu},
984
    {DEC_BGU, dec_bgu},
985
    {DEC_BNE, dec_bne},
986
    {DEC_CALL, dec_call},
987
    {DEC_CALLI, dec_calli},
988
    {DEC_CMPE, dec_cmpe},
989
    {DEC_CMPG, dec_cmpg},
990
    {DEC_CMPGE, dec_cmpge},
991
    {DEC_CMPGEU, dec_cmpgeu},
992
    {DEC_CMPGU, dec_cmpgu},
993
    {DEC_CMPNE, dec_cmpne},
994
    {DEC_DIVU, dec_divu},
995
    {DEC_LB, dec_lb},
996
    {DEC_LBU, dec_lbu},
997
    {DEC_LH, dec_lh},
998
    {DEC_LHU, dec_lhu},
999
    {DEC_LW, dec_lw},
1000
    {DEC_MODU, dec_modu},
1001
    {DEC_MUL, dec_mul},
1002
    {DEC_NOR, dec_nor},
1003
    {DEC_OR, dec_or},
1004
    {DEC_ORHI, dec_orhi},
1005
    {DEC_RAISE, dec_raise},
1006
    {DEC_RCSR, dec_rcsr},
1007
    {DEC_SB, dec_sb},
1008
    {DEC_SEXTB, dec_sextb},
1009
    {DEC_SEXTH, dec_sexth},
1010
    {DEC_SH, dec_sh},
1011
    {DEC_SL, dec_sl},
1012
    {DEC_SR, dec_sr},
1013
    {DEC_SRU, dec_sru},
1014
    {DEC_SUB, dec_sub},
1015
    {DEC_SW, dec_sw},
1016
    {DEC_USER, dec_user},
1017
    {DEC_WCSR, dec_wcsr},
1018
    {DEC_XNOR, dec_xnor},
1019
    {DEC_XOR, dec_xor},
1020
};
1021

  
1022
static inline void decode(DisasContext *dc)
1023
{
1024
    uint32_t ir;
1025
    int i;
1026

  
1027
    if (unlikely(qemu_loglevel_mask(CPU_LOG_TB_OP))) {
1028
        tcg_gen_debug_insn_start(dc->pc);
1029
    }
1030

  
1031
    dc->ir = ir = ldl_code(dc->pc);
1032
    LOG_DIS("%8.8x\t", dc->ir);
1033

  
1034
    /* try guessing 'empty' instruction memory, although it may be a valid
1035
     * instruction sequence (eg. srui r0, r0, 0) */
1036
    if (dc->ir) {
1037
        dc->nr_nops = 0;
1038
    } else {
1039
        LOG_DIS("nr_nops=%d\t", dc->nr_nops);
1040
        dc->nr_nops++;
1041
        if (dc->nr_nops > 4) {
1042
            cpu_abort(dc->env, "fetching nop sequence\n");
1043
        }
1044
    }
1045

  
1046
    dc->opcode = EXTRACT_FIELD(ir, 26, 31);
1047

  
1048
    dc->imm5 = EXTRACT_FIELD(ir, 0, 4);
1049
    dc->imm16 = EXTRACT_FIELD(ir, 0, 15);
1050
    dc->imm26 = EXTRACT_FIELD(ir, 0, 25);
1051

  
1052
    dc->csr = EXTRACT_FIELD(ir, 21, 25);
1053
    dc->r0 = EXTRACT_FIELD(ir, 21, 25);
1054
    dc->r1 = EXTRACT_FIELD(ir, 16, 20);
1055
    dc->r2 = EXTRACT_FIELD(ir, 11, 15);
1056

  
1057
    /* bit 31 seems to indicate insn type.  */
1058
    if (ir & (1 << 31)) {
1059
        dc->format = OP_FMT_RR;
1060
    } else {
1061
        dc->format = OP_FMT_RI;
1062
    }
1063

  
1064
    /* Large switch for all insns.  */
1065
    for (i = 0; i < ARRAY_SIZE(decinfo); i++) {
1066
        if ((dc->opcode & decinfo[i].mask) == decinfo[i].bits) {
1067
            decinfo[i].dec(dc);
1068
            return;
1069
        }
1070
    }
1071

  
1072
    cpu_abort(dc->env, "unknown opcode 0x%02x\n", dc->opcode);
1073
}
1074

  
1075
static void check_breakpoint(CPUState *env, DisasContext *dc)
1076
{
1077
    CPUBreakpoint *bp;
1078

  
1079
    if (unlikely(!QTAILQ_EMPTY(&env->breakpoints))) {
1080
        QTAILQ_FOREACH(bp, &env->breakpoints, entry) {
1081
            if (bp->pc == dc->pc) {
1082
                tcg_gen_movi_tl(cpu_pc, dc->pc);
1083
                t_gen_raise_exception(dc, EXCP_DEBUG);
1084
                dc->is_jmp = DISAS_UPDATE;
1085
             }
1086
        }
1087
    }
1088
}
1089

  
1090
/* generate intermediate code for basic block 'tb'.  */
1091
static void gen_intermediate_code_internal(CPUState *env,
1092
        TranslationBlock *tb, int search_pc)
1093
{
1094
    struct DisasContext ctx, *dc = &ctx;
1095
    uint16_t *gen_opc_end;
1096
    uint32_t pc_start;
1097
    int j, lj;
1098
    uint32_t next_page_start;
1099
    int num_insns;
1100
    int max_insns;
1101

  
1102
    qemu_log_try_set_file(stderr);
1103

  
1104
    pc_start = tb->pc;
1105
    dc->env = env;
1106
    dc->tb = tb;
1107

  
1108
    gen_opc_end = gen_opc_buf + OPC_MAX_SIZE;
1109

  
1110
    dc->is_jmp = DISAS_NEXT;
1111
    dc->pc = pc_start;
1112
    dc->singlestep_enabled = env->singlestep_enabled;
1113
    dc->nr_nops = 0;
1114

  
1115
    if (pc_start & 3) {
1116
        cpu_abort(env, "LM32: unaligned PC=%x\n", pc_start);
1117
    }
1118

  
1119
    if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) {
1120
        qemu_log("-----------------------------------------\n");
1121
        log_cpu_state(env, 0);
1122
    }
1123

  
1124
    next_page_start = (pc_start & TARGET_PAGE_MASK) + TARGET_PAGE_SIZE;
1125
    lj = -1;
1126
    num_insns = 0;
1127
    max_insns = tb->cflags & CF_COUNT_MASK;
1128
    if (max_insns == 0) {
1129
        max_insns = CF_COUNT_MASK;
1130
    }
1131

  
1132
    gen_icount_start();
1133
    do {
1134
        check_breakpoint(env, dc);
... This diff was truncated because it exceeds the maximum size that can be displayed.

Also available in: Unified diff