Patch from Paul Mundt (lethal) adding an initial librt implementation.

I then reworked the syscall handling and made minor cleanups.  With luck
I've not completely broken his patch...

1 files changed, 36 insertions, 0 deletions

diff --git a/librt/mq_send.c b/librt/mq_send.c
new file mode 100644
index 000000000..947e9fe72
--- /dev/null
+++ b/librt/mq_send.c
@@ -0,0 +1,36 @@
+/*
+ * mq_send.c - functions for sending to message queue.
+ */
+
+#include <errno.h>
+#include <stddef.h>
+#include <sys/syscall.h>
+
+#include <mqueue.h>
+
+#ifdef __NR_mq_timedsend
+
+#define __NR___syscall_mq_timedsend __NR_mq_timedsend
+static inline _syscall5(int, __syscall_mq_timedsend, int, mqdes,
+	const char *, msg_ptr, size_t, msg_len, unsigned int, msg_prio,
+	const void *, abs_timeout);
+
+/*
+ * Add a message to queue. If O_NONBLOCK is set and queue is full, wait
+ * for sufficient room in the queue until abs_timeout expires.
+ */
+int mq_timedsend(mqd_t mqdes, const char *msg_ptr, size_t msg_len,
+		unsigned int msg_prio,
+		const struct timespec *abs_timeout)
+{
+    return __syscall_mq_timedsend(mqdes, msg_ptr, msg_len, msg_prio, abs_timeout);
+}
+
+/* Add a message to queue */
+int mq_send(mqd_t mqdes, const char *msg_ptr, size_t msg_len,
+		unsigned int msg_prio)
+{
+    return mq_timedsend(mqdes, msg_ptr, msg_len, msg_prio, NULL);
+}
+
+#endif