sysdeps/unix/sysv/linux/arm/eabi/nptl/unwind-forcedunwind.c

   1 /* Copyright (C) 2003, 2005, 2007, 2009, 2010 Free Software Foundation, Inc.
   2    This file is part of the GNU C Library.
   3    Contributed by Jakub Jelinek <jakub@redhat.com>.
   4
   5    The GNU C Library is free software; you can redistribute it and/or
   6    modify it under the terms of the GNU Lesser General Public License as
   7    published by the Free Software Foundation; either version 2.1 of the
   8    License, or (at your option) any later version.
   9
  10    The GNU C Library is distributed in the hope that it will be useful,
  11    but WITHOUT ANY WARRANTY; without even the implied warranty of
  12    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  13    Lesser General Public License for more details.
  14
  15    You should have received a copy of the GNU Lesser General Public
  16    License along with the GNU C Library; see the file COPYING.LIB.  If not,
  17    write to the Free Software Foundation, Inc., 59 Temple Place - Suite 330,
  18    Boston, MA 02111-1307, USA.  */
  19
  20 #include <dlfcn.h>
  21 #include <stdio.h>
  22 #include <unwind.h>
  23 #include <pthreadP.h>
  24
  25 static void *libgcc_s_handle;
  26 static void (*libgcc_s_resume) (struct _Unwind_Exception *exc);
  27 static _Unwind_Reason_Code (*libgcc_s_personality)
  28   (_Unwind_State, struct _Unwind_Exception *, struct _Unwind_Context *);
  29 static _Unwind_Reason_Code (*libgcc_s_forcedunwind)
  30   (struct _Unwind_Exception *, _Unwind_Stop_Fn, void *);
  31 static _Unwind_Word (*libgcc_s_getcfa) (struct _Unwind_Context *);
  32
  33 void
  34 __attribute_noinline__
  35 pthread_cancel_init (void)
  36 {
  37   void *resume, *personality, *forcedunwind, *getcfa;
  38   void *handle;
  39
  40   if (__builtin_expect (libgcc_s_handle != NULL, 1))
  41     {
  42       /* Force gcc to reload all values.  */
  43       asm volatile ("" ::: "memory");
  44       return;
  45     }
  46
  47   handle = __libc_dlopen ("libgcc_s.so.1");
  48
  49   if (handle == NULL
  50       || (resume = __libc_dlsym (handle, "_Unwind_Resume")) == NULL
  51       || (personality = __libc_dlsym (handle, "__gcc_personality_v0")) == NULL
  52       || (forcedunwind = __libc_dlsym (handle, "_Unwind_ForcedUnwind"))
  53          == NULL
  54       || (getcfa = __libc_dlsym (handle, "_Unwind_GetCFA")) == NULL
  55 #ifdef ARCH_CANCEL_INIT
  56       || ARCH_CANCEL_INIT (handle)
  57 #endif
  58       )
  59     __libc_fatal ("libgcc_s.so.1 must be installed for pthread_cancel to work\n");
  60
  61   libgcc_s_resume = resume;
  62   libgcc_s_personality = personality;
  63   libgcc_s_forcedunwind = forcedunwind;
  64   libgcc_s_getcfa = getcfa;
  65   /* Make sure libgcc_s_getcfa is written last.  Otherwise,
  66      pthread_cancel_init might return early even when the pointer the
  67      caller is interested in is not initialized yet.  */
  68   atomic_write_barrier ();
  69   libgcc_s_handle = handle;
  70 }
  71
  72 void
  73 __libc_freeres_fn_section
  74 __unwind_freeres (void)
  75 {
  76   void *handle = libgcc_s_handle;
  77   if (handle != NULL)
  78     {
  79       libgcc_s_handle = NULL;
  80       __libc_dlclose (handle);
  81     }
  82 }
  83
  84 /* It's vitally important that _Unwind_Resume not have a stack frame; the
  85    ARM unwinder relies on register state at entrance.  So we write this in
  86    assembly.  */
  87
  88 asm (
  89 "       .globl  _Unwind_Resume\n"
  90 "       .type   _Unwind_Resume, %function\n"
  91 "_Unwind_Resume:\n"
  92 "       .cfi_sections .debug_frame\n"
  93 "       " CFI_STARTPROC "\n"
  94 "       stmfd   sp!, {r4, r5, r6, lr}\n"
  95 "       " CFI_ADJUST_CFA_OFFSET (16)" \n"
  96 "       " CFI_REL_OFFSET (r4, 0) "\n"
  97 "       " CFI_REL_OFFSET (r5, 4) "\n"
  98 "       " CFI_REL_OFFSET (r6, 8) "\n"
  99 "       " CFI_REL_OFFSET (lr, 12) "\n"
 100 "       " CFI_REMEMBER_STATE "\n"
 101 "       ldr     r4, 1f\n"
 102 "       ldr     r5, 2f\n"
 103 "3:     add     r4, pc, r4\n"
 104 "       ldr     r3, [r4, r5]\n"
 105 "       mov     r6, r0\n"
 106 "       cmp     r3, #0\n"
 107 "       beq     4f\n"
 108 "5:     mov     r0, r6\n"
 109 "       ldmfd   sp!, {r4, r5, r6, lr}\n"
 110 "       " CFI_ADJUST_CFA_OFFSET (-16) "\n"
 111 "       " CFI_RESTORE (r4) "\n"
 112 "       " CFI_RESTORE (r5) "\n"
 113 "       " CFI_RESTORE (r6) "\n"
 114 "       " CFI_RESTORE (lr) "\n"
 115 "       bx      r3\n"
 116 "       " CFI_RESTORE_STATE "\n"
 117 "4:     bl      pthread_cancel_init\n"
 118 "       ldr     r3, [r4, r5]\n"
 119 "       b       5b\n"
 120 "       " CFI_ENDPROC "\n"
 121 "       .align 2\n"
 122 #ifdef __thumb2__
 123 "1:     .word   _GLOBAL_OFFSET_TABLE_ - 3b - 4\n"
 124 #else
 125 "1:     .word   _GLOBAL_OFFSET_TABLE_ - 3b - 8\n"
 126 #endif
 127 "2:     .word   libgcc_s_resume(GOTOFF)\n"
 128 "       .size   _Unwind_Resume, .-_Unwind_Resume\n"
 129 );
 130
 131 _Unwind_Reason_Code
 132 __gcc_personality_v0 (_Unwind_State state,
 133                       struct _Unwind_Exception *ue_header,
 134                       struct _Unwind_Context *context)
 135 {
 136   if (__builtin_expect (libgcc_s_personality == NULL, 0))
 137     pthread_cancel_init ();
 138
 139   return libgcc_s_personality (state, ue_header, context);
 140 }
 141
 142 _Unwind_Reason_Code
 143 _Unwind_ForcedUnwind (struct _Unwind_Exception *exc, _Unwind_Stop_Fn stop,
 144                       void *stop_argument)
 145 {
 146   if (__builtin_expect (libgcc_s_forcedunwind == NULL, 0))
 147     pthread_cancel_init ();
 148
 149   return libgcc_s_forcedunwind (exc, stop, stop_argument);
 150 }
 151
 152 _Unwind_Word
 153 _Unwind_GetCFA (struct _Unwind_Context *context)
 154 {
 155   if (__builtin_expect (libgcc_s_getcfa == NULL, 0))
 156     pthread_cancel_init ();
 157
 158   return libgcc_s_getcfa (context);
 159 }