1
0

signal.c 9.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412
  1. /*
  2. * Copyright (c) 2013-2014 Hugh 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,
  58. signal_callback_t callback,
  59. void *data)
  60. {
  61. for (size_t i = 0; i < si->callbacks.num; i++) {
  62. struct signal_callback *sc = si->callbacks.array + i;
  63. if (sc->callback == callback && sc->data == data)
  64. return i;
  65. }
  66. return DARRAY_INVALID;
  67. }
  68. struct global_callback_info {
  69. global_signal_callback_t callback;
  70. void *data;
  71. long signaling;
  72. bool remove;
  73. };
  74. struct signal_handler {
  75. struct signal_info *first;
  76. pthread_mutex_t mutex;
  77. volatile long refs;
  78. DARRAY(struct global_callback_info) global_callbacks;
  79. pthread_mutex_t global_callbacks_mutex;
  80. };
  81. static struct signal_info *getsignal(signal_handler_t *handler,
  82. const char *name,
  83. struct signal_info **p_last)
  84. {
  85. struct signal_info *signal, *last = NULL;
  86. signal = handler->first;
  87. while (signal != NULL) {
  88. if (strcmp(signal->func.name, name) == 0)
  89. break;
  90. last = signal;
  91. signal = signal->next;
  92. }
  93. if (p_last)
  94. *p_last = last;
  95. return signal;
  96. }
  97. /* ------------------------------------------------------------------------- */
  98. signal_handler_t *signal_handler_create(void)
  99. {
  100. struct signal_handler *handler = bzalloc(sizeof(struct signal_handler));
  101. handler->first = NULL;
  102. handler->refs = 1;
  103. if (pthread_mutex_init(&handler->mutex, NULL) != 0) {
  104. blog(LOG_ERROR, "Couldn't create signal handler mutex!");
  105. bfree(handler);
  106. return NULL;
  107. }
  108. if (pthread_mutex_init_recursive(&handler->global_callbacks_mutex) !=
  109. 0) {
  110. blog(LOG_ERROR, "Couldn't create signal handler global "
  111. "callbacks mutex!");
  112. pthread_mutex_destroy(&handler->mutex);
  113. bfree(handler);
  114. return NULL;
  115. }
  116. return handler;
  117. }
  118. static void signal_handler_actually_destroy(signal_handler_t *handler)
  119. {
  120. struct signal_info *sig = handler->first;
  121. while (sig != NULL) {
  122. struct signal_info *next = sig->next;
  123. signal_info_destroy(sig);
  124. sig = next;
  125. }
  126. da_free(handler->global_callbacks);
  127. pthread_mutex_destroy(&handler->global_callbacks_mutex);
  128. pthread_mutex_destroy(&handler->mutex);
  129. bfree(handler);
  130. }
  131. void signal_handler_destroy(signal_handler_t *handler)
  132. {
  133. if (handler && os_atomic_dec_long(&handler->refs) == 0) {
  134. signal_handler_actually_destroy(handler);
  135. }
  136. }
  137. bool signal_handler_add(signal_handler_t *handler, const char *signal_decl)
  138. {
  139. struct decl_info func = {0};
  140. struct signal_info *sig, *last;
  141. bool success = true;
  142. if (!parse_decl_string(&func, signal_decl)) {
  143. blog(LOG_ERROR, "Signal declaration invalid: %s", signal_decl);
  144. return false;
  145. }
  146. pthread_mutex_lock(&handler->mutex);
  147. sig = getsignal(handler, func.name, &last);
  148. if (sig) {
  149. blog(LOG_WARNING, "Signal declaration '%s' exists", func.name);
  150. decl_info_free(&func);
  151. success = false;
  152. } else {
  153. sig = signal_info_create(&func);
  154. if (!last)
  155. handler->first = sig;
  156. else
  157. last->next = sig;
  158. }
  159. pthread_mutex_unlock(&handler->mutex);
  160. return success;
  161. }
  162. static void signal_handler_connect_internal(signal_handler_t *handler,
  163. const char *signal,
  164. signal_callback_t callback,
  165. void *data, bool keep_ref)
  166. {
  167. struct signal_info *sig, *last;
  168. struct signal_callback cb_data = {callback, data, false, keep_ref};
  169. size_t idx;
  170. if (!handler)
  171. return;
  172. pthread_mutex_lock(&handler->mutex);
  173. sig = getsignal(handler, signal, &last);
  174. pthread_mutex_unlock(&handler->mutex);
  175. if (!sig) {
  176. blog(LOG_WARNING,
  177. "signal_handler_connect: "
  178. "signal '%s' not found",
  179. signal);
  180. return;
  181. }
  182. /* -------------- */
  183. pthread_mutex_lock(&sig->mutex);
  184. if (keep_ref)
  185. os_atomic_inc_long(&handler->refs);
  186. idx = signal_get_callback_idx(sig, callback, data);
  187. if (keep_ref || idx == DARRAY_INVALID)
  188. da_push_back(sig->callbacks, &cb_data);
  189. pthread_mutex_unlock(&sig->mutex);
  190. }
  191. void signal_handler_connect(signal_handler_t *handler, const char *signal,
  192. signal_callback_t callback, void *data)
  193. {
  194. signal_handler_connect_internal(handler, signal, callback, data, false);
  195. }
  196. void signal_handler_connect_ref(signal_handler_t *handler, const char *signal,
  197. signal_callback_t callback, void *data)
  198. {
  199. signal_handler_connect_internal(handler, signal, callback, data, true);
  200. }
  201. static inline struct signal_info *getsignal_locked(signal_handler_t *handler,
  202. const char *name)
  203. {
  204. struct signal_info *sig;
  205. if (!handler)
  206. return NULL;
  207. pthread_mutex_lock(&handler->mutex);
  208. sig = getsignal(handler, name, NULL);
  209. pthread_mutex_unlock(&handler->mutex);
  210. return sig;
  211. }
  212. void signal_handler_disconnect(signal_handler_t *handler, const char *signal,
  213. signal_callback_t callback, void *data)
  214. {
  215. struct signal_info *sig = getsignal_locked(handler, signal);
  216. bool keep_ref = false;
  217. size_t idx;
  218. if (!sig)
  219. return;
  220. pthread_mutex_lock(&sig->mutex);
  221. idx = signal_get_callback_idx(sig, callback, data);
  222. if (idx != DARRAY_INVALID) {
  223. if (sig->signalling) {
  224. sig->callbacks.array[idx].remove = true;
  225. } else {
  226. keep_ref = sig->callbacks.array[idx].keep_ref;
  227. da_erase(sig->callbacks, idx);
  228. }
  229. }
  230. pthread_mutex_unlock(&sig->mutex);
  231. if (keep_ref && os_atomic_dec_long(&handler->refs) == 0) {
  232. signal_handler_actually_destroy(handler);
  233. }
  234. }
  235. static THREAD_LOCAL struct signal_callback *current_signal_cb = NULL;
  236. static THREAD_LOCAL struct global_callback_info *current_global_cb = NULL;
  237. void signal_handler_remove_current(void)
  238. {
  239. if (current_signal_cb)
  240. current_signal_cb->remove = true;
  241. else if (current_global_cb)
  242. current_global_cb->remove = true;
  243. }
  244. void signal_handler_signal(signal_handler_t *handler, const char *signal,
  245. calldata_t *params)
  246. {
  247. struct signal_info *sig = getsignal_locked(handler, signal);
  248. long remove_refs = 0;
  249. if (!sig)
  250. return;
  251. pthread_mutex_lock(&sig->mutex);
  252. sig->signalling = true;
  253. for (size_t i = 0; i < sig->callbacks.num; i++) {
  254. struct signal_callback *cb = sig->callbacks.array + i;
  255. if (!cb->remove) {
  256. current_signal_cb = cb;
  257. cb->callback(cb->data, params);
  258. current_signal_cb = NULL;
  259. }
  260. }
  261. for (size_t i = sig->callbacks.num; i > 0; i--) {
  262. struct signal_callback *cb = sig->callbacks.array + i - 1;
  263. if (cb->remove) {
  264. if (cb->keep_ref)
  265. remove_refs++;
  266. da_erase(sig->callbacks, i - 1);
  267. }
  268. }
  269. sig->signalling = false;
  270. pthread_mutex_unlock(&sig->mutex);
  271. pthread_mutex_lock(&handler->global_callbacks_mutex);
  272. if (handler->global_callbacks.num) {
  273. for (size_t i = 0; i < handler->global_callbacks.num; i++) {
  274. struct global_callback_info *cb =
  275. handler->global_callbacks.array + i;
  276. if (!cb->remove) {
  277. cb->signaling++;
  278. current_global_cb = cb;
  279. cb->callback(cb->data, signal, params);
  280. current_global_cb = NULL;
  281. cb->signaling--;
  282. }
  283. }
  284. for (size_t i = handler->global_callbacks.num; i > 0; i--) {
  285. struct global_callback_info *cb =
  286. handler->global_callbacks.array + (i - 1);
  287. if (cb->remove && !cb->signaling)
  288. da_erase(handler->global_callbacks, i - 1);
  289. }
  290. }
  291. pthread_mutex_unlock(&handler->global_callbacks_mutex);
  292. if (remove_refs) {
  293. os_atomic_set_long(&handler->refs,
  294. os_atomic_load_long(&handler->refs) -
  295. remove_refs);
  296. }
  297. }
  298. void signal_handler_connect_global(signal_handler_t *handler,
  299. global_signal_callback_t callback,
  300. void *data)
  301. {
  302. struct global_callback_info cb_data = {callback, data, 0, false};
  303. size_t idx;
  304. if (!handler || !callback)
  305. return;
  306. pthread_mutex_lock(&handler->global_callbacks_mutex);
  307. idx = da_find(handler->global_callbacks, &cb_data, 0);
  308. if (idx == DARRAY_INVALID)
  309. da_push_back(handler->global_callbacks, &cb_data);
  310. pthread_mutex_unlock(&handler->global_callbacks_mutex);
  311. }
  312. void signal_handler_disconnect_global(signal_handler_t *handler,
  313. global_signal_callback_t callback,
  314. void *data)
  315. {
  316. struct global_callback_info cb_data = {callback, data, 0, false};
  317. size_t idx;
  318. if (!handler || !callback)
  319. return;
  320. pthread_mutex_lock(&handler->global_callbacks_mutex);
  321. idx = da_find(handler->global_callbacks, &cb_data, 0);
  322. if (idx != DARRAY_INVALID) {
  323. struct global_callback_info *cb =
  324. handler->global_callbacks.array + idx;
  325. if (cb->signaling)
  326. cb->remove = true;
  327. else
  328. da_erase(handler->global_callbacks, idx);
  329. }
  330. pthread_mutex_unlock(&handler->global_callbacks_mutex);
  331. }