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