123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164 |
- #include <dlfcn.h>
- #include <stdio.h>
- #include <unwind.h>
- #include <pthreadP.h>
- #define __libc_dlopen(x) dlopen(x, (RTLD_LOCAL | RTLD_LAZY))
- #define __libc_dlsym dlsym
- #define __libc_dlclose dlclose
- #define __libc_fatal(x) { abort();}
- static void *libgcc_s_handle;
- static void (*libgcc_s_resume) (struct _Unwind_Exception *exc);
- static _Unwind_Reason_Code (*libgcc_s_personality)
- (_Unwind_State, struct _Unwind_Exception *, struct _Unwind_Context *);
- static _Unwind_Reason_Code (*libgcc_s_forcedunwind)
- (struct _Unwind_Exception *, _Unwind_Stop_Fn, void *);
- static _Unwind_Word (*libgcc_s_getcfa) (struct _Unwind_Context *);
- void
- __attribute_noinline__
- pthread_cancel_init (void)
- {
- void *resume, *personality, *forcedunwind, *getcfa;
- void *handle;
- if (__builtin_expect (libgcc_s_handle != NULL, 1))
- {
-
- __asm__ __volatile__ ("" ::: "memory");
- return;
- }
- handle = __libc_dlopen ("libgcc_s.so.1");
- if (handle == NULL
- || (resume = __libc_dlsym (handle, "_Unwind_Resume")) == NULL
- || (personality = __libc_dlsym (handle, "__gcc_personality_v0")) == NULL
- || (forcedunwind = __libc_dlsym (handle, "_Unwind_ForcedUnwind"))
- == NULL
- || (getcfa = __libc_dlsym (handle, "_Unwind_GetCFA")) == NULL
- #ifdef ARCH_CANCEL_INIT
- || ARCH_CANCEL_INIT (handle)
- #endif
- )
- __libc_fatal ("libgcc_s.so.1 must be installed for pthread_cancel to work\n");
- libgcc_s_resume = resume;
- libgcc_s_personality = personality;
- libgcc_s_forcedunwind = forcedunwind;
- libgcc_s_getcfa = getcfa;
-
- atomic_write_barrier ();
- libgcc_s_handle = handle;
- }
- void
- __libc_freeres_fn_section
- __unwind_freeres (void)
- {
- void *handle = libgcc_s_handle;
- if (handle != NULL)
- {
- libgcc_s_handle = NULL;
- __libc_dlclose (handle);
- }
- }
- __asm__ (
- " .globl _Unwind_Resume\n"
- " .type _Unwind_Resume, %function\n"
- "_Unwind_Resume:\n"
- " .cfi_sections .debug_frame\n"
- " " CFI_STARTPROC "\n"
- " stmfd sp!, {r4, r5, r6, lr}\n"
- " " CFI_ADJUST_CFA_OFFSET (16)" \n"
- " " CFI_REL_OFFSET (r4, 0) "\n"
- " " CFI_REL_OFFSET (r5, 4) "\n"
- " " CFI_REL_OFFSET (r6, 8) "\n"
- " " CFI_REL_OFFSET (lr, 12) "\n"
- " " CFI_REMEMBER_STATE "\n"
- " ldr r4, 1f\n"
- " ldr r5, 2f\n"
- "3: add r4, pc, r4\n"
- " ldr r3, [r4, r5]\n"
- " mov r6, r0\n"
- " cmp r3, #0\n"
- " beq 4f\n"
- "5: mov r0, r6\n"
- " ldmfd sp!, {r4, r5, r6, lr}\n"
- " " CFI_ADJUST_CFA_OFFSET (-16) "\n"
- " " CFI_RESTORE (r4) "\n"
- " " CFI_RESTORE (r5) "\n"
- " " CFI_RESTORE (r6) "\n"
- " " CFI_RESTORE (lr) "\n"
- " bx r3\n"
- " " CFI_RESTORE_STATE "\n"
- "4: bl pthread_cancel_init\n"
- " ldr r3, [r4, r5]\n"
- " b 5b\n"
- " " CFI_ENDPROC "\n"
- " .align 2\n"
- #ifdef __thumb2__
- "1: .word _GLOBAL_OFFSET_TABLE_ - 3b - 4\n"
- #else
- "1: .word _GLOBAL_OFFSET_TABLE_ - 3b - 8\n"
- #endif
- "2: .word libgcc_s_resume(GOTOFF)\n"
- " .size _Unwind_Resume, .-_Unwind_Resume\n"
- );
- _Unwind_Reason_Code
- __gcc_personality_v0 (_Unwind_State state,
- struct _Unwind_Exception *ue_header,
- struct _Unwind_Context *context)
- {
- if (__builtin_expect (libgcc_s_personality == NULL, 0))
- pthread_cancel_init ();
- return libgcc_s_personality (state, ue_header, context);
- }
- _Unwind_Reason_Code
- _Unwind_ForcedUnwind (struct _Unwind_Exception *exc, _Unwind_Stop_Fn stop,
- void *stop_argument)
- {
- if (__builtin_expect (libgcc_s_forcedunwind == NULL, 0))
- pthread_cancel_init ();
- return libgcc_s_forcedunwind (exc, stop, stop_argument);
- }
- _Unwind_Word
- _Unwind_GetCFA (struct _Unwind_Context *context)
- {
- if (__builtin_expect (libgcc_s_getcfa == NULL, 0))
- pthread_cancel_init ();
- return libgcc_s_getcfa (context);
- }
|