1152832Sdavidxu/* $FreeBSD$ */
2205225Skib
3205225Skib#include <sys/types.h>
4205225Skib#include <sys/event.h>
5205225Skib#include <sys/select.h>
6205225Skib#include <sys/wait.h>
7205225Skib#include <err.h>
8205225Skib#include <fcntl.h>
9152832Sdavidxu#include <mqueue.h>
10152832Sdavidxu#include <signal.h>
11205225Skib#include <stdio.h>
12205225Skib#include <stdlib.h>
13152832Sdavidxu#include <unistd.h>
14152832Sdavidxu
15152832Sdavidxu#define MQNAME	"/mytstqueue5"
16152832Sdavidxu#define LOOPS	1000
17152832Sdavidxu#define PRIO	10
18152832Sdavidxu
19152832Sdavidxuvoid sighandler(int sig)
20152832Sdavidxu{
21152832Sdavidxu	write(1, "timeout\n", 8);
22152832Sdavidxu	_exit(1);
23152832Sdavidxu}
24152832Sdavidxu
25152832Sdavidxuint main()
26152832Sdavidxu{
27165829Sdavidxu	mqd_t mq;
28165829Sdavidxu	int status;
29152832Sdavidxu	struct mq_attr attr;
30152832Sdavidxu	int pid;
31152832Sdavidxu	sigset_t set;
32152832Sdavidxu	struct sigaction sa;
33152832Sdavidxu	siginfo_t info;
34152832Sdavidxu
35152832Sdavidxu	mq_unlink(MQNAME);
36152832Sdavidxu
37152832Sdavidxu	sigemptyset(&set);
38152832Sdavidxu	sigaddset(&set, SIGRTMIN);
39152832Sdavidxu	sigprocmask(SIG_BLOCK, &set, NULL);
40152832Sdavidxu	sigemptyset(&sa.sa_mask);
41152832Sdavidxu	sa.sa_flags = SA_SIGINFO;
42152832Sdavidxu	sa.sa_sigaction = (void *) SIG_DFL;
43152832Sdavidxu	sigaction(SIGRTMIN, &sa, NULL);
44152832Sdavidxu
45152832Sdavidxu	attr.mq_maxmsg  = 5;
46152832Sdavidxu	attr.mq_msgsize = 128;
47152832Sdavidxu	mq = mq_open(MQNAME, O_CREAT | O_RDWR | O_EXCL, 0666, &attr);
48165829Sdavidxu	if (mq == (mqd_t)-1)
49152832Sdavidxu		err(1, "mq_open()");
50152832Sdavidxu	status = mq_getattr(mq, &attr);
51152832Sdavidxu	if (status)
52152832Sdavidxu		err(1, "mq_getattr()");
53152832Sdavidxu	pid = fork();
54152832Sdavidxu	if (pid == 0) { /* child */
55152832Sdavidxu		int prio, j, i;
56152832Sdavidxu		char *buf;
57152832Sdavidxu		struct sigevent sigev;
58152832Sdavidxu
59152832Sdavidxu		signal(SIGALRM, sighandler);
60152832Sdavidxu
61152832Sdavidxu		sigev.sigev_notify = SIGEV_SIGNAL;
62152832Sdavidxu		sigev.sigev_signo = SIGRTMIN;
63152832Sdavidxu		sigev.sigev_value.sival_int = 2;
64152832Sdavidxu
65152832Sdavidxu		mq_close(mq);
66152832Sdavidxu		mq = mq_open(MQNAME, O_RDWR | O_NONBLOCK);
67165829Sdavidxu		if (mq == (mqd_t)-1)
68152832Sdavidxu			err(1, "child: mq_open");
69152832Sdavidxu		buf = malloc(attr.mq_msgsize);
70152832Sdavidxu		for (j = 0; j < LOOPS; ++j) {
71152832Sdavidxu			alarm(3);
72152832Sdavidxu			status = mq_notify(mq, &sigev);
73152832Sdavidxu			if (status)
74152832Sdavidxu				err(1, "child: mq_notify");
75152832Sdavidxu			status = sigwaitinfo(&set, &info);
76152832Sdavidxu			if (status == -1)
77152832Sdavidxu				err(1, "child: sigwaitinfo");
78152832Sdavidxu			if (info.si_value.sival_int != 2)
79152832Sdavidxu				err(1, "child: sival_int");
80152832Sdavidxu			status = mq_receive(mq, buf, attr.mq_msgsize, &prio);
81152832Sdavidxu			if (status == -1)
82152832Sdavidxu				err(2, "child: mq_receive");
83152832Sdavidxu			for (i = 0; i < attr.mq_msgsize; ++i)
84152832Sdavidxu				if (buf[i] != i)
85152832Sdavidxu					err(3, "child: message data corrupted");
86152832Sdavidxu			if (prio != PRIO)
87152832Sdavidxu				err(4, "child: priority is incorrect: %d",
88152832Sdavidxu					 prio);
89152832Sdavidxu		}
90152832Sdavidxu		alarm(0);
91152832Sdavidxu		free(buf);
92152832Sdavidxu		mq_close(mq);
93152832Sdavidxu		return (0);
94152832Sdavidxu	} else if (pid == -1) {
95152832Sdavidxu		err(1, "fork()");
96152832Sdavidxu	} else {
97152832Sdavidxu		char *buf;
98152832Sdavidxu		int i, j, prio;
99152832Sdavidxu
100152832Sdavidxu		signal(SIGALRM, sighandler);
101152832Sdavidxu		buf = malloc(attr.mq_msgsize);
102152832Sdavidxu		for (j = 0; j < LOOPS; ++j) {
103152832Sdavidxu			for (i = 0; i < attr.mq_msgsize; ++i) {
104152832Sdavidxu				buf[i] = i;
105152832Sdavidxu			}
106152832Sdavidxu			alarm(3);
107152832Sdavidxu			status = mq_send(mq, buf, attr.mq_msgsize, PRIO);
108152832Sdavidxu			if (status) {
109152832Sdavidxu				kill(pid, SIGKILL);
110152832Sdavidxu				err(2, "mq_send()");
111152832Sdavidxu			}
112152832Sdavidxu		}
113152832Sdavidxu		alarm(3);
114152832Sdavidxu		wait(&status);
115152832Sdavidxu		alarm(0);
116152832Sdavidxu	}
117152832Sdavidxu	status = mq_close(mq);
118152832Sdavidxu	if (status)
119152832Sdavidxu		err(1, "mq_close");
120152832Sdavidxu	mq_unlink(MQNAME);
121152832Sdavidxu	return (0);
122152832Sdavidxu}
123