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