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