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