18eef2ab6SToomas Soome /*
2199767f8SToomas Soome  * Copyright (c) 1998 Michael Smith <msmith@freebsd.org>
3199767f8SToomas Soome  * All rights reserved.
4199767f8SToomas Soome  *
5199767f8SToomas Soome  * Redistribution and use in source and binary forms, with or without
6199767f8SToomas Soome  * modification, are permitted provided that the following conditions
7199767f8SToomas Soome  * are met:
8199767f8SToomas Soome  * 1. Redistributions of source code must retain the above copyright
9199767f8SToomas Soome  *    notice, this list of conditions and the following disclaimer.
10199767f8SToomas Soome  * 2. Redistributions in binary form must reproduce the above copyright
11199767f8SToomas Soome  *    notice, this list of conditions and the following disclaimer in the
12199767f8SToomas Soome  *    documentation and/or other materials provided with the distribution.
13199767f8SToomas Soome  *
14199767f8SToomas Soome  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15199767f8SToomas Soome  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16199767f8SToomas Soome  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17199767f8SToomas Soome  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18199767f8SToomas Soome  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19199767f8SToomas Soome  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20199767f8SToomas Soome  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21199767f8SToomas Soome  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22199767f8SToomas Soome  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23199767f8SToomas Soome  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24199767f8SToomas Soome  * SUCH DAMAGE.
25199767f8SToomas Soome  */
26199767f8SToomas Soome 
27199767f8SToomas Soome #include <sys/cdefs.h>
28199767f8SToomas Soome 
29199767f8SToomas Soome #define __ELF_WORD_SIZE 64
30199767f8SToomas Soome #include <sys/param.h>
31199767f8SToomas Soome #include <sys/exec.h>
32199767f8SToomas Soome #include <sys/linker.h>
33199767f8SToomas Soome #include <string.h>
34199767f8SToomas Soome #include <machine/bootinfo.h>
35199767f8SToomas Soome #include <machine/elf.h>
36199767f8SToomas Soome #include <stand.h>
37199767f8SToomas Soome 
38199767f8SToomas Soome #include "bootstrap.h"
39199767f8SToomas Soome #include "libi386.h"
40199767f8SToomas Soome #include "btxv86.h"
41199767f8SToomas Soome 
42199767f8SToomas Soome static int	elf64_exec(struct preloaded_file *amp);
43199767f8SToomas Soome static int	elf64_obj_exec(struct preloaded_file *amp);
44199767f8SToomas Soome 
45199767f8SToomas Soome struct file_format amd64_elf = { elf64_loadfile, elf64_exec };
46199767f8SToomas Soome struct file_format amd64_elf_obj = { elf64_obj_loadfile, elf64_obj_exec };
47199767f8SToomas Soome 
48199767f8SToomas Soome #define PG_V	0x001
49199767f8SToomas Soome #define PG_RW	0x002
50199767f8SToomas Soome #define PG_U	0x004
51199767f8SToomas Soome #define PG_PS	0x080
52199767f8SToomas Soome 
53199767f8SToomas Soome typedef u_int64_t p4_entry_t;
54199767f8SToomas Soome typedef u_int64_t p3_entry_t;
55199767f8SToomas Soome typedef u_int64_t p2_entry_t;
56199767f8SToomas Soome extern p4_entry_t PT4[];
57199767f8SToomas Soome extern p3_entry_t PT3[];
58199767f8SToomas Soome extern p2_entry_t PT2[];
59199767f8SToomas Soome 
60199767f8SToomas Soome u_int32_t entry_hi;
61199767f8SToomas Soome u_int32_t entry_lo;
62199767f8SToomas Soome 
63199767f8SToomas Soome extern void amd64_tramp();
64199767f8SToomas Soome 
65199767f8SToomas Soome /*
66*55fea89dSDan Cross  * There is an ELF kernel and one or more ELF modules loaded.
67*55fea89dSDan Cross  * We wish to start executing the kernel image, so make such
68199767f8SToomas Soome  * preparations as are required, and do so.
69199767f8SToomas Soome  */
70199767f8SToomas Soome static int
elf64_exec(struct preloaded_file * fp)71199767f8SToomas Soome elf64_exec(struct preloaded_file *fp)
72199767f8SToomas Soome {
73199767f8SToomas Soome     struct file_metadata	*md;
74199767f8SToomas Soome     Elf_Ehdr 			*ehdr;
75199767f8SToomas Soome     vm_offset_t			modulep, kernend;
76199767f8SToomas Soome     int				err;
77199767f8SToomas Soome     int				i;
78199767f8SToomas Soome 
79199767f8SToomas Soome     if ((md = file_findmetadata(fp, MODINFOMD_ELFHDR)) == NULL)
80199767f8SToomas Soome 	return(EFTYPE);
81199767f8SToomas Soome     ehdr = (Elf_Ehdr *)&(md->md_data);
82199767f8SToomas Soome 
83199767f8SToomas Soome     err = bi_load64(fp->f_args, 0, &modulep, &kernend, 1);
84199767f8SToomas Soome     if (err != 0)
85199767f8SToomas Soome 	return(err);
86199767f8SToomas Soome 
87199767f8SToomas Soome     bzero(PT4, PAGE_SIZE);
88199767f8SToomas Soome     bzero(PT3, PAGE_SIZE);
89199767f8SToomas Soome     bzero(PT2, PAGE_SIZE);
90199767f8SToomas Soome 
91199767f8SToomas Soome     /*
92199767f8SToomas Soome      * This is kinda brutal, but every single 1GB VM memory segment points to
93199767f8SToomas Soome      * the same first 1GB of physical memory.  But it is more than adequate.
94199767f8SToomas Soome      */
95199767f8SToomas Soome     for (i = 0; i < 512; i++) {
96199767f8SToomas Soome 	/* Each slot of the level 4 pages points to the same level 3 page */
97199767f8SToomas Soome 	PT4[i] = (p4_entry_t)VTOP((uintptr_t)&PT3[0]);
98199767f8SToomas Soome 	PT4[i] |= PG_V | PG_RW | PG_U;
99199767f8SToomas Soome 
100199767f8SToomas Soome 	/* Each slot of the level 3 pages points to the same level 2 page */
101199767f8SToomas Soome 	PT3[i] = (p3_entry_t)VTOP((uintptr_t)&PT2[0]);
102199767f8SToomas Soome 	PT3[i] |= PG_V | PG_RW | PG_U;
103199767f8SToomas Soome 
104199767f8SToomas Soome 	/* The level 2 page slots are mapped with 2MB pages for 1GB. */
105199767f8SToomas Soome 	PT2[i] = i * (2 * 1024 * 1024);
106199767f8SToomas Soome 	PT2[i] |= PG_V | PG_RW | PG_PS | PG_U;
107199767f8SToomas Soome     }
108199767f8SToomas Soome 
109199767f8SToomas Soome     entry_lo = ehdr->e_entry & 0xffffffff;
110199767f8SToomas Soome     entry_hi = (ehdr->e_entry >> 32) & 0xffffffff;
111199767f8SToomas Soome #ifdef DEBUG
112199767f8SToomas Soome     printf("Start @ %#llx ...\n", ehdr->e_entry);
113199767f8SToomas Soome #endif
114199767f8SToomas Soome 
115199767f8SToomas Soome     dev_cleanup();
116199767f8SToomas Soome     __exec((void *)VTOP(amd64_tramp), modulep, kernend);
117199767f8SToomas Soome 
118199767f8SToomas Soome     panic("exec returned");
119199767f8SToomas Soome }
120199767f8SToomas Soome 
121199767f8SToomas Soome static int
elf64_obj_exec(struct preloaded_file * fp __unused)1228eef2ab6SToomas Soome elf64_obj_exec(struct preloaded_file *fp __unused)
123199767f8SToomas Soome {
124199767f8SToomas Soome 	return (EFTYPE);
125199767f8SToomas Soome }
126