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/units.h"
22#include "qemu/error-report.h"
23#include "qemu-common.h"
24#include "cpu.h"
25#include "hw/sysbus.h"
26#include "hw/hw.h"
27#include "hw/block/flash.h"
28#include "sysemu/sysemu.h"
29#include "sysemu/qtest.h"
30#include "hw/boards.h"
31#include "hw/loader.h"
32#include "elf.h"
33#include "milkymist-hw.h"
34#include "hw/display/milkymist_tmu2.h"
35#include "lm32.h"
36#include "exec/address-spaces.h"
37
38#define BIOS_FILENAME "mmone-bios.bin"
39#define BIOS_OFFSET 0x00860000
40#define BIOS_SIZE (512 * KiB)
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 * KiB;
100 size_t flash_size = 32 * MiB;
101 hwaddr sdram_base = 0x40000000;
102 size_t sdram_size = 128 * MiB;
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, "milkymist.flash", flash_size,
124 dinfo ? blk_by_legacy_dinfo(dinfo) : NULL,
125 flash_sector_size, 2, 0x00, 0x89, 0x00, 0x1d, 1);
126
127
128 env->pic_state = lm32_pic_init(qemu_allocate_irq(cpu_irq_handler, cpu, 0));
129 for (i = 0; i < 32; i++) {
130 irq[i] = qdev_get_gpio_in(env->pic_state, i);
131 }
132
133
134 if (bios_name == NULL) {
135 bios_name = BIOS_FILENAME;
136 }
137 bios_filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, bios_name);
138
139 if (bios_filename) {
140 if (load_image_targphys(bios_filename, BIOS_OFFSET, BIOS_SIZE) < 0) {
141 error_report("could not load bios '%s'", bios_filename);
142 exit(1);
143 }
144 }
145
146 reset_info->bootstrap_pc = BIOS_OFFSET;
147
148
149 if (!kernel_filename && !dinfo && !bios_filename && !qtest_enabled()) {
150 error_report("could not load Milkymist One bios '%s'", bios_name);
151 exit(1);
152 }
153 g_free(bios_filename);
154
155 milkymist_uart_create(0x60000000, irq[0], serial_hd(0));
156 milkymist_sysctl_create(0x60001000, irq[1], irq[2], irq[3],
157 80000000, 0x10014d31, 0x0000041f, 0x00000001);
158 milkymist_hpdmc_create(0x60002000);
159 milkymist_vgafb_create(0x60003000, 0x40000000, 0x0fffffff);
160 milkymist_memcard_create(0x60004000);
161 milkymist_ac97_create(0x60005000, irq[4], irq[5], irq[6], irq[7]);
162 milkymist_pfpu_create(0x60006000, irq[8]);
163 if (machine->enable_graphics) {
164 milkymist_tmu2_create(0x60007000, irq[9]);
165 }
166 milkymist_minimac2_create(0x60008000, 0x30000000, irq[10], irq[11]);
167 milkymist_softusb_create(0x6000f000, irq[15],
168 0x20000000, 0x1000, 0x20020000, 0x2000);
169
170
171 env->juart_state = lm32_juart_init(serial_hd(1));
172
173 if (kernel_filename) {
174 uint64_t entry;
175
176
177 kernel_size = load_elf(kernel_filename, NULL, NULL, NULL,
178 &entry, NULL, NULL,
179 1, EM_LATTICEMICO32, 0, 0);
180 reset_info->bootstrap_pc = entry;
181
182 if (kernel_size < 0) {
183 kernel_size = load_image_targphys(kernel_filename, sdram_base,
184 sdram_size);
185 reset_info->bootstrap_pc = sdram_base;
186 }
187
188 if (kernel_size < 0) {
189 error_report("could not load kernel '%s'", kernel_filename);
190 exit(1);
191 }
192 }
193
194 if (kernel_cmdline && strlen(kernel_cmdline)) {
195 pstrcpy_targphys("cmdline", cmdline_base, TARGET_PAGE_SIZE,
196 kernel_cmdline);
197 reset_info->cmdline_base = (uint32_t)cmdline_base;
198 }
199
200 if (initrd_filename) {
201 size_t initrd_size;
202 initrd_size = load_image_targphys(initrd_filename, initrd_base,
203 initrd_max);
204 reset_info->initrd_base = (uint32_t)initrd_base;
205 reset_info->initrd_size = (uint32_t)initrd_size;
206 }
207
208 qemu_register_reset(main_cpu_reset, reset_info);
209}
210
211static void milkymist_machine_init(MachineClass *mc)
212{
213 mc->desc = "Milkymist One";
214 mc->init = milkymist_init;
215 mc->is_default = 0;
216 mc->default_cpu_type = LM32_CPU_TYPE_NAME("lm32-full");
217}
218
219DEFINE_MACHINE("milkymist", milkymist_machine_init)
220
