signal.c 10 KB

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