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_Size 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     memset(&objtmp, 0, sizeof(objtmp));
1146     objtmp.path = NULL;
1147     objtmp.rtld = true;
1148     objtmp.mapbase = mapbase;
1149 #ifdef PIC
1150     objtmp.relocbase = mapbase;
1151 #endif
1152     if (&_DYNAMIC != 0) {
1153         objtmp.dynamic = rtld_dynamic(&objtmp);
1154         digest_dynamic(&objtmp, 1);
1155         assert(objtmp.needed == NULL);
1156         assert(!objtmp.textrel);
1157
1158         /*
1159          * Temporarily put the dynamic linker entry into the object list, so
1160          * that symbols can be found.
1161          */
1162
1163         relocate_objects(&objtmp, true, &objtmp);
1164     }
1165
1166     /* Initialize the object list. */
1167     obj_tail = &obj_list;
1168
1169     /* Now that non-local variables can be accesses, copy out obj_rtld. */
1170     memcpy(&obj_rtld, &objtmp, sizeof(obj_rtld));
1171
1172     /* Replace the path with a dynamically allocated copy. */
1173     obj_rtld.path = xstrdup(PATH_RTLD);
1174
1175     r_debug.r_brk = r_debug_state;
1176     r_debug.r_state = RT_CONSISTENT;
1177 }
1178
1179 /*
1180  * Add the init functions from a needed object list (and its recursive
1181  * needed objects) to "list".  This is not used directly; it is a helper
1182  * function for initlist_add_objects().  The write lock must be held
1183  * when this function is called.
1184  */
1185 static void
1186 initlist_add_neededs(Needed_Entry *needed, Objlist *list)
1187 {
1188     /* Recursively process the successor needed objects. */
1189     if (needed->next != NULL)
1190         initlist_add_neededs(needed->next, list);
1191
1192     /* Process the current needed object. */
1193     if (needed->obj != NULL)
1194         initlist_add_objects(needed->obj, &needed->obj->next, list);
1195 }
1196
1197 /*
1198  * Scan all of the DAGs rooted in the range of objects from "obj" to
1199  * "tail" and add their init functions to "list".  This recurses over
1200  * the DAGs and ensure the proper init ordering such that each object's
1201  * needed libraries are initialized before the object itself.  At the
1202  * same time, this function adds the objects to the global finalization
1203  * list "list_fini" in the opposite order.  The write lock must be
1204  * held when this function is called.
1205  */
1206 static void
1207 initlist_add_objects(Obj_Entry *obj, Obj_Entry **tail, Objlist *list)
1208 {
1209     if (obj->init_done)
1210         return;
1211     obj->init_done = true;
1212
1213     /* Recursively process the successor objects. */
1214     if (&obj->next != tail)
1215         initlist_add_objects(obj->next, tail, list);
1216
1217     /* Recursively process the needed objects. */
1218     if (obj->needed != NULL)
1219         initlist_add_neededs(obj->needed, list);
1220
1221     /* Add the object to the init list. */
1222     if (obj->init != NULL)
1223         objlist_push_tail(list, obj);
1224
1225     /* Add the object to the global fini list in the reverse order. */
1226     if (obj->fini != NULL)
1227         objlist_push_head(&list_fini, obj);
1228 }
1229
1230 static bool
1231 is_exported(const Elf_Sym *def)
1232 {
1233     Elf_Addr value;
1234     const func_ptr_type *p;
1235
1236     value = (Elf_Addr)(obj_rtld.relocbase + def->st_value);
1237     for (p = exports;  *p != NULL;  p++) {
1238         if ((Elf_Addr)(*p) == value)
1239             return true;
1240     }
1241     return false;
1242 }
1243
1244 /*
1245  * Given a shared object, traverse its list of needed objects, and load
1246  * each of them.  Returns 0 on success.  Generates an error message and
1247  * returns -1 on failure.
1248  */
1249 static int
1250 load_needed_objects(Obj_Entry *first)
1251 {
1252     Obj_Entry *obj;
1253
1254     for (obj = first;  obj != NULL;  obj = obj->next) {
1255         Needed_Entry *needed;
1256
1257         for (needed = obj->needed;  needed != NULL;  needed = needed->next) {
1258             const char *name = obj->strtab + needed->name;
1259             char *path = find_library(name, obj);
1260
1261             needed->obj = NULL;
1262             if (path == NULL && !ld_tracing)
1263                 return -1;
1264
1265             if (path) {
1266                 needed->obj = load_object(path);
1267                 if (needed->obj == NULL && !ld_tracing)
1268                     return -1;          /* XXX - cleanup */
1269             }
1270         }
1271     }
1272
1273     return 0;
1274 }
1275
1276 #define RTLD_FUNCTRACE "_rtld_functrace"
1277
1278 static int
1279 load_preload_objects(void)
1280 {
1281     char *p = ld_preload;
1282     static const char delim[] = " \t:;";
1283
1284     if (p == NULL)
1285         return 0;
1286
1287     p += strspn(p, delim);
1288     while (*p != '\0') {
1289         size_t len = strcspn(p, delim);
1290         char *path;
1291         char savech;
1292         Obj_Entry *obj;
1293         const Elf_Sym *sym;
1294
1295         savech = p[len];
1296         p[len] = '\0';
1297         if ((path = find_library(p, NULL)) == NULL)
1298             return -1;
1299         obj = load_object(path);
1300         if (obj == NULL)
1301             return -1;  /* XXX - cleanup */
1302         p[len] = savech;
1303         p += len;
1304         p += strspn(p, delim);
1305
1306         /* Check for the magic tracing function */
1307         sym = symlook_obj(RTLD_FUNCTRACE, elf_hash(RTLD_FUNCTRACE), obj, true);
1308         if (sym != NULL) {
1309                 rtld_functrace = (void *)(obj->relocbase + sym->st_value);
1310                 rtld_functrace_obj = obj;
1311         }
1312     }
1313     return 0;
1314 }
1315
1316 /*
1317  * Returns a pointer to the Obj_Entry for the object with the given path.
1318  * Returns NULL if no matching object was found.
1319  */
1320 static Obj_Entry *
1321 find_object(const char *path)
1322 {
1323     Obj_Entry *obj;
1324
1325     for (obj = obj_list->next;  obj != NULL;  obj = obj->next) {
1326         if (strcmp(obj->path, path) == 0)
1327             return(obj);
1328     }
1329     return(NULL);
1330 }
1331
1332 /*
1333  * Returns a pointer to the Obj_Entry for the object matching device and
1334  * inode of the given path. If no matching object was found, the descriptor
1335  * is returned in fd.
1336  * Returns with obj == NULL && fd == -1 on error.
1337  */
1338 static Obj_Entry *
1339 find_object2(const char *path, int *fd, struct stat *sb)
1340 {
1341     Obj_Entry *obj;
1342
1343     if ((*fd = open(path, O_RDONLY)) == -1) {
1344         _rtld_error("Cannot open \"%s\"", path);
1345         return(NULL);
1346     }
1347
1348     if (fstat(*fd, sb) == -1) {
1349         _rtld_error("Cannot fstat \"%s\"", path);
1350         close(*fd);
1351         *fd = -1;
1352         return NULL;
1353     }
1354
1355     for (obj = obj_list->next;  obj != NULL;  obj = obj->next) {
1356         if (obj->ino == sb->st_ino && obj->dev == sb->st_dev) {
1357             close(*fd);
1358             break;
1359         }
1360     }
1361
1362     return(obj);
1363 }
1364
1365 /*
1366  * Load a shared object into memory, if it is not already loaded.  The
1367  * argument must be a string allocated on the heap.  This function assumes
1368  * responsibility for freeing it when necessary.
1369  *
1370  * Returns a pointer to the Obj_Entry for the object.  Returns NULL
1371  * on failure.
1372  */
1373 static Obj_Entry *
1374 load_object(char *path)
1375 {
1376     Obj_Entry *obj;
1377     int fd = -1;
1378     struct stat sb;
1379
1380     obj = find_object(path);
1381     if (obj != NULL) {
1382         obj->refcount++;
1383         free(path);
1384         return(obj);
1385     }
1386
1387     obj = find_object2(path, &fd, &sb);
1388     if (obj != NULL) {
1389         obj->refcount++;
1390         free(path);
1391         return(obj);
1392     } else if (fd == -1) {
1393         free(path);
1394         return(NULL);
1395     }
1396
1397     dbg("loading \"%s\"", path);
1398     obj = map_object(fd, path, &sb);
1399     close(fd);
1400     if (obj == NULL) {
1401         free(path);
1402         return NULL;
1403     }
1404
1405     obj->path = path;
1406     digest_dynamic(obj, 0);
1407
1408     *obj_tail = obj;
1409     obj_tail = &obj->next;
1410     obj_count++;
1411     linkmap_add(obj);   /* for GDB & dlinfo() */
1412
1413     dbg("  %p .. %p: %s", obj->mapbase, obj->mapbase + obj->mapsize - 1,
1414         obj->path);
1415     if (obj->textrel)
1416         dbg("  WARNING: %s has impure text", obj->path);
1417
1418     obj->refcount++;
1419     return obj;
1420 }
1421
1422 /*
1423  * Check for locking violations and die if one is found.
1424  */
1425 static void
1426 lock_check(void)
1427 {
1428     int rcount, wcount;
1429
1430     rcount = lockinfo.rcount;
1431     wcount = lockinfo.wcount;
1432     assert(rcount >= 0);
1433     assert(wcount >= 0);
1434     if (wcount > 1 || (wcount != 0 && rcount != 0)) {
1435         _rtld_error("Application locking error: %d readers and %d writers"
1436           " in dynamic linker.  See DLLOCKINIT(3) in manual pages.",
1437           rcount, wcount);
1438         die();
1439     }
1440 }
1441
1442 static Obj_Entry *
1443 obj_from_addr(const void *addr)
1444 {
1445     Obj_Entry *obj;
1446
1447     for (obj = obj_list;  obj != NULL;  obj = obj->next) {
1448         if (addr < (void *) obj->mapbase)
1449             continue;
1450         if (addr < (void *) (obj->mapbase + obj->mapsize))
1451             return obj;
1452     }
1453     return NULL;
1454 }
1455
1456 /*
1457  * Call the finalization functions for each of the objects in "list"
1458  * which are unreferenced.  All of the objects are expected to have
1459  * non-NULL fini functions.
1460  */
1461 static void
1462 objlist_call_fini(Objlist *list)
1463 {
1464     Objlist_Entry *elm;
1465     char *saved_msg;
1466
1467     /*
1468      * Preserve the current error message since a fini function might
1469      * call into the dynamic linker and overwrite it.
1470      */
1471     saved_msg = errmsg_save();
1472     STAILQ_FOREACH(elm, list, link) {
1473         if (elm->obj->refcount == 0) {
1474             dbg("calling fini function for %s", elm->obj->path);
1475             (*elm->obj->fini)();
1476         }
1477     }
1478     errmsg_restore(saved_msg);
1479 }
1480
1481 /*
1482  * Call the initialization functions for each of the objects in
1483  * "list".  All of the objects are expected to have non-NULL init
1484  * functions.
1485  */
1486 static void
1487 objlist_call_init(Objlist *list)
1488 {
1489     Objlist_Entry *elm;
1490     char *saved_msg;
1491
1492     /*
1493      * Preserve the current error message since an init function might
1494      * call into the dynamic linker and overwrite it.
1495      */
1496     saved_msg = errmsg_save();
1497     STAILQ_FOREACH(elm, list, link) {
1498         dbg("calling init function for %s", elm->obj->path);
1499         (*elm->obj->init)();
1500     }
1501     errmsg_restore(saved_msg);
1502 }
1503
1504 static void
1505 objlist_clear(Objlist *list)
1506 {
1507     Objlist_Entry *elm;
1508
1509     while (!STAILQ_EMPTY(list)) {
1510         elm = STAILQ_FIRST(list);
1511         STAILQ_REMOVE_HEAD(list, link);
1512         free(elm);
1513     }
1514 }
1515
1516 static Objlist_Entry *
1517 objlist_find(Objlist *list, const Obj_Entry *obj)
1518 {
1519     Objlist_Entry *elm;
1520
1521     STAILQ_FOREACH(elm, list, link)
1522         if (elm->obj == obj)
1523             return elm;
1524     return NULL;
1525 }
1526
1527 static void
1528 objlist_init(Objlist *list)
1529 {
1530     STAILQ_INIT(list);
1531 }
1532
1533 static void
1534 objlist_push_head(Objlist *list, Obj_Entry *obj)
1535 {
1536     Objlist_Entry *elm;
1537
1538     elm = NEW(Objlist_Entry);
1539     elm->obj = obj;
1540     STAILQ_INSERT_HEAD(list, elm, link);
1541 }
1542
1543 static void
1544 objlist_push_tail(Objlist *list, Obj_Entry *obj)
1545 {
1546     Objlist_Entry *elm;
1547
1548     elm = NEW(Objlist_Entry);
1549     elm->obj = obj;
1550     STAILQ_INSERT_TAIL(list, elm, link);
1551 }
1552
1553 static void
1554 objlist_remove(Objlist *list, Obj_Entry *obj)
1555 {
1556     Objlist_Entry *elm;
1557
1558     if ((elm = objlist_find(list, obj)) != NULL) {
1559         STAILQ_REMOVE(list, elm, Struct_Objlist_Entry, link);
1560         free(elm);
1561     }
1562 }
1563
1564 /*
1565  * Remove all of the unreferenced objects from "list".
1566  */
1567 static void
1568 objlist_remove_unref(Objlist *list)
1569 {
1570     Objlist newlist;
1571     Objlist_Entry *elm;
1572
1573     STAILQ_INIT(&newlist);
1574     while (!STAILQ_EMPTY(list)) {
1575         elm = STAILQ_FIRST(list);
1576         STAILQ_REMOVE_HEAD(list, link);
1577         if (elm->obj->refcount == 0)
1578             free(elm);
1579         else
1580             STAILQ_INSERT_TAIL(&newlist, elm, link);
1581     }
1582     *list = newlist;
1583 }
1584
1585 /*
1586  * Relocate newly-loaded shared objects.  The argument is a pointer to
1587  * the Obj_Entry for the first such object.  All objects from the first
1588  * to the end of the list of objects are relocated.  Returns 0 on success,
1589  * or -1 on failure.
1590  */
1591 static int
1592 relocate_objects(Obj_Entry *first, bool bind_now, Obj_Entry *rtldobj)
1593 {
1594     Obj_Entry *obj;
1595
1596     for (obj = first;  obj != NULL;  obj = obj->next) {
1597         if (obj != rtldobj)
1598             dbg("relocating \"%s\"", obj->path);
1599         if (obj->nbuckets == 0 || obj->nchains == 0 || obj->buckets == NULL ||
1600             obj->symtab == NULL || obj->strtab == NULL) {
1601             _rtld_error("%s: Shared object has no run-time symbol table",
1602               obj->path);
1603             return -1;
1604         }
1605
1606         if (obj->textrel) {
1607             /* There are relocations to the write-protected text segment. */
1608             if (mprotect(obj->mapbase, obj->textsize,
1609               PROT_READ|PROT_WRITE|PROT_EXEC) == -1) {
1610                 _rtld_error("%s: Cannot write-enable text segment: %s",
1611                   obj->path, strerror(errno));
1612                 return -1;
1613             }
1614         }
1615
1616         /* Process the non-PLT relocations. */
1617         if (reloc_non_plt(obj, rtldobj))
1618                 return -1;
1619
1620         /*
1621          * Reprotect the text segment.  Make sure it is included in the
1622          * core dump since we modified it.  This unfortunately causes the
1623          * entire text segment to core-out but we don't have much of a
1624          * choice.  We could try to only reenable core dumps on pages
1625          * in which relocations occured but that is likely most of the text
1626          * pages anyway, and even that would not work because the rest of
1627          * the text pages would wind up as a read-only OBJT_DEFAULT object
1628          * (created due to our modifications) backed by the original OBJT_VNODE
1629          * object, and the ELF coredump code is currently only able to dump
1630          * vnode records for pure vnode-backed mappings, not vnode backings
1631          * to memory objects.
1632          */
1633         if (obj->textrel) {
1634             madvise(obj->mapbase, obj->textsize, MADV_CORE);
1635             if (mprotect(obj->mapbase, obj->textsize,
1636               PROT_READ|PROT_EXEC) == -1) {
1637                 _rtld_error("%s: Cannot write-protect text segment: %s",
1638                   obj->path, strerror(errno));
1639                 return -1;
1640             }
1641         }
1642
1643         /* Process the PLT relocations. */
1644         if (reloc_plt(obj) == -1)
1645             return -1;
1646         /* Relocate the jump slots if we are doing immediate binding. */
1647         if (obj->bind_now || bind_now)
1648             if (reloc_jmpslots(obj) == -1)
1649                 return -1;
1650
1651
1652         /*
1653          * Set up the magic number and version in the Obj_Entry.  These
1654          * were checked in the crt1.o from the original ElfKit, so we
1655          * set them for backward compatibility.
1656          */
1657         obj->magic = RTLD_MAGIC;
1658         obj->version = RTLD_VERSION;
1659
1660         /* Set the special PLT or GOT entries. */
1661         init_pltgot(obj);
1662     }
1663
1664     return 0;
1665 }
1666
1667 /*
1668  * Cleanup procedure.  It will be called (by the atexit mechanism) just
1669  * before the process exits.
1670  */
1671 static void
1672 rtld_exit(void)
1673 {
1674     Obj_Entry *obj;
1675
1676     dbg("rtld_exit()");
1677     /* Clear all the reference counts so the fini functions will be called. */
1678     for (obj = obj_list;  obj != NULL;  obj = obj->next)
1679         obj->refcount = 0;
1680     objlist_call_fini(&list_fini);
1681     /* No need to remove the items from the list, since we are exiting. */
1682 }
1683
1684 static void *
1685 path_enumerate(const char *path, path_enum_proc callback, void *arg)
1686 {
1687     if (path == NULL)
1688         return (NULL);
1689
1690     path += strspn(path, ":;");
1691     while (*path != '\0') {
1692         size_t len;
1693         char  *res;
1694
1695         len = strcspn(path, ":;");
1696         res = callback(path, len, arg);
1697
1698         if (res != NULL)
1699             return (res);
1700
1701         path += len;
1702         path += strspn(path, ":;");
1703     }
1704
1705     return (NULL);
1706 }
1707
1708 struct try_library_args {
1709     const char  *name;
1710     size_t       namelen;
1711     char        *buffer;
1712     size_t       buflen;
1713 };
1714
1715 static void *
1716 try_library_path(const char *dir, size_t dirlen, void *param)
1717 {
1718     struct try_library_args *arg;
1719
1720     arg = param;
1721     if (*dir == '/' || trust) {
1722         char *pathname;
1723
1724         if (dirlen + 1 + arg->namelen + 1 > arg->buflen)
1725                 return (NULL);
1726
1727         pathname = arg->buffer;
1728         strncpy(pathname, dir, dirlen);
1729         pathname[dirlen] = '/';
1730         strcpy(pathname + dirlen + 1, arg->name);
1731
1732         dbg("  Trying \"%s\"", pathname);
1733         if (access(pathname, F_OK) == 0) {              /* We found it */
1734             pathname = xmalloc(dirlen + 1 + arg->namelen + 1);
1735             strcpy(pathname, arg->buffer);
1736             return (pathname);
1737         }
1738     }
1739     return (NULL);
1740 }
1741
1742 static char *
1743 search_library_path(const char *name, const char *path)
1744 {
1745     char *p;
1746     struct try_library_args arg;
1747
1748     if (path == NULL)
1749         return NULL;
1750
1751     arg.name = name;
1752     arg.namelen = strlen(name);
1753     arg.buffer = xmalloc(PATH_MAX);
1754     arg.buflen = PATH_MAX;
1755
1756     p = path_enumerate(path, try_library_path, &arg);
1757
1758     free(arg.buffer);
1759
1760     return (p);
1761 }
1762
1763 int
1764 dlclose(void *handle)
1765 {
1766     Obj_Entry *root;
1767
1768     wlock_acquire();
1769     root = dlcheck(handle);
1770     if (root == NULL) {
1771         wlock_release();
1772         return -1;
1773     }
1774
1775     /* Unreference the object and its dependencies. */
1776     root->dl_refcount--;
1777     unref_dag(root);
1778
1779     if (root->refcount == 0) {
1780         /*
1781          * The object is no longer referenced, so we must unload it.
1782          * First, call the fini functions with no locks held.
1783          */
1784         wlock_release();
1785         objlist_call_fini(&list_fini);
1786         wlock_acquire();
1787         objlist_remove_unref(&list_fini);
1788
1789         /* Finish cleaning up the newly-unreferenced objects. */
1790         GDB_STATE(RT_DELETE,&root->linkmap);
1791         unload_object(root);
1792         GDB_STATE(RT_CONSISTENT,NULL);
1793     }
1794     wlock_release();
1795     return 0;
1796 }
1797
1798 const char *
1799 dlerror(void)
1800 {
1801     char *msg = error_message;
1802     error_message = NULL;
1803     return msg;
1804 }
1805
1806 void *
1807 dlopen(const char *name, int mode)
1808 {
1809     Obj_Entry **old_obj_tail;
1810     Obj_Entry *obj;
1811     Objlist initlist;
1812     int result;
1813
1814     ld_tracing = (mode & RTLD_TRACE) == 0 ? NULL : "1";
1815     if (ld_tracing != NULL)
1816         environ = (char **)*get_program_var_addr("environ");
1817
1818     objlist_init(&initlist);
1819
1820     wlock_acquire();
1821     GDB_STATE(RT_ADD,NULL);
1822
1823     old_obj_tail = obj_tail;
1824     obj = NULL;
1825     if (name == NULL) {
1826         obj = obj_main;
1827         obj->refcount++;
1828     } else {
1829         char *path = find_library(name, obj_main);
1830         if (path != NULL)
1831             obj = load_object(path);
1832     }
1833
1834     if (obj) {
1835         obj->dl_refcount++;
1836         if ((mode & RTLD_GLOBAL) && objlist_find(&list_global, obj) == NULL)
1837             objlist_push_tail(&list_global, obj);
1838         mode &= RTLD_MODEMASK;
1839         if (*old_obj_tail != NULL) {            /* We loaded something new. */
1840             assert(*old_obj_tail == obj);
1841
1842             result = load_needed_objects(obj);
1843             if (result != -1 && ld_tracing)
1844                 goto trace;
1845
1846             if (result == -1 ||
1847               (init_dag(obj), relocate_objects(obj, mode == RTLD_NOW,
1848                &obj_rtld)) == -1) {
1849                 obj->dl_refcount--;
1850                 unref_dag(obj);
1851                 if (obj->refcount == 0)
1852                     unload_object(obj);
1853                 obj = NULL;
1854             } else {
1855                 /* Make list of init functions to call. */
1856                 initlist_add_objects(obj, &obj->next, &initlist);
1857             }
1858         } else if (ld_tracing)
1859             goto trace;
1860     }
1861
1862     GDB_STATE(RT_CONSISTENT,obj ? &obj->linkmap : NULL);
1863
1864     /* Call the init functions with no locks held. */
1865     wlock_release();
1866     objlist_call_init(&initlist);
1867     wlock_acquire();
1868     objlist_clear(&initlist);
1869     wlock_release();
1870     return obj;
1871 trace:
1872     trace_loaded_objects(obj);
1873     wlock_release();
1874     exit(0);
1875 }
1876
1877 void *
1878 dlsym(void *handle, const char *name)
1879 {
1880     const Obj_Entry *obj;
1881     unsigned long hash;
1882     const Elf_Sym *def;
1883     const Obj_Entry *defobj;
1884
1885     hash = elf_hash(name);
1886     def = NULL;
1887     defobj = NULL;
1888
1889     rlock_acquire();
1890     if (handle == NULL || handle == RTLD_NEXT ||
1891         handle == RTLD_DEFAULT || handle == RTLD_SELF) {
1892         void *retaddr;
1893
1894         retaddr = __builtin_return_address(0);  /* __GNUC__ only */
1895         if ((obj = obj_from_addr(retaddr)) == NULL) {
1896             _rtld_error("Cannot determine caller's shared object");
1897             rlock_release();
1898             return NULL;
1899         }
1900         if (handle == NULL) {   /* Just the caller's shared object. */
1901             def = symlook_obj(name, hash, obj, true);
1902             defobj = obj;
1903         } else if (handle == RTLD_NEXT || /* Objects after caller's */
1904                    handle == RTLD_SELF) { /* ... caller included */
1905             if (handle == RTLD_NEXT)
1906                 obj = obj->next;
1907             for (; obj != NULL; obj = obj->next) {
1908                 if ((def = symlook_obj(name, hash, obj, true)) != NULL) {
1909                     defobj = obj;
1910                     break;
1911                 }
1912             }
1913         } else {
1914             assert(handle == RTLD_DEFAULT);
1915             def = symlook_default(name, hash, obj, &defobj, true);
1916         }
1917     } else {
1918         DoneList donelist;
1919
1920         if ((obj = dlcheck(handle)) == NULL) {
1921             rlock_release();
1922             return NULL;
1923         }
1924
1925         donelist_init(&donelist);
1926         if (obj->mainprog) {
1927             /* Search main program and all libraries loaded by it. */
1928             def = symlook_list(name, hash, &list_main, &defobj, true,
1929               &donelist);
1930         } else {
1931             Needed_Entry fake;
1932
1933             /* Search the given object and its needed objects. */
1934             fake.next = NULL;
1935             fake.obj = (Obj_Entry *)obj;
1936             fake.name = 0;
1937             def = symlook_needed(name, hash, &fake, &defobj, true,
1938               &donelist);
1939         }
1940     }
1941
1942     if (def != NULL) {
1943         rlock_release();
1944         return defobj->relocbase + def->st_value;
1945     }
1946
1947     _rtld_error("Undefined symbol \"%s\"", name);
1948     rlock_release();
1949     return NULL;
1950 }
1951
1952 int
1953 dladdr(const void *addr, Dl_info *info)
1954 {
1955     const Obj_Entry *obj;
1956     const Elf_Sym *def;
1957     void *symbol_addr;
1958     unsigned long symoffset;
1959
1960     rlock_acquire();
1961     obj = obj_from_addr(addr);
1962     if (obj == NULL) {
1963         _rtld_error("No shared object contains address");
1964         rlock_release();
1965         return 0;
1966     }
1967     info->dli_fname = obj->path;
1968     info->dli_fbase = obj->mapbase;
1969     info->dli_saddr = (void *)0;
1970     info->dli_sname = NULL;
1971
1972     /*
1973      * Walk the symbol list looking for the symbol whose address is
1974      * closest to the address sent in.
1975      */
1976     for (symoffset = 0; symoffset < obj->nchains; symoffset++) {
1977         def = obj->symtab + symoffset;
1978
1979         /*
1980          * For skip the symbol if st_shndx is either SHN_UNDEF or
1981          * SHN_COMMON.
1982          */
1983         if (def->st_shndx == SHN_UNDEF || def->st_shndx == SHN_COMMON)
1984             continue;
1985
1986         /*
1987          * If the symbol is greater than the specified address, or if it
1988          * is further away from addr than the current nearest symbol,
1989          * then reject it.
1990          */
1991         symbol_addr = obj->relocbase + def->st_value;
1992         if (symbol_addr > addr || symbol_addr < info->dli_saddr)
1993             continue;
1994
1995         /* Update our idea of the nearest symbol. */
1996         info->dli_sname = obj->strtab + def->st_name;
1997         info->dli_saddr = symbol_addr;
1998
1999         /* Exact match? */
2000         if (info->dli_saddr == addr)
2001             break;
2002     }
2003     rlock_release();
2004     return 1;
2005 }
2006
2007 int
2008 dlinfo(void *handle, int request, void *p)
2009 {
2010     const Obj_Entry *obj;
2011     int error;
2012
2013     rlock_acquire();
2014
2015     if (handle == NULL || handle == RTLD_SELF) {
2016         void *retaddr;
2017
2018         retaddr = __builtin_return_address(0);  /* __GNUC__ only */
2019         if ((obj = obj_from_addr(retaddr)) == NULL)
2020             _rtld_error("Cannot determine caller's shared object");
2021     } else
2022         obj = dlcheck(handle);
2023
2024     if (obj == NULL) {
2025         rlock_release();
2026         return (-1);
2027     }
2028
2029     error = 0;
2030     switch (request) {
2031     case RTLD_DI_LINKMAP:
2032         *((struct link_map const **)p) = &obj->linkmap;
2033         break;
2034     case RTLD_DI_ORIGIN:
2035         error = rtld_dirname(obj->path, p);
2036         break;
2037
2038     case RTLD_DI_SERINFOSIZE:
2039     case RTLD_DI_SERINFO:
2040         error = do_search_info(obj, request, (struct dl_serinfo *)p);
2041         break;
2042
2043     default:
2044         _rtld_error("Invalid request %d passed to dlinfo()", request);
2045         error = -1;
2046     }
2047
2048     rlock_release();
2049
2050     return (error);
2051 }
2052
2053 struct fill_search_info_args {
2054     int          request;
2055     unsigned int flags;
2056     Dl_serinfo  *serinfo;
2057     Dl_serpath  *serpath;
2058     char        *strspace;
2059 };
2060
2061 static void *
2062 fill_search_info(const char *dir, size_t dirlen, void *param)
2063 {
2064     struct fill_search_info_args *arg;
2065
2066     arg = param;
2067
2068     if (arg->request == RTLD_DI_SERINFOSIZE) {
2069         arg->serinfo->dls_cnt ++;
2070         arg->serinfo->dls_size += dirlen + 1;
2071     } else {
2072         struct dl_serpath *s_entry;
2073
2074         s_entry = arg->serpath;
2075         s_entry->dls_name  = arg->strspace;
2076         s_entry->dls_flags = arg->flags;
2077
2078         strncpy(arg->strspace, dir, dirlen);
2079         arg->strspace[dirlen] = '\0';
2080
2081         arg->strspace += dirlen + 1;
2082         arg->serpath++;
2083     }
2084
2085     return (NULL);
2086 }
2087
2088 static int
2089 do_search_info(const Obj_Entry *obj, int request, struct dl_serinfo *info)
2090 {
2091     struct dl_serinfo _info;
2092     struct fill_search_info_args args;
2093
2094     args.request = RTLD_DI_SERINFOSIZE;
2095     args.serinfo = &_info;
2096
2097     _info.dls_size = __offsetof(struct dl_serinfo, dls_serpath);
2098     _info.dls_cnt  = 0;
2099
2100     path_enumerate(ld_library_path, fill_search_info, &args);
2101     path_enumerate(obj->rpath, fill_search_info, &args);
2102     path_enumerate(gethints(), fill_search_info, &args);
2103     path_enumerate(STANDARD_LIBRARY_PATH, fill_search_info, &args);
2104
2105
2106     if (request == RTLD_DI_SERINFOSIZE) {
2107         info->dls_size = _info.dls_size;
2108         info->dls_cnt = _info.dls_cnt;
2109         return (0);
2110     }
2111
2112     if (info->dls_cnt != _info.dls_cnt || info->dls_size != _info.dls_size) {
2113         _rtld_error("Uninitialized Dl_serinfo struct passed to dlinfo()");
2114         return (-1);
2115     }
2116
2117     args.request  = RTLD_DI_SERINFO;
2118     args.serinfo  = info;
2119     args.serpath  = &info->dls_serpath[0];
2120     args.strspace = (char *)&info->dls_serpath[_info.dls_cnt];
2121
2122     args.flags = LA_SER_LIBPATH;
2123     if (path_enumerate(ld_library_path, fill_search_info, &args) != NULL)
2124         return (-1);
2125
2126     args.flags = LA_SER_RUNPATH;
2127     if (path_enumerate(obj->rpath, fill_search_info, &args) != NULL)
2128         return (-1);
2129
2130     args.flags = LA_SER_CONFIG;
2131     if (path_enumerate(gethints(), fill_search_info, &args) != NULL)
2132         return (-1);
2133
2134     args.flags = LA_SER_DEFAULT;
2135     if (path_enumerate(STANDARD_LIBRARY_PATH, fill_search_info, &args) != NULL)
2136         return (-1);
2137     return (0);
2138 }
2139
2140 static int
2141 rtld_dirname(const char *path, char *bname)
2142 {
2143     const char *endp;
2144
2145     /* Empty or NULL string gets treated as "." */
2146     if (path == NULL || *path == '\0') {
2147         bname[0] = '.';
2148         bname[1] = '\0';
2149         return (0);
2150     }
2151
2152     /* Strip trailing slashes */
2153     endp = path + strlen(path) - 1;
2154     while (endp > path && *endp == '/')
2155         endp--;
2156
2157     /* Find the start of the dir */
2158     while (endp > path && *endp != '/')
2159         endp--;
2160
2161     /* Either the dir is "/" or there are no slashes */
2162     if (endp == path) {
2163         bname[0] = *endp == '/' ? '/' : '.';
2164         bname[1] = '\0';
2165         return (0);
2166     } else {
2167         do {
2168             endp--;
2169         } while (endp > path && *endp == '/');
2170     }
2171
2172     if (endp - path + 2 > PATH_MAX)
2173     {
2174         _rtld_error("Filename is too long: %s", path);
2175         return(-1);
2176     }
2177
2178     strncpy(bname, path, endp - path + 1);
2179     bname[endp - path + 1] = '\0';
2180     return (0);
2181 }
2182
2183 static void
2184 linkmap_add(Obj_Entry *obj)
2185 {
2186     struct link_map *l = &obj->linkmap;
2187     struct link_map *prev;
2188
2189     obj->linkmap.l_name = obj->path;
2190     obj->linkmap.l_addr = obj->mapbase;
2191     obj->linkmap.l_ld = obj->dynamic;
2192 #ifdef __mips__
2193     /* GDB needs load offset on MIPS to use the symbols */
2194     obj->linkmap.l_offs = obj->relocbase;
2195 #endif
2196
2197     if (r_debug.r_map == NULL) {
2198         r_debug.r_map = l;
2199         return;
2200     }
2201
2202     /*
2203      * Scan to the end of the list, but not past the entry for the
2204      * dynamic linker, which we want to keep at the very end.
2205      */
2206     for (prev = r_debug.r_map;
2207       prev->l_next != NULL && prev->l_next != &obj_rtld.linkmap;
2208       prev = prev->l_next)
2209         ;
2210
2211     /* Link in the new entry. */
2212     l->l_prev = prev;
2213     l->l_next = prev->l_next;
2214     if (l->l_next != NULL)
2215         l->l_next->l_prev = l;
2216     prev->l_next = l;
2217 }
2218
2219 static void
2220 linkmap_delete(Obj_Entry *obj)
2221 {
2222     struct link_map *l = &obj->linkmap;
2223
2224     if (l->l_prev == NULL) {
2225         if ((r_debug.r_map = l->l_next) != NULL)
2226             l->l_next->l_prev = NULL;
2227         return;
2228     }
2229
2230     if ((l->l_prev->l_next = l->l_next) != NULL)
2231         l->l_next->l_prev = l->l_prev;
2232 }
2233
2234 /*
2235  * Function for the debugger to set a breakpoint on to gain control.
2236  *
2237  * The two parameters allow the debugger to easily find and determine
2238  * what the runtime loader is doing and to whom it is doing it.
2239  *
2240  * When the loadhook trap is hit (r_debug_state, set at program
2241  * initialization), the arguments can be found on the stack:
2242  *
2243  *  +8   struct link_map *m
2244  *  +4   struct r_debug  *rd
2245  *  +0   RetAddr
2246  */
2247 void
2248 r_debug_state(struct r_debug* rd, struct link_map *m)
2249 {
2250 }
2251
2252 /*
2253  * Get address of the pointer variable in the main program.
2254  */
2255 static const void **
2256 get_program_var_addr(const char *name)
2257 {
2258     const Obj_Entry *obj;
2259     unsigned long hash;
2260
2261     hash = elf_hash(name);
2262     for (obj = obj_main;  obj != NULL;  obj = obj->next) {
2263         const Elf_Sym *def;
2264
2265         if ((def = symlook_obj(name, hash, obj, false)) != NULL) {
2266             const void **addr;
2267
2268             addr = (const void **)(obj->relocbase + def->st_value);
2269             return addr;
2270         }
2271     }
2272     return NULL;
2273 }
2274
2275 /*
2276  * Set a pointer variable in the main program to the given value.  This
2277  * is used to set key variables such as "environ" before any of the
2278  * init functions are called.
2279  */
2280 static void
2281 set_program_var(const char *name, const void *value)
2282 {
2283     const void **addr;
2284
2285     if ((addr = get_program_var_addr(name)) != NULL) {
2286         dbg("\"%s\": *%p <-- %p", name, addr, value);
2287         *addr = value;
2288     }
2289 }
2290
2291 /*
2292  * This is a special version of getenv which is far more efficient
2293  * at finding LD_ environment vars.
2294  */
2295 static
2296 const char *
2297 _getenv_ld(const char *id)
2298 {
2299     const char *envp;
2300     int i, j;
2301     int idlen = strlen(id);
2302
2303     if (ld_index == LD_ARY_CACHE)
2304         return(getenv(id));
2305     if (ld_index == 0) {
2306         for (i = j = 0; (envp = environ[i]) != NULL && j < LD_ARY_CACHE; ++i) {
2307             if (envp[0] == 'L' && envp[1] == 'D' && envp[2] == '_')
2308                 ld_ary[j++] = envp;
2309         }
2310         if (j == 0)
2311                 ld_ary[j++] = "";
2312         ld_index = j;
2313     }
2314     for (i = ld_index - 1; i >= 0; --i) {
2315         if (strncmp(ld_ary[i], id, idlen) == 0 && ld_ary[i][idlen] == '=')
2316             return(ld_ary[i] + idlen + 1);
2317     }
2318     return(NULL);
2319 }
2320
2321 /*
2322  * Given a symbol name in a referencing object, find the corresponding
2323  * definition of the symbol.  Returns a pointer to the symbol, or NULL if
2324  * no definition was found.  Returns a pointer to the Obj_Entry of the
2325  * defining object via the reference parameter DEFOBJ_OUT.
2326  */
2327 static const Elf_Sym *
2328 symlook_default(const char *name, unsigned long hash,
2329     const Obj_Entry *refobj, const Obj_Entry **defobj_out, bool in_plt)
2330 {
2331     DoneList donelist;
2332     const Elf_Sym *def;
2333     const Elf_Sym *symp;
2334     const Obj_Entry *obj;
2335     const Obj_Entry *defobj;
2336     const Objlist_Entry *elm;
2337     def = NULL;
2338     defobj = NULL;
2339     donelist_init(&donelist);
2340
2341     /* Look first in the referencing object if linked symbolically. */
2342     if (refobj->symbolic && !donelist_check(&donelist, refobj)) {
2343         symp = symlook_obj(name, hash, refobj, in_plt);
2344         if (symp != NULL) {
2345             def = symp;
2346             defobj = refobj;
2347         }
2348     }
2349
2350     /* Search all objects loaded at program start up. */
2351     if (def == NULL || ELF_ST_BIND(def->st_info) == STB_WEAK) {
2352         symp = symlook_list(name, hash, &list_main, &obj, in_plt, &donelist);
2353         if (symp != NULL &&
2354           (def == NULL || ELF_ST_BIND(symp->st_info) != STB_WEAK)) {
2355             def = symp;
2356             defobj = obj;
2357         }
2358     }
2359
2360     /* Search all DAGs whose roots are RTLD_GLOBAL objects. */
2361     STAILQ_FOREACH(elm, &list_global, link) {
2362        if (def != NULL && ELF_ST_BIND(def->st_info) != STB_WEAK)
2363            break;
2364        symp = symlook_list(name, hash, &elm->obj->dagmembers, &obj, in_plt,
2365          &donelist);
2366         if (symp != NULL &&
2367           (def == NULL || ELF_ST_BIND(symp->st_info) != STB_WEAK)) {
2368             def = symp;
2369             defobj = obj;
2370         }
2371     }
2372
2373     /* Search all dlopened DAGs containing the referencing object. */
2374     STAILQ_FOREACH(elm, &refobj->dldags, link) {
2375         if (def != NULL && ELF_ST_BIND(def->st_info) != STB_WEAK)
2376             break;
2377         symp = symlook_list(name, hash, &elm->obj->dagmembers, &obj, in_plt,
2378           &donelist);
2379         if (symp != NULL &&
2380           (def == NULL || ELF_ST_BIND(symp->st_info) != STB_WEAK)) {
2381             def = symp;
2382             defobj = obj;
2383         }
2384     }
2385
2386     /*
2387      * Search the dynamic linker itself, and possibly resolve the
2388      * symbol from there.  This is how the application links to
2389      * dynamic linker services such as dlopen.  Only the values listed
2390      * in the "exports" array can be resolved from the dynamic linker.
2391      */
2392     if (def == NULL || ELF_ST_BIND(def->st_info) == STB_WEAK) {
2393         symp = symlook_obj(name, hash, &obj_rtld, in_plt);
2394         if (symp != NULL && is_exported(symp)) {
2395             def = symp;
2396             defobj = &obj_rtld;
2397         }
2398     }
2399
2400     if (def != NULL)
2401         *defobj_out = defobj;
2402     return def;
2403 }
2404
2405 static const Elf_Sym *
2406 symlook_list(const char *name, unsigned long hash, const Objlist *objlist,
2407   const Obj_Entry **defobj_out, bool in_plt, DoneList *dlp)
2408 {
2409     const Elf_Sym *symp;
2410     const Elf_Sym *def;
2411     const Obj_Entry *defobj;
2412     const Objlist_Entry *elm;
2413
2414     def = NULL;
2415     defobj = NULL;
2416     STAILQ_FOREACH(elm, objlist, link) {
2417         if (donelist_check(dlp, elm->obj))
2418             continue;
2419         if ((symp = symlook_obj(name, hash, elm->obj, in_plt)) != NULL) {
2420             if (def == NULL || ELF_ST_BIND(symp->st_info) != STB_WEAK) {
2421                 def = symp;
2422                 defobj = elm->obj;
2423                 if (ELF_ST_BIND(def->st_info) != STB_WEAK)
2424                     break;
2425             }
2426         }
2427     }
2428     if (def != NULL)
2429         *defobj_out = defobj;
2430     return def;
2431 }
2432
2433 /*
2434  * Search the symbol table of a shared object and all objects needed
2435  * by it for a symbol of the given name.  Search order is
2436  * breadth-first.  Returns a pointer to the symbol, or NULL if no
2437  * definition was found.
2438  */
2439 static const Elf_Sym *
2440 symlook_needed(const char *name, unsigned long hash, const Needed_Entry *needed,
2441   const Obj_Entry **defobj_out, bool in_plt, DoneList *dlp)
2442 {
2443     const Elf_Sym *def, *def_w;
2444     const Needed_Entry *n;
2445     const Obj_Entry *obj, *defobj, *defobj1;
2446
2447     def = def_w = NULL;
2448     defobj = NULL;
2449     for (n = needed; n != NULL; n = n->next) {
2450         if ((obj = n->obj) == NULL ||
2451             donelist_check(dlp, obj) ||
2452             (def = symlook_obj(name, hash, obj, in_plt)) == NULL)
2453                 continue;
2454         defobj = obj;
2455         if (ELF_ST_BIND(def->st_info) != STB_WEAK) {
2456             *defobj_out = defobj;
2457             return (def);
2458         }
2459     }
2460     /*
2461      * There we come when either symbol definition is not found in
2462      * directly needed objects, or found symbol is weak.
2463      */
2464     for (n = needed; n != NULL; n = n->next) {
2465         if ((obj = n->obj) == NULL)
2466             continue;
2467         def_w = symlook_needed(name, hash, obj->needed, &defobj1,
2468                                in_plt, dlp);
2469         if (def_w == NULL)
2470             continue;
2471         if (def == NULL || ELF_ST_BIND(def_w->st_info) != STB_WEAK) {
2472             def = def_w;
2473             defobj = defobj1;
2474         }
2475         if (ELF_ST_BIND(def_w->st_info) != STB_WEAK)
2476             break;
2477     }
2478     if (def != NULL)
2479         *defobj_out = defobj;
2480     return def;
2481 }
2482
2483 /*
2484  * Search the symbol table of a single shared object for a symbol of
2485  * the given name.  Returns a pointer to the symbol, or NULL if no
2486  * definition was found.
2487  *
2488  * The symbol's hash value is passed in for efficiency reasons; that
2489  * eliminates many recomputations of the hash value.
2490  */
2491 const Elf_Sym *
2492 symlook_obj(const char *name, unsigned long hash, const Obj_Entry *obj,
2493   bool in_plt)
2494 {
2495     if (obj->buckets != NULL) {
2496         unsigned long symnum = obj->buckets[hash % obj->nbuckets];
2497
2498         while (symnum != STN_UNDEF) {
2499             const Elf_Sym *symp;
2500             const char *strp;
2501
2502             if (symnum >= obj->nchains)
2503                 return NULL;    /* Bad object */
2504             symp = obj->symtab + symnum;
2505             strp = obj->strtab + symp->st_name;
2506
2507             if (name[0] == strp[0] && strcmp(name, strp) == 0)
2508                 return symp->st_shndx != SHN_UNDEF ||
2509                   (!in_plt && symp->st_value != 0 &&
2510                   ELF_ST_TYPE(symp->st_info) == STT_FUNC) ? symp : NULL;
2511
2512             symnum = obj->chains[symnum];
2513         }
2514     }
2515     return NULL;
2516 }
2517
2518 static void
2519 trace_loaded_objects(Obj_Entry *obj)
2520 {
2521     const char *fmt1, *fmt2, *fmt, *main_local;
2522     int         c;
2523
2524     if ((main_local = _getenv_ld("LD_TRACE_LOADED_OBJECTS_PROGNAME")) == NULL)
2525         main_local = "";
2526
2527     if ((fmt1 = _getenv_ld("LD_TRACE_LOADED_OBJECTS_FMT1")) == NULL)
2528         fmt1 = "\t%o => %p (%x)\n";
2529
2530     if ((fmt2 = _getenv_ld("LD_TRACE_LOADED_OBJECTS_FMT2")) == NULL)
2531         fmt2 = "\t%o (%x)\n";
2532
2533     for (; obj; obj = obj->next) {
2534         Needed_Entry            *needed;
2535         char                    *name, *path;
2536         bool                    is_lib;
2537
2538         for (needed = obj->needed; needed; needed = needed->next) {
2539             if (needed->obj != NULL) {
2540                 if (needed->obj->traced)
2541                     continue;
2542                 needed->obj->traced = true;
2543                 path = needed->obj->path;
2544             } else
2545                 path = "not found";
2546
2547             name = (char *)obj->strtab + needed->name;
2548             is_lib = strncmp(name, "lib", 3) == 0;      /* XXX - bogus */
2549
2550             fmt = is_lib ? fmt1 : fmt2;
2551             while ((c = *fmt++) != '\0') {
2552                 switch (c) {
2553                 default:
2554                     putchar(c);
2555                     continue;
2556                 case '\\':
2557                     switch (c = *fmt) {
2558                     case '\0':
2559                         continue;
2560                     case 'n':
2561                         putchar('\n');
2562                         break;
2563                     case 't':
2564                         putchar('\t');
2565                         break;
2566                     }
2567                     break;
2568                 case '%':
2569                     switch (c = *fmt) {
2570                     case '\0':
2571                         continue;
2572                     case '%':
2573                     default:
2574                         putchar(c);
2575                         break;
2576                     case 'A':
2577                         printf("%s", main_local);
2578                         break;
2579                     case 'a':
2580                         printf("%s", obj_main->path);
2581                         break;
2582                     case 'o':
2583                         printf("%s", name);
2584                         break;
2585 #if 0
2586                     case 'm':
2587                         printf("%d", sodp->sod_major);
2588                         break;
2589                     case 'n':
2590                         printf("%d", sodp->sod_minor);
2591                         break;
2592 #endif
2593                     case 'p':
2594                         printf("%s", path);
2595                         break;
2596                     case 'x':
2597                         printf("%p", needed->obj ? needed->obj->mapbase : 0);
2598                         break;
2599                     }
2600                     break;
2601                 }
2602                 ++fmt;
2603             }
2604         }
2605     }
2606 }
2607
2608 /*
2609  * Unload a dlopened object and its dependencies from memory and from
2610  * our data structures.  It is assumed that the DAG rooted in the
2611  * object has already been unreferenced, and that the object has a
2612  * reference count of 0.
2613  */
2614 static void
2615 unload_object(Obj_Entry *root)
2616 {
2617     Obj_Entry *obj;
2618     Obj_Entry **linkp;
2619
2620     assert(root->refcount == 0);
2621
2622     /*
2623      * Pass over the DAG removing unreferenced objects from
2624      * appropriate lists.
2625      */
2626     unlink_object(root);
2627
2628     /* Unmap all objects that are no longer referenced. */
2629     linkp = &obj_list->next;
2630     while ((obj = *linkp) != NULL) {
2631         if (obj->refcount == 0) {
2632             dbg("unloading \"%s\"", obj->path);
2633             munmap(obj->mapbase, obj->mapsize);
2634             linkmap_delete(obj);
2635             *linkp = obj->next;
2636             obj_count--;
2637             obj_free(obj);
2638         } else
2639             linkp = &obj->next;
2640     }
2641     obj_tail = linkp;
2642 }
2643
2644 static void
2645 unlink_object(Obj_Entry *root)
2646 {
2647     const Needed_Entry *needed;
2648     Objlist_Entry *elm;
2649
2650     if (root->refcount == 0) {
2651         /* Remove the object from the RTLD_GLOBAL list. */
2652         objlist_remove(&list_global, root);
2653
2654         /* Remove the object from all objects' DAG lists. */
2655         STAILQ_FOREACH(elm, &root->dagmembers , link)
2656             objlist_remove(&elm->obj->dldags, root);
2657     }
2658
2659     for (needed = root->needed;  needed != NULL;  needed = needed->next)
2660         if (needed->obj != NULL)
2661             unlink_object(needed->obj);
2662 }
2663
2664 static void
2665 unref_dag(Obj_Entry *root)
2666 {
2667     const Needed_Entry *needed;
2668
2669     if (root->refcount == 0)
2670         return;
2671     root->refcount--;
2672     if (root->refcount == 0)
2673         for (needed = root->needed;  needed != NULL;  needed = needed->next)
2674             if (needed->obj != NULL)
2675                 unref_dag(needed->obj);
2676 }
2677
2678 /*
2679  * Common code for MD __tls_get_addr().
2680  */
2681 void *
2682 tls_get_addr_common(void **dtvp, int index, size_t offset)
2683 {
2684     Elf_Addr* dtv = *dtvp;
2685
2686     /* Check dtv generation in case new modules have arrived */
2687     if (dtv[0] != tls_dtv_generation) {
2688         Elf_Addr* newdtv;
2689         int to_copy;
2690
2691         wlock_acquire();
2692
2693         newdtv = calloc(1, (tls_max_index + 2) * sizeof(Elf_Addr));
2694         to_copy = dtv[1];
2695         if (to_copy > tls_max_index)
2696             to_copy = tls_max_index;
2697         memcpy(&newdtv[2], &dtv[2], to_copy * sizeof(Elf_Addr));
2698         newdtv[0] = tls_dtv_generation;
2699         newdtv[1] = tls_max_index;
2700         free(dtv);
2701         *dtvp = newdtv;
2702
2703         wlock_release();
2704     }
2705
2706     /* Dynamically allocate module TLS if necessary */
2707     if (!dtv[index + 1]) {
2708         /* XXX
2709          * here we should avoid to be re-entered by signal handler
2710          * code, I assume wlock_acquire will masked all signals,
2711          * otherwise there is race and dead lock thread itself.
2712          */
2713         wlock_acquire();
2714         if (!dtv[index + 1])
2715             dtv[index + 1] = (Elf_Addr)allocate_module_tls(index);
2716         wlock_release();
2717     }
2718
2719     return (void*) (dtv[index + 1] + offset);
2720 }
2721
2722 #if defined(RTLD_STATIC_TLS_VARIANT_II)
2723
2724 /*
2725  * Allocate the static TLS area.  Return a pointer to the TCB.  The
2726  * static area is based on negative offsets relative to the tcb.
2727  *
2728  * The TCB contains an errno pointer for the system call layer, but because
2729  * we are the RTLD we really have no idea how the caller was compiled so
2730  * the information has to be passed in.  errno can either be:
2731  *
2732  *      type 0  errno is a simple non-TLS global pointer.
2733  *              (special case for e.g. libc_rtld)
2734  *      type 1  errno accessed by GOT entry     (dynamically linked programs)
2735  *      type 2  errno accessed by %gs:OFFSET    (statically linked programs)
2736  */
2737 struct tls_tcb *
2738 allocate_tls(Obj_Entry *objs)
2739 {
2740     Obj_Entry *obj;
2741     size_t data_size;
2742     size_t dtv_size;
2743     struct tls_tcb *tcb;
2744     Elf_Addr *dtv;
2745     Elf_Addr addr;
2746
2747     /*
2748      * Allocate the new TCB.  static TLS storage is placed just before the
2749      * TCB to support the %gs:OFFSET (negative offset) model.
2750      */
2751     data_size = (tls_static_space + RTLD_STATIC_TLS_ALIGN_MASK) &
2752                 ~RTLD_STATIC_TLS_ALIGN_MASK;
2753     tcb = malloc(data_size + sizeof(*tcb));
2754     tcb = (void *)((char *)tcb + data_size);    /* actual tcb location */
2755
2756     dtv_size = (tls_max_index + 2) * sizeof(Elf_Addr);
2757     dtv = malloc(dtv_size);
2758     bzero(dtv, dtv_size);
2759
2760 #ifdef RTLD_TCB_HAS_SELF_POINTER
2761     tcb->tcb_self = tcb;
2762 #endif
2763     tcb->tcb_dtv = dtv;
2764     tcb->tcb_pthread = NULL;
2765
2766     dtv[0] = tls_dtv_generation;
2767     dtv[1] = tls_max_index;
2768
2769     for (obj = objs; obj; obj = obj->next) {
2770         if (obj->tlsoffset) {
2771             addr = (Elf_Addr)tcb - obj->tlsoffset;
2772             memset((void *)(addr + obj->tlsinitsize),
2773                    0, obj->tlssize - obj->tlsinitsize);
2774             if (obj->tlsinit)
2775                 memcpy((void*) addr, obj->tlsinit, obj->tlsinitsize);
2776             dtv[obj->tlsindex + 1] = addr;
2777         }
2778     }
2779     return(tcb);
2780 }
2781
2782 void
2783 free_tls(struct tls_tcb *tcb)
2784 {
2785     Elf_Addr *dtv;
2786     int dtv_size, i;
2787     Elf_Addr tls_start, tls_end;
2788     size_t data_size;
2789
2790     data_size = (tls_static_space + RTLD_STATIC_TLS_ALIGN_MASK) &
2791                 ~RTLD_STATIC_TLS_ALIGN_MASK;
2792     dtv = tcb->tcb_dtv;
2793     dtv_size = dtv[1];
2794     tls_end = (Elf_Addr)tcb;
2795     tls_start = (Elf_Addr)tcb - data_size;
2796     for (i = 0; i < dtv_size; i++) {
2797         if (dtv[i+2] != 0 && (dtv[i+2] < tls_start || dtv[i+2] > tls_end)) {
2798             free((void *)dtv[i+2]);
2799         }
2800     }
2801     free((void *)tls_start);
2802 }
2803
2804 #else
2805 #error "Unsupported TLS layout"
2806 #endif
2807
2808 /*
2809  * Allocate TLS block for module with given index.
2810  */
2811 void *
2812 allocate_module_tls(int index)
2813 {
2814     Obj_Entry* obj;
2815     char* p;
2816
2817     for (obj = obj_list; obj; obj = obj->next) {
2818         if (obj->tlsindex == index)
2819             break;
2820     }
2821     if (!obj) {
2822         _rtld_error("Can't find module with TLS index %d", index);
2823         die();
2824     }
2825
2826     p = malloc(obj->tlssize);
2827     memcpy(p, obj->tlsinit, obj->tlsinitsize);
2828     memset(p + obj->tlsinitsize, 0, obj->tlssize - obj->tlsinitsize);
2829
2830     return p;
2831 }
2832
2833 bool
2834 allocate_tls_offset(Obj_Entry *obj)
2835 {
2836     size_t off;
2837
2838     if (obj->tls_done)
2839         return true;
2840
2841     if (obj->tlssize == 0) {
2842         obj->tls_done = true;
2843         return true;
2844     }
2845
2846     if (obj->tlsindex == 1)
2847         off = calculate_first_tls_offset(obj->tlssize, obj->tlsalign);
2848     else
2849         off = calculate_tls_offset(tls_last_offset, tls_last_size,
2850                                    obj->tlssize, obj->tlsalign);
2851
2852     /*
2853      * If we have already fixed the size of the static TLS block, we
2854      * must stay within that size. When allocating the static TLS, we
2855      * leave a small amount of space spare to be used for dynamically
2856      * loading modules which use static TLS.
2857      */
2858     if (tls_static_space) {
2859         if (calculate_tls_end(off, obj->tlssize) > tls_static_space)
2860             return false;
2861     }
2862
2863     tls_last_offset = obj->tlsoffset = off;
2864     tls_last_size = obj->tlssize;
2865     obj->tls_done = true;
2866
2867     return true;
2868 }
2869
2870 void
2871 free_tls_offset(Obj_Entry *obj)
2872 {
2873 #ifdef RTLD_STATIC_TLS_VARIANT_II
2874     /*
2875      * If we were the last thing to allocate out of the static TLS
2876      * block, we give our space back to the 'allocator'. This is a
2877      * simplistic workaround to allow libGL.so.1 to be loaded and
2878      * unloaded multiple times. We only handle the Variant II
2879      * mechanism for now - this really needs a proper allocator.
2880      */
2881     if (calculate_tls_end(obj->tlsoffset, obj->tlssize)
2882         == calculate_tls_end(tls_last_offset, tls_last_size)) {
2883         tls_last_offset -= obj->tlssize;
2884         tls_last_size = 0;
2885     }
2886 #endif
2887 }
2888
2889 struct tls_tcb *
2890 _rtld_allocate_tls(void)
2891 {
2892     struct tls_tcb *new_tcb;
2893
2894     wlock_acquire();
2895     new_tcb = allocate_tls(obj_list);
2896     wlock_release();
2897
2898     return (new_tcb);
2899 }
2900
2901 void
2902 _rtld_free_tls(struct tls_tcb *tcb)
2903 {
2904     wlock_acquire();
2905     free_tls(tcb);
2906     wlock_release();
2907 }
2908