root / hw / petalogix_ml605_mmu.c @ cde844fa
History | View | Annotate | Download (8.9 kB)
1 | 00914b7d | Michal Simek | /*
|
---|---|---|---|
2 | 00914b7d | Michal Simek | * Model of Petalogix linux reference design targeting Xilinx Spartan ml605
|
3 | 00914b7d | Michal Simek | * board.
|
4 | 00914b7d | Michal Simek | *
|
5 | 00914b7d | Michal Simek | * Copyright (c) 2011 Michal Simek <monstr@monstr.eu>
|
6 | 00914b7d | Michal Simek | * Copyright (c) 2011 PetaLogix
|
7 | 00914b7d | Michal Simek | * Copyright (c) 2009 Edgar E. Iglesias.
|
8 | 00914b7d | Michal Simek | *
|
9 | 00914b7d | Michal Simek | * Permission is hereby granted, free of charge, to any person obtaining a copy
|
10 | 00914b7d | Michal Simek | * of this software and associated documentation files (the "Software"), to deal
|
11 | 00914b7d | Michal Simek | * in the Software without restriction, including without limitation the rights
|
12 | 00914b7d | Michal Simek | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
13 | 00914b7d | Michal Simek | * copies of the Software, and to permit persons to whom the Software is
|
14 | 00914b7d | Michal Simek | * furnished to do so, subject to the following conditions:
|
15 | 00914b7d | Michal Simek | *
|
16 | 00914b7d | Michal Simek | * The above copyright notice and this permission notice shall be included in
|
17 | 00914b7d | Michal Simek | * all copies or substantial portions of the Software.
|
18 | 00914b7d | Michal Simek | *
|
19 | 00914b7d | Michal Simek | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
20 | 00914b7d | Michal Simek | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
21 | 00914b7d | Michal Simek | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
22 | 00914b7d | Michal Simek | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
23 | 00914b7d | Michal Simek | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
24 | 00914b7d | Michal Simek | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
25 | 00914b7d | Michal Simek | * THE SOFTWARE.
|
26 | 00914b7d | Michal Simek | */
|
27 | 00914b7d | Michal Simek | |
28 | 00914b7d | Michal Simek | #include "sysbus.h" |
29 | 00914b7d | Michal Simek | #include "hw.h" |
30 | 00914b7d | Michal Simek | #include "net.h" |
31 | 00914b7d | Michal Simek | #include "flash.h" |
32 | 00914b7d | Michal Simek | #include "sysemu.h" |
33 | 00914b7d | Michal Simek | #include "devices.h" |
34 | 00914b7d | Michal Simek | #include "boards.h" |
35 | 00914b7d | Michal Simek | #include "device_tree.h" |
36 | 00914b7d | Michal Simek | #include "xilinx.h" |
37 | 00914b7d | Michal Simek | #include "loader.h" |
38 | 00914b7d | Michal Simek | #include "elf.h" |
39 | 00914b7d | Michal Simek | #include "blockdev.h" |
40 | 00914b7d | Michal Simek | #include "pc.h" |
41 | 39186d8a | Richard Henderson | #include "exec-memory.h" |
42 | 00914b7d | Michal Simek | |
43 | b861b741 | Peter A. G. Crosthwaite | #include "microblaze_pic_cpu.h" |
44 | 00914b7d | Michal Simek | #include "xilinx_axidma.h" |
45 | 00914b7d | Michal Simek | |
46 | 00914b7d | Michal Simek | #define LMB_BRAM_SIZE (128 * 1024) |
47 | 00914b7d | Michal Simek | #define FLASH_SIZE (32 * 1024 * 1024) |
48 | 00914b7d | Michal Simek | |
49 | 00914b7d | Michal Simek | static struct |
50 | 00914b7d | Michal Simek | { |
51 | 00914b7d | Michal Simek | uint32_t bootstrap_pc; |
52 | 00914b7d | Michal Simek | uint32_t cmdline; |
53 | 00914b7d | Michal Simek | uint32_t fdt; |
54 | 00914b7d | Michal Simek | } boot_info; |
55 | 00914b7d | Michal Simek | |
56 | 00914b7d | Michal Simek | static void main_cpu_reset(void *opaque) |
57 | 00914b7d | Michal Simek | { |
58 | 00914b7d | Michal Simek | CPUState *env = opaque; |
59 | 00914b7d | Michal Simek | |
60 | 00914b7d | Michal Simek | cpu_reset(env); |
61 | 00914b7d | Michal Simek | env->regs[5] = boot_info.cmdline;
|
62 | 00914b7d | Michal Simek | env->regs[7] = boot_info.fdt;
|
63 | 00914b7d | Michal Simek | env->sregs[SR_PC] = boot_info.bootstrap_pc; |
64 | 00914b7d | Michal Simek | env->pvr.regs[10] = 0x0e000000; /* virtex 6 */ |
65 | 00914b7d | Michal Simek | /* setup pvr to match kernel setting */
|
66 | 00914b7d | Michal Simek | env->pvr.regs[5] |= PVR5_DCACHE_WRITEBACK_MASK;
|
67 | 00914b7d | Michal Simek | env->pvr.regs[0] |= PVR0_USE_FPU_MASK | PVR0_ENDI;
|
68 | 00914b7d | Michal Simek | env->pvr.regs[0] = (env->pvr.regs[0] & ~PVR0_VERSION_MASK) | (0x14 << 8); |
69 | 00914b7d | Michal Simek | env->pvr.regs[2] ^= PVR2_USE_FPU2_MASK;
|
70 | 00914b7d | Michal Simek | env->pvr.regs[4] = 0xc56b8000; |
71 | 00914b7d | Michal Simek | env->pvr.regs[5] = 0xc56be000; |
72 | 00914b7d | Michal Simek | } |
73 | 00914b7d | Michal Simek | |
74 | 00914b7d | Michal Simek | #define BINARY_DEVICE_TREE_FILE "petalogix-ml605.dtb" |
75 | 00914b7d | Michal Simek | static int petalogix_load_device_tree(target_phys_addr_t addr, |
76 | 00914b7d | Michal Simek | uint32_t ramsize, |
77 | 00914b7d | Michal Simek | target_phys_addr_t initrd_base, |
78 | 00914b7d | Michal Simek | target_phys_addr_t initrd_size, |
79 | 00914b7d | Michal Simek | const char *kernel_cmdline) |
80 | 00914b7d | Michal Simek | { |
81 | 00914b7d | Michal Simek | char *path;
|
82 | 00914b7d | Michal Simek | int fdt_size;
|
83 | 00914b7d | Michal Simek | #ifdef CONFIG_FDT
|
84 | 00914b7d | Michal Simek | void *fdt;
|
85 | 00914b7d | Michal Simek | int r;
|
86 | 00914b7d | Michal Simek | |
87 | 00914b7d | Michal Simek | /* Try the local "mb.dtb" override. */
|
88 | 00914b7d | Michal Simek | fdt = load_device_tree("mb.dtb", &fdt_size);
|
89 | 00914b7d | Michal Simek | if (!fdt) {
|
90 | 00914b7d | Michal Simek | path = qemu_find_file(QEMU_FILE_TYPE_BIOS, BINARY_DEVICE_TREE_FILE); |
91 | 00914b7d | Michal Simek | if (path) {
|
92 | 00914b7d | Michal Simek | fdt = load_device_tree(path, &fdt_size); |
93 | 7267c094 | Anthony Liguori | g_free(path); |
94 | 00914b7d | Michal Simek | } |
95 | 00914b7d | Michal Simek | if (!fdt) {
|
96 | 00914b7d | Michal Simek | return 0; |
97 | 00914b7d | Michal Simek | } |
98 | 00914b7d | Michal Simek | } |
99 | 00914b7d | Michal Simek | |
100 | 00914b7d | Michal Simek | r = qemu_devtree_setprop_string(fdt, "/chosen", "bootargs", kernel_cmdline); |
101 | 00914b7d | Michal Simek | if (r < 0) { |
102 | 00914b7d | Michal Simek | fprintf(stderr, "couldn't set /chosen/bootargs\n");
|
103 | 00914b7d | Michal Simek | } |
104 | 00914b7d | Michal Simek | cpu_physical_memory_write(addr, (void *)fdt, fdt_size);
|
105 | 00914b7d | Michal Simek | #else
|
106 | 00914b7d | Michal Simek | /* We lack libfdt so we cannot manipulate the fdt. Just pass on the blob
|
107 | 00914b7d | Michal Simek | to the kernel. */
|
108 | 00914b7d | Michal Simek | fdt_size = load_image_targphys("mb.dtb", addr, 0x10000); |
109 | 00914b7d | Michal Simek | if (fdt_size < 0) { |
110 | 00914b7d | Michal Simek | path = qemu_find_file(QEMU_FILE_TYPE_BIOS, BINARY_DEVICE_TREE_FILE); |
111 | 00914b7d | Michal Simek | if (path) {
|
112 | 00914b7d | Michal Simek | fdt_size = load_image_targphys(path, addr, 0x10000);
|
113 | 7267c094 | Anthony Liguori | g_free(path); |
114 | 00914b7d | Michal Simek | } |
115 | 00914b7d | Michal Simek | } |
116 | 00914b7d | Michal Simek | |
117 | 00914b7d | Michal Simek | if (kernel_cmdline) {
|
118 | 00914b7d | Michal Simek | fprintf(stderr, |
119 | 00914b7d | Michal Simek | "Warning: missing libfdt, cannot pass cmdline to kernel!\n");
|
120 | 00914b7d | Michal Simek | } |
121 | 00914b7d | Michal Simek | #endif
|
122 | 00914b7d | Michal Simek | return fdt_size;
|
123 | 00914b7d | Michal Simek | } |
124 | 00914b7d | Michal Simek | |
125 | 00914b7d | Michal Simek | static uint64_t translate_kernel_address(void *opaque, uint64_t addr) |
126 | 00914b7d | Michal Simek | { |
127 | 00914b7d | Michal Simek | return addr - 0x30000000LL; |
128 | 00914b7d | Michal Simek | } |
129 | 00914b7d | Michal Simek | |
130 | 00914b7d | Michal Simek | #define MEMORY_BASEADDR 0x50000000 |
131 | 00914b7d | Michal Simek | #define FLASH_BASEADDR 0x86000000 |
132 | 00914b7d | Michal Simek | #define INTC_BASEADDR 0x81800000 |
133 | 00914b7d | Michal Simek | #define TIMER_BASEADDR 0x83c00000 |
134 | 00914b7d | Michal Simek | #define UART16550_BASEADDR 0x83e00000 |
135 | 00914b7d | Michal Simek | #define AXIENET_BASEADDR 0x82780000 |
136 | 00914b7d | Michal Simek | #define AXIDMA_BASEADDR 0x84600000 |
137 | 00914b7d | Michal Simek | |
138 | 00914b7d | Michal Simek | static void |
139 | 00914b7d | Michal Simek | petalogix_ml605_init(ram_addr_t ram_size, |
140 | 00914b7d | Michal Simek | const char *boot_device, |
141 | 00914b7d | Michal Simek | const char *kernel_filename, |
142 | 00914b7d | Michal Simek | const char *kernel_cmdline, |
143 | 00914b7d | Michal Simek | const char *initrd_filename, const char *cpu_model) |
144 | 00914b7d | Michal Simek | { |
145 | 39186d8a | Richard Henderson | MemoryRegion *address_space_mem = get_system_memory(); |
146 | 00914b7d | Michal Simek | DeviceState *dev; |
147 | 00914b7d | Michal Simek | CPUState *env; |
148 | 00914b7d | Michal Simek | int kernel_size;
|
149 | 00914b7d | Michal Simek | DriveInfo *dinfo; |
150 | 00914b7d | Michal Simek | int i;
|
151 | 00914b7d | Michal Simek | target_phys_addr_t ddr_base = MEMORY_BASEADDR; |
152 | d7973c77 | Avi Kivity | MemoryRegion *phys_lmb_bram = g_new(MemoryRegion, 1);
|
153 | d7973c77 | Avi Kivity | MemoryRegion *phys_ram = g_new(MemoryRegion, 1);
|
154 | 00914b7d | Michal Simek | qemu_irq irq[32], *cpu_irq;
|
155 | 00914b7d | Michal Simek | |
156 | 00914b7d | Michal Simek | /* init CPUs */
|
157 | 00914b7d | Michal Simek | if (cpu_model == NULL) { |
158 | 00914b7d | Michal Simek | cpu_model = "microblaze";
|
159 | 00914b7d | Michal Simek | } |
160 | 00914b7d | Michal Simek | env = cpu_init(cpu_model); |
161 | 00914b7d | Michal Simek | |
162 | 00914b7d | Michal Simek | qemu_register_reset(main_cpu_reset, env); |
163 | 00914b7d | Michal Simek | |
164 | 00914b7d | Michal Simek | /* Attach emulated BRAM through the LMB. */
|
165 | d7973c77 | Avi Kivity | memory_region_init_ram(phys_lmb_bram, NULL, "petalogix_ml605.lmb_bram", |
166 | d7973c77 | Avi Kivity | LMB_BRAM_SIZE); |
167 | d7973c77 | Avi Kivity | memory_region_add_subregion(address_space_mem, 0x00000000, phys_lmb_bram);
|
168 | 00914b7d | Michal Simek | |
169 | d7973c77 | Avi Kivity | memory_region_init_ram(phys_ram, NULL, "petalogix_ml605.ram", ram_size); |
170 | d7973c77 | Avi Kivity | memory_region_add_subregion(address_space_mem, ddr_base, phys_ram); |
171 | 00914b7d | Michal Simek | |
172 | 00914b7d | Michal Simek | dinfo = drive_get(IF_PFLASH, 0, 0); |
173 | 00914b7d | Michal Simek | /* 5th parameter 2 means bank-width
|
174 | 00914b7d | Michal Simek | * 10th paremeter 0 means little-endian */
|
175 | cfe5f011 | Avi Kivity | pflash_cfi01_register(FLASH_BASEADDR, |
176 | cfe5f011 | Avi Kivity | NULL, "petalogix_ml605.flash", FLASH_SIZE, |
177 | 00914b7d | Michal Simek | dinfo ? dinfo->bdrv : NULL, (64 * 1024), |
178 | 00914b7d | Michal Simek | FLASH_SIZE >> 16,
|
179 | 01e0451a | Anthony Liguori | 2, 0x89, 0x18, 0x0000, 0x0, 0); |
180 | 00914b7d | Michal Simek | |
181 | 00914b7d | Michal Simek | |
182 | 00914b7d | Michal Simek | cpu_irq = microblaze_pic_init_cpu(env); |
183 | 00914b7d | Michal Simek | dev = xilinx_intc_create(INTC_BASEADDR, cpu_irq[0], 4); |
184 | 00914b7d | Michal Simek | for (i = 0; i < 32; i++) { |
185 | 00914b7d | Michal Simek | irq[i] = qdev_get_gpio_in(dev, i); |
186 | 00914b7d | Michal Simek | } |
187 | 00914b7d | Michal Simek | |
188 | 39186d8a | Richard Henderson | serial_mm_init(address_space_mem, UART16550_BASEADDR + 0x1000, 2, |
189 | 39186d8a | Richard Henderson | irq[5], 115200, serial_hds[0], DEVICE_LITTLE_ENDIAN); |
190 | 00914b7d | Michal Simek | |
191 | 00914b7d | Michal Simek | /* 2 timers at irq 2 @ 100 Mhz. */
|
192 | 00914b7d | Michal Simek | xilinx_timer_create(TIMER_BASEADDR, irq[2], 2, 100 * 1000000); |
193 | 00914b7d | Michal Simek | |
194 | 00914b7d | Michal Simek | /* axi ethernet and dma initialization. TODO: Dynamically connect them. */
|
195 | 00914b7d | Michal Simek | { |
196 | 00914b7d | Michal Simek | static struct XilinxDMAConnection dmach; |
197 | 00914b7d | Michal Simek | |
198 | 00914b7d | Michal Simek | xilinx_axiethernet_create(&dmach, &nd_table[0], 0x82780000, |
199 | 00914b7d | Michal Simek | irq[3], 0x1000, 0x1000); |
200 | 00914b7d | Michal Simek | xilinx_axiethernetdma_create(&dmach, 0x84600000,
|
201 | 00914b7d | Michal Simek | irq[1], irq[0], 100 * 1000000); |
202 | 00914b7d | Michal Simek | } |
203 | 00914b7d | Michal Simek | |
204 | 00914b7d | Michal Simek | if (kernel_filename) {
|
205 | 00914b7d | Michal Simek | uint64_t entry, low, high; |
206 | 00914b7d | Michal Simek | uint32_t base32; |
207 | 00914b7d | Michal Simek | int big_endian = 0; |
208 | 00914b7d | Michal Simek | |
209 | 00914b7d | Michal Simek | #ifdef TARGET_WORDS_BIGENDIAN
|
210 | 00914b7d | Michal Simek | big_endian = 1;
|
211 | 00914b7d | Michal Simek | #endif
|
212 | 00914b7d | Michal Simek | |
213 | 00914b7d | Michal Simek | /* Boots a kernel elf binary. */
|
214 | 00914b7d | Michal Simek | kernel_size = load_elf(kernel_filename, NULL, NULL, |
215 | 00914b7d | Michal Simek | &entry, &low, &high, |
216 | 00914b7d | Michal Simek | big_endian, ELF_MACHINE, 0);
|
217 | 00914b7d | Michal Simek | base32 = entry; |
218 | 00914b7d | Michal Simek | if (base32 == 0xc0000000) { |
219 | 00914b7d | Michal Simek | kernel_size = load_elf(kernel_filename, translate_kernel_address, |
220 | 00914b7d | Michal Simek | NULL, &entry, NULL, NULL, |
221 | 00914b7d | Michal Simek | big_endian, ELF_MACHINE, 0);
|
222 | 00914b7d | Michal Simek | } |
223 | 00914b7d | Michal Simek | /* Always boot into physical ram. */
|
224 | 00914b7d | Michal Simek | boot_info.bootstrap_pc = ddr_base + (entry & 0x0fffffff);
|
225 | 00914b7d | Michal Simek | |
226 | 00914b7d | Michal Simek | /* If it wasn't an ELF image, try an u-boot image. */
|
227 | 00914b7d | Michal Simek | if (kernel_size < 0) { |
228 | 00914b7d | Michal Simek | target_phys_addr_t uentry, loadaddr; |
229 | 00914b7d | Michal Simek | |
230 | 00914b7d | Michal Simek | kernel_size = load_uimage(kernel_filename, &uentry, &loadaddr, 0);
|
231 | 00914b7d | Michal Simek | boot_info.bootstrap_pc = uentry; |
232 | 00914b7d | Michal Simek | high = (loadaddr + kernel_size + 3) & ~3; |
233 | 00914b7d | Michal Simek | } |
234 | 00914b7d | Michal Simek | |
235 | 00914b7d | Michal Simek | /* Not an ELF image nor an u-boot image, try a RAW image. */
|
236 | 00914b7d | Michal Simek | if (kernel_size < 0) { |
237 | 00914b7d | Michal Simek | kernel_size = load_image_targphys(kernel_filename, ddr_base, |
238 | 00914b7d | Michal Simek | ram_size); |
239 | 00914b7d | Michal Simek | boot_info.bootstrap_pc = ddr_base; |
240 | 00914b7d | Michal Simek | high = (ddr_base + kernel_size + 3) & ~3; |
241 | 00914b7d | Michal Simek | } |
242 | 00914b7d | Michal Simek | |
243 | 00914b7d | Michal Simek | boot_info.cmdline = high + 4096;
|
244 | 00914b7d | Michal Simek | if (kernel_cmdline && strlen(kernel_cmdline)) {
|
245 | 00914b7d | Michal Simek | pstrcpy_targphys("cmdline", boot_info.cmdline, 256, kernel_cmdline); |
246 | 00914b7d | Michal Simek | } |
247 | 00914b7d | Michal Simek | /* Provide a device-tree. */
|
248 | 00914b7d | Michal Simek | boot_info.fdt = boot_info.cmdline + 4096;
|
249 | 00914b7d | Michal Simek | petalogix_load_device_tree(boot_info.fdt, ram_size, |
250 | 00914b7d | Michal Simek | 0, 0, |
251 | 00914b7d | Michal Simek | kernel_cmdline); |
252 | 00914b7d | Michal Simek | } |
253 | 00914b7d | Michal Simek | } |
254 | 00914b7d | Michal Simek | |
255 | 00914b7d | Michal Simek | static QEMUMachine petalogix_ml605_machine = {
|
256 | 00914b7d | Michal Simek | .name = "petalogix-ml605",
|
257 | 00914b7d | Michal Simek | .desc = "PetaLogix linux refdesign for xilinx ml605 little endian",
|
258 | 00914b7d | Michal Simek | .init = petalogix_ml605_init, |
259 | 00914b7d | Michal Simek | .is_default = 0
|
260 | 00914b7d | Michal Simek | }; |
261 | 00914b7d | Michal Simek | |
262 | 00914b7d | Michal Simek | static void petalogix_ml605_machine_init(void) |
263 | 00914b7d | Michal Simek | { |
264 | 00914b7d | Michal Simek | qemu_register_machine(&petalogix_ml605_machine); |
265 | 00914b7d | Michal Simek | } |
266 | 00914b7d | Michal Simek | |
267 | 00914b7d | Michal Simek | machine_init(petalogix_ml605_machine_init); |