libexec/rtld-elf/rtld.c

   1 /*-
   2  * Copyright 1996, 1997, 1998, 1999, 2000 John D. Polstra.
   3  * Copyright 2003 Alexander Kabaev <kan@FreeBSD.ORG>.
   4  * All rights reserved.
   5  *
   6  * Redistribution and use in source and binary forms, with or without
   7  * modification, are permitted provided that the following conditions
   8  * are met:
   9  * 1. Redistributions of source code must retain the above copyright
  10  *    notice, this list of conditions and the following disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25  *
  26  * $FreeBSD: src/libexec/rtld-elf/rtld.c,v 1.43.2.15 2003/02/20 20:42:46 kan Exp $
  27  * $DragonFly: src/libexec/rtld-elf/rtld.c,v 1.29 2008/01/08 00:02:04 corecode Exp $
  28  */
  29
  30 /*
  31  * Dynamic linker for ELF.
  32  *
  33  * John Polstra <jdp@polstra.com>.
  34  */
  35
  36 #ifndef __GNUC__
  37 #error "GCC is needed to compile this file"
  38 #endif
  39
  40 #include <sys/param.h>
  41 #include <sys/mman.h>
  42 #include <sys/stat.h>
  43 #include <sys/resident.h>
  44 #include <sys/tls.h>
  45
  46 #include <machine/tls.h>
  47
  48 #include <dlfcn.h>
  49 #include <err.h>
  50 #include <errno.h>
  51 #include <fcntl.h>
  52 #include <stdarg.h>
  53 #include <stdio.h>
  54 #include <stdlib.h>
  55 #include <string.h>
  56 #include <unistd.h>
  57
  58 #include "debug.h"
  59 #include "rtld.h"
  60
  61 #define PATH_RTLD       "/usr/libexec/ld-elf.so.2"
  62 #define LD_ARY_CACHE    16
  63
  64 /* Types. */
  65 typedef void (*func_ptr_type)();
  66 typedef void * (*path_enum_proc) (const char *path, size_t len, void *arg);
  67
  68 /*
  69  * This structure provides a reentrant way to keep a list of objects and
  70  * check which ones have already been processed in some way.
  71  */
  72 typedef struct Struct_DoneList {
  73     const Obj_Entry **objs;             /* Array of object pointers */
  74     unsigned int num_alloc;             /* Allocated size of the array */
  75     unsigned int num_used;              /* Number of array slots used */
  76 } DoneList;
  77
  78 /*
  79  * Function declarations.
  80  */
  81 static void die(void);
  82 static void digest_dynamic(Obj_Entry *, int);
  83 static const char *_getenv_ld(const char *id);
  84 static Obj_Entry *digest_phdr(const Elf_Phdr *, int, caddr_t, const char *);
  85 static Obj_Entry *dlcheck(void *);
  86 static int do_search_info(const Obj_Entry *obj, int, struct dl_serinfo *);
  87 static bool donelist_check(DoneList *, const Obj_Entry *);
  88 static void errmsg_restore(char *);
  89 static char *errmsg_save(void);
  90 static void *fill_search_info(const char *, size_t, void *);
  91 static char *find_library(const char *, const Obj_Entry *);
  92 static Obj_Entry *find_object(const char *);
  93 static Obj_Entry *find_object2(const char *, int *, struct stat *);
  94 static const char *gethints(void);
  95 static void init_dag(Obj_Entry *);
  96 static void init_dag1(Obj_Entry *root, Obj_Entry *obj, DoneList *);
  97 static void init_rtld(caddr_t);
  98 static void initlist_add_neededs(Needed_Entry *needed, Objlist *list);
  99 static void initlist_add_objects(Obj_Entry *obj, Obj_Entry **tail,
 100   Objlist *list);
 101 static bool is_exported(const Elf_Sym *);
 102 static void linkmap_add(Obj_Entry *);
 103 static void linkmap_delete(Obj_Entry *);
 104 static int load_needed_objects(Obj_Entry *);
 105 static int load_preload_objects(void);
 106 static Obj_Entry *load_object(char *);
 107 static void lock_check(void);
 108 static Obj_Entry *obj_from_addr(const void *);
 109 static void objlist_call_fini(Objlist *);
 110 static void objlist_call_init(Objlist *);
 111 static void objlist_clear(Objlist *);
 112 static Objlist_Entry *objlist_find(Objlist *, const Obj_Entry *);
 113 static void objlist_init(Objlist *);
 114 static void objlist_push_head(Objlist *, Obj_Entry *);
 115 static void objlist_push_tail(Objlist *, Obj_Entry *);
 116 static void objlist_remove(Objlist *, Obj_Entry *);
 117 static void objlist_remove_unref(Objlist *);
 118 static void *path_enumerate(const char *, path_enum_proc, void *);
 119 static int relocate_objects(Obj_Entry *, bool, Obj_Entry *);
 120 static int rtld_dirname(const char *, char *);
 121 static void rtld_exit(void);
 122 static char *search_library_path(const char *, const char *);
 123 static const void **get_program_var_addr(const char *name);
 124 static void set_program_var(const char *, const void *);
 125 static const Elf_Sym *symlook_default(const char *, unsigned long hash,
 126   const Obj_Entry *refobj, const Obj_Entry **defobj_out, bool in_plt);
 127 static const Elf_Sym *symlook_list(const char *, unsigned long,
 128   const Objlist *, const Obj_Entry **, bool in_plt, DoneList *);
 129 static const Elf_Sym *symlook_needed(const char *, unsigned long,
 130   const Needed_Entry *, const Obj_Entry **, bool in_plt, DoneList *);
 131 static void trace_loaded_objects(Obj_Entry *obj);
 132 static void unlink_object(Obj_Entry *);
 133 static void unload_object(Obj_Entry *);
 134 static void unref_dag(Obj_Entry *);
 135
 136 void r_debug_state(struct r_debug*, struct link_map*);
 137
 138 /*
 139  * Data declarations.
 140  */
 141 static char *error_message;     /* Message for dlerror(), or NULL */
 142 struct r_debug r_debug;         /* for GDB; */
 143 static bool trust;              /* False for setuid and setgid programs */
 144 static const char *ld_bind_now; /* Environment variable for immediate binding */
 145 static const char *ld_debug;    /* Environment variable for debugging */
 146 static const char *ld_library_path; /* Environment variable for search path */
 147 static char *ld_preload;        /* Environment variable for libraries to
 148                                    load first */
 149 static const char *ld_tracing;  /* Called from ldd(1) to print libs */
 150                                 /* Optional function call tracing hook */
 151 static int (*rtld_functrace)(const char *caller_obj,
 152                              const char *callee_obj,
 153                              const char *callee_func,
 154                              void *stack);
 155 static Obj_Entry *rtld_functrace_obj;   /* Object thereof */
 156 static Obj_Entry *obj_list;     /* Head of linked list of shared objects */
 157 static Obj_Entry **obj_tail;    /* Link field of last object in list */
 158 static Obj_Entry **preload_tail;
 159 static Obj_Entry *obj_main;     /* The main program shared object */
 160 static Obj_Entry obj_rtld;      /* The dynamic linker shared object */
 161 static unsigned int obj_count;  /* Number of objects in obj_list */
 162 static int      ld_resident;    /* Non-zero if resident */
 163 static const char *ld_ary[LD_ARY_CACHE];
 164 static int      ld_index;
 165 static Objlist initlist;
 166
 167 static Objlist list_global =    /* Objects dlopened with RTLD_GLOBAL */
 168   STAILQ_HEAD_INITIALIZER(list_global);
 169 static Objlist list_main =      /* Objects loaded at program startup */
 170   STAILQ_HEAD_INITIALIZER(list_main);
 171 static Objlist list_fini =      /* Objects needing fini() calls */
 172   STAILQ_HEAD_INITIALIZER(list_fini);
 173
 174 static LockInfo lockinfo;
 175
 176 static Elf_Sym sym_zero;        /* For resolving undefined weak refs. */
 177
 178 #define GDB_STATE(s,m)  r_debug.r_state = s; r_debug_state(&r_debug,m);
 179
 180 extern Elf_Dyn _DYNAMIC;
 181 #pragma weak _DYNAMIC
 182
 183 /*
 184  * These are the functions the dynamic linker exports to application
 185  * programs.  They are the only symbols the dynamic linker is willing
 186  * to export from itself.
 187  */
 188 static func_ptr_type exports[] = {
 189     (func_ptr_type) &_rtld_error,
 190     (func_ptr_type) &dlclose,
 191     (func_ptr_type) &dlerror,
 192     (func_ptr_type) &dlopen,
 193     (func_ptr_type) &dlsym,
 194     (func_ptr_type) &dladdr,
 195     (func_ptr_type) &dlinfo,
 196 #ifdef __i386__
 197     (func_ptr_type) &___tls_get_addr,
 198 #endif
 199     (func_ptr_type) &__tls_get_addr,
 200     (func_ptr_type) &__tls_get_addr_tcb,
 201     (func_ptr_type) &_rtld_allocate_tls,
 202     (func_ptr_type) &_rtld_free_tls,
 203     (func_ptr_type) &_rtld_call_init,
 204     NULL
 205 };
 206
 207 /*
 208  * Global declarations normally provided by crt1.  The dynamic linker is
 209  * not built with crt1, so we have to provide them ourselves.
 210  */
 211 char *__progname;
 212 char **environ;
 213
 214 /*
 215  * Globals to control TLS allocation.
 216  */
 217 size_t tls_last_offset;         /* Static TLS offset of last module */
 218 size_t tls_last_size;           /* Static TLS size of last module */
 219 size_t tls_static_space;        /* Static TLS space allocated */
 220 int tls_dtv_generation = 1;     /* Used to detect when dtv size changes  */
 221 int tls_max_index = 1;          /* Largest module index allocated */
 222
 223 /*
 224  * Fill in a DoneList with an allocation large enough to hold all of
 225  * the currently-loaded objects.  Keep this as a macro since it calls
 226  * alloca and we want that to occur within the scope of the caller.
 227  */
 228 #define donelist_init(dlp)                                      \
 229     ((dlp)->objs = alloca(obj_count * sizeof (dlp)->objs[0]),   \
 230     assert((dlp)->objs != NULL),                                \
 231     (dlp)->num_alloc = obj_count,                               \
 232     (dlp)->num_used = 0)
 233
 234 static __inline void
 235 rlock_acquire(void)
 236 {
 237     lockinfo.rlock_acquire(lockinfo.thelock);
 238     atomic_incr_int(&lockinfo.rcount);
 239     lock_check();
 240 }
 241
 242 static __inline void
 243 wlock_acquire(void)
 244 {
 245     lockinfo.wlock_acquire(lockinfo.thelock);
 246     atomic_incr_int(&lockinfo.wcount);
 247     lock_check();
 248 }
 249
 250 static __inline void
 251 rlock_release(void)
 252 {
 253     atomic_decr_int(&lockinfo.rcount);
 254     lockinfo.rlock_release(lockinfo.thelock);
 255 }
 256
 257 static __inline void
 258 wlock_release(void)
 259 {
 260     atomic_decr_int(&lockinfo.wcount);
 261     lockinfo.wlock_release(lockinfo.thelock);
 262 }
 263
 264 /*
 265  * Main entry point for dynamic linking.  The first argument is the
 266  * stack pointer.  The stack is expected to be laid out as described
 267  * in the SVR4 ABI specification, Intel 386 Processor Supplement.
 268  * Specifically, the stack pointer points to a word containing
 269  * ARGC.  Following that in the stack is a null-terminated sequence
 270  * of pointers to argument strings.  Then comes a null-terminated
 271  * sequence of pointers to environment strings.  Finally, there is a
 272  * sequence of "auxiliary vector" entries.
 273  *
 274  * The second argument points to a place to store the dynamic linker's
 275  * exit procedure pointer and the third to a place to store the main
 276  * program's object.
 277  *
 278  * The return value is the main program's entry point.
 279  */
 280
 281 func_ptr_type
 282 _rtld(Elf_Addr *sp, func_ptr_type *exit_proc, Obj_Entry **objp)
 283 {
 284     Elf_Auxinfo *aux_info[AT_COUNT];
 285     int i;
 286     int argc;
 287     char **argv;
 288     char **env;
 289     Elf_Auxinfo *aux;
 290     Elf_Auxinfo *auxp;
 291     const char *argv0;
 292     Objlist_Entry *entry;
 293     Obj_Entry *obj;
 294
 295     ld_index = 0;       /* don't use old env cache in case we are resident */
 296
 297     /*
 298      * On entry, the dynamic linker itself has not been relocated yet.
 299      * Be very careful not to reference any global data until after
 300      * init_rtld has returned.  It is OK to reference file-scope statics
 301      * and string constants, and to call static and global functions.
 302      */
 303
 304     /* Find the auxiliary vector on the stack. */
 305     argc = *sp++;
 306     argv = (char **) sp;
 307     sp += argc + 1;     /* Skip over arguments and NULL terminator */
 308     env = (char **) sp;
 309
 310     /*
 311      * If we aren't already resident we have to dig out some more info.
 312      * Note that auxinfo does not exist when we are resident.
 313      */
 314     if (ld_resident == 0) {
 315         while (*sp++ != 0)      /* Skip over environment, and NULL terminator */
 316             ;
 317         aux = (Elf_Auxinfo *) sp;
 318
 319         /* Digest the auxiliary vector. */
 320         for (i = 0;  i < AT_COUNT;  i++)
 321             aux_info[i] = NULL;
 322         for (auxp = aux;  auxp->a_type != AT_NULL;  auxp++) {
 323             if (auxp->a_type < AT_COUNT)
 324                 aux_info[auxp->a_type] = auxp;
 325         }
 326
 327         /* Initialize and relocate ourselves. */
 328         assert(aux_info[AT_BASE] != NULL);
 329         init_rtld((caddr_t) aux_info[AT_BASE]->a_un.a_ptr);
 330     }
 331
 332     __progname = obj_rtld.path;
 333     argv0 = argv[0] != NULL ? argv[0] : "(null)";
 334     environ = env;
 335
 336     trust = (geteuid() == getuid()) && (getegid() == getgid());
 337
 338     ld_bind_now = _getenv_ld("LD_BIND_NOW");
 339     if (trust) {
 340         ld_debug = _getenv_ld("LD_DEBUG");
 341         ld_library_path = _getenv_ld("LD_LIBRARY_PATH");
 342         ld_preload = (char *)_getenv_ld("LD_PRELOAD");
 343     }
 344     ld_tracing = _getenv_ld("LD_TRACE_LOADED_OBJECTS");
 345
 346     if (ld_debug != NULL && *ld_debug != '\0')
 347         debug = 1;
 348     dbg("%s is initialized, base address = %p", __progname,
 349         (caddr_t) aux_info[AT_BASE]->a_un.a_ptr);
 350     dbg("RTLD dynamic = %p", obj_rtld.dynamic);
 351     dbg("RTLD pltgot  = %p", obj_rtld.pltgot);
 352
 353     /*
 354      * If we are resident we can skip work that we have already done.
 355      * Note that the stack is reset and there is no Elf_Auxinfo
 356      * when running from a resident image, and the static globals setup
 357      * between here and resident_skip will have already been setup.
 358      */
 359     if (ld_resident)
 360         goto resident_skip1;
 361
 362     /*
 363      * Load the main program, or process its program header if it is
 364      * already loaded.
 365      */
 366     if (aux_info[AT_EXECFD] != NULL) {  /* Load the main program. */
 367         int fd = aux_info[AT_EXECFD]->a_un.a_val;
 368         dbg("loading main program");
 369         obj_main = map_object(fd, argv0, NULL);
 370         close(fd);
 371         if (obj_main == NULL)
 372             die();
 373     } else {                            /* Main program already loaded. */
 374         const Elf_Phdr *phdr;
 375         int phnum;
 376         caddr_t entry;
 377
 378         dbg("processing main program's program header");
 379         assert(aux_info[AT_PHDR] != NULL);
 380         phdr = (const Elf_Phdr *) aux_info[AT_PHDR]->a_un.a_ptr;
 381         assert(aux_info[AT_PHNUM] != NULL);
 382         phnum = aux_info[AT_PHNUM]->a_un.a_val;
 383         assert(aux_info[AT_PHENT] != NULL);
 384         assert(aux_info[AT_PHENT]->a_un.a_val == sizeof(Elf_Phdr));
 385         assert(aux_info[AT_ENTRY] != NULL);
 386         entry = (caddr_t) aux_info[AT_ENTRY]->a_un.a_ptr;
 387         if ((obj_main = digest_phdr(phdr, phnum, entry, argv0)) == NULL)
 388             die();
 389     }
 390
 391     obj_main->path = xstrdup(argv0);
 392     obj_main->mainprog = true;
 393
 394     /*
 395      * Get the actual dynamic linker pathname from the executable if
 396      * possible.  (It should always be possible.)  That ensures that
 397      * gdb will find the right dynamic linker even if a non-standard
 398      * one is being used.
 399      */
 400     if (obj_main->interp != NULL &&
 401       strcmp(obj_main->interp, obj_rtld.path) != 0) {
 402         free(obj_rtld.path);
 403         obj_rtld.path = xstrdup(obj_main->interp);
 404         __progname = obj_rtld.path;
 405     }
 406
 407     digest_dynamic(obj_main, 0);
 408
 409     linkmap_add(obj_main);
 410     linkmap_add(&obj_rtld);
 411
 412     /* Link the main program into the list of objects. */
 413     *obj_tail = obj_main;
 414     obj_tail = &obj_main->next;
 415     obj_count++;
 416     obj_main->refcount++;
 417     /* Make sure we don't call the main program's init and fini functions. */
 418     obj_main->init = obj_main->fini = NULL;
 419
 420     /* Initialize a fake symbol for resolving undefined weak references. */
 421     sym_zero.st_info = ELF_ST_INFO(STB_GLOBAL, STT_NOTYPE);
 422     sym_zero.st_shndx = SHN_ABS;
 423
 424     dbg("loading LD_PRELOAD libraries");
 425     if (load_preload_objects() == -1)
 426         die();
 427     preload_tail = obj_tail;
 428
 429     dbg("loading needed objects");
 430     if (load_needed_objects(obj_main) == -1)
 431         die();
 432
 433     /* Make a list of all objects loaded at startup. */
 434     for (obj = obj_list;  obj != NULL;  obj = obj->next)
 435         objlist_push_tail(&list_main, obj);
 436
 437 resident_skip1:
 438
 439     if (ld_tracing) {           /* We're done */
 440         trace_loaded_objects(obj_main);
 441         exit(0);
 442     }
 443
 444     if (ld_resident)            /* XXX clean this up! */
 445         goto resident_skip2;
 446
 447     if (getenv("LD_DUMP_REL_PRE") != NULL) {
 448        dump_relocations(obj_main);
 449        exit (0);
 450     }
 451
 452     /* setup TLS for main thread */
 453     dbg("initializing initial thread local storage");
 454     STAILQ_FOREACH(entry, &list_main, link) {
 455         /*
 456          * Allocate all the initial objects out of the static TLS
 457          * block even if they didn't ask for it.
 458          */
 459         allocate_tls_offset(entry->obj);
 460     }
 461
 462     tls_static_space = tls_last_offset + RTLD_STATIC_TLS_EXTRA;
 463
 464     /*
 465      * Do not try to allocate the TLS here, let libc do it itself.
 466      * (crt1 for the program will call _init_tls())
 467      */
 468
 469     if (relocate_objects(obj_main,
 470         ld_bind_now != NULL && *ld_bind_now != '\0', &obj_rtld) == -1)
 471         die();
 472
 473     dbg("doing copy relocations");
 474     if (do_copy_relocations(obj_main) == -1)
 475         die();
 476
 477 resident_skip2:
 478
 479     if (_getenv_ld("LD_RESIDENT_UNREGISTER_NOW")) {
 480         if (exec_sys_unregister(-1) < 0) {
 481             dbg("exec_sys_unregister failed %d\n", errno);
 482             exit(errno);
 483         }
 484         dbg("exec_sys_unregister success\n");
 485         exit(0);
 486     }
 487
 488     if (getenv("LD_DUMP_REL_POST") != NULL) {
 489        dump_relocations(obj_main);
 490        exit (0);
 491     }
 492
 493     dbg("initializing key program variables");
 494     set_program_var("__progname", argv[0] != NULL ? basename(argv[0]) : "");
 495     set_program_var("environ", env);
 496
 497     if (_getenv_ld("LD_RESIDENT_REGISTER_NOW")) {
 498         extern void resident_start(void);
 499         ld_resident = 1;
 500         if (exec_sys_register(resident_start) < 0) {
 501             dbg("exec_sys_register failed %d\n", errno);
 502             exit(errno);
 503         }
 504         dbg("exec_sys_register success\n");
 505         exit(0);
 506     }
 507
 508     dbg("initializing thread locks");
 509     lockdflt_init(&lockinfo);
 510     lockinfo.thelock = lockinfo.lock_create(lockinfo.context);
 511
 512     /* Make a list of init functions to call. */
 513     objlist_init(&initlist);
 514     initlist_add_objects(obj_list, preload_tail, &initlist);
 515
 516     r_debug_state(NULL, &obj_main->linkmap); /* say hello to gdb! */
 517
 518     /*
 519      * Do NOT call the initlist here, give libc a chance to set up
 520      * the initial TLS segment.  crt1 will then call _rtld_call_init().
 521      */
 522
 523     dbg("transferring control to program entry point = %p", obj_main->entry);
 524
 525     /* Return the exit procedure and the program entry point. */
 526     *exit_proc = rtld_exit;
 527     *objp = obj_main;
 528     return (func_ptr_type) obj_main->entry;
 529 }
 530
 531 /*
 532  * Call the initialization list for dynamically loaded libraries.
 533  * (called from crt1.c).
 534  */
 535 void
 536 _rtld_call_init(void)
 537 {
 538     objlist_call_init(&initlist);
 539     wlock_acquire();
 540     objlist_clear(&initlist);
 541     wlock_release();
 542 }
 543
 544 Elf_Addr
 545 _rtld_bind(Obj_Entry *obj, Elf_Word reloff, void *stack)
 546 {
 547     const Elf_Rel *rel;
 548     const Elf_Sym *def;
 549     const Obj_Entry *defobj;
 550     Elf_Addr *where;
 551     Elf_Addr target;
 552     int do_reloc = 1;
 553
 554     rlock_acquire();
 555     if (obj->pltrel)
 556         rel = (const Elf_Rel *) ((caddr_t) obj->pltrel + reloff);
 557     else
 558         rel = (const Elf_Rel *) ((caddr_t) obj->pltrela + reloff);
 559
 560     where = (Elf_Addr *) (obj->relocbase + rel->r_offset);
 561     def = find_symdef(ELF_R_SYM(rel->r_info), obj, &defobj, true, NULL);
 562     if (def == NULL)
 563         die();
 564
 565     target = (Elf_Addr)(defobj->relocbase + def->st_value);
 566
 567     dbg("\"%s\" in \"%s\" ==> %p in \"%s\"",
 568       defobj->strtab + def->st_name, basename(obj->path),
 569       (void *)target, basename(defobj->path));
 570     rlock_release();
 571
 572     /*
 573      * If we have a function call tracing hook, and the
 574      * hook would like to keep tracing this one function,
 575      * prevent the relocation so we will wind up here
 576      * the next time again.
 577      *
 578      * We don't want to functrace calls from the functracer
 579      * to avoid recursive loops.
 580      */
 581     if (rtld_functrace != NULL && obj != rtld_functrace_obj) {
 582         if (rtld_functrace(obj->path,
 583                            defobj->path,
 584                            defobj->strtab + def->st_name,
 585                            stack))
 586             do_reloc = 0;
 587     }
 588
 589     if (do_reloc)
 590         reloc_jmpslot(where, target);
 591     return target;
 592 }
 593
 594 /*
 595  * Error reporting function.  Use it like printf.  If formats the message
 596  * into a buffer, and sets things up so that the next call to dlerror()
 597  * will return the message.
 598  */
 599 void
 600 _rtld_error(const char *fmt, ...)
 601 {
 602     static char buf[512];
 603     va_list ap;
 604
 605     va_start(ap, fmt);
 606     vsnprintf(buf, sizeof buf, fmt, ap);
 607     error_message = buf;
 608     va_end(ap);
 609 }
 610
 611 /*
 612  * Return a dynamically-allocated copy of the current error message, if any.
 613  */
 614 static char *
 615 errmsg_save(void)
 616 {
 617     return error_message == NULL ? NULL : xstrdup(error_message);
 618 }
 619
 620 /*
 621  * Restore the current error message from a copy which was previously saved
 622  * by errmsg_save().  The copy is freed.
 623  */
 624 static void
 625 errmsg_restore(char *saved_msg)
 626 {
 627     if (saved_msg == NULL)
 628         error_message = NULL;
 629     else {
 630         _rtld_error("%s", saved_msg);
 631         free(saved_msg);
 632     }
 633 }
 634
 635 const char *
 636 basename(const char *name)
 637 {
 638     const char *p = strrchr(name, '/');
 639     return p != NULL ? p + 1 : name;
 640 }
 641
 642 static void
 643 die(void)
 644 {
 645     const char *msg = dlerror();
 646
 647     if (msg == NULL)
 648         msg = "Fatal error";
 649     errx(1, "%s", msg);
 650 }
 651
 652 /*
 653  * Process a shared object's DYNAMIC section, and save the important
 654  * information in its Obj_Entry structure.
 655  */
 656 static void
 657 digest_dynamic(Obj_Entry *obj, int early)
 658 {
 659     const Elf_Dyn *dynp;
 660     Needed_Entry **needed_tail = &obj->needed;
 661     const Elf_Dyn *dyn_rpath = NULL;
 662     int plttype = DT_REL;
 663
 664     for (dynp = obj->dynamic;  dynp->d_tag != DT_NULL;  dynp++) {
 665         switch (dynp->d_tag) {
 666
 667         case DT_REL:
 668             obj->rel = (const Elf_Rel *) (obj->relocbase + dynp->d_un.d_ptr);
 669             break;
 670
 671         case DT_RELSZ:
 672             obj->relsize = dynp->d_un.d_val;
 673             break;
 674
 675         case DT_RELENT:
 676             assert(dynp->d_un.d_val == sizeof(Elf_Rel));
 677             break;
 678
 679         case DT_JMPREL:
 680             obj->pltrel = (const Elf_Rel *)
 681               (obj->relocbase + dynp->d_un.d_ptr);
 682             break;
 683
 684         case DT_PLTRELSZ:
 685             obj->pltrelsize = dynp->d_un.d_val;
 686             break;
 687
 688         case DT_RELA:
 689             obj->rela = (const Elf_Rela *) (obj->relocbase + dynp->d_un.d_ptr);
 690             break;
 691
 692         case DT_RELASZ:
 693             obj->relasize = dynp->d_un.d_val;
 694             break;
 695
 696         case DT_RELAENT:
 697             assert(dynp->d_un.d_val == sizeof(Elf_Rela));
 698             break;
 699
 700         case DT_PLTREL:
 701             plttype = dynp->d_un.d_val;
 702             assert(dynp->d_un.d_val == DT_REL || plttype == DT_RELA);
 703             break;
 704
 705         case DT_SYMTAB:
 706             obj->symtab = (const Elf_Sym *)
 707               (obj->relocbase + dynp->d_un.d_ptr);
 708             break;
 709
 710         case DT_SYMENT:
 711             assert(dynp->d_un.d_val == sizeof(Elf_Sym));
 712             break;
 713
 714         case DT_STRTAB:
 715             obj->strtab = (const char *) (obj->relocbase + dynp->d_un.d_ptr);
 716             break;
 717
 718         case DT_STRSZ:
 719             obj->strsize = dynp->d_un.d_val;
 720             break;
 721
 722         case DT_HASH:
 723             {
 724                 const Elf_Hashelt *hashtab = (const Elf_Hashelt *)
 725                   (obj->relocbase + dynp->d_un.d_ptr);
 726                 obj->nbuckets = hashtab[0];
 727                 obj->nchains = hashtab[1];
 728                 obj->buckets = hashtab + 2;
 729                 obj->chains = obj->buckets + obj->nbuckets;
 730             }
 731             break;
 732
 733         case DT_NEEDED:
 734             if (!obj->rtld) {
 735                 Needed_Entry *nep = NEW(Needed_Entry);
 736                 nep->name = dynp->d_un.d_val;
 737                 nep->obj = NULL;
 738                 nep->next = NULL;
 739
 740                 *needed_tail = nep;
 741                 needed_tail = &nep->next;
 742             }
 743             break;
 744
 745         case DT_PLTGOT:
 746             obj->pltgot = (Elf_Addr *) (obj->relocbase + dynp->d_un.d_ptr);
 747             break;
 748
 749         case DT_TEXTREL:
 750             obj->textrel = true;
 751             break;
 752
 753         case DT_SYMBOLIC:
 754             obj->symbolic = true;
 755             break;
 756
 757         case DT_RPATH:
 758         case DT_RUNPATH:        /* XXX: process separately */
 759             /*
 760              * We have to wait until later to process this, because we
 761              * might not have gotten the address of the string table yet.
 762              */
 763             dyn_rpath = dynp;
 764             break;
 765
 766         case DT_SONAME:
 767             /* Not used by the dynamic linker. */
 768             break;
 769
 770         case DT_INIT:
 771             obj->init = (InitFunc) (obj->relocbase + dynp->d_un.d_ptr);
 772             break;
 773
 774         case DT_FINI:
 775             obj->fini = (InitFunc) (obj->relocbase + dynp->d_un.d_ptr);
 776             break;
 777
 778         case DT_DEBUG:
 779             /* XXX - not implemented yet */
 780             if (!early)
 781                 dbg("Filling in DT_DEBUG entry");
 782             ((Elf_Dyn*)dynp)->d_un.d_ptr = (Elf_Addr) &r_debug;
 783             break;
 784
 785         case DT_FLAGS:
 786                 if (dynp->d_un.d_val & DF_ORIGIN) {
 787                     obj->origin_path = xmalloc(PATH_MAX);
 788                     if (rtld_dirname(obj->path, obj->origin_path) == -1)
 789                         die();
 790                 }
 791                 if (dynp->d_un.d_val & DF_SYMBOLIC)
 792                     obj->symbolic = true;
 793                 if (dynp->d_un.d_val & DF_TEXTREL)
 794                     obj->textrel = true;
 795                 if (dynp->d_un.d_val & DF_BIND_NOW)
 796                     obj->bind_now = true;
 797                 if (dynp->d_un.d_val & DF_STATIC_TLS)
 798                     ;
 799             break;
 800
 801         default:
 802             if (!early)
 803                 dbg("Ignoring d_tag %d = %#x", dynp->d_tag, dynp->d_tag);
 804             break;
 805         }
 806     }
 807
 808     obj->traced = false;
 809
 810     if (plttype == DT_RELA) {
 811         obj->pltrela = (const Elf_Rela *) obj->pltrel;
 812         obj->pltrel = NULL;
 813         obj->pltrelasize = obj->pltrelsize;
 814         obj->pltrelsize = 0;
 815     }
 816
 817     if (dyn_rpath != NULL)
 818         obj->rpath = obj->strtab + dyn_rpath->d_un.d_val;
 819 }
 820
 821 /*
 822  * Process a shared object's program header.  This is used only for the
 823  * main program, when the kernel has already loaded the main program
 824  * into memory before calling the dynamic linker.  It creates and
 825  * returns an Obj_Entry structure.
 826  */
 827 static Obj_Entry *
 828 digest_phdr(const Elf_Phdr *phdr, int phnum, caddr_t entry, const char *path)
 829 {
 830     Obj_Entry *obj;
 831     const Elf_Phdr *phlimit = phdr + phnum;
 832     const Elf_Phdr *ph;
 833     int nsegs = 0;
 834
 835     obj = obj_new();
 836     for (ph = phdr;  ph < phlimit;  ph++) {
 837         switch (ph->p_type) {
 838
 839         case PT_PHDR:
 840             if ((const Elf_Phdr *)ph->p_vaddr != phdr) {
 841                 _rtld_error("%s: invalid PT_PHDR", path);
 842                 return NULL;
 843             }
 844             obj->phdr = (const Elf_Phdr *) ph->p_vaddr;
 845             obj->phsize = ph->p_memsz;
 846             break;
 847
 848         case PT_INTERP:
 849             obj->interp = (const char *) ph->p_vaddr;
 850             break;
 851
 852         case PT_LOAD:
 853             if (nsegs == 0) {   /* First load segment */
 854                 obj->vaddrbase = trunc_page(ph->p_vaddr);
 855                 obj->mapbase = (caddr_t) obj->vaddrbase;
 856                 obj->relocbase = obj->mapbase - obj->vaddrbase;
 857                 obj->textsize = round_page(ph->p_vaddr + ph->p_memsz) -
 858                   obj->vaddrbase;
 859             } else {            /* Last load segment */
 860                 obj->mapsize = round_page(ph->p_vaddr + ph->p_memsz) -
 861                   obj->vaddrbase;
 862             }
 863             nsegs++;
 864             break;
 865
 866         case PT_DYNAMIC:
 867             obj->dynamic = (const Elf_Dyn *) ph->p_vaddr;
 868             break;
 869
 870         case PT_TLS:
 871             obj->tlsindex = 1;
 872             obj->tlssize = ph->p_memsz;
 873             obj->tlsalign = ph->p_align;
 874             obj->tlsinitsize = ph->p_filesz;
 875             obj->tlsinit = (void*) ph->p_vaddr;
 876             break;
 877         }
 878     }
 879     if (nsegs < 1) {
 880         _rtld_error("%s: too few PT_LOAD segments", path);
 881         return NULL;
 882     }
 883
 884     obj->entry = entry;
 885     return obj;
 886 }
 887
 888 static Obj_Entry *
 889 dlcheck(void *handle)
 890 {
 891     Obj_Entry *obj;
 892
 893     for (obj = obj_list;  obj != NULL;  obj = obj->next)
 894         if (obj == (Obj_Entry *) handle)
 895             break;
 896
 897     if (obj == NULL || obj->refcount == 0 || obj->dl_refcount == 0) {
 898         _rtld_error("Invalid shared object handle %p", handle);
 899         return NULL;
 900     }
 901     return obj;
 902 }
 903
 904 /*
 905  * If the given object is already in the donelist, return true.  Otherwise
 906  * add the object to the list and return false.
 907  */
 908 static bool
 909 donelist_check(DoneList *dlp, const Obj_Entry *obj)
 910 {
 911     unsigned int i;
 912
 913     for (i = 0;  i < dlp->num_used;  i++)
 914         if (dlp->objs[i] == obj)
 915             return true;
 916     /*
 917      * Our donelist allocation should always be sufficient.  But if
 918      * our threads locking isn't working properly, more shared objects
 919      * could have been loaded since we allocated the list.  That should
 920      * never happen, but we'll handle it properly just in case it does.
 921      */
 922     if (dlp->num_used < dlp->num_alloc)
 923         dlp->objs[dlp->num_used++] = obj;
 924     return false;
 925 }
 926
 927 /*
 928  * Hash function for symbol table lookup.  Don't even think about changing
 929  * this.  It is specified by the System V ABI.
 930  */
 931 unsigned long
 932 elf_hash(const char *name)
 933 {
 934     const unsigned char *p = (const unsigned char *) name;
 935     unsigned long h = 0;
 936     unsigned long g;
 937
 938     while (*p != '\0') {
 939         h = (h << 4) + *p++;
 940         if ((g = h & 0xf0000000) != 0)
 941             h ^= g >> 24;
 942         h &= ~g;
 943     }
 944     return h;
 945 }
 946
 947 /*
 948  * Find the library with the given name, and return its full pathname.
 949  * The returned string is dynamically allocated.  Generates an error
 950  * message and returns NULL if the library cannot be found.
 951  *
 952  * If the second argument is non-NULL, then it refers to an already-
 953  * loaded shared object, whose library search path will be searched.
 954  *
 955  * The search order is:
 956  *   LD_LIBRARY_PATH
 957  *   rpath in the referencing file
 958  *   ldconfig hints
 959  *   /usr/lib
 960  */
 961 static char *
 962 find_library(const char *name, const Obj_Entry *refobj)
 963 {
 964     char *pathname;
 965
 966     if (strchr(name, '/') != NULL) {    /* Hard coded pathname */
 967         if (name[0] != '/' && !trust) {
 968             _rtld_error("Absolute pathname required for shared object \"%s\"",
 969               name);
 970             return NULL;
 971         }
 972         return xstrdup(name);
 973     }
 974
 975     dbg(" Searching for \"%s\"", name);
 976
 977     if ((pathname = search_library_path(name, ld_library_path)) != NULL ||
 978       (refobj != NULL &&
 979       (pathname = search_library_path(name, refobj->rpath)) != NULL) ||
 980       (pathname = search_library_path(name, gethints())) != NULL ||
 981       (pathname = search_library_path(name, STANDARD_LIBRARY_PATH)) != NULL)
 982         return pathname;
 983
 984     if(refobj != NULL && refobj->path != NULL) {
 985         _rtld_error("Shared object \"%s\" not found, required by \"%s\"",
 986           name, basename(refobj->path));
 987     } else {
 988         _rtld_error("Shared object \"%s\" not found", name);
 989     }
 990     return NULL;
 991 }
 992
 993 /*
 994  * Given a symbol number in a referencing object, find the corresponding
 995  * definition of the symbol.  Returns a pointer to the symbol, or NULL if
 996  * no definition was found.  Returns a pointer to the Obj_Entry of the
 997  * defining object via the reference parameter DEFOBJ_OUT.
 998  */
 999 const Elf_Sym *
1000 find_symdef(unsigned long symnum, const Obj_Entry *refobj,
1001     const Obj_Entry **defobj_out, bool in_plt, SymCache *cache)
1002 {
1003     const Elf_Sym *ref;
1004     const Elf_Sym *def;
1005     const Obj_Entry *defobj;
1006     const char *name;
1007     unsigned long hash;
1008
1009     /*
1010      * If we have already found this symbol, get the information from
1011      * the cache.
1012      */
1013     if (symnum >= refobj->nchains)
1014         return NULL;    /* Bad object */
1015     if (cache != NULL && cache[symnum].sym != NULL) {
1016         *defobj_out = cache[symnum].obj;
1017         return cache[symnum].sym;
1018     }
1019
1020     ref = refobj->symtab + symnum;
1021     name = refobj->strtab + ref->st_name;
1022     defobj = NULL;
1023
1024     /*
1025      * We don't have to do a full scale lookup if the symbol is local.
1026      * We know it will bind to the instance in this load module; to
1027      * which we already have a pointer (ie ref). By not doing a lookup,
1028      * we not only improve performance, but it also avoids unresolvable
1029      * symbols when local symbols are not in the hash table.
1030      *
1031      * This might occur for TLS module relocations, which simply use
1032      * symbol 0.
1033      */
1034     if (ELF_ST_BIND(ref->st_info) != STB_LOCAL) {
1035         if (ELF_ST_TYPE(ref->st_info) == STT_SECTION) {
1036             _rtld_error("%s: Bogus symbol table entry %lu", refobj->path,
1037                 symnum);
1038         }
1039         hash = elf_hash(name);
1040         def = symlook_default(name, hash, refobj, &defobj, in_plt);
1041     } else {
1042         def = ref;
1043         defobj = refobj;
1044     }
1045
1046     /*
1047      * If we found no definition and the reference is weak, treat the
1048      * symbol as having the value zero.
1049      */
1050     if (def == NULL && ELF_ST_BIND(ref->st_info) == STB_WEAK) {
1051         def = &sym_zero;
1052         defobj = obj_main;
1053     }
1054
1055     if (def != NULL) {
1056         *defobj_out = defobj;
1057         /* Record the information in the cache to avoid subsequent lookups. */
1058         if (cache != NULL) {
1059             cache[symnum].sym = def;
1060             cache[symnum].obj = defobj;
1061         }
1062     } else
1063         _rtld_error("%s: Undefined symbol \"%s\"", refobj->path, name);
1064     return def;
1065 }
1066
1067 /*
1068  * Return the search path from the ldconfig hints file, reading it if
1069  * necessary.  Returns NULL if there are problems with the hints file,
1070  * or if the search path there is empty.
1071  */
1072 static const char *
1073 gethints(void)
1074 {
1075     static char *hints;
1076
1077     if (hints == NULL) {
1078         int fd;
1079         struct elfhints_hdr hdr;
1080         char *p;
1081
1082         /* Keep from trying again in case the hints file is bad. */
1083         hints = "";
1084
1085         if ((fd = open(_PATH_ELF_HINTS, O_RDONLY)) == -1)
1086             return NULL;
1087         if (read(fd, &hdr, sizeof hdr) != sizeof hdr ||
1088           hdr.magic != ELFHINTS_MAGIC ||
1089           hdr.version != 1) {
1090             close(fd);
1091             return NULL;
1092         }
1093         p = xmalloc(hdr.dirlistlen + 1);
1094         if (lseek(fd, hdr.strtab + hdr.dirlist, SEEK_SET) == -1 ||
1095           read(fd, p, hdr.dirlistlen + 1) != hdr.dirlistlen + 1) {
1096             free(p);
1097             close(fd);
1098             return NULL;
1099         }
1100         hints = p;
1101         close(fd);
1102     }
1103     return hints[0] != '\0' ? hints : NULL;
1104 }
1105
1106 static void
1107 init_dag(Obj_Entry *root)
1108 {
1109     DoneList donelist;
1110
1111     donelist_init(&donelist);
1112     init_dag1(root, root, &donelist);
1113 }
1114
1115 static void
1116 init_dag1(Obj_Entry *root, Obj_Entry *obj, DoneList *dlp)
1117 {
1118     const Needed_Entry *needed;
1119
1120     if (donelist_check(dlp, obj))
1121         return;
1122     objlist_push_tail(&obj->dldags, root);
1123     objlist_push_tail(&root->dagmembers, obj);
1124     for (needed = obj->needed;  needed != NULL;  needed = needed->next)
1125         if (needed->obj != NULL)
1126             init_dag1(root, needed->obj, dlp);
1127 }
1128
1129 /*
1130  * Initialize the dynamic linker.  The argument is the address at which
1131  * the dynamic linker has been mapped into memory.  The primary task of
1132  * this function is to relocate the dynamic linker.
1133  */
1134 static void
1135 init_rtld(caddr_t mapbase)
1136 {
1137     Obj_Entry objtmp;   /* Temporary rtld object */
1138
1139     /*
1140      * Conjure up an Obj_Entry structure for the dynamic linker.
1141      *
1142      * The "path" member can't be initialized yet because string constatns
1143      * cannot yet be acessed. Below we will set it correctly.
1144      */
1145     objtmp.path = NULL;
1146     objtmp.rtld = true;
1147     objtmp.mapbase = mapbase;
1148 #ifdef PIC
1149     objtmp.relocbase = mapbase;
1150 #endif
1151     if (&_DYNAMIC != 0) {
1152         objtmp.dynamic = rtld_dynamic(&objtmp);
1153         digest_dynamic(&objtmp, 1);
1154         assert(objtmp.needed == NULL);
1155         assert(!objtmp.textrel);
1156
1157         /*
1158          * Temporarily put the dynamic linker entry into the object list, so
1159          * that symbols can be found.
1160          */
1161
1162         relocate_objects(&objtmp, true, &objtmp);
1163     }
1164
1165     /* Initialize the object list. */
1166     obj_tail = &obj_list;
1167
1168     /* Now that non-local variables can be accesses, copy out obj_rtld. */
1169     memcpy(&obj_rtld, &objtmp, sizeof(obj_rtld));
1170
1171     /* Replace the path with a dynamically allocated copy. */
1172     obj_rtld.path = xstrdup(PATH_RTLD);
1173
1174     r_debug.r_brk = r_debug_state;
1175     r_debug.r_state = RT_CONSISTENT;
1176 }
1177
1178 /*
1179  * Add the init functions from a needed object list (and its recursive
1180  * needed objects) to "list".  This is not used directly; it is a helper
1181  * function for initlist_add_objects().  The write lock must be held
1182  * when this function is called.
1183  */
1184 static void
1185 initlist_add_neededs(Needed_Entry *needed, Objlist *list)
1186 {
1187     /* Recursively process the successor needed objects. */
1188     if (needed->next != NULL)
1189         initlist_add_neededs(needed->next, list);
1190
1191     /* Process the current needed object. */
1192     if (needed->obj != NULL)
1193         initlist_add_objects(needed->obj, &needed->obj->next, list);
1194 }
1195
1196 /*
1197  * Scan all of the DAGs rooted in the range of objects from "obj" to
1198  * "tail" and add their init functions to "list".  This recurses over
1199  * the DAGs and ensure the proper init ordering such that each object's
1200  * needed libraries are initialized before the object itself.  At the
1201  * same time, this function adds the objects to the global finalization
1202  * list "list_fini" in the opposite order.  The write lock must be
1203  * held when this function is called.
1204  */
1205 static void
1206 initlist_add_objects(Obj_Entry *obj, Obj_Entry **tail, Objlist *list)
1207 {
1208     if (obj->init_done)
1209         return;
1210     obj->init_done = true;
1211
1212     /* Recursively process the successor objects. */
1213     if (&obj->next != tail)
1214         initlist_add_objects(obj->next, tail, list);
1215
1216     /* Recursively process the needed objects. */
1217     if (obj->needed != NULL)
1218         initlist_add_neededs(obj->needed, list);
1219
1220     /* Add the object to the init list. */
1221     if (obj->init != NULL)
1222         objlist_push_tail(list, obj);
1223
1224     /* Add the object to the global fini list in the reverse order. */
1225     if (obj->fini != NULL)
1226         objlist_push_head(&list_fini, obj);
1227 }
1228
1229 static bool
1230 is_exported(const Elf_Sym *def)
1231 {
1232     Elf_Addr value;
1233     const func_ptr_type *p;
1234
1235     value = (Elf_Addr)(obj_rtld.relocbase + def->st_value);
1236     for (p = exports;  *p != NULL;  p++) {
1237         if ((Elf_Addr)(*p) == value)
1238             return true;
1239     }
1240     return false;
1241 }
1242
1243 /*
1244  * Given a shared object, traverse its list of needed objects, and load
1245  * each of them.  Returns 0 on success.  Generates an error message and
1246  * returns -1 on failure.
1247  */
1248 static int
1249 load_needed_objects(Obj_Entry *first)
1250 {
1251     Obj_Entry *obj;
1252
1253     for (obj = first;  obj != NULL;  obj = obj->next) {
1254         Needed_Entry *needed;
1255
1256         for (needed = obj->needed;  needed != NULL;  needed = needed->next) {
1257             const char *name = obj->strtab + needed->name;
1258             char *path = find_library(name, obj);
1259
1260             needed->obj = NULL;
1261             if (path == NULL && !ld_tracing)
1262                 return -1;
1263
1264             if (path) {
1265                 needed->obj = load_object(path);
1266                 if (needed->obj == NULL && !ld_tracing)
1267                     return -1;          /* XXX - cleanup */
1268             }
1269         }
1270     }
1271
1272     return 0;
1273 }
1274
1275 #define RTLD_FUNCTRACE "_rtld_functrace"
1276
1277 static int
1278 load_preload_objects(void)
1279 {
1280     char *p = ld_preload;
1281     static const char delim[] = " \t:;";
1282
1283     if (p == NULL)
1284         return 0;
1285
1286     p += strspn(p, delim);
1287     while (*p != '\0') {
1288         size_t len = strcspn(p, delim);
1289         char *path;
1290         char savech;
1291         Obj_Entry *obj;
1292         const Elf_Sym *sym;
1293
1294         savech = p[len];
1295         p[len] = '\0';
1296         if ((path = find_library(p, NULL)) == NULL)
1297             return -1;
1298         obj = load_object(path);
1299         if (obj == NULL)
1300             return -1;  /* XXX - cleanup */
1301         p[len] = savech;
1302         p += len;
1303         p += strspn(p, delim);
1304
1305         /* Check for the magic tracing function */
1306         sym = symlook_obj(RTLD_FUNCTRACE, elf_hash(RTLD_FUNCTRACE), obj, true);
1307         if (sym != NULL) {
1308                 rtld_functrace = (void *)(obj->relocbase + sym->st_value);
1309                 rtld_functrace_obj = obj;
1310         }
1311     }
1312     return 0;
1313 }
1314
1315 /*
1316  * Returns a pointer to the Obj_Entry for the object with the given path.
1317  * Returns NULL if no matching object was found.
1318  */
1319 static Obj_Entry *
1320 find_object(const char *path)
1321 {
1322     Obj_Entry *obj;
1323
1324     for (obj = obj_list->next;  obj != NULL;  obj = obj->next) {
1325         if (strcmp(obj->path, path) == 0)
1326             return(obj);
1327     }
1328     return(NULL);
1329 }
1330
1331 /*
1332  * Returns a pointer to the Obj_Entry for the object matching device and
1333  * inode of the given path. If no matching object was found, the descriptor
1334  * is returned in fd.
1335  * Returns with obj == NULL && fd == -1 on error.
1336  */
1337 static Obj_Entry *
1338 find_object2(const char *path, int *fd, struct stat *sb)
1339 {
1340     Obj_Entry *obj;
1341
1342     if ((*fd = open(path, O_RDONLY)) == -1) {
1343         _rtld_error("Cannot open \"%s\"", path);
1344         return(NULL);
1345     }
1346
1347     if (fstat(*fd, sb) == -1) {
1348         _rtld_error("Cannot fstat \"%s\"", path);
1349         close(*fd);
1350         *fd = -1;
1351         return NULL;
1352     }
1353
1354     for (obj = obj_list->next;  obj != NULL;  obj = obj->next) {
1355         if (obj->ino == sb->st_ino && obj->dev == sb->st_dev) {
1356             close(*fd);
1357             break;
1358         }
1359     }
1360
1361     return(obj);
1362 }
1363
1364 /*
1365  * Load a shared object into memory, if it is not already loaded.  The
1366  * argument must be a string allocated on the heap.  This function assumes
1367  * responsibility for freeing it when necessary.
1368  *
1369  * Returns a pointer to the Obj_Entry for the object.  Returns NULL
1370  * on failure.
1371  */
1372 static Obj_Entry *
1373 load_object(char *path)
1374 {
1375     Obj_Entry *obj;
1376     int fd = -1;
1377     struct stat sb;
1378
1379     obj = find_object(path);
1380     if (obj != NULL) {
1381         obj->refcount++;
1382         free(path);
1383         return(obj);
1384     }
1385
1386     obj = find_object2(path, &fd, &sb);
1387     if (obj != NULL) {
1388         obj->refcount++;
1389         free(path);
1390         return(obj);
1391     } else if (fd == -1) {
1392         free(path);
1393         return(NULL);
1394     }
1395
1396     dbg("loading \"%s\"", path);
1397     obj = map_object(fd, path, &sb);
1398     close(fd);
1399     if (obj == NULL) {
1400         free(path);
1401         return NULL;
1402     }
1403
1404     obj->path = path;
1405     digest_dynamic(obj, 0);
1406
1407     *obj_tail = obj;
1408     obj_tail = &obj->next;
1409     obj_count++;
1410     linkmap_add(obj);   /* for GDB & dlinfo() */
1411
1412     dbg("  %p .. %p: %s", obj->mapbase, obj->mapbase + obj->mapsize - 1,
1413         obj->path);
1414     if (obj->textrel)
1415         dbg("  WARNING: %s has impure text", obj->path);
1416
1417     obj->refcount++;
1418     return obj;
1419 }
1420
1421 /*
1422  * Check for locking violations and die if one is found.
1423  */
1424 static void
1425 lock_check(void)
1426 {
1427     int rcount, wcount;
1428
1429     rcount = lockinfo.rcount;
1430     wcount = lockinfo.wcount;
1431     assert(rcount >= 0);
1432     assert(wcount >= 0);
1433     if (wcount > 1 || (wcount != 0 && rcount != 0)) {
1434         _rtld_error("Application locking error: %d readers and %d writers"
1435           " in dynamic linker.  See DLLOCKINIT(3) in manual pages.",
1436           rcount, wcount);
1437         die();
1438     }
1439 }
1440
1441 static Obj_Entry *
1442 obj_from_addr(const void *addr)
1443 {
1444     Obj_Entry *obj;
1445
1446     for (obj = obj_list;  obj != NULL;  obj = obj->next) {
1447         if (addr < (void *) obj->mapbase)
1448             continue;
1449         if (addr < (void *) (obj->mapbase + obj->mapsize))
1450             return obj;
1451     }
1452     return NULL;
1453 }
1454
1455 /*
1456  * Call the finalization functions for each of the objects in "list"
1457  * which are unreferenced.  All of the objects are expected to have
1458  * non-NULL fini functions.
1459  */
1460 static void
1461 objlist_call_fini(Objlist *list)
1462 {
1463     Objlist_Entry *elm;
1464     char *saved_msg;
1465
1466     /*
1467      * Preserve the current error message since a fini function might
1468      * call into the dynamic linker and overwrite it.
1469      */
1470     saved_msg = errmsg_save();
1471     STAILQ_FOREACH(elm, list, link) {
1472         if (elm->obj->refcount == 0) {
1473             dbg("calling fini function for %s", elm->obj->path);
1474             (*elm->obj->fini)();
1475         }
1476     }
1477     errmsg_restore(saved_msg);
1478 }
1479
1480 /*
1481  * Call the initialization functions for each of the objects in
1482  * "list".  All of the objects are expected to have non-NULL init
1483  * functions.
1484  */
1485 static void
1486 objlist_call_init(Objlist *list)
1487 {
1488     Objlist_Entry *elm;
1489     char *saved_msg;
1490
1491     /*
1492      * Preserve the current error message since an init function might
1493      * call into the dynamic linker and overwrite it.
1494      */
1495     saved_msg = errmsg_save();
1496     STAILQ_FOREACH(elm, list, link) {
1497         dbg("calling init function for %s", elm->obj->path);
1498         (*elm->obj->init)();
1499     }
1500     errmsg_restore(saved_msg);
1501 }
1502
1503 static void
1504 objlist_clear(Objlist *list)
1505 {
1506     Objlist_Entry *elm;
1507
1508     while (!STAILQ_EMPTY(list)) {
1509         elm = STAILQ_FIRST(list);
1510         STAILQ_REMOVE_HEAD(list, link);
1511         free(elm);
1512     }
1513 }
1514
1515 static Objlist_Entry *
1516 objlist_find(Objlist *list, const Obj_Entry *obj)
1517 {
1518     Objlist_Entry *elm;
1519
1520     STAILQ_FOREACH(elm, list, link)
1521         if (elm->obj == obj)
1522             return elm;
1523     return NULL;
1524 }
1525
1526 static void
1527 objlist_init(Objlist *list)
1528 {
1529     STAILQ_INIT(list);
1530 }
1531
1532 static void
1533 objlist_push_head(Objlist *list, Obj_Entry *obj)
1534 {
1535     Objlist_Entry *elm;
1536
1537     elm = NEW(Objlist_Entry);
1538     elm->obj = obj;
1539     STAILQ_INSERT_HEAD(list, elm, link);
1540 }
1541
1542 static void
1543 objlist_push_tail(Objlist *list, Obj_Entry *obj)
1544 {
1545     Objlist_Entry *elm;
1546
1547     elm = NEW(Objlist_Entry);
1548     elm->obj = obj;
1549     STAILQ_INSERT_TAIL(list, elm, link);
1550 }
1551
1552 static void
1553 objlist_remove(Objlist *list, Obj_Entry *obj)
1554 {
1555     Objlist_Entry *elm;
1556
1557     if ((elm = objlist_find(list, obj)) != NULL) {
1558         STAILQ_REMOVE(list, elm, Struct_Objlist_Entry, link);
1559         free(elm);
1560     }
1561 }
1562
1563 /*
1564  * Remove all of the unreferenced objects from "list".
1565  */
1566 static void
1567 objlist_remove_unref(Objlist *list)
1568 {
1569     Objlist newlist;
1570     Objlist_Entry *elm;
1571
1572     STAILQ_INIT(&newlist);
1573     while (!STAILQ_EMPTY(list)) {
1574         elm = STAILQ_FIRST(list);
1575         STAILQ_REMOVE_HEAD(list, link);
1576         if (elm->obj->refcount == 0)
1577             free(elm);
1578         else
1579             STAILQ_INSERT_TAIL(&newlist, elm, link);
1580     }
1581     *list = newlist;
1582 }
1583
1584 /*
1585  * Relocate newly-loaded shared objects.  The argument is a pointer to
1586  * the Obj_Entry for the first such object.  All objects from the first
1587  * to the end of the list of objects are relocated.  Returns 0 on success,
1588  * or -1 on failure.
1589  */
1590 static int
1591 relocate_objects(Obj_Entry *first, bool bind_now, Obj_Entry *rtldobj)
1592 {
1593     Obj_Entry *obj;
1594
1595     for (obj = first;  obj != NULL;  obj = obj->next) {
1596         if (obj != rtldobj)
1597             dbg("relocating \"%s\"", obj->path);
1598         if (obj->nbuckets == 0 || obj->nchains == 0 || obj->buckets == NULL ||
1599             obj->symtab == NULL || obj->strtab == NULL) {
1600             _rtld_error("%s: Shared object has no run-time symbol table",
1601               obj->path);
1602             return -1;
1603         }
1604
1605         if (obj->textrel) {
1606             /* There are relocations to the write-protected text segment. */
1607             if (mprotect(obj->mapbase, obj->textsize,
1608               PROT_READ|PROT_WRITE|PROT_EXEC) == -1) {
1609                 _rtld_error("%s: Cannot write-enable text segment: %s",
1610                   obj->path, strerror(errno));
1611                 return -1;
1612             }
1613         }
1614
1615         /* Process the non-PLT relocations. */
1616         if (reloc_non_plt(obj, rtldobj))
1617                 return -1;
1618
1619         /*
1620          * Reprotect the text segment.  Make sure it is included in the
1621          * core dump since we modified it.  This unfortunately causes the
1622          * entire text segment to core-out but we don't have much of a
1623          * choice.  We could try to only reenable core dumps on pages
1624          * in which relocations occured but that is likely most of the text
1625          * pages anyway, and even that would not work because the rest of
1626          * the text pages would wind up as a read-only OBJT_DEFAULT object
1627          * (created due to our modifications) backed by the original OBJT_VNODE
1628          * object, and the ELF coredump code is currently only able to dump
1629          * vnode records for pure vnode-backed mappings, not vnode backings
1630          * to memory objects.
1631          */
1632         if (obj->textrel) {
1633             madvise(obj->mapbase, obj->textsize, MADV_CORE);
1634             if (mprotect(obj->mapbase, obj->textsize,
1635               PROT_READ|PROT_EXEC) == -1) {
1636                 _rtld_error("%s: Cannot write-protect text segment: %s",
1637                   obj->path, strerror(errno));
1638                 return -1;
1639             }
1640         }
1641
1642         /* Process the PLT relocations. */
1643         if (reloc_plt(obj) == -1)
1644             return -1;
1645         /* Relocate the jump slots if we are doing immediate binding. */
1646         if (obj->bind_now || bind_now)
1647             if (reloc_jmpslots(obj) == -1)
1648                 return -1;
1649
1650
1651         /*
1652          * Set up the magic number and version in the Obj_Entry.  These
1653          * were checked in the crt1.o from the original ElfKit, so we
1654          * set them for backward compatibility.
1655          */
1656         obj->magic = RTLD_MAGIC;
1657         obj->version = RTLD_VERSION;
1658
1659         /* Set the special PLT or GOT entries. */
1660         init_pltgot(obj);
1661     }
1662
1663     return 0;
1664 }
1665
1666 /*
1667  * Cleanup procedure.  It will be called (by the atexit mechanism) just
1668  * before the process exits.
1669  */
1670 static void
1671 rtld_exit(void)
1672 {
1673     Obj_Entry *obj;
1674
1675     dbg("rtld_exit()");
1676     /* Clear all the reference counts so the fini functions will be called. */
1677     for (obj = obj_list;  obj != NULL;  obj = obj->next)
1678         obj->refcount = 0;
1679     objlist_call_fini(&list_fini);
1680     /* No need to remove the items from the list, since we are exiting. */
1681 }
1682
1683 static void *
1684 path_enumerate(const char *path, path_enum_proc callback, void *arg)
1685 {
1686     if (path == NULL)
1687         return (NULL);
1688
1689     path += strspn(path, ":;");
1690     while (*path != '\0') {
1691         size_t len;
1692         char  *res;
1693
1694         len = strcspn(path, ":;");
1695         res = callback(path, len, arg);
1696
1697         if (res != NULL)
1698             return (res);
1699
1700         path += len;
1701         path += strspn(path, ":;");
1702     }
1703
1704     return (NULL);
1705 }
1706
1707 struct try_library_args {
1708     const char  *name;
1709     size_t       namelen;
1710     char        *buffer;
1711     size_t       buflen;
1712 };
1713
1714 static void *
1715 try_library_path(const char *dir, size_t dirlen, void *param)
1716 {
1717     struct try_library_args *arg;
1718
1719     arg = param;
1720     if (*dir == '/' || trust) {
1721         char *pathname;
1722
1723         if (dirlen + 1 + arg->namelen + 1 > arg->buflen)
1724                 return (NULL);
1725
1726         pathname = arg->buffer;
1727         strncpy(pathname, dir, dirlen);
1728         pathname[dirlen] = '/';
1729         strcpy(pathname + dirlen + 1, arg->name);
1730
1731         dbg("  Trying \"%s\"", pathname);
1732         if (access(pathname, F_OK) == 0) {              /* We found it */
1733             pathname = xmalloc(dirlen + 1 + arg->namelen + 1);
1734             strcpy(pathname, arg->buffer);
1735             return (pathname);
1736         }
1737     }
1738     return (NULL);
1739 }
1740
1741 static char *
1742 search_library_path(const char *name, const char *path)
1743 {
1744     char *p;
1745     struct try_library_args arg;
1746
1747     if (path == NULL)
1748         return NULL;
1749
1750     arg.name = name;
1751     arg.namelen = strlen(name);
1752     arg.buffer = xmalloc(PATH_MAX);
1753     arg.buflen = PATH_MAX;
1754
1755     p = path_enumerate(path, try_library_path, &arg);
1756
1757     free(arg.buffer);
1758
1759     return (p);
1760 }
1761
1762 int
1763 dlclose(void *handle)
1764 {
1765     Obj_Entry *root;
1766
1767     wlock_acquire();
1768     root = dlcheck(handle);
1769     if (root == NULL) {
1770         wlock_release();
1771         return -1;
1772     }
1773
1774     /* Unreference the object and its dependencies. */
1775     root->dl_refcount--;
1776     unref_dag(root);
1777
1778     if (root->refcount == 0) {
1779         /*
1780          * The object is no longer referenced, so we must unload it.
1781          * First, call the fini functions with no locks held.
1782          */
1783         wlock_release();
1784         objlist_call_fini(&list_fini);
1785         wlock_acquire();
1786         objlist_remove_unref(&list_fini);
1787
1788         /* Finish cleaning up the newly-unreferenced objects. */
1789         GDB_STATE(RT_DELETE,&root->linkmap);
1790         unload_object(root);
1791         GDB_STATE(RT_CONSISTENT,NULL);
1792     }
1793     wlock_release();
1794     return 0;
1795 }
1796
1797 const char *
1798 dlerror(void)
1799 {
1800     char *msg = error_message;
1801     error_message = NULL;
1802     return msg;
1803 }
1804
1805 void *
1806 dlopen(const char *name, int mode)
1807 {
1808     Obj_Entry **old_obj_tail;
1809     Obj_Entry *obj;
1810     Objlist initlist;
1811     int result;
1812
1813     ld_tracing = (mode & RTLD_TRACE) == 0 ? NULL : "1";
1814     if (ld_tracing != NULL)
1815         environ = (char **)*get_program_var_addr("environ");
1816
1817     objlist_init(&initlist);
1818
1819     wlock_acquire();
1820     GDB_STATE(RT_ADD,NULL);
1821
1822     old_obj_tail = obj_tail;
1823     obj = NULL;
1824     if (name == NULL) {
1825         obj = obj_main;
1826         obj->refcount++;
1827     } else {
1828         char *path = find_library(name, obj_main);
1829         if (path != NULL)
1830             obj = load_object(path);
1831     }
1832
1833     if (obj) {
1834         obj->dl_refcount++;
1835         if ((mode & RTLD_GLOBAL) && objlist_find(&list_global, obj) == NULL)
1836             objlist_push_tail(&list_global, obj);
1837         mode &= RTLD_MODEMASK;
1838         if (*old_obj_tail != NULL) {            /* We loaded something new. */
1839             assert(*old_obj_tail == obj);
1840
1841             result = load_needed_objects(obj);
1842             if (result != -1 && ld_tracing)
1843                 goto trace;
1844
1845             if (result == -1 ||
1846               (init_dag(obj), relocate_objects(obj, mode == RTLD_NOW,
1847                &obj_rtld)) == -1) {
1848                 obj->dl_refcount--;
1849                 unref_dag(obj);
1850                 if (obj->refcount == 0)
1851                     unload_object(obj);
1852                 obj = NULL;
1853             } else {
1854                 /* Make list of init functions to call. */
1855                 initlist_add_objects(obj, &obj->next, &initlist);
1856             }
1857         } else if (ld_tracing)
1858             goto trace;
1859     }
1860
1861     GDB_STATE(RT_CONSISTENT,obj ? &obj->linkmap : NULL);
1862
1863     /* Call the init functions with no locks held. */
1864     wlock_release();
1865     objlist_call_init(&initlist);
1866     wlock_acquire();
1867     objlist_clear(&initlist);
1868     wlock_release();
1869     return obj;
1870 trace:
1871     trace_loaded_objects(obj);
1872     wlock_release();
1873     exit(0);
1874 }
1875
1876 void *
1877 dlsym(void *handle, const char *name)
1878 {
1879     const Obj_Entry *obj;
1880     unsigned long hash;
1881     const Elf_Sym *def;
1882     const Obj_Entry *defobj;
1883
1884     hash = elf_hash(name);
1885     def = NULL;
1886     defobj = NULL;
1887
1888     rlock_acquire();
1889     if (handle == NULL || handle == RTLD_NEXT ||
1890         handle == RTLD_DEFAULT || handle == RTLD_SELF) {
1891         void *retaddr;
1892
1893         retaddr = __builtin_return_address(0);  /* __GNUC__ only */
1894         if ((obj = obj_from_addr(retaddr)) == NULL) {
1895             _rtld_error("Cannot determine caller's shared object");
1896             rlock_release();
1897             return NULL;
1898         }
1899         if (handle == NULL) {   /* Just the caller's shared object. */
1900             def = symlook_obj(name, hash, obj, true);
1901             defobj = obj;
1902         } else if (handle == RTLD_NEXT || /* Objects after caller's */
1903                    handle == RTLD_SELF) { /* ... caller included */
1904             if (handle == RTLD_NEXT)
1905                 obj = obj->next;
1906             for (; obj != NULL; obj = obj->next) {
1907                 if ((def = symlook_obj(name, hash, obj, true)) != NULL) {
1908                     defobj = obj;
1909                     break;
1910                 }
1911             }
1912         } else {
1913             assert(handle == RTLD_DEFAULT);
1914             def = symlook_default(name, hash, obj, &defobj, true);
1915         }
1916     } else {
1917         DoneList donelist;
1918
1919         if ((obj = dlcheck(handle)) == NULL) {
1920             rlock_release();
1921             return NULL;
1922         }
1923
1924         donelist_init(&donelist);
1925         if (obj->mainprog) {
1926             /* Search main program and all libraries loaded by it. */
1927             def = symlook_list(name, hash, &list_main, &defobj, true,
1928               &donelist);
1929         } else {
1930             Needed_Entry fake;
1931
1932             /* Search the given object and its needed objects. */
1933             fake.next = NULL;
1934             fake.obj = (Obj_Entry *)obj;
1935             fake.name = 0;
1936             def = symlook_needed(name, hash, &fake, &defobj, true,
1937               &donelist);
1938         }
1939     }
1940
1941     if (def != NULL) {
1942         rlock_release();
1943         return defobj->relocbase + def->st_value;
1944     }
1945
1946     _rtld_error("Undefined symbol \"%s\"", name);
1947     rlock_release();
1948     return NULL;
1949 }
1950
1951 int
1952 dladdr(const void *addr, Dl_info *info)
1953 {
1954     const Obj_Entry *obj;
1955     const Elf_Sym *def;
1956     void *symbol_addr;
1957     unsigned long symoffset;
1958
1959     rlock_acquire();
1960     obj = obj_from_addr(addr);
1961     if (obj == NULL) {
1962         _rtld_error("No shared object contains address");
1963         rlock_release();
1964         return 0;
1965     }
1966     info->dli_fname = obj->path;
1967     info->dli_fbase = obj->mapbase;
1968     info->dli_saddr = (void *)0;
1969     info->dli_sname = NULL;
1970
1971     /*
1972      * Walk the symbol list looking for the symbol whose address is
1973      * closest to the address sent in.
1974      */
1975     for (symoffset = 0; symoffset < obj->nchains; symoffset++) {
1976         def = obj->symtab + symoffset;
1977
1978         /*
1979          * For skip the symbol if st_shndx is either SHN_UNDEF or
1980          * SHN_COMMON.
1981          */
1982         if (def->st_shndx == SHN_UNDEF || def->st_shndx == SHN_COMMON)
1983             continue;
1984
1985         /*
1986          * If the symbol is greater than the specified address, or if it
1987          * is further away from addr than the current nearest symbol,
1988          * then reject it.
1989          */
1990         symbol_addr = obj->relocbase + def->st_value;
1991         if (symbol_addr > addr || symbol_addr < info->dli_saddr)
1992             continue;
1993
1994         /* Update our idea of the nearest symbol. */
1995         info->dli_sname = obj->strtab + def->st_name;
1996         info->dli_saddr = symbol_addr;
1997
1998         /* Exact match? */
1999         if (info->dli_saddr == addr)
2000             break;
2001     }
2002     rlock_release();
2003     return 1;
2004 }
2005
2006 int
2007 dlinfo(void *handle, int request, void *p)
2008 {
2009     const Obj_Entry *obj;
2010     int error;
2011
2012     rlock_acquire();
2013
2014     if (handle == NULL || handle == RTLD_SELF) {
2015         void *retaddr;
2016
2017         retaddr = __builtin_return_address(0);  /* __GNUC__ only */
2018         if ((obj = obj_from_addr(retaddr)) == NULL)
2019             _rtld_error("Cannot determine caller's shared object");
2020     } else
2021         obj = dlcheck(handle);
2022
2023     if (obj == NULL) {
2024         rlock_release();
2025         return (-1);
2026     }
2027
2028     error = 0;
2029     switch (request) {
2030     case RTLD_DI_LINKMAP:
2031         *((struct link_map const **)p) = &obj->linkmap;
2032         break;
2033     case RTLD_DI_ORIGIN:
2034         error = rtld_dirname(obj->path, p);
2035         break;
2036
2037     case RTLD_DI_SERINFOSIZE:
2038     case RTLD_DI_SERINFO:
2039         error = do_search_info(obj, request, (struct dl_serinfo *)p);
2040         break;
2041
2042     default:
2043         _rtld_error("Invalid request %d passed to dlinfo()", request);
2044         error = -1;
2045     }
2046
2047     rlock_release();
2048
2049     return (error);
2050 }
2051
2052 struct fill_search_info_args {
2053     int          request;
2054     unsigned int flags;
2055     Dl_serinfo  *serinfo;
2056     Dl_serpath  *serpath;
2057     char        *strspace;
2058 };
2059
2060 static void *
2061 fill_search_info(const char *dir, size_t dirlen, void *param)
2062 {
2063     struct fill_search_info_args *arg;
2064
2065     arg = param;
2066
2067     if (arg->request == RTLD_DI_SERINFOSIZE) {
2068         arg->serinfo->dls_cnt ++;
2069         arg->serinfo->dls_size += dirlen + 1;
2070     } else {
2071         struct dl_serpath *s_entry;
2072
2073         s_entry = arg->serpath;
2074         s_entry->dls_name  = arg->strspace;
2075         s_entry->dls_flags = arg->flags;
2076
2077         strncpy(arg->strspace, dir, dirlen);
2078         arg->strspace[dirlen] = '\0';
2079
2080         arg->strspace += dirlen + 1;
2081         arg->serpath++;
2082     }
2083
2084     return (NULL);
2085 }
2086
2087 static int
2088 do_search_info(const Obj_Entry *obj, int request, struct dl_serinfo *info)
2089 {
2090     struct dl_serinfo _info;
2091     struct fill_search_info_args args;
2092
2093     args.request = RTLD_DI_SERINFOSIZE;
2094     args.serinfo = &_info;
2095
2096     _info.dls_size = __offsetof(struct dl_serinfo, dls_serpath);
2097     _info.dls_cnt  = 0;
2098
2099     path_enumerate(ld_library_path, fill_search_info, &args);
2100     path_enumerate(obj->rpath, fill_search_info, &args);
2101     path_enumerate(gethints(), fill_search_info, &args);
2102     path_enumerate(STANDARD_LIBRARY_PATH, fill_search_info, &args);
2103
2104
2105     if (request == RTLD_DI_SERINFOSIZE) {
2106         info->dls_size = _info.dls_size;
2107         info->dls_cnt = _info.dls_cnt;
2108         return (0);
2109     }
2110
2111     if (info->dls_cnt != _info.dls_cnt || info->dls_size != _info.dls_size) {
2112         _rtld_error("Uninitialized Dl_serinfo struct passed to dlinfo()");
2113         return (-1);
2114     }
2115
2116     args.request  = RTLD_DI_SERINFO;
2117     args.serinfo  = info;
2118     args.serpath  = &info->dls_serpath[0];
2119     args.strspace = (char *)&info->dls_serpath[_info.dls_cnt];
2120
2121     args.flags = LA_SER_LIBPATH;
2122     if (path_enumerate(ld_library_path, fill_search_info, &args) != NULL)
2123         return (-1);
2124
2125     args.flags = LA_SER_RUNPATH;
2126     if (path_enumerate(obj->rpath, fill_search_info, &args) != NULL)
2127         return (-1);
2128
2129     args.flags = LA_SER_CONFIG;
2130     if (path_enumerate(gethints(), fill_search_info, &args) != NULL)
2131         return (-1);
2132
2133     args.flags = LA_SER_DEFAULT;
2134     if (path_enumerate(STANDARD_LIBRARY_PATH, fill_search_info, &args) != NULL)
2135         return (-1);
2136     return (0);
2137 }
2138
2139 static int
2140 rtld_dirname(const char *path, char *bname)
2141 {
2142     const char *endp;
2143
2144     /* Empty or NULL string gets treated as "." */
2145     if (path == NULL || *path == '\0') {
2146         bname[0] = '.';
2147         bname[1] = '\0';
2148         return (0);
2149     }
2150
2151     /* Strip trailing slashes */
2152     endp = path + strlen(path) - 1;
2153     while (endp > path && *endp == '/')
2154         endp--;
2155
2156     /* Find the start of the dir */
2157     while (endp > path && *endp != '/')
2158         endp--;
2159
2160     /* Either the dir is "/" or there are no slashes */
2161     if (endp == path) {
2162         bname[0] = *endp == '/' ? '/' : '.';
2163         bname[1] = '\0';
2164         return (0);
2165     } else {
2166         do {
2167             endp--;
2168         } while (endp > path && *endp == '/');
2169     }
2170
2171     if (endp - path + 2 > PATH_MAX)
2172     {
2173         _rtld_error("Filename is too long: %s", path);
2174         return(-1);
2175     }
2176
2177     strncpy(bname, path, endp - path + 1);
2178     bname[endp - path + 1] = '\0';
2179     return (0);
2180 }
2181
2182 static void
2183 linkmap_add(Obj_Entry *obj)
2184 {
2185     struct link_map *l = &obj->linkmap;
2186     struct link_map *prev;
2187
2188     obj->linkmap.l_name = obj->path;
2189     obj->linkmap.l_addr = obj->mapbase;
2190     obj->linkmap.l_ld = obj->dynamic;
2191 #ifdef __mips__
2192     /* GDB needs load offset on MIPS to use the symbols */
2193     obj->linkmap.l_offs = obj->relocbase;
2194 #endif
2195
2196     if (r_debug.r_map == NULL) {
2197         r_debug.r_map = l;
2198         return;
2199     }
2200
2201     /*
2202      * Scan to the end of the list, but not past the entry for the
2203      * dynamic linker, which we want to keep at the very end.
2204      */
2205     for (prev = r_debug.r_map;
2206       prev->l_next != NULL && prev->l_next != &obj_rtld.linkmap;
2207       prev = prev->l_next)
2208         ;
2209
2210     /* Link in the new entry. */
2211     l->l_prev = prev;
2212     l->l_next = prev->l_next;
2213     if (l->l_next != NULL)
2214         l->l_next->l_prev = l;
2215     prev->l_next = l;
2216 }
2217
2218 static void
2219 linkmap_delete(Obj_Entry *obj)
2220 {
2221     struct link_map *l = &obj->linkmap;
2222
2223     if (l->l_prev == NULL) {
2224         if ((r_debug.r_map = l->l_next) != NULL)
2225             l->l_next->l_prev = NULL;
2226         return;
2227     }
2228
2229     if ((l->l_prev->l_next = l->l_next) != NULL)
2230         l->l_next->l_prev = l->l_prev;
2231 }
2232
2233 /*
2234  * Function for the debugger to set a breakpoint on to gain control.
2235  *
2236  * The two parameters allow the debugger to easily find and determine
2237  * what the runtime loader is doing and to whom it is doing it.
2238  *
2239  * When the loadhook trap is hit (r_debug_state, set at program
2240  * initialization), the arguments can be found on the stack:
2241  *
2242  *  +8   struct link_map *m
2243  *  +4   struct r_debug  *rd
2244  *  +0   RetAddr
2245  */
2246 void
2247 r_debug_state(struct r_debug* rd, struct link_map *m)
2248 {
2249 }
2250
2251 /*
2252  * Get address of the pointer variable in the main program.
2253  */
2254 static const void **
2255 get_program_var_addr(const char *name)
2256 {
2257     const Obj_Entry *obj;
2258     unsigned long hash;
2259
2260     hash = elf_hash(name);
2261     for (obj = obj_main;  obj != NULL;  obj = obj->next) {
2262         const Elf_Sym *def;
2263
2264         if ((def = symlook_obj(name, hash, obj, false)) != NULL) {
2265             const void **addr;
2266
2267             addr = (const void **)(obj->relocbase + def->st_value);
2268             return addr;
2269         }
2270     }
2271     return NULL;
2272 }
2273
2274 /*
2275  * Set a pointer variable in the main program to the given value.  This
2276  * is used to set key variables such as "environ" before any of the
2277  * init functions are called.
2278  */
2279 static void
2280 set_program_var(const char *name, const void *value)
2281 {
2282     const void **addr;
2283
2284     if ((addr = get_program_var_addr(name)) != NULL) {
2285         dbg("\"%s\": *%p <-- %p", name, addr, value);
2286         *addr = value;
2287     }
2288 }
2289
2290 /*
2291  * This is a special version of getenv which is far more efficient
2292  * at finding LD_ environment vars.
2293  */
2294 static
2295 const char *
2296 _getenv_ld(const char *id)
2297 {
2298     const char *envp;
2299     int i, j;
2300     int idlen = strlen(id);
2301
2302     if (ld_index == LD_ARY_CACHE)
2303         return(getenv(id));
2304     if (ld_index == 0) {
2305         for (i = j = 0; (envp = environ[i]) != NULL && j < LD_ARY_CACHE; ++i) {
2306             if (envp[0] == 'L' && envp[1] == 'D' && envp[2] == '_')
2307                 ld_ary[j++] = envp;
2308         }
2309         if (j == 0)
2310                 ld_ary[j++] = "";
2311         ld_index = j;
2312     }
2313     for (i = ld_index - 1; i >= 0; --i) {
2314         if (strncmp(ld_ary[i], id, idlen) == 0 && ld_ary[i][idlen] == '=')
2315             return(ld_ary[i] + idlen + 1);
2316     }
2317     return(NULL);
2318 }
2319
2320 /*
2321  * Given a symbol name in a referencing object, find the corresponding
2322  * definition of the symbol.  Returns a pointer to the symbol, or NULL if
2323  * no definition was found.  Returns a pointer to the Obj_Entry of the
2324  * defining object via the reference parameter DEFOBJ_OUT.
2325  */
2326 static const Elf_Sym *
2327 symlook_default(const char *name, unsigned long hash,
2328     const Obj_Entry *refobj, const Obj_Entry **defobj_out, bool in_plt)
2329 {
2330     DoneList donelist;
2331     const Elf_Sym *def;
2332     const Elf_Sym *symp;
2333     const Obj_Entry *obj;
2334     const Obj_Entry *defobj;
2335     const Objlist_Entry *elm;
2336     def = NULL;
2337     defobj = NULL;
2338     donelist_init(&donelist);
2339
2340     /* Look first in the referencing object if linked symbolically. */
2341     if (refobj->symbolic && !donelist_check(&donelist, refobj)) {
2342         symp = symlook_obj(name, hash, refobj, in_plt);
2343         if (symp != NULL) {
2344             def = symp;
2345             defobj = refobj;
2346         }
2347     }
2348
2349     /* Search all objects loaded at program start up. */
2350     if (def == NULL || ELF_ST_BIND(def->st_info) == STB_WEAK) {
2351         symp = symlook_list(name, hash, &list_main, &obj, in_plt, &donelist);
2352         if (symp != NULL &&
2353           (def == NULL || ELF_ST_BIND(symp->st_info) != STB_WEAK)) {
2354             def = symp;
2355             defobj = obj;
2356         }
2357     }
2358
2359     /* Search all DAGs whose roots are RTLD_GLOBAL objects. */
2360     STAILQ_FOREACH(elm, &list_global, link) {
2361        if (def != NULL && ELF_ST_BIND(def->st_info) != STB_WEAK)
2362            break;
2363        symp = symlook_list(name, hash, &elm->obj->dagmembers, &obj, in_plt,
2364          &donelist);
2365         if (symp != NULL &&
2366           (def == NULL || ELF_ST_BIND(symp->st_info) != STB_WEAK)) {
2367             def = symp;
2368             defobj = obj;
2369         }
2370     }
2371
2372     /* Search all dlopened DAGs containing the referencing object. */
2373     STAILQ_FOREACH(elm, &refobj->dldags, link) {
2374         if (def != NULL && ELF_ST_BIND(def->st_info) != STB_WEAK)
2375             break;
2376         symp = symlook_list(name, hash, &elm->obj->dagmembers, &obj, in_plt,
2377           &donelist);
2378         if (symp != NULL &&
2379           (def == NULL || ELF_ST_BIND(symp->st_info) != STB_WEAK)) {
2380             def = symp;
2381             defobj = obj;
2382         }
2383     }
2384
2385     /*
2386      * Search the dynamic linker itself, and possibly resolve the
2387      * symbol from there.  This is how the application links to
2388      * dynamic linker services such as dlopen.  Only the values listed
2389      * in the "exports" array can be resolved from the dynamic linker.
2390      */
2391     if (def == NULL || ELF_ST_BIND(def->st_info) == STB_WEAK) {
2392         symp = symlook_obj(name, hash, &obj_rtld, in_plt);
2393         if (symp != NULL && is_exported(symp)) {
2394             def = symp;
2395             defobj = &obj_rtld;
2396         }
2397     }
2398
2399     if (def != NULL)
2400         *defobj_out = defobj;
2401     return def;
2402 }
2403
2404 static const Elf_Sym *
2405 symlook_list(const char *name, unsigned long hash, const Objlist *objlist,
2406   const Obj_Entry **defobj_out, bool in_plt, DoneList *dlp)
2407 {
2408     const Elf_Sym *symp;
2409     const Elf_Sym *def;
2410     const Obj_Entry *defobj;
2411     const Objlist_Entry *elm;
2412
2413     def = NULL;
2414     defobj = NULL;
2415     STAILQ_FOREACH(elm, objlist, link) {
2416         if (donelist_check(dlp, elm->obj))
2417             continue;
2418         if ((symp = symlook_obj(name, hash, elm->obj, in_plt)) != NULL) {
2419             if (def == NULL || ELF_ST_BIND(symp->st_info) != STB_WEAK) {
2420                 def = symp;
2421                 defobj = elm->obj;
2422                 if (ELF_ST_BIND(def->st_info) != STB_WEAK)
2423                     break;
2424             }
2425         }
2426     }
2427     if (def != NULL)
2428         *defobj_out = defobj;
2429     return def;
2430 }
2431
2432 /*
2433  * Search the symbol table of a shared object and all objects needed
2434  * by it for a symbol of the given name.  Search order is
2435  * breadth-first.  Returns a pointer to the symbol, or NULL if no
2436  * definition was found.
2437  */
2438 static const Elf_Sym *
2439 symlook_needed(const char *name, unsigned long hash, const Needed_Entry *needed,
2440   const Obj_Entry **defobj_out, bool in_plt, DoneList *dlp)
2441 {
2442     const Elf_Sym *def, *def_w;
2443     const Needed_Entry *n;
2444     const Obj_Entry *obj, *defobj, *defobj1;
2445
2446     def = def_w = NULL;
2447     defobj = NULL;
2448     for (n = needed; n != NULL; n = n->next) {
2449         if ((obj = n->obj) == NULL ||
2450             donelist_check(dlp, obj) ||
2451             (def = symlook_obj(name, hash, obj, in_plt)) == NULL)
2452                 continue;
2453         defobj = obj;
2454         if (ELF_ST_BIND(def->st_info) != STB_WEAK) {
2455             *defobj_out = defobj;
2456             return (def);
2457         }
2458     }
2459     /*
2460      * There we come when either symbol definition is not found in
2461      * directly needed objects, or found symbol is weak.
2462      */
2463     for (n = needed; n != NULL; n = n->next) {
2464         if ((obj = n->obj) == NULL)
2465             continue;
2466         def_w = symlook_needed(name, hash, obj->needed, &defobj1,
2467                                in_plt, dlp);
2468         if (def_w == NULL)
2469             continue;
2470         if (def == NULL || ELF_ST_BIND(def_w->st_info) != STB_WEAK) {
2471             def = def_w;
2472             defobj = defobj1;
2473         }
2474         if (ELF_ST_BIND(def_w->st_info) != STB_WEAK)
2475             break;
2476     }
2477     if (def != NULL)
2478         *defobj_out = defobj;
2479     return def;
2480 }
2481
2482 /*
2483  * Search the symbol table of a single shared object for a symbol of
2484  * the given name.  Returns a pointer to the symbol, or NULL if no
2485  * definition was found.
2486  *
2487  * The symbol's hash value is passed in for efficiency reasons; that
2488  * eliminates many recomputations of the hash value.
2489  */
2490 const Elf_Sym *
2491 symlook_obj(const char *name, unsigned long hash, const Obj_Entry *obj,
2492   bool in_plt)
2493 {
2494     if (obj->buckets != NULL) {
2495         unsigned long symnum = obj->buckets[hash % obj->nbuckets];
2496
2497         while (symnum != STN_UNDEF) {
2498             const Elf_Sym *symp;
2499             const char *strp;
2500
2501             if (symnum >= obj->nchains)
2502                 return NULL;    /* Bad object */
2503             symp = obj->symtab + symnum;
2504             strp = obj->strtab + symp->st_name;
2505
2506             if (name[0] == strp[0] && strcmp(name, strp) == 0)
2507                 return symp->st_shndx != SHN_UNDEF ||
2508                   (!in_plt && symp->st_value != 0 &&
2509                   ELF_ST_TYPE(symp->st_info) == STT_FUNC) ? symp : NULL;
2510
2511             symnum = obj->chains[symnum];
2512         }
2513     }
2514     return NULL;
2515 }
2516
2517 static void
2518 trace_loaded_objects(Obj_Entry *obj)
2519 {
2520     const char *fmt1, *fmt2, *fmt, *main_local;
2521     int         c;
2522
2523     if ((main_local = _getenv_ld("LD_TRACE_LOADED_OBJECTS_PROGNAME")) == NULL)
2524         main_local = "";
2525
2526     if ((fmt1 = _getenv_ld("LD_TRACE_LOADED_OBJECTS_FMT1")) == NULL)
2527         fmt1 = "\t%o => %p (%x)\n";
2528
2529     if ((fmt2 = _getenv_ld("LD_TRACE_LOADED_OBJECTS_FMT2")) == NULL)
2530         fmt2 = "\t%o (%x)\n";
2531
2532     for (; obj; obj = obj->next) {
2533         Needed_Entry            *needed;
2534         char                    *name, *path;
2535         bool                    is_lib;
2536
2537         for (needed = obj->needed; needed; needed = needed->next) {
2538             if (needed->obj != NULL) {
2539                 if (needed->obj->traced)
2540                     continue;
2541                 needed->obj->traced = true;
2542                 path = needed->obj->path;
2543             } else
2544                 path = "not found";
2545
2546             name = (char *)obj->strtab + needed->name;
2547             is_lib = strncmp(name, "lib", 3) == 0;      /* XXX - bogus */
2548
2549             fmt = is_lib ? fmt1 : fmt2;
2550             while ((c = *fmt++) != '\0') {
2551                 switch (c) {
2552                 default:
2553                     putchar(c);
2554                     continue;
2555                 case '\\':
2556                     switch (c = *fmt) {
2557                     case '\0':
2558                         continue;
2559                     case 'n':
2560                         putchar('\n');
2561                         break;
2562                     case 't':
2563                         putchar('\t');
2564                         break;
2565                     }
2566                     break;
2567                 case '%':
2568                     switch (c = *fmt) {
2569                     case '\0':
2570                         continue;
2571                     case '%':
2572                     default:
2573                         putchar(c);
2574                         break;
2575                     case 'A':
2576                         printf("%s", main_local);
2577                         break;
2578                     case 'a':
2579                         printf("%s", obj_main->path);
2580                         break;
2581                     case 'o':
2582                         printf("%s", name);
2583                         break;
2584 #if 0
2585                     case 'm':
2586                         printf("%d", sodp->sod_major);
2587                         break;
2588                     case 'n':
2589                         printf("%d", sodp->sod_minor);
2590                         break;
2591 #endif
2592                     case 'p':
2593                         printf("%s", path);
2594                         break;
2595                     case 'x':
2596                         printf("%p", needed->obj ? needed->obj->mapbase : 0);
2597                         break;
2598                     }
2599                     break;
2600                 }
2601                 ++fmt;
2602             }
2603         }
2604     }
2605 }
2606
2607 /*
2608  * Unload a dlopened object and its dependencies from memory and from
2609  * our data structures.  It is assumed that the DAG rooted in the
2610  * object has already been unreferenced, and that the object has a
2611  * reference count of 0.
2612  */
2613 static void
2614 unload_object(Obj_Entry *root)
2615 {
2616     Obj_Entry *obj;
2617     Obj_Entry **linkp;
2618
2619     assert(root->refcount == 0);
2620
2621     /*
2622      * Pass over the DAG removing unreferenced objects from
2623      * appropriate lists.
2624      */
2625     unlink_object(root);
2626
2627     /* Unmap all objects that are no longer referenced. */
2628     linkp = &obj_list->next;
2629     while ((obj = *linkp) != NULL) {
2630         if (obj->refcount == 0) {
2631             dbg("unloading \"%s\"", obj->path);
2632             munmap(obj->mapbase, obj->mapsize);
2633             linkmap_delete(obj);
2634             *linkp = obj->next;
2635             obj_count--;
2636             obj_free(obj);
2637         } else
2638             linkp = &obj->next;
2639     }
2640     obj_tail = linkp;
2641 }
2642
2643 static void
2644 unlink_object(Obj_Entry *root)
2645 {
2646     const Needed_Entry *needed;
2647     Objlist_Entry *elm;
2648
2649     if (root->refcount == 0) {
2650         /* Remove the object from the RTLD_GLOBAL list. */
2651         objlist_remove(&list_global, root);
2652
2653         /* Remove the object from all objects' DAG lists. */
2654         STAILQ_FOREACH(elm, &root->dagmembers , link)
2655             objlist_remove(&elm->obj->dldags, root);
2656     }
2657
2658     for (needed = root->needed;  needed != NULL;  needed = needed->next)
2659         if (needed->obj != NULL)
2660             unlink_object(needed->obj);
2661 }
2662
2663 static void
2664 unref_dag(Obj_Entry *root)
2665 {
2666     const Needed_Entry *needed;
2667
2668     if (root->refcount == 0)
2669         return;
2670     root->refcount--;
2671     if (root->refcount == 0)
2672         for (needed = root->needed;  needed != NULL;  needed = needed->next)
2673             if (needed->obj != NULL)
2674                 unref_dag(needed->obj);
2675 }
2676
2677 /*
2678  * Common code for MD __tls_get_addr().
2679  */
2680 void *
2681 tls_get_addr_common(void **dtvp, int index, size_t offset)
2682 {
2683     Elf_Addr* dtv = *dtvp;
2684
2685     /* Check dtv generation in case new modules have arrived */
2686     if (dtv[0] != tls_dtv_generation) {
2687         Elf_Addr* newdtv;
2688         int to_copy;
2689
2690         wlock_acquire();
2691
2692         newdtv = calloc(1, (tls_max_index + 2) * sizeof(Elf_Addr));
2693         to_copy = dtv[1];
2694         if (to_copy > tls_max_index)
2695             to_copy = tls_max_index;
2696         memcpy(&newdtv[2], &dtv[2], to_copy * sizeof(Elf_Addr));
2697         newdtv[0] = tls_dtv_generation;
2698         newdtv[1] = tls_max_index;
2699         free(dtv);
2700         *dtvp = newdtv;
2701
2702         wlock_release();
2703     }
2704
2705     /* Dynamically allocate module TLS if necessary */
2706     if (!dtv[index + 1]) {
2707         /* XXX
2708          * here we should avoid to be re-entered by signal handler
2709          * code, I assume wlock_acquire will masked all signals,
2710          * otherwise there is race and dead lock thread itself.
2711          */
2712         wlock_acquire();
2713         if (!dtv[index + 1])
2714             dtv[index + 1] = (Elf_Addr)allocate_module_tls(index);
2715         wlock_release();
2716     }
2717
2718     return (void*) (dtv[index + 1] + offset);
2719 }
2720
2721 #if defined(RTLD_STATIC_TLS_VARIANT_II)
2722
2723 /*
2724  * Allocate the static TLS area.  Return a pointer to the TCB.  The
2725  * static area is based on negative offsets relative to the tcb.
2726  *
2727  * The TCB contains an errno pointer for the system call layer, but because
2728  * we are the RTLD we really have no idea how the caller was compiled so
2729  * the information has to be passed in.  errno can either be:
2730  *
2731  *      type 0  errno is a simple non-TLS global pointer.
2732  *              (special case for e.g. libc_rtld)
2733  *      type 1  errno accessed by GOT entry     (dynamically linked programs)
2734  *      type 2  errno accessed by %gs:OFFSET    (statically linked programs)
2735  */
2736 struct tls_tcb *
2737 allocate_tls(Obj_Entry *objs)
2738 {
2739     Obj_Entry *obj;
2740     size_t data_size;
2741     size_t dtv_size;
2742     struct tls_tcb *tcb;
2743     Elf_Addr *dtv;
2744     Elf_Addr addr;
2745
2746     /*
2747      * Allocate the new TCB.  static TLS storage is placed just before the
2748      * TCB to support the %gs:OFFSET (negative offset) model.
2749      */
2750     data_size = (tls_static_space + RTLD_STATIC_TLS_ALIGN_MASK) &
2751                 ~RTLD_STATIC_TLS_ALIGN_MASK;
2752     tcb = malloc(data_size + sizeof(*tcb));
2753     tcb = (void *)((char *)tcb + data_size);    /* actual tcb location */
2754
2755     dtv_size = (tls_max_index + 2) * sizeof(Elf_Addr);
2756     dtv = malloc(dtv_size);
2757     bzero(dtv, dtv_size);
2758
2759 #ifdef RTLD_TCB_HAS_SELF_POINTER
2760     tcb->tcb_self = tcb;
2761 #endif
2762     tcb->tcb_dtv = dtv;
2763     tcb->tcb_pthread = NULL;
2764
2765     dtv[0] = tls_dtv_generation;
2766     dtv[1] = tls_max_index;
2767
2768     for (obj = objs; obj; obj = obj->next) {
2769         if (obj->tlsoffset) {
2770             addr = (Elf_Addr)tcb - obj->tlsoffset;
2771             memset((void *)(addr + obj->tlsinitsize),
2772                    0, obj->tlssize - obj->tlsinitsize);
2773             if (obj->tlsinit)
2774                 memcpy((void*) addr, obj->tlsinit, obj->tlsinitsize);
2775             dtv[obj->tlsindex + 1] = addr;
2776         }
2777     }
2778     return(tcb);
2779 }
2780
2781 void
2782 free_tls(struct tls_tcb *tcb)
2783 {
2784     Elf_Addr *dtv;
2785     int dtv_size, i;
2786     Elf_Addr tls_start, tls_end;
2787     size_t data_size;
2788
2789     data_size = (tls_static_space + RTLD_STATIC_TLS_ALIGN_MASK) &
2790                 ~RTLD_STATIC_TLS_ALIGN_MASK;
2791     dtv = tcb->tcb_dtv;
2792     dtv_size = dtv[1];
2793     tls_end = (Elf_Addr)tcb;
2794     tls_start = (Elf_Addr)tcb - data_size;
2795     for (i = 0; i < dtv_size; i++) {
2796         if (dtv[i+2] != 0 && (dtv[i+2] < tls_start || dtv[i+2] > tls_end)) {
2797             free((void *)dtv[i+2]);
2798         }
2799     }
2800     free((void *)tls_start);
2801 }
2802
2803 #else
2804 #error "Unsupported TLS layout"
2805 #endif
2806
2807 /*
2808  * Allocate TLS block for module with given index.
2809  */
2810 void *
2811 allocate_module_tls(int index)
2812 {
2813     Obj_Entry* obj;
2814     char* p;
2815
2816     for (obj = obj_list; obj; obj = obj->next) {
2817         if (obj->tlsindex == index)
2818             break;
2819     }
2820     if (!obj) {
2821         _rtld_error("Can't find module with TLS index %d", index);
2822         die();
2823     }
2824
2825     p = malloc(obj->tlssize);
2826     memcpy(p, obj->tlsinit, obj->tlsinitsize);
2827     memset(p + obj->tlsinitsize, 0, obj->tlssize - obj->tlsinitsize);
2828
2829     return p;
2830 }
2831
2832 bool
2833 allocate_tls_offset(Obj_Entry *obj)
2834 {
2835     size_t off;
2836
2837     if (obj->tls_done)
2838         return true;
2839
2840     if (obj->tlssize == 0) {
2841         obj->tls_done = true;
2842         return true;
2843     }
2844
2845     if (obj->tlsindex == 1)
2846         off = calculate_first_tls_offset(obj->tlssize, obj->tlsalign);
2847     else
2848         off = calculate_tls_offset(tls_last_offset, tls_last_size,
2849                                    obj->tlssize, obj->tlsalign);
2850
2851     /*
2852      * If we have already fixed the size of the static TLS block, we
2853      * must stay within that size. When allocating the static TLS, we
2854      * leave a small amount of space spare to be used for dynamically
2855      * loading modules which use static TLS.
2856      */
2857     if (tls_static_space) {
2858         if (calculate_tls_end(off, obj->tlssize) > tls_static_space)
2859             return false;
2860     }
2861
2862     tls_last_offset = obj->tlsoffset = off;
2863     tls_last_size = obj->tlssize;
2864     obj->tls_done = true;
2865
2866     return true;
2867 }
2868
2869 void
2870 free_tls_offset(Obj_Entry *obj)
2871 {
2872 #ifdef RTLD_STATIC_TLS_VARIANT_II
2873     /*
2874      * If we were the last thing to allocate out of the static TLS
2875      * block, we give our space back to the 'allocator'. This is a
2876      * simplistic workaround to allow libGL.so.1 to be loaded and
2877      * unloaded multiple times. We only handle the Variant II
2878      * mechanism for now - this really needs a proper allocator.
2879      */
2880     if (calculate_tls_end(obj->tlsoffset, obj->tlssize)
2881         == calculate_tls_end(tls_last_offset, tls_last_size)) {
2882         tls_last_offset -= obj->tlssize;
2883         tls_last_size = 0;
2884     }
2885 #endif
2886 }
2887
2888 struct tls_tcb *
2889 _rtld_allocate_tls(void)
2890 {
2891     struct tls_tcb *new_tcb;
2892
2893     wlock_acquire();
2894     new_tcb = allocate_tls(obj_list);
2895     wlock_release();
2896
2897     return (new_tcb);
2898 }
2899
2900 void
2901 _rtld_free_tls(struct tls_tcb *tcb)
2902 {
2903     wlock_acquire();
2904     free_tls(tcb);
2905     wlock_release();
2906 }
2907