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