]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/kern/imgact_elf.c
Map PIE binaries at non-zero base address.
[FreeBSD/FreeBSD.git] / sys / kern / imgact_elf.c
1 /*-
2  * Copyright (c) 2000 David O'Brien
3  * Copyright (c) 1995-1996 Søren Schmidt
4  * Copyright (c) 1996 Peter Wemm
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer
12  *    in this position and unchanged.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  * 3. The name of the author may not be used to endorse or promote products
17  *    derived from this software without specific prior written permission
18  *
19  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
20  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
21  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
22  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
23  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
24  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
25  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
26  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
27  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
28  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29  */
30
31 #include <sys/cdefs.h>
32 __FBSDID("$FreeBSD$");
33
34 #include "opt_compat.h"
35
36 #include <sys/param.h>
37 #include <sys/exec.h>
38 #include <sys/fcntl.h>
39 #include <sys/imgact.h>
40 #include <sys/imgact_elf.h>
41 #include <sys/kernel.h>
42 #include <sys/lock.h>
43 #include <sys/malloc.h>
44 #include <sys/mount.h>
45 #include <sys/mutex.h>
46 #include <sys/mman.h>
47 #include <sys/namei.h>
48 #include <sys/pioctl.h>
49 #include <sys/proc.h>
50 #include <sys/procfs.h>
51 #include <sys/resourcevar.h>
52 #include <sys/sf_buf.h>
53 #include <sys/systm.h>
54 #include <sys/signalvar.h>
55 #include <sys/stat.h>
56 #include <sys/sx.h>
57 #include <sys/syscall.h>
58 #include <sys/sysctl.h>
59 #include <sys/sysent.h>
60 #include <sys/vnode.h>
61
62 #include <vm/vm.h>
63 #include <vm/vm_kern.h>
64 #include <vm/vm_param.h>
65 #include <vm/pmap.h>
66 #include <vm/vm_map.h>
67 #include <vm/vm_object.h>
68 #include <vm/vm_extern.h>
69
70 #include <machine/elf.h>
71 #include <machine/md_var.h>
72
73 #if defined(COMPAT_IA32) && __ELF_WORD_SIZE == 32
74 #include <machine/fpu.h>
75 #include <compat/ia32/ia32_reg.h>
76 #endif
77
78 #define OLD_EI_BRAND    8
79
80 static int __elfN(check_header)(const Elf_Ehdr *hdr);
81 static Elf_Brandinfo *__elfN(get_brandinfo)(struct image_params *imgp,
82     const char *interp, int32_t *osrel);
83 static int __elfN(load_file)(struct proc *p, const char *file, u_long *addr,
84     u_long *entry, size_t pagesize);
85 static int __elfN(load_section)(struct vmspace *vmspace, vm_object_t object,
86     vm_offset_t offset, caddr_t vmaddr, size_t memsz, size_t filsz,
87     vm_prot_t prot, size_t pagesize);
88 static int __CONCAT(exec_, __elfN(imgact))(struct image_params *imgp);
89 static boolean_t __elfN(freebsd_trans_osrel)(const Elf_Note *note,
90     int32_t *osrel);
91 static boolean_t kfreebsd_trans_osrel(const Elf_Note *note, int32_t *osrel);
92 static boolean_t __elfN(check_note)(struct image_params *imgp,
93     Elf_Brandnote *checknote, int32_t *osrel);
94
95 SYSCTL_NODE(_kern, OID_AUTO, __CONCAT(elf, __ELF_WORD_SIZE), CTLFLAG_RW, 0,
96     "");
97
98 int __elfN(fallback_brand) = -1;
99 SYSCTL_INT(__CONCAT(_kern_elf, __ELF_WORD_SIZE), OID_AUTO,
100     fallback_brand, CTLFLAG_RW, &__elfN(fallback_brand), 0,
101     __XSTRING(__CONCAT(ELF, __ELF_WORD_SIZE)) " brand of last resort");
102 TUNABLE_INT("kern.elf" __XSTRING(__ELF_WORD_SIZE) ".fallback_brand",
103     &__elfN(fallback_brand));
104
105 static int elf_legacy_coredump = 0;
106 SYSCTL_INT(_debug, OID_AUTO, __elfN(legacy_coredump), CTLFLAG_RW, 
107     &elf_legacy_coredump, 0, "");
108
109 static Elf_Brandinfo *elf_brand_list[MAX_BRANDS];
110
111 #define trunc_page_ps(va, ps)   ((va) & ~(ps - 1))
112 #define round_page_ps(va, ps)   (((va) + (ps - 1)) & ~(ps - 1))
113 #define aligned(a, t)   (trunc_page_ps((u_long)(a), sizeof(t)) == (u_long)(a))
114
115 static const char FREEBSD_ABI_VENDOR[] = "FreeBSD";
116
117 Elf_Brandnote __elfN(freebsd_brandnote) = {
118         .hdr.n_namesz   = sizeof(FREEBSD_ABI_VENDOR),
119         .hdr.n_descsz   = sizeof(int32_t),
120         .hdr.n_type     = 1,
121         .vendor         = FREEBSD_ABI_VENDOR,
122         .flags          = BN_TRANSLATE_OSREL,
123         .trans_osrel    = __elfN(freebsd_trans_osrel)
124 };
125
126 static boolean_t
127 __elfN(freebsd_trans_osrel)(const Elf_Note *note, int32_t *osrel)
128 {
129         uintptr_t p;
130
131         p = (uintptr_t)(note + 1);
132         p += roundup2(note->n_namesz, sizeof(Elf32_Addr));
133         *osrel = *(const int32_t *)(p);
134
135         return (TRUE);
136 }
137
138 static const char GNU_ABI_VENDOR[] = "GNU";
139 static int GNU_KFREEBSD_ABI_DESC = 3;
140
141 Elf_Brandnote __elfN(kfreebsd_brandnote) = {
142         .hdr.n_namesz   = sizeof(GNU_ABI_VENDOR),
143         .hdr.n_descsz   = 16,   /* XXX at least 16 */
144         .hdr.n_type     = 1,
145         .vendor         = GNU_ABI_VENDOR,
146         .flags          = BN_TRANSLATE_OSREL,
147         .trans_osrel    = kfreebsd_trans_osrel
148 };
149
150 static boolean_t
151 kfreebsd_trans_osrel(const Elf_Note *note, int32_t *osrel)
152 {
153         const Elf32_Word *desc;
154         uintptr_t p;
155
156         p = (uintptr_t)(note + 1);
157         p += roundup2(note->n_namesz, sizeof(Elf32_Addr));
158
159         desc = (const Elf32_Word *)p;
160         if (desc[0] != GNU_KFREEBSD_ABI_DESC)
161                 return (FALSE);
162
163         /*
164          * Debian GNU/kFreeBSD embed the earliest compatible kernel version
165          * (__FreeBSD_version: <major><two digit minor>Rxx) in the LSB way.
166          */
167         *osrel = desc[1] * 100000 + desc[2] * 1000 + desc[3];
168
169         return (TRUE);
170 }
171
172 int
173 __elfN(insert_brand_entry)(Elf_Brandinfo *entry)
174 {
175         int i;
176
177         for (i = 0; i < MAX_BRANDS; i++) {
178                 if (elf_brand_list[i] == NULL) {
179                         elf_brand_list[i] = entry;
180                         break;
181                 }
182         }
183         if (i == MAX_BRANDS) {
184                 printf("WARNING: %s: could not insert brandinfo entry: %p\n",
185                         __func__, entry);
186                 return (-1);
187         }
188         return (0);
189 }
190
191 int
192 __elfN(remove_brand_entry)(Elf_Brandinfo *entry)
193 {
194         int i;
195
196         for (i = 0; i < MAX_BRANDS; i++) {
197                 if (elf_brand_list[i] == entry) {
198                         elf_brand_list[i] = NULL;
199                         break;
200                 }
201         }
202         if (i == MAX_BRANDS)
203                 return (-1);
204         return (0);
205 }
206
207 int
208 __elfN(brand_inuse)(Elf_Brandinfo *entry)
209 {
210         struct proc *p;
211         int rval = FALSE;
212
213         sx_slock(&allproc_lock);
214         FOREACH_PROC_IN_SYSTEM(p) {
215                 if (p->p_sysent == entry->sysvec) {
216                         rval = TRUE;
217                         break;
218                 }
219         }
220         sx_sunlock(&allproc_lock);
221
222         return (rval);
223 }
224
225 static Elf_Brandinfo *
226 __elfN(get_brandinfo)(struct image_params *imgp, const char *interp,
227     int32_t *osrel)
228 {
229         const Elf_Ehdr *hdr = (const Elf_Ehdr *)imgp->image_header;
230         Elf_Brandinfo *bi;
231         boolean_t ret;
232         int i;
233
234         /*
235          * We support four types of branding -- (1) the ELF EI_OSABI field
236          * that SCO added to the ELF spec, (2) FreeBSD 3.x's traditional string
237          * branding w/in the ELF header, (3) path of the `interp_path'
238          * field, and (4) the ".note.ABI-tag" ELF section.
239          */
240
241         /* Look for an ".note.ABI-tag" ELF section */
242         for (i = 0; i < MAX_BRANDS; i++) {
243                 bi = elf_brand_list[i];
244                 if (bi == NULL)
245                         continue;
246                 if (hdr->e_machine == bi->machine && (bi->flags &
247                     (BI_BRAND_NOTE|BI_BRAND_NOTE_MANDATORY)) != 0) {
248                         ret = __elfN(check_note)(imgp, bi->brand_note, osrel);
249                         if (ret)
250                                 return (bi);
251                 }
252         }
253
254         /* If the executable has a brand, search for it in the brand list. */
255         for (i = 0; i < MAX_BRANDS; i++) {
256                 bi = elf_brand_list[i];
257                 if (bi == NULL || bi->flags & BI_BRAND_NOTE_MANDATORY)
258                         continue;
259                 if (hdr->e_machine == bi->machine &&
260                     (hdr->e_ident[EI_OSABI] == bi->brand ||
261                     strncmp((const char *)&hdr->e_ident[OLD_EI_BRAND],
262                     bi->compat_3_brand, strlen(bi->compat_3_brand)) == 0))
263                         return (bi);
264         }
265
266         /* Lacking a known brand, search for a recognized interpreter. */
267         if (interp != NULL) {
268                 for (i = 0; i < MAX_BRANDS; i++) {
269                         bi = elf_brand_list[i];
270                         if (bi == NULL || bi->flags & BI_BRAND_NOTE_MANDATORY)
271                                 continue;
272                         if (hdr->e_machine == bi->machine &&
273                             strcmp(interp, bi->interp_path) == 0)
274                                 return (bi);
275                 }
276         }
277
278         /* Lacking a recognized interpreter, try the default brand */
279         for (i = 0; i < MAX_BRANDS; i++) {
280                 bi = elf_brand_list[i];
281                 if (bi == NULL || bi->flags & BI_BRAND_NOTE_MANDATORY)
282                         continue;
283                 if (hdr->e_machine == bi->machine &&
284                     __elfN(fallback_brand) == bi->brand)
285                         return (bi);
286         }
287         return (NULL);
288 }
289
290 static int
291 __elfN(check_header)(const Elf_Ehdr *hdr)
292 {
293         Elf_Brandinfo *bi;
294         int i;
295
296         if (!IS_ELF(*hdr) ||
297             hdr->e_ident[EI_CLASS] != ELF_TARG_CLASS ||
298             hdr->e_ident[EI_DATA] != ELF_TARG_DATA ||
299             hdr->e_ident[EI_VERSION] != EV_CURRENT ||
300             hdr->e_phentsize != sizeof(Elf_Phdr) ||
301             hdr->e_version != ELF_TARG_VER)
302                 return (ENOEXEC);
303
304         /*
305          * Make sure we have at least one brand for this machine.
306          */
307
308         for (i = 0; i < MAX_BRANDS; i++) {
309                 bi = elf_brand_list[i];
310                 if (bi != NULL && bi->machine == hdr->e_machine)
311                         break;
312         }
313         if (i == MAX_BRANDS)
314                 return (ENOEXEC);
315
316         return (0);
317 }
318
319 static int
320 __elfN(map_partial)(vm_map_t map, vm_object_t object, vm_ooffset_t offset,
321     vm_offset_t start, vm_offset_t end, vm_prot_t prot)
322 {
323         struct sf_buf *sf;
324         int error;
325         vm_offset_t off;
326
327         /*
328          * Create the page if it doesn't exist yet. Ignore errors.
329          */
330         vm_map_lock(map);
331         vm_map_insert(map, NULL, 0, trunc_page(start), round_page(end),
332             VM_PROT_ALL, VM_PROT_ALL, 0);
333         vm_map_unlock(map);
334
335         /*
336          * Find the page from the underlying object.
337          */
338         if (object) {
339                 sf = vm_imgact_map_page(object, offset);
340                 if (sf == NULL)
341                         return (KERN_FAILURE);
342                 off = offset - trunc_page(offset);
343                 error = copyout((caddr_t)sf_buf_kva(sf) + off, (caddr_t)start,
344                     end - start);
345                 vm_imgact_unmap_page(sf);
346                 if (error) {
347                         return (KERN_FAILURE);
348                 }
349         }
350
351         return (KERN_SUCCESS);
352 }
353
354 static int
355 __elfN(map_insert)(vm_map_t map, vm_object_t object, vm_ooffset_t offset,
356     vm_offset_t start, vm_offset_t end, vm_prot_t prot, int cow)
357 {
358         struct sf_buf *sf;
359         vm_offset_t off;
360         vm_size_t sz;
361         int error, rv;
362
363         if (start != trunc_page(start)) {
364                 rv = __elfN(map_partial)(map, object, offset, start,
365                     round_page(start), prot);
366                 if (rv)
367                         return (rv);
368                 offset += round_page(start) - start;
369                 start = round_page(start);
370         }
371         if (end != round_page(end)) {
372                 rv = __elfN(map_partial)(map, object, offset +
373                     trunc_page(end) - start, trunc_page(end), end, prot);
374                 if (rv)
375                         return (rv);
376                 end = trunc_page(end);
377         }
378         if (end > start) {
379                 if (offset & PAGE_MASK) {
380                         /*
381                          * The mapping is not page aligned. This means we have
382                          * to copy the data. Sigh.
383                          */
384                         rv = vm_map_find(map, NULL, 0, &start, end - start,
385                             FALSE, prot | VM_PROT_WRITE, VM_PROT_ALL, 0);
386                         if (rv)
387                                 return (rv);
388                         if (object == NULL)
389                                 return (KERN_SUCCESS);
390                         for (; start < end; start += sz) {
391                                 sf = vm_imgact_map_page(object, offset);
392                                 if (sf == NULL)
393                                         return (KERN_FAILURE);
394                                 off = offset - trunc_page(offset);
395                                 sz = end - start;
396                                 if (sz > PAGE_SIZE - off)
397                                         sz = PAGE_SIZE - off;
398                                 error = copyout((caddr_t)sf_buf_kva(sf) + off,
399                                     (caddr_t)start, sz);
400                                 vm_imgact_unmap_page(sf);
401                                 if (error) {
402                                         return (KERN_FAILURE);
403                                 }
404                                 offset += sz;
405                         }
406                         rv = KERN_SUCCESS;
407                 } else {
408                         vm_object_reference(object);
409                         vm_map_lock(map);
410                         rv = vm_map_insert(map, object, offset, start, end,
411                             prot, VM_PROT_ALL, cow);
412                         vm_map_unlock(map);
413                         if (rv != KERN_SUCCESS)
414                                 vm_object_deallocate(object);
415                 }
416                 return (rv);
417         } else {
418                 return (KERN_SUCCESS);
419         }
420 }
421
422 static int
423 __elfN(load_section)(struct vmspace *vmspace,
424         vm_object_t object, vm_offset_t offset,
425         caddr_t vmaddr, size_t memsz, size_t filsz, vm_prot_t prot,
426         size_t pagesize)
427 {
428         struct sf_buf *sf;
429         size_t map_len;
430         vm_offset_t map_addr;
431         int error, rv, cow;
432         size_t copy_len;
433         vm_offset_t file_addr;
434
435         /*
436          * It's necessary to fail if the filsz + offset taken from the
437          * header is greater than the actual file pager object's size.
438          * If we were to allow this, then the vm_map_find() below would
439          * walk right off the end of the file object and into the ether.
440          *
441          * While I'm here, might as well check for something else that
442          * is invalid: filsz cannot be greater than memsz.
443          */
444         if ((off_t)filsz + offset > object->un_pager.vnp.vnp_size ||
445             filsz > memsz) {
446                 uprintf("elf_load_section: truncated ELF file\n");
447                 return (ENOEXEC);
448         }
449
450         map_addr = trunc_page_ps((vm_offset_t)vmaddr, pagesize);
451         file_addr = trunc_page_ps(offset, pagesize);
452
453         /*
454          * We have two choices.  We can either clear the data in the last page
455          * of an oversized mapping, or we can start the anon mapping a page
456          * early and copy the initialized data into that first page.  We
457          * choose the second..
458          */
459         if (memsz > filsz)
460                 map_len = trunc_page_ps(offset + filsz, pagesize) - file_addr;
461         else
462                 map_len = round_page_ps(offset + filsz, pagesize) - file_addr;
463
464         if (map_len != 0) {
465                 /* cow flags: don't dump readonly sections in core */
466                 cow = MAP_COPY_ON_WRITE | MAP_PREFAULT |
467                     (prot & VM_PROT_WRITE ? 0 : MAP_DISABLE_COREDUMP);
468
469                 rv = __elfN(map_insert)(&vmspace->vm_map,
470                                       object,
471                                       file_addr,        /* file offset */
472                                       map_addr,         /* virtual start */
473                                       map_addr + map_len,/* virtual end */
474                                       prot,
475                                       cow);
476                 if (rv != KERN_SUCCESS)
477                         return (EINVAL);
478
479                 /* we can stop now if we've covered it all */
480                 if (memsz == filsz) {
481                         return (0);
482                 }
483         }
484
485
486         /*
487          * We have to get the remaining bit of the file into the first part
488          * of the oversized map segment.  This is normally because the .data
489          * segment in the file is extended to provide bss.  It's a neat idea
490          * to try and save a page, but it's a pain in the behind to implement.
491          */
492         copy_len = (offset + filsz) - trunc_page_ps(offset + filsz, pagesize);
493         map_addr = trunc_page_ps((vm_offset_t)vmaddr + filsz, pagesize);
494         map_len = round_page_ps((vm_offset_t)vmaddr + memsz, pagesize) -
495             map_addr;
496
497         /* This had damn well better be true! */
498         if (map_len != 0) {
499                 rv = __elfN(map_insert)(&vmspace->vm_map, NULL, 0, map_addr,
500                     map_addr + map_len, VM_PROT_ALL, 0);
501                 if (rv != KERN_SUCCESS) {
502                         return (EINVAL);
503                 }
504         }
505
506         if (copy_len != 0) {
507                 vm_offset_t off;
508
509                 sf = vm_imgact_map_page(object, offset + filsz);
510                 if (sf == NULL)
511                         return (EIO);
512
513                 /* send the page fragment to user space */
514                 off = trunc_page_ps(offset + filsz, pagesize) -
515                     trunc_page(offset + filsz);
516                 error = copyout((caddr_t)sf_buf_kva(sf) + off,
517                     (caddr_t)map_addr, copy_len);
518                 vm_imgact_unmap_page(sf);
519                 if (error) {
520                         return (error);
521                 }
522         }
523
524         /*
525          * set it to the specified protection.
526          * XXX had better undo the damage from pasting over the cracks here!
527          */
528         vm_map_protect(&vmspace->vm_map, trunc_page(map_addr),
529             round_page(map_addr + map_len),  prot, FALSE);
530
531         return (0);
532 }
533
534 /*
535  * Load the file "file" into memory.  It may be either a shared object
536  * or an executable.
537  *
538  * The "addr" reference parameter is in/out.  On entry, it specifies
539  * the address where a shared object should be loaded.  If the file is
540  * an executable, this value is ignored.  On exit, "addr" specifies
541  * where the file was actually loaded.
542  *
543  * The "entry" reference parameter is out only.  On exit, it specifies
544  * the entry point for the loaded file.
545  */
546 static int
547 __elfN(load_file)(struct proc *p, const char *file, u_long *addr,
548         u_long *entry, size_t pagesize)
549 {
550         struct {
551                 struct nameidata nd;
552                 struct vattr attr;
553                 struct image_params image_params;
554         } *tempdata;
555         const Elf_Ehdr *hdr = NULL;
556         const Elf_Phdr *phdr = NULL;
557         struct nameidata *nd;
558         struct vmspace *vmspace = p->p_vmspace;
559         struct vattr *attr;
560         struct image_params *imgp;
561         vm_prot_t prot;
562         u_long rbase;
563         u_long base_addr = 0;
564         int vfslocked, error, i, numsegs;
565
566         tempdata = malloc(sizeof(*tempdata), M_TEMP, M_WAITOK);
567         nd = &tempdata->nd;
568         attr = &tempdata->attr;
569         imgp = &tempdata->image_params;
570
571         /*
572          * Initialize part of the common data
573          */
574         imgp->proc = p;
575         imgp->attr = attr;
576         imgp->firstpage = NULL;
577         imgp->image_header = NULL;
578         imgp->object = NULL;
579         imgp->execlabel = NULL;
580
581         NDINIT(nd, LOOKUP, MPSAFE|LOCKLEAF|FOLLOW, UIO_SYSSPACE, file,
582             curthread);
583         vfslocked = 0;
584         if ((error = namei(nd)) != 0) {
585                 nd->ni_vp = NULL;
586                 goto fail;
587         }
588         vfslocked = NDHASGIANT(nd);
589         NDFREE(nd, NDF_ONLY_PNBUF);
590         imgp->vp = nd->ni_vp;
591
592         /*
593          * Check permissions, modes, uid, etc on the file, and "open" it.
594          */
595         error = exec_check_permissions(imgp);
596         if (error)
597                 goto fail;
598
599         error = exec_map_first_page(imgp);
600         if (error)
601                 goto fail;
602
603         /*
604          * Also make certain that the interpreter stays the same, so set
605          * its VV_TEXT flag, too.
606          */
607         nd->ni_vp->v_vflag |= VV_TEXT;
608
609         imgp->object = nd->ni_vp->v_object;
610
611         hdr = (const Elf_Ehdr *)imgp->image_header;
612         if ((error = __elfN(check_header)(hdr)) != 0)
613                 goto fail;
614         if (hdr->e_type == ET_DYN)
615                 rbase = *addr;
616         else if (hdr->e_type == ET_EXEC)
617                 rbase = 0;
618         else {
619                 error = ENOEXEC;
620                 goto fail;
621         }
622
623         /* Only support headers that fit within first page for now      */
624         /*    (multiplication of two Elf_Half fields will not overflow) */
625         if ((hdr->e_phoff > PAGE_SIZE) ||
626             (hdr->e_phentsize * hdr->e_phnum) > PAGE_SIZE - hdr->e_phoff) {
627                 error = ENOEXEC;
628                 goto fail;
629         }
630
631         phdr = (const Elf_Phdr *)(imgp->image_header + hdr->e_phoff);
632         if (!aligned(phdr, Elf_Addr)) {
633                 error = ENOEXEC;
634                 goto fail;
635         }
636
637         for (i = 0, numsegs = 0; i < hdr->e_phnum; i++) {
638                 if (phdr[i].p_type == PT_LOAD && phdr[i].p_memsz != 0) {
639                         /* Loadable segment */
640                         prot = 0;
641                         if (phdr[i].p_flags & PF_X)
642                                 prot |= VM_PROT_EXECUTE;
643                         if (phdr[i].p_flags & PF_W)
644                                 prot |= VM_PROT_WRITE;
645                         if (phdr[i].p_flags & PF_R)
646                                 prot |= VM_PROT_READ;
647
648                         if ((error = __elfN(load_section)(vmspace,
649                             imgp->object, phdr[i].p_offset,
650                             (caddr_t)(uintptr_t)phdr[i].p_vaddr + rbase,
651                             phdr[i].p_memsz, phdr[i].p_filesz, prot,
652                             pagesize)) != 0)
653                                 goto fail;
654                         /*
655                          * Establish the base address if this is the
656                          * first segment.
657                          */
658                         if (numsegs == 0)
659                                 base_addr = trunc_page(phdr[i].p_vaddr +
660                                     rbase);
661                         numsegs++;
662                 }
663         }
664         *addr = base_addr;
665         *entry = (unsigned long)hdr->e_entry + rbase;
666
667 fail:
668         if (imgp->firstpage)
669                 exec_unmap_first_page(imgp);
670
671         if (nd->ni_vp)
672                 vput(nd->ni_vp);
673
674         VFS_UNLOCK_GIANT(vfslocked);
675         free(tempdata, M_TEMP);
676
677         return (error);
678 }
679
680 static int
681 __CONCAT(exec_, __elfN(imgact))(struct image_params *imgp)
682 {
683         const Elf_Ehdr *hdr = (const Elf_Ehdr *)imgp->image_header;
684         const Elf_Phdr *phdr;
685         Elf_Auxargs *elf_auxargs;
686         struct vmspace *vmspace;
687         vm_prot_t prot;
688         u_long text_size = 0, data_size = 0, total_size = 0;
689         u_long text_addr = 0, data_addr = 0;
690         u_long seg_size, seg_addr;
691         u_long addr, et_dyn_addr, entry = 0, proghdr = 0;
692         int32_t osrel = 0;
693         int error = 0, i;
694         const char *interp = NULL, *newinterp = NULL;
695         Elf_Brandinfo *brand_info;
696         char *path;
697         struct sysentvec *sv;
698
699         /*
700          * Do we have a valid ELF header ?
701          *
702          * Only allow ET_EXEC & ET_DYN here, reject ET_DYN later
703          * if particular brand doesn't support it.
704          */
705         if (__elfN(check_header)(hdr) != 0 ||
706             (hdr->e_type != ET_EXEC && hdr->e_type != ET_DYN))
707                 return (-1);
708
709         /*
710          * From here on down, we return an errno, not -1, as we've
711          * detected an ELF file.
712          */
713
714         if ((hdr->e_phoff > PAGE_SIZE) ||
715             (hdr->e_phoff + hdr->e_phentsize * hdr->e_phnum) > PAGE_SIZE) {
716                 /* Only support headers in first page for now */
717                 return (ENOEXEC);
718         }
719         phdr = (const Elf_Phdr *)(imgp->image_header + hdr->e_phoff);
720         if (!aligned(phdr, Elf_Addr))
721                 return (ENOEXEC);
722         for (i = 0; i < hdr->e_phnum; i++) {
723                 if (phdr[i].p_type == PT_INTERP) {
724                         /* Path to interpreter */
725                         if (phdr[i].p_filesz > MAXPATHLEN ||
726                             phdr[i].p_offset + phdr[i].p_filesz > PAGE_SIZE)
727                                 return (ENOEXEC);
728                         interp = imgp->image_header + phdr[i].p_offset;
729                         break;
730                 }
731         }
732
733         brand_info = __elfN(get_brandinfo)(imgp, interp, &osrel);
734         if (brand_info == NULL) {
735                 uprintf("ELF binary type \"%u\" not known.\n",
736                     hdr->e_ident[EI_OSABI]);
737                 return (ENOEXEC);
738         }
739         if (hdr->e_type == ET_DYN) {
740                 if ((brand_info->flags & BI_CAN_EXEC_DYN) == 0)
741                         return (ENOEXEC);
742                 et_dyn_addr = ET_DYN_LOAD_ADDR;
743         } else
744                 et_dyn_addr = 0;
745         sv = brand_info->sysvec;
746         if (interp != NULL && brand_info->interp_newpath != NULL)
747                 newinterp = brand_info->interp_newpath;
748
749         /*
750          * Avoid a possible deadlock if the current address space is destroyed
751          * and that address space maps the locked vnode.  In the common case,
752          * the locked vnode's v_usecount is decremented but remains greater
753          * than zero.  Consequently, the vnode lock is not needed by vrele().
754          * However, in cases where the vnode lock is external, such as nullfs,
755          * v_usecount may become zero.
756          */
757         VOP_UNLOCK(imgp->vp, 0);
758
759         error = exec_new_vmspace(imgp, sv);
760         imgp->proc->p_sysent = sv;
761
762         vn_lock(imgp->vp, LK_EXCLUSIVE | LK_RETRY);
763         if (error)
764                 return (error);
765
766         vmspace = imgp->proc->p_vmspace;
767
768         for (i = 0; i < hdr->e_phnum; i++) {
769                 switch (phdr[i].p_type) {
770                 case PT_LOAD:   /* Loadable segment */
771                         if (phdr[i].p_memsz == 0)
772                                 break;
773                         prot = 0;
774                         if (phdr[i].p_flags & PF_X)
775                                 prot |= VM_PROT_EXECUTE;
776                         if (phdr[i].p_flags & PF_W)
777                                 prot |= VM_PROT_WRITE;
778                         if (phdr[i].p_flags & PF_R)
779                                 prot |= VM_PROT_READ;
780
781 #if defined(__ia64__) && __ELF_WORD_SIZE == 32 && defined(IA32_ME_HARDER)
782                         /*
783                          * Some x86 binaries assume read == executable,
784                          * notably the M3 runtime and therefore cvsup
785                          */
786                         if (prot & VM_PROT_READ)
787                                 prot |= VM_PROT_EXECUTE;
788 #endif
789
790                         if ((error = __elfN(load_section)(vmspace,
791                             imgp->object, phdr[i].p_offset,
792                             (caddr_t)(uintptr_t)phdr[i].p_vaddr + et_dyn_addr,
793                             phdr[i].p_memsz, phdr[i].p_filesz, prot,
794                             sv->sv_pagesize)) != 0)
795                                 return (error);
796
797                         /*
798                          * If this segment contains the program headers,
799                          * remember their virtual address for the AT_PHDR
800                          * aux entry. Static binaries don't usually include
801                          * a PT_PHDR entry.
802                          */
803                         if (phdr[i].p_offset == 0 &&
804                             hdr->e_phoff + hdr->e_phnum * hdr->e_phentsize
805                                 <= phdr[i].p_filesz)
806                                 proghdr = phdr[i].p_vaddr + hdr->e_phoff +
807                                     et_dyn_addr;
808
809                         seg_addr = trunc_page(phdr[i].p_vaddr + et_dyn_addr);
810                         seg_size = round_page(phdr[i].p_memsz +
811                             phdr[i].p_vaddr + et_dyn_addr - seg_addr);
812
813                         /*
814                          * Is this .text or .data?  We can't use
815                          * VM_PROT_WRITE or VM_PROT_EXEC, it breaks the
816                          * alpha terribly and possibly does other bad
817                          * things so we stick to the old way of figuring
818                          * it out:  If the segment contains the program
819                          * entry point, it's a text segment, otherwise it
820                          * is a data segment.
821                          *
822                          * Note that obreak() assumes that data_addr + 
823                          * data_size == end of data load area, and the ELF
824                          * file format expects segments to be sorted by
825                          * address.  If multiple data segments exist, the
826                          * last one will be used.
827                          */
828                         if (hdr->e_entry >= phdr[i].p_vaddr &&
829                             hdr->e_entry < (phdr[i].p_vaddr +
830                             phdr[i].p_memsz)) {
831                                 text_size = seg_size;
832                                 text_addr = seg_addr;
833                                 entry = (u_long)hdr->e_entry + et_dyn_addr;
834                         } else {
835                                 data_size = seg_size;
836                                 data_addr = seg_addr;
837                         }
838                         total_size += seg_size;
839                         break;
840                 case PT_PHDR:   /* Program header table info */
841                         proghdr = phdr[i].p_vaddr + et_dyn_addr;
842                         break;
843                 default:
844                         break;
845                 }
846         }
847         
848         if (data_addr == 0 && data_size == 0) {
849                 data_addr = text_addr;
850                 data_size = text_size;
851         }
852
853         /*
854          * Check limits.  It should be safe to check the
855          * limits after loading the segments since we do
856          * not actually fault in all the segments pages.
857          */
858         PROC_LOCK(imgp->proc);
859         if (data_size > lim_cur(imgp->proc, RLIMIT_DATA) ||
860             text_size > maxtsiz ||
861             total_size > lim_cur(imgp->proc, RLIMIT_VMEM)) {
862                 PROC_UNLOCK(imgp->proc);
863                 return (ENOMEM);
864         }
865
866         vmspace->vm_tsize = text_size >> PAGE_SHIFT;
867         vmspace->vm_taddr = (caddr_t)(uintptr_t)text_addr;
868         vmspace->vm_dsize = data_size >> PAGE_SHIFT;
869         vmspace->vm_daddr = (caddr_t)(uintptr_t)data_addr;
870
871         /*
872          * We load the dynamic linker where a userland call
873          * to mmap(0, ...) would put it.  The rationale behind this
874          * calculation is that it leaves room for the heap to grow to
875          * its maximum allowed size.
876          */
877         addr = round_page((vm_offset_t)imgp->proc->p_vmspace->vm_daddr +
878             lim_max(imgp->proc, RLIMIT_DATA));
879         PROC_UNLOCK(imgp->proc);
880
881         imgp->entry_addr = entry;
882
883         if (interp != NULL) {
884                 int have_interp = FALSE;
885                 VOP_UNLOCK(imgp->vp, 0);
886                 if (brand_info->emul_path != NULL &&
887                     brand_info->emul_path[0] != '\0') {
888                         path = malloc(MAXPATHLEN, M_TEMP, M_WAITOK);
889                         snprintf(path, MAXPATHLEN, "%s%s",
890                             brand_info->emul_path, interp);
891                         error = __elfN(load_file)(imgp->proc, path, &addr,
892                             &imgp->entry_addr, sv->sv_pagesize);
893                         free(path, M_TEMP);
894                         if (error == 0)
895                                 have_interp = TRUE;
896                 }
897                 if (!have_interp && newinterp != NULL) {
898                         error = __elfN(load_file)(imgp->proc, newinterp, &addr,
899                             &imgp->entry_addr, sv->sv_pagesize);
900                         if (error == 0)
901                                 have_interp = TRUE;
902                 }
903                 if (!have_interp) {
904                         error = __elfN(load_file)(imgp->proc, interp, &addr,
905                             &imgp->entry_addr, sv->sv_pagesize);
906                 }
907                 vn_lock(imgp->vp, LK_EXCLUSIVE | LK_RETRY);
908                 if (error != 0) {
909                         uprintf("ELF interpreter %s not found\n", interp);
910                         return (error);
911                 }
912         } else
913                 addr = 0;
914
915         /*
916          * Construct auxargs table (used by the fixup routine)
917          */
918         elf_auxargs = malloc(sizeof(Elf_Auxargs), M_TEMP, M_WAITOK);
919         elf_auxargs->execfd = -1;
920         elf_auxargs->phdr = proghdr;
921         elf_auxargs->phent = hdr->e_phentsize;
922         elf_auxargs->phnum = hdr->e_phnum;
923         elf_auxargs->pagesz = PAGE_SIZE;
924         elf_auxargs->base = addr;
925         elf_auxargs->flags = 0;
926         elf_auxargs->entry = entry;
927
928         imgp->auxargs = elf_auxargs;
929         imgp->interpreted = 0;
930         imgp->proc->p_osrel = osrel;
931
932         return (error);
933 }
934
935 #define suword __CONCAT(suword, __ELF_WORD_SIZE)
936
937 int
938 __elfN(freebsd_fixup)(register_t **stack_base, struct image_params *imgp)
939 {
940         Elf_Auxargs *args = (Elf_Auxargs *)imgp->auxargs;
941         Elf_Addr *base;
942         Elf_Addr *pos;
943
944         base = (Elf_Addr *)*stack_base;
945         pos = base + (imgp->args->argc + imgp->args->envc + 2);
946
947         if (args->execfd != -1)
948                 AUXARGS_ENTRY(pos, AT_EXECFD, args->execfd);
949         AUXARGS_ENTRY(pos, AT_PHDR, args->phdr);
950         AUXARGS_ENTRY(pos, AT_PHENT, args->phent);
951         AUXARGS_ENTRY(pos, AT_PHNUM, args->phnum);
952         AUXARGS_ENTRY(pos, AT_PAGESZ, args->pagesz);
953         AUXARGS_ENTRY(pos, AT_FLAGS, args->flags);
954         AUXARGS_ENTRY(pos, AT_ENTRY, args->entry);
955         AUXARGS_ENTRY(pos, AT_BASE, args->base);
956         if (imgp->execpathp != 0)
957                 AUXARGS_ENTRY(pos, AT_EXECPATH, imgp->execpathp);
958         AUXARGS_ENTRY(pos, AT_NULL, 0);
959
960         free(imgp->auxargs, M_TEMP);
961         imgp->auxargs = NULL;
962
963         base--;
964         suword(base, (long)imgp->args->argc);
965         *stack_base = (register_t *)base;
966         return (0);
967 }
968
969 /*
970  * Code for generating ELF core dumps.
971  */
972
973 typedef void (*segment_callback)(vm_map_entry_t, void *);
974
975 /* Closure for cb_put_phdr(). */
976 struct phdr_closure {
977         Elf_Phdr *phdr;         /* Program header to fill in */
978         Elf_Off offset;         /* Offset of segment in core file */
979 };
980
981 /* Closure for cb_size_segment(). */
982 struct sseg_closure {
983         int count;              /* Count of writable segments. */
984         size_t size;            /* Total size of all writable segments. */
985 };
986
987 static void cb_put_phdr(vm_map_entry_t, void *);
988 static void cb_size_segment(vm_map_entry_t, void *);
989 static void each_writable_segment(struct thread *, segment_callback, void *);
990 static int __elfN(corehdr)(struct thread *, struct vnode *, struct ucred *,
991     int, void *, size_t);
992 static void __elfN(puthdr)(struct thread *, void *, size_t *, int);
993 static void __elfN(putnote)(void *, size_t *, const char *, int,
994     const void *, size_t);
995
996 int
997 __elfN(coredump)(td, vp, limit)
998         struct thread *td;
999         struct vnode *vp;
1000         off_t limit;
1001 {
1002         struct ucred *cred = td->td_ucred;
1003         int error = 0;
1004         struct sseg_closure seginfo;
1005         void *hdr;
1006         size_t hdrsize;
1007
1008         /* Size the program segments. */
1009         seginfo.count = 0;
1010         seginfo.size = 0;
1011         each_writable_segment(td, cb_size_segment, &seginfo);
1012
1013         /*
1014          * Calculate the size of the core file header area by making
1015          * a dry run of generating it.  Nothing is written, but the
1016          * size is calculated.
1017          */
1018         hdrsize = 0;
1019         __elfN(puthdr)(td, (void *)NULL, &hdrsize, seginfo.count);
1020
1021         if (hdrsize + seginfo.size >= limit)
1022                 return (EFAULT);
1023
1024         /*
1025          * Allocate memory for building the header, fill it up,
1026          * and write it out.
1027          */
1028         hdr = malloc(hdrsize, M_TEMP, M_WAITOK);
1029         if (hdr == NULL) {
1030                 return (EINVAL);
1031         }
1032         error = __elfN(corehdr)(td, vp, cred, seginfo.count, hdr, hdrsize);
1033
1034         /* Write the contents of all of the writable segments. */
1035         if (error == 0) {
1036                 Elf_Phdr *php;
1037                 off_t offset;
1038                 int i;
1039
1040                 php = (Elf_Phdr *)((char *)hdr + sizeof(Elf_Ehdr)) + 1;
1041                 offset = hdrsize;
1042                 for (i = 0; i < seginfo.count; i++) {
1043                         error = vn_rdwr_inchunks(UIO_WRITE, vp,
1044                             (caddr_t)(uintptr_t)php->p_vaddr,
1045                             php->p_filesz, offset, UIO_USERSPACE,
1046                             IO_UNIT | IO_DIRECT, cred, NOCRED, NULL,
1047                             curthread);
1048                         if (error != 0)
1049                                 break;
1050                         offset += php->p_filesz;
1051                         php++;
1052                 }
1053         }
1054         free(hdr, M_TEMP);
1055
1056         return (error);
1057 }
1058
1059 /*
1060  * A callback for each_writable_segment() to write out the segment's
1061  * program header entry.
1062  */
1063 static void
1064 cb_put_phdr(entry, closure)
1065         vm_map_entry_t entry;
1066         void *closure;
1067 {
1068         struct phdr_closure *phc = (struct phdr_closure *)closure;
1069         Elf_Phdr *phdr = phc->phdr;
1070
1071         phc->offset = round_page(phc->offset);
1072
1073         phdr->p_type = PT_LOAD;
1074         phdr->p_offset = phc->offset;
1075         phdr->p_vaddr = entry->start;
1076         phdr->p_paddr = 0;
1077         phdr->p_filesz = phdr->p_memsz = entry->end - entry->start;
1078         phdr->p_align = PAGE_SIZE;
1079         phdr->p_flags = 0;
1080         if (entry->protection & VM_PROT_READ)
1081                 phdr->p_flags |= PF_R;
1082         if (entry->protection & VM_PROT_WRITE)
1083                 phdr->p_flags |= PF_W;
1084         if (entry->protection & VM_PROT_EXECUTE)
1085                 phdr->p_flags |= PF_X;
1086
1087         phc->offset += phdr->p_filesz;
1088         phc->phdr++;
1089 }
1090
1091 /*
1092  * A callback for each_writable_segment() to gather information about
1093  * the number of segments and their total size.
1094  */
1095 static void
1096 cb_size_segment(entry, closure)
1097         vm_map_entry_t entry;
1098         void *closure;
1099 {
1100         struct sseg_closure *ssc = (struct sseg_closure *)closure;
1101
1102         ssc->count++;
1103         ssc->size += entry->end - entry->start;
1104 }
1105
1106 /*
1107  * For each writable segment in the process's memory map, call the given
1108  * function with a pointer to the map entry and some arbitrary
1109  * caller-supplied data.
1110  */
1111 static void
1112 each_writable_segment(td, func, closure)
1113         struct thread *td;
1114         segment_callback func;
1115         void *closure;
1116 {
1117         struct proc *p = td->td_proc;
1118         vm_map_t map = &p->p_vmspace->vm_map;
1119         vm_map_entry_t entry;
1120         vm_object_t backing_object, object;
1121         boolean_t ignore_entry;
1122
1123         vm_map_lock_read(map);
1124         for (entry = map->header.next; entry != &map->header;
1125             entry = entry->next) {
1126                 /*
1127                  * Don't dump inaccessible mappings, deal with legacy
1128                  * coredump mode.
1129                  *
1130                  * Note that read-only segments related to the elf binary
1131                  * are marked MAP_ENTRY_NOCOREDUMP now so we no longer
1132                  * need to arbitrarily ignore such segments.
1133                  */
1134                 if (elf_legacy_coredump) {
1135                         if ((entry->protection & VM_PROT_RW) != VM_PROT_RW)
1136                                 continue;
1137                 } else {
1138                         if ((entry->protection & VM_PROT_ALL) == 0)
1139                                 continue;
1140                 }
1141
1142                 /*
1143                  * Dont include memory segment in the coredump if
1144                  * MAP_NOCORE is set in mmap(2) or MADV_NOCORE in
1145                  * madvise(2).  Do not dump submaps (i.e. parts of the
1146                  * kernel map).
1147                  */
1148                 if (entry->eflags & (MAP_ENTRY_NOCOREDUMP|MAP_ENTRY_IS_SUB_MAP))
1149                         continue;
1150
1151                 if ((object = entry->object.vm_object) == NULL)
1152                         continue;
1153
1154                 /* Ignore memory-mapped devices and such things. */
1155                 VM_OBJECT_LOCK(object);
1156                 while ((backing_object = object->backing_object) != NULL) {
1157                         VM_OBJECT_LOCK(backing_object);
1158                         VM_OBJECT_UNLOCK(object);
1159                         object = backing_object;
1160                 }
1161                 ignore_entry = object->type != OBJT_DEFAULT &&
1162                     object->type != OBJT_SWAP && object->type != OBJT_VNODE;
1163                 VM_OBJECT_UNLOCK(object);
1164                 if (ignore_entry)
1165                         continue;
1166
1167                 (*func)(entry, closure);
1168         }
1169         vm_map_unlock_read(map);
1170 }
1171
1172 /*
1173  * Write the core file header to the file, including padding up to
1174  * the page boundary.
1175  */
1176 static int
1177 __elfN(corehdr)(td, vp, cred, numsegs, hdr, hdrsize)
1178         struct thread *td;
1179         struct vnode *vp;
1180         struct ucred *cred;
1181         int numsegs;
1182         size_t hdrsize;
1183         void *hdr;
1184 {
1185         size_t off;
1186
1187         /* Fill in the header. */
1188         bzero(hdr, hdrsize);
1189         off = 0;
1190         __elfN(puthdr)(td, hdr, &off, numsegs);
1191
1192         /* Write it to the core file. */
1193         return (vn_rdwr_inchunks(UIO_WRITE, vp, hdr, hdrsize, (off_t)0,
1194             UIO_SYSSPACE, IO_UNIT | IO_DIRECT, cred, NOCRED, NULL,
1195             td));
1196 }
1197
1198 #if defined(COMPAT_IA32) && __ELF_WORD_SIZE == 32
1199 typedef struct prstatus32 elf_prstatus_t;
1200 typedef struct prpsinfo32 elf_prpsinfo_t;
1201 typedef struct fpreg32 elf_prfpregset_t;
1202 typedef struct fpreg32 elf_fpregset_t;
1203 typedef struct reg32 elf_gregset_t;
1204 #else
1205 typedef prstatus_t elf_prstatus_t;
1206 typedef prpsinfo_t elf_prpsinfo_t;
1207 typedef prfpregset_t elf_prfpregset_t;
1208 typedef prfpregset_t elf_fpregset_t;
1209 typedef gregset_t elf_gregset_t;
1210 #endif
1211
1212 static void
1213 __elfN(puthdr)(struct thread *td, void *dst, size_t *off, int numsegs)
1214 {
1215         struct {
1216                 elf_prstatus_t status;
1217                 elf_prfpregset_t fpregset;
1218                 elf_prpsinfo_t psinfo;
1219         } *tempdata;
1220         elf_prstatus_t *status;
1221         elf_prfpregset_t *fpregset;
1222         elf_prpsinfo_t *psinfo;
1223         struct proc *p;
1224         struct thread *thr;
1225         size_t ehoff, noteoff, notesz, phoff;
1226
1227         p = td->td_proc;
1228
1229         ehoff = *off;
1230         *off += sizeof(Elf_Ehdr);
1231
1232         phoff = *off;
1233         *off += (numsegs + 1) * sizeof(Elf_Phdr);
1234
1235         noteoff = *off;
1236         /*
1237          * Don't allocate space for the notes if we're just calculating
1238          * the size of the header. We also don't collect the data.
1239          */
1240         if (dst != NULL) {
1241                 tempdata = malloc(sizeof(*tempdata), M_TEMP, M_ZERO|M_WAITOK);
1242                 status = &tempdata->status;
1243                 fpregset = &tempdata->fpregset;
1244                 psinfo = &tempdata->psinfo;
1245         } else {
1246                 tempdata = NULL;
1247                 status = NULL;
1248                 fpregset = NULL;
1249                 psinfo = NULL;
1250         }
1251
1252         if (dst != NULL) {
1253                 psinfo->pr_version = PRPSINFO_VERSION;
1254                 psinfo->pr_psinfosz = sizeof(elf_prpsinfo_t);
1255                 strlcpy(psinfo->pr_fname, p->p_comm, sizeof(psinfo->pr_fname));
1256                 /*
1257                  * XXX - We don't fill in the command line arguments properly
1258                  * yet.
1259                  */
1260                 strlcpy(psinfo->pr_psargs, p->p_comm,
1261                     sizeof(psinfo->pr_psargs));
1262         }
1263         __elfN(putnote)(dst, off, "FreeBSD", NT_PRPSINFO, psinfo,
1264             sizeof *psinfo);
1265
1266         /*
1267          * To have the debugger select the right thread (LWP) as the initial
1268          * thread, we dump the state of the thread passed to us in td first.
1269          * This is the thread that causes the core dump and thus likely to
1270          * be the right thread one wants to have selected in the debugger.
1271          */
1272         thr = td;
1273         while (thr != NULL) {
1274                 if (dst != NULL) {
1275                         status->pr_version = PRSTATUS_VERSION;
1276                         status->pr_statussz = sizeof(elf_prstatus_t);
1277                         status->pr_gregsetsz = sizeof(elf_gregset_t);
1278                         status->pr_fpregsetsz = sizeof(elf_fpregset_t);
1279                         status->pr_osreldate = osreldate;
1280                         status->pr_cursig = p->p_sig;
1281                         status->pr_pid = thr->td_tid;
1282 #if defined(COMPAT_IA32) && __ELF_WORD_SIZE == 32
1283                         fill_regs32(thr, &status->pr_reg);
1284                         fill_fpregs32(thr, fpregset);
1285 #else
1286                         fill_regs(thr, &status->pr_reg);
1287                         fill_fpregs(thr, fpregset);
1288 #endif
1289                 }
1290                 __elfN(putnote)(dst, off, "FreeBSD", NT_PRSTATUS, status,
1291                     sizeof *status);
1292                 __elfN(putnote)(dst, off, "FreeBSD", NT_FPREGSET, fpregset,
1293                     sizeof *fpregset);
1294                 /*
1295                  * Allow for MD specific notes, as well as any MD
1296                  * specific preparations for writing MI notes.
1297                  */
1298                 __elfN(dump_thread)(thr, dst, off);
1299
1300                 thr = (thr == td) ? TAILQ_FIRST(&p->p_threads) :
1301                     TAILQ_NEXT(thr, td_plist);
1302                 if (thr == td)
1303                         thr = TAILQ_NEXT(thr, td_plist);
1304         }
1305
1306         notesz = *off - noteoff;
1307
1308         if (dst != NULL)
1309                 free(tempdata, M_TEMP);
1310
1311         /* Align up to a page boundary for the program segments. */
1312         *off = round_page(*off);
1313
1314         if (dst != NULL) {
1315                 Elf_Ehdr *ehdr;
1316                 Elf_Phdr *phdr;
1317                 struct phdr_closure phc;
1318
1319                 /*
1320                  * Fill in the ELF header.
1321                  */
1322                 ehdr = (Elf_Ehdr *)((char *)dst + ehoff);
1323                 ehdr->e_ident[EI_MAG0] = ELFMAG0;
1324                 ehdr->e_ident[EI_MAG1] = ELFMAG1;
1325                 ehdr->e_ident[EI_MAG2] = ELFMAG2;
1326                 ehdr->e_ident[EI_MAG3] = ELFMAG3;
1327                 ehdr->e_ident[EI_CLASS] = ELF_CLASS;
1328                 ehdr->e_ident[EI_DATA] = ELF_DATA;
1329                 ehdr->e_ident[EI_VERSION] = EV_CURRENT;
1330                 ehdr->e_ident[EI_OSABI] = ELFOSABI_FREEBSD;
1331                 ehdr->e_ident[EI_ABIVERSION] = 0;
1332                 ehdr->e_ident[EI_PAD] = 0;
1333                 ehdr->e_type = ET_CORE;
1334 #if defined(COMPAT_IA32) && __ELF_WORD_SIZE == 32
1335                 ehdr->e_machine = EM_386;
1336 #else
1337                 ehdr->e_machine = ELF_ARCH;
1338 #endif
1339                 ehdr->e_version = EV_CURRENT;
1340                 ehdr->e_entry = 0;
1341                 ehdr->e_phoff = phoff;
1342                 ehdr->e_flags = 0;
1343                 ehdr->e_ehsize = sizeof(Elf_Ehdr);
1344                 ehdr->e_phentsize = sizeof(Elf_Phdr);
1345                 ehdr->e_phnum = numsegs + 1;
1346                 ehdr->e_shentsize = sizeof(Elf_Shdr);
1347                 ehdr->e_shnum = 0;
1348                 ehdr->e_shstrndx = SHN_UNDEF;
1349
1350                 /*
1351                  * Fill in the program header entries.
1352                  */
1353                 phdr = (Elf_Phdr *)((char *)dst + phoff);
1354
1355                 /* The note segement. */
1356                 phdr->p_type = PT_NOTE;
1357                 phdr->p_offset = noteoff;
1358                 phdr->p_vaddr = 0;
1359                 phdr->p_paddr = 0;
1360                 phdr->p_filesz = notesz;
1361                 phdr->p_memsz = 0;
1362                 phdr->p_flags = 0;
1363                 phdr->p_align = 0;
1364                 phdr++;
1365
1366                 /* All the writable segments from the program. */
1367                 phc.phdr = phdr;
1368                 phc.offset = *off;
1369                 each_writable_segment(td, cb_put_phdr, &phc);
1370         }
1371 }
1372
1373 static void
1374 __elfN(putnote)(void *dst, size_t *off, const char *name, int type,
1375     const void *desc, size_t descsz)
1376 {
1377         Elf_Note note;
1378
1379         note.n_namesz = strlen(name) + 1;
1380         note.n_descsz = descsz;
1381         note.n_type = type;
1382         if (dst != NULL)
1383                 bcopy(&note, (char *)dst + *off, sizeof note);
1384         *off += sizeof note;
1385         if (dst != NULL)
1386                 bcopy(name, (char *)dst + *off, note.n_namesz);
1387         *off += roundup2(note.n_namesz, sizeof(Elf_Size));
1388         if (dst != NULL)
1389                 bcopy(desc, (char *)dst + *off, note.n_descsz);
1390         *off += roundup2(note.n_descsz, sizeof(Elf_Size));
1391 }
1392
1393 /*
1394  * Try to find the appropriate ABI-note section for checknote,
1395  * fetch the osreldate for binary from the ELF OSABI-note. Only the
1396  * first page of the image is searched, the same as for headers.
1397  */
1398 static boolean_t
1399 __elfN(check_note)(struct image_params *imgp, Elf_Brandnote *checknote,
1400     int32_t *osrel)
1401 {
1402         const Elf_Note *note, *note0, *note_end;
1403         const Elf_Phdr *phdr, *pnote;
1404         const Elf_Ehdr *hdr;
1405         const char *note_name;
1406         int i;
1407
1408         pnote = NULL;
1409         hdr = (const Elf_Ehdr *)imgp->image_header;
1410         phdr = (const Elf_Phdr *)(imgp->image_header + hdr->e_phoff);
1411
1412         for (i = 0; i < hdr->e_phnum; i++) {
1413                 if (phdr[i].p_type == PT_NOTE) {
1414                         pnote = &phdr[i];
1415                         break;
1416                 }
1417         }
1418
1419         if (pnote == NULL || pnote->p_offset >= PAGE_SIZE ||
1420             pnote->p_offset + pnote->p_filesz >= PAGE_SIZE)
1421                 return (FALSE);
1422
1423         note = note0 = (const Elf_Note *)(imgp->image_header + pnote->p_offset);
1424         note_end = (const Elf_Note *)(imgp->image_header +
1425             pnote->p_offset + pnote->p_filesz);
1426         for (i = 0; i < 100 && note >= note0 && note < note_end; i++) {
1427                 if (!aligned(note, Elf32_Addr))
1428                         return (FALSE);
1429                 if (note->n_namesz != checknote->hdr.n_namesz ||
1430                     note->n_descsz != checknote->hdr.n_descsz ||
1431                     note->n_type != checknote->hdr.n_type)
1432                         goto nextnote;
1433                 note_name = (const char *)(note + 1);
1434                 if (strncmp(checknote->vendor, note_name,
1435                     checknote->hdr.n_namesz) != 0)
1436                         goto nextnote;
1437
1438                 /*
1439                  * Fetch the osreldate for binary
1440                  * from the ELF OSABI-note if necessary.
1441                  */
1442                 if ((checknote->flags & BN_TRANSLATE_OSREL) != 0 &&
1443                     checknote->trans_osrel != NULL)
1444                         return (checknote->trans_osrel(note, osrel));
1445                 return (TRUE);
1446
1447 nextnote:
1448                 note = (const Elf_Note *)((const char *)(note + 1) +
1449                     roundup2(note->n_namesz, sizeof(Elf32_Addr)) +
1450                     roundup2(note->n_descsz, sizeof(Elf32_Addr)));
1451         }
1452
1453         return (FALSE);
1454 }
1455
1456 /*
1457  * Tell kern_execve.c about it, with a little help from the linker.
1458  */
1459 static struct execsw __elfN(execsw) = {
1460         __CONCAT(exec_, __elfN(imgact)),
1461         __XSTRING(__CONCAT(ELF, __ELF_WORD_SIZE))
1462 };
1463 EXEC_SET(__CONCAT(elf, __ELF_WORD_SIZE), __elfN(execsw));