xref: /netbsd-src/sys/kern/sysv_sem.c (revision d48f14661dda8638fee055ba15d35bdfb29b9fa8)
1 /*	$NetBSD: sysv_sem.c,v 1.62 2006/06/07 22:33:41 kardel Exp $	*/
2 
3 /*-
4  * Copyright (c) 1999 The NetBSD Foundation, Inc.
5  * All rights reserved.
6  *
7  * This code is derived from software contributed to The NetBSD Foundation
8  * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
9  * NASA Ames Research Center.
10  *
11  * Redistribution and use in source and binary forms, with or without
12  * modification, are permitted provided that the following conditions
13  * are met:
14  * 1. Redistributions of source code must retain the above copyright
15  *    notice, this list of conditions and the following disclaimer.
16  * 2. Redistributions in binary form must reproduce the above copyright
17  *    notice, this list of conditions and the following disclaimer in the
18  *    documentation and/or other materials provided with the distribution.
19  * 3. All advertising materials mentioning features or use of this software
20  *    must display the following acknowledgement:
21  *	This product includes software developed by the NetBSD
22  *	Foundation, Inc. and its contributors.
23  * 4. Neither the name of The NetBSD Foundation nor the names of its
24  *    contributors may be used to endorse or promote products derived
25  *    from this software without specific prior written permission.
26  *
27  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
28  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
29  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
30  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
31  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
32  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
33  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
34  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
35  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
36  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37  * POSSIBILITY OF SUCH DAMAGE.
38  */
39 
40 /*
41  * Implementation of SVID semaphores
42  *
43  * Author: Daniel Boulet
44  *
45  * This software is provided ``AS IS'' without any warranties of any kind.
46  */
47 
48 #include <sys/cdefs.h>
49 __KERNEL_RCSID(0, "$NetBSD: sysv_sem.c,v 1.62 2006/06/07 22:33:41 kardel Exp $");
50 
51 #define SYSVSEM
52 
53 #include <sys/param.h>
54 #include <sys/kernel.h>
55 #include <sys/sem.h>
56 #include <sys/sysctl.h>
57 #include <sys/malloc.h>
58 #include <sys/mount.h>		/* XXX for <sys/syscallargs.h> */
59 #include <sys/sa.h>
60 #include <sys/syscallargs.h>
61 #include <sys/kauth.h>
62 
63 static int	semtot = 0;
64 struct	semid_ds *sema;			/* semaphore id pool */
65 static struct	__sem *sem;		/* semaphore pool */
66 static struct	sem_undo *semu_list;	/* list of active undo structures */
67 static int	*semu;			/* undo structure pool */
68 
69 #ifdef SEM_DEBUG
70 #define SEM_PRINTF(a) printf a
71 #else
72 #define SEM_PRINTF(a)
73 #endif
74 
75 struct sem_undo *semu_alloc(struct proc *);
76 int semundo_adjust(struct proc *, struct sem_undo **, int, int, int);
77 void semundo_clear(int, int);
78 
79 /*
80  * XXXSMP Once we go MP, there needs to be a lock for the semaphore system.
81  * Until then, we're saved by being a non-preemptive kernel.
82  */
83 
84 void
85 seminit(void)
86 {
87 	int i, sz;
88 	vaddr_t v;
89 
90 	/* Allocate pageable memory for our structures */
91 	sz = seminfo.semmni * sizeof(struct semid_ds) +
92 	    seminfo.semmns * sizeof(struct __sem) +
93 	    seminfo.semmnu * seminfo.semusz;
94 	v = uvm_km_alloc(kernel_map, round_page(sz), 0,
95 	    UVM_KMF_WIRED|UVM_KMF_ZERO);
96 	if (v == 0)
97 		panic("sysv_sem: cannot allocate memory");
98 	sema = (void *)v;
99 	sem = (void *)(sema + seminfo.semmni);
100 	semu = (void *)(sem + seminfo.semmns);
101 
102 	for (i = 0; i < seminfo.semmni; i++) {
103 		sema[i]._sem_base = 0;
104 		sema[i].sem_perm.mode = 0;
105 	}
106 	for (i = 0; i < seminfo.semmnu; i++) {
107 		struct sem_undo *suptr = SEMU(i);
108 		suptr->un_proc = NULL;
109 	}
110 	semu_list = NULL;
111 	exithook_establish(semexit, NULL);
112 }
113 
114 /*
115  * Placebo.
116  */
117 
118 int
119 sys_semconfig(struct lwp *l, void *v, register_t *retval)
120 {
121 
122 	*retval = 0;
123 	return 0;
124 }
125 
126 /*
127  * Allocate a new sem_undo structure for a process
128  * (returns ptr to structure or NULL if no more room)
129  */
130 
131 struct sem_undo *
132 semu_alloc(struct proc *p)
133 {
134 	int i;
135 	struct sem_undo *suptr;
136 	struct sem_undo **supptr;
137 	int attempt;
138 
139 	/*
140 	 * Try twice to allocate something.
141 	 * (we'll purge any empty structures after the first pass so
142 	 * two passes are always enough)
143 	 */
144 
145 	for (attempt = 0; attempt < 2; attempt++) {
146 		/*
147 		 * Look for a free structure.
148 		 * Fill it in and return it if we find one.
149 		 */
150 
151 		for (i = 0; i < seminfo.semmnu; i++) {
152 			suptr = SEMU(i);
153 			if (suptr->un_proc == NULL) {
154 				suptr->un_next = semu_list;
155 				semu_list = suptr;
156 				suptr->un_cnt = 0;
157 				suptr->un_proc = p;
158 				return (suptr);
159 			}
160 		}
161 
162 		/*
163 		 * We didn't find a free one, if this is the first attempt
164 		 * then try to free some structures.
165 		 */
166 
167 		if (attempt == 0) {
168 			/* All the structures are in use - try to free some */
169 			int did_something = 0;
170 
171 			supptr = &semu_list;
172 			while ((suptr = *supptr) != NULL) {
173 				if (suptr->un_cnt == 0)  {
174 					suptr->un_proc = NULL;
175 					*supptr = suptr->un_next;
176 					did_something = 1;
177 				} else
178 					supptr = &suptr->un_next;
179 			}
180 
181 			/* If we didn't free anything then just give-up */
182 			if (!did_something)
183 				return (NULL);
184 		} else {
185 			/*
186 			 * The second pass failed even though we freed
187 			 * something after the first pass!
188 			 * This is IMPOSSIBLE!
189 			 */
190 			panic("semu_alloc - second attempt failed");
191 		}
192 	}
193 	return NULL;
194 }
195 
196 /*
197  * Adjust a particular entry for a particular proc
198  */
199 
200 int
201 semundo_adjust(struct proc *p, struct sem_undo **supptr, int semid, int semnum,
202     int adjval)
203 {
204 	struct sem_undo *suptr;
205 	struct undo *sunptr;
206 	int i;
207 
208 	/*
209 	 * Look for and remember the sem_undo if the caller doesn't
210 	 * provide it
211 	 */
212 
213 	suptr = *supptr;
214 	if (suptr == NULL) {
215 		for (suptr = semu_list; suptr != NULL; suptr = suptr->un_next)
216 			if (suptr->un_proc == p)
217 				break;
218 
219 		if (suptr == NULL) {
220 			suptr = semu_alloc(p);
221 			if (suptr == NULL)
222 				return (ENOSPC);
223 		}
224 		*supptr = suptr;
225 	}
226 
227 	/*
228 	 * Look for the requested entry and adjust it (delete if
229 	 * adjval becomes 0).
230 	 */
231 	sunptr = &suptr->un_ent[0];
232 	for (i = 0; i < suptr->un_cnt; i++, sunptr++) {
233 		if (sunptr->un_id != semid || sunptr->un_num != semnum)
234 			continue;
235 		sunptr->un_adjval += adjval;
236 		if (sunptr->un_adjval == 0) {
237 			suptr->un_cnt--;
238 			if (i < suptr->un_cnt)
239 				suptr->un_ent[i] =
240 				    suptr->un_ent[suptr->un_cnt];
241 		}
242 		return (0);
243 	}
244 
245 	/* Didn't find the right entry - create it */
246 	if (suptr->un_cnt == SEMUME)
247 		return (EINVAL);
248 
249 	sunptr = &suptr->un_ent[suptr->un_cnt];
250 	suptr->un_cnt++;
251 	sunptr->un_adjval = adjval;
252 	sunptr->un_id = semid;
253 	sunptr->un_num = semnum;
254 	return (0);
255 }
256 
257 void
258 semundo_clear(int semid, int semnum)
259 {
260 	struct sem_undo *suptr;
261 	struct undo *sunptr, *sunend;
262 
263 	for (suptr = semu_list; suptr != NULL; suptr = suptr->un_next)
264 		for (sunptr = &suptr->un_ent[0],
265 		    sunend = sunptr + suptr->un_cnt; sunptr < sunend;) {
266 			if (sunptr->un_id == semid) {
267 				if (semnum == -1 || sunptr->un_num == semnum) {
268 					suptr->un_cnt--;
269 					sunend--;
270 					if (sunptr != sunend)
271 						*sunptr = *sunend;
272 					if (semnum != -1)
273 						break;
274 					else
275 						continue;
276 				}
277 			}
278 			sunptr++;
279 		}
280 }
281 
282 int
283 sys_____semctl13(struct lwp *l, void *v, register_t *retval)
284 {
285 	struct sys_____semctl13_args /* {
286 		syscallarg(int) semid;
287 		syscallarg(int) semnum;
288 		syscallarg(int) cmd;
289 		syscallarg(union __semun *) arg;
290 	} */ *uap = v;
291 	struct proc *p = l->l_proc;
292 	struct semid_ds sembuf;
293 	int cmd, error;
294 	void *pass_arg;
295 	union __semun karg;
296 
297 	cmd = SCARG(uap, cmd);
298 
299 	switch (cmd) {
300 	case IPC_SET:
301 	case IPC_STAT:
302 		pass_arg = &sembuf;
303 		break;
304 
305 	case GETALL:
306 	case SETVAL:
307 	case SETALL:
308 		pass_arg = &karg;
309 		break;
310 	default:
311 		pass_arg = NULL;
312 		break;
313 	}
314 
315 	if (pass_arg) {
316 		error = copyin(SCARG(uap, arg), &karg, sizeof(karg));
317 		if (error)
318 			return error;
319 		if (cmd == IPC_SET) {
320 			error = copyin(karg.buf, &sembuf, sizeof(sembuf));
321 			if (error)
322 				return (error);
323 		}
324 	}
325 
326 	error = semctl1(p, SCARG(uap, semid), SCARG(uap, semnum), cmd,
327 	    pass_arg, retval);
328 
329 	if (error == 0 && cmd == IPC_STAT)
330 		error = copyout(&sembuf, karg.buf, sizeof(sembuf));
331 
332 	return (error);
333 }
334 
335 int
336 semctl1(struct proc *p, int semid, int semnum, int cmd, void *v,
337     register_t *retval)
338 {
339 	kauth_cred_t cred = p->p_cred;
340 	union __semun *arg = v;
341 	struct semid_ds *sembuf = v, *semaptr;
342 	int i, error, ix;
343 
344 	SEM_PRINTF(("call to semctl(%d, %d, %d, %p)\n",
345 	    semid, semnum, cmd, v));
346 
347 	ix = IPCID_TO_IX(semid);
348 	if (ix < 0 || ix >= seminfo.semmni)
349 		return (EINVAL);
350 
351 	semaptr = &sema[ix];
352 	if ((semaptr->sem_perm.mode & SEM_ALLOC) == 0 ||
353 	    semaptr->sem_perm._seq != IPCID_TO_SEQ(semid))
354 		return (EINVAL);
355 
356 	switch (cmd) {
357 	case IPC_RMID:
358 		if ((error = ipcperm(cred, &semaptr->sem_perm, IPC_M)) != 0)
359 			return (error);
360 		semaptr->sem_perm.cuid = kauth_cred_geteuid(cred);
361 		semaptr->sem_perm.uid = kauth_cred_geteuid(cred);
362 		semtot -= semaptr->sem_nsems;
363 		for (i = semaptr->_sem_base - sem; i < semtot; i++)
364 			sem[i] = sem[i + semaptr->sem_nsems];
365 		for (i = 0; i < seminfo.semmni; i++) {
366 			if ((sema[i].sem_perm.mode & SEM_ALLOC) &&
367 			    sema[i]._sem_base > semaptr->_sem_base)
368 				sema[i]._sem_base -= semaptr->sem_nsems;
369 		}
370 		semaptr->sem_perm.mode = 0;
371 		semundo_clear(ix, -1);
372 		wakeup(semaptr);
373 		break;
374 
375 	case IPC_SET:
376 		if ((error = ipcperm(cred, &semaptr->sem_perm, IPC_M)))
377 			return (error);
378 		semaptr->sem_perm.uid = sembuf->sem_perm.uid;
379 		semaptr->sem_perm.gid = sembuf->sem_perm.gid;
380 		semaptr->sem_perm.mode = (semaptr->sem_perm.mode & ~0777) |
381 		    (sembuf->sem_perm.mode & 0777);
382 		semaptr->sem_ctime = time_second;
383 		break;
384 
385 	case IPC_STAT:
386 		if ((error = ipcperm(cred, &semaptr->sem_perm, IPC_R)))
387 			return (error);
388 		memcpy(sembuf, semaptr, sizeof(struct semid_ds));
389 		break;
390 
391 	case GETNCNT:
392 		if ((error = ipcperm(cred, &semaptr->sem_perm, IPC_R)))
393 			return (error);
394 		if (semnum < 0 || semnum >= semaptr->sem_nsems)
395 			return (EINVAL);
396 		*retval = semaptr->_sem_base[semnum].semncnt;
397 		break;
398 
399 	case GETPID:
400 		if ((error = ipcperm(cred, &semaptr->sem_perm, IPC_R)))
401 			return (error);
402 		if (semnum < 0 || semnum >= semaptr->sem_nsems)
403 			return (EINVAL);
404 		*retval = semaptr->_sem_base[semnum].sempid;
405 		break;
406 
407 	case GETVAL:
408 		if ((error = ipcperm(cred, &semaptr->sem_perm, IPC_R)))
409 			return (error);
410 		if (semnum < 0 || semnum >= semaptr->sem_nsems)
411 			return (EINVAL);
412 		*retval = semaptr->_sem_base[semnum].semval;
413 		break;
414 
415 	case GETALL:
416 		if ((error = ipcperm(cred, &semaptr->sem_perm, IPC_R)))
417 			return (error);
418 		KASSERT(arg != NULL);
419 		for (i = 0; i < semaptr->sem_nsems; i++) {
420 			error = copyout(&semaptr->_sem_base[i].semval,
421 			    &arg->array[i], sizeof(arg->array[i]));
422 			if (error != 0)
423 				break;
424 		}
425 		break;
426 
427 	case GETZCNT:
428 		if ((error = ipcperm(cred, &semaptr->sem_perm, IPC_R)))
429 			return (error);
430 		if (semnum < 0 || semnum >= semaptr->sem_nsems)
431 			return (EINVAL);
432 		*retval = semaptr->_sem_base[semnum].semzcnt;
433 		break;
434 
435 	case SETVAL:
436 		if ((error = ipcperm(cred, &semaptr->sem_perm, IPC_W)))
437 			return (error);
438 		if (semnum < 0 || semnum >= semaptr->sem_nsems)
439 			return (EINVAL);
440 		KASSERT(arg != NULL);
441 		semaptr->_sem_base[semnum].semval = arg->val;
442 		semundo_clear(ix, semnum);
443 		wakeup(semaptr);
444 		break;
445 
446 	case SETALL:
447 		if ((error = ipcperm(cred, &semaptr->sem_perm, IPC_W)))
448 			return (error);
449 		KASSERT(arg != NULL);
450 		for (i = 0; i < semaptr->sem_nsems; i++) {
451 			error = copyin(&arg->array[i],
452 			    &semaptr->_sem_base[i].semval,
453 			    sizeof(arg->array[i]));
454 			if (error != 0)
455 				break;
456 		}
457 		semundo_clear(ix, -1);
458 		wakeup(semaptr);
459 		break;
460 
461 	default:
462 		return (EINVAL);
463 	}
464 
465 	return (error);
466 }
467 
468 int
469 sys_semget(struct lwp *l, void *v, register_t *retval)
470 {
471 	struct sys_semget_args /* {
472 		syscallarg(key_t) key;
473 		syscallarg(int) nsems;
474 		syscallarg(int) semflg;
475 	} */ *uap = v;
476 	int semid, eval;
477 	int key = SCARG(uap, key);
478 	int nsems = SCARG(uap, nsems);
479 	int semflg = SCARG(uap, semflg);
480 	kauth_cred_t cred = l->l_proc->p_cred;
481 
482 	SEM_PRINTF(("semget(0x%x, %d, 0%o)\n", key, nsems, semflg));
483 
484 	if (key != IPC_PRIVATE) {
485 		for (semid = 0; semid < seminfo.semmni; semid++) {
486 			if ((sema[semid].sem_perm.mode & SEM_ALLOC) &&
487 			    sema[semid].sem_perm._key == key)
488 				break;
489 		}
490 		if (semid < seminfo.semmni) {
491 			SEM_PRINTF(("found public key\n"));
492 			if ((eval = ipcperm(cred, &sema[semid].sem_perm,
493 			    semflg & 0700)))
494 				return (eval);
495 			if (nsems > 0 && sema[semid].sem_nsems < nsems) {
496 				SEM_PRINTF(("too small\n"));
497 				return (EINVAL);
498 			}
499 			if ((semflg & IPC_CREAT) && (semflg & IPC_EXCL)) {
500 				SEM_PRINTF(("not exclusive\n"));
501 				return (EEXIST);
502 			}
503 			goto found;
504 		}
505 	}
506 
507 	SEM_PRINTF(("need to allocate the semid_ds\n"));
508 	if (key == IPC_PRIVATE || (semflg & IPC_CREAT)) {
509 		if (nsems <= 0 || nsems > seminfo.semmsl) {
510 			SEM_PRINTF(("nsems out of range (0<%d<=%d)\n", nsems,
511 			    seminfo.semmsl));
512 			return (EINVAL);
513 		}
514 		if (nsems > seminfo.semmns - semtot) {
515 			SEM_PRINTF(("not enough semaphores left "
516 			    "(need %d, got %d)\n",
517 			    nsems, seminfo.semmns - semtot));
518 			return (ENOSPC);
519 		}
520 		for (semid = 0; semid < seminfo.semmni; semid++) {
521 			if ((sema[semid].sem_perm.mode & SEM_ALLOC) == 0)
522 				break;
523 		}
524 		if (semid == seminfo.semmni) {
525 			SEM_PRINTF(("no more semid_ds's available\n"));
526 			return (ENOSPC);
527 		}
528 		SEM_PRINTF(("semid %d is available\n", semid));
529 		sema[semid].sem_perm._key = key;
530 		sema[semid].sem_perm.cuid = kauth_cred_geteuid(cred);
531 		sema[semid].sem_perm.uid = kauth_cred_geteuid(cred);
532 		sema[semid].sem_perm.cgid = kauth_cred_getegid(cred);
533 		sema[semid].sem_perm.gid = kauth_cred_getegid(cred);
534 		sema[semid].sem_perm.mode = (semflg & 0777) | SEM_ALLOC;
535 		sema[semid].sem_perm._seq =
536 		    (sema[semid].sem_perm._seq + 1) & 0x7fff;
537 		sema[semid].sem_nsems = nsems;
538 		sema[semid].sem_otime = 0;
539 		sema[semid].sem_ctime = time_second;
540 		sema[semid]._sem_base = &sem[semtot];
541 		semtot += nsems;
542 		memset(sema[semid]._sem_base, 0,
543 		    sizeof(sema[semid]._sem_base[0]) * nsems);
544 		SEM_PRINTF(("sembase = %p, next = %p\n", sema[semid]._sem_base,
545 		    &sem[semtot]));
546 	} else {
547 		SEM_PRINTF(("didn't find it and wasn't asked to create it\n"));
548 		return (ENOENT);
549 	}
550 
551 found:
552 	*retval = IXSEQ_TO_IPCID(semid, sema[semid].sem_perm);
553 	return (0);
554 }
555 
556 #define SMALL_SOPS 8
557 
558 int
559 sys_semop(struct lwp *l, void *v, register_t *retval)
560 {
561 	struct sys_semop_args /* {
562 		syscallarg(int) semid;
563 		syscallarg(struct sembuf *) sops;
564 		syscallarg(size_t) nsops;
565 	} */ *uap = v;
566 	struct proc *p = l->l_proc;
567 	int semid = SCARG(uap, semid), seq;
568 	size_t nsops = SCARG(uap, nsops);
569 	struct sembuf small_sops[SMALL_SOPS];
570 	struct sembuf *sops;
571 	struct semid_ds *semaptr;
572 	struct sembuf *sopptr = NULL;
573 	struct __sem *semptr = NULL;
574 	struct sem_undo *suptr = NULL;
575 	kauth_cred_t cred = p->p_cred;
576 	int i, eval;
577 	int do_wakeup, do_undos;
578 
579 	SEM_PRINTF(("call to semop(%d, %p, %zd)\n", semid, SCARG(uap,sops), nsops));
580 
581 	semid = IPCID_TO_IX(semid);	/* Convert back to zero origin */
582 	if (semid < 0 || semid >= seminfo.semmni)
583 		return (EINVAL);
584 
585 	semaptr = &sema[semid];
586 	seq = IPCID_TO_SEQ(SCARG(uap, semid));
587 	if ((semaptr->sem_perm.mode & SEM_ALLOC) == 0 ||
588 	    semaptr->sem_perm._seq != seq)
589 		return (EINVAL);
590 
591 	if ((eval = ipcperm(cred, &semaptr->sem_perm, IPC_W))) {
592 		SEM_PRINTF(("eval = %d from ipaccess\n", eval));
593 		return (eval);
594 	}
595 
596 	if (nsops <= SMALL_SOPS) {
597 		sops = small_sops;
598 	} else if (nsops <= seminfo.semopm) {
599 		sops = malloc(nsops * sizeof(*sops), M_TEMP, M_WAITOK);
600 	} else {
601 		SEM_PRINTF(("too many sops (max=%d, nsops=%zd)\n",
602 		    seminfo.semopm, nsops));
603 		return (E2BIG);
604 	}
605 
606 	if ((eval = copyin(SCARG(uap, sops),
607 	    sops, nsops * sizeof(sops[0]))) != 0) {
608 		SEM_PRINTF(("eval = %d from copyin(%p, %p, %zd)\n", eval,
609 		    SCARG(uap, sops), &sops, nsops * sizeof(sops[0])));
610 		goto out;
611 	}
612 
613 	for (i = 0; i < nsops; i++)
614 		if (sops[i].sem_num >= semaptr->sem_nsems) {
615 			eval = EFBIG;
616 			goto out;
617 		}
618 
619 	/*
620 	 * Loop trying to satisfy the vector of requests.
621 	 * If we reach a point where we must wait, any requests already
622 	 * performed are rolled back and we go to sleep until some other
623 	 * process wakes us up.  At this point, we start all over again.
624 	 *
625 	 * This ensures that from the perspective of other tasks, a set
626 	 * of requests is atomic (never partially satisfied).
627 	 */
628 	do_undos = 0;
629 
630 	for (;;) {
631 		do_wakeup = 0;
632 
633 		for (i = 0; i < nsops; i++) {
634 			sopptr = &sops[i];
635 			semptr = &semaptr->_sem_base[sopptr->sem_num];
636 
637 			SEM_PRINTF(("semop:  semaptr=%p, sem_base=%p, "
638 			    "semptr=%p, sem[%d]=%d : op=%d, flag=%s\n",
639 			    semaptr, semaptr->_sem_base, semptr,
640 			    sopptr->sem_num, semptr->semval, sopptr->sem_op,
641 			    (sopptr->sem_flg & IPC_NOWAIT) ?
642 			    "nowait" : "wait"));
643 
644 			if (sopptr->sem_op < 0) {
645 				if ((int)(semptr->semval +
646 				    sopptr->sem_op) < 0) {
647 					SEM_PRINTF(("semop:  "
648 					    "can't do it now\n"));
649 					break;
650 				} else {
651 					semptr->semval += sopptr->sem_op;
652 					if (semptr->semval == 0 &&
653 					    semptr->semzcnt > 0)
654 						do_wakeup = 1;
655 				}
656 				if (sopptr->sem_flg & SEM_UNDO)
657 					do_undos = 1;
658 			} else if (sopptr->sem_op == 0) {
659 				if (semptr->semval > 0) {
660 					SEM_PRINTF(("semop:  not zero now\n"));
661 					break;
662 				}
663 			} else {
664 				if (semptr->semncnt > 0)
665 					do_wakeup = 1;
666 				semptr->semval += sopptr->sem_op;
667 				if (sopptr->sem_flg & SEM_UNDO)
668 					do_undos = 1;
669 			}
670 		}
671 
672 		/*
673 		 * Did we get through the entire vector?
674 		 */
675 		if (i >= nsops)
676 			goto done;
677 
678 		/*
679 		 * No ... rollback anything that we've already done
680 		 */
681 		SEM_PRINTF(("semop:  rollback 0 through %d\n", i - 1));
682 		while (i-- > 0)
683 			semaptr->_sem_base[sops[i].sem_num].semval -=
684 			    sops[i].sem_op;
685 
686 		/*
687 		 * If the request that we couldn't satisfy has the
688 		 * NOWAIT flag set then return with EAGAIN.
689 		 */
690 		if (sopptr->sem_flg & IPC_NOWAIT) {
691 			eval = EAGAIN;
692 			goto out;
693 		}
694 
695 		if (sopptr->sem_op == 0)
696 			semptr->semzcnt++;
697 		else
698 			semptr->semncnt++;
699 
700 		SEM_PRINTF(("semop:  good night!\n"));
701 		eval = tsleep((caddr_t)semaptr, (PZERO - 4) | PCATCH,
702 		    "semwait", 0);
703 		SEM_PRINTF(("semop:  good morning (eval=%d)!\n", eval));
704 
705 		/*
706 		 * Make sure that the semaphore still exists
707 		 */
708 		if ((semaptr->sem_perm.mode & SEM_ALLOC) == 0 ||
709 		    semaptr->sem_perm._seq != seq) {
710 			eval = EIDRM;
711 			goto out;
712 		}
713 
714 		/*
715 		 * The semaphore is still alive.  Readjust the count of
716 		 * waiting processes.
717 		 */
718 		semptr = &semaptr->_sem_base[sopptr->sem_num];
719 		if (sopptr->sem_op == 0)
720 			semptr->semzcnt--;
721 		else
722 			semptr->semncnt--;
723 		/*
724 		 * Is it really morning, or was our sleep interrupted?
725 		 * (Delayed check of tsleep() return code because we
726 		 * need to decrement sem[nz]cnt either way.)
727 		 */
728 		if (eval != 0) {
729 			eval = EINTR;
730 			goto out;
731 		}
732 		SEM_PRINTF(("semop:  good morning!\n"));
733 	}
734 
735 done:
736 	/*
737 	 * Process any SEM_UNDO requests.
738 	 */
739 	if (do_undos) {
740 		for (i = 0; i < nsops; i++) {
741 			/*
742 			 * We only need to deal with SEM_UNDO's for non-zero
743 			 * op's.
744 			 */
745 			int adjval;
746 
747 			if ((sops[i].sem_flg & SEM_UNDO) == 0)
748 				continue;
749 			adjval = sops[i].sem_op;
750 			if (adjval == 0)
751 				continue;
752 			eval = semundo_adjust(p, &suptr, semid,
753 			    sops[i].sem_num, -adjval);
754 			if (eval == 0)
755 				continue;
756 
757 			/*
758 			 * Oh-Oh!  We ran out of either sem_undo's or undo's.
759 			 * Rollback the adjustments to this point and then
760 			 * rollback the semaphore ups and down so we can return
761 			 * with an error with all structures restored.  We
762 			 * rollback the undo's in the exact reverse order that
763 			 * we applied them.  This guarantees that we won't run
764 			 * out of space as we roll things back out.
765 			 */
766 			while (i-- > 0) {
767 				if ((sops[i].sem_flg & SEM_UNDO) == 0)
768 					continue;
769 				adjval = sops[i].sem_op;
770 				if (adjval == 0)
771 					continue;
772 				if (semundo_adjust(p, &suptr, semid,
773 				    sops[i].sem_num, adjval) != 0)
774 					panic("semop - can't undo undos");
775 			}
776 
777 			for (i = 0; i < nsops; i++)
778 				semaptr->_sem_base[sops[i].sem_num].semval -=
779 				    sops[i].sem_op;
780 
781 			SEM_PRINTF(("eval = %d from semundo_adjust\n", eval));
782 			goto out;
783 		} /* loop through the sops */
784 	} /* if (do_undos) */
785 
786 	/* We're definitely done - set the sempid's */
787 	for (i = 0; i < nsops; i++) {
788 		sopptr = &sops[i];
789 		semptr = &semaptr->_sem_base[sopptr->sem_num];
790 		semptr->sempid = p->p_pid;
791 	}
792 
793 	/* Update sem_otime */
794 	semaptr->sem_otime = time_second;
795 
796 	/* Do a wakeup if any semaphore was up'd. */
797 	if (do_wakeup) {
798 		SEM_PRINTF(("semop:  doing wakeup\n"));
799 #ifdef SEM_WAKEUP
800 		sem_wakeup((caddr_t)semaptr);
801 #else
802 		wakeup((caddr_t)semaptr);
803 #endif
804 		SEM_PRINTF(("semop:  back from wakeup\n"));
805 	}
806 	SEM_PRINTF(("semop:  done\n"));
807 	*retval = 0;
808 
809 out:
810 	if (sops != small_sops) {
811 		free(sops, M_TEMP);
812 	}
813 	return eval;
814 }
815 
816 /*
817  * Go through the undo structures for this process and apply the
818  * adjustments to semaphores.
819  */
820 /*ARGSUSED*/
821 void
822 semexit(struct proc *p, void *v)
823 {
824 	struct sem_undo *suptr;
825 	struct sem_undo **supptr;
826 
827 	/*
828 	 * Go through the chain of undo vectors looking for one
829 	 * associated with this process.
830 	 */
831 
832 	for (supptr = &semu_list; (suptr = *supptr) != NULL;
833 	    supptr = &suptr->un_next) {
834 		if (suptr->un_proc == p)
835 			break;
836 	}
837 
838 	/*
839 	 * If there is no undo vector, skip to the end.
840 	 */
841 
842 	if (suptr == NULL)
843 		return;
844 
845 	/*
846 	 * We now have an undo vector for this process.
847 	 */
848 
849 	SEM_PRINTF(("proc @%p has undo structure with %d entries\n", p,
850 	    suptr->un_cnt));
851 
852 	/*
853 	 * If there are any active undo elements then process them.
854 	 */
855 	if (suptr->un_cnt > 0) {
856 		int ix;
857 
858 		for (ix = 0; ix < suptr->un_cnt; ix++) {
859 			int semid = suptr->un_ent[ix].un_id;
860 			int semnum = suptr->un_ent[ix].un_num;
861 			int adjval = suptr->un_ent[ix].un_adjval;
862 			struct semid_ds *semaptr;
863 
864 			semaptr = &sema[semid];
865 			if ((semaptr->sem_perm.mode & SEM_ALLOC) == 0)
866 				panic("semexit - semid not allocated");
867 			if (semnum >= semaptr->sem_nsems)
868 				panic("semexit - semnum out of range");
869 
870 			SEM_PRINTF(("semexit:  %p id=%d num=%d(adj=%d) ; "
871 			    "sem=%d\n",
872 			    suptr->un_proc, suptr->un_ent[ix].un_id,
873 			    suptr->un_ent[ix].un_num,
874 			    suptr->un_ent[ix].un_adjval,
875 			    semaptr->_sem_base[semnum].semval));
876 
877 			if (adjval < 0 &&
878 			    semaptr->_sem_base[semnum].semval < -adjval)
879 				semaptr->_sem_base[semnum].semval = 0;
880 			else
881 				semaptr->_sem_base[semnum].semval += adjval;
882 
883 #ifdef SEM_WAKEUP
884 			sem_wakeup((caddr_t)semaptr);
885 #else
886 			wakeup((caddr_t)semaptr);
887 #endif
888 			SEM_PRINTF(("semexit:  back from wakeup\n"));
889 		}
890 	}
891 
892 	/*
893 	 * Deallocate the undo vector.
894 	 */
895 	SEM_PRINTF(("removing vector\n"));
896 	suptr->un_proc = NULL;
897 	*supptr = suptr->un_next;
898 }
899