1199767f8SToomas Soome /*-
2199767f8SToomas Soome * Copyright (c) 1998 Michael Smith <msmith@freebsd.org>
3199767f8SToomas Soome * Copyright (c) 2014 The FreeBSD Foundation
4199767f8SToomas Soome * All rights reserved.
5199767f8SToomas Soome *
6199767f8SToomas Soome * Redistribution and use in source and binary forms, with or without
7199767f8SToomas Soome * modification, are permitted provided that the following conditions
8199767f8SToomas Soome * are met:
9199767f8SToomas Soome * 1. Redistributions of source code must retain the above copyright
10199767f8SToomas Soome * notice, this list of conditions and the following disclaimer.
11199767f8SToomas Soome * 2. Redistributions in binary form must reproduce the above copyright
12199767f8SToomas Soome * notice, this list of conditions and the following disclaimer in the
13199767f8SToomas Soome * documentation and/or other materials provided with the distribution.
14199767f8SToomas Soome *
15199767f8SToomas Soome * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16199767f8SToomas Soome * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17199767f8SToomas Soome * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18199767f8SToomas Soome * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19199767f8SToomas Soome * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20199767f8SToomas Soome * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21199767f8SToomas Soome * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22199767f8SToomas Soome * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23199767f8SToomas Soome * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24199767f8SToomas Soome * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25199767f8SToomas Soome * SUCH DAMAGE.
26199767f8SToomas Soome */
27199767f8SToomas Soome
28199767f8SToomas Soome #include <sys/cdefs.h>
29199767f8SToomas Soome __FBSDID("$FreeBSD$");
30199767f8SToomas Soome
31199767f8SToomas Soome #define __ELF_WORD_SIZE 64
32199767f8SToomas Soome #include <sys/param.h>
33199767f8SToomas Soome #include <sys/exec.h>
34199767f8SToomas Soome #include <sys/linker.h>
35199767f8SToomas Soome #include <string.h>
36199767f8SToomas Soome #include <machine/elf.h>
37199767f8SToomas Soome #include <stand.h>
38199767f8SToomas Soome
39199767f8SToomas Soome #include <efi.h>
40199767f8SToomas Soome #include <efilib.h>
41199767f8SToomas Soome
42199767f8SToomas Soome #include "bootstrap.h"
43199767f8SToomas Soome
44199767f8SToomas Soome #include "platform/acfreebsd.h"
45199767f8SToomas Soome #include "acconfig.h"
46199767f8SToomas Soome #define ACPI_SYSTEM_XFACE
47199767f8SToomas Soome #include "actypes.h"
48199767f8SToomas Soome #include "actbl.h"
49199767f8SToomas Soome
50199767f8SToomas Soome #include "loader_efi.h"
51199767f8SToomas Soome
52199767f8SToomas Soome static EFI_GUID acpi_guid = ACPI_TABLE_GUID;
53199767f8SToomas Soome static EFI_GUID acpi20_guid = ACPI_20_TABLE_GUID;
54199767f8SToomas Soome
55199767f8SToomas Soome extern int bi_load(char *args, vm_offset_t *modulep, vm_offset_t *kernendp);
56199767f8SToomas Soome
57199767f8SToomas Soome static int elf64_exec(struct preloaded_file *amp);
58199767f8SToomas Soome static int elf64_obj_exec(struct preloaded_file *amp);
59199767f8SToomas Soome
60199767f8SToomas Soome static struct file_format amd64_elf = { elf64_loadfile, elf64_exec };
61199767f8SToomas Soome static struct file_format amd64_elf_obj = { elf64_obj_loadfile, elf64_obj_exec };
62199767f8SToomas Soome
63199767f8SToomas Soome struct file_format *file_formats[] = {
64199767f8SToomas Soome &amd64_elf,
65199767f8SToomas Soome &amd64_elf_obj,
66199767f8SToomas Soome NULL
67199767f8SToomas Soome };
68199767f8SToomas Soome
69199767f8SToomas Soome #define PG_V 0x001
70199767f8SToomas Soome #define PG_RW 0x002
71199767f8SToomas Soome #define PG_U 0x004
72199767f8SToomas Soome #define PG_PS 0x080
73199767f8SToomas Soome
74199767f8SToomas Soome typedef u_int64_t p4_entry_t;
75199767f8SToomas Soome typedef u_int64_t p3_entry_t;
76199767f8SToomas Soome typedef u_int64_t p2_entry_t;
77199767f8SToomas Soome static p4_entry_t *PT4;
78199767f8SToomas Soome static p3_entry_t *PT3;
79199767f8SToomas Soome static p2_entry_t *PT2;
80199767f8SToomas Soome
81199767f8SToomas Soome static void (*trampoline)(uint64_t stack, void *copy_finish, uint64_t kernend,
82199767f8SToomas Soome uint64_t modulep, p4_entry_t *pagetable,
83199767f8SToomas Soome uint64_t entry);
84199767f8SToomas Soome
85199767f8SToomas Soome extern uintptr_t amd64_tramp;
86199767f8SToomas Soome extern uint32_t amd64_tramp_size;
87199767f8SToomas Soome
88199767f8SToomas Soome /*
89199767f8SToomas Soome * There is an ELF kernel and one or more ELF modules loaded.
90199767f8SToomas Soome * We wish to start executing the kernel image, so make such
91199767f8SToomas Soome * preparations as are required, and do so.
92199767f8SToomas Soome */
93199767f8SToomas Soome static int
elf64_exec(struct preloaded_file * fp)94199767f8SToomas Soome elf64_exec(struct preloaded_file *fp)
95199767f8SToomas Soome {
96199767f8SToomas Soome struct file_metadata *md;
97199767f8SToomas Soome Elf_Ehdr *ehdr;
98199767f8SToomas Soome vm_offset_t modulep, kernend, trampcode, trampstack;
99199767f8SToomas Soome int err, i;
100199767f8SToomas Soome ACPI_TABLE_RSDP *rsdp;
101199767f8SToomas Soome char buf[24];
102199767f8SToomas Soome int revision;
103199767f8SToomas Soome
104199767f8SToomas Soome rsdp = efi_get_table(&acpi20_guid);
105199767f8SToomas Soome if (rsdp == NULL) {
106199767f8SToomas Soome rsdp = efi_get_table(&acpi_guid);
107199767f8SToomas Soome }
108199767f8SToomas Soome if (rsdp != NULL) {
109199767f8SToomas Soome sprintf(buf, "0x%016llx", (unsigned long long)rsdp);
110199767f8SToomas Soome setenv("hint.acpi.0.rsdp", buf, 1);
111199767f8SToomas Soome revision = rsdp->Revision;
112199767f8SToomas Soome if (revision == 0)
113199767f8SToomas Soome revision = 1;
114199767f8SToomas Soome sprintf(buf, "%d", revision);
115199767f8SToomas Soome setenv("hint.acpi.0.revision", buf, 1);
116199767f8SToomas Soome strncpy(buf, rsdp->OemId, sizeof(rsdp->OemId));
117199767f8SToomas Soome buf[sizeof(rsdp->OemId)] = '\0';
118199767f8SToomas Soome setenv("hint.acpi.0.oem", buf, 1);
119199767f8SToomas Soome sprintf(buf, "0x%016x", rsdp->RsdtPhysicalAddress);
120199767f8SToomas Soome setenv("hint.acpi.0.rsdt", buf, 1);
121199767f8SToomas Soome if (revision >= 2) {
122199767f8SToomas Soome /* XXX extended checksum? */
123199767f8SToomas Soome sprintf(buf, "0x%016llx",
124199767f8SToomas Soome (unsigned long long)rsdp->XsdtPhysicalAddress);
125199767f8SToomas Soome setenv("hint.acpi.0.xsdt", buf, 1);
126199767f8SToomas Soome sprintf(buf, "%d", rsdp->Length);
127199767f8SToomas Soome setenv("hint.acpi.0.xsdt_length", buf, 1);
128199767f8SToomas Soome }
129199767f8SToomas Soome }
130199767f8SToomas Soome
131199767f8SToomas Soome if ((md = file_findmetadata(fp, MODINFOMD_ELFHDR)) == NULL)
132199767f8SToomas Soome return(EFTYPE);
133199767f8SToomas Soome ehdr = (Elf_Ehdr *)&(md->md_data);
134199767f8SToomas Soome
135199767f8SToomas Soome trampcode = (vm_offset_t)0x0000000040000000;
136199767f8SToomas Soome err = BS->AllocatePages(AllocateMaxAddress, EfiLoaderData, 1,
137199767f8SToomas Soome (EFI_PHYSICAL_ADDRESS *)&trampcode);
138199767f8SToomas Soome bzero((void *)trampcode, EFI_PAGE_SIZE);
139199767f8SToomas Soome trampstack = trampcode + EFI_PAGE_SIZE - 8;
140199767f8SToomas Soome bcopy((void *)&amd64_tramp, (void *)trampcode, amd64_tramp_size);
141199767f8SToomas Soome trampoline = (void *)trampcode;
142199767f8SToomas Soome
143199767f8SToomas Soome PT4 = (p4_entry_t *)0x0000000040000000;
144199767f8SToomas Soome err = BS->AllocatePages(AllocateMaxAddress, EfiLoaderData, 3,
145199767f8SToomas Soome (EFI_PHYSICAL_ADDRESS *)&PT4);
146199767f8SToomas Soome bzero(PT4, 3 * EFI_PAGE_SIZE);
147199767f8SToomas Soome
148199767f8SToomas Soome PT3 = &PT4[512];
149199767f8SToomas Soome PT2 = &PT3[512];
150199767f8SToomas Soome
151199767f8SToomas Soome /*
152199767f8SToomas Soome * This is kinda brutal, but every single 1GB VM memory segment points
153199767f8SToomas Soome * to the same first 1GB of physical memory. But it is more than
154199767f8SToomas Soome * adequate.
155199767f8SToomas Soome */
156199767f8SToomas Soome for (i = 0; i < 512; i++) {
157199767f8SToomas Soome /* Each slot of the L4 pages points to the same L3 page. */
158199767f8SToomas Soome PT4[i] = (p4_entry_t)PT3;
159199767f8SToomas Soome PT4[i] |= PG_V | PG_RW | PG_U;
160199767f8SToomas Soome
161199767f8SToomas Soome /* Each slot of the L3 pages points to the same L2 page. */
162199767f8SToomas Soome PT3[i] = (p3_entry_t)PT2;
163199767f8SToomas Soome PT3[i] |= PG_V | PG_RW | PG_U;
164199767f8SToomas Soome
165199767f8SToomas Soome /* The L2 page slots are mapped with 2MB pages for 1GB. */
166199767f8SToomas Soome PT2[i] = i * (2 * 1024 * 1024);
167199767f8SToomas Soome PT2[i] |= PG_V | PG_RW | PG_PS | PG_U;
168199767f8SToomas Soome }
169199767f8SToomas Soome
170199767f8SToomas Soome printf("Start @ 0x%lx ...\n", ehdr->e_entry);
171199767f8SToomas Soome
17204f8e093SToomas Soome efi_time_fini();
173199767f8SToomas Soome err = bi_load(fp->f_args, &modulep, &kernend);
17404f8e093SToomas Soome if (err != 0) {
17504f8e093SToomas Soome efi_time_init();
176199767f8SToomas Soome return(err);
17704f8e093SToomas Soome }
178199767f8SToomas Soome
179199767f8SToomas Soome dev_cleanup();
180199767f8SToomas Soome
181199767f8SToomas Soome trampoline(trampstack, efi_copy_finish, kernend, modulep, PT4,
182199767f8SToomas Soome ehdr->e_entry);
183199767f8SToomas Soome
184199767f8SToomas Soome panic("exec returned");
185199767f8SToomas Soome }
186199767f8SToomas Soome
187199767f8SToomas Soome static int
elf64_obj_exec(struct preloaded_file * fp __attribute ((unused)))188199767f8SToomas Soome elf64_obj_exec(struct preloaded_file *fp __attribute((unused)))
189199767f8SToomas Soome {
190199767f8SToomas Soome return (EFTYPE);
191199767f8SToomas Soome }
192