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 *kernel_filename = machine->kernel_filename;
84 const char *kernel_cmdline = machine->kernel_cmdline;
85 const char *initrd_filename = machine->initrd_filename;
86 LM32CPU *cpu;
87 CPULM32State *env;
88 int kernel_size;
89 DriveInfo *dinfo;
90 MemoryRegion *address_space_mem = get_system_memory();
91 MemoryRegion *phys_sdram = g_new(MemoryRegion, 1);
92 qemu_irq irq[32];
93 int i;
94 char *bios_filename;
95 ResetInfo *reset_info;
96
97
98 hwaddr flash_base = 0x00000000;
99 size_t flash_sector_size = 128 * 1024;
100 size_t flash_size = 32 * 1024 * 1024;
101 hwaddr sdram_base = 0x40000000;
102 size_t sdram_size = 128 * 1024 * 1024;
103
104 hwaddr initrd_base = sdram_base + 0x1002000;
105 hwaddr cmdline_base = sdram_base + 0x1000000;
106 size_t initrd_max = sdram_size - 0x1002000;
107
108 reset_info = g_malloc0(sizeof(ResetInfo));
109
110 cpu = LM32_CPU(cpu_create(machine->cpu_type));
111
112 env = &cpu->env;
113 reset_info->cpu = cpu;
114
115 cpu_lm32_set_phys_msb_ignore(env, 1);
116
117 memory_region_allocate_system_memory(phys_sdram, NULL, "milkymist.sdram",
118 sdram_size);
119 memory_region_add_subregion(address_space_mem, sdram_base, phys_sdram);
120
121 dinfo = drive_get(IF_PFLASH, 0, 0);
122
123 pflash_cfi01_register(flash_base, NULL, "milkymist.flash", flash_size,
124 dinfo ? blk_by_legacy_dinfo(dinfo) : NULL,
125 flash_sector_size, flash_size / flash_sector_size,
126 2, 0x00, 0x89, 0x00, 0x1d, 1);
127
128
129 env->pic_state = lm32_pic_init(qemu_allocate_irq(cpu_irq_handler, cpu, 0));
130 for (i = 0; i < 32; i++) {
131 irq[i] = qdev_get_gpio_in(env->pic_state, i);
132 }
133
134
135 if (bios_name == NULL) {
136 bios_name = BIOS_FILENAME;
137 }
138 bios_filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, bios_name);
139
140 if (bios_filename) {
141 load_image_targphys(bios_filename, BIOS_OFFSET, BIOS_SIZE);
142 }
143
144 reset_info->bootstrap_pc = BIOS_OFFSET;
145
146
147 if (!kernel_filename && !dinfo && !bios_filename && !qtest_enabled()) {
148 fprintf(stderr, "qemu: could not load Milkymist One bios '%s'\n",
149 bios_name);
150 exit(1);
151 }
152 g_free(bios_filename);
153
154 milkymist_uart_create(0x60000000, irq[0], serial_hds[0]);
155 milkymist_sysctl_create(0x60001000, irq[1], irq[2], irq[3],
156 80000000, 0x10014d31, 0x0000041f, 0x00000001);
157 milkymist_hpdmc_create(0x60002000);
158 milkymist_vgafb_create(0x60003000, 0x40000000, 0x0fffffff);
159 milkymist_memcard_create(0x60004000);
160 milkymist_ac97_create(0x60005000, irq[4], irq[5], irq[6], irq[7]);
161 milkymist_pfpu_create(0x60006000, irq[8]);
162 if (machine->enable_graphics) {
163 milkymist_tmu2_create(0x60007000, irq[9]);
164 }
165 milkymist_minimac2_create(0x60008000, 0x30000000, irq[10], irq[11]);
166 milkymist_softusb_create(0x6000f000, irq[15],
167 0x20000000, 0x1000, 0x20020000, 0x2000);
168
169
170 env->juart_state = lm32_juart_init(serial_hds[1]);
171
172 if (kernel_filename) {
173 uint64_t entry;
174
175
176 kernel_size = load_elf(kernel_filename, NULL, NULL, &entry, NULL, NULL,
177 1, EM_LATTICEMICO32, 0, 0);
178 reset_info->bootstrap_pc = entry;
179
180 if (kernel_size < 0) {
181 kernel_size = load_image_targphys(kernel_filename, sdram_base,
182 sdram_size);
183 reset_info->bootstrap_pc = sdram_base;
184 }
185
186 if (kernel_size < 0) {
187 fprintf(stderr, "qemu: could not load kernel '%s'\n",
188 kernel_filename);
189 exit(1);
190 }
191 }
192
193 if (kernel_cmdline && strlen(kernel_cmdline)) {
194 pstrcpy_targphys("cmdline", cmdline_base, TARGET_PAGE_SIZE,
195 kernel_cmdline);
196 reset_info->cmdline_base = (uint32_t)cmdline_base;
197 }
198
199 if (initrd_filename) {
200 size_t initrd_size;
201 initrd_size = load_image_targphys(initrd_filename, initrd_base,
202 initrd_max);
203 reset_info->initrd_base = (uint32_t)initrd_base;
204 reset_info->initrd_size = (uint32_t)initrd_size;
205 }
206
207 qemu_register_reset(main_cpu_reset, reset_info);
208}
209
210static void milkymist_machine_init(MachineClass *mc)
211{
212 mc->desc = "Milkymist One";
213 mc->init = milkymist_init;
214 mc->is_default = 0;
215 mc->default_cpu_type = LM32_CPU_TYPE_NAME("lm32-full");
216}
217
218DEFINE_MACHINE("milkymist", milkymist_machine_init)
219
