Home | History | Annotate | Line # | Download | only in kern
sysv_sem.c revision 1.40.2.1
      1 /*	$NetBSD: sysv_sem.c,v 1.40.2.1 2001/03/05 22:49:45 nathanw 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 <sys/sysctl.h>
     54 #include <sys/mount.h>		/* XXX for <sys/syscallargs.h> */
     55 #include <sys/syscallargs.h>
     56 
     57 int	semtot = 0;
     58 struct	semid_ds *sema;		/* semaphore id pool */
     59 struct	__sem *sem;		/* semaphore pool */
     60 struct	sem_undo *semu_list;	/* list of active undo structures */
     61 int	*semu;			/* undo structure pool */
     62 
     63 #ifdef SEM_DEBUG
     64 #define SEM_PRINTF(a) printf a
     65 #else
     66 #define SEM_PRINTF(a)
     67 #endif
     68 
     69 struct sem_undo *semu_alloc __P((struct proc *));
     70 int semundo_adjust __P((struct proc *, struct sem_undo **, int, int, int));
     71 void semundo_clear __P((int, int));
     72 
     73 /*
     74  * XXXSMP Once we go MP, there needs to be a lock for the semaphore system.
     75  * Until then, we're saved by being a non-preemptive kernel.
     76  */
     77 
     78 void
     79 seminit()
     80 {
     81 	int i;
     82 
     83 	if (sema == NULL)
     84 		panic("sema is NULL");
     85 	if (semu == NULL)
     86 		panic("semu is NULL");
     87 
     88 	for (i = 0; i < seminfo.semmni; i++) {
     89 		sema[i]._sem_base = 0;
     90 		sema[i].sem_perm.mode = 0;
     91 	}
     92 	for (i = 0; i < seminfo.semmnu; i++) {
     93 		struct sem_undo *suptr = SEMU(i);
     94 		suptr->un_proc = NULL;
     95 	}
     96 	semu_list = NULL;
     97 }
     98 
     99 /*
    100  * Placebo.
    101  */
    102 
    103 int
    104 sys_semconfig(l, v, retval)
    105 	struct lwp *l;
    106 	void *v;
    107 	register_t *retval;
    108 {
    109 	*retval = 0;
    110 	return 0;
    111 }
    112 
    113 /*
    114  * Allocate a new sem_undo structure for a process
    115  * (returns ptr to structure or NULL if no more room)
    116  */
    117 
    118 struct sem_undo *
    119 semu_alloc(p)
    120 	struct proc *p;
    121 {
    122 	int i;
    123 	struct sem_undo *suptr;
    124 	struct sem_undo **supptr;
    125 	int attempt;
    126 
    127 	/*
    128 	 * Try twice to allocate something.
    129 	 * (we'll purge any empty structures after the first pass so
    130 	 * two passes are always enough)
    131 	 */
    132 
    133 	for (attempt = 0; attempt < 2; attempt++) {
    134 		/*
    135 		 * Look for a free structure.
    136 		 * Fill it in and return it if we find one.
    137 		 */
    138 
    139 		for (i = 0; i < seminfo.semmnu; i++) {
    140 			suptr = SEMU(i);
    141 			if (suptr->un_proc == NULL) {
    142 				suptr->un_next = semu_list;
    143 				semu_list = suptr;
    144 				suptr->un_cnt = 0;
    145 				suptr->un_proc = p;
    146 				return(suptr);
    147 			}
    148 		}
    149 
    150 		/*
    151 		 * We didn't find a free one, if this is the first attempt
    152 		 * then try to free some structures.
    153 		 */
    154 
    155 		if (attempt == 0) {
    156 			/* All the structures are in use - try to free some */
    157 			int did_something = 0;
    158 
    159 			supptr = &semu_list;
    160 			while ((suptr = *supptr) != NULL) {
    161 				if (suptr->un_cnt == 0)  {
    162 					suptr->un_proc = NULL;
    163 					*supptr = suptr->un_next;
    164 					did_something = 1;
    165 				} else
    166 					supptr = &(suptr->un_next);
    167 			}
    168 
    169 			/* If we didn't free anything then just give-up */
    170 			if (!did_something)
    171 				return(NULL);
    172 		} else {
    173 			/*
    174 			 * The second pass failed even though we freed
    175 			 * something after the first pass!
    176 			 * This is IMPOSSIBLE!
    177 			 */
    178 			panic("semu_alloc - second attempt failed");
    179 		}
    180 	}
    181 	return NULL;
    182 }
    183 
    184 /*
    185  * Adjust a particular entry for a particular proc
    186  */
    187 
    188 int
    189 semundo_adjust(p, supptr, semid, semnum, adjval)
    190 	struct proc *p;
    191 	struct sem_undo **supptr;
    192 	int semid, semnum;
    193 	int adjval;
    194 {
    195 	struct sem_undo *suptr;
    196 	struct undo *sunptr;
    197 	int i;
    198 
    199 	/* Look for and remember the sem_undo if the caller doesn't provide
    200 	   it */
    201 
    202 	suptr = *supptr;
    203 	if (suptr == NULL) {
    204 		for (suptr = semu_list; suptr != NULL; suptr = suptr->un_next) {
    205 			if (suptr->un_proc == p) {
    206 				*supptr = suptr;
    207 				break;
    208 			}
    209 		}
    210 		if (suptr == NULL) {
    211 			if (adjval == 0)
    212 				return(0);
    213 			suptr = semu_alloc(p);
    214 			if (suptr == NULL)
    215 				return(ENOSPC);
    216 			*supptr = suptr;
    217 		}
    218 	}
    219 
    220 	/*
    221 	 * Look for the requested entry and adjust it (delete if adjval becomes
    222 	 * 0).
    223 	 */
    224 	sunptr = &suptr->un_ent[0];
    225 	for (i = 0; i < suptr->un_cnt; i++, sunptr++) {
    226 		if (sunptr->un_id != semid || sunptr->un_num != semnum)
    227 			continue;
    228 		if (adjval == 0)
    229 			sunptr->un_adjval = 0;
    230 		else
    231 			sunptr->un_adjval += adjval;
    232 		if (sunptr->un_adjval == 0) {
    233 			suptr->un_cnt--;
    234 			if (i < suptr->un_cnt)
    235 				suptr->un_ent[i] =
    236 				    suptr->un_ent[suptr->un_cnt];
    237 		}
    238 		return(0);
    239 	}
    240 
    241 	/* Didn't find the right entry - create it */
    242 	if (adjval == 0)
    243 		return(0);
    244 	if (suptr->un_cnt == SEMUME)
    245 		return(EINVAL);
    246 
    247 	sunptr = &suptr->un_ent[suptr->un_cnt];
    248 	suptr->un_cnt++;
    249 	sunptr->un_adjval = adjval;
    250 	sunptr->un_id = semid;
    251 	sunptr->un_num = semnum;
    252 	return(0);
    253 }
    254 
    255 void
    256 semundo_clear(semid, semnum)
    257 	int semid, semnum;
    258 {
    259 	struct sem_undo *suptr;
    260 
    261 	for (suptr = semu_list; suptr != NULL; suptr = suptr->un_next) {
    262 		struct undo *sunptr;
    263 		int i;
    264 
    265 		sunptr = &suptr->un_ent[0];
    266 		for (i = 0; i < suptr->un_cnt; i++, sunptr++) {
    267 			if (sunptr->un_id == semid) {
    268 				if (semnum == -1 || sunptr->un_num == semnum) {
    269 					suptr->un_cnt--;
    270 					if (i < suptr->un_cnt) {
    271 						suptr->un_ent[i] =
    272 						  suptr->un_ent[suptr->un_cnt];
    273 						i--, sunptr--;
    274 					}
    275 				}
    276 				if (semnum != -1)
    277 					break;
    278 			}
    279 		}
    280 	}
    281 }
    282 
    283 int
    284 sys_____semctl13(l, v, retval)
    285 	struct lwp *l;
    286 	void *v;
    287 	register_t *retval;
    288 {
    289 	struct sys_____semctl13_args /* {
    290 		syscallarg(int) semid;
    291 		syscallarg(int) semnum;
    292 		syscallarg(int) cmd;
    293 		syscallarg(union __semun *) arg;
    294 	} */ *uap = v;
    295 	struct proc *p = l->l_proc;
    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(l, v, retval)
    474 	struct lwp *l;
    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 = l->l_proc->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(l, v, retval)
    564 	struct lwp *l;
    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 	struct proc *p = l->l_proc;
    574 	int semid = SCARG(uap, semid);
    575 	int nsops = SCARG(uap, nsops);
    576 	struct sembuf sops[MAX_SOPS];
    577 	struct semid_ds *semaptr;
    578 	struct sembuf *sopptr = NULL;
    579 	struct __sem *semptr = NULL;
    580 	struct sem_undo *suptr = NULL;
    581 	struct ucred *cred = p->p_ucred;
    582 	int i, j, eval;
    583 	int do_wakeup, do_undos;
    584 
    585 	SEM_PRINTF(("call to semop(%d, %p, %d)\n", semid, sops, nsops));
    586 
    587 	semid = IPCID_TO_IX(semid);	/* Convert back to zero origin */
    588 
    589 	if (semid < 0 || semid >= seminfo.semmsl)
    590 		return(EINVAL);
    591 
    592 	semaptr = &sema[semid];
    593 	if ((semaptr->sem_perm.mode & SEM_ALLOC) == 0 ||
    594 	    semaptr->sem_perm._seq != IPCID_TO_SEQ(SCARG(uap, semid)))
    595 		return(EINVAL);
    596 
    597 	if ((eval = ipcperm(cred, &semaptr->sem_perm, IPC_W))) {
    598 		SEM_PRINTF(("eval = %d from ipaccess\n", eval));
    599 		return(eval);
    600 	}
    601 
    602 	if (nsops > MAX_SOPS) {
    603 		SEM_PRINTF(("too many sops (max=%d, nsops=%d)\n", MAX_SOPS, nsops));
    604 		return(E2BIG);
    605 	}
    606 
    607 	if ((eval = copyin(SCARG(uap, sops), sops, nsops * sizeof(sops[0])))
    608 	    != 0) {
    609 		SEM_PRINTF(("eval = %d from copyin(%p, %p, %d)\n", eval,
    610 		    SCARG(uap, sops), &sops, nsops * sizeof(sops[0])));
    611 		return(eval);
    612 	}
    613 
    614 	/*
    615 	 * Loop trying to satisfy the vector of requests.
    616 	 * If we reach a point where we must wait, any requests already
    617 	 * performed are rolled back and we go to sleep until some other
    618 	 * process wakes us up.  At this point, we start all over again.
    619 	 *
    620 	 * This ensures that from the perspective of other tasks, a set
    621 	 * of requests is atomic (never partially satisfied).
    622 	 */
    623 	do_undos = 0;
    624 
    625 	for (;;) {
    626 		do_wakeup = 0;
    627 
    628 		for (i = 0; i < nsops; i++) {
    629 			sopptr = &sops[i];
    630 
    631 			if (sopptr->sem_num >= semaptr->sem_nsems)
    632 				return(EFBIG);
    633 
    634 			semptr = &semaptr->_sem_base[sopptr->sem_num];
    635 
    636 			SEM_PRINTF(("semop:  semaptr=%x, sem_base=%x, semptr=%x, sem[%d]=%d : op=%d, flag=%s\n",
    637 			    semaptr, semaptr->_sem_base, semptr,
    638 			    sopptr->sem_num, semptr->semval, sopptr->sem_op,
    639 			    (sopptr->sem_flg & IPC_NOWAIT) ? "nowait" : "wait"));
    640 
    641 			if (sopptr->sem_op < 0) {
    642 				if ((int)(semptr->semval +
    643 					  sopptr->sem_op) < 0) {
    644 					SEM_PRINTF(("semop:  can't do it now\n"));
    645 					break;
    646 				} else {
    647 					semptr->semval += sopptr->sem_op;
    648 					if (semptr->semval == 0 &&
    649 					    semptr->semzcnt > 0)
    650 						do_wakeup = 1;
    651 				}
    652 				if (sopptr->sem_flg & SEM_UNDO)
    653 					do_undos = 1;
    654 			} else if (sopptr->sem_op == 0) {
    655 				if (semptr->semval > 0) {
    656 					SEM_PRINTF(("semop:  not zero now\n"));
    657 					break;
    658 				}
    659 			} else {
    660 				if (semptr->semncnt > 0)
    661 					do_wakeup = 1;
    662 				semptr->semval += sopptr->sem_op;
    663 				if (sopptr->sem_flg & SEM_UNDO)
    664 					do_undos = 1;
    665 			}
    666 		}
    667 
    668 		/*
    669 		 * Did we get through the entire vector?
    670 		 */
    671 		if (i >= nsops)
    672 			goto done;
    673 
    674 		/*
    675 		 * No ... rollback anything that we've already done
    676 		 */
    677 		SEM_PRINTF(("semop:  rollback 0 through %d\n", i-1));
    678 		for (j = 0; j < i; j++)
    679 			semaptr->_sem_base[sops[j].sem_num].semval -=
    680 			    sops[j].sem_op;
    681 
    682 		/*
    683 		 * If the request that we couldn't satisfy has the
    684 		 * NOWAIT flag set then return with EAGAIN.
    685 		 */
    686 		if (sopptr->sem_flg & IPC_NOWAIT)
    687 			return(EAGAIN);
    688 
    689 		if (sopptr->sem_op == 0)
    690 			semptr->semzcnt++;
    691 		else
    692 			semptr->semncnt++;
    693 
    694 		SEM_PRINTF(("semop:  good night!\n"));
    695 		eval = tsleep((caddr_t)semaptr, (PZERO - 4) | PCATCH,
    696 		    "semwait", 0);
    697 		SEM_PRINTF(("semop:  good morning (eval=%d)!\n", eval));
    698 
    699 		suptr = NULL;	/* sem_undo may have been reallocated */
    700 
    701 		if (eval != 0)
    702 			return(EINTR);
    703 		SEM_PRINTF(("semop:  good morning!\n"));
    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 != IPCID_TO_SEQ(SCARG(uap, semid))) {
    710 			/* The man page says to return EIDRM. */
    711 			/* Unfortunately, BSD doesn't define that code! */
    712 #ifdef EIDRM
    713 			return(EIDRM);
    714 #else
    715 			return(EINVAL);
    716 #endif
    717 		}
    718 
    719 		/*
    720 		 * The semaphore is still alive.  Readjust the count of
    721 		 * waiting processes.
    722 		 */
    723 		if (sopptr->sem_op == 0)
    724 			semptr->semzcnt--;
    725 		else
    726 			semptr->semncnt--;
    727 	}
    728 
    729 done:
    730 	/*
    731 	 * Process any SEM_UNDO requests.
    732 	 */
    733 	if (do_undos) {
    734 		for (i = 0; i < nsops; i++) {
    735 			/*
    736 			 * We only need to deal with SEM_UNDO's for non-zero
    737 			 * op's.
    738 			 */
    739 			int adjval;
    740 
    741 			if ((sops[i].sem_flg & SEM_UNDO) == 0)
    742 				continue;
    743 			adjval = sops[i].sem_op;
    744 			if (adjval == 0)
    745 				continue;
    746 			eval = semundo_adjust(p, &suptr, semid,
    747 			    sops[i].sem_num, -adjval);
    748 			if (eval == 0)
    749 				continue;
    750 
    751 			/*
    752 			 * Oh-Oh!  We ran out of either sem_undo's or undo's.
    753 			 * Rollback the adjustments to this point and then
    754 			 * rollback the semaphore ups and down so we can return
    755 			 * with an error with all structures restored.  We
    756 			 * rollback the undo's in the exact reverse order that
    757 			 * we applied them.  This guarantees that we won't run
    758 			 * out of space as we roll things back out.
    759 			 */
    760 			for (j = i - 1; j >= 0; j--) {
    761 				if ((sops[j].sem_flg & SEM_UNDO) == 0)
    762 					continue;
    763 				adjval = sops[j].sem_op;
    764 				if (adjval == 0)
    765 					continue;
    766 				if (semundo_adjust(p, &suptr, semid,
    767 				    sops[j].sem_num, adjval) != 0)
    768 					panic("semop - can't undo undos");
    769 			}
    770 
    771 			for (j = 0; j < nsops; j++)
    772 				semaptr->_sem_base[sops[j].sem_num].semval -=
    773 				    sops[j].sem_op;
    774 
    775 			SEM_PRINTF(("eval = %d from semundo_adjust\n", eval));
    776 			return(eval);
    777 		} /* loop through the sops */
    778 	} /* if (do_undos) */
    779 
    780 	/* We're definitely done - set the sempid's */
    781 	for (i = 0; i < nsops; i++) {
    782 		sopptr = &sops[i];
    783 		semptr = &semaptr->_sem_base[sopptr->sem_num];
    784 		semptr->sempid = p->p_pid;
    785 	}
    786 
    787 	/* Do a wakeup if any semaphore was up'd. */
    788 	if (do_wakeup) {
    789 		SEM_PRINTF(("semop:  doing wakeup\n"));
    790 #ifdef SEM_WAKEUP
    791 		sem_wakeup((caddr_t)semaptr);
    792 #else
    793 		wakeup((caddr_t)semaptr);
    794 #endif
    795 		SEM_PRINTF(("semop:  back from wakeup\n"));
    796 	}
    797 	SEM_PRINTF(("semop:  done\n"));
    798 	*retval = 0;
    799 	return(0);
    800 }
    801 
    802 /*
    803  * Go through the undo structures for this process and apply the adjustments to
    804  * semaphores.
    805  */
    806 void
    807 semexit(p)
    808 	struct proc *p;
    809 {
    810 	struct sem_undo *suptr;
    811 	struct sem_undo **supptr;
    812 
    813 	/*
    814 	 * Go through the chain of undo vectors looking for one associated with
    815 	 * this process.
    816 	 */
    817 
    818 	for (supptr = &semu_list; (suptr = *supptr) != NULL;
    819 	    supptr = &suptr->un_next) {
    820 		if (suptr->un_proc == p)
    821 			break;
    822 	}
    823 
    824 	/*
    825 	 * If there is no undo vector, skip to the end.
    826 	 */
    827 
    828 	if (suptr == NULL)
    829 		return;
    830 
    831 	/*
    832 	 * We now have an undo vector for this process.
    833 	 */
    834 
    835 	SEM_PRINTF(("proc @%p has undo structure with %d entries\n", p,
    836 	    suptr->un_cnt));
    837 
    838 	/*
    839 	 * If there are any active undo elements then process them.
    840 	 */
    841 	if (suptr->un_cnt > 0) {
    842 		int ix;
    843 
    844 		for (ix = 0; ix < suptr->un_cnt; ix++) {
    845 			int semid = suptr->un_ent[ix].un_id;
    846 			int semnum = suptr->un_ent[ix].un_num;
    847 			int adjval = suptr->un_ent[ix].un_adjval;
    848 			struct semid_ds *semaptr;
    849 
    850 			semaptr = &sema[semid];
    851 			if ((semaptr->sem_perm.mode & SEM_ALLOC) == 0)
    852 				panic("semexit - semid not allocated");
    853 			if (semnum >= semaptr->sem_nsems)
    854 				panic("semexit - semnum out of range");
    855 
    856 			SEM_PRINTF(("semexit:  %p id=%d num=%d(adj=%d) ; sem=%d\n",
    857 			    suptr->un_proc, suptr->un_ent[ix].un_id,
    858 			    suptr->un_ent[ix].un_num,
    859 			    suptr->un_ent[ix].un_adjval,
    860 			    semaptr->_sem_base[semnum].semval));
    861 
    862 			if (adjval < 0 &&
    863 			    semaptr->_sem_base[semnum].semval < -adjval)
    864 				semaptr->_sem_base[semnum].semval = 0;
    865 			else
    866 				semaptr->_sem_base[semnum].semval += adjval;
    867 
    868 #ifdef SEM_WAKEUP
    869 			sem_wakeup((caddr_t)semaptr);
    870 #else
    871 			wakeup((caddr_t)semaptr);
    872 #endif
    873 			SEM_PRINTF(("semexit:  back from wakeup\n"));
    874 		}
    875 	}
    876 
    877 	/*
    878 	 * Deallocate the undo vector.
    879 	 */
    880 	SEM_PRINTF(("removing vector\n"));
    881 	suptr->un_proc = NULL;
    882 	*supptr = suptr->un_next;
    883 }
    884