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