]> CyberLeo.Net >> Repos - FreeBSD/releng/9.2.git/blob - sys/kern/sysv_msg.c
- Copy stable/9 to releng/9.2 as part of the 9.2-RELEASE cycle.
[FreeBSD/releng/9.2.git] / sys / kern / sysv_msg.c
1 /*-
2  * Implementation of SVID messages
3  *
4  * Author:  Daniel Boulet
5  *
6  * Copyright 1993 Daniel Boulet and RTMX Inc.
7  *
8  * This system call was implemented by Daniel Boulet under contract from RTMX.
9  *
10  * Redistribution and use in source forms, with and without modification,
11  * are permitted provided that this entire comment appears intact.
12  *
13  * Redistribution in binary form may occur without any restrictions.
14  * Obviously, it would be nice if you gave credit where credit is due
15  * but requiring it would be too onerous.
16  *
17  * This software is provided ``AS IS'' without any warranties of any kind.
18  */
19 /*-
20  * Copyright (c) 2003-2005 McAfee, Inc.
21  * All rights reserved.
22  *
23  * This software was developed for the FreeBSD Project in part by McAfee
24  * Research, the Security Research Division of McAfee, Inc under DARPA/SPAWAR
25  * contract N66001-01-C-8035 ("CBOSS"), as part of the DARPA CHATS research
26  * program.
27  *
28  * Redistribution and use in source and binary forms, with or without
29  * modification, are permitted provided that the following conditions
30  * are met:
31  * 1. Redistributions of source code must retain the above copyright
32  *    notice, this list of conditions and the following disclaimer.
33  * 2. Redistributions in binary form must reproduce the above copyright
34  *    notice, this list of conditions and the following disclaimer in the
35  *    documentation and/or other materials provided with the distribution.
36  *
37  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
38  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
39  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
40  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
41  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
42  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
43  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
44  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
45  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
46  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
47  * SUCH DAMAGE.
48  */
49
50 #include <sys/cdefs.h>
51 __FBSDID("$FreeBSD$");
52
53 #include "opt_compat.h"
54 #include "opt_sysvipc.h"
55
56 #include <sys/param.h>
57 #include <sys/systm.h>
58 #include <sys/sysproto.h>
59 #include <sys/kernel.h>
60 #include <sys/priv.h>
61 #include <sys/proc.h>
62 #include <sys/lock.h>
63 #include <sys/mutex.h>
64 #include <sys/module.h>
65 #include <sys/msg.h>
66 #include <sys/racct.h>
67 #include <sys/syscall.h>
68 #include <sys/syscallsubr.h>
69 #include <sys/sysent.h>
70 #include <sys/sysctl.h>
71 #include <sys/malloc.h>
72 #include <sys/jail.h>
73
74 #include <security/mac/mac_framework.h>
75
76 FEATURE(sysv_msg, "System V message queues support");
77
78 static MALLOC_DEFINE(M_MSG, "msg", "SVID compatible message queues");
79
80 static int msginit(void);
81 static int msgunload(void);
82 static int sysvmsg_modload(struct module *, int, void *);
83
84
85 #ifdef MSG_DEBUG
86 #define DPRINTF(a)      printf a
87 #else
88 #define DPRINTF(a)      (void)0
89 #endif
90
91 static void msg_freehdr(struct msg *msghdr);
92
93 #ifndef MSGSSZ
94 #define MSGSSZ  8               /* Each segment must be 2^N long */
95 #endif
96 #ifndef MSGSEG
97 #define MSGSEG  2048            /* must be less than 32767 */
98 #endif
99 #define MSGMAX  (MSGSSZ*MSGSEG)
100 #ifndef MSGMNB
101 #define MSGMNB  2048            /* max # of bytes in a queue */
102 #endif
103 #ifndef MSGMNI
104 #define MSGMNI  40
105 #endif
106 #ifndef MSGTQL
107 #define MSGTQL  40
108 #endif
109
110 /*
111  * Based on the configuration parameters described in an SVR2 (yes, two)
112  * config(1m) man page.
113  *
114  * Each message is broken up and stored in segments that are msgssz bytes
115  * long.  For efficiency reasons, this should be a power of two.  Also,
116  * it doesn't make sense if it is less than 8 or greater than about 256.
117  * Consequently, msginit in kern/sysv_msg.c checks that msgssz is a power of
118  * two between 8 and 1024 inclusive (and panic's if it isn't).
119  */
120 struct msginfo msginfo = {
121                 MSGMAX,         /* max chars in a message */
122                 MSGMNI,         /* # of message queue identifiers */
123                 MSGMNB,         /* max chars in a queue */
124                 MSGTQL,         /* max messages in system */
125                 MSGSSZ,         /* size of a message segment */
126                                 /* (must be small power of 2 greater than 4) */
127                 MSGSEG          /* number of message segments */
128 };
129
130 /*
131  * macros to convert between msqid_ds's and msqid's.
132  * (specific to this implementation)
133  */
134 #define MSQID(ix,ds)    ((ix) & 0xffff | (((ds).msg_perm.seq << 16) & 0xffff0000))
135 #define MSQID_IX(id)    ((id) & 0xffff)
136 #define MSQID_SEQ(id)   (((id) >> 16) & 0xffff)
137
138 /*
139  * The rest of this file is specific to this particular implementation.
140  */
141
142 struct msgmap {
143         short   next;           /* next segment in buffer */
144                                 /* -1 -> available */
145                                 /* 0..(MSGSEG-1) -> index of next segment */
146 };
147
148 #define MSG_LOCKED      01000   /* Is this msqid_ds locked? */
149
150 static int nfree_msgmaps;       /* # of free map entries */
151 static short free_msgmaps;      /* head of linked list of free map entries */
152 static struct msg *free_msghdrs;/* list of free msg headers */
153 static char *msgpool;           /* MSGMAX byte long msg buffer pool */
154 static struct msgmap *msgmaps;  /* MSGSEG msgmap structures */
155 static struct msg *msghdrs;     /* MSGTQL msg headers */
156 static struct msqid_kernel *msqids;     /* MSGMNI msqid_kernel struct's */
157 static struct mtx msq_mtx;      /* global mutex for message queues. */
158
159 static struct syscall_helper_data msg_syscalls[] = {
160         SYSCALL_INIT_HELPER(msgctl),
161         SYSCALL_INIT_HELPER(msgget),
162         SYSCALL_INIT_HELPER(msgsnd),
163         SYSCALL_INIT_HELPER(msgrcv),
164 #if defined(COMPAT_FREEBSD4) || defined(COMPAT_FREEBSD5) || \
165     defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD7)
166         SYSCALL_INIT_HELPER(msgsys),
167         SYSCALL_INIT_HELPER_COMPAT(freebsd7_msgctl),
168 #endif
169         SYSCALL_INIT_LAST
170 };
171
172 #ifdef COMPAT_FREEBSD32
173 #include <compat/freebsd32/freebsd32.h>
174 #include <compat/freebsd32/freebsd32_ipc.h>
175 #include <compat/freebsd32/freebsd32_proto.h>
176 #include <compat/freebsd32/freebsd32_signal.h>
177 #include <compat/freebsd32/freebsd32_syscall.h>
178 #include <compat/freebsd32/freebsd32_util.h>
179
180 static struct syscall_helper_data msg32_syscalls[] = {
181         SYSCALL32_INIT_HELPER(freebsd32_msgctl),
182         SYSCALL32_INIT_HELPER(freebsd32_msgsnd),
183         SYSCALL32_INIT_HELPER(freebsd32_msgrcv),
184         SYSCALL32_INIT_HELPER_COMPAT(msgget),
185         SYSCALL32_INIT_HELPER(freebsd32_msgsys),
186 #if defined(COMPAT_FREEBSD4) || defined(COMPAT_FREEBSD5) || \
187     defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD7)
188         SYSCALL32_INIT_HELPER(freebsd7_freebsd32_msgctl),
189 #endif
190         SYSCALL_INIT_LAST
191 };
192 #endif
193
194 static int
195 msginit()
196 {
197         int i, error;
198
199         TUNABLE_INT_FETCH("kern.ipc.msgseg", &msginfo.msgseg);
200         TUNABLE_INT_FETCH("kern.ipc.msgssz", &msginfo.msgssz);
201         msginfo.msgmax = msginfo.msgseg * msginfo.msgssz;
202         TUNABLE_INT_FETCH("kern.ipc.msgmni", &msginfo.msgmni);
203         TUNABLE_INT_FETCH("kern.ipc.msgmnb", &msginfo.msgmnb);
204         TUNABLE_INT_FETCH("kern.ipc.msgtql", &msginfo.msgtql);
205
206         msgpool = malloc(msginfo.msgmax, M_MSG, M_WAITOK);
207         msgmaps = malloc(sizeof(struct msgmap) * msginfo.msgseg, M_MSG, M_WAITOK);
208         msghdrs = malloc(sizeof(struct msg) * msginfo.msgtql, M_MSG, M_WAITOK);
209         msqids = malloc(sizeof(struct msqid_kernel) * msginfo.msgmni, M_MSG,
210             M_WAITOK);
211
212         /*
213          * msginfo.msgssz should be a power of two for efficiency reasons.
214          * It is also pretty silly if msginfo.msgssz is less than 8
215          * or greater than about 256 so ...
216          */
217
218         i = 8;
219         while (i < 1024 && i != msginfo.msgssz)
220                 i <<= 1;
221         if (i != msginfo.msgssz) {
222                 DPRINTF(("msginfo.msgssz=%d (0x%x)\n", msginfo.msgssz,
223                     msginfo.msgssz));
224                 panic("msginfo.msgssz not a small power of 2");
225         }
226
227         if (msginfo.msgseg > 32767) {
228                 DPRINTF(("msginfo.msgseg=%d\n", msginfo.msgseg));
229                 panic("msginfo.msgseg > 32767");
230         }
231
232         for (i = 0; i < msginfo.msgseg; i++) {
233                 if (i > 0)
234                         msgmaps[i-1].next = i;
235                 msgmaps[i].next = -1;   /* implies entry is available */
236         }
237         free_msgmaps = 0;
238         nfree_msgmaps = msginfo.msgseg;
239
240         for (i = 0; i < msginfo.msgtql; i++) {
241                 msghdrs[i].msg_type = 0;
242                 if (i > 0)
243                         msghdrs[i-1].msg_next = &msghdrs[i];
244                 msghdrs[i].msg_next = NULL;
245 #ifdef MAC
246                 mac_sysvmsg_init(&msghdrs[i]);
247 #endif
248         }
249         free_msghdrs = &msghdrs[0];
250
251         for (i = 0; i < msginfo.msgmni; i++) {
252                 msqids[i].u.msg_qbytes = 0;     /* implies entry is available */
253                 msqids[i].u.msg_perm.seq = 0;   /* reset to a known value */
254                 msqids[i].u.msg_perm.mode = 0;
255 #ifdef MAC
256                 mac_sysvmsq_init(&msqids[i]);
257 #endif
258         }
259         mtx_init(&msq_mtx, "msq", NULL, MTX_DEF);
260
261         error = syscall_helper_register(msg_syscalls);
262         if (error != 0)
263                 return (error);
264 #ifdef COMPAT_FREEBSD32
265         error = syscall32_helper_register(msg32_syscalls);
266         if (error != 0)
267                 return (error);
268 #endif
269         return (0);
270 }
271
272 static int
273 msgunload()
274 {
275         struct msqid_kernel *msqkptr;
276         int msqid;
277 #ifdef MAC
278         int i;
279 #endif
280
281         syscall_helper_unregister(msg_syscalls);
282 #ifdef COMPAT_FREEBSD32
283         syscall32_helper_unregister(msg32_syscalls);
284 #endif
285
286         for (msqid = 0; msqid < msginfo.msgmni; msqid++) {
287                 /*
288                  * Look for an unallocated and unlocked msqid_ds.
289                  * msqid_ds's can be locked by msgsnd or msgrcv while
290                  * they are copying the message in/out.  We can't
291                  * re-use the entry until they release it.
292                  */
293                 msqkptr = &msqids[msqid];
294                 if (msqkptr->u.msg_qbytes != 0 ||
295                     (msqkptr->u.msg_perm.mode & MSG_LOCKED) != 0)
296                         break;
297         }
298         if (msqid != msginfo.msgmni)
299                 return (EBUSY);
300
301 #ifdef MAC
302         for (i = 0; i < msginfo.msgtql; i++)
303                 mac_sysvmsg_destroy(&msghdrs[i]);
304         for (msqid = 0; msqid < msginfo.msgmni; msqid++)
305                 mac_sysvmsq_destroy(&msqids[msqid]);
306 #endif
307         free(msgpool, M_MSG);
308         free(msgmaps, M_MSG);
309         free(msghdrs, M_MSG);
310         free(msqids, M_MSG);
311         mtx_destroy(&msq_mtx);
312         return (0);
313 }
314
315
316 static int
317 sysvmsg_modload(struct module *module, int cmd, void *arg)
318 {
319         int error = 0;
320
321         switch (cmd) {
322         case MOD_LOAD:
323                 error = msginit();
324                 if (error != 0)
325                         msgunload();
326                 break;
327         case MOD_UNLOAD:
328                 error = msgunload();
329                 break;
330         case MOD_SHUTDOWN:
331                 break;
332         default:
333                 error = EINVAL;
334                 break;
335         }
336         return (error);
337 }
338
339 static moduledata_t sysvmsg_mod = {
340         "sysvmsg",
341         &sysvmsg_modload,
342         NULL
343 };
344
345 DECLARE_MODULE(sysvmsg, sysvmsg_mod, SI_SUB_SYSV_MSG, SI_ORDER_FIRST);
346 MODULE_VERSION(sysvmsg, 1);
347
348 static void
349 msg_freehdr(msghdr)
350         struct msg *msghdr;
351 {
352         while (msghdr->msg_ts > 0) {
353                 short next;
354                 if (msghdr->msg_spot < 0 || msghdr->msg_spot >= msginfo.msgseg)
355                         panic("msghdr->msg_spot out of range");
356                 next = msgmaps[msghdr->msg_spot].next;
357                 msgmaps[msghdr->msg_spot].next = free_msgmaps;
358                 free_msgmaps = msghdr->msg_spot;
359                 nfree_msgmaps++;
360                 msghdr->msg_spot = next;
361                 if (msghdr->msg_ts >= msginfo.msgssz)
362                         msghdr->msg_ts -= msginfo.msgssz;
363                 else
364                         msghdr->msg_ts = 0;
365         }
366         if (msghdr->msg_spot != -1)
367                 panic("msghdr->msg_spot != -1");
368         msghdr->msg_next = free_msghdrs;
369         free_msghdrs = msghdr;
370 #ifdef MAC
371         mac_sysvmsg_cleanup(msghdr);
372 #endif
373 }
374
375 #ifndef _SYS_SYSPROTO_H_
376 struct msgctl_args {
377         int     msqid;
378         int     cmd;
379         struct  msqid_ds *buf;
380 };
381 #endif
382 int
383 sys_msgctl(td, uap)
384         struct thread *td;
385         register struct msgctl_args *uap;
386 {
387         int msqid = uap->msqid;
388         int cmd = uap->cmd;
389         struct msqid_ds msqbuf;
390         int error;
391
392         DPRINTF(("call to msgctl(%d, %d, %p)\n", msqid, cmd, uap->buf));
393         if (cmd == IPC_SET &&
394             (error = copyin(uap->buf, &msqbuf, sizeof(msqbuf))) != 0)
395                 return (error);
396         error = kern_msgctl(td, msqid, cmd, &msqbuf);
397         if (cmd == IPC_STAT && error == 0)
398                 error = copyout(&msqbuf, uap->buf, sizeof(struct msqid_ds));
399         return (error);
400 }
401
402 int
403 kern_msgctl(td, msqid, cmd, msqbuf)
404         struct thread *td;
405         int msqid;
406         int cmd;
407         struct msqid_ds *msqbuf;
408 {
409         int rval, error, msqix;
410         register struct msqid_kernel *msqkptr;
411
412         if (!prison_allow(td->td_ucred, PR_ALLOW_SYSVIPC))
413                 return (ENOSYS);
414
415         msqix = IPCID_TO_IX(msqid);
416
417         if (msqix < 0 || msqix >= msginfo.msgmni) {
418                 DPRINTF(("msqid (%d) out of range (0<=msqid<%d)\n", msqix,
419                     msginfo.msgmni));
420                 return (EINVAL);
421         }
422
423         msqkptr = &msqids[msqix];
424
425         mtx_lock(&msq_mtx);
426         if (msqkptr->u.msg_qbytes == 0) {
427                 DPRINTF(("no such msqid\n"));
428                 error = EINVAL;
429                 goto done2;
430         }
431         if (msqkptr->u.msg_perm.seq != IPCID_TO_SEQ(msqid)) {
432                 DPRINTF(("wrong sequence number\n"));
433                 error = EINVAL;
434                 goto done2;
435         }
436 #ifdef MAC
437         error = mac_sysvmsq_check_msqctl(td->td_ucred, msqkptr, cmd);
438         if (error != 0)
439                 goto done2;
440 #endif
441
442         error = 0;
443         rval = 0;
444
445         switch (cmd) {
446
447         case IPC_RMID:
448         {
449                 struct msg *msghdr;
450                 if ((error = ipcperm(td, &msqkptr->u.msg_perm, IPC_M)))
451                         goto done2;
452
453 #ifdef MAC
454                 /*
455                  * Check that the thread has MAC access permissions to
456                  * individual msghdrs.  Note: We need to do this in a
457                  * separate loop because the actual loop alters the
458                  * msq/msghdr info as it progresses, and there is no going
459                  * back if half the way through we discover that the
460                  * thread cannot free a certain msghdr.  The msq will get
461                  * into an inconsistent state.
462                  */
463                 for (msghdr = msqkptr->u.msg_first; msghdr != NULL;
464                     msghdr = msghdr->msg_next) {
465                         error = mac_sysvmsq_check_msgrmid(td->td_ucred, msghdr);
466                         if (error != 0)
467                                 goto done2;
468                 }
469 #endif
470
471                 racct_sub_cred(msqkptr->cred, RACCT_NMSGQ, 1);
472                 racct_sub_cred(msqkptr->cred, RACCT_MSGQQUEUED, msqkptr->u.msg_qnum);
473                 racct_sub_cred(msqkptr->cred, RACCT_MSGQSIZE, msqkptr->u.msg_cbytes);
474                 crfree(msqkptr->cred);
475                 msqkptr->cred = NULL;
476
477                 /* Free the message headers */
478                 msghdr = msqkptr->u.msg_first;
479                 while (msghdr != NULL) {
480                         struct msg *msghdr_tmp;
481
482                         /* Free the segments of each message */
483                         msqkptr->u.msg_cbytes -= msghdr->msg_ts;
484                         msqkptr->u.msg_qnum--;
485                         msghdr_tmp = msghdr;
486                         msghdr = msghdr->msg_next;
487                         msg_freehdr(msghdr_tmp);
488                 }
489
490                 if (msqkptr->u.msg_cbytes != 0)
491                         panic("msg_cbytes is screwed up");
492                 if (msqkptr->u.msg_qnum != 0)
493                         panic("msg_qnum is screwed up");
494
495                 msqkptr->u.msg_qbytes = 0;      /* Mark it as free */
496
497 #ifdef MAC
498                 mac_sysvmsq_cleanup(msqkptr);
499 #endif
500
501                 wakeup(msqkptr);
502         }
503
504                 break;
505
506         case IPC_SET:
507                 if ((error = ipcperm(td, &msqkptr->u.msg_perm, IPC_M)))
508                         goto done2;
509                 if (msqbuf->msg_qbytes > msqkptr->u.msg_qbytes) {
510                         error = priv_check(td, PRIV_IPC_MSGSIZE);
511                         if (error)
512                                 goto done2;
513                 }
514                 if (msqbuf->msg_qbytes > msginfo.msgmnb) {
515                         DPRINTF(("can't increase msg_qbytes beyond %d"
516                             "(truncating)\n", msginfo.msgmnb));
517                         msqbuf->msg_qbytes = msginfo.msgmnb;    /* silently restrict qbytes to system limit */
518                 }
519                 if (msqbuf->msg_qbytes == 0) {
520                         DPRINTF(("can't reduce msg_qbytes to 0\n"));
521                         error = EINVAL;         /* non-standard errno! */
522                         goto done2;
523                 }
524                 msqkptr->u.msg_perm.uid = msqbuf->msg_perm.uid; /* change the owner */
525                 msqkptr->u.msg_perm.gid = msqbuf->msg_perm.gid; /* change the owner */
526                 msqkptr->u.msg_perm.mode = (msqkptr->u.msg_perm.mode & ~0777) |
527                     (msqbuf->msg_perm.mode & 0777);
528                 msqkptr->u.msg_qbytes = msqbuf->msg_qbytes;
529                 msqkptr->u.msg_ctime = time_second;
530                 break;
531
532         case IPC_STAT:
533                 if ((error = ipcperm(td, &msqkptr->u.msg_perm, IPC_R))) {
534                         DPRINTF(("requester doesn't have read access\n"));
535                         goto done2;
536                 }
537                 *msqbuf = msqkptr->u;
538                 break;
539
540         default:
541                 DPRINTF(("invalid command %d\n", cmd));
542                 error = EINVAL;
543                 goto done2;
544         }
545
546         if (error == 0)
547                 td->td_retval[0] = rval;
548 done2:
549         mtx_unlock(&msq_mtx);
550         return (error);
551 }
552
553 #ifndef _SYS_SYSPROTO_H_
554 struct msgget_args {
555         key_t   key;
556         int     msgflg;
557 };
558 #endif
559
560 int
561 sys_msgget(td, uap)
562         struct thread *td;
563         register struct msgget_args *uap;
564 {
565         int msqid, error = 0;
566         int key = uap->key;
567         int msgflg = uap->msgflg;
568         struct ucred *cred = td->td_ucred;
569         register struct msqid_kernel *msqkptr = NULL;
570
571         DPRINTF(("msgget(0x%x, 0%o)\n", key, msgflg));
572
573         if (!prison_allow(td->td_ucred, PR_ALLOW_SYSVIPC))
574                 return (ENOSYS);
575
576         mtx_lock(&msq_mtx);
577         if (key != IPC_PRIVATE) {
578                 for (msqid = 0; msqid < msginfo.msgmni; msqid++) {
579                         msqkptr = &msqids[msqid];
580                         if (msqkptr->u.msg_qbytes != 0 &&
581                             msqkptr->u.msg_perm.key == key)
582                                 break;
583                 }
584                 if (msqid < msginfo.msgmni) {
585                         DPRINTF(("found public key\n"));
586                         if ((msgflg & IPC_CREAT) && (msgflg & IPC_EXCL)) {
587                                 DPRINTF(("not exclusive\n"));
588                                 error = EEXIST;
589                                 goto done2;
590                         }
591                         if ((error = ipcperm(td, &msqkptr->u.msg_perm,
592                             msgflg & 0700))) {
593                                 DPRINTF(("requester doesn't have 0%o access\n",
594                                     msgflg & 0700));
595                                 goto done2;
596                         }
597 #ifdef MAC
598                         error = mac_sysvmsq_check_msqget(cred, msqkptr);
599                         if (error != 0)
600                                 goto done2;
601 #endif
602                         goto found;
603                 }
604         }
605
606         DPRINTF(("need to allocate the msqid_ds\n"));
607         if (key == IPC_PRIVATE || (msgflg & IPC_CREAT)) {
608                 for (msqid = 0; msqid < msginfo.msgmni; msqid++) {
609                         /*
610                          * Look for an unallocated and unlocked msqid_ds.
611                          * msqid_ds's can be locked by msgsnd or msgrcv while
612                          * they are copying the message in/out.  We can't
613                          * re-use the entry until they release it.
614                          */
615                         msqkptr = &msqids[msqid];
616                         if (msqkptr->u.msg_qbytes == 0 &&
617                             (msqkptr->u.msg_perm.mode & MSG_LOCKED) == 0)
618                                 break;
619                 }
620                 if (msqid == msginfo.msgmni) {
621                         DPRINTF(("no more msqid_ds's available\n"));
622                         error = ENOSPC;
623                         goto done2;
624                 }
625 #ifdef RACCT
626                 PROC_LOCK(td->td_proc);
627                 error = racct_add(td->td_proc, RACCT_NMSGQ, 1);
628                 PROC_UNLOCK(td->td_proc);
629                 if (error != 0) {
630                         error = ENOSPC;
631                         goto done2;
632                 }
633 #endif
634                 DPRINTF(("msqid %d is available\n", msqid));
635                 msqkptr->u.msg_perm.key = key;
636                 msqkptr->u.msg_perm.cuid = cred->cr_uid;
637                 msqkptr->u.msg_perm.uid = cred->cr_uid;
638                 msqkptr->u.msg_perm.cgid = cred->cr_gid;
639                 msqkptr->u.msg_perm.gid = cred->cr_gid;
640                 msqkptr->u.msg_perm.mode = (msgflg & 0777);
641                 msqkptr->cred = crhold(cred);
642                 /* Make sure that the returned msqid is unique */
643                 msqkptr->u.msg_perm.seq = (msqkptr->u.msg_perm.seq + 1) & 0x7fff;
644                 msqkptr->u.msg_first = NULL;
645                 msqkptr->u.msg_last = NULL;
646                 msqkptr->u.msg_cbytes = 0;
647                 msqkptr->u.msg_qnum = 0;
648                 msqkptr->u.msg_qbytes = msginfo.msgmnb;
649                 msqkptr->u.msg_lspid = 0;
650                 msqkptr->u.msg_lrpid = 0;
651                 msqkptr->u.msg_stime = 0;
652                 msqkptr->u.msg_rtime = 0;
653                 msqkptr->u.msg_ctime = time_second;
654 #ifdef MAC
655                 mac_sysvmsq_create(cred, msqkptr);
656 #endif
657         } else {
658                 DPRINTF(("didn't find it and wasn't asked to create it\n"));
659                 error = ENOENT;
660                 goto done2;
661         }
662
663 found:
664         /* Construct the unique msqid */
665         td->td_retval[0] = IXSEQ_TO_IPCID(msqid, msqkptr->u.msg_perm);
666 done2:
667         mtx_unlock(&msq_mtx);
668         return (error);
669 }
670
671 #ifndef _SYS_SYSPROTO_H_
672 struct msgsnd_args {
673         int     msqid;
674         const void      *msgp;
675         size_t  msgsz;
676         int     msgflg;
677 };
678 #endif
679 int
680 kern_msgsnd(td, msqid, msgp, msgsz, msgflg, mtype)
681         struct thread *td;
682         int msqid;
683         const void *msgp;       /* XXX msgp is actually mtext. */
684         size_t msgsz;
685         int msgflg;
686         long mtype;
687 {
688         int msqix, segs_needed, error = 0;
689         register struct msqid_kernel *msqkptr;
690         register struct msg *msghdr;
691         short next;
692 #ifdef RACCT
693         size_t saved_msgsz;
694 #endif
695
696         if (!prison_allow(td->td_ucred, PR_ALLOW_SYSVIPC))
697                 return (ENOSYS);
698
699         mtx_lock(&msq_mtx);
700         msqix = IPCID_TO_IX(msqid);
701
702         if (msqix < 0 || msqix >= msginfo.msgmni) {
703                 DPRINTF(("msqid (%d) out of range (0<=msqid<%d)\n", msqix,
704                     msginfo.msgmni));
705                 error = EINVAL;
706                 goto done2;
707         }
708
709         msqkptr = &msqids[msqix];
710         if (msqkptr->u.msg_qbytes == 0) {
711                 DPRINTF(("no such message queue id\n"));
712                 error = EINVAL;
713                 goto done2;
714         }
715         if (msqkptr->u.msg_perm.seq != IPCID_TO_SEQ(msqid)) {
716                 DPRINTF(("wrong sequence number\n"));
717                 error = EINVAL;
718                 goto done2;
719         }
720
721         if ((error = ipcperm(td, &msqkptr->u.msg_perm, IPC_W))) {
722                 DPRINTF(("requester doesn't have write access\n"));
723                 goto done2;
724         }
725
726 #ifdef MAC
727         error = mac_sysvmsq_check_msqsnd(td->td_ucred, msqkptr);
728         if (error != 0)
729                 goto done2;
730 #endif
731
732 #ifdef RACCT
733         PROC_LOCK(td->td_proc);
734         if (racct_add(td->td_proc, RACCT_MSGQQUEUED, 1)) {
735                 PROC_UNLOCK(td->td_proc);
736                 error = EAGAIN;
737                 goto done2;
738         }
739         saved_msgsz = msgsz;
740         if (racct_add(td->td_proc, RACCT_MSGQSIZE, msgsz)) {
741                 racct_sub(td->td_proc, RACCT_MSGQQUEUED, 1);
742                 PROC_UNLOCK(td->td_proc);
743                 error = EAGAIN;
744                 goto done2;
745         }
746         PROC_UNLOCK(td->td_proc);
747 #endif
748
749         segs_needed = (msgsz + msginfo.msgssz - 1) / msginfo.msgssz;
750         DPRINTF(("msgsz=%zu, msgssz=%d, segs_needed=%d\n", msgsz,
751             msginfo.msgssz, segs_needed));
752         for (;;) {
753                 int need_more_resources = 0;
754
755                 /*
756                  * check msgsz
757                  * (inside this loop in case msg_qbytes changes while we sleep)
758                  */
759
760                 if (msgsz > msqkptr->u.msg_qbytes) {
761                         DPRINTF(("msgsz > msqkptr->u.msg_qbytes\n"));
762                         error = EINVAL;
763                         goto done3;
764                 }
765
766                 if (msqkptr->u.msg_perm.mode & MSG_LOCKED) {
767                         DPRINTF(("msqid is locked\n"));
768                         need_more_resources = 1;
769                 }
770                 if (msgsz + msqkptr->u.msg_cbytes > msqkptr->u.msg_qbytes) {
771                         DPRINTF(("msgsz + msg_cbytes > msg_qbytes\n"));
772                         need_more_resources = 1;
773                 }
774                 if (segs_needed > nfree_msgmaps) {
775                         DPRINTF(("segs_needed > nfree_msgmaps\n"));
776                         need_more_resources = 1;
777                 }
778                 if (free_msghdrs == NULL) {
779                         DPRINTF(("no more msghdrs\n"));
780                         need_more_resources = 1;
781                 }
782
783                 if (need_more_resources) {
784                         int we_own_it;
785
786                         if ((msgflg & IPC_NOWAIT) != 0) {
787                                 DPRINTF(("need more resources but caller "
788                                     "doesn't want to wait\n"));
789                                 error = EAGAIN;
790                                 goto done3;
791                         }
792
793                         if ((msqkptr->u.msg_perm.mode & MSG_LOCKED) != 0) {
794                                 DPRINTF(("we don't own the msqid_ds\n"));
795                                 we_own_it = 0;
796                         } else {
797                                 /* Force later arrivals to wait for our
798                                    request */
799                                 DPRINTF(("we own the msqid_ds\n"));
800                                 msqkptr->u.msg_perm.mode |= MSG_LOCKED;
801                                 we_own_it = 1;
802                         }
803                         DPRINTF(("msgsnd:  goodnight\n"));
804                         error = msleep(msqkptr, &msq_mtx, (PZERO - 4) | PCATCH,
805                             "msgsnd", hz);
806                         DPRINTF(("msgsnd:  good morning, error=%d\n", error));
807                         if (we_own_it)
808                                 msqkptr->u.msg_perm.mode &= ~MSG_LOCKED;
809                         if (error == EWOULDBLOCK) {
810                                 DPRINTF(("msgsnd:  timed out\n"));
811                                 continue;
812                         }
813                         if (error != 0) {
814                                 DPRINTF(("msgsnd:  interrupted system call\n"));
815                                 error = EINTR;
816                                 goto done3;
817                         }
818
819                         /*
820                          * Make sure that the msq queue still exists
821                          */
822
823                         if (msqkptr->u.msg_qbytes == 0) {
824                                 DPRINTF(("msqid deleted\n"));
825                                 error = EIDRM;
826                                 goto done3;
827                         }
828
829                 } else {
830                         DPRINTF(("got all the resources that we need\n"));
831                         break;
832                 }
833         }
834
835         /*
836          * We have the resources that we need.
837          * Make sure!
838          */
839
840         if (msqkptr->u.msg_perm.mode & MSG_LOCKED)
841                 panic("msg_perm.mode & MSG_LOCKED");
842         if (segs_needed > nfree_msgmaps)
843                 panic("segs_needed > nfree_msgmaps");
844         if (msgsz + msqkptr->u.msg_cbytes > msqkptr->u.msg_qbytes)
845                 panic("msgsz + msg_cbytes > msg_qbytes");
846         if (free_msghdrs == NULL)
847                 panic("no more msghdrs");
848
849         /*
850          * Re-lock the msqid_ds in case we page-fault when copying in the
851          * message
852          */
853
854         if ((msqkptr->u.msg_perm.mode & MSG_LOCKED) != 0)
855                 panic("msqid_ds is already locked");
856         msqkptr->u.msg_perm.mode |= MSG_LOCKED;
857
858         /*
859          * Allocate a message header
860          */
861
862         msghdr = free_msghdrs;
863         free_msghdrs = msghdr->msg_next;
864         msghdr->msg_spot = -1;
865         msghdr->msg_ts = msgsz;
866         msghdr->msg_type = mtype;
867 #ifdef MAC
868         /*
869          * XXXMAC: Should the mac_sysvmsq_check_msgmsq check follow here
870          * immediately?  Or, should it be checked just before the msg is
871          * enqueued in the msgq (as it is done now)?
872          */
873         mac_sysvmsg_create(td->td_ucred, msqkptr, msghdr);
874 #endif
875
876         /*
877          * Allocate space for the message
878          */
879
880         while (segs_needed > 0) {
881                 if (nfree_msgmaps <= 0)
882                         panic("not enough msgmaps");
883                 if (free_msgmaps == -1)
884                         panic("nil free_msgmaps");
885                 next = free_msgmaps;
886                 if (next <= -1)
887                         panic("next too low #1");
888                 if (next >= msginfo.msgseg)
889                         panic("next out of range #1");
890                 DPRINTF(("allocating segment %d to message\n", next));
891                 free_msgmaps = msgmaps[next].next;
892                 nfree_msgmaps--;
893                 msgmaps[next].next = msghdr->msg_spot;
894                 msghdr->msg_spot = next;
895                 segs_needed--;
896         }
897
898         /*
899          * Validate the message type
900          */
901
902         if (msghdr->msg_type < 1) {
903                 msg_freehdr(msghdr);
904                 msqkptr->u.msg_perm.mode &= ~MSG_LOCKED;
905                 wakeup(msqkptr);
906                 DPRINTF(("mtype (%ld) < 1\n", msghdr->msg_type));
907                 error = EINVAL;
908                 goto done3;
909         }
910
911         /*
912          * Copy in the message body
913          */
914
915         next = msghdr->msg_spot;
916         while (msgsz > 0) {
917                 size_t tlen;
918                 if (msgsz > msginfo.msgssz)
919                         tlen = msginfo.msgssz;
920                 else
921                         tlen = msgsz;
922                 if (next <= -1)
923                         panic("next too low #2");
924                 if (next >= msginfo.msgseg)
925                         panic("next out of range #2");
926                 mtx_unlock(&msq_mtx);
927                 if ((error = copyin(msgp, &msgpool[next * msginfo.msgssz],
928                     tlen)) != 0) {
929                         mtx_lock(&msq_mtx);
930                         DPRINTF(("error %d copying in message segment\n",
931                             error));
932                         msg_freehdr(msghdr);
933                         msqkptr->u.msg_perm.mode &= ~MSG_LOCKED;
934                         wakeup(msqkptr);
935                         goto done3;
936                 }
937                 mtx_lock(&msq_mtx);
938                 msgsz -= tlen;
939                 msgp = (const char *)msgp + tlen;
940                 next = msgmaps[next].next;
941         }
942         if (next != -1)
943                 panic("didn't use all the msg segments");
944
945         /*
946          * We've got the message.  Unlock the msqid_ds.
947          */
948
949         msqkptr->u.msg_perm.mode &= ~MSG_LOCKED;
950
951         /*
952          * Make sure that the msqid_ds is still allocated.
953          */
954
955         if (msqkptr->u.msg_qbytes == 0) {
956                 msg_freehdr(msghdr);
957                 wakeup(msqkptr);
958                 error = EIDRM;
959                 goto done3;
960         }
961
962 #ifdef MAC
963         /*
964          * Note: Since the task/thread allocates the msghdr and usually
965          * primes it with its own MAC label, for a majority of policies, it
966          * won't be necessary to check whether the msghdr has access
967          * permissions to the msgq.  The mac_sysvmsq_check_msqsnd check would
968          * suffice in that case.  However, this hook may be required where
969          * individual policies derive a non-identical label for the msghdr
970          * from the current thread label and may want to check the msghdr
971          * enqueue permissions, along with read/write permissions to the
972          * msgq.
973          */
974         error = mac_sysvmsq_check_msgmsq(td->td_ucred, msghdr, msqkptr);
975         if (error != 0) {
976                 msg_freehdr(msghdr);
977                 wakeup(msqkptr);
978                 goto done3;
979         }
980 #endif
981
982         /*
983          * Put the message into the queue
984          */
985         if (msqkptr->u.msg_first == NULL) {
986                 msqkptr->u.msg_first = msghdr;
987                 msqkptr->u.msg_last = msghdr;
988         } else {
989                 msqkptr->u.msg_last->msg_next = msghdr;
990                 msqkptr->u.msg_last = msghdr;
991         }
992         msqkptr->u.msg_last->msg_next = NULL;
993
994         msqkptr->u.msg_cbytes += msghdr->msg_ts;
995         msqkptr->u.msg_qnum++;
996         msqkptr->u.msg_lspid = td->td_proc->p_pid;
997         msqkptr->u.msg_stime = time_second;
998
999         wakeup(msqkptr);
1000         td->td_retval[0] = 0;
1001 done3:
1002 #ifdef RACCT
1003         if (error != 0) {
1004                 PROC_LOCK(td->td_proc);
1005                 racct_sub(td->td_proc, RACCT_MSGQQUEUED, 1);
1006                 racct_sub(td->td_proc, RACCT_MSGQSIZE, saved_msgsz);
1007                 PROC_UNLOCK(td->td_proc);
1008         }
1009 #endif
1010 done2:
1011         mtx_unlock(&msq_mtx);
1012         return (error);
1013 }
1014
1015 int
1016 sys_msgsnd(td, uap)
1017         struct thread *td;
1018         register struct msgsnd_args *uap;
1019 {
1020         int error;
1021         long mtype;
1022
1023         DPRINTF(("call to msgsnd(%d, %p, %zu, %d)\n", uap->msqid, uap->msgp,
1024             uap->msgsz, uap->msgflg));
1025
1026         if ((error = copyin(uap->msgp, &mtype, sizeof(mtype))) != 0) {
1027                 DPRINTF(("error %d copying the message type\n", error));
1028                 return (error);
1029         }
1030         return (kern_msgsnd(td, uap->msqid,
1031             (const char *)uap->msgp + sizeof(mtype),
1032             uap->msgsz, uap->msgflg, mtype));
1033 }
1034
1035 #ifndef _SYS_SYSPROTO_H_
1036 struct msgrcv_args {
1037         int     msqid;
1038         void    *msgp;
1039         size_t  msgsz;
1040         long    msgtyp;
1041         int     msgflg;
1042 };
1043 #endif
1044 int
1045 kern_msgrcv(td, msqid, msgp, msgsz, msgtyp, msgflg, mtype)
1046         struct thread *td;
1047         int msqid;
1048         void *msgp;     /* XXX msgp is actually mtext. */
1049         size_t msgsz;
1050         long msgtyp;
1051         int msgflg;
1052         long *mtype;
1053 {
1054         size_t len;
1055         register struct msqid_kernel *msqkptr;
1056         register struct msg *msghdr;
1057         int msqix, error = 0;
1058         short next;
1059
1060         if (!prison_allow(td->td_ucred, PR_ALLOW_SYSVIPC))
1061                 return (ENOSYS);
1062
1063         msqix = IPCID_TO_IX(msqid);
1064
1065         if (msqix < 0 || msqix >= msginfo.msgmni) {
1066                 DPRINTF(("msqid (%d) out of range (0<=msqid<%d)\n", msqix,
1067                     msginfo.msgmni));
1068                 return (EINVAL);
1069         }
1070
1071         msqkptr = &msqids[msqix];
1072         mtx_lock(&msq_mtx);
1073         if (msqkptr->u.msg_qbytes == 0) {
1074                 DPRINTF(("no such message queue id\n"));
1075                 error = EINVAL;
1076                 goto done2;
1077         }
1078         if (msqkptr->u.msg_perm.seq != IPCID_TO_SEQ(msqid)) {
1079                 DPRINTF(("wrong sequence number\n"));
1080                 error = EINVAL;
1081                 goto done2;
1082         }
1083
1084         if ((error = ipcperm(td, &msqkptr->u.msg_perm, IPC_R))) {
1085                 DPRINTF(("requester doesn't have read access\n"));
1086                 goto done2;
1087         }
1088
1089 #ifdef MAC
1090         error = mac_sysvmsq_check_msqrcv(td->td_ucred, msqkptr);
1091         if (error != 0)
1092                 goto done2;
1093 #endif
1094
1095         msghdr = NULL;
1096         while (msghdr == NULL) {
1097                 if (msgtyp == 0) {
1098                         msghdr = msqkptr->u.msg_first;
1099                         if (msghdr != NULL) {
1100                                 if (msgsz < msghdr->msg_ts &&
1101                                     (msgflg & MSG_NOERROR) == 0) {
1102                                         DPRINTF(("first message on the queue "
1103                                             "is too big (want %zu, got %d)\n",
1104                                             msgsz, msghdr->msg_ts));
1105                                         error = E2BIG;
1106                                         goto done2;
1107                                 }
1108 #ifdef MAC
1109                                 error = mac_sysvmsq_check_msgrcv(td->td_ucred,
1110                                     msghdr);
1111                                 if (error != 0)
1112                                         goto done2;
1113 #endif
1114                                 if (msqkptr->u.msg_first == msqkptr->u.msg_last) {
1115                                         msqkptr->u.msg_first = NULL;
1116                                         msqkptr->u.msg_last = NULL;
1117                                 } else {
1118                                         msqkptr->u.msg_first = msghdr->msg_next;
1119                                         if (msqkptr->u.msg_first == NULL)
1120                                                 panic("msg_first/last screwed up #1");
1121                                 }
1122                         }
1123                 } else {
1124                         struct msg *previous;
1125                         struct msg **prev;
1126
1127                         previous = NULL;
1128                         prev = &(msqkptr->u.msg_first);
1129                         while ((msghdr = *prev) != NULL) {
1130                                 /*
1131                                  * Is this message's type an exact match or is
1132                                  * this message's type less than or equal to
1133                                  * the absolute value of a negative msgtyp?
1134                                  * Note that the second half of this test can
1135                                  * NEVER be true if msgtyp is positive since
1136                                  * msg_type is always positive!
1137                                  */
1138
1139                                 if (msgtyp == msghdr->msg_type ||
1140                                     msghdr->msg_type <= -msgtyp) {
1141                                         DPRINTF(("found message type %ld, "
1142                                             "requested %ld\n",
1143                                             msghdr->msg_type, msgtyp));
1144                                         if (msgsz < msghdr->msg_ts &&
1145                                             (msgflg & MSG_NOERROR) == 0) {
1146                                                 DPRINTF(("requested message "
1147                                                     "on the queue is too big "
1148                                                     "(want %zu, got %hu)\n",
1149                                                     msgsz, msghdr->msg_ts));
1150                                                 error = E2BIG;
1151                                                 goto done2;
1152                                         }
1153 #ifdef MAC
1154                                         error = mac_sysvmsq_check_msgrcv(
1155                                             td->td_ucred, msghdr);
1156                                         if (error != 0)
1157                                                 goto done2;
1158 #endif
1159                                         *prev = msghdr->msg_next;
1160                                         if (msghdr == msqkptr->u.msg_last) {
1161                                                 if (previous == NULL) {
1162                                                         if (prev !=
1163                                                             &msqkptr->u.msg_first)
1164                                                                 panic("msg_first/last screwed up #2");
1165                                                         msqkptr->u.msg_first =
1166                                                             NULL;
1167                                                         msqkptr->u.msg_last =
1168                                                             NULL;
1169                                                 } else {
1170                                                         if (prev ==
1171                                                             &msqkptr->u.msg_first)
1172                                                                 panic("msg_first/last screwed up #3");
1173                                                         msqkptr->u.msg_last =
1174                                                             previous;
1175                                                 }
1176                                         }
1177                                         break;
1178                                 }
1179                                 previous = msghdr;
1180                                 prev = &(msghdr->msg_next);
1181                         }
1182                 }
1183
1184                 /*
1185                  * We've either extracted the msghdr for the appropriate
1186                  * message or there isn't one.
1187                  * If there is one then bail out of this loop.
1188                  */
1189
1190                 if (msghdr != NULL)
1191                         break;
1192
1193                 /*
1194                  * Hmph!  No message found.  Does the user want to wait?
1195                  */
1196
1197                 if ((msgflg & IPC_NOWAIT) != 0) {
1198                         DPRINTF(("no appropriate message found (msgtyp=%ld)\n",
1199                             msgtyp));
1200                         /* The SVID says to return ENOMSG. */
1201                         error = ENOMSG;
1202                         goto done2;
1203                 }
1204
1205                 /*
1206                  * Wait for something to happen
1207                  */
1208
1209                 DPRINTF(("msgrcv:  goodnight\n"));
1210                 error = msleep(msqkptr, &msq_mtx, (PZERO - 4) | PCATCH,
1211                     "msgrcv", 0);
1212                 DPRINTF(("msgrcv:  good morning (error=%d)\n", error));
1213
1214                 if (error != 0) {
1215                         DPRINTF(("msgrcv:  interrupted system call\n"));
1216                         error = EINTR;
1217                         goto done2;
1218                 }
1219
1220                 /*
1221                  * Make sure that the msq queue still exists
1222                  */
1223
1224                 if (msqkptr->u.msg_qbytes == 0 ||
1225                     msqkptr->u.msg_perm.seq != IPCID_TO_SEQ(msqid)) {
1226                         DPRINTF(("msqid deleted\n"));
1227                         error = EIDRM;
1228                         goto done2;
1229                 }
1230         }
1231
1232         /*
1233          * Return the message to the user.
1234          *
1235          * First, do the bookkeeping (before we risk being interrupted).
1236          */
1237
1238         msqkptr->u.msg_cbytes -= msghdr->msg_ts;
1239         msqkptr->u.msg_qnum--;
1240         msqkptr->u.msg_lrpid = td->td_proc->p_pid;
1241         msqkptr->u.msg_rtime = time_second;
1242
1243         racct_sub_cred(msqkptr->cred, RACCT_MSGQQUEUED, 1);
1244         racct_sub_cred(msqkptr->cred, RACCT_MSGQSIZE, msghdr->msg_ts);
1245
1246         /*
1247          * Make msgsz the actual amount that we'll be returning.
1248          * Note that this effectively truncates the message if it is too long
1249          * (since msgsz is never increased).
1250          */
1251
1252         DPRINTF(("found a message, msgsz=%zu, msg_ts=%hu\n", msgsz,
1253             msghdr->msg_ts));
1254         if (msgsz > msghdr->msg_ts)
1255                 msgsz = msghdr->msg_ts;
1256         *mtype = msghdr->msg_type;
1257
1258         /*
1259          * Return the segments to the user
1260          */
1261
1262         next = msghdr->msg_spot;
1263         for (len = 0; len < msgsz; len += msginfo.msgssz) {
1264                 size_t tlen;
1265
1266                 if (msgsz - len > msginfo.msgssz)
1267                         tlen = msginfo.msgssz;
1268                 else
1269                         tlen = msgsz - len;
1270                 if (next <= -1)
1271                         panic("next too low #3");
1272                 if (next >= msginfo.msgseg)
1273                         panic("next out of range #3");
1274                 mtx_unlock(&msq_mtx);
1275                 error = copyout(&msgpool[next * msginfo.msgssz], msgp, tlen);
1276                 mtx_lock(&msq_mtx);
1277                 if (error != 0) {
1278                         DPRINTF(("error (%d) copying out message segment\n",
1279                             error));
1280                         msg_freehdr(msghdr);
1281                         wakeup(msqkptr);
1282                         goto done2;
1283                 }
1284                 msgp = (char *)msgp + tlen;
1285                 next = msgmaps[next].next;
1286         }
1287
1288         /*
1289          * Done, return the actual number of bytes copied out.
1290          */
1291
1292         msg_freehdr(msghdr);
1293         wakeup(msqkptr);
1294         td->td_retval[0] = msgsz;
1295 done2:
1296         mtx_unlock(&msq_mtx);
1297         return (error);
1298 }
1299
1300 int
1301 sys_msgrcv(td, uap)
1302         struct thread *td;
1303         register struct msgrcv_args *uap;
1304 {
1305         int error;
1306         long mtype;
1307
1308         DPRINTF(("call to msgrcv(%d, %p, %zu, %ld, %d)\n", uap->msqid,
1309             uap->msgp, uap->msgsz, uap->msgtyp, uap->msgflg));
1310
1311         if ((error = kern_msgrcv(td, uap->msqid,
1312             (char *)uap->msgp + sizeof(mtype), uap->msgsz,
1313             uap->msgtyp, uap->msgflg, &mtype)) != 0)
1314                 return (error);
1315         if ((error = copyout(&mtype, uap->msgp, sizeof(mtype))) != 0)
1316                 DPRINTF(("error %d copying the message type\n", error));
1317         return (error);
1318 }
1319
1320 static int
1321 sysctl_msqids(SYSCTL_HANDLER_ARGS)
1322 {
1323
1324         return (SYSCTL_OUT(req, msqids,
1325             sizeof(struct msqid_kernel) * msginfo.msgmni));
1326 }
1327
1328 SYSCTL_INT(_kern_ipc, OID_AUTO, msgmax, CTLFLAG_RD, &msginfo.msgmax, 0,
1329     "Maximum message size");
1330 SYSCTL_INT(_kern_ipc, OID_AUTO, msgmni, CTLFLAG_RDTUN, &msginfo.msgmni, 0,
1331     "Number of message queue identifiers");
1332 SYSCTL_INT(_kern_ipc, OID_AUTO, msgmnb, CTLFLAG_RDTUN, &msginfo.msgmnb, 0,
1333     "Maximum number of bytes in a queue");
1334 SYSCTL_INT(_kern_ipc, OID_AUTO, msgtql, CTLFLAG_RDTUN, &msginfo.msgtql, 0,
1335     "Maximum number of messages in the system");
1336 SYSCTL_INT(_kern_ipc, OID_AUTO, msgssz, CTLFLAG_RDTUN, &msginfo.msgssz, 0,
1337     "Size of a message segment");
1338 SYSCTL_INT(_kern_ipc, OID_AUTO, msgseg, CTLFLAG_RDTUN, &msginfo.msgseg, 0,
1339     "Number of message segments");
1340 SYSCTL_PROC(_kern_ipc, OID_AUTO, msqids, CTLTYPE_OPAQUE | CTLFLAG_RD,
1341     NULL, 0, sysctl_msqids, "", "Message queue IDs");
1342
1343 #ifdef COMPAT_FREEBSD32
1344 int
1345 freebsd32_msgsys(struct thread *td, struct freebsd32_msgsys_args *uap)
1346 {
1347
1348 #if defined(COMPAT_FREEBSD4) || defined(COMPAT_FREEBSD5) || \
1349     defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD7)
1350         switch (uap->which) {
1351         case 0:
1352                 return (freebsd7_freebsd32_msgctl(td,
1353                     (struct freebsd7_freebsd32_msgctl_args *)&uap->a2));
1354         case 2:
1355                 return (freebsd32_msgsnd(td,
1356                     (struct freebsd32_msgsnd_args *)&uap->a2));
1357         case 3:
1358                 return (freebsd32_msgrcv(td,
1359                     (struct freebsd32_msgrcv_args *)&uap->a2));
1360         default:
1361                 return (sys_msgsys(td, (struct msgsys_args *)uap));
1362         }
1363 #else
1364         return (nosys(td, NULL));
1365 #endif
1366 }
1367
1368 #if defined(COMPAT_FREEBSD4) || defined(COMPAT_FREEBSD5) || \
1369     defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD7)
1370 int
1371 freebsd7_freebsd32_msgctl(struct thread *td,
1372     struct freebsd7_freebsd32_msgctl_args *uap)
1373 {
1374         struct msqid_ds msqbuf;
1375         struct msqid_ds32_old msqbuf32;
1376         int error;
1377
1378         if (uap->cmd == IPC_SET) {
1379                 error = copyin(uap->buf, &msqbuf32, sizeof(msqbuf32));
1380                 if (error)
1381                         return (error);
1382                 freebsd32_ipcperm_old_in(&msqbuf32.msg_perm, &msqbuf.msg_perm);
1383                 PTRIN_CP(msqbuf32, msqbuf, msg_first);
1384                 PTRIN_CP(msqbuf32, msqbuf, msg_last);
1385                 CP(msqbuf32, msqbuf, msg_cbytes);
1386                 CP(msqbuf32, msqbuf, msg_qnum);
1387                 CP(msqbuf32, msqbuf, msg_qbytes);
1388                 CP(msqbuf32, msqbuf, msg_lspid);
1389                 CP(msqbuf32, msqbuf, msg_lrpid);
1390                 CP(msqbuf32, msqbuf, msg_stime);
1391                 CP(msqbuf32, msqbuf, msg_rtime);
1392                 CP(msqbuf32, msqbuf, msg_ctime);
1393         }
1394         error = kern_msgctl(td, uap->msqid, uap->cmd, &msqbuf);
1395         if (error)
1396                 return (error);
1397         if (uap->cmd == IPC_STAT) {
1398                 bzero(&msqbuf32, sizeof(msqbuf32));
1399                 freebsd32_ipcperm_old_out(&msqbuf.msg_perm, &msqbuf32.msg_perm);
1400                 PTROUT_CP(msqbuf, msqbuf32, msg_first);
1401                 PTROUT_CP(msqbuf, msqbuf32, msg_last);
1402                 CP(msqbuf, msqbuf32, msg_cbytes);
1403                 CP(msqbuf, msqbuf32, msg_qnum);
1404                 CP(msqbuf, msqbuf32, msg_qbytes);
1405                 CP(msqbuf, msqbuf32, msg_lspid);
1406                 CP(msqbuf, msqbuf32, msg_lrpid);
1407                 CP(msqbuf, msqbuf32, msg_stime);
1408                 CP(msqbuf, msqbuf32, msg_rtime);
1409                 CP(msqbuf, msqbuf32, msg_ctime);
1410                 error = copyout(&msqbuf32, uap->buf, sizeof(struct msqid_ds32));
1411         }
1412         return (error);
1413 }
1414 #endif
1415
1416 int
1417 freebsd32_msgctl(struct thread *td, struct freebsd32_msgctl_args *uap)
1418 {
1419         struct msqid_ds msqbuf;
1420         struct msqid_ds32 msqbuf32;
1421         int error;
1422
1423         if (uap->cmd == IPC_SET) {
1424                 error = copyin(uap->buf, &msqbuf32, sizeof(msqbuf32));
1425                 if (error)
1426                         return (error);
1427                 freebsd32_ipcperm_in(&msqbuf32.msg_perm, &msqbuf.msg_perm);
1428                 PTRIN_CP(msqbuf32, msqbuf, msg_first);
1429                 PTRIN_CP(msqbuf32, msqbuf, msg_last);
1430                 CP(msqbuf32, msqbuf, msg_cbytes);
1431                 CP(msqbuf32, msqbuf, msg_qnum);
1432                 CP(msqbuf32, msqbuf, msg_qbytes);
1433                 CP(msqbuf32, msqbuf, msg_lspid);
1434                 CP(msqbuf32, msqbuf, msg_lrpid);
1435                 CP(msqbuf32, msqbuf, msg_stime);
1436                 CP(msqbuf32, msqbuf, msg_rtime);
1437                 CP(msqbuf32, msqbuf, msg_ctime);
1438         }
1439         error = kern_msgctl(td, uap->msqid, uap->cmd, &msqbuf);
1440         if (error)
1441                 return (error);
1442         if (uap->cmd == IPC_STAT) {
1443                 freebsd32_ipcperm_out(&msqbuf.msg_perm, &msqbuf32.msg_perm);
1444                 PTROUT_CP(msqbuf, msqbuf32, msg_first);
1445                 PTROUT_CP(msqbuf, msqbuf32, msg_last);
1446                 CP(msqbuf, msqbuf32, msg_cbytes);
1447                 CP(msqbuf, msqbuf32, msg_qnum);
1448                 CP(msqbuf, msqbuf32, msg_qbytes);
1449                 CP(msqbuf, msqbuf32, msg_lspid);
1450                 CP(msqbuf, msqbuf32, msg_lrpid);
1451                 CP(msqbuf, msqbuf32, msg_stime);
1452                 CP(msqbuf, msqbuf32, msg_rtime);
1453                 CP(msqbuf, msqbuf32, msg_ctime);
1454                 error = copyout(&msqbuf32, uap->buf, sizeof(struct msqid_ds32));
1455         }
1456         return (error);
1457 }
1458
1459 int
1460 freebsd32_msgsnd(struct thread *td, struct freebsd32_msgsnd_args *uap)
1461 {
1462         const void *msgp;
1463         long mtype;
1464         int32_t mtype32;
1465         int error;
1466
1467         msgp = PTRIN(uap->msgp);
1468         if ((error = copyin(msgp, &mtype32, sizeof(mtype32))) != 0)
1469                 return (error);
1470         mtype = mtype32;
1471         return (kern_msgsnd(td, uap->msqid,
1472             (const char *)msgp + sizeof(mtype32),
1473             uap->msgsz, uap->msgflg, mtype));
1474 }
1475
1476 int
1477 freebsd32_msgrcv(struct thread *td, struct freebsd32_msgrcv_args *uap)
1478 {
1479         void *msgp;
1480         long mtype;
1481         int32_t mtype32;
1482         int error;
1483
1484         msgp = PTRIN(uap->msgp);
1485         if ((error = kern_msgrcv(td, uap->msqid,
1486             (char *)msgp + sizeof(mtype32), uap->msgsz,
1487             uap->msgtyp, uap->msgflg, &mtype)) != 0)
1488                 return (error);
1489         mtype32 = (int32_t)mtype;
1490         return (copyout(&mtype32, msgp, sizeof(mtype32)));
1491 }
1492 #endif
1493
1494 #if defined(COMPAT_FREEBSD4) || defined(COMPAT_FREEBSD5) || \
1495     defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD7)
1496
1497 /* XXX casting to (sy_call_t *) is bogus, as usual. */
1498 static sy_call_t *msgcalls[] = {
1499         (sy_call_t *)freebsd7_msgctl, (sy_call_t *)sys_msgget,
1500         (sy_call_t *)sys_msgsnd, (sy_call_t *)sys_msgrcv
1501 };
1502
1503 /*
1504  * Entry point for all MSG calls.
1505  */
1506 int
1507 sys_msgsys(td, uap)
1508         struct thread *td;
1509         /* XXX actually varargs. */
1510         struct msgsys_args /* {
1511                 int     which;
1512                 int     a2;
1513                 int     a3;
1514                 int     a4;
1515                 int     a5;
1516                 int     a6;
1517         } */ *uap;
1518 {
1519         int error;
1520
1521         if (!prison_allow(td->td_ucred, PR_ALLOW_SYSVIPC))
1522                 return (ENOSYS);
1523         if (uap->which < 0 ||
1524             uap->which >= sizeof(msgcalls)/sizeof(msgcalls[0]))
1525                 return (EINVAL);
1526         error = (*msgcalls[uap->which])(td, &uap->a2);
1527         return (error);
1528 }
1529
1530 #ifndef CP
1531 #define CP(src, dst, fld)       do { (dst).fld = (src).fld; } while (0)
1532 #endif
1533
1534 #ifndef _SYS_SYSPROTO_H_
1535 struct freebsd7_msgctl_args {
1536         int     msqid;
1537         int     cmd;
1538         struct  msqid_ds_old *buf;
1539 };
1540 #endif
1541 int
1542 freebsd7_msgctl(td, uap)
1543         struct thread *td;
1544         struct freebsd7_msgctl_args *uap;
1545 {
1546         struct msqid_ds_old msqold;
1547         struct msqid_ds msqbuf;
1548         int error;
1549
1550         DPRINTF(("call to freebsd7_msgctl(%d, %d, %p)\n", uap->msqid, uap->cmd,
1551             uap->buf));
1552         if (uap->cmd == IPC_SET) {
1553                 error = copyin(uap->buf, &msqold, sizeof(msqold));
1554                 if (error)
1555                         return (error);
1556                 ipcperm_old2new(&msqold.msg_perm, &msqbuf.msg_perm);
1557                 CP(msqold, msqbuf, msg_first);
1558                 CP(msqold, msqbuf, msg_last);
1559                 CP(msqold, msqbuf, msg_cbytes);
1560                 CP(msqold, msqbuf, msg_qnum);
1561                 CP(msqold, msqbuf, msg_qbytes);
1562                 CP(msqold, msqbuf, msg_lspid);
1563                 CP(msqold, msqbuf, msg_lrpid);
1564                 CP(msqold, msqbuf, msg_stime);
1565                 CP(msqold, msqbuf, msg_rtime);
1566                 CP(msqold, msqbuf, msg_ctime);
1567         }
1568         error = kern_msgctl(td, uap->msqid, uap->cmd, &msqbuf);
1569         if (error)
1570                 return (error);
1571         if (uap->cmd == IPC_STAT) {
1572                 bzero(&msqold, sizeof(msqold));
1573                 ipcperm_new2old(&msqbuf.msg_perm, &msqold.msg_perm);
1574                 CP(msqbuf, msqold, msg_first);
1575                 CP(msqbuf, msqold, msg_last);
1576                 CP(msqbuf, msqold, msg_cbytes);
1577                 CP(msqbuf, msqold, msg_qnum);
1578                 CP(msqbuf, msqold, msg_qbytes);
1579                 CP(msqbuf, msqold, msg_lspid);
1580                 CP(msqbuf, msqold, msg_lrpid);
1581                 CP(msqbuf, msqold, msg_stime);
1582                 CP(msqbuf, msqold, msg_rtime);
1583                 CP(msqbuf, msqold, msg_ctime);
1584                 error = copyout(&msqold, uap->buf, sizeof(struct msqid_ds_old));
1585         }
1586         return (error);
1587 }
1588
1589 #undef CP
1590
1591 #endif  /* COMPAT_FREEBSD4 || COMPAT_FREEBSD5 || COMPAT_FREEBSD6 ||
1592            COMPAT_FREEBSD7 */