threading-posix.c 5.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260
  1. /*
  2. * Copyright (c) 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. #ifdef __APPLE__
  17. #include <sys/time.h>
  18. #include <mach/semaphore.h>
  19. #include <mach/task.h>
  20. #include <mach/mach_init.h>
  21. #else
  22. #define _GNU_SOURCE
  23. #include <semaphore.h>
  24. #endif
  25. #include "bmem.h"
  26. #include "threading.h"
  27. struct os_event_data {
  28. pthread_mutex_t mutex;
  29. pthread_cond_t cond;
  30. volatile bool signalled;
  31. bool manual;
  32. };
  33. int os_event_init(os_event_t **event, enum os_event_type type)
  34. {
  35. int code = 0;
  36. struct os_event_data *data = bzalloc(sizeof(struct os_event_data));
  37. if ((code = pthread_mutex_init(&data->mutex, NULL)) < 0) {
  38. bfree(data);
  39. return code;
  40. }
  41. if ((code = pthread_cond_init(&data->cond, NULL)) < 0) {
  42. pthread_mutex_destroy(&data->mutex);
  43. bfree(data);
  44. return code;
  45. }
  46. data->manual = (type == OS_EVENT_TYPE_MANUAL);
  47. data->signalled = false;
  48. *event = data;
  49. return 0;
  50. }
  51. void os_event_destroy(os_event_t *event)
  52. {
  53. if (event) {
  54. pthread_mutex_destroy(&event->mutex);
  55. pthread_cond_destroy(&event->cond);
  56. bfree(event);
  57. }
  58. }
  59. int os_event_wait(os_event_t *event)
  60. {
  61. int code = 0;
  62. pthread_mutex_lock(&event->mutex);
  63. if (!event->signalled)
  64. code = pthread_cond_wait(&event->cond, &event->mutex);
  65. if (code == 0) {
  66. if (!event->manual)
  67. event->signalled = false;
  68. pthread_mutex_unlock(&event->mutex);
  69. }
  70. return code;
  71. }
  72. static inline void add_ms_to_ts(struct timespec *ts,
  73. unsigned long milliseconds)
  74. {
  75. ts->tv_sec += milliseconds/1000;
  76. ts->tv_nsec += (milliseconds%1000)*1000000;
  77. if (ts->tv_nsec > 1000000000) {
  78. ts->tv_sec += 1;
  79. ts->tv_nsec -= 1000000000;
  80. }
  81. }
  82. int os_event_timedwait(os_event_t *event, unsigned long milliseconds)
  83. {
  84. int code = 0;
  85. pthread_mutex_lock(&event->mutex);
  86. if (!event->signalled) {
  87. struct timespec ts;
  88. #ifdef __APPLE__
  89. struct timeval tv;
  90. gettimeofday(&tv, NULL);
  91. ts.tv_sec = tv.tv_sec;
  92. ts.tv_nsec = tv.tv_usec * 1000;
  93. #else
  94. clock_gettime(CLOCK_REALTIME, &ts);
  95. #endif
  96. add_ms_to_ts(&ts, milliseconds);
  97. code = pthread_cond_timedwait(&event->cond, &event->mutex, &ts);
  98. }
  99. if (code == 0) {
  100. if (!event->manual)
  101. event->signalled = false;
  102. }
  103. pthread_mutex_unlock(&event->mutex);
  104. return code;
  105. }
  106. int os_event_try(os_event_t *event)
  107. {
  108. int ret = EAGAIN;
  109. pthread_mutex_lock(&event->mutex);
  110. if (event->signalled) {
  111. if (!event->manual)
  112. event->signalled = false;
  113. ret = 0;
  114. }
  115. pthread_mutex_unlock(&event->mutex);
  116. return ret;
  117. }
  118. int os_event_signal(os_event_t *event)
  119. {
  120. int code = 0;
  121. pthread_mutex_lock(&event->mutex);
  122. code = pthread_cond_signal(&event->cond);
  123. event->signalled = true;
  124. pthread_mutex_unlock(&event->mutex);
  125. return code;
  126. }
  127. void os_event_reset(os_event_t *event)
  128. {
  129. pthread_mutex_lock(&event->mutex);
  130. event->signalled = false;
  131. pthread_mutex_unlock(&event->mutex);
  132. }
  133. #ifdef __APPLE__
  134. struct os_sem_data {
  135. semaphore_t sem;
  136. task_t task;
  137. };
  138. int os_sem_init(os_sem_t **sem, int value)
  139. {
  140. semaphore_t new_sem;
  141. task_t task = mach_task_self();
  142. if (semaphore_create(task, &new_sem, 0, value) != KERN_SUCCESS)
  143. return -1;
  144. *sem = bzalloc(sizeof(struct os_sem_data));
  145. if (!*sem)
  146. return -2;
  147. (*sem)->sem = new_sem;
  148. (*sem)->task = task;
  149. return 0;
  150. }
  151. void os_sem_destroy(os_sem_t *sem)
  152. {
  153. if (sem) {
  154. semaphore_destroy(sem->task, sem->sem);
  155. bfree(sem);
  156. }
  157. }
  158. int os_sem_post(os_sem_t *sem)
  159. {
  160. if (!sem) return -1;
  161. return (semaphore_signal(sem->sem) == KERN_SUCCESS) ? 0 : -1;
  162. }
  163. int os_sem_wait(os_sem_t *sem)
  164. {
  165. if (!sem) return -1;
  166. return (semaphore_wait(sem->sem) == KERN_SUCCESS) ? 0 : -1;
  167. }
  168. #else
  169. struct os_sem_data {
  170. sem_t sem;
  171. };
  172. int os_sem_init(os_sem_t **sem, int value)
  173. {
  174. sem_t new_sem;
  175. int ret = sem_init(&new_sem, 0, value);
  176. if (ret != 0)
  177. return ret;
  178. *sem = bzalloc(sizeof(struct os_sem_data));
  179. (*sem)->sem = new_sem;
  180. return 0;
  181. }
  182. void os_sem_destroy(os_sem_t *sem)
  183. {
  184. if (sem) {
  185. sem_destroy(&sem->sem);
  186. bfree(sem);
  187. }
  188. }
  189. int os_sem_post(os_sem_t *sem)
  190. {
  191. if (!sem) return -1;
  192. return sem_post(&sem->sem);
  193. }
  194. int os_sem_wait(os_sem_t *sem)
  195. {
  196. if (!sem) return -1;
  197. return sem_wait(&sem->sem);
  198. }
  199. #endif
  200. long os_atomic_inc_long(volatile long *val)
  201. {
  202. return __sync_add_and_fetch(val, 1);
  203. }
  204. long os_atomic_dec_long(volatile long *val)
  205. {
  206. return __sync_sub_and_fetch(val, 1);
  207. }
  208. void os_set_thread_name(const char *name)
  209. {
  210. #ifdef __APPLE__
  211. pthread_setname_np(name);
  212. #else
  213. pthread_setname_np(pthread_self(), name);
  214. #endif
  215. }