2 * Copyright (c) 2004 Olivier Houchard
3 * Copyright (c) 1994-1998 Mark Brinicombe.
4 * Copyright (c) 1994 Brini.
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 #include "opt_platform.h"
31 #include <sys/cdefs.h>
32 __FBSDID("$FreeBSD$");
34 #include <sys/param.h>
35 #include <sys/systm.h>
36 #include <sys/ctype.h>
37 #include <sys/linker.h>
38 #include <sys/reboot.h>
39 #include <sys/sysctl.h>
44 #include <machine/cpu.h>
45 #include <machine/machdep.h>
46 #include <machine/metadata.h>
47 #include <machine/vmparam.h>
50 #include <contrib/libfdt/libfdt.h>
51 #include <dev/fdt/fdt_common.h>
55 static char *loader_envp;
56 static char static_kenv[4096];
60 #define CMDLINE_GUARD "FreeBSD:"
61 #define LBABI_MAX_COMMAND_LINE 512
62 static char linux_command_line[LBABI_MAX_COMMAND_LINE + 1];
66 * Fake up a boot descriptor table
68 #define PRELOAD_PUSH_VALUE(type, value) do { \
69 *(type *)(preload_ptr + size) = (value); \
70 size += sizeof(type); \
73 #define PRELOAD_PUSH_STRING(str) do { \
75 ssize = strlen(str) + 1; \
76 PRELOAD_PUSH_VALUE(uint32_t, ssize); \
77 strcpy((char*)(preload_ptr + size), str); \
79 size = roundup(size, sizeof(u_long)); \
83 /* Build minimal set of metatda. */
85 fake_preload_metadata(void *dtb_ptr, size_t dtb_size)
88 vm_offset_t zstart = 0, zend = 0;
91 static char fake_preload[256];
95 preload_ptr = (caddr_t)&fake_preload[0];
98 PRELOAD_PUSH_VALUE(uint32_t, MODINFO_NAME);
99 PRELOAD_PUSH_STRING("kernel");
101 PRELOAD_PUSH_VALUE(uint32_t, MODINFO_TYPE);
102 PRELOAD_PUSH_STRING("elf kernel");
104 PRELOAD_PUSH_VALUE(uint32_t, MODINFO_ADDR);
105 PRELOAD_PUSH_VALUE(uint32_t, sizeof(vm_offset_t));
106 PRELOAD_PUSH_VALUE(uint64_t, VM_MIN_KERNEL_ADDRESS);
108 PRELOAD_PUSH_VALUE(uint32_t, MODINFO_SIZE);
109 PRELOAD_PUSH_VALUE(uint32_t, sizeof(size_t));
110 PRELOAD_PUSH_VALUE(uint64_t, (size_t)(&end - VM_MIN_KERNEL_ADDRESS));
112 if (*(uint64_t *)VM_MIN_KERNEL_ADDRESS == MAGIC_TRAMP_NUMBER) {
113 PRELOAD_PUSH_VALUE(uint32_t, MODINFO_METADATA|MODINFOMD_SSYM);
114 PRELOAD_PUSH_VALUE(uint32_t, sizeof(vm_offset_t));
115 PRELOAD_PUSH_VALUE(uint64_t,
116 *(uint64_t *)(VM_MIN_KERNEL_ADDRESS + 4));
118 PRELOAD_PUSH_VALUE(uint32_t, MODINFO_METADATA | MODINFOMD_ESYM);
119 PRELOAD_PUSH_VALUE(uint32_t, sizeof(vm_offset_t));
120 PRELOAD_PUSH_VALUE(uint64_t,
121 *(uint64_t *)(VM_MIN_KERNEL_ADDRESS + 8));
123 lastaddr = *(uint64_t *)(VM_MIN_KERNEL_ADDRESS + 8);
125 zstart = *(uint64_t *)(VM_MIN_KERNEL_ADDRESS + 4);
126 db_fetch_ksymtab(zstart, zend);
129 lastaddr = (vm_offset_t)&end;
130 if (dtb_ptr != NULL) {
131 /* Copy DTB to KVA space and insert it into module chain. */
132 lastaddr = roundup(lastaddr, sizeof(int));
133 PRELOAD_PUSH_VALUE(uint32_t, MODINFO_METADATA | MODINFOMD_DTBP);
134 PRELOAD_PUSH_VALUE(uint32_t, sizeof(uint64_t));
135 PRELOAD_PUSH_VALUE(uint64_t, (uint64_t)lastaddr);
136 memmove((void *)lastaddr, dtb_ptr, dtb_size);
137 lastaddr += dtb_size;
138 lastaddr = roundup(lastaddr, sizeof(int));
141 PRELOAD_PUSH_VALUE(uint32_t, 0);
142 PRELOAD_PUSH_VALUE(uint32_t, 0);
144 preload_metadata = (caddr_t)(uintptr_t)fake_preload;
146 init_static_kenv(NULL, 0);
153 /* Convert the U-Boot command line into FreeBSD kenv and boot options. */
155 cmdline_set_env(char *cmdline, const char *guard)
159 /* Skip leading spaces. */
160 while (isspace(*cmdline))
163 /* Test and remove guard. */
164 if (guard != NULL && guard[0] != '\0') {
165 guard_len = strlen(guard);
166 if (strncasecmp(cmdline, guard, guard_len) != 0)
168 cmdline += guard_len;
171 boothowto |= boot_parse_cmdline(cmdline);
175 parse_fdt_bootargs(void)
178 if (loader_envp == NULL && fdt_get_chosen_bootargs(linux_command_line,
179 LBABI_MAX_COMMAND_LINE) == 0) {
180 init_static_kenv(static_kenv, sizeof(static_kenv));
181 cmdline_set_env(linux_command_line, CMDLINE_GUARD);
187 #if defined(LINUX_BOOT_ABI) && defined(FDT)
189 linux_parse_boot_param(struct arm64_bootparams *abp)
191 struct fdt_header *dtb_ptr;
194 if (abp->modulep == 0)
196 /* Test if modulep point to valid DTB. */
197 dtb_ptr = (struct fdt_header *)abp->modulep;
198 if (fdt_check_header(dtb_ptr) != 0)
200 dtb_size = fdt_totalsize(dtb_ptr);
201 return (fake_preload_metadata(dtb_ptr, dtb_size));
207 freebsd_parse_boot_param(struct arm64_bootparams *abp)
209 vm_offset_t lastaddr = 0;
212 vm_offset_t ksym_start;
213 vm_offset_t ksym_end;
216 if (abp->modulep == 0)
219 preload_metadata = (caddr_t)(uintptr_t)(abp->modulep);
220 kmdp = preload_search_by_type("elf kernel");
224 boothowto = MD_FETCH(kmdp, MODINFOMD_HOWTO, int);
225 loader_envp = MD_FETCH(kmdp, MODINFOMD_ENVP, char *);
226 init_static_kenv(loader_envp, 0);
227 lastaddr = MD_FETCH(kmdp, MODINFOMD_KERNEND, vm_offset_t);
229 ksym_start = MD_FETCH(kmdp, MODINFOMD_SSYM, uintptr_t);
230 ksym_end = MD_FETCH(kmdp, MODINFOMD_ESYM, uintptr_t);
231 db_fetch_ksymtab(ksym_start, ksym_end);
237 parse_boot_param(struct arm64_bootparams *abp)
239 vm_offset_t lastaddr;
241 #if defined(LINUX_BOOT_ABI) && defined(FDT)
242 lastaddr = linux_parse_boot_param(abp);
246 lastaddr = freebsd_parse_boot_param(abp);
250 /* Fall back to hardcoded metadata. */
251 lastaddr = fake_preload_metadata(NULL, 0);