add support for POSIX message queues, except mq_notify

diff --git a/include/mqueue.h b/include/mqueue.h
new file mode 100644 (file)
index 0000000..ffbf4ae
--- /dev/null
+++ b/include/mqueue.h
@@ -0,0 +1,34 @@
+#ifndef _SEMAPHORE_H
+#define _SEMAPHORE_H
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#define __NEED_size_t
+#define __NEED_ssize_t
+#define __NEED_pthread_attr_t
+#define __NEED_time_t
+#define __NEED_struct_timespec
+#include <bits/alltypes.h>
+
+typedef int mqd_t;
+struct mq_attr {
+       long mq_flags, mq_maxmsg, mq_msgsize, mq_curmsgs, __unused[4];
+};
+struct sigevent;
+
+int mq_close(mqd_t);
+int mq_getattr(mqd_t, struct mq_attr *);
+int mq_notify(mqd_t, const struct sigevent *);
+mqd_t mq_open(const char *, int, ...);
+ssize_t mq_receive(mqd_t, char *, size_t, unsigned *);
+int mq_send(mqd_t, const char *, size_t, unsigned);
+int mq_setattr(mqd_t, const struct mq_attr *, struct mq_attr *);
+ssize_t mq_timedreceive(mqd_t, char *, size_t, unsigned *, const struct timespec *);
+int mq_timedsend(mqd_t, const char *, size_t, unsigned, const struct timespec *);
+int mq_unlink(const char *);
+
+#ifdef __cplusplus
+}
+#endif
+#endif

diff --git a/src/mq/mq_close.c b/src/mq/mq_close.c
new file mode 100644 (file)
index 0000000..a61f094
--- /dev/null
+++ b/src/mq/mq_close.c
@@ -0,0 +1,7 @@
+#include <mqueue.h>
+#include "syscall.h"
+
+int mq_close(mqd_t mqd)
+{
+       return syscall(SYS_close, mqd);
+}

diff --git a/src/mq/mq_getattr.c b/src/mq/mq_getattr.c
new file mode 100644 (file)
index 0000000..dce1806
--- /dev/null
+++ b/src/mq/mq_getattr.c
@@ -0,0 +1,7 @@
+#include <mqueue.h>
+#include "syscall.h"
+
+int mq_getattr(mqd_t mqd, struct mq_attr *attr)
+{
+       return mq_setattr(mqd, 0, attr);
+}

diff --git a/src/mq/mq_notify.c b/src/mq/mq_notify.c
new file mode 100644 (file)
index 0000000..d85db1d
--- /dev/null
+++ b/src/mq/mq_notify.c
@@ -0,0 +1,10 @@
+#include <mqueue.h>
+#include <pthread.h>
+#include <errno.h>
+#include "syscall.h"
+
+int mq_notify(mqd_t mqd, const struct sigevent *sev)
+{
+       errno = ENOSYS;
+       return -1;
+}

diff --git a/src/mq/mq_open.c b/src/mq/mq_open.c
new file mode 100644 (file)
index 0000000..57220a2
--- /dev/null
+++ b/src/mq/mq_open.c
@@ -0,0 +1,23 @@
+#include <mqueue.h>
+#include <fcntl.h>
+#include <errno.h>
+#include <stdarg.h>
+#include "syscall.h"
+
+mqd_t mq_open(const char *name, int flags, ...)
+{
+       mode_t mode = 0;
+       struct mq_attr *attr = 0;
+       if (*name++ != '/') {
+               errno = EINVAL;
+               return -1;
+       }
+       if (flags & O_CREAT) {
+               va_list ap;
+               va_start(ap, flags);
+               mode = va_arg(ap, mode_t);
+               attr = va_arg(ap, struct mq_attr *);
+               va_end(ap);
+       }
+       return syscall(SYS_mq_open, name, flags, mode, attr);
+}

diff --git a/src/mq/mq_receive.c b/src/mq/mq_receive.c
new file mode 100644 (file)
index 0000000..0b1bb4e
--- /dev/null
+++ b/src/mq/mq_receive.c
@@ -0,0 +1,6 @@
+#include <mqueue.h>
+
+ssize_t mq_receive(mqd_t mqd, char *msg, size_t len, unsigned *prio)
+{
+       return mq_timedreceive(mqd, msg, len, prio, 0);
+}

diff --git a/src/mq/mq_send.c b/src/mq/mq_send.c
new file mode 100644 (file)
index 0000000..1acb1b7
--- /dev/null
+++ b/src/mq/mq_send.c
@@ -0,0 +1,6 @@
+#include <mqueue.h>
+
+int mq_send(mqd_t mqd, const char *msg, size_t len, unsigned prio)
+{
+       return mq_timedsend(mqd, msg, len, prio, 0);
+}

diff --git a/src/mq/mq_setattr.c b/src/mq/mq_setattr.c
new file mode 100644 (file)
index 0000000..9064fa0
--- /dev/null
+++ b/src/mq/mq_setattr.c
@@ -0,0 +1,7 @@
+#include <mqueue.h>
+#include "syscall.h"
+
+int mq_setattr(mqd_t mqd, const struct mq_attr *new, struct mq_attr *old)
+{
+       return syscall(SYS_mq_getsetattr, mqd, new, old);
+}

diff --git a/src/mq/mq_timedreceive.c b/src/mq/mq_timedreceive.c
new file mode 100644 (file)
index 0000000..ad705f8
--- /dev/null
+++ b/src/mq/mq_timedreceive.c
@@ -0,0 +1,7 @@
+#include <mqueue.h>
+#include "syscall.h"
+
+ssize_t mq_timedreceive(mqd_t mqd, char *msg, size_t len, unsigned *prio, const struct timespec *at)
+{
+       return syscall(SYS_mq_timedreceive, mqd, msg, len, prio, at);
+}

diff --git a/src/mq/mq_timedsend.c b/src/mq/mq_timedsend.c
new file mode 100644 (file)
index 0000000..edbaccf
--- /dev/null
+++ b/src/mq/mq_timedsend.c
@@ -0,0 +1,7 @@
+#include <mqueue.h>
+#include "syscall.h"
+
+int mq_timedsend(mqd_t mqd, const char *msg, size_t len, unsigned prio, const struct timespec *at)
+{
+       return syscall(SYS_mq_timedsend, mqd, msg, len, prio, at);
+}

diff --git a/src/mq/mq_unlink.c b/src/mq/mq_unlink.c
new file mode 100644 (file)
index 0000000..1bb92af
--- /dev/null
+++ b/src/mq/mq_unlink.c
@@ -0,0 +1,19 @@
+#include <mqueue.h>
+#include <errno.h>
+#include "syscall.h"
+
+int mq_unlink(const char *name)
+{
+       int ret;
+       if (*name++ != '/') {
+               errno = EINVAL;
+               return -1;
+       }
+       ret = __syscall(SYS_mq_unlink, name);
+       if (ret < 0) {
+               if (ret == -EPERM) ret = -EACCES;
+               errno = -ret;
+               return -1;
+       }
+       return ret;
+}