1 /* $NetBSD: sysv_sem.c,v 1.38 2000/06/02 15:53:05 simonb 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 <vm/vm.h> /* XXX for <sys/sysctl.h> */ 54 #include <sys/sysctl.h> 55 #include <sys/mount.h> /* XXX for <sys/syscallargs.h> */ 56 #include <sys/syscallargs.h> 57 58 int semtot = 0; 59 struct semid_ds *sema; /* semaphore id pool */ 60 struct __sem *sem; /* semaphore pool */ 61 struct sem_undo *semu_list; /* list of active undo structures */ 62 int *semu; /* undo structure pool */ 63 64 #ifdef SEM_DEBUG 65 #define SEM_PRINTF(a) printf a 66 #else 67 #define SEM_PRINTF(a) 68 #endif 69 70 struct sem_undo *semu_alloc __P((struct proc *)); 71 int semundo_adjust __P((struct proc *, struct sem_undo **, int, int, int)); 72 void semundo_clear __P((int, int)); 73 74 /* 75 * XXXSMP Once we go MP, there needs to be a lock for the semaphore system. 76 * Until then, we're saved by being a non-preemptive kernel. 77 */ 78 79 void 80 seminit() 81 { 82 int i; 83 84 if (sema == NULL) 85 panic("sema is NULL"); 86 if (semu == NULL) 87 panic("semu is NULL"); 88 89 for (i = 0; i < seminfo.semmni; i++) { 90 sema[i]._sem_base = 0; 91 sema[i].sem_perm.mode = 0; 92 } 93 for (i = 0; i < seminfo.semmnu; i++) { 94 struct sem_undo *suptr = SEMU(i); 95 suptr->un_proc = NULL; 96 } 97 semu_list = NULL; 98 } 99 100 /* 101 * Placebo. 102 */ 103 104 int 105 sys_semconfig(p, v, retval) 106 struct proc *p; 107 void *v; 108 register_t *retval; 109 { 110 *retval = 0; 111 return 0; 112 } 113 114 /* 115 * Allocate a new sem_undo structure for a process 116 * (returns ptr to structure or NULL if no more room) 117 */ 118 119 struct sem_undo * 120 semu_alloc(p) 121 struct proc *p; 122 { 123 int i; 124 struct sem_undo *suptr; 125 struct sem_undo **supptr; 126 int attempt; 127 128 /* 129 * Try twice to allocate something. 130 * (we'll purge any empty structures after the first pass so 131 * two passes are always enough) 132 */ 133 134 for (attempt = 0; attempt < 2; attempt++) { 135 /* 136 * Look for a free structure. 137 * Fill it in and return it if we find one. 138 */ 139 140 for (i = 0; i < seminfo.semmnu; i++) { 141 suptr = SEMU(i); 142 if (suptr->un_proc == NULL) { 143 suptr->un_next = semu_list; 144 semu_list = suptr; 145 suptr->un_cnt = 0; 146 suptr->un_proc = p; 147 return(suptr); 148 } 149 } 150 151 /* 152 * We didn't find a free one, if this is the first attempt 153 * then try to free some structures. 154 */ 155 156 if (attempt == 0) { 157 /* All the structures are in use - try to free some */ 158 int did_something = 0; 159 160 supptr = &semu_list; 161 while ((suptr = *supptr) != NULL) { 162 if (suptr->un_cnt == 0) { 163 suptr->un_proc = NULL; 164 *supptr = suptr->un_next; 165 did_something = 1; 166 } else 167 supptr = &(suptr->un_next); 168 } 169 170 /* If we didn't free anything then just give-up */ 171 if (!did_something) 172 return(NULL); 173 } else { 174 /* 175 * The second pass failed even though we freed 176 * something after the first pass! 177 * This is IMPOSSIBLE! 178 */ 179 panic("semu_alloc - second attempt failed"); 180 } 181 } 182 return NULL; 183 } 184 185 /* 186 * Adjust a particular entry for a particular proc 187 */ 188 189 int 190 semundo_adjust(p, supptr, semid, semnum, adjval) 191 struct proc *p; 192 struct sem_undo **supptr; 193 int semid, semnum; 194 int adjval; 195 { 196 struct sem_undo *suptr; 197 struct undo *sunptr; 198 int i; 199 200 /* Look for and remember the sem_undo if the caller doesn't provide 201 it */ 202 203 suptr = *supptr; 204 if (suptr == NULL) { 205 for (suptr = semu_list; suptr != NULL; suptr = suptr->un_next) { 206 if (suptr->un_proc == p) { 207 *supptr = suptr; 208 break; 209 } 210 } 211 if (suptr == NULL) { 212 if (adjval == 0) 213 return(0); 214 suptr = semu_alloc(p); 215 if (suptr == NULL) 216 return(ENOSPC); 217 *supptr = suptr; 218 } 219 } 220 221 /* 222 * Look for the requested entry and adjust it (delete if adjval becomes 223 * 0). 224 */ 225 sunptr = &suptr->un_ent[0]; 226 for (i = 0; i < suptr->un_cnt; i++, sunptr++) { 227 if (sunptr->un_id != semid || sunptr->un_num != semnum) 228 continue; 229 if (adjval == 0) 230 sunptr->un_adjval = 0; 231 else 232 sunptr->un_adjval += adjval; 233 if (sunptr->un_adjval == 0) { 234 suptr->un_cnt--; 235 if (i < suptr->un_cnt) 236 suptr->un_ent[i] = 237 suptr->un_ent[suptr->un_cnt]; 238 } 239 return(0); 240 } 241 242 /* Didn't find the right entry - create it */ 243 if (adjval == 0) 244 return(0); 245 if (suptr->un_cnt == SEMUME) 246 return(EINVAL); 247 248 sunptr = &suptr->un_ent[suptr->un_cnt]; 249 suptr->un_cnt++; 250 sunptr->un_adjval = adjval; 251 sunptr->un_id = semid; 252 sunptr->un_num = semnum; 253 return(0); 254 } 255 256 void 257 semundo_clear(semid, semnum) 258 int semid, semnum; 259 { 260 struct sem_undo *suptr; 261 262 for (suptr = semu_list; suptr != NULL; suptr = suptr->un_next) { 263 struct undo *sunptr; 264 int i; 265 266 sunptr = &suptr->un_ent[0]; 267 for (i = 0; i < suptr->un_cnt; i++, sunptr++) { 268 if (sunptr->un_id == semid) { 269 if (semnum == -1 || sunptr->un_num == semnum) { 270 suptr->un_cnt--; 271 if (i < suptr->un_cnt) { 272 suptr->un_ent[i] = 273 suptr->un_ent[suptr->un_cnt]; 274 i--, sunptr--; 275 } 276 } 277 if (semnum != -1) 278 break; 279 } 280 } 281 } 282 } 283 284 int 285 sys_____semctl13(p, v, retval) 286 struct proc *p; 287 void *v; 288 register_t *retval; 289 { 290 struct sys_____semctl13_args /* { 291 syscallarg(int) semid; 292 syscallarg(int) semnum; 293 syscallarg(int) cmd; 294 syscallarg(union __semun *) arg; 295 } */ *uap = v; 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(p, v, retval) 474 struct proc *p; 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 = p->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(p, v, retval) 564 struct proc *p; 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 int semid = SCARG(uap, semid); 574 int nsops = SCARG(uap, nsops); 575 struct sembuf sops[MAX_SOPS]; 576 struct semid_ds *semaptr; 577 struct sembuf *sopptr = NULL; 578 struct __sem *semptr = NULL; 579 struct sem_undo *suptr = NULL; 580 struct ucred *cred = p->p_ucred; 581 int i, j, eval; 582 int do_wakeup, do_undos; 583 584 SEM_PRINTF(("call to semop(%d, %p, %d)\n", semid, sops, nsops)); 585 586 semid = IPCID_TO_IX(semid); /* Convert back to zero origin */ 587 588 if (semid < 0 || semid >= seminfo.semmsl) 589 return(EINVAL); 590 591 semaptr = &sema[semid]; 592 if ((semaptr->sem_perm.mode & SEM_ALLOC) == 0 || 593 semaptr->sem_perm._seq != IPCID_TO_SEQ(SCARG(uap, semid))) 594 return(EINVAL); 595 596 if ((eval = ipcperm(cred, &semaptr->sem_perm, IPC_W))) { 597 SEM_PRINTF(("eval = %d from ipaccess\n", eval)); 598 return(eval); 599 } 600 601 if (nsops > MAX_SOPS) { 602 SEM_PRINTF(("too many sops (max=%d, nsops=%d)\n", MAX_SOPS, nsops)); 603 return(E2BIG); 604 } 605 606 if ((eval = copyin(SCARG(uap, sops), sops, nsops * sizeof(sops[0]))) 607 != 0) { 608 SEM_PRINTF(("eval = %d from copyin(%p, %p, %d)\n", eval, 609 SCARG(uap, sops), &sops, nsops * sizeof(sops[0]))); 610 return(eval); 611 } 612 613 /* 614 * Loop trying to satisfy the vector of requests. 615 * If we reach a point where we must wait, any requests already 616 * performed are rolled back and we go to sleep until some other 617 * process wakes us up. At this point, we start all over again. 618 * 619 * This ensures that from the perspective of other tasks, a set 620 * of requests is atomic (never partially satisfied). 621 */ 622 do_undos = 0; 623 624 for (;;) { 625 do_wakeup = 0; 626 627 for (i = 0; i < nsops; i++) { 628 sopptr = &sops[i]; 629 630 if (sopptr->sem_num >= semaptr->sem_nsems) 631 return(EFBIG); 632 633 semptr = &semaptr->_sem_base[sopptr->sem_num]; 634 635 SEM_PRINTF(("semop: semaptr=%x, sem_base=%x, semptr=%x, sem[%d]=%d : op=%d, flag=%s\n", 636 semaptr, semaptr->_sem_base, semptr, 637 sopptr->sem_num, semptr->semval, sopptr->sem_op, 638 (sopptr->sem_flg & IPC_NOWAIT) ? "nowait" : "wait")); 639 640 if (sopptr->sem_op < 0) { 641 if ((int)(semptr->semval + 642 sopptr->sem_op) < 0) { 643 SEM_PRINTF(("semop: can't do it now\n")); 644 break; 645 } else { 646 semptr->semval += sopptr->sem_op; 647 if (semptr->semval == 0 && 648 semptr->semzcnt > 0) 649 do_wakeup = 1; 650 } 651 if (sopptr->sem_flg & SEM_UNDO) 652 do_undos = 1; 653 } else if (sopptr->sem_op == 0) { 654 if (semptr->semval > 0) { 655 SEM_PRINTF(("semop: not zero now\n")); 656 break; 657 } 658 } else { 659 if (semptr->semncnt > 0) 660 do_wakeup = 1; 661 semptr->semval += sopptr->sem_op; 662 if (sopptr->sem_flg & SEM_UNDO) 663 do_undos = 1; 664 } 665 } 666 667 /* 668 * Did we get through the entire vector? 669 */ 670 if (i >= nsops) 671 goto done; 672 673 /* 674 * No ... rollback anything that we've already done 675 */ 676 SEM_PRINTF(("semop: rollback 0 through %d\n", i-1)); 677 for (j = 0; j < i; j++) 678 semaptr->_sem_base[sops[j].sem_num].semval -= 679 sops[j].sem_op; 680 681 /* 682 * If the request that we couldn't satisfy has the 683 * NOWAIT flag set then return with EAGAIN. 684 */ 685 if (sopptr->sem_flg & IPC_NOWAIT) 686 return(EAGAIN); 687 688 if (sopptr->sem_op == 0) 689 semptr->semzcnt++; 690 else 691 semptr->semncnt++; 692 693 SEM_PRINTF(("semop: good night!\n")); 694 eval = tsleep((caddr_t)semaptr, (PZERO - 4) | PCATCH, 695 "semwait", 0); 696 SEM_PRINTF(("semop: good morning (eval=%d)!\n", eval)); 697 698 suptr = NULL; /* sem_undo may have been reallocated */ 699 700 if (eval != 0) 701 return(EINTR); 702 SEM_PRINTF(("semop: good morning!\n")); 703 704 /* 705 * Make sure that the semaphore still exists 706 */ 707 if ((semaptr->sem_perm.mode & SEM_ALLOC) == 0 || 708 semaptr->sem_perm._seq != IPCID_TO_SEQ(SCARG(uap, semid))) { 709 /* The man page says to return EIDRM. */ 710 /* Unfortunately, BSD doesn't define that code! */ 711 #ifdef EIDRM 712 return(EIDRM); 713 #else 714 return(EINVAL); 715 #endif 716 } 717 718 /* 719 * The semaphore is still alive. Readjust the count of 720 * waiting processes. 721 */ 722 if (sopptr->sem_op == 0) 723 semptr->semzcnt--; 724 else 725 semptr->semncnt--; 726 } 727 728 done: 729 /* 730 * Process any SEM_UNDO requests. 731 */ 732 if (do_undos) { 733 for (i = 0; i < nsops; i++) { 734 /* 735 * We only need to deal with SEM_UNDO's for non-zero 736 * op's. 737 */ 738 int adjval; 739 740 if ((sops[i].sem_flg & SEM_UNDO) == 0) 741 continue; 742 adjval = sops[i].sem_op; 743 if (adjval == 0) 744 continue; 745 eval = semundo_adjust(p, &suptr, semid, 746 sops[i].sem_num, -adjval); 747 if (eval == 0) 748 continue; 749 750 /* 751 * Oh-Oh! We ran out of either sem_undo's or undo's. 752 * Rollback the adjustments to this point and then 753 * rollback the semaphore ups and down so we can return 754 * with an error with all structures restored. We 755 * rollback the undo's in the exact reverse order that 756 * we applied them. This guarantees that we won't run 757 * out of space as we roll things back out. 758 */ 759 for (j = i - 1; j >= 0; j--) { 760 if ((sops[j].sem_flg & SEM_UNDO) == 0) 761 continue; 762 adjval = sops[j].sem_op; 763 if (adjval == 0) 764 continue; 765 if (semundo_adjust(p, &suptr, semid, 766 sops[j].sem_num, adjval) != 0) 767 panic("semop - can't undo undos"); 768 } 769 770 for (j = 0; j < nsops; j++) 771 semaptr->_sem_base[sops[j].sem_num].semval -= 772 sops[j].sem_op; 773 774 SEM_PRINTF(("eval = %d from semundo_adjust\n", eval)); 775 return(eval); 776 } /* loop through the sops */ 777 } /* if (do_undos) */ 778 779 /* We're definitely done - set the sempid's */ 780 for (i = 0; i < nsops; i++) { 781 sopptr = &sops[i]; 782 semptr = &semaptr->_sem_base[sopptr->sem_num]; 783 semptr->sempid = p->p_pid; 784 } 785 786 /* Do a wakeup if any semaphore was up'd. */ 787 if (do_wakeup) { 788 SEM_PRINTF(("semop: doing wakeup\n")); 789 #ifdef SEM_WAKEUP 790 sem_wakeup((caddr_t)semaptr); 791 #else 792 wakeup((caddr_t)semaptr); 793 #endif 794 SEM_PRINTF(("semop: back from wakeup\n")); 795 } 796 SEM_PRINTF(("semop: done\n")); 797 *retval = 0; 798 return(0); 799 } 800 801 /* 802 * Go through the undo structures for this process and apply the adjustments to 803 * semaphores. 804 */ 805 void 806 semexit(p) 807 struct proc *p; 808 { 809 struct sem_undo *suptr; 810 struct sem_undo **supptr; 811 812 /* 813 * Go through the chain of undo vectors looking for one associated with 814 * this process. 815 */ 816 817 for (supptr = &semu_list; (suptr = *supptr) != NULL; 818 supptr = &suptr->un_next) { 819 if (suptr->un_proc == p) 820 break; 821 } 822 823 /* 824 * If there is no undo vector, skip to the end. 825 */ 826 827 if (suptr == NULL) 828 return; 829 830 /* 831 * We now have an undo vector for this process. 832 */ 833 834 SEM_PRINTF(("proc @%p has undo structure with %d entries\n", p, 835 suptr->un_cnt)); 836 837 /* 838 * If there are any active undo elements then process them. 839 */ 840 if (suptr->un_cnt > 0) { 841 int ix; 842 843 for (ix = 0; ix < suptr->un_cnt; ix++) { 844 int semid = suptr->un_ent[ix].un_id; 845 int semnum = suptr->un_ent[ix].un_num; 846 int adjval = suptr->un_ent[ix].un_adjval; 847 struct semid_ds *semaptr; 848 849 semaptr = &sema[semid]; 850 if ((semaptr->sem_perm.mode & SEM_ALLOC) == 0) 851 panic("semexit - semid not allocated"); 852 if (semnum >= semaptr->sem_nsems) 853 panic("semexit - semnum out of range"); 854 855 SEM_PRINTF(("semexit: %p id=%d num=%d(adj=%d) ; sem=%d\n", 856 suptr->un_proc, suptr->un_ent[ix].un_id, 857 suptr->un_ent[ix].un_num, 858 suptr->un_ent[ix].un_adjval, 859 semaptr->_sem_base[semnum].semval)); 860 861 if (adjval < 0 && 862 semaptr->_sem_base[semnum].semval < -adjval) 863 semaptr->_sem_base[semnum].semval = 0; 864 else 865 semaptr->_sem_base[semnum].semval += adjval; 866 867 #ifdef SEM_WAKEUP 868 sem_wakeup((caddr_t)semaptr); 869 #else 870 wakeup((caddr_t)semaptr); 871 #endif 872 SEM_PRINTF(("semexit: back from wakeup\n")); 873 } 874 } 875 876 /* 877 * Deallocate the undo vector. 878 */ 879 SEM_PRINTF(("removing vector\n")); 880 suptr->un_proc = NULL; 881 *supptr = suptr->un_next; 882 } 883