1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include "qemu/osdep.h"
21#include "qemu-common.h"
22#include "cpu.h"
23#include "hw/sysbus.h"
24#include "hw/hw.h"
25#include "hw/block/flash.h"
26#include "sysemu/sysemu.h"
27#include "sysemu/qtest.h"
28#include "hw/devices.h"
29#include "hw/boards.h"
30#include "hw/loader.h"
31#include "elf.h"
32#include "sysemu/block-backend.h"
33#include "milkymist-hw.h"
34#include "lm32.h"
35#include "exec/address-spaces.h"
36#include "qemu/cutils.h"
37
38#define BIOS_FILENAME "mmone-bios.bin"
39#define BIOS_OFFSET 0x00860000
40#define BIOS_SIZE (512*1024)
41#define KERNEL_LOAD_ADDR 0x40000000
42
43typedef struct {
44 LM32CPU *cpu;
45 hwaddr bootstrap_pc;
46 hwaddr flash_base;
47 hwaddr initrd_base;
48 size_t initrd_size;
49 hwaddr cmdline_base;
50} ResetInfo;
51
52static void cpu_irq_handler(void *opaque, int irq, int level)
53{
54 LM32CPU *cpu = opaque;
55 CPUState *cs = CPU(cpu);
56
57 if (level) {
58 cpu_interrupt(cs, CPU_INTERRUPT_HARD);
59 } else {
60 cpu_reset_interrupt(cs, CPU_INTERRUPT_HARD);
61 }
62}
63
64static void main_cpu_reset(void *opaque)
65{
66 ResetInfo *reset_info = opaque;
67 CPULM32State *env = &reset_info->cpu->env;
68
69 cpu_reset(CPU(reset_info->cpu));
70
71
72 env->pc = reset_info->bootstrap_pc;
73 env->regs[R_R1] = reset_info->cmdline_base;
74 env->regs[R_R2] = reset_info->initrd_base;
75 env->regs[R_R3] = reset_info->initrd_base + reset_info->initrd_size;
76 env->eba = reset_info->flash_base;
77 env->deba = reset_info->flash_base;
78}
79
80static void
81milkymist_init(MachineState *machine)
82{
83 const char *cpu_model = machine->cpu_model;
84 const char *kernel_filename = machine->kernel_filename;
85 const char *kernel_cmdline = machine->kernel_cmdline;
86 const char *initrd_filename = machine->initrd_filename;
87 LM32CPU *cpu;
88 CPULM32State *env;
89 int kernel_size;
90 DriveInfo *dinfo;
91 MemoryRegion *address_space_mem = get_system_memory();
92 MemoryRegion *phys_sdram = g_new(MemoryRegion, 1);
93 qemu_irq irq[32];
94 int i;
95 char *bios_filename;
96 ResetInfo *reset_info;
97
98
99 hwaddr flash_base = 0x00000000;
100 size_t flash_sector_size = 128 * 1024;
101 size_t flash_size = 32 * 1024 * 1024;
102 hwaddr sdram_base = 0x40000000;
103 size_t sdram_size = 128 * 1024 * 1024;
104
105 hwaddr initrd_base = sdram_base + 0x1002000;
106 hwaddr cmdline_base = sdram_base + 0x1000000;
107 size_t initrd_max = sdram_size - 0x1002000;
108
109 reset_info = g_malloc0(sizeof(ResetInfo));
110
111 if (cpu_model == NULL) {
112 cpu_model = "lm32-full";
113 }
114 cpu = cpu_lm32_init(cpu_model);
115 if (cpu == NULL) {
116 fprintf(stderr, "qemu: unable to find CPU '%s'\n", cpu_model);
117 exit(1);
118 }
119
120 env = &cpu->env;
121 reset_info->cpu = cpu;
122
123 cpu_lm32_set_phys_msb_ignore(env, 1);
124
125 memory_region_allocate_system_memory(phys_sdram, NULL, "milkymist.sdram",
126 sdram_size);
127 memory_region_add_subregion(address_space_mem, sdram_base, phys_sdram);
128
129 dinfo = drive_get(IF_PFLASH, 0, 0);
130
131 pflash_cfi01_register(flash_base, NULL, "milkymist.flash", flash_size,
132 dinfo ? blk_by_legacy_dinfo(dinfo) : NULL,
133 flash_sector_size, flash_size / flash_sector_size,
134 2, 0x00, 0x89, 0x00, 0x1d, 1);
135
136
137 env->pic_state = lm32_pic_init(qemu_allocate_irq(cpu_irq_handler, cpu, 0));
138 for (i = 0; i < 32; i++) {
139 irq[i] = qdev_get_gpio_in(env->pic_state, i);
140 }
141
142
143 if (bios_name == NULL) {
144 bios_name = BIOS_FILENAME;
145 }
146 bios_filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, bios_name);
147
148 if (bios_filename) {
149 load_image_targphys(bios_filename, BIOS_OFFSET, BIOS_SIZE);
150 }
151
152 reset_info->bootstrap_pc = BIOS_OFFSET;
153
154
155 if (!kernel_filename && !dinfo && !bios_filename && !qtest_enabled()) {
156 fprintf(stderr, "qemu: could not load Milkymist One bios '%s'\n",
157 bios_name);
158 exit(1);
159 }
160 g_free(bios_filename);
161
162 milkymist_uart_create(0x60000000, irq[0]);
163 milkymist_sysctl_create(0x60001000, irq[1], irq[2], irq[3],
164 80000000, 0x10014d31, 0x0000041f, 0x00000001);
165 milkymist_hpdmc_create(0x60002000);
166 milkymist_vgafb_create(0x60003000, 0x40000000, 0x0fffffff);
167 milkymist_memcard_create(0x60004000);
168 milkymist_ac97_create(0x60005000, irq[4], irq[5], irq[6], irq[7]);
169 milkymist_pfpu_create(0x60006000, irq[8]);
170 milkymist_tmu2_create(0x60007000, irq[9]);
171 milkymist_minimac2_create(0x60008000, 0x30000000, irq[10], irq[11]);
172 milkymist_softusb_create(0x6000f000, irq[15],
173 0x20000000, 0x1000, 0x20020000, 0x2000);
174
175
176 env->juart_state = lm32_juart_init();
177
178 if (kernel_filename) {
179 uint64_t entry;
180
181
182 kernel_size = load_elf(kernel_filename, NULL, NULL, &entry, NULL, NULL,
183 1, EM_LATTICEMICO32, 0, 0);
184 reset_info->bootstrap_pc = entry;
185
186 if (kernel_size < 0) {
187 kernel_size = load_image_targphys(kernel_filename, sdram_base,
188 sdram_size);
189 reset_info->bootstrap_pc = sdram_base;
190 }
191
192 if (kernel_size < 0) {
193 fprintf(stderr, "qemu: could not load kernel '%s'\n",
194 kernel_filename);
195 exit(1);
196 }
197 }
198
199 if (kernel_cmdline && strlen(kernel_cmdline)) {
200 pstrcpy_targphys("cmdline", cmdline_base, TARGET_PAGE_SIZE,
201 kernel_cmdline);
202 reset_info->cmdline_base = (uint32_t)cmdline_base;
203 }
204
205 if (initrd_filename) {
206 size_t initrd_size;
207 initrd_size = load_image_targphys(initrd_filename, initrd_base,
208 initrd_max);
209 reset_info->initrd_base = (uint32_t)initrd_base;
210 reset_info->initrd_size = (uint32_t)initrd_size;
211 }
212
213 qemu_register_reset(main_cpu_reset, reset_info);
214}
215
216static void milkymist_machine_init(MachineClass *mc)
217{
218 mc->desc = "Milkymist One";
219 mc->init = milkymist_init;
220 mc->is_default = 0;
221}
222
223DEFINE_MACHINE("milkymist", milkymist_machine_init)
224
