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