Home | History | Annotate | Line # | Download | only in kern
sys_mqueue.c revision 1.2.4.5
      1  1.2.4.5  joerg /*	$NetBSD: sys_mqueue.c,v 1.2.4.5 2007/12/03 16:14:58 joerg Exp $	*/
      2  1.2.4.2  joerg 
      3  1.2.4.2  joerg /*
      4  1.2.4.2  joerg  * Copyright (c) 2007, Mindaugas Rasiukevicius <rmind at NetBSD org>
      5  1.2.4.5  joerg  * All rights reserved.
      6  1.2.4.2  joerg  *
      7  1.2.4.2  joerg  * Redistribution and use in source and binary forms, with or without
      8  1.2.4.2  joerg  * modification, are permitted provided that the following conditions
      9  1.2.4.2  joerg  * are met:
     10  1.2.4.2  joerg  * 1. Redistributions of source code must retain the above copyright
     11  1.2.4.2  joerg  *    notice, this list of conditions and the following disclaimer.
     12  1.2.4.2  joerg  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.2.4.2  joerg  *    notice, this list of conditions and the following disclaimer in the
     14  1.2.4.2  joerg  *    documentation and/or other materials provided with the distribution.
     15  1.2.4.2  joerg  *
     16  1.2.4.2  joerg  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
     17  1.2.4.2  joerg  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  1.2.4.2  joerg  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  1.2.4.2  joerg  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20  1.2.4.2  joerg  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  1.2.4.2  joerg  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  1.2.4.2  joerg  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  1.2.4.2  joerg  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  1.2.4.2  joerg  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  1.2.4.2  joerg  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  1.2.4.2  joerg  * POSSIBILITY OF SUCH DAMAGE.
     27  1.2.4.2  joerg  */
     28  1.2.4.2  joerg 
     29  1.2.4.2  joerg /*
     30  1.2.4.2  joerg  * Implementation of POSIX message queues.
     31  1.2.4.2  joerg  * Defined in the Base Definitions volume of IEEE Std 1003.1-2001.
     32  1.2.4.2  joerg  *
     33  1.2.4.2  joerg  * Locking
     34  1.2.4.2  joerg  *  Global list of message queues and proc::p_mqueue_cnt counter are protected
     35  1.2.4.2  joerg  *  by mqlist_mtx lock.  Concrete message queue and its members are protected
     36  1.2.4.2  joerg  *  by mqueue::mq_mtx.
     37  1.2.4.2  joerg  *
     38  1.2.4.2  joerg  * Lock order:
     39  1.2.4.2  joerg  * 	mqlist_mtx
     40  1.2.4.2  joerg  * 	  -> mqueue::mq_mtx
     41  1.2.4.2  joerg  *
     42  1.2.4.2  joerg  * TODO:
     43  1.2.4.2  joerg  *  - Hashing or RB-tree for the global list.
     44  1.2.4.2  joerg  *  - Support for select(), poll() and perhaps kqueue().
     45  1.2.4.2  joerg  */
     46  1.2.4.2  joerg 
     47  1.2.4.2  joerg #include <sys/cdefs.h>
     48  1.2.4.5  joerg __KERNEL_RCSID(0, "$NetBSD: sys_mqueue.c,v 1.2.4.5 2007/12/03 16:14:58 joerg Exp $");
     49  1.2.4.2  joerg 
     50  1.2.4.2  joerg #include <sys/param.h>
     51  1.2.4.2  joerg #include <sys/types.h>
     52  1.2.4.2  joerg 
     53  1.2.4.2  joerg #include <sys/condvar.h>
     54  1.2.4.2  joerg #include <sys/errno.h>
     55  1.2.4.2  joerg #include <sys/fcntl.h>
     56  1.2.4.2  joerg #include <sys/file.h>
     57  1.2.4.2  joerg #include <sys/filedesc.h>
     58  1.2.4.2  joerg #include <sys/kauth.h>
     59  1.2.4.2  joerg #include <sys/kernel.h>
     60  1.2.4.2  joerg #include <sys/kmem.h>
     61  1.2.4.2  joerg #include <sys/lwp.h>
     62  1.2.4.2  joerg #include <sys/mqueue.h>
     63  1.2.4.2  joerg #include <sys/mutex.h>
     64  1.2.4.2  joerg #include <sys/pool.h>
     65  1.2.4.2  joerg #include <sys/proc.h>
     66  1.2.4.2  joerg #include <sys/queue.h>
     67  1.2.4.2  joerg #include <sys/signal.h>
     68  1.2.4.2  joerg #include <sys/signalvar.h>
     69  1.2.4.2  joerg #include <sys/sysctl.h>
     70  1.2.4.2  joerg #include <sys/syscallargs.h>
     71  1.2.4.2  joerg #include <sys/systm.h>
     72  1.2.4.2  joerg #include <sys/unistd.h>
     73  1.2.4.2  joerg #include <sys/vnode.h>
     74  1.2.4.2  joerg 
     75  1.2.4.2  joerg /* System-wide limits. */
     76  1.2.4.2  joerg static u_int			mq_open_max = MQ_OPEN_MAX;
     77  1.2.4.2  joerg static u_int			mq_prio_max = MQ_PRIO_MAX;
     78  1.2.4.2  joerg 
     79  1.2.4.2  joerg static u_int			mq_max_msgsize = 16 * MQ_DEF_MSGSIZE;
     80  1.2.4.2  joerg static u_int			mq_def_maxmsg = 32;
     81  1.2.4.2  joerg 
     82  1.2.4.2  joerg static kmutex_t			mqlist_mtx;
     83  1.2.4.2  joerg static struct pool		mqmsg_poll;
     84  1.2.4.4  joerg static LIST_HEAD(, mqueue)	mqueue_head =
     85  1.2.4.4  joerg 	LIST_HEAD_INITIALIZER(mqueue_head);
     86  1.2.4.2  joerg 
     87  1.2.4.2  joerg static int	mq_close_fop(struct file *, struct lwp *);
     88  1.2.4.2  joerg 
     89  1.2.4.2  joerg static const struct fileops mqops = {
     90  1.2.4.2  joerg 	fbadop_read, fbadop_write, fbadop_ioctl, fnullop_fcntl, fnullop_poll,
     91  1.2.4.2  joerg 	fbadop_stat, mq_close_fop, fnullop_kqfilter
     92  1.2.4.2  joerg };
     93  1.2.4.2  joerg 
     94  1.2.4.2  joerg /*
     95  1.2.4.2  joerg  * Initialize POSIX message queue subsystem.
     96  1.2.4.2  joerg  */
     97  1.2.4.2  joerg void
     98  1.2.4.2  joerg mqueue_sysinit(void)
     99  1.2.4.2  joerg {
    100  1.2.4.2  joerg 
    101  1.2.4.2  joerg 	pool_init(&mqmsg_poll, MQ_DEF_MSGSIZE, 0, 0, 0,
    102  1.2.4.2  joerg 	    "mqmsg_poll", &pool_allocator_nointr, IPL_NONE);
    103  1.2.4.2  joerg 	mutex_init(&mqlist_mtx, MUTEX_DEFAULT, IPL_NONE);
    104  1.2.4.2  joerg }
    105  1.2.4.2  joerg 
    106  1.2.4.2  joerg /*
    107  1.2.4.2  joerg  * Free the message.
    108  1.2.4.2  joerg  */
    109  1.2.4.2  joerg static void
    110  1.2.4.2  joerg mqueue_freemsg(struct mq_msg *msg, const size_t size)
    111  1.2.4.2  joerg {
    112  1.2.4.2  joerg 
    113  1.2.4.2  joerg 	if (size > MQ_DEF_MSGSIZE)
    114  1.2.4.2  joerg 		kmem_free(msg, size);
    115  1.2.4.2  joerg 	else
    116  1.2.4.2  joerg 		pool_put(&mqmsg_poll, msg);
    117  1.2.4.2  joerg }
    118  1.2.4.2  joerg 
    119  1.2.4.2  joerg /*
    120  1.2.4.2  joerg  * Destroy the message queue.
    121  1.2.4.2  joerg  */
    122  1.2.4.2  joerg static void
    123  1.2.4.2  joerg mqueue_destroy(struct mqueue *mq)
    124  1.2.4.2  joerg {
    125  1.2.4.2  joerg 	struct mq_msg *msg;
    126  1.2.4.2  joerg 
    127  1.2.4.2  joerg 	while ((msg = TAILQ_FIRST(&mq->mq_head)) != NULL) {
    128  1.2.4.2  joerg 		TAILQ_REMOVE(&mq->mq_head, msg, msg_queue);
    129  1.2.4.2  joerg 		mqueue_freemsg(msg, sizeof(struct mq_msg) + msg->msg_len);
    130  1.2.4.2  joerg 	}
    131  1.2.4.2  joerg 	cv_destroy(&mq->mq_send_cv);
    132  1.2.4.2  joerg 	cv_destroy(&mq->mq_recv_cv);
    133  1.2.4.2  joerg 	mutex_destroy(&mq->mq_mtx);
    134  1.2.4.2  joerg 	kmem_free(mq, sizeof(struct mqueue));
    135  1.2.4.2  joerg }
    136  1.2.4.2  joerg 
    137  1.2.4.2  joerg /*
    138  1.2.4.2  joerg  * Lookup for file name in general list of message queues.
    139  1.2.4.2  joerg  *  => locks the message queue
    140  1.2.4.2  joerg  */
    141  1.2.4.2  joerg static void *
    142  1.2.4.2  joerg mqueue_lookup(char *name)
    143  1.2.4.2  joerg {
    144  1.2.4.2  joerg 	struct mqueue *mq;
    145  1.2.4.2  joerg 	KASSERT(mutex_owned(&mqlist_mtx));
    146  1.2.4.2  joerg 
    147  1.2.4.2  joerg 	LIST_FOREACH(mq, &mqueue_head, mq_list) {
    148  1.2.4.2  joerg 		if (strncmp(mq->mq_name, name, MQ_NAMELEN) == 0) {
    149  1.2.4.2  joerg 			mutex_enter(&mq->mq_mtx);
    150  1.2.4.2  joerg 			return mq;
    151  1.2.4.2  joerg 		}
    152  1.2.4.2  joerg 	}
    153  1.2.4.2  joerg 
    154  1.2.4.2  joerg 	return NULL;
    155  1.2.4.2  joerg }
    156  1.2.4.2  joerg 
    157  1.2.4.2  joerg /*
    158  1.2.4.2  joerg  * Check access against message queue.
    159  1.2.4.2  joerg  */
    160  1.2.4.2  joerg static inline int
    161  1.2.4.2  joerg mqueue_access(struct lwp *l, struct mqueue *mq, mode_t acc_mode)
    162  1.2.4.2  joerg {
    163  1.2.4.2  joerg 
    164  1.2.4.2  joerg 	KASSERT(mutex_owned(&mq->mq_mtx));
    165  1.2.4.2  joerg 	return vaccess(VNON, mq->mq_mode, mq->mq_euid, mq->mq_egid,
    166  1.2.4.2  joerg 	    acc_mode, l->l_cred);
    167  1.2.4.2  joerg }
    168  1.2.4.2  joerg 
    169  1.2.4.2  joerg /*
    170  1.2.4.2  joerg  * Get the mqueue from the descriptor.
    171  1.2.4.2  joerg  *  => locks the message queue
    172  1.2.4.2  joerg  *  => increments the reference on file entry
    173  1.2.4.2  joerg  */
    174  1.2.4.2  joerg static int
    175  1.2.4.2  joerg mqueue_get(struct lwp *l, mqd_t mqd, mode_t acc_mode, struct file **fpr)
    176  1.2.4.2  joerg {
    177  1.2.4.2  joerg 	const struct proc *p = l->l_proc;
    178  1.2.4.2  joerg 	struct file *fp;
    179  1.2.4.2  joerg 	struct mqueue *mq;
    180  1.2.4.2  joerg 
    181  1.2.4.2  joerg 	/* Get the file and descriptor */
    182  1.2.4.2  joerg 	fp = fd_getfile(p->p_fd, (int)mqd);
    183  1.2.4.2  joerg 	if (fp == NULL)
    184  1.2.4.2  joerg 		return EBADF;
    185  1.2.4.2  joerg 
    186  1.2.4.2  joerg 	/* Increment the reference of file entry, and lock the mqueue */
    187  1.2.4.2  joerg 	FILE_USE(fp);
    188  1.2.4.2  joerg 	mq = fp->f_data;
    189  1.2.4.2  joerg 	*fpr = fp;
    190  1.2.4.2  joerg 	mutex_enter(&mq->mq_mtx);
    191  1.2.4.2  joerg 
    192  1.2.4.2  joerg 	/* Check the access mode and permission if needed */
    193  1.2.4.2  joerg 	if (acc_mode == VNOVAL)
    194  1.2.4.2  joerg 		return 0;
    195  1.2.4.2  joerg 	if ((acc_mode & fp->f_flag) == 0 || mqueue_access(l, mq, acc_mode)) {
    196  1.2.4.2  joerg 		mutex_exit(&mq->mq_mtx);
    197  1.2.4.2  joerg 		FILE_UNUSE(fp, l);
    198  1.2.4.2  joerg 		return EPERM;
    199  1.2.4.2  joerg 	}
    200  1.2.4.2  joerg 
    201  1.2.4.2  joerg 	return 0;
    202  1.2.4.2  joerg }
    203  1.2.4.2  joerg 
    204  1.2.4.2  joerg /*
    205  1.2.4.2  joerg  * Converter from struct timespec to the ticks.
    206  1.2.4.2  joerg  * Used by mq_timedreceive(), mq_timedsend().
    207  1.2.4.2  joerg  */
    208  1.2.4.2  joerg static int
    209  1.2.4.2  joerg abstimeout2timo(const void *uaddr, int *timo)
    210  1.2.4.2  joerg {
    211  1.2.4.2  joerg 	struct timespec ts;
    212  1.2.4.2  joerg 	int error;
    213  1.2.4.2  joerg 
    214  1.2.4.2  joerg 	error = copyin(uaddr, &ts, sizeof(struct timespec));
    215  1.2.4.2  joerg 	if (error)
    216  1.2.4.2  joerg 		return error;
    217  1.2.4.2  joerg 
    218  1.2.4.2  joerg 	/*
    219  1.2.4.2  joerg 	 * According to POSIX, validation check is needed only in case of
    220  1.2.4.2  joerg 	 * blocking.  Thus, set the invalid value right now, and fail latter.
    221  1.2.4.2  joerg 	 */
    222  1.2.4.2  joerg 	error = itimespecfix(&ts);
    223  1.2.4.2  joerg 	*timo = (error == 0) ? tstohz(&ts) : -1;
    224  1.2.4.2  joerg 
    225  1.2.4.2  joerg 	return 0;
    226  1.2.4.2  joerg }
    227  1.2.4.2  joerg 
    228  1.2.4.2  joerg static int
    229  1.2.4.2  joerg mq_close_fop(struct file *fp, struct lwp *l)
    230  1.2.4.2  joerg {
    231  1.2.4.2  joerg 	struct proc *p = l->l_proc;
    232  1.2.4.2  joerg 	struct mqueue *mq = fp->f_data;
    233  1.2.4.2  joerg 	bool destroy;
    234  1.2.4.2  joerg 
    235  1.2.4.2  joerg 	mutex_enter(&mqlist_mtx);
    236  1.2.4.2  joerg 	mutex_enter(&mq->mq_mtx);
    237  1.2.4.2  joerg 
    238  1.2.4.2  joerg 	/* Decrease the counters */
    239  1.2.4.2  joerg 	p->p_mqueue_cnt--;
    240  1.2.4.2  joerg 	mq->mq_refcnt--;
    241  1.2.4.2  joerg 
    242  1.2.4.2  joerg 	/* Remove notification if registered for this process */
    243  1.2.4.2  joerg 	if (mq->mq_notify_proc == p)
    244  1.2.4.2  joerg 		mq->mq_notify_proc = NULL;
    245  1.2.4.2  joerg 
    246  1.2.4.2  joerg 	/*
    247  1.2.4.2  joerg 	 * If this is the last reference and mqueue is marked for unlink,
    248  1.2.4.2  joerg 	 * remove and later destroy the message queue.
    249  1.2.4.2  joerg 	 */
    250  1.2.4.2  joerg 	if (mq->mq_refcnt == 0 && (mq->mq_attrib.mq_flags & MQ_UNLINK)) {
    251  1.2.4.2  joerg 		LIST_REMOVE(mq, mq_list);
    252  1.2.4.2  joerg 		destroy = true;
    253  1.2.4.2  joerg 	} else
    254  1.2.4.2  joerg 		destroy = false;
    255  1.2.4.2  joerg 
    256  1.2.4.2  joerg 	mutex_exit(&mq->mq_mtx);
    257  1.2.4.2  joerg 	mutex_exit(&mqlist_mtx);
    258  1.2.4.2  joerg 
    259  1.2.4.2  joerg 	if (destroy)
    260  1.2.4.2  joerg 		mqueue_destroy(mq);
    261  1.2.4.2  joerg 
    262  1.2.4.2  joerg 	return 0;
    263  1.2.4.2  joerg }
    264  1.2.4.2  joerg 
    265  1.2.4.2  joerg /*
    266  1.2.4.2  joerg  * General mqueue system calls.
    267  1.2.4.2  joerg  */
    268  1.2.4.2  joerg 
    269  1.2.4.2  joerg int
    270  1.2.4.2  joerg sys_mq_open(struct lwp *l, void *v, register_t *retval)
    271  1.2.4.2  joerg {
    272  1.2.4.2  joerg 	struct sys_mq_open_args /* {
    273  1.2.4.2  joerg 		syscallarg(const char *) name;
    274  1.2.4.2  joerg 		syscallarg(int) oflag;
    275  1.2.4.2  joerg 		syscallarg(mode_t) mode;
    276  1.2.4.2  joerg 		syscallarg(struct mq_attr) attr;
    277  1.2.4.2  joerg 	} */ *uap = v;
    278  1.2.4.2  joerg 	struct proc *p = l->l_proc;
    279  1.2.4.2  joerg 	struct mqueue *mq, *mq_new = NULL;
    280  1.2.4.2  joerg 	struct file *fp;
    281  1.2.4.2  joerg 	char *name;
    282  1.2.4.2  joerg 	int mqd, error, oflag;
    283  1.2.4.2  joerg 
    284  1.2.4.2  joerg 	/* Check access mode flags */
    285  1.2.4.2  joerg 	oflag = SCARG(uap, oflag);
    286  1.2.4.2  joerg 	if ((oflag & (O_RDWR | O_RDONLY | O_WRONLY)) == 0)
    287  1.2.4.2  joerg 		return EINVAL;
    288  1.2.4.2  joerg 
    289  1.2.4.2  joerg 	/* Get the name from the user-space */
    290  1.2.4.2  joerg 	name = kmem_zalloc(MQ_NAMELEN, KM_SLEEP);
    291  1.2.4.2  joerg 	error = copyinstr(SCARG(uap, name), name, MQ_NAMELEN - 1, NULL);
    292  1.2.4.2  joerg 	if (error) {
    293  1.2.4.2  joerg 		kmem_free(name, MQ_NAMELEN);
    294  1.2.4.2  joerg 		return error;
    295  1.2.4.2  joerg 	}
    296  1.2.4.2  joerg 
    297  1.2.4.2  joerg 	if (oflag & O_CREAT) {
    298  1.2.4.2  joerg 		struct mq_attr attr;
    299  1.2.4.2  joerg 
    300  1.2.4.2  joerg 		/* Check the limit */
    301  1.2.4.2  joerg 		if (p->p_mqueue_cnt == mq_open_max) {
    302  1.2.4.2  joerg 			kmem_free(name, MQ_NAMELEN);
    303  1.2.4.2  joerg 			return EMFILE;
    304  1.2.4.2  joerg 		}
    305  1.2.4.2  joerg 
    306  1.2.4.2  joerg 		/* Check for mqueue attributes */
    307  1.2.4.2  joerg 		if (SCARG(uap, attr)) {
    308  1.2.4.2  joerg 			error = copyin(SCARG(uap, attr), &attr,
    309  1.2.4.2  joerg 				sizeof(struct mq_attr));
    310  1.2.4.2  joerg 			if (error) {
    311  1.2.4.2  joerg 				kmem_free(name, MQ_NAMELEN);
    312  1.2.4.2  joerg 				return error;
    313  1.2.4.2  joerg 			}
    314  1.2.4.2  joerg 			if (attr.mq_maxmsg <= 0 || attr.mq_msgsize <= 0 ||
    315  1.2.4.2  joerg 			    attr.mq_msgsize > mq_max_msgsize) {
    316  1.2.4.2  joerg 				kmem_free(name, MQ_NAMELEN);
    317  1.2.4.2  joerg 				return EINVAL;
    318  1.2.4.2  joerg 			}
    319  1.2.4.2  joerg 			attr.mq_curmsgs = 0;
    320  1.2.4.2  joerg 		} else {
    321  1.2.4.2  joerg 			memset(&attr, 0, sizeof(struct mq_attr));
    322  1.2.4.2  joerg 			attr.mq_maxmsg = mq_def_maxmsg;
    323  1.2.4.2  joerg 			attr.mq_msgsize =
    324  1.2.4.2  joerg 			    MQ_DEF_MSGSIZE - sizeof(struct mq_msg);
    325  1.2.4.2  joerg 		}
    326  1.2.4.2  joerg 
    327  1.2.4.2  joerg 		/*
    328  1.2.4.2  joerg 		 * Allocate new mqueue, initialize data structures,
    329  1.2.4.2  joerg 		 * copy the name, attributes and set the flag.
    330  1.2.4.2  joerg 		 */
    331  1.2.4.2  joerg 		mq_new = kmem_zalloc(sizeof(struct mqueue), KM_SLEEP);
    332  1.2.4.2  joerg 
    333  1.2.4.2  joerg 		mutex_init(&mq_new->mq_mtx, MUTEX_DEFAULT, IPL_NONE);
    334  1.2.4.2  joerg 		cv_init(&mq_new->mq_send_cv, "mqsendcv");
    335  1.2.4.2  joerg 		cv_init(&mq_new->mq_recv_cv, "mqrecvcv");
    336  1.2.4.2  joerg 		TAILQ_INIT(&mq_new->mq_head);
    337  1.2.4.2  joerg 
    338  1.2.4.2  joerg 		strlcpy(mq_new->mq_name, name, MQ_NAMELEN);
    339  1.2.4.2  joerg 		memcpy(&mq_new->mq_attrib, &attr, sizeof(struct mq_attr));
    340  1.2.4.2  joerg 		mq_new->mq_attrib.mq_flags = oflag;
    341  1.2.4.2  joerg 
    342  1.2.4.2  joerg 		/* Store mode and effective UID with GID */
    343  1.2.4.2  joerg 		mq_new->mq_mode = SCARG(uap, mode);
    344  1.2.4.2  joerg 		mq_new->mq_euid = kauth_cred_geteuid(l->l_cred);
    345  1.2.4.2  joerg 		mq_new->mq_egid = kauth_cred_getegid(l->l_cred);
    346  1.2.4.2  joerg 	}
    347  1.2.4.2  joerg 
    348  1.2.4.2  joerg 	/* Allocate file structure and descriptor */
    349  1.2.4.2  joerg 	error = falloc(l, &fp, &mqd);
    350  1.2.4.2  joerg 	if (error) {
    351  1.2.4.2  joerg 		if (mq_new)
    352  1.2.4.2  joerg 			mqueue_destroy(mq_new);
    353  1.2.4.2  joerg 		kmem_free(name, MQ_NAMELEN);
    354  1.2.4.2  joerg 		return error;
    355  1.2.4.2  joerg 	}
    356  1.2.4.2  joerg 	fp->f_type = DTYPE_MQUEUE;
    357  1.2.4.2  joerg 	fp->f_flag = (oflag & O_RDWR) ? (VREAD | VWRITE) :
    358  1.2.4.2  joerg 	    ((oflag & O_RDONLY) ? VREAD : VWRITE);
    359  1.2.4.2  joerg 	fp->f_ops = &mqops;
    360  1.2.4.2  joerg 
    361  1.2.4.2  joerg 	/* Look up for mqueue with such name */
    362  1.2.4.2  joerg 	mutex_enter(&mqlist_mtx);
    363  1.2.4.2  joerg 	mq = mqueue_lookup(name);
    364  1.2.4.2  joerg 	if (mq) {
    365  1.2.4.2  joerg 		KASSERT(mutex_owned(&mq->mq_mtx));
    366  1.2.4.2  joerg 		/* Check if mqueue is not marked as unlinking */
    367  1.2.4.2  joerg 		if (mq->mq_attrib.mq_flags & MQ_UNLINK) {
    368  1.2.4.2  joerg 			error = EACCES;
    369  1.2.4.2  joerg 			goto exit;
    370  1.2.4.2  joerg 		}
    371  1.2.4.2  joerg 		/* Fail if O_EXCL is set, and mqueue already exists */
    372  1.2.4.2  joerg 		if ((oflag & O_CREAT) && (oflag & O_EXCL)) {
    373  1.2.4.2  joerg 			error = EEXIST;
    374  1.2.4.2  joerg 			goto exit;
    375  1.2.4.2  joerg 		}
    376  1.2.4.2  joerg 		/* Check the permission */
    377  1.2.4.2  joerg 		if (mqueue_access(l, mq, fp->f_flag)) {
    378  1.2.4.2  joerg 			error = EACCES;
    379  1.2.4.2  joerg 			goto exit;
    380  1.2.4.2  joerg 		}
    381  1.2.4.2  joerg 	} else {
    382  1.2.4.2  joerg 		/* Fail if mqueue neither exists, nor we create it */
    383  1.2.4.2  joerg 		if ((oflag & O_CREAT) == 0) {
    384  1.2.4.2  joerg 			mutex_exit(&mqlist_mtx);
    385  1.2.4.2  joerg 			KASSERT(mq_new == NULL);
    386  1.2.4.2  joerg 			FILE_UNUSE(fp, l);
    387  1.2.4.2  joerg 			ffree(fp);
    388  1.2.4.2  joerg 			fdremove(p->p_fd, mqd);
    389  1.2.4.2  joerg 			kmem_free(name, MQ_NAMELEN);
    390  1.2.4.2  joerg 			return ENOENT;
    391  1.2.4.2  joerg 		}
    392  1.2.4.2  joerg 
    393  1.2.4.2  joerg 		/* Check the limit */
    394  1.2.4.2  joerg 		if (p->p_mqueue_cnt == mq_open_max) {
    395  1.2.4.2  joerg 			error = EMFILE;
    396  1.2.4.2  joerg 			goto exit;
    397  1.2.4.2  joerg 		}
    398  1.2.4.2  joerg 
    399  1.2.4.2  joerg 		/* Insert the queue to the list */
    400  1.2.4.2  joerg 		mq = mq_new;
    401  1.2.4.2  joerg 		mutex_enter(&mq->mq_mtx);
    402  1.2.4.2  joerg 		LIST_INSERT_HEAD(&mqueue_head, mq, mq_list);
    403  1.2.4.2  joerg 		mq_new = NULL;
    404  1.2.4.2  joerg 	}
    405  1.2.4.2  joerg 
    406  1.2.4.2  joerg 	/* Increase the counters, and make descriptor ready */
    407  1.2.4.2  joerg 	p->p_mqueue_cnt++;
    408  1.2.4.2  joerg 	mq->mq_refcnt++;
    409  1.2.4.2  joerg 	fp->f_data = mq;
    410  1.2.4.2  joerg 	FILE_SET_MATURE(fp);
    411  1.2.4.2  joerg exit:
    412  1.2.4.2  joerg 	mutex_exit(&mq->mq_mtx);
    413  1.2.4.2  joerg 	mutex_exit(&mqlist_mtx);
    414  1.2.4.2  joerg 	FILE_UNUSE(fp, l);
    415  1.2.4.2  joerg 
    416  1.2.4.2  joerg 	if (mq_new)
    417  1.2.4.2  joerg 		mqueue_destroy(mq_new);
    418  1.2.4.2  joerg 	if (error) {
    419  1.2.4.2  joerg 		ffree(fp);
    420  1.2.4.2  joerg 		fdremove(p->p_fd, mqd);
    421  1.2.4.2  joerg 	} else
    422  1.2.4.2  joerg 		*retval = mqd;
    423  1.2.4.2  joerg 	kmem_free(name, MQ_NAMELEN);
    424  1.2.4.2  joerg 
    425  1.2.4.2  joerg 	return error;
    426  1.2.4.2  joerg }
    427  1.2.4.2  joerg 
    428  1.2.4.2  joerg int
    429  1.2.4.2  joerg sys_mq_close(struct lwp *l, void *v, register_t *retval)
    430  1.2.4.2  joerg {
    431  1.2.4.2  joerg 
    432  1.2.4.2  joerg 	return sys_close(l, v, retval);
    433  1.2.4.2  joerg }
    434  1.2.4.2  joerg 
    435  1.2.4.2  joerg /*
    436  1.2.4.2  joerg  * Primary mq_receive1() function.
    437  1.2.4.2  joerg  */
    438  1.2.4.2  joerg static int
    439  1.2.4.2  joerg mq_receive1(struct lwp *l, mqd_t mqdes, void *msg_ptr, size_t msg_len,
    440  1.2.4.2  joerg     unsigned *msg_prio, int t, ssize_t *mlen)
    441  1.2.4.2  joerg {
    442  1.2.4.2  joerg 	struct file *fp = NULL;
    443  1.2.4.2  joerg 	struct mqueue *mq;
    444  1.2.4.2  joerg 	struct mq_msg *msg = NULL;
    445  1.2.4.2  joerg 	int error;
    446  1.2.4.2  joerg 
    447  1.2.4.2  joerg 	/* Get the message queue */
    448  1.2.4.2  joerg 	error = mqueue_get(l, mqdes, VREAD, &fp);
    449  1.2.4.2  joerg 	if (error)
    450  1.2.4.2  joerg 		return error;
    451  1.2.4.2  joerg 	mq = fp->f_data;
    452  1.2.4.2  joerg 
    453  1.2.4.2  joerg 	/* Check the message size limits */
    454  1.2.4.2  joerg 	if (msg_len < mq->mq_attrib.mq_msgsize) {
    455  1.2.4.2  joerg 		error = EMSGSIZE;
    456  1.2.4.2  joerg 		goto error;
    457  1.2.4.2  joerg 	}
    458  1.2.4.2  joerg 
    459  1.2.4.2  joerg 	/* Check if queue is empty */
    460  1.2.4.2  joerg 	while (TAILQ_EMPTY(&mq->mq_head)) {
    461  1.2.4.2  joerg 		if (mq->mq_attrib.mq_flags & O_NONBLOCK) {
    462  1.2.4.2  joerg 			error = EAGAIN;
    463  1.2.4.2  joerg 			goto error;
    464  1.2.4.2  joerg 		}
    465  1.2.4.2  joerg 		if (t < 0) {
    466  1.2.4.2  joerg 			error = EINVAL;
    467  1.2.4.2  joerg 			goto error;
    468  1.2.4.2  joerg 		}
    469  1.2.4.2  joerg 		/*
    470  1.2.4.2  joerg 		 * Block until someone sends the message.
    471  1.2.4.2  joerg 		 * While doing this, notification should not be sent.
    472  1.2.4.2  joerg 		 */
    473  1.2.4.2  joerg 		mq->mq_attrib.mq_flags |= MQ_RECEIVE;
    474  1.2.4.2  joerg 		error = cv_timedwait_sig(&mq->mq_send_cv, &mq->mq_mtx, t);
    475  1.2.4.2  joerg 		mq->mq_attrib.mq_flags &= ~MQ_RECEIVE;
    476  1.2.4.2  joerg 		if (error || (mq->mq_attrib.mq_flags & MQ_UNLINK)) {
    477  1.2.4.3  joerg 			error = (error == EWOULDBLOCK) ? ETIMEDOUT : EINTR;
    478  1.2.4.2  joerg 			goto error;
    479  1.2.4.2  joerg 		}
    480  1.2.4.2  joerg 	}
    481  1.2.4.2  joerg 
    482  1.2.4.2  joerg 	/* Remove the message from the queue */
    483  1.2.4.2  joerg 	msg = TAILQ_FIRST(&mq->mq_head);
    484  1.2.4.2  joerg 	KASSERT(msg != NULL);
    485  1.2.4.2  joerg 	TAILQ_REMOVE(&mq->mq_head, msg, msg_queue);
    486  1.2.4.2  joerg 
    487  1.2.4.2  joerg 	/* Decrement the counter and signal waiter, if any */
    488  1.2.4.2  joerg 	mq->mq_attrib.mq_curmsgs--;
    489  1.2.4.2  joerg 	cv_signal(&mq->mq_recv_cv);
    490  1.2.4.2  joerg error:
    491  1.2.4.2  joerg 	mutex_exit(&mq->mq_mtx);
    492  1.2.4.2  joerg 	FILE_UNUSE(fp, l);
    493  1.2.4.2  joerg 	if (error)
    494  1.2.4.2  joerg 		return error;
    495  1.2.4.2  joerg 
    496  1.2.4.2  joerg 	/*
    497  1.2.4.2  joerg 	 * Copy the data to the user-space.
    498  1.2.4.2  joerg 	 * Note: According to POSIX, no message should be removed from the
    499  1.2.4.2  joerg 	 * queue in case of fail - this would be violated.
    500  1.2.4.2  joerg 	 */
    501  1.2.4.2  joerg 	*mlen = msg->msg_len;
    502  1.2.4.2  joerg 	error = copyout(msg->msg_ptr, msg_ptr, msg->msg_len);
    503  1.2.4.2  joerg 	if (error == 0 && msg_prio)
    504  1.2.4.2  joerg 		error = copyout(&msg->msg_prio, msg_prio, sizeof(unsigned));
    505  1.2.4.2  joerg 	mqueue_freemsg(msg, sizeof(struct mq_msg) + msg->msg_len);
    506  1.2.4.2  joerg 
    507  1.2.4.2  joerg 	return error;
    508  1.2.4.2  joerg }
    509  1.2.4.2  joerg 
    510  1.2.4.2  joerg int
    511  1.2.4.2  joerg sys_mq_receive(struct lwp *l, void *v, register_t *retval)
    512  1.2.4.2  joerg {
    513  1.2.4.2  joerg 	struct sys_mq_receive_args /* {
    514  1.2.4.2  joerg 		syscallarg(mqd_t) mqdes;
    515  1.2.4.2  joerg 		syscallarg(char *) msg_ptr;
    516  1.2.4.2  joerg 		syscallarg(size_t) msg_len;
    517  1.2.4.2  joerg 		syscallarg(unsigned *) msg_prio;
    518  1.2.4.2  joerg 	} */ *uap = v;
    519  1.2.4.2  joerg 	int error;
    520  1.2.4.2  joerg 	ssize_t mlen;
    521  1.2.4.2  joerg 
    522  1.2.4.2  joerg 	error = mq_receive1(l, SCARG(uap, mqdes), SCARG(uap, msg_ptr),
    523  1.2.4.2  joerg 	    SCARG(uap, msg_len), SCARG(uap, msg_prio), 0, &mlen);
    524  1.2.4.2  joerg 	if (error == 0)
    525  1.2.4.2  joerg 		*retval = mlen;
    526  1.2.4.2  joerg 
    527  1.2.4.2  joerg 	return error;
    528  1.2.4.2  joerg }
    529  1.2.4.2  joerg 
    530  1.2.4.2  joerg int
    531  1.2.4.2  joerg sys_mq_timedreceive(struct lwp *l, void *v, register_t *retval)
    532  1.2.4.2  joerg {
    533  1.2.4.2  joerg 	struct sys_mq_timedreceive_args /* {
    534  1.2.4.2  joerg 		syscallarg(mqd_t) mqdes;
    535  1.2.4.2  joerg 		syscallarg(char *) msg_ptr;
    536  1.2.4.2  joerg 		syscallarg(size_t) msg_len;
    537  1.2.4.2  joerg 		syscallarg(unsigned *) msg_prio;
    538  1.2.4.2  joerg 		syscallarg(const struct timespec *) abs_timeout;
    539  1.2.4.2  joerg 	} */ *uap = v;
    540  1.2.4.2  joerg 	int error, t;
    541  1.2.4.2  joerg 	ssize_t mlen;
    542  1.2.4.2  joerg 
    543  1.2.4.2  joerg 	/* Get and convert time value */
    544  1.2.4.2  joerg 	if (SCARG(uap, abs_timeout)) {
    545  1.2.4.2  joerg 		error = abstimeout2timo(SCARG(uap, abs_timeout), &t);
    546  1.2.4.2  joerg 		if (error)
    547  1.2.4.2  joerg 			return error;
    548  1.2.4.2  joerg 	} else
    549  1.2.4.2  joerg 		t = 0;
    550  1.2.4.2  joerg 
    551  1.2.4.2  joerg 	error = mq_receive1(l, SCARG(uap, mqdes), SCARG(uap, msg_ptr),
    552  1.2.4.2  joerg 	    SCARG(uap, msg_len), SCARG(uap, msg_prio), t, &mlen);
    553  1.2.4.2  joerg 	if (error == 0)
    554  1.2.4.2  joerg 		*retval = mlen;
    555  1.2.4.2  joerg 
    556  1.2.4.2  joerg 	return error;
    557  1.2.4.2  joerg }
    558  1.2.4.2  joerg 
    559  1.2.4.2  joerg /*
    560  1.2.4.2  joerg  * Primary mq_send1() function.
    561  1.2.4.2  joerg  */
    562  1.2.4.2  joerg static int
    563  1.2.4.2  joerg mq_send1(struct lwp *l, mqd_t mqdes, const char *msg_ptr, size_t msg_len,
    564  1.2.4.2  joerg     unsigned msg_prio, int t)
    565  1.2.4.2  joerg {
    566  1.2.4.2  joerg 	struct file *fp = NULL;
    567  1.2.4.2  joerg 	struct mqueue *mq;
    568  1.2.4.2  joerg 	struct mq_msg *msg, *pos_msg;
    569  1.2.4.2  joerg 	struct proc *notify = NULL;
    570  1.2.4.2  joerg 	ksiginfo_t ksi;
    571  1.2.4.2  joerg 	size_t size;
    572  1.2.4.2  joerg 	int error;
    573  1.2.4.2  joerg 
    574  1.2.4.2  joerg 	/* Check the priority range */
    575  1.2.4.2  joerg 	if (msg_prio >= mq_prio_max)
    576  1.2.4.2  joerg 		return EINVAL;
    577  1.2.4.2  joerg 
    578  1.2.4.2  joerg 	/* Allocate a new message */
    579  1.2.4.2  joerg 	size = sizeof(struct mq_msg) + msg_len;
    580  1.2.4.2  joerg 	if (size > mq_max_msgsize)
    581  1.2.4.2  joerg 		return EMSGSIZE;
    582  1.2.4.2  joerg 
    583  1.2.4.2  joerg 	if (size > MQ_DEF_MSGSIZE)
    584  1.2.4.2  joerg 		msg = kmem_alloc(size, KM_SLEEP);
    585  1.2.4.2  joerg 	else
    586  1.2.4.2  joerg 		msg = pool_get(&mqmsg_poll, PR_WAITOK);
    587  1.2.4.2  joerg 
    588  1.2.4.2  joerg 	/* Get the data from user-space */
    589  1.2.4.2  joerg 	error = copyin(msg_ptr, msg->msg_ptr, msg_len);
    590  1.2.4.2  joerg 	if (error) {
    591  1.2.4.2  joerg 		mqueue_freemsg(msg, size);
    592  1.2.4.2  joerg 		return error;
    593  1.2.4.2  joerg 	}
    594  1.2.4.2  joerg 	msg->msg_len = msg_len;
    595  1.2.4.2  joerg 	msg->msg_prio = msg_prio;
    596  1.2.4.2  joerg 
    597  1.2.4.2  joerg 	/* Get the mqueue */
    598  1.2.4.2  joerg 	error = mqueue_get(l, mqdes, VWRITE, &fp);
    599  1.2.4.2  joerg 	if (error) {
    600  1.2.4.2  joerg 		mqueue_freemsg(msg, size);
    601  1.2.4.2  joerg 		return error;
    602  1.2.4.2  joerg 	}
    603  1.2.4.2  joerg 	mq = fp->f_data;
    604  1.2.4.2  joerg 
    605  1.2.4.2  joerg 	/* Check the message size limit */
    606  1.2.4.2  joerg 	if (msg_len <= 0 || msg_len > mq->mq_attrib.mq_msgsize) {
    607  1.2.4.2  joerg 		error = EMSGSIZE;
    608  1.2.4.2  joerg 		goto error;
    609  1.2.4.2  joerg 	}
    610  1.2.4.2  joerg 
    611  1.2.4.2  joerg 	/* Check if queue is full */
    612  1.2.4.2  joerg 	while (mq->mq_attrib.mq_curmsgs >= mq->mq_attrib.mq_maxmsg) {
    613  1.2.4.2  joerg 		if (mq->mq_attrib.mq_flags & O_NONBLOCK) {
    614  1.2.4.2  joerg 			error = EAGAIN;
    615  1.2.4.2  joerg 			goto error;
    616  1.2.4.2  joerg 		}
    617  1.2.4.2  joerg 		if (t < 0) {
    618  1.2.4.2  joerg 			error = EINVAL;
    619  1.2.4.2  joerg 			goto error;
    620  1.2.4.2  joerg 		}
    621  1.2.4.2  joerg 		/* Block until queue becomes available */
    622  1.2.4.2  joerg 		error = cv_timedwait_sig(&mq->mq_recv_cv, &mq->mq_mtx, t);
    623  1.2.4.2  joerg 		if (error || (mq->mq_attrib.mq_flags & MQ_UNLINK)) {
    624  1.2.4.2  joerg 			error = (error == EWOULDBLOCK) ? ETIMEDOUT : error;
    625  1.2.4.2  joerg 			goto error;
    626  1.2.4.2  joerg 		}
    627  1.2.4.2  joerg 	}
    628  1.2.4.2  joerg 	KASSERT(mq->mq_attrib.mq_curmsgs < mq->mq_attrib.mq_maxmsg);
    629  1.2.4.2  joerg 
    630  1.2.4.2  joerg 	/* Insert message into the queue, according to the priority */
    631  1.2.4.2  joerg 	TAILQ_FOREACH(pos_msg, &mq->mq_head, msg_queue)
    632  1.2.4.2  joerg 		if (msg->msg_prio > pos_msg->msg_prio)
    633  1.2.4.2  joerg 			break;
    634  1.2.4.2  joerg 	if (pos_msg == NULL)
    635  1.2.4.2  joerg 		TAILQ_INSERT_TAIL(&mq->mq_head, msg, msg_queue);
    636  1.2.4.2  joerg 	else
    637  1.2.4.2  joerg 		TAILQ_INSERT_BEFORE(pos_msg, msg, msg_queue);
    638  1.2.4.2  joerg 
    639  1.2.4.2  joerg 	/* Check for the notify */
    640  1.2.4.2  joerg 	if (mq->mq_attrib.mq_curmsgs == 0 && mq->mq_notify_proc &&
    641  1.2.4.2  joerg 	    (mq->mq_attrib.mq_flags & MQ_RECEIVE) == 0) {
    642  1.2.4.2  joerg 		/* Initialize the signal */
    643  1.2.4.2  joerg 		KSI_INIT(&ksi);
    644  1.2.4.2  joerg 		ksi.ksi_signo = mq->mq_sig_notify.sigev_signo;
    645  1.2.4.2  joerg 		ksi.ksi_code = SI_MESGQ;
    646  1.2.4.2  joerg 		ksi.ksi_value = mq->mq_sig_notify.sigev_value;
    647  1.2.4.2  joerg 		/* Unregister the process */
    648  1.2.4.2  joerg 		notify = mq->mq_notify_proc;
    649  1.2.4.2  joerg 		mq->mq_notify_proc = NULL;
    650  1.2.4.2  joerg 	}
    651  1.2.4.2  joerg 
    652  1.2.4.2  joerg 	/* Increment the counter and signal waiter, if any */
    653  1.2.4.2  joerg 	mq->mq_attrib.mq_curmsgs++;
    654  1.2.4.2  joerg 	cv_signal(&mq->mq_send_cv);
    655  1.2.4.2  joerg error:
    656  1.2.4.2  joerg 	mutex_exit(&mq->mq_mtx);
    657  1.2.4.2  joerg 	FILE_UNUSE(fp, l);
    658  1.2.4.2  joerg 
    659  1.2.4.2  joerg 	if (error) {
    660  1.2.4.2  joerg 		mqueue_freemsg(msg, size);
    661  1.2.4.2  joerg 	} else if (notify) {
    662  1.2.4.2  joerg 		/* Send the notify, if needed */
    663  1.2.4.2  joerg 		mutex_enter(&proclist_mutex);
    664  1.2.4.2  joerg 		kpsignal(notify, &ksi, NULL);
    665  1.2.4.2  joerg 		mutex_exit(&proclist_mutex);
    666  1.2.4.2  joerg 	}
    667  1.2.4.2  joerg 
    668  1.2.4.2  joerg 	return error;
    669  1.2.4.2  joerg }
    670  1.2.4.2  joerg 
    671  1.2.4.2  joerg int
    672  1.2.4.2  joerg sys_mq_send(struct lwp *l, void *v, register_t *retval)
    673  1.2.4.2  joerg {
    674  1.2.4.2  joerg 	struct sys_mq_send_args /* {
    675  1.2.4.2  joerg 		syscallarg(mqd_t) mqdes;
    676  1.2.4.2  joerg 		syscallarg(const char *) msg_ptr;
    677  1.2.4.2  joerg 		syscallarg(size_t) msg_len;
    678  1.2.4.2  joerg 		syscallarg(unsigned) msg_prio;
    679  1.2.4.2  joerg 	} */ *uap = v;
    680  1.2.4.2  joerg 
    681  1.2.4.2  joerg 	return mq_send1(l, SCARG(uap, mqdes), SCARG(uap, msg_ptr),
    682  1.2.4.2  joerg 	    SCARG(uap, msg_len), SCARG(uap, msg_prio), 0);
    683  1.2.4.2  joerg }
    684  1.2.4.2  joerg 
    685  1.2.4.2  joerg int
    686  1.2.4.2  joerg sys_mq_timedsend(struct lwp *l, void *v, register_t *retval)
    687  1.2.4.2  joerg {
    688  1.2.4.2  joerg 	struct sys_mq_timedsend_args /* {
    689  1.2.4.2  joerg 		syscallarg(mqd_t) mqdes;
    690  1.2.4.2  joerg 		syscallarg(const char *) msg_ptr;
    691  1.2.4.2  joerg 		syscallarg(size_t) msg_len;
    692  1.2.4.2  joerg 		syscallarg(unsigned) msg_prio;
    693  1.2.4.2  joerg 		syscallarg(const struct timespec *) abs_timeout;
    694  1.2.4.2  joerg 	} */ *uap = v;
    695  1.2.4.2  joerg 	int t;
    696  1.2.4.2  joerg 
    697  1.2.4.2  joerg 	/* Get and convert time value */
    698  1.2.4.2  joerg 	if (SCARG(uap, abs_timeout)) {
    699  1.2.4.2  joerg 		int error = abstimeout2timo(SCARG(uap, abs_timeout), &t);
    700  1.2.4.2  joerg 		if (error)
    701  1.2.4.2  joerg 			return error;
    702  1.2.4.2  joerg 	} else
    703  1.2.4.2  joerg 		t = 0;
    704  1.2.4.2  joerg 
    705  1.2.4.2  joerg 	return mq_send1(l, SCARG(uap, mqdes), SCARG(uap, msg_ptr),
    706  1.2.4.2  joerg 	    SCARG(uap, msg_len), SCARG(uap, msg_prio), t);
    707  1.2.4.2  joerg }
    708  1.2.4.2  joerg 
    709  1.2.4.2  joerg int
    710  1.2.4.2  joerg sys_mq_notify(struct lwp *l, void *v, register_t *retval)
    711  1.2.4.2  joerg {
    712  1.2.4.2  joerg 	struct sys_mq_notify_args /* {
    713  1.2.4.2  joerg 		syscallarg(mqd_t) mqdes;
    714  1.2.4.2  joerg 		syscallarg(const struct sigevent *) notification;
    715  1.2.4.2  joerg 	} */ *uap = v;
    716  1.2.4.2  joerg 	struct file *fp = NULL;
    717  1.2.4.2  joerg 	struct mqueue *mq;
    718  1.2.4.2  joerg 	struct sigevent sig;
    719  1.2.4.2  joerg 	int error;
    720  1.2.4.2  joerg 
    721  1.2.4.2  joerg 	if (SCARG(uap, notification)) {
    722  1.2.4.2  joerg 		/* Get the signal from user-space */
    723  1.2.4.2  joerg 		error = copyin(SCARG(uap, notification), &sig,
    724  1.2.4.2  joerg 		    sizeof(struct sigevent));
    725  1.2.4.2  joerg 		if (error)
    726  1.2.4.2  joerg 			return error;
    727  1.2.4.2  joerg 	}
    728  1.2.4.2  joerg 
    729  1.2.4.2  joerg 	error = mqueue_get(l, SCARG(uap, mqdes), VNOVAL, &fp);
    730  1.2.4.2  joerg 	if (error)
    731  1.2.4.2  joerg 		return error;
    732  1.2.4.2  joerg 	mq = fp->f_data;
    733  1.2.4.2  joerg 
    734  1.2.4.2  joerg 	if (SCARG(uap, notification)) {
    735  1.2.4.2  joerg 		/* Register notification: set the signal and target process */
    736  1.2.4.2  joerg 		if (mq->mq_notify_proc == NULL) {
    737  1.2.4.2  joerg 			memcpy(&mq->mq_sig_notify, &sig,
    738  1.2.4.2  joerg 			    sizeof(struct sigevent));
    739  1.2.4.2  joerg 			mq->mq_notify_proc = l->l_proc;
    740  1.2.4.2  joerg 		} else {
    741  1.2.4.2  joerg 			/* Fail if someone else already registered */
    742  1.2.4.2  joerg 			error = EBUSY;
    743  1.2.4.2  joerg 		}
    744  1.2.4.2  joerg 	} else {
    745  1.2.4.2  joerg 		/* Unregister the notification */
    746  1.2.4.2  joerg 		mq->mq_notify_proc = NULL;
    747  1.2.4.2  joerg 	}
    748  1.2.4.2  joerg 	mutex_exit(&mq->mq_mtx);
    749  1.2.4.2  joerg 	FILE_UNUSE(fp, l);
    750  1.2.4.2  joerg 
    751  1.2.4.2  joerg 	return error;
    752  1.2.4.2  joerg }
    753  1.2.4.2  joerg 
    754  1.2.4.2  joerg int
    755  1.2.4.2  joerg sys_mq_getattr(struct lwp *l, void *v, register_t *retval)
    756  1.2.4.2  joerg {
    757  1.2.4.2  joerg 	struct sys_mq_getattr_args /* {
    758  1.2.4.2  joerg 		syscallarg(mqd_t) mqdes;
    759  1.2.4.2  joerg 		syscallarg(struct mq_attr *) mqstat;
    760  1.2.4.2  joerg 	} */ *uap = v;
    761  1.2.4.2  joerg 	struct file *fp = NULL;
    762  1.2.4.2  joerg 	struct mqueue *mq;
    763  1.2.4.2  joerg 	struct mq_attr attr;
    764  1.2.4.2  joerg 	int error;
    765  1.2.4.2  joerg 
    766  1.2.4.2  joerg 	/* Get the message queue */
    767  1.2.4.2  joerg 	error = mqueue_get(l, SCARG(uap, mqdes), VNOVAL, &fp);
    768  1.2.4.2  joerg 	if (error)
    769  1.2.4.2  joerg 		return error;
    770  1.2.4.2  joerg 	mq = fp->f_data;
    771  1.2.4.2  joerg 	memcpy(&attr, &mq->mq_attrib, sizeof(struct mq_attr));
    772  1.2.4.2  joerg 	mutex_exit(&mq->mq_mtx);
    773  1.2.4.2  joerg 	FILE_UNUSE(fp, l);
    774  1.2.4.2  joerg 
    775  1.2.4.2  joerg 	return copyout(&attr, SCARG(uap, mqstat), sizeof(struct mq_attr));
    776  1.2.4.2  joerg }
    777  1.2.4.2  joerg 
    778  1.2.4.2  joerg int
    779  1.2.4.2  joerg sys_mq_setattr(struct lwp *l, void *v, register_t *retval)
    780  1.2.4.2  joerg {
    781  1.2.4.2  joerg 	struct sys_mq_setattr_args /* {
    782  1.2.4.2  joerg 		syscallarg(mqd_t) mqdes;
    783  1.2.4.2  joerg 		syscallarg(const struct mq_attr *) mqstat;
    784  1.2.4.2  joerg 		syscallarg(struct mq_attr *) omqstat;
    785  1.2.4.2  joerg 	} */ *uap = v;
    786  1.2.4.2  joerg 	struct file *fp = NULL;
    787  1.2.4.2  joerg 	struct mqueue *mq;
    788  1.2.4.2  joerg 	struct mq_attr attr;
    789  1.2.4.2  joerg 	int error, nonblock;
    790  1.2.4.2  joerg 
    791  1.2.4.2  joerg 	error = copyin(SCARG(uap, mqstat), &attr, sizeof(struct mq_attr));
    792  1.2.4.2  joerg 	if (error)
    793  1.2.4.2  joerg 		return error;
    794  1.2.4.2  joerg 	nonblock = (attr.mq_flags & O_NONBLOCK);
    795  1.2.4.2  joerg 
    796  1.2.4.2  joerg 	/* Get the message queue */
    797  1.2.4.2  joerg 	error = mqueue_get(l, SCARG(uap, mqdes), VNOVAL, &fp);
    798  1.2.4.2  joerg 	if (error)
    799  1.2.4.2  joerg 		return error;
    800  1.2.4.2  joerg 	mq = fp->f_data;
    801  1.2.4.2  joerg 
    802  1.2.4.2  joerg 	/* Copy the old attributes, if needed */
    803  1.2.4.2  joerg 	if (SCARG(uap, omqstat))
    804  1.2.4.2  joerg 		memcpy(&attr, &mq->mq_attrib, sizeof(struct mq_attr));
    805  1.2.4.2  joerg 
    806  1.2.4.2  joerg 	/* Ignore everything, except O_NONBLOCK */
    807  1.2.4.2  joerg 	if (nonblock)
    808  1.2.4.2  joerg 		mq->mq_attrib.mq_flags |= O_NONBLOCK;
    809  1.2.4.2  joerg 	else
    810  1.2.4.2  joerg 		mq->mq_attrib.mq_flags &= ~O_NONBLOCK;
    811  1.2.4.2  joerg 
    812  1.2.4.2  joerg 	mutex_exit(&mq->mq_mtx);
    813  1.2.4.2  joerg 	FILE_UNUSE(fp, l);
    814  1.2.4.2  joerg 
    815  1.2.4.2  joerg 	/*
    816  1.2.4.2  joerg 	 * Copy the data to the user-space.
    817  1.2.4.2  joerg 	 * Note: According to POSIX, the new attributes should not be set in
    818  1.2.4.2  joerg 	 * case of fail - this would be violated.
    819  1.2.4.2  joerg 	 */
    820  1.2.4.2  joerg 	if (SCARG(uap, omqstat))
    821  1.2.4.2  joerg 		error = copyout(&attr, SCARG(uap, omqstat),
    822  1.2.4.2  joerg 		    sizeof(struct mq_attr));
    823  1.2.4.2  joerg 
    824  1.2.4.2  joerg 	return error;
    825  1.2.4.2  joerg }
    826  1.2.4.2  joerg 
    827  1.2.4.2  joerg int
    828  1.2.4.2  joerg sys_mq_unlink(struct lwp *l, void *v, register_t *retval)
    829  1.2.4.2  joerg {
    830  1.2.4.2  joerg 	struct sys_mq_unlink_args /* {
    831  1.2.4.2  joerg 		syscallarg(const char *) name;
    832  1.2.4.2  joerg 	} */ *uap = v;
    833  1.2.4.2  joerg 	struct mqueue *mq;
    834  1.2.4.2  joerg 	char *name;
    835  1.2.4.2  joerg 	int error, refcnt = 0;
    836  1.2.4.2  joerg 
    837  1.2.4.2  joerg 	/* Get the name from the user-space */
    838  1.2.4.2  joerg 	name = kmem_zalloc(MQ_NAMELEN, KM_SLEEP);
    839  1.2.4.2  joerg 	error = copyinstr(SCARG(uap, name), name, MQ_NAMELEN - 1, NULL);
    840  1.2.4.2  joerg 	if (error) {
    841  1.2.4.2  joerg 		kmem_free(name, MQ_NAMELEN);
    842  1.2.4.2  joerg 		return error;
    843  1.2.4.2  joerg 	}
    844  1.2.4.2  joerg 
    845  1.2.4.2  joerg 	/* Lookup for this file */
    846  1.2.4.2  joerg 	mutex_enter(&mqlist_mtx);
    847  1.2.4.2  joerg 	mq = mqueue_lookup(name);
    848  1.2.4.2  joerg 	if (mq == NULL) {
    849  1.2.4.2  joerg 		error = ENOENT;
    850  1.2.4.2  joerg 		goto error;
    851  1.2.4.2  joerg 	}
    852  1.2.4.2  joerg 
    853  1.2.4.2  joerg 	/* Check the permissions */
    854  1.2.4.2  joerg 	if (mqueue_access(l, mq, VWRITE)) {
    855  1.2.4.2  joerg 		mutex_exit(&mq->mq_mtx);
    856  1.2.4.2  joerg 		error = EACCES;
    857  1.2.4.2  joerg 		goto error;
    858  1.2.4.2  joerg 	}
    859  1.2.4.2  joerg 
    860  1.2.4.2  joerg 	/* Mark message queue as unlinking, before leaving the window */
    861  1.2.4.2  joerg 	mq->mq_attrib.mq_flags |= MQ_UNLINK;
    862  1.2.4.2  joerg 
    863  1.2.4.2  joerg 	/* Wake up all waiters, if there are such */
    864  1.2.4.2  joerg 	cv_broadcast(&mq->mq_send_cv);
    865  1.2.4.2  joerg 	cv_broadcast(&mq->mq_recv_cv);
    866  1.2.4.2  joerg 
    867  1.2.4.2  joerg 	refcnt = mq->mq_refcnt;
    868  1.2.4.2  joerg 	if (refcnt == 0)
    869  1.2.4.2  joerg 		LIST_REMOVE(mq, mq_list);
    870  1.2.4.2  joerg 
    871  1.2.4.2  joerg 	mutex_exit(&mq->mq_mtx);
    872  1.2.4.2  joerg error:
    873  1.2.4.2  joerg 	mutex_exit(&mqlist_mtx);
    874  1.2.4.2  joerg 
    875  1.2.4.2  joerg 	/*
    876  1.2.4.2  joerg 	 * If there are no references - destroy the message
    877  1.2.4.2  joerg 	 * queue, otherwise, the last mq_close() will do that.
    878  1.2.4.2  joerg 	 */
    879  1.2.4.2  joerg 	if (error == 0 && refcnt == 0)
    880  1.2.4.2  joerg 		mqueue_destroy(mq);
    881  1.2.4.2  joerg 
    882  1.2.4.2  joerg 	kmem_free(name, MQ_NAMELEN);
    883  1.2.4.2  joerg 	return error;
    884  1.2.4.2  joerg }
    885  1.2.4.2  joerg 
    886  1.2.4.2  joerg /*
    887  1.2.4.2  joerg  * SysCtl.
    888  1.2.4.2  joerg  */
    889  1.2.4.2  joerg 
    890  1.2.4.2  joerg SYSCTL_SETUP(sysctl_mqueue_setup, "sysctl mqueue setup")
    891  1.2.4.2  joerg {
    892  1.2.4.2  joerg 	const struct sysctlnode *node = NULL;
    893  1.2.4.2  joerg 
    894  1.2.4.2  joerg 	sysctl_createv(clog, 0, NULL, NULL,
    895  1.2.4.2  joerg 		CTLFLAG_PERMANENT,
    896  1.2.4.2  joerg 		CTLTYPE_NODE, "kern", NULL,
    897  1.2.4.2  joerg 		NULL, 0, NULL, 0,
    898  1.2.4.2  joerg 		CTL_KERN, CTL_EOL);
    899  1.2.4.2  joerg 	sysctl_createv(clog, 0, NULL, NULL,
    900  1.2.4.2  joerg 		CTLFLAG_PERMANENT|CTLFLAG_IMMEDIATE,
    901  1.2.4.2  joerg 		CTLTYPE_INT, "posix_msg",
    902  1.2.4.2  joerg 		SYSCTL_DESCR("Version of IEEE Std 1003.1 and its "
    903  1.2.4.2  joerg 			     "Message Passing option to which the "
    904  1.2.4.2  joerg 			     "system attempts to conform"),
    905  1.2.4.2  joerg 		NULL, _POSIX_MESSAGE_PASSING, NULL, 0,
    906  1.2.4.2  joerg 		CTL_KERN, CTL_CREATE, CTL_EOL);
    907  1.2.4.2  joerg 	sysctl_createv(clog, 0, NULL, &node,
    908  1.2.4.2  joerg 		CTLFLAG_PERMANENT,
    909  1.2.4.2  joerg 		CTLTYPE_NODE, "mqueue",
    910  1.2.4.2  joerg 		SYSCTL_DESCR("Message queue options"),
    911  1.2.4.2  joerg 		NULL, 0, NULL, 0,
    912  1.2.4.2  joerg 		CTL_KERN, CTL_CREATE, CTL_EOL);
    913  1.2.4.2  joerg 
    914  1.2.4.2  joerg 	if (node == NULL)
    915  1.2.4.2  joerg 		return;
    916  1.2.4.2  joerg 
    917  1.2.4.2  joerg 	sysctl_createv(clog, 0, &node, NULL,
    918  1.2.4.2  joerg 		CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
    919  1.2.4.2  joerg 		CTLTYPE_INT, "mq_open_max",
    920  1.2.4.2  joerg 		SYSCTL_DESCR("Maximal number of message queue descriptors "
    921  1.2.4.2  joerg 			     "that process could open"),
    922  1.2.4.2  joerg 		NULL, 0, &mq_open_max, 0,
    923  1.2.4.2  joerg 		CTL_CREATE, CTL_EOL);
    924  1.2.4.2  joerg 	sysctl_createv(clog, 0, &node, NULL,
    925  1.2.4.2  joerg 		CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
    926  1.2.4.2  joerg 		CTLTYPE_INT, "mq_prio_max",
    927  1.2.4.2  joerg 		SYSCTL_DESCR("Maximal priority of the message"),
    928  1.2.4.2  joerg 		NULL, 0, &mq_prio_max, 0,
    929  1.2.4.2  joerg 		CTL_CREATE, CTL_EOL);
    930  1.2.4.2  joerg 	sysctl_createv(clog, 0, &node, NULL,
    931  1.2.4.2  joerg 		CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
    932  1.2.4.2  joerg 		CTLTYPE_INT, "mq_max_msgsize",
    933  1.2.4.2  joerg 		SYSCTL_DESCR("Maximal allowed size of the message"),
    934  1.2.4.2  joerg 		NULL, 0, &mq_max_msgsize, 0,
    935  1.2.4.2  joerg 		CTL_CREATE, CTL_EOL);
    936  1.2.4.2  joerg 	sysctl_createv(clog, 0, &node, NULL,
    937  1.2.4.2  joerg 		CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
    938  1.2.4.2  joerg 		CTLTYPE_INT, "mq_def_maxmsg",
    939  1.2.4.2  joerg 		SYSCTL_DESCR("Default maximal message count"),
    940  1.2.4.2  joerg 		NULL, 0, &mq_def_maxmsg, 0,
    941  1.2.4.2  joerg 		CTL_CREATE, CTL_EOL);
    942  1.2.4.2  joerg }
    943  1.2.4.2  joerg 
    944  1.2.4.2  joerg /*
    945  1.2.4.2  joerg  * Debugging.
    946  1.2.4.2  joerg  */
    947  1.2.4.2  joerg #if defined(DDB)
    948  1.2.4.2  joerg 
    949  1.2.4.2  joerg void
    950  1.2.4.2  joerg mqueue_print_list(void (*pr)(const char *, ...))
    951  1.2.4.2  joerg {
    952  1.2.4.2  joerg 	struct mqueue *mq;
    953  1.2.4.2  joerg 
    954  1.2.4.2  joerg 	(*pr)("Global list of the message queues:\n");
    955  1.2.4.2  joerg 	(*pr)("%20s %10s %8s %8s %3s %4s %4s %4s\n",
    956  1.2.4.2  joerg 	    "Name", "Ptr", "Mode", "Flags",  "Ref",
    957  1.2.4.2  joerg 	    "MaxMsg", "MsgSze", "CurMsg");
    958  1.2.4.2  joerg 	LIST_FOREACH(mq, &mqueue_head, mq_list) {
    959  1.2.4.2  joerg 		(*pr)("%20s %10p %8x %8x %3u %6lu %6lu %6lu\n",
    960  1.2.4.2  joerg 		    mq->mq_name, mq, mq->mq_mode,
    961  1.2.4.2  joerg 		    mq->mq_attrib.mq_flags, mq->mq_refcnt,
    962  1.2.4.2  joerg 		    mq->mq_attrib.mq_maxmsg, mq->mq_attrib.mq_msgsize,
    963  1.2.4.2  joerg 		    mq->mq_attrib.mq_curmsgs);
    964  1.2.4.2  joerg 	}
    965  1.2.4.2  joerg }
    966  1.2.4.2  joerg 
    967  1.2.4.2  joerg #endif /* defined(DDB) */
    968