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