sys_lwp.c revision 1.17 1 1.17 ad /* $NetBSD: sys_lwp.c,v 1.17 2007/03/21 18:26:00 ad Exp $ */
2 1.2 ad
3 1.2 ad /*-
4 1.2 ad * Copyright (c) 2001, 2006, 2007 The NetBSD Foundation, Inc.
5 1.2 ad * All rights reserved.
6 1.2 ad *
7 1.2 ad * This code is derived from software contributed to The NetBSD Foundation
8 1.2 ad * by Nathan J. Williams, and Andrew Doran.
9 1.2 ad *
10 1.2 ad * Redistribution and use in source and binary forms, with or without
11 1.2 ad * modification, are permitted provided that the following conditions
12 1.2 ad * are met:
13 1.2 ad * 1. Redistributions of source code must retain the above copyright
14 1.2 ad * notice, this list of conditions and the following disclaimer.
15 1.2 ad * 2. Redistributions in binary form must reproduce the above copyright
16 1.2 ad * notice, this list of conditions and the following disclaimer in the
17 1.2 ad * documentation and/or other materials provided with the distribution.
18 1.2 ad * 3. All advertising materials mentioning features or use of this software
19 1.2 ad * must display the following acknowledgement:
20 1.2 ad * This product includes software developed by the NetBSD
21 1.2 ad * Foundation, Inc. and its contributors.
22 1.2 ad * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.2 ad * contributors may be used to endorse or promote products derived
24 1.2 ad * from this software without specific prior written permission.
25 1.2 ad *
26 1.2 ad * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.2 ad * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.2 ad * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.2 ad * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.2 ad * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.2 ad * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.2 ad * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.2 ad * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.2 ad * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.2 ad * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.2 ad * POSSIBILITY OF SUCH DAMAGE.
37 1.2 ad */
38 1.2 ad
39 1.2 ad /*
40 1.2 ad * Lightweight process (LWP) system calls. See kern_lwp.c for a description
41 1.2 ad * of LWPs.
42 1.2 ad */
43 1.2 ad
44 1.2 ad #include <sys/cdefs.h>
45 1.17 ad __KERNEL_RCSID(0, "$NetBSD: sys_lwp.c,v 1.17 2007/03/21 18:26:00 ad Exp $");
46 1.2 ad
47 1.2 ad #include <sys/param.h>
48 1.2 ad #include <sys/systm.h>
49 1.2 ad #include <sys/pool.h>
50 1.2 ad #include <sys/proc.h>
51 1.2 ad #include <sys/types.h>
52 1.2 ad #include <sys/syscallargs.h>
53 1.2 ad #include <sys/kauth.h>
54 1.2 ad #include <sys/kmem.h>
55 1.2 ad #include <sys/sleepq.h>
56 1.2 ad
57 1.2 ad #include <uvm/uvm_extern.h>
58 1.2 ad
59 1.2 ad #define LWP_UNPARK_MAX 1024
60 1.2 ad
61 1.2 ad syncobj_t lwp_park_sobj = {
62 1.16 ad SOBJ_SLEEPQ_FIFO,
63 1.2 ad sleepq_unsleep,
64 1.7 yamt sleepq_changepri,
65 1.7 yamt sleepq_lendpri,
66 1.7 yamt syncobj_noowner,
67 1.2 ad };
68 1.2 ad
69 1.2 ad sleeptab_t lwp_park_tab;
70 1.2 ad
71 1.2 ad void
72 1.2 ad lwp_sys_init(void)
73 1.2 ad {
74 1.2 ad sleeptab_init(&lwp_park_tab);
75 1.2 ad }
76 1.2 ad
77 1.2 ad /* ARGSUSED */
78 1.2 ad int
79 1.2 ad sys__lwp_create(struct lwp *l, void *v, register_t *retval)
80 1.2 ad {
81 1.2 ad struct sys__lwp_create_args /* {
82 1.2 ad syscallarg(const ucontext_t *) ucp;
83 1.2 ad syscallarg(u_long) flags;
84 1.2 ad syscallarg(lwpid_t *) new_lwp;
85 1.2 ad } */ *uap = v;
86 1.2 ad struct proc *p = l->l_proc;
87 1.2 ad struct lwp *l2;
88 1.2 ad vaddr_t uaddr;
89 1.6 thorpej bool inmem;
90 1.2 ad ucontext_t *newuc;
91 1.2 ad int error, lid;
92 1.2 ad
93 1.2 ad newuc = pool_get(&lwp_uc_pool, PR_WAITOK);
94 1.2 ad
95 1.2 ad error = copyin(SCARG(uap, ucp), newuc, p->p_emul->e_ucsize);
96 1.2 ad if (error) {
97 1.2 ad pool_put(&lwp_uc_pool, newuc);
98 1.2 ad return error;
99 1.2 ad }
100 1.2 ad
101 1.2 ad /* XXX check against resource limits */
102 1.2 ad
103 1.2 ad inmem = uvm_uarea_alloc(&uaddr);
104 1.2 ad if (__predict_false(uaddr == 0)) {
105 1.2 ad pool_put(&lwp_uc_pool, newuc);
106 1.2 ad return ENOMEM;
107 1.2 ad }
108 1.2 ad
109 1.2 ad newlwp(l, p, uaddr, inmem,
110 1.2 ad SCARG(uap, flags) & LWP_DETACHED,
111 1.5 cube NULL, 0, p->p_emul->e_startlwp, newuc, &l2);
112 1.2 ad
113 1.2 ad /*
114 1.2 ad * Set the new LWP running, unless the caller has requested that
115 1.2 ad * it be created in suspended state. If the process is stopping,
116 1.2 ad * then the LWP is created stopped.
117 1.2 ad */
118 1.2 ad mutex_enter(&p->p_smutex);
119 1.2 ad lwp_lock(l2);
120 1.2 ad lid = l2->l_lid;
121 1.2 ad if ((SCARG(uap, flags) & LWP_SUSPENDED) == 0 &&
122 1.4 pavel (l->l_flag & (LW_WREBOOT | LW_WSUSPEND | LW_WEXIT)) == 0) {
123 1.2 ad if (p->p_stat == SSTOP || (p->p_sflag & PS_STOPPING) != 0)
124 1.2 ad l2->l_stat = LSSTOP;
125 1.2 ad else {
126 1.8 ad KASSERT(lwp_locked(l2, &sched_mutex));
127 1.2 ad p->p_nrlwps++;
128 1.2 ad l2->l_stat = LSRUN;
129 1.2 ad setrunqueue(l2);
130 1.2 ad }
131 1.2 ad } else
132 1.2 ad l2->l_stat = LSSUSPENDED;
133 1.2 ad lwp_unlock(l2);
134 1.2 ad mutex_exit(&p->p_smutex);
135 1.2 ad
136 1.2 ad error = copyout(&lid, SCARG(uap, new_lwp), sizeof(lid));
137 1.2 ad if (error)
138 1.2 ad return error;
139 1.2 ad
140 1.2 ad return 0;
141 1.2 ad }
142 1.2 ad
143 1.2 ad int
144 1.2 ad sys__lwp_exit(struct lwp *l, void *v, register_t *retval)
145 1.2 ad {
146 1.2 ad
147 1.2 ad lwp_exit(l);
148 1.2 ad return 0;
149 1.2 ad }
150 1.2 ad
151 1.2 ad int
152 1.2 ad sys__lwp_self(struct lwp *l, void *v, register_t *retval)
153 1.2 ad {
154 1.2 ad
155 1.2 ad *retval = l->l_lid;
156 1.2 ad return 0;
157 1.2 ad }
158 1.2 ad
159 1.2 ad int
160 1.2 ad sys__lwp_getprivate(struct lwp *l, void *v, register_t *retval)
161 1.2 ad {
162 1.2 ad
163 1.2 ad *retval = (uintptr_t)l->l_private;
164 1.2 ad return 0;
165 1.2 ad }
166 1.2 ad
167 1.2 ad int
168 1.2 ad sys__lwp_setprivate(struct lwp *l, void *v, register_t *retval)
169 1.2 ad {
170 1.2 ad struct sys__lwp_setprivate_args /* {
171 1.2 ad syscallarg(void *) ptr;
172 1.2 ad } */ *uap = v;
173 1.2 ad
174 1.2 ad l->l_private = SCARG(uap, ptr);
175 1.2 ad return 0;
176 1.2 ad }
177 1.2 ad
178 1.2 ad int
179 1.2 ad sys__lwp_suspend(struct lwp *l, void *v, register_t *retval)
180 1.2 ad {
181 1.2 ad struct sys__lwp_suspend_args /* {
182 1.2 ad syscallarg(lwpid_t) target;
183 1.2 ad } */ *uap = v;
184 1.2 ad struct proc *p = l->l_proc;
185 1.2 ad struct lwp *t;
186 1.2 ad int error;
187 1.2 ad
188 1.2 ad mutex_enter(&p->p_smutex);
189 1.2 ad if ((t = lwp_find(p, SCARG(uap, target))) == NULL) {
190 1.2 ad mutex_exit(&p->p_smutex);
191 1.2 ad return ESRCH;
192 1.2 ad }
193 1.2 ad
194 1.2 ad /*
195 1.2 ad * Check for deadlock, which is only possible when we're suspending
196 1.2 ad * ourself. XXX There is a short race here, as p_nrlwps is only
197 1.2 ad * incremented when an LWP suspends itself on the kernel/user
198 1.2 ad * boundary. It's still possible to kill -9 the process so we
199 1.2 ad * don't bother checking further.
200 1.2 ad */
201 1.2 ad lwp_lock(t);
202 1.2 ad if ((t == l && p->p_nrlwps == 1) ||
203 1.4 pavel (l->l_flag & (LW_WCORE | LW_WEXIT)) != 0) {
204 1.2 ad lwp_unlock(t);
205 1.2 ad mutex_exit(&p->p_smutex);
206 1.2 ad return EDEADLK;
207 1.2 ad }
208 1.2 ad
209 1.2 ad /*
210 1.2 ad * Suspend the LWP. XXX If it's on a different CPU, we should wait
211 1.2 ad * for it to be preempted, where it will put itself to sleep.
212 1.2 ad *
213 1.2 ad * Suspension of the current LWP will happen on return to userspace.
214 1.2 ad */
215 1.2 ad error = lwp_suspend(l, t);
216 1.2 ad mutex_exit(&p->p_smutex);
217 1.2 ad
218 1.2 ad return error;
219 1.2 ad }
220 1.2 ad
221 1.2 ad int
222 1.2 ad sys__lwp_continue(struct lwp *l, void *v, register_t *retval)
223 1.2 ad {
224 1.2 ad struct sys__lwp_continue_args /* {
225 1.2 ad syscallarg(lwpid_t) target;
226 1.2 ad } */ *uap = v;
227 1.2 ad int error;
228 1.2 ad struct proc *p = l->l_proc;
229 1.2 ad struct lwp *t;
230 1.2 ad
231 1.2 ad error = 0;
232 1.2 ad
233 1.2 ad mutex_enter(&p->p_smutex);
234 1.2 ad if ((t = lwp_find(p, SCARG(uap, target))) == NULL) {
235 1.2 ad mutex_exit(&p->p_smutex);
236 1.2 ad return ESRCH;
237 1.2 ad }
238 1.2 ad
239 1.2 ad lwp_lock(t);
240 1.2 ad lwp_continue(t);
241 1.2 ad mutex_exit(&p->p_smutex);
242 1.2 ad
243 1.2 ad return error;
244 1.2 ad }
245 1.2 ad
246 1.2 ad int
247 1.2 ad sys__lwp_wakeup(struct lwp *l, void *v, register_t *retval)
248 1.2 ad {
249 1.2 ad struct sys__lwp_wakeup_args /* {
250 1.2 ad syscallarg(lwpid_t) target;
251 1.2 ad } */ *uap = v;
252 1.2 ad struct lwp *t;
253 1.2 ad struct proc *p;
254 1.2 ad int error;
255 1.2 ad
256 1.2 ad p = l->l_proc;
257 1.2 ad mutex_enter(&p->p_smutex);
258 1.2 ad
259 1.2 ad if ((t = lwp_find(p, SCARG(uap, target))) == NULL) {
260 1.2 ad mutex_exit(&p->p_smutex);
261 1.2 ad return ESRCH;
262 1.2 ad }
263 1.2 ad
264 1.2 ad lwp_lock(t);
265 1.15 ad t->l_flag |= (LW_CANCELLED | LW_UNPARKED);
266 1.2 ad
267 1.2 ad if (t->l_stat != LSSLEEP) {
268 1.16 ad lwp_unlock(t);
269 1.2 ad error = ENODEV;
270 1.16 ad } else if ((t->l_flag & LW_SINTR) == 0) {
271 1.16 ad lwp_unlock(t);
272 1.2 ad error = EBUSY;
273 1.16 ad } else {
274 1.16 ad /* Wake it up. lwp_unsleep() will release the LWP lock. */
275 1.16 ad lwp_unsleep(t);
276 1.16 ad error = 0;
277 1.2 ad }
278 1.2 ad
279 1.2 ad mutex_exit(&p->p_smutex);
280 1.2 ad
281 1.2 ad return error;
282 1.2 ad }
283 1.2 ad
284 1.2 ad int
285 1.2 ad sys__lwp_wait(struct lwp *l, void *v, register_t *retval)
286 1.2 ad {
287 1.2 ad struct sys__lwp_wait_args /* {
288 1.2 ad syscallarg(lwpid_t) wait_for;
289 1.2 ad syscallarg(lwpid_t *) departed;
290 1.2 ad } */ *uap = v;
291 1.2 ad struct proc *p = l->l_proc;
292 1.2 ad int error;
293 1.2 ad lwpid_t dep;
294 1.2 ad
295 1.2 ad mutex_enter(&p->p_smutex);
296 1.2 ad error = lwp_wait1(l, SCARG(uap, wait_for), &dep, 0);
297 1.2 ad mutex_exit(&p->p_smutex);
298 1.2 ad
299 1.2 ad if (error)
300 1.2 ad return error;
301 1.2 ad
302 1.2 ad if (SCARG(uap, departed)) {
303 1.2 ad error = copyout(&dep, SCARG(uap, departed), sizeof(dep));
304 1.2 ad if (error)
305 1.2 ad return error;
306 1.2 ad }
307 1.2 ad
308 1.2 ad return 0;
309 1.2 ad }
310 1.2 ad
311 1.2 ad /* ARGSUSED */
312 1.2 ad int
313 1.2 ad sys__lwp_kill(struct lwp *l, void *v, register_t *retval)
314 1.2 ad {
315 1.2 ad struct sys__lwp_kill_args /* {
316 1.2 ad syscallarg(lwpid_t) target;
317 1.2 ad syscallarg(int) signo;
318 1.2 ad } */ *uap = v;
319 1.2 ad struct proc *p = l->l_proc;
320 1.2 ad struct lwp *t;
321 1.2 ad ksiginfo_t ksi;
322 1.2 ad int signo = SCARG(uap, signo);
323 1.2 ad int error = 0;
324 1.2 ad
325 1.2 ad if ((u_int)signo >= NSIG)
326 1.2 ad return EINVAL;
327 1.2 ad
328 1.2 ad KSI_INIT(&ksi);
329 1.2 ad ksi.ksi_signo = signo;
330 1.2 ad ksi.ksi_code = SI_USER;
331 1.2 ad ksi.ksi_pid = p->p_pid;
332 1.2 ad ksi.ksi_uid = kauth_cred_geteuid(l->l_cred);
333 1.2 ad ksi.ksi_lid = SCARG(uap, target);
334 1.2 ad
335 1.2 ad mutex_enter(&proclist_mutex);
336 1.2 ad mutex_enter(&p->p_smutex);
337 1.2 ad if ((t = lwp_find(p, ksi.ksi_lid)) == NULL)
338 1.2 ad error = ESRCH;
339 1.2 ad else if (signo != 0)
340 1.2 ad kpsignal2(p, &ksi);
341 1.2 ad mutex_exit(&p->p_smutex);
342 1.2 ad mutex_exit(&proclist_mutex);
343 1.2 ad
344 1.2 ad return error;
345 1.2 ad }
346 1.2 ad
347 1.2 ad int
348 1.2 ad sys__lwp_detach(struct lwp *l, void *v, register_t *retval)
349 1.2 ad {
350 1.2 ad struct sys__lwp_detach_args /* {
351 1.2 ad syscallarg(lwpid_t) target;
352 1.2 ad } */ *uap = v;
353 1.2 ad struct proc *p;
354 1.2 ad struct lwp *t;
355 1.2 ad lwpid_t target;
356 1.2 ad int error;
357 1.2 ad
358 1.2 ad target = SCARG(uap, target);
359 1.2 ad p = l->l_proc;
360 1.2 ad
361 1.2 ad mutex_enter(&p->p_smutex);
362 1.2 ad
363 1.2 ad if (l->l_lid == target)
364 1.2 ad t = l;
365 1.2 ad else {
366 1.2 ad /*
367 1.2 ad * We can't use lwp_find() here because the target might
368 1.2 ad * be a zombie.
369 1.2 ad */
370 1.2 ad LIST_FOREACH(t, &p->p_lwps, l_sibling)
371 1.2 ad if (t->l_lid == target)
372 1.2 ad break;
373 1.2 ad }
374 1.2 ad
375 1.2 ad /*
376 1.2 ad * If the LWP is already detached, there's nothing to do.
377 1.2 ad * If it's a zombie, we need to clean up after it. LSZOMB
378 1.2 ad * is visible with the proc mutex held.
379 1.2 ad *
380 1.2 ad * After we have detached or released the LWP, kick any
381 1.2 ad * other LWPs that may be sitting in _lwp_wait(), waiting
382 1.2 ad * for the target LWP to exit.
383 1.2 ad */
384 1.2 ad if (t != NULL && t->l_stat != LSIDL) {
385 1.2 ad if ((t->l_prflag & LPR_DETACHED) == 0) {
386 1.2 ad p->p_ndlwps++;
387 1.2 ad t->l_prflag |= LPR_DETACHED;
388 1.2 ad if (t->l_stat == LSZOMB) {
389 1.17 ad /* Releases proc mutex. */
390 1.17 ad lwp_free(t, false, false);
391 1.2 ad return 0;
392 1.2 ad }
393 1.2 ad error = 0;
394 1.17 ad
395 1.17 ad /*
396 1.17 ad * Have any LWPs sleeping in lwp_wait() recheck
397 1.17 ad * for deadlock.
398 1.17 ad */
399 1.17 ad cv_broadcast(&p->p_lwpcv);
400 1.2 ad } else
401 1.2 ad error = EINVAL;
402 1.2 ad } else
403 1.2 ad error = ESRCH;
404 1.2 ad
405 1.2 ad mutex_exit(&p->p_smutex);
406 1.2 ad
407 1.2 ad return error;
408 1.2 ad }
409 1.2 ad
410 1.2 ad static inline wchan_t
411 1.2 ad lwp_park_wchan(struct proc *p, const void *hint)
412 1.2 ad {
413 1.2 ad return (wchan_t)((uintptr_t)p ^ (uintptr_t)hint);
414 1.2 ad }
415 1.2 ad
416 1.2 ad /*
417 1.2 ad * 'park' an LWP waiting on a user-level synchronisation object. The LWP
418 1.2 ad * will remain parked until another LWP in the same process calls in and
419 1.2 ad * requests that it be unparked.
420 1.2 ad */
421 1.2 ad int
422 1.2 ad sys__lwp_park(struct lwp *l, void *v, register_t *retval)
423 1.2 ad {
424 1.2 ad struct sys__lwp_park_args /* {
425 1.2 ad syscallarg(const struct timespec *) ts;
426 1.2 ad syscallarg(ucontext_t *) uc;
427 1.2 ad syscallarg(const void *) hint;
428 1.2 ad } */ *uap = v;
429 1.2 ad const struct timespec *tsp;
430 1.2 ad struct timespec ts, tsx;
431 1.2 ad struct timeval tv;
432 1.2 ad sleepq_t *sq;
433 1.2 ad wchan_t wchan;
434 1.2 ad int timo, error;
435 1.2 ad
436 1.2 ad /* Fix up the given timeout value. */
437 1.2 ad if ((tsp = SCARG(uap, ts)) != NULL) {
438 1.2 ad if ((error = copyin(tsp, &ts, sizeof(ts))) != 0)
439 1.2 ad return error;
440 1.2 ad getnanotime(&tsx);
441 1.2 ad timespecsub(&ts, &tsx, &ts);
442 1.2 ad tv.tv_sec = ts.tv_sec;
443 1.2 ad tv.tv_usec = ts.tv_nsec / 1000;
444 1.2 ad if (tv.tv_sec < 0 || (tv.tv_sec == 0 && tv.tv_usec < 0))
445 1.2 ad return ETIMEDOUT;
446 1.2 ad if ((error = itimerfix(&tv)) != 0)
447 1.2 ad return error;
448 1.2 ad timo = tvtohz(&tv);
449 1.2 ad } else
450 1.2 ad timo = 0;
451 1.2 ad
452 1.2 ad /* Find and lock the sleep queue. */
453 1.2 ad wchan = lwp_park_wchan(l->l_proc, SCARG(uap, hint));
454 1.2 ad sq = sleeptab_lookup(&lwp_park_tab, wchan);
455 1.2 ad
456 1.2 ad /*
457 1.2 ad * Before going the full route and blocking, check to see if an
458 1.2 ad * unpark op is pending.
459 1.2 ad */
460 1.9 ad sleepq_lwp_lock(l);
461 1.8 ad if ((l->l_flag & (LW_CANCELLED | LW_UNPARKED)) != 0) {
462 1.8 ad l->l_flag &= ~(LW_CANCELLED | LW_UNPARKED);
463 1.9 ad sleepq_lwp_unlock(l);
464 1.2 ad sleepq_unlock(sq);
465 1.2 ad return EALREADY;
466 1.2 ad }
467 1.9 ad #if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
468 1.8 ad lwp_unlock_to(l, sq->sq_mutex);
469 1.9 ad #endif
470 1.2 ad
471 1.2 ad /*
472 1.2 ad * For now we ignore the ucontext argument. In the future, we may
473 1.2 ad * put our stack up to be recycled. If it's binned, a trampoline
474 1.2 ad * function could call sleepq_unblock() on our behalf.
475 1.2 ad */
476 1.10 ad KERNEL_UNLOCK_ALL(l, &l->l_biglocks); /* XXX for compat32 */
477 1.2 ad sleepq_block(sq, sched_kpri(l), wchan, "parked", timo, 1,
478 1.2 ad &lwp_park_sobj);
479 1.2 ad error = sleepq_unblock(timo, 1);
480 1.13 yamt switch (error) {
481 1.14 yamt case EWOULDBLOCK:
482 1.14 yamt error = ETIMEDOUT;
483 1.14 yamt break;
484 1.14 yamt case ERESTART:
485 1.14 yamt error = EINTR;
486 1.14 yamt break;
487 1.14 yamt default:
488 1.14 yamt /* nothing */
489 1.14 yamt break;
490 1.13 yamt }
491 1.13 yamt return error;
492 1.2 ad }
493 1.2 ad
494 1.2 ad int
495 1.2 ad sys__lwp_unpark(struct lwp *l, void *v, register_t *retval)
496 1.2 ad {
497 1.2 ad struct sys__lwp_unpark_args /* {
498 1.2 ad syscallarg(lwpid_t) target;
499 1.2 ad syscallarg(const void *) hint;
500 1.2 ad } */ *uap = v;
501 1.2 ad struct proc *p;
502 1.2 ad struct lwp *t;
503 1.2 ad sleepq_t *sq;
504 1.2 ad lwpid_t target;
505 1.2 ad wchan_t wchan;
506 1.2 ad int swapin;
507 1.2 ad
508 1.2 ad p = l->l_proc;
509 1.2 ad target = SCARG(uap, target);
510 1.2 ad
511 1.2 ad /*
512 1.2 ad * Easy case: search for the LWP on the sleep queue. If
513 1.2 ad * it's parked, remove it from the queue and set running.
514 1.2 ad */
515 1.2 ad wchan = lwp_park_wchan(p, SCARG(uap, hint));
516 1.2 ad sq = sleeptab_lookup(&lwp_park_tab, wchan);
517 1.2 ad
518 1.2 ad TAILQ_FOREACH(t, &sq->sq_queue, l_sleepchain)
519 1.2 ad if (t->l_proc == p && t->l_lid == target)
520 1.2 ad break;
521 1.2 ad
522 1.15 ad if (__predict_true(t != NULL)) {
523 1.15 ad swapin = sleepq_remove(sq, t);
524 1.2 ad sleepq_unlock(sq);
525 1.15 ad if (swapin)
526 1.15 ad uvm_kick_scheduler();
527 1.15 ad return 0;
528 1.15 ad }
529 1.15 ad
530 1.15 ad /*
531 1.15 ad * The LWP hasn't parked yet. Take the hit and mark the
532 1.15 ad * operation as pending.
533 1.15 ad */
534 1.15 ad sleepq_unlock(sq);
535 1.15 ad mutex_enter(&p->p_smutex);
536 1.15 ad if ((t = lwp_find(p, target)) == NULL) {
537 1.2 ad mutex_exit(&p->p_smutex);
538 1.15 ad return ESRCH;
539 1.15 ad }
540 1.15 ad lwp_lock(t);
541 1.2 ad
542 1.15 ad /*
543 1.15 ad * It may not have parked yet, we may have raced, or it
544 1.15 ad * is parked on a different user sync object.
545 1.15 ad */
546 1.15 ad if (t->l_syncobj == &lwp_park_sobj) {
547 1.15 ad /* Releases the LWP lock. */
548 1.16 ad lwp_unsleep(t);
549 1.15 ad } else {
550 1.15 ad /*
551 1.15 ad * Set the operation pending. The next call to _lwp_park
552 1.15 ad * will return early.
553 1.15 ad */
554 1.15 ad t->l_flag |= LW_UNPARKED;
555 1.15 ad lwp_unlock(t);
556 1.2 ad }
557 1.2 ad
558 1.15 ad mutex_exit(&p->p_smutex);
559 1.2 ad return 0;
560 1.2 ad }
561 1.2 ad
562 1.2 ad int
563 1.2 ad sys__lwp_unpark_all(struct lwp *l, void *v, register_t *retval)
564 1.2 ad {
565 1.2 ad struct sys__lwp_unpark_all_args /* {
566 1.2 ad syscallarg(const lwpid_t *) targets;
567 1.2 ad syscallarg(size_t) ntargets;
568 1.2 ad syscallarg(const void *) hint;
569 1.2 ad } */ *uap = v;
570 1.2 ad struct proc *p;
571 1.2 ad struct lwp *t;
572 1.2 ad sleepq_t *sq;
573 1.2 ad wchan_t wchan;
574 1.2 ad lwpid_t targets[32], *tp, *tpp, *tmax, target;
575 1.2 ad int swapin, error;
576 1.15 ad u_int ntargets;
577 1.2 ad size_t sz;
578 1.2 ad
579 1.2 ad p = l->l_proc;
580 1.2 ad ntargets = SCARG(uap, ntargets);
581 1.2 ad
582 1.2 ad if (SCARG(uap, targets) == NULL) {
583 1.2 ad /*
584 1.2 ad * Let the caller know how much we are willing to do, and
585 1.2 ad * let it unpark the LWPs in blocks.
586 1.2 ad */
587 1.2 ad *retval = LWP_UNPARK_MAX;
588 1.2 ad return 0;
589 1.2 ad }
590 1.2 ad if (ntargets > LWP_UNPARK_MAX || ntargets == 0)
591 1.2 ad return EINVAL;
592 1.2 ad
593 1.2 ad /*
594 1.2 ad * Copy in the target array. If it's a small number of LWPs, then
595 1.2 ad * place the numbers on the stack.
596 1.2 ad */
597 1.2 ad sz = sizeof(target) * ntargets;
598 1.2 ad if (sz <= sizeof(targets))
599 1.2 ad tp = targets;
600 1.2 ad else {
601 1.2 ad KERNEL_LOCK(1, l); /* XXXSMP */
602 1.2 ad tp = kmem_alloc(sz, KM_SLEEP);
603 1.2 ad KERNEL_UNLOCK_ONE(l); /* XXXSMP */
604 1.2 ad if (tp == NULL)
605 1.2 ad return ENOMEM;
606 1.2 ad }
607 1.2 ad error = copyin(SCARG(uap, targets), tp, sz);
608 1.2 ad if (error != 0) {
609 1.2 ad if (tp != targets) {
610 1.2 ad KERNEL_LOCK(1, l); /* XXXSMP */
611 1.2 ad kmem_free(tp, sz);
612 1.2 ad KERNEL_UNLOCK_ONE(l); /* XXXSMP */
613 1.2 ad }
614 1.2 ad return error;
615 1.2 ad }
616 1.2 ad
617 1.2 ad swapin = 0;
618 1.2 ad wchan = lwp_park_wchan(p, SCARG(uap, hint));
619 1.2 ad sq = sleeptab_lookup(&lwp_park_tab, wchan);
620 1.2 ad
621 1.2 ad for (tmax = tp + ntargets, tpp = tp; tpp < tmax; tpp++) {
622 1.2 ad target = *tpp;
623 1.2 ad
624 1.2 ad /*
625 1.2 ad * Easy case: search for the LWP on the sleep queue. If
626 1.2 ad * it's parked, remove it from the queue and set running.
627 1.2 ad */
628 1.2 ad TAILQ_FOREACH(t, &sq->sq_queue, l_sleepchain)
629 1.2 ad if (t->l_proc == p && t->l_lid == target)
630 1.2 ad break;
631 1.2 ad
632 1.2 ad if (t != NULL) {
633 1.2 ad swapin |= sleepq_remove(sq, t);
634 1.2 ad continue;
635 1.2 ad }
636 1.2 ad
637 1.2 ad /*
638 1.2 ad * The LWP hasn't parked yet. Take the hit and
639 1.2 ad * mark the operation as pending.
640 1.2 ad */
641 1.2 ad sleepq_unlock(sq);
642 1.2 ad mutex_enter(&p->p_smutex);
643 1.2 ad if ((t = lwp_find(p, target)) == NULL) {
644 1.2 ad mutex_exit(&p->p_smutex);
645 1.2 ad sleepq_lock(sq);
646 1.2 ad continue;
647 1.2 ad }
648 1.2 ad lwp_lock(t);
649 1.2 ad
650 1.15 ad /*
651 1.15 ad * It may not have parked yet, we may have raced, or
652 1.15 ad * it is parked on a different user sync object.
653 1.15 ad */
654 1.15 ad if (t->l_syncobj == &lwp_park_sobj) {
655 1.15 ad /* Releases the LWP lock. */
656 1.16 ad lwp_unsleep(t);
657 1.2 ad } else {
658 1.2 ad /*
659 1.15 ad * Set the operation pending. The next call to
660 1.15 ad * _lwp_park will return early.
661 1.2 ad */
662 1.8 ad t->l_flag |= LW_UNPARKED;
663 1.2 ad lwp_unlock(t);
664 1.2 ad }
665 1.15 ad
666 1.15 ad mutex_exit(&p->p_smutex);
667 1.15 ad sleepq_lock(sq);
668 1.2 ad }
669 1.2 ad
670 1.2 ad sleepq_unlock(sq);
671 1.2 ad if (tp != targets) {
672 1.2 ad KERNEL_LOCK(1, l); /* XXXSMP */
673 1.2 ad kmem_free(tp, sz);
674 1.2 ad KERNEL_UNLOCK_ONE(l); /* XXXSMP */
675 1.2 ad }
676 1.2 ad if (swapin)
677 1.3 ad uvm_kick_scheduler();
678 1.15 ad
679 1.2 ad return 0;
680 1.2 ad }
681