xref: /dflybsd-src/stand/boot/common/load_elf_obj.c (revision 34f6038d8e05d03acda52bf11979c6c2afe7b5ea)
1479ab7f0SSascha Wildner /*-
2479ab7f0SSascha Wildner  * Copyright (c) 2004 Ian Dowse <iedowse@freebsd.org>
3479ab7f0SSascha Wildner  * Copyright (c) 1998 Michael Smith <msmith@freebsd.org>
4479ab7f0SSascha Wildner  * Copyright (c) 1998 Peter Wemm <peter@freebsd.org>
5479ab7f0SSascha Wildner  * All rights reserved.
6479ab7f0SSascha Wildner  *
7479ab7f0SSascha Wildner  * Redistribution and use in source and binary forms, with or without
8479ab7f0SSascha Wildner  * modification, are permitted provided that the following conditions
9479ab7f0SSascha Wildner  * are met:
10479ab7f0SSascha Wildner  * 1. Redistributions of source code must retain the above copyright
11479ab7f0SSascha Wildner  *    notice, this list of conditions and the following disclaimer.
12479ab7f0SSascha Wildner  * 2. Redistributions in binary form must reproduce the above copyright
13479ab7f0SSascha Wildner  *    notice, this list of conditions and the following disclaimer in the
14479ab7f0SSascha Wildner  *    documentation and/or other materials provided with the distribution.
15479ab7f0SSascha Wildner  *
16479ab7f0SSascha Wildner  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17479ab7f0SSascha Wildner  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18479ab7f0SSascha Wildner  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19479ab7f0SSascha Wildner  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20479ab7f0SSascha Wildner  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21479ab7f0SSascha Wildner  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22479ab7f0SSascha Wildner  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23479ab7f0SSascha Wildner  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24479ab7f0SSascha Wildner  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25479ab7f0SSascha Wildner  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26479ab7f0SSascha Wildner  * SUCH DAMAGE.
27479ab7f0SSascha Wildner  *
28479ab7f0SSascha Wildner  * $FreeBSD: src/sys/boot/common/load_elf_obj.c,v 1.2 2005/12/18 04:52:35 marcel Exp $
29479ab7f0SSascha Wildner  */
30479ab7f0SSascha Wildner 
31479ab7f0SSascha Wildner #include <sys/param.h>
32479ab7f0SSascha Wildner #include <sys/exec.h>
33479ab7f0SSascha Wildner #include <sys/linker.h>
34479ab7f0SSascha Wildner #include <sys/module.h>
35479ab7f0SSascha Wildner #include <inttypes.h>
36479ab7f0SSascha Wildner #include <string.h>
37479ab7f0SSascha Wildner #include <machine/elf.h>
38479ab7f0SSascha Wildner #include <stand.h>
39479ab7f0SSascha Wildner #define FREEBSD_ELF
40479ab7f0SSascha Wildner #include <link.h>
41479ab7f0SSascha Wildner 
42479ab7f0SSascha Wildner #include "bootstrap.h"
43479ab7f0SSascha Wildner 
44479ab7f0SSascha Wildner #define COPYOUT(s,d,l)	archsw.arch_copyout((vm_offset_t)(s), d, l)
45479ab7f0SSascha Wildner 
46479ab7f0SSascha Wildner #if defined(__i386__) && __ELF_WORD_SIZE == 64
47479ab7f0SSascha Wildner #undef ELF_TARG_CLASS
48479ab7f0SSascha Wildner #undef ELF_TARG_MACH
49479ab7f0SSascha Wildner #define ELF_TARG_CLASS  ELFCLASS64
50479ab7f0SSascha Wildner #define ELF_TARG_MACH   EM_X86_64
51479ab7f0SSascha Wildner #endif
52479ab7f0SSascha Wildner 
53479ab7f0SSascha Wildner typedef struct elf_file {
54479ab7f0SSascha Wildner 	Elf_Ehdr	hdr;
55479ab7f0SSascha Wildner 	Elf_Shdr	*e_shdr;
56479ab7f0SSascha Wildner 
57479ab7f0SSascha Wildner 	int		symtabindex;	/* Index of symbol table */
58479ab7f0SSascha Wildner 	int		shstrindex;	/* Index of section name string table */
59479ab7f0SSascha Wildner 
60479ab7f0SSascha Wildner 	int		fd;
61479ab7f0SSascha Wildner 	vm_offset_t	off;
62479ab7f0SSascha Wildner } *elf_file_t;
63479ab7f0SSascha Wildner 
64479ab7f0SSascha Wildner static int __elfN(obj_loadimage)(struct preloaded_file *mp, elf_file_t ef,
65479ab7f0SSascha Wildner     u_int64_t loadaddr);
66479ab7f0SSascha Wildner static int __elfN(obj_lookup_set)(struct preloaded_file *mp, elf_file_t ef,
67479ab7f0SSascha Wildner     const char *name, Elf_Addr *startp, Elf_Addr *stopp, int *countp);
68479ab7f0SSascha Wildner static int __elfN(obj_reloc_ptr)(struct preloaded_file *mp, elf_file_t ef,
69479ab7f0SSascha Wildner     Elf_Addr p, void *val, size_t len);
70479ab7f0SSascha Wildner static int __elfN(obj_parse_modmetadata)(struct preloaded_file *mp,
71479ab7f0SSascha Wildner     elf_file_t ef);
72479ab7f0SSascha Wildner static Elf_Addr __elfN(obj_symaddr)(struct elf_file *ef, Elf_Size symidx);
73479ab7f0SSascha Wildner 
74479ab7f0SSascha Wildner const char	*__elfN(obj_kerneltype) = "elf kernel";
75479ab7f0SSascha Wildner const char	*__elfN(obj_moduletype) = "elf obj module";
76479ab7f0SSascha Wildner 
77479ab7f0SSascha Wildner /*
78479ab7f0SSascha Wildner  * Attempt to load the file (file) as an ELF module.  It will be stored at
79479ab7f0SSascha Wildner  * (dest), and a pointer to a module structure describing the loaded object
80479ab7f0SSascha Wildner  * will be saved in (result).
81479ab7f0SSascha Wildner  */
82479ab7f0SSascha Wildner int
__elfN(obj_loadfile)83479ab7f0SSascha Wildner __elfN(obj_loadfile)(char *filename, u_int64_t dest,
84479ab7f0SSascha Wildner     struct preloaded_file **result)
85479ab7f0SSascha Wildner {
86479ab7f0SSascha Wildner 	struct preloaded_file *fp, *kfp;
87479ab7f0SSascha Wildner 	struct elf_file ef;
88479ab7f0SSascha Wildner 	Elf_Ehdr *hdr;
89479ab7f0SSascha Wildner 	int err;
90479ab7f0SSascha Wildner 	ssize_t bytes_read;
91479ab7f0SSascha Wildner 
92479ab7f0SSascha Wildner 	fp = NULL;
93479ab7f0SSascha Wildner 	bzero(&ef, sizeof(struct elf_file));
94479ab7f0SSascha Wildner 
95479ab7f0SSascha Wildner 	/*
96479ab7f0SSascha Wildner 	 * Open the image, read and validate the ELF header
97479ab7f0SSascha Wildner 	 */
98479ab7f0SSascha Wildner 	if (filename == NULL)	/* can't handle nameless */
99479ab7f0SSascha Wildner 		return(EFTYPE);
100479ab7f0SSascha Wildner 	if ((ef.fd = rel_open(filename, NULL, O_RDONLY)) == -1)
101479ab7f0SSascha Wildner 		return(errno);
102479ab7f0SSascha Wildner 
103479ab7f0SSascha Wildner 	hdr = &ef.hdr;
104479ab7f0SSascha Wildner 	bytes_read = read(ef.fd, hdr, sizeof(*hdr));
105479ab7f0SSascha Wildner 	if (bytes_read != sizeof(*hdr)) {
106479ab7f0SSascha Wildner 		err = EFTYPE;	/* could be EIO, but may be small file */
107479ab7f0SSascha Wildner 		goto oerr;
108479ab7f0SSascha Wildner 	}
109479ab7f0SSascha Wildner 
110479ab7f0SSascha Wildner 	/* Is it ELF? */
111479ab7f0SSascha Wildner 	if (!IS_ELF(*hdr)) {
112479ab7f0SSascha Wildner 		err = EFTYPE;
113479ab7f0SSascha Wildner 		goto oerr;
114479ab7f0SSascha Wildner 	}
115479ab7f0SSascha Wildner 	if (hdr->e_ident[EI_CLASS] != ELF_TARG_CLASS ||	/* Layout ? */
116479ab7f0SSascha Wildner 	    hdr->e_ident[EI_DATA] != ELF_TARG_DATA ||
117479ab7f0SSascha Wildner 	    hdr->e_ident[EI_VERSION] != EV_CURRENT ||	/* Version ? */
118479ab7f0SSascha Wildner 	    hdr->e_version != EV_CURRENT ||
119479ab7f0SSascha Wildner 	    hdr->e_machine != ELF_TARG_MACH ||		/* Machine ? */
120479ab7f0SSascha Wildner 	    hdr->e_type != ET_REL) {
121479ab7f0SSascha Wildner 		err = EFTYPE;
122479ab7f0SSascha Wildner 		goto oerr;
123479ab7f0SSascha Wildner 	}
124479ab7f0SSascha Wildner 
125479ab7f0SSascha Wildner 	if (hdr->e_shnum * hdr->e_shentsize == 0 || hdr->e_shoff == 0 ||
126479ab7f0SSascha Wildner 	    hdr->e_shentsize != sizeof(Elf_Shdr)) {
127479ab7f0SSascha Wildner 		err = EFTYPE;
128479ab7f0SSascha Wildner 		goto oerr;
129479ab7f0SSascha Wildner 	}
130479ab7f0SSascha Wildner 
131479ab7f0SSascha Wildner 	kfp = file_findfile(NULL, NULL);
132479ab7f0SSascha Wildner 	if (kfp == NULL) {
133479ab7f0SSascha Wildner 		printf("elf" __XSTRING(__ELF_WORD_SIZE)
134479ab7f0SSascha Wildner 		    "_obj_loadfile: can't load module before kernel\n");
135479ab7f0SSascha Wildner 		err = EPERM;
136479ab7f0SSascha Wildner 		goto oerr;
137479ab7f0SSascha Wildner 	}
138479ab7f0SSascha Wildner 	if (strcmp(__elfN(obj_kerneltype), kfp->f_type)) {
139479ab7f0SSascha Wildner 		printf("elf" __XSTRING(__ELF_WORD_SIZE)
140479ab7f0SSascha Wildner 		    "_obj_loadfile: can't load module with kernel type '%s'\n",
141479ab7f0SSascha Wildner 		    kfp->f_type);
142479ab7f0SSascha Wildner 		err = EPERM;
143479ab7f0SSascha Wildner 		goto oerr;
144479ab7f0SSascha Wildner 	}
145479ab7f0SSascha Wildner 
146479ab7f0SSascha Wildner 	/* Page-align the load address */
147479ab7f0SSascha Wildner 	dest = roundup(dest, PAGE_SIZE);
148479ab7f0SSascha Wildner 
149479ab7f0SSascha Wildner 	/*
150479ab7f0SSascha Wildner 	 * Ok, we think we should handle this.
151479ab7f0SSascha Wildner 	 */
152479ab7f0SSascha Wildner 	fp = file_alloc();
153479ab7f0SSascha Wildner 	if (fp == NULL) {
154479ab7f0SSascha Wildner 		printf("elf" __XSTRING(__ELF_WORD_SIZE)
155479ab7f0SSascha Wildner 		    "_obj_loadfile: cannot allocate module info\n");
156479ab7f0SSascha Wildner 		err = EPERM;
157479ab7f0SSascha Wildner 		goto out;
158479ab7f0SSascha Wildner 	}
159*34f6038dSAaron LI 	fp->f_name = rel_rootpath(filename);
160479ab7f0SSascha Wildner 	fp->f_type = strdup(__elfN(obj_moduletype));
161479ab7f0SSascha Wildner 
162479ab7f0SSascha Wildner 	printf("%s ", filename);
163479ab7f0SSascha Wildner 
164479ab7f0SSascha Wildner 	fp->f_size = __elfN(obj_loadimage)(fp, &ef, dest);
165479ab7f0SSascha Wildner 	if (fp->f_size == 0 || fp->f_addr == 0)
166479ab7f0SSascha Wildner 		goto ioerr;
167479ab7f0SSascha Wildner 
168479ab7f0SSascha Wildner 	/* save exec header as metadata */
169479ab7f0SSascha Wildner 	file_addmetadata(fp, MODINFOMD_ELFHDR, sizeof(*hdr), hdr);
170479ab7f0SSascha Wildner 
171479ab7f0SSascha Wildner 	/* Load OK, return module pointer */
172479ab7f0SSascha Wildner 	*result = (struct preloaded_file *)fp;
173479ab7f0SSascha Wildner 	err = 0;
174479ab7f0SSascha Wildner 	goto out;
175479ab7f0SSascha Wildner 
176479ab7f0SSascha Wildner ioerr:
177479ab7f0SSascha Wildner 	err = EIO;
178479ab7f0SSascha Wildner oerr:
179479ab7f0SSascha Wildner 	file_discard(fp);
180479ab7f0SSascha Wildner out:
181479ab7f0SSascha Wildner 	close(ef.fd);
182479ab7f0SSascha Wildner 	if (ef.e_shdr != NULL)
183479ab7f0SSascha Wildner 		free(ef.e_shdr);
184479ab7f0SSascha Wildner 
185479ab7f0SSascha Wildner 	return(err);
186479ab7f0SSascha Wildner }
187479ab7f0SSascha Wildner 
188479ab7f0SSascha Wildner /*
189479ab7f0SSascha Wildner  * With the file (fd) open on the image, and (ehdr) containing
190479ab7f0SSascha Wildner  * the Elf header, load the image at (off)
191479ab7f0SSascha Wildner  */
192479ab7f0SSascha Wildner static int
__elfN(obj_loadimage)193479ab7f0SSascha Wildner __elfN(obj_loadimage)(struct preloaded_file *fp, elf_file_t ef, u_int64_t off)
194479ab7f0SSascha Wildner {
195479ab7f0SSascha Wildner 	Elf_Ehdr *hdr;
196479ab7f0SSascha Wildner 	Elf_Shdr *shdr;
197479ab7f0SSascha Wildner 	vm_offset_t firstaddr, lastaddr;
198479ab7f0SSascha Wildner 	int i, nsym, res, ret, shdrbytes, symstrindex;
199479ab7f0SSascha Wildner 
200479ab7f0SSascha Wildner 	ret = 0;
201479ab7f0SSascha Wildner 	firstaddr = lastaddr = (vm_offset_t)off;
202479ab7f0SSascha Wildner 	hdr = &ef->hdr;
203479ab7f0SSascha Wildner 	ef->off = (vm_offset_t)off;
204479ab7f0SSascha Wildner 
205479ab7f0SSascha Wildner 	/* Read in the section headers. */
206479ab7f0SSascha Wildner 	shdrbytes = hdr->e_shnum * hdr->e_shentsize;
207479ab7f0SSascha Wildner 	shdr = alloc_pread(ef->fd, (off_t)hdr->e_shoff, shdrbytes);
208479ab7f0SSascha Wildner 	if (shdr == NULL) {
209479ab7f0SSascha Wildner 		printf("\nelf" __XSTRING(__ELF_WORD_SIZE)
210479ab7f0SSascha Wildner 		    "_obj_loadimage: read section headers failed\n");
211479ab7f0SSascha Wildner 		goto out;
212479ab7f0SSascha Wildner 	}
213479ab7f0SSascha Wildner 	ef->e_shdr = shdr;
214479ab7f0SSascha Wildner 
215479ab7f0SSascha Wildner 	/*
216479ab7f0SSascha Wildner 	 * Decide where to load everything, but don't read it yet.
217479ab7f0SSascha Wildner 	 * We store the load address as a non-zero sh_addr value.
218479ab7f0SSascha Wildner 	 * Start with the code/data and bss.
219479ab7f0SSascha Wildner 	 */
220479ab7f0SSascha Wildner 	for (i = 0; i < hdr->e_shnum; i++) {
221479ab7f0SSascha Wildner 		shdr[i].sh_addr = 0;
222479ab7f0SSascha Wildner 		if (shdr[i].sh_size == 0)
223479ab7f0SSascha Wildner 			continue;
224479ab7f0SSascha Wildner 		switch (shdr[i].sh_type) {
225479ab7f0SSascha Wildner 		case SHT_PROGBITS:
226479ab7f0SSascha Wildner 		case SHT_NOBITS:
227479ab7f0SSascha Wildner 			lastaddr = roundup(lastaddr, shdr[i].sh_addralign);
228479ab7f0SSascha Wildner 			shdr[i].sh_addr = (Elf_Addr)lastaddr;
229479ab7f0SSascha Wildner 			lastaddr += shdr[i].sh_size;
230479ab7f0SSascha Wildner 			break;
231479ab7f0SSascha Wildner 		}
232479ab7f0SSascha Wildner 	}
233479ab7f0SSascha Wildner 
234479ab7f0SSascha Wildner 	/* Symbols. */
235479ab7f0SSascha Wildner 	nsym = 0;
236479ab7f0SSascha Wildner 	for (i = 0; i < hdr->e_shnum; i++) {
237479ab7f0SSascha Wildner 		switch (shdr[i].sh_type) {
238479ab7f0SSascha Wildner 		case SHT_SYMTAB:
239479ab7f0SSascha Wildner 			nsym++;
240479ab7f0SSascha Wildner 			ef->symtabindex = i;
241479ab7f0SSascha Wildner 			shdr[i].sh_addr = (Elf_Addr)lastaddr;
242479ab7f0SSascha Wildner 			lastaddr += shdr[i].sh_size;
243479ab7f0SSascha Wildner 			break;
244479ab7f0SSascha Wildner 		}
245479ab7f0SSascha Wildner 	}
246479ab7f0SSascha Wildner 	if (nsym != 1) {
247479ab7f0SSascha Wildner 		printf("\nelf" __XSTRING(__ELF_WORD_SIZE)
248479ab7f0SSascha Wildner 		    "_obj_loadimage: file has no valid symbol table\n");
249479ab7f0SSascha Wildner 		goto out;
250479ab7f0SSascha Wildner 	}
251479ab7f0SSascha Wildner 	lastaddr = roundup(lastaddr, shdr[ef->symtabindex].sh_addralign);
252479ab7f0SSascha Wildner 	shdr[ef->symtabindex].sh_addr = (Elf_Addr)lastaddr;
253479ab7f0SSascha Wildner 	lastaddr += shdr[ef->symtabindex].sh_size;
254479ab7f0SSascha Wildner 
255479ab7f0SSascha Wildner 	symstrindex = shdr[ef->symtabindex].sh_link;
256479ab7f0SSascha Wildner 	if (symstrindex < 0 || symstrindex >= hdr->e_shnum ||
257479ab7f0SSascha Wildner 	    shdr[symstrindex].sh_type != SHT_STRTAB) {
258479ab7f0SSascha Wildner 		printf("\nelf" __XSTRING(__ELF_WORD_SIZE)
259479ab7f0SSascha Wildner 		    "_obj_loadimage: file has invalid symbol strings\n");
260479ab7f0SSascha Wildner 		goto out;
261479ab7f0SSascha Wildner 	}
262479ab7f0SSascha Wildner 	lastaddr = roundup(lastaddr, shdr[symstrindex].sh_addralign);
263479ab7f0SSascha Wildner 	shdr[symstrindex].sh_addr = (Elf_Addr)lastaddr;
264479ab7f0SSascha Wildner 	lastaddr += shdr[symstrindex].sh_size;
265479ab7f0SSascha Wildner 
266479ab7f0SSascha Wildner 	/* Section names. */
267479ab7f0SSascha Wildner 	if (hdr->e_shstrndx == 0 || hdr->e_shstrndx >= hdr->e_shnum ||
268479ab7f0SSascha Wildner 	    shdr[hdr->e_shstrndx].sh_type != SHT_STRTAB) {
269479ab7f0SSascha Wildner 		printf("\nelf" __XSTRING(__ELF_WORD_SIZE)
270479ab7f0SSascha Wildner 		    "_obj_loadimage: file has no section names\n");
271479ab7f0SSascha Wildner 		goto out;
272479ab7f0SSascha Wildner 	}
273479ab7f0SSascha Wildner 	ef->shstrindex = hdr->e_shstrndx;
274479ab7f0SSascha Wildner 	lastaddr = roundup(lastaddr, shdr[ef->shstrindex].sh_addralign);
275479ab7f0SSascha Wildner 	shdr[ef->shstrindex].sh_addr = (Elf_Addr)lastaddr;
276479ab7f0SSascha Wildner 	lastaddr += shdr[ef->shstrindex].sh_size;
277479ab7f0SSascha Wildner 
278479ab7f0SSascha Wildner 	/* Relocation tables. */
279479ab7f0SSascha Wildner 	for (i = 0; i < hdr->e_shnum; i++) {
280479ab7f0SSascha Wildner 		switch (shdr[i].sh_type) {
281479ab7f0SSascha Wildner 		case SHT_REL:
282479ab7f0SSascha Wildner 		case SHT_RELA:
283479ab7f0SSascha Wildner 			lastaddr = roundup(lastaddr, shdr[i].sh_addralign);
284479ab7f0SSascha Wildner 			shdr[i].sh_addr = (Elf_Addr)lastaddr;
285479ab7f0SSascha Wildner 			lastaddr += shdr[i].sh_size;
286479ab7f0SSascha Wildner 			break;
287479ab7f0SSascha Wildner 		}
288479ab7f0SSascha Wildner 	}
289479ab7f0SSascha Wildner 
290479ab7f0SSascha Wildner 	/* Clear the whole area, including bss regions. */
291479ab7f0SSascha Wildner 	kern_bzero(firstaddr, lastaddr - firstaddr);
292479ab7f0SSascha Wildner 
293479ab7f0SSascha Wildner 	/* Now read it all in. */
294479ab7f0SSascha Wildner 	for (i = 0; i < hdr->e_shnum; i++) {
295479ab7f0SSascha Wildner 		if (shdr[i].sh_addr == 0 || shdr[i].sh_type == SHT_NOBITS)
296479ab7f0SSascha Wildner 			continue;
297479ab7f0SSascha Wildner 		if (kern_pread(ef->fd, (vm_offset_t)shdr[i].sh_addr,
298479ab7f0SSascha Wildner 		    shdr[i].sh_size, (off_t)shdr[i].sh_offset) != 0) {
299479ab7f0SSascha Wildner 			printf("\nelf" __XSTRING(__ELF_WORD_SIZE)
300479ab7f0SSascha Wildner 			    "_obj_loadimage: read failed\n");
301479ab7f0SSascha Wildner 			goto out;
302479ab7f0SSascha Wildner 		}
303479ab7f0SSascha Wildner 	}
304479ab7f0SSascha Wildner 
305479ab7f0SSascha Wildner 	file_addmetadata(fp, MODINFOMD_SHDR, shdrbytes, shdr);
306479ab7f0SSascha Wildner 
307479ab7f0SSascha Wildner 	res = __elfN(obj_parse_modmetadata)(fp, ef);
308479ab7f0SSascha Wildner 	if (res != 0)
309479ab7f0SSascha Wildner 		goto out;
310479ab7f0SSascha Wildner 
311479ab7f0SSascha Wildner 	ret = lastaddr - firstaddr;
312479ab7f0SSascha Wildner 	fp->f_addr = firstaddr;
313479ab7f0SSascha Wildner 
314479ab7f0SSascha Wildner 	printf("size 0x%lx at 0x%lx", (u_long)ret, (u_long)firstaddr);
315479ab7f0SSascha Wildner 
316479ab7f0SSascha Wildner out:
317479ab7f0SSascha Wildner 	printf("\n");
318479ab7f0SSascha Wildner 	return ret;
319479ab7f0SSascha Wildner }
320479ab7f0SSascha Wildner 
321479ab7f0SSascha Wildner #if defined(__i386__) && __ELF_WORD_SIZE == 64
322479ab7f0SSascha Wildner struct mod_metadata64 {
323479ab7f0SSascha Wildner 	int		md_version;	/* structure version MDTV_* */
324479ab7f0SSascha Wildner 	int		md_type;	/* type of entry MDT_* */
325479ab7f0SSascha Wildner 	u_int64_t	md_data;	/* specific data */
326479ab7f0SSascha Wildner 	u_int64_t	md_cval;	/* common string label */
327479ab7f0SSascha Wildner };
328479ab7f0SSascha Wildner #endif
329479ab7f0SSascha Wildner 
330479ab7f0SSascha Wildner int
__elfN(obj_parse_modmetadata)331479ab7f0SSascha Wildner __elfN(obj_parse_modmetadata)(struct preloaded_file *fp, elf_file_t ef)
332479ab7f0SSascha Wildner {
333479ab7f0SSascha Wildner 	struct mod_metadata md;
334479ab7f0SSascha Wildner #if defined(__i386__) && __ELF_WORD_SIZE == 64
335479ab7f0SSascha Wildner 	struct mod_metadata64 md64;
336479ab7f0SSascha Wildner #endif
337479ab7f0SSascha Wildner 	struct mod_depend *mdepend;
338479ab7f0SSascha Wildner 	struct mod_version mver;
339479ab7f0SSascha Wildner 	char *s;
340479ab7f0SSascha Wildner 	int error, modcnt, minfolen;
341479ab7f0SSascha Wildner 	Elf_Addr v, p, p_stop;
342479ab7f0SSascha Wildner 
343479ab7f0SSascha Wildner 	if (__elfN(obj_lookup_set)(fp, ef, "modmetadata_set", &p, &p_stop,
344479ab7f0SSascha Wildner 	    &modcnt) != 0)
345479ab7f0SSascha Wildner 		return ENOENT;
346479ab7f0SSascha Wildner 
347479ab7f0SSascha Wildner 	modcnt = 0;
348479ab7f0SSascha Wildner 	while (p < p_stop) {
349479ab7f0SSascha Wildner 		COPYOUT(p, &v, sizeof(v));
350479ab7f0SSascha Wildner 		error = __elfN(obj_reloc_ptr)(fp, ef, p, &v, sizeof(v));
351479ab7f0SSascha Wildner 		if (error != 0)
352479ab7f0SSascha Wildner 			return (error);
353479ab7f0SSascha Wildner #if defined(__i386__) && __ELF_WORD_SIZE == 64
354479ab7f0SSascha Wildner 		COPYOUT(v, &md64, sizeof(md64));
355479ab7f0SSascha Wildner 		error = __elfN(obj_reloc_ptr)(fp, ef, v, &md64, sizeof(md64));
356479ab7f0SSascha Wildner 		if (error != 0)
357479ab7f0SSascha Wildner 			return (error);
358479ab7f0SSascha Wildner 		md.md_version = md64.md_version;
359479ab7f0SSascha Wildner 		md.md_type = md64.md_type;
360479ab7f0SSascha Wildner 		md.md_cval = (const char *)(uintptr_t)md64.md_cval;
361479ab7f0SSascha Wildner 		md.md_data = (void *)(uintptr_t)md64.md_data;
362479ab7f0SSascha Wildner #else
363479ab7f0SSascha Wildner 		COPYOUT(v, &md, sizeof(md));
364479ab7f0SSascha Wildner 		error = __elfN(obj_reloc_ptr)(fp, ef, v, &md, sizeof(md));
365479ab7f0SSascha Wildner 		if (error != 0)
366479ab7f0SSascha Wildner 			return (error);
367479ab7f0SSascha Wildner #endif
368479ab7f0SSascha Wildner 		p += sizeof(Elf_Addr);
369479ab7f0SSascha Wildner 		switch(md.md_type) {
370479ab7f0SSascha Wildner 		case MDT_DEPEND:
371479ab7f0SSascha Wildner 			s = strdupout((vm_offset_t)md.md_cval);
372479ab7f0SSascha Wildner 			minfolen = sizeof(*mdepend) + strlen(s) + 1;
373479ab7f0SSascha Wildner 			mdepend = malloc(minfolen);
374479ab7f0SSascha Wildner 			if (mdepend == NULL)
375479ab7f0SSascha Wildner 				return ENOMEM;
376479ab7f0SSascha Wildner 			COPYOUT((vm_offset_t)md.md_data, mdepend,
377479ab7f0SSascha Wildner 			    sizeof(*mdepend));
378479ab7f0SSascha Wildner 			strcpy((char*)(mdepend + 1), s);
379479ab7f0SSascha Wildner 			free(s);
380479ab7f0SSascha Wildner 			file_addmetadata(fp, MODINFOMD_DEPLIST, minfolen,
381479ab7f0SSascha Wildner 			    mdepend);
382479ab7f0SSascha Wildner 			free(mdepend);
383479ab7f0SSascha Wildner 			break;
384479ab7f0SSascha Wildner 		case MDT_VERSION:
385479ab7f0SSascha Wildner 			s = strdupout((vm_offset_t)md.md_cval);
386479ab7f0SSascha Wildner 			COPYOUT((vm_offset_t)md.md_data, &mver, sizeof(mver));
387479ab7f0SSascha Wildner 			file_addmodule(fp, s, mver.mv_version, NULL);
388479ab7f0SSascha Wildner 			free(s);
389479ab7f0SSascha Wildner 			modcnt++;
390479ab7f0SSascha Wildner 			break;
391479ab7f0SSascha Wildner 		case MDT_MODULE:
392479ab7f0SSascha Wildner 			break;
393479ab7f0SSascha Wildner 		default:
394479ab7f0SSascha Wildner 			printf("unknown type %d\n", md.md_type);
395479ab7f0SSascha Wildner 			break;
396479ab7f0SSascha Wildner 		}
397479ab7f0SSascha Wildner 	}
398479ab7f0SSascha Wildner 	return 0;
399479ab7f0SSascha Wildner }
400479ab7f0SSascha Wildner 
401479ab7f0SSascha Wildner static int
__elfN(obj_lookup_set)402479ab7f0SSascha Wildner __elfN(obj_lookup_set)(struct preloaded_file *fp, elf_file_t ef,
403479ab7f0SSascha Wildner     const char* name, Elf_Addr *startp, Elf_Addr *stopp, int *countp)
404479ab7f0SSascha Wildner {
405479ab7f0SSascha Wildner 	Elf_Ehdr *hdr;
406479ab7f0SSascha Wildner 	Elf_Shdr *shdr;
407479ab7f0SSascha Wildner 	char *p;
408479ab7f0SSascha Wildner 	vm_offset_t shstrtab;
409479ab7f0SSascha Wildner 	int i;
410479ab7f0SSascha Wildner 
411479ab7f0SSascha Wildner 	hdr = &ef->hdr;
412479ab7f0SSascha Wildner 	shdr = ef->e_shdr;
413479ab7f0SSascha Wildner 	shstrtab = shdr[ef->shstrindex].sh_addr;
414479ab7f0SSascha Wildner 
415479ab7f0SSascha Wildner 	for (i = 0; i < hdr->e_shnum; i++) {
416479ab7f0SSascha Wildner 		if (shdr[i].sh_type != SHT_PROGBITS)
417479ab7f0SSascha Wildner 			continue;
418479ab7f0SSascha Wildner 		if (shdr[i].sh_name == 0)
419479ab7f0SSascha Wildner 			continue;
420479ab7f0SSascha Wildner 		p = strdupout(shstrtab + shdr[i].sh_name);
421479ab7f0SSascha Wildner 		if (strncmp(p, "set_", 4) == 0 && strcmp(p + 4, name) == 0) {
422479ab7f0SSascha Wildner 			*startp = shdr[i].sh_addr;
423479ab7f0SSascha Wildner 			*stopp = shdr[i].sh_addr +  shdr[i].sh_size;
424479ab7f0SSascha Wildner 			*countp = (*stopp - *startp) / sizeof(Elf_Addr);
425479ab7f0SSascha Wildner 			free(p);
426479ab7f0SSascha Wildner 			return (0);
427479ab7f0SSascha Wildner 		}
428479ab7f0SSascha Wildner 		free(p);
429479ab7f0SSascha Wildner 	}
430479ab7f0SSascha Wildner 
431479ab7f0SSascha Wildner 	return (ESRCH);
432479ab7f0SSascha Wildner }
433479ab7f0SSascha Wildner 
434479ab7f0SSascha Wildner /*
435479ab7f0SSascha Wildner  * Apply any intra-module relocations to the value. p is the load address
436479ab7f0SSascha Wildner  * of the value and val/len is the value to be modified. This does NOT modify
437479ab7f0SSascha Wildner  * the image in-place, because this is done by kern_linker later on.
438479ab7f0SSascha Wildner  */
439479ab7f0SSascha Wildner static int
__elfN(obj_reloc_ptr)440479ab7f0SSascha Wildner __elfN(obj_reloc_ptr)(struct preloaded_file *mp, elf_file_t ef, Elf_Addr p,
441479ab7f0SSascha Wildner     void *val, size_t len)
442479ab7f0SSascha Wildner {
443479ab7f0SSascha Wildner 	Elf_Ehdr *hdr;
444479ab7f0SSascha Wildner 	Elf_Shdr *shdr;
445479ab7f0SSascha Wildner 	Elf_Addr off = p;
446479ab7f0SSascha Wildner 	Elf_Addr base;
447479ab7f0SSascha Wildner 	Elf_Rela a, *abase;
448479ab7f0SSascha Wildner 	Elf_Rel r, *rbase;
449479ab7f0SSascha Wildner 	int error, i, j, nrel, nrela;
450479ab7f0SSascha Wildner 
451479ab7f0SSascha Wildner 	hdr = &ef->hdr;
452479ab7f0SSascha Wildner 	shdr = ef->e_shdr;
453479ab7f0SSascha Wildner 
454479ab7f0SSascha Wildner 	for (i = 0; i < hdr->e_shnum; i++) {
455479ab7f0SSascha Wildner 		if (shdr[i].sh_type != SHT_RELA && shdr[i].sh_type != SHT_REL)
456479ab7f0SSascha Wildner 			continue;
457479ab7f0SSascha Wildner 		base = shdr[shdr[i].sh_info].sh_addr;
458479ab7f0SSascha Wildner 		if (base == 0 || shdr[i].sh_addr == 0)
459479ab7f0SSascha Wildner 			continue;
460479ab7f0SSascha Wildner 		if (off < base || off + len > base +
461479ab7f0SSascha Wildner 		    shdr[shdr[i].sh_info].sh_size)
462479ab7f0SSascha Wildner 			continue;
463479ab7f0SSascha Wildner 
464479ab7f0SSascha Wildner 		switch (shdr[i].sh_type) {
465479ab7f0SSascha Wildner 		case SHT_RELA:
466479ab7f0SSascha Wildner 			abase = (Elf_Rela *)(intptr_t)shdr[i].sh_addr;
467479ab7f0SSascha Wildner 
468479ab7f0SSascha Wildner 			nrela = shdr[i].sh_size / sizeof(Elf_Rela);
469479ab7f0SSascha Wildner 			for (j = 0; j < nrela; j++) {
470479ab7f0SSascha Wildner 				COPYOUT(abase + j, &a, sizeof(a));
471479ab7f0SSascha Wildner 
472479ab7f0SSascha Wildner 				error = __elfN(reloc)(ef, __elfN(obj_symaddr),
473479ab7f0SSascha Wildner 				    &a, ELF_RELOC_RELA, base, off, val, len);
474479ab7f0SSascha Wildner 				if (error != 0)
475479ab7f0SSascha Wildner 					return (error);
476479ab7f0SSascha Wildner 			}
477479ab7f0SSascha Wildner 			break;
478479ab7f0SSascha Wildner 		case SHT_REL:
479479ab7f0SSascha Wildner 			rbase = (Elf_Rel *)(intptr_t)shdr[i].sh_addr;
480479ab7f0SSascha Wildner 
481479ab7f0SSascha Wildner 			nrel = shdr[i].sh_size / sizeof(Elf_Rel);
482479ab7f0SSascha Wildner 			for (j = 0; j < nrel; j++) {
483479ab7f0SSascha Wildner 				COPYOUT(rbase + j, &r, sizeof(r));
484479ab7f0SSascha Wildner 
485479ab7f0SSascha Wildner 				error = __elfN(reloc)(ef, __elfN(obj_symaddr),
486479ab7f0SSascha Wildner 				    &r, ELF_RELOC_REL, base, off, val, len);
487479ab7f0SSascha Wildner 				if (error != 0)
488479ab7f0SSascha Wildner 					return (error);
489479ab7f0SSascha Wildner 			}
490479ab7f0SSascha Wildner 			break;
491479ab7f0SSascha Wildner 		}
492479ab7f0SSascha Wildner 	}
493479ab7f0SSascha Wildner 	return (0);
494479ab7f0SSascha Wildner }
495479ab7f0SSascha Wildner 
496479ab7f0SSascha Wildner /* Look up the address of a specified symbol. */
497479ab7f0SSascha Wildner static Elf_Addr
__elfN(obj_symaddr)498479ab7f0SSascha Wildner __elfN(obj_symaddr)(struct elf_file *ef, Elf_Size symidx)
499479ab7f0SSascha Wildner {
500479ab7f0SSascha Wildner 	Elf_Sym sym;
501479ab7f0SSascha Wildner 	Elf_Addr base;
502479ab7f0SSascha Wildner 
503479ab7f0SSascha Wildner 	if (symidx >= ef->e_shdr[ef->symtabindex].sh_size / sizeof(Elf_Sym))
504479ab7f0SSascha Wildner 		return (0);
505479ab7f0SSascha Wildner 	COPYOUT(ef->e_shdr[ef->symtabindex].sh_addr + symidx * sizeof(Elf_Sym),
506479ab7f0SSascha Wildner 	    &sym, sizeof(sym));
507479ab7f0SSascha Wildner 	if (sym.st_shndx == SHN_UNDEF || sym.st_shndx >= ef->hdr.e_shnum)
508479ab7f0SSascha Wildner 		return (0);
509479ab7f0SSascha Wildner 	base = ef->e_shdr[sym.st_shndx].sh_addr;
510479ab7f0SSascha Wildner 	if (base == 0)
511479ab7f0SSascha Wildner 		return (0);
512479ab7f0SSascha Wildner 	return (base + sym.st_value);
513479ab7f0SSascha Wildner }
514