1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include "qemu/osdep.h"
22#include "qapi/error.h"
23#include "qemu/qemu-print.h"
24#include "exec/exec-all.h"
25#include "cpu.h"
26#include "disas/dis-asm.h"
27
28static void avr_cpu_set_pc(CPUState *cs, vaddr value)
29{
30 AVRCPU *cpu = AVR_CPU(cs);
31
32 cpu->env.pc_w = value / 2;
33}
34
35static bool avr_cpu_has_work(CPUState *cs)
36{
37 AVRCPU *cpu = AVR_CPU(cs);
38 CPUAVRState *env = &cpu->env;
39
40 return (cs->interrupt_request & (CPU_INTERRUPT_HARD | CPU_INTERRUPT_RESET))
41 && cpu_interrupts_enabled(env);
42}
43
44static void avr_cpu_synchronize_from_tb(CPUState *cs,
45 const TranslationBlock *tb)
46{
47 AVRCPU *cpu = AVR_CPU(cs);
48 CPUAVRState *env = &cpu->env;
49
50 env->pc_w = tb->pc / 2;
51}
52
53static void avr_cpu_reset(DeviceState *ds)
54{
55 CPUState *cs = CPU(ds);
56 AVRCPU *cpu = AVR_CPU(cs);
57 AVRCPUClass *mcc = AVR_CPU_GET_CLASS(cpu);
58 CPUAVRState *env = &cpu->env;
59
60 mcc->parent_reset(ds);
61
62 env->pc_w = 0;
63 env->sregI = 1;
64 env->sregC = 0;
65 env->sregZ = 0;
66 env->sregN = 0;
67 env->sregV = 0;
68 env->sregS = 0;
69 env->sregH = 0;
70 env->sregT = 0;
71
72 env->rampD = 0;
73 env->rampX = 0;
74 env->rampY = 0;
75 env->rampZ = 0;
76 env->eind = 0;
77 env->sp = 0;
78
79 env->skip = 0;
80
81 memset(env->r, 0, sizeof(env->r));
82}
83
84static void avr_cpu_disas_set_info(CPUState *cpu, disassemble_info *info)
85{
86 info->mach = bfd_arch_avr;
87 info->print_insn = avr_print_insn;
88}
89
90static void avr_cpu_realizefn(DeviceState *dev, Error **errp)
91{
92 CPUState *cs = CPU(dev);
93 AVRCPUClass *mcc = AVR_CPU_GET_CLASS(dev);
94 Error *local_err = NULL;
95
96 cpu_exec_realizefn(cs, &local_err);
97 if (local_err != NULL) {
98 error_propagate(errp, local_err);
99 return;
100 }
101 qemu_init_vcpu(cs);
102 cpu_reset(cs);
103
104 mcc->parent_realize(dev, errp);
105}
106
107static void avr_cpu_set_int(void *opaque, int irq, int level)
108{
109 AVRCPU *cpu = opaque;
110 CPUAVRState *env = &cpu->env;
111 CPUState *cs = CPU(cpu);
112 uint64_t mask = (1ull << irq);
113
114 if (level) {
115 env->intsrc |= mask;
116 cpu_interrupt(cs, CPU_INTERRUPT_HARD);
117 } else {
118 env->intsrc &= ~mask;
119 if (env->intsrc == 0) {
120 cpu_reset_interrupt(cs, CPU_INTERRUPT_HARD);
121 }
122 }
123}
124
125static void avr_cpu_initfn(Object *obj)
126{
127 AVRCPU *cpu = AVR_CPU(obj);
128
129 cpu_set_cpustate_pointers(cpu);
130
131
132 qdev_init_gpio_in(DEVICE(cpu), avr_cpu_set_int,
133 sizeof(cpu->env.intsrc) * 8);
134}
135
136static ObjectClass *avr_cpu_class_by_name(const char *cpu_model)
137{
138 ObjectClass *oc;
139
140 oc = object_class_by_name(cpu_model);
141 if (object_class_dynamic_cast(oc, TYPE_AVR_CPU) == NULL ||
142 object_class_is_abstract(oc)) {
143 oc = NULL;
144 }
145 return oc;
146}
147
148static void avr_cpu_dump_state(CPUState *cs, FILE *f, int flags)
149{
150 AVRCPU *cpu = AVR_CPU(cs);
151 CPUAVRState *env = &cpu->env;
152 int i;
153
154 qemu_fprintf(f, "\n");
155 qemu_fprintf(f, "PC: %06x\n", env->pc_w * 2);
156 qemu_fprintf(f, "SP: %04x\n", env->sp);
157 qemu_fprintf(f, "rampD: %02x\n", env->rampD >> 16);
158 qemu_fprintf(f, "rampX: %02x\n", env->rampX >> 16);
159 qemu_fprintf(f, "rampY: %02x\n", env->rampY >> 16);
160 qemu_fprintf(f, "rampZ: %02x\n", env->rampZ >> 16);
161 qemu_fprintf(f, "EIND: %02x\n", env->eind >> 16);
162 qemu_fprintf(f, "X: %02x%02x\n", env->r[27], env->r[26]);
163 qemu_fprintf(f, "Y: %02x%02x\n", env->r[29], env->r[28]);
164 qemu_fprintf(f, "Z: %02x%02x\n", env->r[31], env->r[30]);
165 qemu_fprintf(f, "SREG: [ %c %c %c %c %c %c %c %c ]\n",
166 env->sregI ? 'I' : '-',
167 env->sregT ? 'T' : '-',
168 env->sregH ? 'H' : '-',
169 env->sregS ? 'S' : '-',
170 env->sregV ? 'V' : '-',
171 env->sregN ? '-' : 'N',
172 env->sregZ ? 'Z' : '-',
173 env->sregC ? 'I' : '-');
174 qemu_fprintf(f, "SKIP: %02x\n", env->skip);
175
176 qemu_fprintf(f, "\n");
177 for (i = 0; i < ARRAY_SIZE(env->r); i++) {
178 qemu_fprintf(f, "R[%02d]: %02x ", i, env->r[i]);
179
180 if ((i % 8) == 7) {
181 qemu_fprintf(f, "\n");
182 }
183 }
184 qemu_fprintf(f, "\n");
185}
186
187#include "hw/core/sysemu-cpu-ops.h"
188
189static const struct SysemuCPUOps avr_sysemu_ops = {
190 .get_phys_page_debug = avr_cpu_get_phys_page_debug,
191};
192
193#include "hw/core/tcg-cpu-ops.h"
194
195static const struct TCGCPUOps avr_tcg_ops = {
196 .initialize = avr_cpu_tcg_init,
197 .synchronize_from_tb = avr_cpu_synchronize_from_tb,
198 .cpu_exec_interrupt = avr_cpu_exec_interrupt,
199 .tlb_fill = avr_cpu_tlb_fill,
200 .do_interrupt = avr_cpu_do_interrupt,
201};
202
203static void avr_cpu_class_init(ObjectClass *oc, void *data)
204{
205 DeviceClass *dc = DEVICE_CLASS(oc);
206 CPUClass *cc = CPU_CLASS(oc);
207 AVRCPUClass *mcc = AVR_CPU_CLASS(oc);
208
209 device_class_set_parent_realize(dc, avr_cpu_realizefn, &mcc->parent_realize);
210 device_class_set_parent_reset(dc, avr_cpu_reset, &mcc->parent_reset);
211
212 cc->class_by_name = avr_cpu_class_by_name;
213
214 cc->has_work = avr_cpu_has_work;
215 cc->dump_state = avr_cpu_dump_state;
216 cc->set_pc = avr_cpu_set_pc;
217 dc->vmsd = &vms_avr_cpu;
218 cc->sysemu_ops = &avr_sysemu_ops;
219 cc->disas_set_info = avr_cpu_disas_set_info;
220 cc->gdb_read_register = avr_cpu_gdb_read_register;
221 cc->gdb_write_register = avr_cpu_gdb_write_register;
222 cc->gdb_adjust_breakpoint = avr_cpu_gdb_adjust_breakpoint;
223 cc->gdb_num_core_regs = 35;
224 cc->gdb_core_xml_file = "avr-cpu.xml";
225 cc->tcg_ops = &avr_tcg_ops;
226}
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252static void avr_avr5_initfn(Object *obj)
253{
254 AVRCPU *cpu = AVR_CPU(obj);
255 CPUAVRState *env = &cpu->env;
256
257 set_avr_feature(env, AVR_FEATURE_LPM);
258 set_avr_feature(env, AVR_FEATURE_IJMP_ICALL);
259 set_avr_feature(env, AVR_FEATURE_ADIW_SBIW);
260 set_avr_feature(env, AVR_FEATURE_SRAM);
261 set_avr_feature(env, AVR_FEATURE_BREAK);
262
263 set_avr_feature(env, AVR_FEATURE_2_BYTE_PC);
264 set_avr_feature(env, AVR_FEATURE_2_BYTE_SP);
265 set_avr_feature(env, AVR_FEATURE_JMP_CALL);
266 set_avr_feature(env, AVR_FEATURE_LPMX);
267 set_avr_feature(env, AVR_FEATURE_MOVW);
268 set_avr_feature(env, AVR_FEATURE_MUL);
269}
270
271
272
273
274
275
276
277
278
279
280
281static void avr_avr51_initfn(Object *obj)
282{
283 AVRCPU *cpu = AVR_CPU(obj);
284 CPUAVRState *env = &cpu->env;
285
286 set_avr_feature(env, AVR_FEATURE_LPM);
287 set_avr_feature(env, AVR_FEATURE_IJMP_ICALL);
288 set_avr_feature(env, AVR_FEATURE_ADIW_SBIW);
289 set_avr_feature(env, AVR_FEATURE_SRAM);
290 set_avr_feature(env, AVR_FEATURE_BREAK);
291
292 set_avr_feature(env, AVR_FEATURE_2_BYTE_PC);
293 set_avr_feature(env, AVR_FEATURE_2_BYTE_SP);
294 set_avr_feature(env, AVR_FEATURE_RAMPZ);
295 set_avr_feature(env, AVR_FEATURE_ELPMX);
296 set_avr_feature(env, AVR_FEATURE_ELPM);
297 set_avr_feature(env, AVR_FEATURE_JMP_CALL);
298 set_avr_feature(env, AVR_FEATURE_LPMX);
299 set_avr_feature(env, AVR_FEATURE_MOVW);
300 set_avr_feature(env, AVR_FEATURE_MUL);
301}
302
303
304
305
306
307
308
309
310
311static void avr_avr6_initfn(Object *obj)
312{
313 AVRCPU *cpu = AVR_CPU(obj);
314 CPUAVRState *env = &cpu->env;
315
316 set_avr_feature(env, AVR_FEATURE_LPM);
317 set_avr_feature(env, AVR_FEATURE_IJMP_ICALL);
318 set_avr_feature(env, AVR_FEATURE_ADIW_SBIW);
319 set_avr_feature(env, AVR_FEATURE_SRAM);
320 set_avr_feature(env, AVR_FEATURE_BREAK);
321
322 set_avr_feature(env, AVR_FEATURE_3_BYTE_PC);
323 set_avr_feature(env, AVR_FEATURE_2_BYTE_SP);
324 set_avr_feature(env, AVR_FEATURE_RAMPZ);
325 set_avr_feature(env, AVR_FEATURE_EIJMP_EICALL);
326 set_avr_feature(env, AVR_FEATURE_ELPMX);
327 set_avr_feature(env, AVR_FEATURE_ELPM);
328 set_avr_feature(env, AVR_FEATURE_JMP_CALL);
329 set_avr_feature(env, AVR_FEATURE_LPMX);
330 set_avr_feature(env, AVR_FEATURE_MOVW);
331 set_avr_feature(env, AVR_FEATURE_MUL);
332}
333
334typedef struct AVRCPUInfo {
335 const char *name;
336 void (*initfn)(Object *obj);
337} AVRCPUInfo;
338
339
340static void avr_cpu_list_entry(gpointer data, gpointer user_data)
341{
342 const char *typename = object_class_get_name(OBJECT_CLASS(data));
343
344 qemu_printf("%s\n", typename);
345}
346
347void avr_cpu_list(void)
348{
349 GSList *list;
350 list = object_class_get_list_sorted(TYPE_AVR_CPU, false);
351 g_slist_foreach(list, avr_cpu_list_entry, NULL);
352 g_slist_free(list);
353}
354
355#define DEFINE_AVR_CPU_TYPE(model, initfn) \
356 { \
357 .parent = TYPE_AVR_CPU, \
358 .instance_init = initfn, \
359 .name = AVR_CPU_TYPE_NAME(model), \
360 }
361
362static const TypeInfo avr_cpu_type_info[] = {
363 {
364 .name = TYPE_AVR_CPU,
365 .parent = TYPE_CPU,
366 .instance_size = sizeof(AVRCPU),
367 .instance_init = avr_cpu_initfn,
368 .class_size = sizeof(AVRCPUClass),
369 .class_init = avr_cpu_class_init,
370 .abstract = true,
371 },
372 DEFINE_AVR_CPU_TYPE("avr5", avr_avr5_initfn),
373 DEFINE_AVR_CPU_TYPE("avr51", avr_avr51_initfn),
374 DEFINE_AVR_CPU_TYPE("avr6", avr_avr6_initfn),
375};
376
377DEFINE_TYPES(avr_cpu_type_info)
378