signal.c 9.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391
  1. /*
  2. * Copyright (c) 2023 Lain Bailey <[email protected]>
  3. *
  4. * Permission to use, copy, modify, and distribute this software for any
  5. * purpose with or without fee is hereby granted, provided that the above
  6. * copyright notice and this permission notice appear in all copies.
  7. *
  8. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  9. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15. */
  16. #include "../util/darray.h"
  17. #include "../util/threading.h"
  18. #include "decl.h"
  19. #include "signal.h"
  20. struct signal_callback {
  21. signal_callback_t callback;
  22. void *data;
  23. bool remove;
  24. bool keep_ref;
  25. };
  26. struct signal_info {
  27. struct decl_info func;
  28. DARRAY(struct signal_callback) callbacks;
  29. pthread_mutex_t mutex;
  30. bool signalling;
  31. struct signal_info *next;
  32. };
  33. static inline struct signal_info *signal_info_create(struct decl_info *info)
  34. {
  35. struct signal_info *si = bmalloc(sizeof(struct signal_info));
  36. si->func = *info;
  37. si->next = NULL;
  38. si->signalling = false;
  39. da_init(si->callbacks);
  40. if (pthread_mutex_init_recursive(&si->mutex) != 0) {
  41. blog(LOG_ERROR, "Could not create signal");
  42. decl_info_free(&si->func);
  43. bfree(si);
  44. return NULL;
  45. }
  46. return si;
  47. }
  48. static inline void signal_info_destroy(struct signal_info *si)
  49. {
  50. if (si) {
  51. pthread_mutex_destroy(&si->mutex);
  52. decl_info_free(&si->func);
  53. da_free(si->callbacks);
  54. bfree(si);
  55. }
  56. }
  57. static inline size_t signal_get_callback_idx(struct signal_info *si, signal_callback_t callback, void *data)
  58. {
  59. for (size_t i = 0; i < si->callbacks.num; i++) {
  60. struct signal_callback *sc = si->callbacks.array + i;
  61. if (sc->callback == callback && sc->data == data)
  62. return i;
  63. }
  64. return DARRAY_INVALID;
  65. }
  66. struct global_callback_info {
  67. global_signal_callback_t callback;
  68. void *data;
  69. long signaling;
  70. bool remove;
  71. };
  72. struct signal_handler {
  73. struct signal_info *first;
  74. pthread_mutex_t mutex;
  75. volatile long refs;
  76. DARRAY(struct global_callback_info) global_callbacks;
  77. pthread_mutex_t global_callbacks_mutex;
  78. };
  79. static struct signal_info *getsignal(signal_handler_t *handler, const char *name, struct signal_info **p_last)
  80. {
  81. struct signal_info *signal, *last = NULL;
  82. signal = handler->first;
  83. while (signal != NULL) {
  84. if (strcmp(signal->func.name, name) == 0)
  85. break;
  86. last = signal;
  87. signal = signal->next;
  88. }
  89. if (p_last)
  90. *p_last = last;
  91. return signal;
  92. }
  93. /* ------------------------------------------------------------------------- */
  94. signal_handler_t *signal_handler_create(void)
  95. {
  96. struct signal_handler *handler = bzalloc(sizeof(struct signal_handler));
  97. handler->first = NULL;
  98. handler->refs = 1;
  99. if (pthread_mutex_init(&handler->mutex, NULL) != 0) {
  100. blog(LOG_ERROR, "Couldn't create signal handler mutex!");
  101. bfree(handler);
  102. return NULL;
  103. }
  104. if (pthread_mutex_init_recursive(&handler->global_callbacks_mutex) != 0) {
  105. blog(LOG_ERROR, "Couldn't create signal handler global "
  106. "callbacks mutex!");
  107. pthread_mutex_destroy(&handler->mutex);
  108. bfree(handler);
  109. return NULL;
  110. }
  111. return handler;
  112. }
  113. static void signal_handler_actually_destroy(signal_handler_t *handler)
  114. {
  115. struct signal_info *sig = handler->first;
  116. while (sig != NULL) {
  117. struct signal_info *next = sig->next;
  118. signal_info_destroy(sig);
  119. sig = next;
  120. }
  121. da_free(handler->global_callbacks);
  122. pthread_mutex_destroy(&handler->global_callbacks_mutex);
  123. pthread_mutex_destroy(&handler->mutex);
  124. bfree(handler);
  125. }
  126. void signal_handler_destroy(signal_handler_t *handler)
  127. {
  128. if (handler && os_atomic_dec_long(&handler->refs) == 0) {
  129. signal_handler_actually_destroy(handler);
  130. }
  131. }
  132. bool signal_handler_add(signal_handler_t *handler, const char *signal_decl)
  133. {
  134. struct decl_info func = {0};
  135. struct signal_info *sig, *last;
  136. bool success = true;
  137. if (!parse_decl_string(&func, signal_decl)) {
  138. blog(LOG_ERROR, "Signal declaration invalid: %s", signal_decl);
  139. return false;
  140. }
  141. pthread_mutex_lock(&handler->mutex);
  142. sig = getsignal(handler, func.name, &last);
  143. if (sig) {
  144. blog(LOG_WARNING, "Signal declaration '%s' exists", func.name);
  145. decl_info_free(&func);
  146. success = false;
  147. } else {
  148. sig = signal_info_create(&func);
  149. if (!last)
  150. handler->first = sig;
  151. else
  152. last->next = sig;
  153. }
  154. pthread_mutex_unlock(&handler->mutex);
  155. return success;
  156. }
  157. static void signal_handler_connect_internal(signal_handler_t *handler, const char *signal, signal_callback_t callback,
  158. void *data, bool keep_ref)
  159. {
  160. struct signal_info *sig, *last;
  161. struct signal_callback cb_data = {callback, data, false, keep_ref};
  162. size_t idx;
  163. if (!handler)
  164. return;
  165. pthread_mutex_lock(&handler->mutex);
  166. sig = getsignal(handler, signal, &last);
  167. pthread_mutex_unlock(&handler->mutex);
  168. if (!sig) {
  169. blog(LOG_WARNING,
  170. "signal_handler_connect: "
  171. "signal '%s' not found",
  172. signal);
  173. return;
  174. }
  175. /* -------------- */
  176. pthread_mutex_lock(&sig->mutex);
  177. if (keep_ref)
  178. os_atomic_inc_long(&handler->refs);
  179. idx = signal_get_callback_idx(sig, callback, data);
  180. if (keep_ref || idx == DARRAY_INVALID)
  181. da_push_back(sig->callbacks, &cb_data);
  182. pthread_mutex_unlock(&sig->mutex);
  183. }
  184. void signal_handler_connect(signal_handler_t *handler, const char *signal, signal_callback_t callback, void *data)
  185. {
  186. signal_handler_connect_internal(handler, signal, callback, data, false);
  187. }
  188. void signal_handler_connect_ref(signal_handler_t *handler, const char *signal, signal_callback_t callback, void *data)
  189. {
  190. signal_handler_connect_internal(handler, signal, callback, data, true);
  191. }
  192. static inline struct signal_info *getsignal_locked(signal_handler_t *handler, const char *name)
  193. {
  194. struct signal_info *sig;
  195. if (!handler)
  196. return NULL;
  197. pthread_mutex_lock(&handler->mutex);
  198. sig = getsignal(handler, name, NULL);
  199. pthread_mutex_unlock(&handler->mutex);
  200. return sig;
  201. }
  202. void signal_handler_disconnect(signal_handler_t *handler, const char *signal, signal_callback_t callback, void *data)
  203. {
  204. struct signal_info *sig = getsignal_locked(handler, signal);
  205. bool keep_ref = false;
  206. size_t idx;
  207. if (!sig)
  208. return;
  209. pthread_mutex_lock(&sig->mutex);
  210. idx = signal_get_callback_idx(sig, callback, data);
  211. if (idx != DARRAY_INVALID) {
  212. if (sig->signalling) {
  213. sig->callbacks.array[idx].remove = true;
  214. } else {
  215. keep_ref = sig->callbacks.array[idx].keep_ref;
  216. da_erase(sig->callbacks, idx);
  217. }
  218. }
  219. pthread_mutex_unlock(&sig->mutex);
  220. if (keep_ref && os_atomic_dec_long(&handler->refs) == 0) {
  221. signal_handler_actually_destroy(handler);
  222. }
  223. }
  224. static THREAD_LOCAL struct signal_callback *current_signal_cb = NULL;
  225. static THREAD_LOCAL struct global_callback_info *current_global_cb = NULL;
  226. void signal_handler_remove_current(void)
  227. {
  228. if (current_signal_cb)
  229. current_signal_cb->remove = true;
  230. else if (current_global_cb)
  231. current_global_cb->remove = true;
  232. }
  233. void signal_handler_signal(signal_handler_t *handler, const char *signal, calldata_t *params)
  234. {
  235. struct signal_info *sig = getsignal_locked(handler, signal);
  236. long remove_refs = 0;
  237. if (!sig)
  238. return;
  239. pthread_mutex_lock(&sig->mutex);
  240. sig->signalling = true;
  241. for (size_t i = 0; i < sig->callbacks.num; i++) {
  242. struct signal_callback *cb = sig->callbacks.array + i;
  243. if (!cb->remove) {
  244. current_signal_cb = cb;
  245. cb->callback(cb->data, params);
  246. current_signal_cb = NULL;
  247. }
  248. }
  249. for (size_t i = sig->callbacks.num; i > 0; i--) {
  250. struct signal_callback *cb = sig->callbacks.array + i - 1;
  251. if (cb->remove) {
  252. if (cb->keep_ref)
  253. remove_refs++;
  254. da_erase(sig->callbacks, i - 1);
  255. }
  256. }
  257. sig->signalling = false;
  258. pthread_mutex_unlock(&sig->mutex);
  259. pthread_mutex_lock(&handler->global_callbacks_mutex);
  260. if (handler->global_callbacks.num) {
  261. for (size_t i = 0; i < handler->global_callbacks.num; i++) {
  262. struct global_callback_info *cb = handler->global_callbacks.array + i;
  263. if (!cb->remove) {
  264. cb->signaling++;
  265. current_global_cb = cb;
  266. cb->callback(cb->data, signal, params);
  267. current_global_cb = NULL;
  268. cb->signaling--;
  269. }
  270. }
  271. for (size_t i = handler->global_callbacks.num; i > 0; i--) {
  272. struct global_callback_info *cb = handler->global_callbacks.array + (i - 1);
  273. if (cb->remove && !cb->signaling)
  274. da_erase(handler->global_callbacks, i - 1);
  275. }
  276. }
  277. pthread_mutex_unlock(&handler->global_callbacks_mutex);
  278. if (remove_refs) {
  279. os_atomic_set_long(&handler->refs, os_atomic_load_long(&handler->refs) - remove_refs);
  280. }
  281. }
  282. void signal_handler_connect_global(signal_handler_t *handler, global_signal_callback_t callback, void *data)
  283. {
  284. struct global_callback_info cb_data = {callback, data, 0, false};
  285. size_t idx;
  286. if (!handler || !callback)
  287. return;
  288. pthread_mutex_lock(&handler->global_callbacks_mutex);
  289. idx = da_find(handler->global_callbacks, &cb_data, 0);
  290. if (idx == DARRAY_INVALID)
  291. da_push_back(handler->global_callbacks, &cb_data);
  292. pthread_mutex_unlock(&handler->global_callbacks_mutex);
  293. }
  294. void signal_handler_disconnect_global(signal_handler_t *handler, global_signal_callback_t callback, void *data)
  295. {
  296. struct global_callback_info cb_data = {callback, data, 0, false};
  297. size_t idx;
  298. if (!handler || !callback)
  299. return;
  300. pthread_mutex_lock(&handler->global_callbacks_mutex);
  301. idx = da_find(handler->global_callbacks, &cb_data, 0);
  302. if (idx != DARRAY_INVALID) {
  303. struct global_callback_info *cb = handler->global_callbacks.array + idx;
  304. if (cb->signaling)
  305. cb->remove = true;
  306. else
  307. da_erase(handler->global_callbacks, idx);
  308. }
  309. pthread_mutex_unlock(&handler->global_callbacks_mutex);
  310. }