sysv_msg.c revision 1.41 1 1.41 cube /* $NetBSD: sysv_msg.c,v 1.41 2006/03/06 14:24:13 cube Exp $ */
2 1.26 thorpej
3 1.26 thorpej /*-
4 1.26 thorpej * Copyright (c) 1999 The NetBSD Foundation, Inc.
5 1.26 thorpej * All rights reserved.
6 1.26 thorpej *
7 1.26 thorpej * This code is derived from software contributed to The NetBSD Foundation
8 1.26 thorpej * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
9 1.26 thorpej * NASA Ames Research Center.
10 1.26 thorpej *
11 1.26 thorpej * Redistribution and use in source and binary forms, with or without
12 1.26 thorpej * modification, are permitted provided that the following conditions
13 1.26 thorpej * are met:
14 1.26 thorpej * 1. Redistributions of source code must retain the above copyright
15 1.26 thorpej * notice, this list of conditions and the following disclaimer.
16 1.26 thorpej * 2. Redistributions in binary form must reproduce the above copyright
17 1.26 thorpej * notice, this list of conditions and the following disclaimer in the
18 1.26 thorpej * documentation and/or other materials provided with the distribution.
19 1.26 thorpej * 3. All advertising materials mentioning features or use of this software
20 1.26 thorpej * must display the following acknowledgement:
21 1.26 thorpej * This product includes software developed by the NetBSD
22 1.26 thorpej * Foundation, Inc. and its contributors.
23 1.26 thorpej * 4. Neither the name of The NetBSD Foundation nor the names of its
24 1.26 thorpej * contributors may be used to endorse or promote products derived
25 1.26 thorpej * from this software without specific prior written permission.
26 1.26 thorpej *
27 1.26 thorpej * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
28 1.26 thorpej * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
29 1.26 thorpej * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
30 1.26 thorpej * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
31 1.26 thorpej * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
32 1.26 thorpej * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
33 1.26 thorpej * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
34 1.26 thorpej * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
35 1.26 thorpej * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
36 1.26 thorpej * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37 1.26 thorpej * POSSIBILITY OF SUCH DAMAGE.
38 1.26 thorpej */
39 1.9 cgd
40 1.1 cgd /*
41 1.1 cgd * Implementation of SVID messages
42 1.1 cgd *
43 1.26 thorpej * Author: Daniel Boulet
44 1.1 cgd *
45 1.1 cgd * Copyright 1993 Daniel Boulet and RTMX Inc.
46 1.1 cgd *
47 1.1 cgd * This system call was implemented by Daniel Boulet under contract from RTMX.
48 1.1 cgd *
49 1.1 cgd * Redistribution and use in source forms, with and without modification,
50 1.1 cgd * are permitted provided that this entire comment appears intact.
51 1.1 cgd *
52 1.1 cgd * Redistribution in binary form may occur without any restrictions.
53 1.1 cgd * Obviously, it would be nice if you gave credit where credit is due
54 1.1 cgd * but requiring it would be too onerous.
55 1.1 cgd *
56 1.1 cgd * This software is provided ``AS IS'' without any warranties of any kind.
57 1.1 cgd */
58 1.33 lukem
59 1.33 lukem #include <sys/cdefs.h>
60 1.41 cube __KERNEL_RCSID(0, "$NetBSD: sysv_msg.c,v 1.41 2006/03/06 14:24:13 cube Exp $");
61 1.23 tron
62 1.24 tron #define SYSVMSG
63 1.1 cgd
64 1.2 mycroft #include <sys/param.h>
65 1.2 mycroft #include <sys/kernel.h>
66 1.2 mycroft #include <sys/msg.h>
67 1.29 simonb #include <sys/sysctl.h>
68 1.29 simonb #include <sys/mount.h> /* XXX for <sys/syscallargs.h> */
69 1.35 thorpej #include <sys/sa.h>
70 1.10 cgd #include <sys/syscallargs.h>
71 1.18 christos
72 1.1 cgd #define MSG_DEBUG
73 1.1 cgd #undef MSG_DEBUG_OK
74 1.1 cgd
75 1.20 christos #ifdef MSG_DEBUG_OK
76 1.21 christos #define MSG_PRINTF(a) printf a
77 1.20 christos #else
78 1.20 christos #define MSG_PRINTF(a)
79 1.20 christos #endif
80 1.20 christos
81 1.36 jdolecek static int nfree_msgmaps; /* # of free map entries */
82 1.36 jdolecek static short free_msgmaps; /* head of linked list of free map entries */
83 1.36 jdolecek static struct __msg *free_msghdrs; /* list of free msg headers */
84 1.36 jdolecek static char *msgpool; /* MSGMAX byte long msg buffer pool */
85 1.36 jdolecek static struct msgmap *msgmaps; /* MSGSEG msgmap structures */
86 1.36 jdolecek static struct __msg *msghdrs; /* MSGTQL msg headers */
87 1.36 jdolecek struct msqid_ds *msqids; /* MSGMNI msqid_ds struct's */
88 1.1 cgd
89 1.37 junyoung static void msg_freehdr(struct __msg *);
90 1.18 christos
91 1.18 christos void
92 1.40 thorpej msginit(void)
93 1.1 cgd {
94 1.36 jdolecek int i, sz;
95 1.36 jdolecek vaddr_t v;
96 1.1 cgd
97 1.3 mycroft /*
98 1.3 mycroft * msginfo.msgssz should be a power of two for efficiency reasons.
99 1.3 mycroft * It is also pretty silly if msginfo.msgssz is less than 8
100 1.3 mycroft * or greater than about 256 so ...
101 1.3 mycroft */
102 1.1 cgd
103 1.3 mycroft i = 8;
104 1.3 mycroft while (i < 1024 && i != msginfo.msgssz)
105 1.3 mycroft i <<= 1;
106 1.3 mycroft if (i != msginfo.msgssz) {
107 1.20 christos MSG_PRINTF(("msginfo.msgssz=%d (0x%x)\n", msginfo.msgssz,
108 1.20 christos msginfo.msgssz));
109 1.3 mycroft panic("msginfo.msgssz not a small power of 2");
110 1.3 mycroft }
111 1.3 mycroft
112 1.3 mycroft if (msginfo.msgseg > 32767) {
113 1.20 christos MSG_PRINTF(("msginfo.msgseg=%d\n", msginfo.msgseg));
114 1.3 mycroft panic("msginfo.msgseg > 32767");
115 1.3 mycroft }
116 1.3 mycroft
117 1.36 jdolecek /* Allocate pageable memory for our structures */
118 1.36 jdolecek sz = msginfo.msgmax
119 1.36 jdolecek + msginfo.msgseg * sizeof(struct msgmap)
120 1.36 jdolecek + msginfo.msgtql * sizeof(struct __msg)
121 1.36 jdolecek + msginfo.msgmni * sizeof(struct msqid_ds);
122 1.39 yamt v = uvm_km_alloc(kernel_map, round_page(sz), 0,
123 1.39 yamt UVM_KMF_WIRED|UVM_KMF_ZERO);
124 1.39 yamt if (v == 0)
125 1.36 jdolecek panic("sysv_msg: cannot allocate memory");
126 1.36 jdolecek msgpool = (void *)v;
127 1.36 jdolecek msgmaps = (void *) (msgpool + msginfo.msgmax);
128 1.36 jdolecek msghdrs = (void *) (msgmaps + msginfo.msgseg);
129 1.36 jdolecek msqids = (void *) (msghdrs + msginfo.msgtql);
130 1.3 mycroft
131 1.3 mycroft for (i = 0; i < msginfo.msgseg; i++) {
132 1.3 mycroft if (i > 0)
133 1.3 mycroft msgmaps[i-1].next = i;
134 1.3 mycroft msgmaps[i].next = -1; /* implies entry is available */
135 1.3 mycroft }
136 1.3 mycroft free_msgmaps = 0;
137 1.3 mycroft nfree_msgmaps = msginfo.msgseg;
138 1.3 mycroft
139 1.3 mycroft if (msghdrs == NULL)
140 1.3 mycroft panic("msghdrs is NULL");
141 1.3 mycroft
142 1.3 mycroft for (i = 0; i < msginfo.msgtql; i++) {
143 1.3 mycroft msghdrs[i].msg_type = 0;
144 1.3 mycroft if (i > 0)
145 1.3 mycroft msghdrs[i-1].msg_next = &msghdrs[i];
146 1.3 mycroft msghdrs[i].msg_next = NULL;
147 1.3 mycroft }
148 1.3 mycroft free_msghdrs = &msghdrs[0];
149 1.3 mycroft
150 1.3 mycroft if (msqids == NULL)
151 1.3 mycroft panic("msqids is NULL");
152 1.3 mycroft
153 1.4 mycroft for (i = 0; i < msginfo.msgmni; i++) {
154 1.3 mycroft msqids[i].msg_qbytes = 0; /* implies entry is available */
155 1.26 thorpej msqids[i].msg_perm._seq = 0; /* reset to a known value */
156 1.3 mycroft }
157 1.1 cgd }
158 1.1 cgd
159 1.3 mycroft static void
160 1.40 thorpej msg_freehdr(struct __msg *msghdr)
161 1.1 cgd {
162 1.3 mycroft while (msghdr->msg_ts > 0) {
163 1.3 mycroft short next;
164 1.3 mycroft if (msghdr->msg_spot < 0 || msghdr->msg_spot >= msginfo.msgseg)
165 1.3 mycroft panic("msghdr->msg_spot out of range");
166 1.3 mycroft next = msgmaps[msghdr->msg_spot].next;
167 1.3 mycroft msgmaps[msghdr->msg_spot].next = free_msgmaps;
168 1.3 mycroft free_msgmaps = msghdr->msg_spot;
169 1.5 mycroft nfree_msgmaps++;
170 1.3 mycroft msghdr->msg_spot = next;
171 1.3 mycroft if (msghdr->msg_ts >= msginfo.msgssz)
172 1.3 mycroft msghdr->msg_ts -= msginfo.msgssz;
173 1.3 mycroft else
174 1.3 mycroft msghdr->msg_ts = 0;
175 1.3 mycroft }
176 1.3 mycroft if (msghdr->msg_spot != -1)
177 1.3 mycroft panic("msghdr->msg_spot != -1");
178 1.3 mycroft msghdr->msg_next = free_msghdrs;
179 1.3 mycroft free_msghdrs = msghdr;
180 1.1 cgd }
181 1.1 cgd
182 1.1 cgd int
183 1.40 thorpej sys___msgctl13(struct lwp *l, void *v, register_t *retval)
184 1.16 thorpej {
185 1.26 thorpej struct sys___msgctl13_args /* {
186 1.10 cgd syscallarg(int) msqid;
187 1.10 cgd syscallarg(int) cmd;
188 1.10 cgd syscallarg(struct msqid_ds *) buf;
189 1.16 thorpej } */ *uap = v;
190 1.35 thorpej struct proc *p = l->l_proc;
191 1.26 thorpej struct msqid_ds msqbuf;
192 1.26 thorpej int cmd, error;
193 1.26 thorpej
194 1.26 thorpej cmd = SCARG(uap, cmd);
195 1.26 thorpej
196 1.26 thorpej if (cmd == IPC_SET) {
197 1.26 thorpej error = copyin(SCARG(uap, buf), &msqbuf, sizeof(msqbuf));
198 1.26 thorpej if (error)
199 1.26 thorpej return (error);
200 1.26 thorpej }
201 1.26 thorpej
202 1.26 thorpej error = msgctl1(p, SCARG(uap, msqid), cmd,
203 1.26 thorpej (cmd == IPC_SET || cmd == IPC_STAT) ? &msqbuf : NULL);
204 1.26 thorpej
205 1.26 thorpej if (error == 0 && cmd == IPC_STAT)
206 1.26 thorpej error = copyout(&msqbuf, SCARG(uap, buf), sizeof(msqbuf));
207 1.26 thorpej
208 1.26 thorpej return (error);
209 1.26 thorpej }
210 1.26 thorpej
211 1.26 thorpej int
212 1.40 thorpej msgctl1(struct proc *p, int msqid, int cmd, struct msqid_ds *msqbuf)
213 1.26 thorpej {
214 1.3 mycroft struct ucred *cred = p->p_ucred;
215 1.26 thorpej struct msqid_ds *msqptr;
216 1.26 thorpej int error = 0, ix;
217 1.1 cgd
218 1.26 thorpej MSG_PRINTF(("call to msgctl1(%d, %d)\n", msqid, cmd));
219 1.1 cgd
220 1.26 thorpej ix = IPCID_TO_IX(msqid);
221 1.1 cgd
222 1.26 thorpej if (ix < 0 || ix >= msginfo.msgmni) {
223 1.26 thorpej MSG_PRINTF(("msqid (%d) out of range (0<=msqid<%d)\n", ix,
224 1.20 christos msginfo.msgmni));
225 1.26 thorpej return (EINVAL);
226 1.3 mycroft }
227 1.1 cgd
228 1.26 thorpej msqptr = &msqids[ix];
229 1.1 cgd
230 1.3 mycroft if (msqptr->msg_qbytes == 0) {
231 1.20 christos MSG_PRINTF(("no such msqid\n"));
232 1.26 thorpej return (EINVAL);
233 1.3 mycroft }
234 1.26 thorpej if (msqptr->msg_perm._seq != IPCID_TO_SEQ(msqid)) {
235 1.20 christos MSG_PRINTF(("wrong sequence number\n"));
236 1.26 thorpej return (EINVAL);
237 1.3 mycroft }
238 1.1 cgd
239 1.3 mycroft switch (cmd) {
240 1.3 mycroft case IPC_RMID:
241 1.1 cgd {
242 1.26 thorpej struct __msg *msghdr;
243 1.26 thorpej if ((error = ipcperm(cred, &msqptr->msg_perm, IPC_M)) != 0)
244 1.26 thorpej return (error);
245 1.3 mycroft /* Free the message headers */
246 1.26 thorpej msghdr = msqptr->_msg_first;
247 1.3 mycroft while (msghdr != NULL) {
248 1.26 thorpej struct __msg *msghdr_tmp;
249 1.3 mycroft
250 1.3 mycroft /* Free the segments of each message */
251 1.26 thorpej msqptr->_msg_cbytes -= msghdr->msg_ts;
252 1.5 mycroft msqptr->msg_qnum--;
253 1.3 mycroft msghdr_tmp = msghdr;
254 1.3 mycroft msghdr = msghdr->msg_next;
255 1.3 mycroft msg_freehdr(msghdr_tmp);
256 1.3 mycroft }
257 1.1 cgd
258 1.26 thorpej if (msqptr->_msg_cbytes != 0)
259 1.3 mycroft panic("msg_cbytes is screwed up");
260 1.3 mycroft if (msqptr->msg_qnum != 0)
261 1.3 mycroft panic("msg_qnum is screwed up");
262 1.1 cgd
263 1.3 mycroft msqptr->msg_qbytes = 0; /* Mark it as free */
264 1.1 cgd
265 1.26 thorpej wakeup(msqptr);
266 1.1 cgd }
267 1.3 mycroft break;
268 1.1 cgd
269 1.3 mycroft case IPC_SET:
270 1.26 thorpej if ((error = ipcperm(cred, &msqptr->msg_perm, IPC_M)))
271 1.26 thorpej return (error);
272 1.26 thorpej if (msqbuf->msg_qbytes > msqptr->msg_qbytes && cred->cr_uid != 0)
273 1.26 thorpej return (EPERM);
274 1.26 thorpej if (msqbuf->msg_qbytes > msginfo.msgmnb) {
275 1.26 thorpej MSG_PRINTF(("can't increase msg_qbytes beyond %d "
276 1.26 thorpej "(truncating)\n", msginfo.msgmnb));
277 1.26 thorpej /* silently restrict qbytes to system limit */
278 1.26 thorpej msqbuf->msg_qbytes = msginfo.msgmnb;
279 1.3 mycroft }
280 1.26 thorpej if (msqbuf->msg_qbytes == 0) {
281 1.20 christos MSG_PRINTF(("can't reduce msg_qbytes to 0\n"));
282 1.26 thorpej return (EINVAL); /* XXX non-standard errno! */
283 1.3 mycroft }
284 1.26 thorpej msqptr->msg_perm.uid = msqbuf->msg_perm.uid;
285 1.26 thorpej msqptr->msg_perm.gid = msqbuf->msg_perm.gid;
286 1.3 mycroft msqptr->msg_perm.mode = (msqptr->msg_perm.mode & ~0777) |
287 1.26 thorpej (msqbuf->msg_perm.mode & 0777);
288 1.26 thorpej msqptr->msg_qbytes = msqbuf->msg_qbytes;
289 1.3 mycroft msqptr->msg_ctime = time.tv_sec;
290 1.3 mycroft break;
291 1.1 cgd
292 1.3 mycroft case IPC_STAT:
293 1.26 thorpej if ((error = ipcperm(cred, &msqptr->msg_perm, IPC_R))) {
294 1.20 christos MSG_PRINTF(("requester doesn't have read access\n"));
295 1.26 thorpej return (error);
296 1.3 mycroft }
297 1.26 thorpej memcpy(msqbuf, msqptr, sizeof(struct msqid_ds));
298 1.3 mycroft break;
299 1.1 cgd
300 1.3 mycroft default:
301 1.20 christos MSG_PRINTF(("invalid command %d\n", cmd));
302 1.26 thorpej return (EINVAL);
303 1.3 mycroft }
304 1.3 mycroft
305 1.26 thorpej return (error);
306 1.1 cgd }
307 1.1 cgd
308 1.1 cgd int
309 1.40 thorpej sys_msgget(struct lwp *l, void *v, register_t *retval)
310 1.16 thorpej {
311 1.26 thorpej struct sys_msgget_args /* {
312 1.10 cgd syscallarg(key_t) key;
313 1.10 cgd syscallarg(int) msgflg;
314 1.16 thorpej } */ *uap = v;
315 1.35 thorpej struct proc *p = l->l_proc;
316 1.26 thorpej int msqid, error;
317 1.10 cgd int key = SCARG(uap, key);
318 1.10 cgd int msgflg = SCARG(uap, msgflg);
319 1.3 mycroft struct ucred *cred = p->p_ucred;
320 1.26 thorpej struct msqid_ds *msqptr = NULL;
321 1.1 cgd
322 1.20 christos MSG_PRINTF(("msgget(0x%x, 0%o)\n", key, msgflg));
323 1.1 cgd
324 1.5 mycroft if (key != IPC_PRIVATE) {
325 1.5 mycroft for (msqid = 0; msqid < msginfo.msgmni; msqid++) {
326 1.3 mycroft msqptr = &msqids[msqid];
327 1.3 mycroft if (msqptr->msg_qbytes != 0 &&
328 1.26 thorpej msqptr->msg_perm._key == key)
329 1.3 mycroft break;
330 1.3 mycroft }
331 1.3 mycroft if (msqid < msginfo.msgmni) {
332 1.20 christos MSG_PRINTF(("found public key\n"));
333 1.3 mycroft if ((msgflg & IPC_CREAT) && (msgflg & IPC_EXCL)) {
334 1.20 christos MSG_PRINTF(("not exclusive\n"));
335 1.3 mycroft return(EEXIST);
336 1.3 mycroft }
337 1.26 thorpej if ((error = ipcperm(cred, &msqptr->msg_perm,
338 1.26 thorpej msgflg & 0700 ))) {
339 1.20 christos MSG_PRINTF(("requester doesn't have 0%o access\n",
340 1.20 christos msgflg & 0700));
341 1.26 thorpej return (error);
342 1.3 mycroft }
343 1.5 mycroft goto found;
344 1.3 mycroft }
345 1.1 cgd }
346 1.1 cgd
347 1.20 christos MSG_PRINTF(("need to allocate the msqid_ds\n"));
348 1.5 mycroft if (key == IPC_PRIVATE || (msgflg & IPC_CREAT)) {
349 1.5 mycroft for (msqid = 0; msqid < msginfo.msgmni; msqid++) {
350 1.5 mycroft /*
351 1.5 mycroft * Look for an unallocated and unlocked msqid_ds.
352 1.5 mycroft * msqid_ds's can be locked by msgsnd or msgrcv while
353 1.5 mycroft * they are copying the message in/out. We can't
354 1.5 mycroft * re-use the entry until they release it.
355 1.5 mycroft */
356 1.5 mycroft msqptr = &msqids[msqid];
357 1.5 mycroft if (msqptr->msg_qbytes == 0 &&
358 1.5 mycroft (msqptr->msg_perm.mode & MSG_LOCKED) == 0)
359 1.5 mycroft break;
360 1.5 mycroft }
361 1.5 mycroft if (msqid == msginfo.msgmni) {
362 1.20 christos MSG_PRINTF(("no more msqid_ds's available\n"));
363 1.38 perry return (ENOSPC);
364 1.5 mycroft }
365 1.20 christos MSG_PRINTF(("msqid %d is available\n", msqid));
366 1.26 thorpej msqptr->msg_perm._key = key;
367 1.5 mycroft msqptr->msg_perm.cuid = cred->cr_uid;
368 1.5 mycroft msqptr->msg_perm.uid = cred->cr_uid;
369 1.5 mycroft msqptr->msg_perm.cgid = cred->cr_gid;
370 1.5 mycroft msqptr->msg_perm.gid = cred->cr_gid;
371 1.5 mycroft msqptr->msg_perm.mode = (msgflg & 0777);
372 1.5 mycroft /* Make sure that the returned msqid is unique */
373 1.26 thorpej msqptr->msg_perm._seq++;
374 1.26 thorpej msqptr->_msg_first = NULL;
375 1.26 thorpej msqptr->_msg_last = NULL;
376 1.26 thorpej msqptr->_msg_cbytes = 0;
377 1.5 mycroft msqptr->msg_qnum = 0;
378 1.5 mycroft msqptr->msg_qbytes = msginfo.msgmnb;
379 1.5 mycroft msqptr->msg_lspid = 0;
380 1.5 mycroft msqptr->msg_lrpid = 0;
381 1.5 mycroft msqptr->msg_stime = 0;
382 1.5 mycroft msqptr->msg_rtime = 0;
383 1.5 mycroft msqptr->msg_ctime = time.tv_sec;
384 1.5 mycroft } else {
385 1.20 christos MSG_PRINTF(("didn't find it and wasn't asked to create it\n"));
386 1.26 thorpej return (ENOENT);
387 1.1 cgd }
388 1.1 cgd
389 1.26 thorpej found:
390 1.3 mycroft /* Construct the unique msqid */
391 1.3 mycroft *retval = IXSEQ_TO_IPCID(msqid, msqptr->msg_perm);
392 1.26 thorpej return (0);
393 1.1 cgd }
394 1.1 cgd
395 1.1 cgd int
396 1.40 thorpej sys_msgsnd(struct lwp *l, void *v, register_t *retval)
397 1.16 thorpej {
398 1.26 thorpej struct sys_msgsnd_args /* {
399 1.10 cgd syscallarg(int) msqid;
400 1.22 kleink syscallarg(const void *) msgp;
401 1.10 cgd syscallarg(size_t) msgsz;
402 1.10 cgd syscallarg(int) msgflg;
403 1.16 thorpej } */ *uap = v;
404 1.41 cube
405 1.41 cube return msgsnd1(l->l_proc, SCARG(uap, msqid), SCARG(uap, msgp),
406 1.41 cube SCARG(uap, msgsz), SCARG(uap, msgflg), sizeof(long), copyin);
407 1.41 cube }
408 1.41 cube
409 1.41 cube int
410 1.41 cube msgsnd1(struct proc *p, int msqidr, const char *user_msgp, size_t msgsz,
411 1.41 cube int msgflg, size_t typesz, copyin_t fetch_type)
412 1.41 cube {
413 1.41 cube int segs_needed, error, msqid;
414 1.3 mycroft struct ucred *cred = p->p_ucred;
415 1.26 thorpej struct msqid_ds *msqptr;
416 1.26 thorpej struct __msg *msghdr;
417 1.3 mycroft short next;
418 1.1 cgd
419 1.34 nathanw MSG_PRINTF(("call to msgsnd(%d, %p, %lld, %d)\n", msqid, user_msgp,
420 1.34 nathanw (long long)msgsz, msgflg));
421 1.1 cgd
422 1.41 cube msqid = IPCID_TO_IX(msqidr);
423 1.1 cgd
424 1.3 mycroft if (msqid < 0 || msqid >= msginfo.msgmni) {
425 1.20 christos MSG_PRINTF(("msqid (%d) out of range (0<=msqid<%d)\n", msqid,
426 1.20 christos msginfo.msgmni));
427 1.26 thorpej return (EINVAL);
428 1.3 mycroft }
429 1.1 cgd
430 1.3 mycroft msqptr = &msqids[msqid];
431 1.3 mycroft if (msqptr->msg_qbytes == 0) {
432 1.20 christos MSG_PRINTF(("no such message queue id\n"));
433 1.26 thorpej return (EINVAL);
434 1.3 mycroft }
435 1.41 cube if (msqptr->msg_perm._seq != IPCID_TO_SEQ(msqidr)) {
436 1.20 christos MSG_PRINTF(("wrong sequence number\n"));
437 1.26 thorpej return (EINVAL);
438 1.3 mycroft }
439 1.1 cgd
440 1.26 thorpej if ((error = ipcperm(cred, &msqptr->msg_perm, IPC_W))) {
441 1.20 christos MSG_PRINTF(("requester doesn't have write access\n"));
442 1.26 thorpej return (error);
443 1.3 mycroft }
444 1.1 cgd
445 1.3 mycroft segs_needed = (msgsz + msginfo.msgssz - 1) / msginfo.msgssz;
446 1.34 nathanw MSG_PRINTF(("msgsz=%lld, msgssz=%d, segs_needed=%d\n",
447 1.34 nathanw (long long)msgsz, msginfo.msgssz, segs_needed));
448 1.3 mycroft for (;;) {
449 1.3 mycroft int need_more_resources = 0;
450 1.1 cgd
451 1.3 mycroft /*
452 1.18 christos * check msgsz [cannot be negative since it is unsigned]
453 1.3 mycroft * (inside this loop in case msg_qbytes changes while we sleep)
454 1.3 mycroft */
455 1.1 cgd
456 1.18 christos if (msgsz > msqptr->msg_qbytes) {
457 1.20 christos MSG_PRINTF(("msgsz > msqptr->msg_qbytes\n"));
458 1.26 thorpej return (EINVAL);
459 1.3 mycroft }
460 1.1 cgd
461 1.3 mycroft if (msqptr->msg_perm.mode & MSG_LOCKED) {
462 1.20 christos MSG_PRINTF(("msqid is locked\n"));
463 1.3 mycroft need_more_resources = 1;
464 1.3 mycroft }
465 1.26 thorpej if (msgsz + msqptr->_msg_cbytes > msqptr->msg_qbytes) {
466 1.20 christos MSG_PRINTF(("msgsz + msg_cbytes > msg_qbytes\n"));
467 1.3 mycroft need_more_resources = 1;
468 1.3 mycroft }
469 1.3 mycroft if (segs_needed > nfree_msgmaps) {
470 1.20 christos MSG_PRINTF(("segs_needed > nfree_msgmaps\n"));
471 1.3 mycroft need_more_resources = 1;
472 1.3 mycroft }
473 1.3 mycroft if (free_msghdrs == NULL) {
474 1.20 christos MSG_PRINTF(("no more msghdrs\n"));
475 1.3 mycroft need_more_resources = 1;
476 1.3 mycroft }
477 1.1 cgd
478 1.3 mycroft if (need_more_resources) {
479 1.3 mycroft int we_own_it;
480 1.1 cgd
481 1.3 mycroft if ((msgflg & IPC_NOWAIT) != 0) {
482 1.26 thorpej MSG_PRINTF(("need more resources but caller "
483 1.26 thorpej "doesn't want to wait\n"));
484 1.26 thorpej return (EAGAIN);
485 1.3 mycroft }
486 1.1 cgd
487 1.3 mycroft if ((msqptr->msg_perm.mode & MSG_LOCKED) != 0) {
488 1.20 christos MSG_PRINTF(("we don't own the msqid_ds\n"));
489 1.3 mycroft we_own_it = 0;
490 1.3 mycroft } else {
491 1.3 mycroft /* Force later arrivals to wait for our
492 1.3 mycroft request */
493 1.20 christos MSG_PRINTF(("we own the msqid_ds\n"));
494 1.3 mycroft msqptr->msg_perm.mode |= MSG_LOCKED;
495 1.3 mycroft we_own_it = 1;
496 1.3 mycroft }
497 1.20 christos MSG_PRINTF(("goodnight\n"));
498 1.26 thorpej error = tsleep(msqptr, (PZERO - 4) | PCATCH,
499 1.3 mycroft "msgwait", 0);
500 1.26 thorpej MSG_PRINTF(("good morning, error=%d\n", error));
501 1.3 mycroft if (we_own_it)
502 1.3 mycroft msqptr->msg_perm.mode &= ~MSG_LOCKED;
503 1.26 thorpej if (error != 0) {
504 1.26 thorpej MSG_PRINTF(("msgsnd: interrupted system "
505 1.26 thorpej "call\n"));
506 1.26 thorpej return (EINTR);
507 1.3 mycroft }
508 1.1 cgd
509 1.3 mycroft /*
510 1.3 mycroft * Make sure that the msq queue still exists
511 1.3 mycroft */
512 1.1 cgd
513 1.3 mycroft if (msqptr->msg_qbytes == 0) {
514 1.20 christos MSG_PRINTF(("msqid deleted\n"));
515 1.26 thorpej return (EIDRM);
516 1.3 mycroft }
517 1.3 mycroft } else {
518 1.20 christos MSG_PRINTF(("got all the resources that we need\n"));
519 1.3 mycroft break;
520 1.3 mycroft }
521 1.1 cgd }
522 1.1 cgd
523 1.3 mycroft /*
524 1.3 mycroft * We have the resources that we need.
525 1.3 mycroft * Make sure!
526 1.3 mycroft */
527 1.1 cgd
528 1.3 mycroft if (msqptr->msg_perm.mode & MSG_LOCKED)
529 1.3 mycroft panic("msg_perm.mode & MSG_LOCKED");
530 1.3 mycroft if (segs_needed > nfree_msgmaps)
531 1.3 mycroft panic("segs_needed > nfree_msgmaps");
532 1.26 thorpej if (msgsz + msqptr->_msg_cbytes > msqptr->msg_qbytes)
533 1.3 mycroft panic("msgsz + msg_cbytes > msg_qbytes");
534 1.3 mycroft if (free_msghdrs == NULL)
535 1.3 mycroft panic("no more msghdrs");
536 1.1 cgd
537 1.3 mycroft /*
538 1.3 mycroft * Re-lock the msqid_ds in case we page-fault when copying in the
539 1.3 mycroft * message
540 1.3 mycroft */
541 1.1 cgd
542 1.3 mycroft if ((msqptr->msg_perm.mode & MSG_LOCKED) != 0)
543 1.3 mycroft panic("msqid_ds is already locked");
544 1.3 mycroft msqptr->msg_perm.mode |= MSG_LOCKED;
545 1.1 cgd
546 1.3 mycroft /*
547 1.3 mycroft * Allocate a message header
548 1.3 mycroft */
549 1.1 cgd
550 1.3 mycroft msghdr = free_msghdrs;
551 1.3 mycroft free_msghdrs = msghdr->msg_next;
552 1.3 mycroft msghdr->msg_spot = -1;
553 1.3 mycroft msghdr->msg_ts = msgsz;
554 1.1 cgd
555 1.3 mycroft /*
556 1.3 mycroft * Allocate space for the message
557 1.3 mycroft */
558 1.1 cgd
559 1.3 mycroft while (segs_needed > 0) {
560 1.3 mycroft if (nfree_msgmaps <= 0)
561 1.3 mycroft panic("not enough msgmaps");
562 1.3 mycroft if (free_msgmaps == -1)
563 1.3 mycroft panic("nil free_msgmaps");
564 1.3 mycroft next = free_msgmaps;
565 1.3 mycroft if (next <= -1)
566 1.3 mycroft panic("next too low #1");
567 1.3 mycroft if (next >= msginfo.msgseg)
568 1.3 mycroft panic("next out of range #1");
569 1.20 christos MSG_PRINTF(("allocating segment %d to message\n", next));
570 1.3 mycroft free_msgmaps = msgmaps[next].next;
571 1.5 mycroft nfree_msgmaps--;
572 1.3 mycroft msgmaps[next].next = msghdr->msg_spot;
573 1.3 mycroft msghdr->msg_spot = next;
574 1.5 mycroft segs_needed--;
575 1.1 cgd }
576 1.1 cgd
577 1.3 mycroft /*
578 1.3 mycroft * Copy in the message type
579 1.3 mycroft */
580 1.1 cgd
581 1.41 cube if ((error = (*fetch_type)(user_msgp, &msghdr->msg_type,
582 1.41 cube typesz)) != 0) {
583 1.26 thorpej MSG_PRINTF(("error %d copying the message type\n", error));
584 1.3 mycroft msg_freehdr(msghdr);
585 1.3 mycroft msqptr->msg_perm.mode &= ~MSG_LOCKED;
586 1.26 thorpej wakeup(msqptr);
587 1.26 thorpej return (error);
588 1.3 mycroft }
589 1.41 cube user_msgp += typesz;
590 1.1 cgd
591 1.3 mycroft /*
592 1.3 mycroft * Validate the message type
593 1.3 mycroft */
594 1.1 cgd
595 1.3 mycroft if (msghdr->msg_type < 1) {
596 1.3 mycroft msg_freehdr(msghdr);
597 1.3 mycroft msqptr->msg_perm.mode &= ~MSG_LOCKED;
598 1.26 thorpej wakeup(msqptr);
599 1.34 nathanw MSG_PRINTF(("mtype (%ld) < 1\n", msghdr->msg_type));
600 1.26 thorpej return (EINVAL);
601 1.3 mycroft }
602 1.1 cgd
603 1.3 mycroft /*
604 1.3 mycroft * Copy in the message body
605 1.3 mycroft */
606 1.3 mycroft
607 1.3 mycroft next = msghdr->msg_spot;
608 1.3 mycroft while (msgsz > 0) {
609 1.3 mycroft size_t tlen;
610 1.3 mycroft if (msgsz > msginfo.msgssz)
611 1.3 mycroft tlen = msginfo.msgssz;
612 1.3 mycroft else
613 1.3 mycroft tlen = msgsz;
614 1.3 mycroft if (next <= -1)
615 1.3 mycroft panic("next too low #2");
616 1.3 mycroft if (next >= msginfo.msgseg)
617 1.3 mycroft panic("next out of range #2");
618 1.26 thorpej if ((error = copyin(user_msgp, &msgpool[next * msginfo.msgssz],
619 1.3 mycroft tlen)) != 0) {
620 1.26 thorpej MSG_PRINTF(("error %d copying in message segment\n",
621 1.26 thorpej error));
622 1.3 mycroft msg_freehdr(msghdr);
623 1.3 mycroft msqptr->msg_perm.mode &= ~MSG_LOCKED;
624 1.26 thorpej wakeup(msqptr);
625 1.26 thorpej return (error);
626 1.3 mycroft }
627 1.3 mycroft msgsz -= tlen;
628 1.3 mycroft user_msgp += tlen;
629 1.3 mycroft next = msgmaps[next].next;
630 1.1 cgd }
631 1.3 mycroft if (next != -1)
632 1.3 mycroft panic("didn't use all the msg segments");
633 1.1 cgd
634 1.3 mycroft /*
635 1.3 mycroft * We've got the message. Unlock the msqid_ds.
636 1.3 mycroft */
637 1.1 cgd
638 1.3 mycroft msqptr->msg_perm.mode &= ~MSG_LOCKED;
639 1.1 cgd
640 1.3 mycroft /*
641 1.3 mycroft * Make sure that the msqid_ds is still allocated.
642 1.3 mycroft */
643 1.1 cgd
644 1.3 mycroft if (msqptr->msg_qbytes == 0) {
645 1.3 mycroft msg_freehdr(msghdr);
646 1.26 thorpej wakeup(msqptr);
647 1.26 thorpej return (EIDRM);
648 1.3 mycroft }
649 1.3 mycroft
650 1.3 mycroft /*
651 1.3 mycroft * Put the message into the queue
652 1.3 mycroft */
653 1.1 cgd
654 1.26 thorpej if (msqptr->_msg_first == NULL) {
655 1.26 thorpej msqptr->_msg_first = msghdr;
656 1.26 thorpej msqptr->_msg_last = msghdr;
657 1.3 mycroft } else {
658 1.26 thorpej msqptr->_msg_last->msg_next = msghdr;
659 1.26 thorpej msqptr->_msg_last = msghdr;
660 1.3 mycroft }
661 1.26 thorpej msqptr->_msg_last->msg_next = NULL;
662 1.3 mycroft
663 1.26 thorpej msqptr->_msg_cbytes += msghdr->msg_ts;
664 1.5 mycroft msqptr->msg_qnum++;
665 1.3 mycroft msqptr->msg_lspid = p->p_pid;
666 1.3 mycroft msqptr->msg_stime = time.tv_sec;
667 1.3 mycroft
668 1.26 thorpej wakeup(msqptr);
669 1.26 thorpej return (0);
670 1.1 cgd }
671 1.1 cgd
672 1.1 cgd int
673 1.40 thorpej sys_msgrcv(struct lwp *l, void *v, register_t *retval)
674 1.16 thorpej {
675 1.27 augustss struct sys_msgrcv_args /* {
676 1.10 cgd syscallarg(int) msqid;
677 1.10 cgd syscallarg(void *) msgp;
678 1.10 cgd syscallarg(size_t) msgsz;
679 1.10 cgd syscallarg(long) msgtyp;
680 1.10 cgd syscallarg(int) msgflg;
681 1.16 thorpej } */ *uap = v;
682 1.41 cube
683 1.41 cube return msgrcv1(l->l_proc, SCARG(uap, msqid), SCARG(uap, msgp),
684 1.41 cube SCARG(uap, msgsz), SCARG(uap, msgtyp), SCARG(uap, msgflg),
685 1.41 cube sizeof(long), copyout, retval);
686 1.41 cube }
687 1.41 cube
688 1.41 cube int
689 1.41 cube msgrcv1(struct proc *p, int msqidr, char *user_msgp, size_t msgsz, long msgtyp,
690 1.41 cube int msgflg, size_t typesz, copyout_t put_type, register_t *retval)
691 1.41 cube {
692 1.3 mycroft size_t len;
693 1.3 mycroft struct ucred *cred = p->p_ucred;
694 1.27 augustss struct msqid_ds *msqptr;
695 1.27 augustss struct __msg *msghdr;
696 1.41 cube int error, msqid;
697 1.3 mycroft short next;
698 1.1 cgd
699 1.34 nathanw MSG_PRINTF(("call to msgrcv(%d, %p, %lld, %ld, %d)\n", msqid,
700 1.34 nathanw user_msgp, (long long)msgsz, msgtyp, msgflg));
701 1.1 cgd
702 1.41 cube msqid = IPCID_TO_IX(msqidr);
703 1.1 cgd
704 1.3 mycroft if (msqid < 0 || msqid >= msginfo.msgmni) {
705 1.20 christos MSG_PRINTF(("msqid (%d) out of range (0<=msqid<%d)\n", msqid,
706 1.20 christos msginfo.msgmni));
707 1.26 thorpej return (EINVAL);
708 1.3 mycroft }
709 1.1 cgd
710 1.3 mycroft msqptr = &msqids[msqid];
711 1.3 mycroft if (msqptr->msg_qbytes == 0) {
712 1.20 christos MSG_PRINTF(("no such message queue id\n"));
713 1.26 thorpej return (EINVAL);
714 1.3 mycroft }
715 1.41 cube if (msqptr->msg_perm._seq != IPCID_TO_SEQ(msqidr)) {
716 1.20 christos MSG_PRINTF(("wrong sequence number\n"));
717 1.26 thorpej return (EINVAL);
718 1.3 mycroft }
719 1.1 cgd
720 1.26 thorpej if ((error = ipcperm(cred, &msqptr->msg_perm, IPC_R))) {
721 1.20 christos MSG_PRINTF(("requester doesn't have read access\n"));
722 1.26 thorpej return (error);
723 1.3 mycroft }
724 1.1 cgd
725 1.18 christos #if 0
726 1.18 christos /* cannot happen, msgsz is unsigned */
727 1.3 mycroft if (msgsz < 0) {
728 1.20 christos MSG_PRINTF(("msgsz < 0\n"));
729 1.26 thorpej return (EINVAL);
730 1.3 mycroft }
731 1.18 christos #endif
732 1.1 cgd
733 1.3 mycroft msghdr = NULL;
734 1.3 mycroft while (msghdr == NULL) {
735 1.3 mycroft if (msgtyp == 0) {
736 1.26 thorpej msghdr = msqptr->_msg_first;
737 1.3 mycroft if (msghdr != NULL) {
738 1.3 mycroft if (msgsz < msghdr->msg_ts &&
739 1.3 mycroft (msgflg & MSG_NOERROR) == 0) {
740 1.26 thorpej MSG_PRINTF(("first message on the "
741 1.26 thorpej "queue is too big "
742 1.34 nathanw "(want %lld, got %d)\n",
743 1.34 nathanw (long long)msgsz, msghdr->msg_ts));
744 1.26 thorpej return (E2BIG);
745 1.3 mycroft }
746 1.26 thorpej if (msqptr->_msg_first == msqptr->_msg_last) {
747 1.26 thorpej msqptr->_msg_first = NULL;
748 1.26 thorpej msqptr->_msg_last = NULL;
749 1.3 mycroft } else {
750 1.26 thorpej msqptr->_msg_first = msghdr->msg_next;
751 1.26 thorpej if (msqptr->_msg_first == NULL)
752 1.26 thorpej panic("msg_first/last screwed "
753 1.26 thorpej "up #1");
754 1.3 mycroft }
755 1.3 mycroft }
756 1.3 mycroft } else {
757 1.26 thorpej struct __msg *previous;
758 1.26 thorpej struct __msg **prev;
759 1.1 cgd
760 1.26 thorpej for (previous = NULL, prev = &msqptr->_msg_first;
761 1.12 mycroft (msghdr = *prev) != NULL;
762 1.12 mycroft previous = msghdr, prev = &msghdr->msg_next) {
763 1.3 mycroft /*
764 1.3 mycroft * Is this message's type an exact match or is
765 1.3 mycroft * this message's type less than or equal to
766 1.3 mycroft * the absolute value of a negative msgtyp?
767 1.3 mycroft * Note that the second half of this test can
768 1.3 mycroft * NEVER be true if msgtyp is positive since
769 1.3 mycroft * msg_type is always positive!
770 1.3 mycroft */
771 1.3 mycroft
772 1.3 mycroft if (msgtyp == msghdr->msg_type ||
773 1.3 mycroft msghdr->msg_type <= -msgtyp) {
774 1.34 nathanw MSG_PRINTF(("found message type %ld, "
775 1.34 nathanw "requested %ld\n",
776 1.20 christos msghdr->msg_type, msgtyp));
777 1.3 mycroft if (msgsz < msghdr->msg_ts &&
778 1.3 mycroft (msgflg & MSG_NOERROR) == 0) {
779 1.26 thorpej MSG_PRINTF(("requested message "
780 1.26 thorpej "on the queue is too big "
781 1.34 nathanw "(want %lld, got %d)\n",
782 1.34 nathanw (long long)msgsz,
783 1.34 nathanw msghdr->msg_ts));
784 1.26 thorpej return (E2BIG);
785 1.3 mycroft }
786 1.3 mycroft *prev = msghdr->msg_next;
787 1.26 thorpej if (msghdr == msqptr->_msg_last) {
788 1.3 mycroft if (previous == NULL) {
789 1.3 mycroft if (prev !=
790 1.26 thorpej &msqptr->_msg_first)
791 1.3 mycroft panic("msg_first/last screwed up #2");
792 1.26 thorpej msqptr->_msg_first =
793 1.3 mycroft NULL;
794 1.26 thorpej msqptr->_msg_last =
795 1.3 mycroft NULL;
796 1.3 mycroft } else {
797 1.3 mycroft if (prev ==
798 1.26 thorpej &msqptr->_msg_first)
799 1.3 mycroft panic("msg_first/last screwed up #3");
800 1.26 thorpej msqptr->_msg_last =
801 1.3 mycroft previous;
802 1.3 mycroft }
803 1.3 mycroft }
804 1.3 mycroft break;
805 1.3 mycroft }
806 1.3 mycroft }
807 1.1 cgd }
808 1.1 cgd
809 1.3 mycroft /*
810 1.3 mycroft * We've either extracted the msghdr for the appropriate
811 1.3 mycroft * message or there isn't one.
812 1.3 mycroft * If there is one then bail out of this loop.
813 1.3 mycroft */
814 1.1 cgd
815 1.3 mycroft if (msghdr != NULL)
816 1.3 mycroft break;
817 1.1 cgd
818 1.1 cgd /*
819 1.3 mycroft * Hmph! No message found. Does the user want to wait?
820 1.1 cgd */
821 1.1 cgd
822 1.3 mycroft if ((msgflg & IPC_NOWAIT) != 0) {
823 1.34 nathanw MSG_PRINTF(("no appropriate message found (msgtyp=%ld)\n",
824 1.20 christos msgtyp));
825 1.3 mycroft /* The SVID says to return ENOMSG. */
826 1.1 cgd #ifdef ENOMSG
827 1.26 thorpej return (ENOMSG);
828 1.1 cgd #else
829 1.3 mycroft /* Unfortunately, BSD doesn't define that code yet! */
830 1.26 thorpej return (EAGAIN);
831 1.1 cgd #endif
832 1.3 mycroft }
833 1.1 cgd
834 1.3 mycroft /*
835 1.3 mycroft * Wait for something to happen
836 1.3 mycroft */
837 1.1 cgd
838 1.20 christos MSG_PRINTF(("msgrcv: goodnight\n"));
839 1.26 thorpej error = tsleep(msqptr, (PZERO - 4) | PCATCH, "msgwait",
840 1.3 mycroft 0);
841 1.26 thorpej MSG_PRINTF(("msgrcv: good morning (error=%d)\n", error));
842 1.1 cgd
843 1.26 thorpej if (error != 0) {
844 1.26 thorpej MSG_PRINTF(("msgsnd: interrupted system call\n"));
845 1.26 thorpej return (EINTR);
846 1.3 mycroft }
847 1.1 cgd
848 1.3 mycroft /*
849 1.3 mycroft * Make sure that the msq queue still exists
850 1.3 mycroft */
851 1.1 cgd
852 1.3 mycroft if (msqptr->msg_qbytes == 0 ||
853 1.41 cube msqptr->msg_perm._seq != IPCID_TO_SEQ(msqidr)) {
854 1.20 christos MSG_PRINTF(("msqid deleted\n"));
855 1.26 thorpej return (EIDRM);
856 1.3 mycroft }
857 1.1 cgd }
858 1.1 cgd
859 1.3 mycroft /*
860 1.3 mycroft * Return the message to the user.
861 1.3 mycroft *
862 1.3 mycroft * First, do the bookkeeping (before we risk being interrupted).
863 1.3 mycroft */
864 1.1 cgd
865 1.26 thorpej msqptr->_msg_cbytes -= msghdr->msg_ts;
866 1.5 mycroft msqptr->msg_qnum--;
867 1.3 mycroft msqptr->msg_lrpid = p->p_pid;
868 1.3 mycroft msqptr->msg_rtime = time.tv_sec;
869 1.1 cgd
870 1.3 mycroft /*
871 1.3 mycroft * Make msgsz the actual amount that we'll be returning.
872 1.3 mycroft * Note that this effectively truncates the message if it is too long
873 1.3 mycroft * (since msgsz is never increased).
874 1.3 mycroft */
875 1.1 cgd
876 1.34 nathanw MSG_PRINTF(("found a message, msgsz=%lld, msg_ts=%d\n",
877 1.34 nathanw (long long)msgsz, msghdr->msg_ts));
878 1.3 mycroft if (msgsz > msghdr->msg_ts)
879 1.3 mycroft msgsz = msghdr->msg_ts;
880 1.1 cgd
881 1.3 mycroft /*
882 1.3 mycroft * Return the type to the user.
883 1.3 mycroft */
884 1.1 cgd
885 1.41 cube error = (*put_type)(&msghdr->msg_type, user_msgp, typesz);
886 1.26 thorpej if (error != 0) {
887 1.26 thorpej MSG_PRINTF(("error (%d) copying out message type\n", error));
888 1.3 mycroft msg_freehdr(msghdr);
889 1.26 thorpej wakeup(msqptr);
890 1.26 thorpej return (error);
891 1.3 mycroft }
892 1.41 cube user_msgp += typesz;
893 1.3 mycroft
894 1.3 mycroft /*
895 1.3 mycroft * Return the segments to the user
896 1.3 mycroft */
897 1.1 cgd
898 1.3 mycroft next = msghdr->msg_spot;
899 1.3 mycroft for (len = 0; len < msgsz; len += msginfo.msgssz) {
900 1.3 mycroft size_t tlen;
901 1.3 mycroft
902 1.25 mrg if (msgsz - len > msginfo.msgssz)
903 1.3 mycroft tlen = msginfo.msgssz;
904 1.3 mycroft else
905 1.25 mrg tlen = msgsz - len;
906 1.3 mycroft if (next <= -1)
907 1.3 mycroft panic("next too low #3");
908 1.3 mycroft if (next >= msginfo.msgseg)
909 1.3 mycroft panic("next out of range #3");
910 1.26 thorpej error = copyout(&msgpool[next * msginfo.msgssz],
911 1.3 mycroft user_msgp, tlen);
912 1.26 thorpej if (error != 0) {
913 1.20 christos MSG_PRINTF(("error (%d) copying out message segment\n",
914 1.26 thorpej error));
915 1.3 mycroft msg_freehdr(msghdr);
916 1.26 thorpej wakeup(msqptr);
917 1.26 thorpej return (error);
918 1.3 mycroft }
919 1.3 mycroft user_msgp += tlen;
920 1.3 mycroft next = msgmaps[next].next;
921 1.1 cgd }
922 1.1 cgd
923 1.3 mycroft /*
924 1.3 mycroft * Done, return the actual number of bytes copied out.
925 1.3 mycroft */
926 1.1 cgd
927 1.3 mycroft msg_freehdr(msghdr);
928 1.26 thorpej wakeup(msqptr);
929 1.3 mycroft *retval = msgsz;
930 1.26 thorpej return (0);
931 1.1 cgd }
932