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