Index: fusl/src/mq/mq_notify.c |
diff --git a/fusl/src/mq/mq_notify.c b/fusl/src/mq/mq_notify.c |
new file mode 100644 |
index 0000000000000000000000000000000000000000..221591c73ad50be87ee1174e5aea5506809f7a17 |
--- /dev/null |
+++ b/fusl/src/mq/mq_notify.c |
@@ -0,0 +1,73 @@ |
+#include <mqueue.h> |
+#include <pthread.h> |
+#include <errno.h> |
+#include <sys/socket.h> |
+#include <signal.h> |
+#include <unistd.h> |
+#include "syscall.h" |
+ |
+struct args { |
+ pthread_barrier_t barrier; |
+ int sock; |
+ const struct sigevent *sev; |
+}; |
+ |
+static void *start(void *p) |
+{ |
+ struct args *args = p; |
+ char buf[32]; |
+ ssize_t n; |
+ int s = args->sock; |
+ void (*func)(union sigval) = args->sev->sigev_notify_function; |
+ union sigval val = args->sev->sigev_value; |
+ |
+ pthread_barrier_wait(&args->barrier); |
+ n = recv(s, buf, sizeof(buf), MSG_NOSIGNAL|MSG_WAITALL); |
+ close(s); |
+ if (n==sizeof buf && buf[sizeof buf - 1] == 1) |
+ func(val); |
+ return 0; |
+} |
+ |
+int mq_notify(mqd_t mqd, const struct sigevent *sev) |
+{ |
+ struct args args = { .sev = sev }; |
+ pthread_attr_t attr; |
+ pthread_t td; |
+ int s; |
+ struct sigevent sev2; |
+ static const char zeros[32]; |
+ |
+ if (!sev || sev->sigev_notify != SIGEV_THREAD) |
+ return syscall(SYS_mq_notify, mqd, sev); |
+ |
+ s = socket(AF_NETLINK, SOCK_RAW|SOCK_CLOEXEC, 0); |
+ if (s < 0) return -1; |
+ args.sock = s; |
+ |
+ if (sev->sigev_notify_attributes) attr = *sev->sigev_notify_attributes; |
+ else pthread_attr_init(&attr); |
+ pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED); |
+ pthread_barrier_init(&args.barrier, 0, 2); |
+ |
+ if (pthread_create(&td, &attr, start, &args)) { |
+ __syscall(SYS_close, s); |
+ errno = EAGAIN; |
+ return -1; |
+ } |
+ |
+ pthread_barrier_wait(&args.barrier); |
+ pthread_barrier_destroy(&args.barrier); |
+ |
+ sev2.sigev_notify = SIGEV_THREAD; |
+ sev2.sigev_signo = s; |
+ sev2.sigev_value.sival_ptr = (void *)&zeros; |
+ |
+ if (syscall(SYS_mq_notify, mqd, &sev2) < 0) { |
+ pthread_cancel(td); |
+ __syscall(SYS_close, s); |
+ return -1; |
+ } |
+ |
+ return 0; |
+} |