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