1570af302Sopenharmony_ci#include <stdlib.h> 2570af302Sopenharmony_ci#include <stdint.h> 3570af302Sopenharmony_ci#include "libc.h" 4570af302Sopenharmony_ci#include "lock.h" 5570af302Sopenharmony_ci#include "fork_impl.h" 6570af302Sopenharmony_ci 7570af302Sopenharmony_ci#define malloc __libc_malloc 8570af302Sopenharmony_ci#define calloc __libc_calloc 9570af302Sopenharmony_ci#define realloc undef 10570af302Sopenharmony_ci#define free undef 11570af302Sopenharmony_ci 12570af302Sopenharmony_ci/* Ensure that at least 32 atexit handlers can be registered without malloc */ 13570af302Sopenharmony_ci#define COUNT 32 14570af302Sopenharmony_ci 15570af302Sopenharmony_cistatic struct fl 16570af302Sopenharmony_ci{ 17570af302Sopenharmony_ci struct fl *next; 18570af302Sopenharmony_ci void (*f[COUNT])(void *); 19570af302Sopenharmony_ci void *a[COUNT]; 20570af302Sopenharmony_ci} builtin, *head; 21570af302Sopenharmony_ci 22570af302Sopenharmony_cistatic int slot; 23570af302Sopenharmony_cistatic volatile int lock[1]; 24570af302Sopenharmony_civolatile int *const __atexit_lockptr = lock; 25570af302Sopenharmony_ci 26570af302Sopenharmony_civoid __funcs_on_exit() 27570af302Sopenharmony_ci{ 28570af302Sopenharmony_ci void (*func)(void *), *arg; 29570af302Sopenharmony_ci LOCK(lock); 30570af302Sopenharmony_ci for (; head; head=head->next, slot=COUNT) while(slot-->0) { 31570af302Sopenharmony_ci func = head->f[slot]; 32570af302Sopenharmony_ci arg = head->a[slot]; 33570af302Sopenharmony_ci UNLOCK(lock); 34570af302Sopenharmony_ci func(arg); 35570af302Sopenharmony_ci LOCK(lock); 36570af302Sopenharmony_ci } 37570af302Sopenharmony_ci} 38570af302Sopenharmony_ci 39570af302Sopenharmony_civoid __cxa_finalize(void *dso) 40570af302Sopenharmony_ci{ 41570af302Sopenharmony_ci} 42570af302Sopenharmony_ci 43570af302Sopenharmony_ciint __cxa_atexit(void (*func)(void *), void *arg, void *dso) 44570af302Sopenharmony_ci{ 45570af302Sopenharmony_ci LOCK(lock); 46570af302Sopenharmony_ci 47570af302Sopenharmony_ci /* Defer initialization of head so it can be in BSS */ 48570af302Sopenharmony_ci if (!head) head = &builtin; 49570af302Sopenharmony_ci 50570af302Sopenharmony_ci /* If the current function list is full, add a new one */ 51570af302Sopenharmony_ci if (slot==COUNT) { 52570af302Sopenharmony_ci struct fl *new_fl = calloc(sizeof(struct fl), 1); 53570af302Sopenharmony_ci if (!new_fl) { 54570af302Sopenharmony_ci UNLOCK(lock); 55570af302Sopenharmony_ci return -1; 56570af302Sopenharmony_ci } 57570af302Sopenharmony_ci new_fl->next = head; 58570af302Sopenharmony_ci head = new_fl; 59570af302Sopenharmony_ci slot = 0; 60570af302Sopenharmony_ci } 61570af302Sopenharmony_ci 62570af302Sopenharmony_ci /* Append function to the list. */ 63570af302Sopenharmony_ci head->f[slot] = func; 64570af302Sopenharmony_ci head->a[slot] = arg; 65570af302Sopenharmony_ci slot++; 66570af302Sopenharmony_ci 67570af302Sopenharmony_ci UNLOCK(lock); 68570af302Sopenharmony_ci return 0; 69570af302Sopenharmony_ci} 70570af302Sopenharmony_ci 71570af302Sopenharmony_cistatic void call(void *p) 72570af302Sopenharmony_ci{ 73570af302Sopenharmony_ci ((void (*)(void))(uintptr_t)p)(); 74570af302Sopenharmony_ci} 75570af302Sopenharmony_ci 76570af302Sopenharmony_ciint atexit(void (*func)(void)) 77570af302Sopenharmony_ci{ 78570af302Sopenharmony_ci return __cxa_atexit(call, (void *)(uintptr_t)func, 0); 79570af302Sopenharmony_ci} 80