Home | History | Annotate | Line # | Download | only in kern
sys_lwp.c revision 1.3.2.6
      1  1.3.2.6   yamt /*	$NetBSD: sys_lwp.c,v 1.3.2.6 2007/03/24 14:56:04 yamt 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.3.2.6   yamt __KERNEL_RCSID(0, "$NetBSD: sys_lwp.c,v 1.3.2.6 2007/03/24 14:56:04 yamt 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.3.2.6   yamt 	SOBJ_SLEEPQ_FIFO,
     63      1.2     ad 	sleepq_unsleep,
     64  1.3.2.2   yamt 	sleepq_changepri,
     65  1.3.2.2   yamt 	sleepq_lendpri,
     66  1.3.2.2   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.3.2.2   yamt 	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.3.2.2   yamt 	    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.3.2.2   yamt 	    (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.3.2.5  rmind 			KASSERT(lwp_locked(l2, l2->l_cpu->ci_schedstate.spc_mutex));
    127      1.2     ad 			p->p_nrlwps++;
    128      1.2     ad 			l2->l_stat = LSRUN;
    129  1.3.2.4  rmind 			sched_enqueue(l2, false);
    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.3.2.2   yamt 	    (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.3.2.6   yamt 	t->l_flag |= (LW_CANCELLED | LW_UNPARKED);
    266      1.2     ad 
    267      1.2     ad 	if (t->l_stat != LSSLEEP) {
    268  1.3.2.6   yamt 		lwp_unlock(t);
    269      1.2     ad 		error = ENODEV;
    270  1.3.2.6   yamt 	} else if ((t->l_flag & LW_SINTR) == 0) {
    271  1.3.2.6   yamt 		lwp_unlock(t);
    272      1.2     ad 		error = EBUSY;
    273  1.3.2.6   yamt 	} else {
    274  1.3.2.6   yamt 		/* Wake it up.  lwp_unsleep() will release the LWP lock. */
    275  1.3.2.6   yamt 		lwp_unsleep(t);
    276  1.3.2.6   yamt 		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.3.2.6   yamt 				/* Releases proc mutex. */
    390  1.3.2.6   yamt 				lwp_free(t, false, false);
    391      1.2     ad 				return 0;
    392      1.2     ad 			}
    393      1.2     ad 			error = 0;
    394  1.3.2.6   yamt 
    395  1.3.2.6   yamt 			/*
    396  1.3.2.6   yamt 			 * Have any LWPs sleeping in lwp_wait() recheck
    397  1.3.2.6   yamt 			 * for deadlock.
    398  1.3.2.6   yamt 			 */
    399  1.3.2.6   yamt 			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.3.2.3  rmind 	sleepq_lwp_lock(l);
    461  1.3.2.3  rmind 	if ((l->l_flag & (LW_CANCELLED | LW_UNPARKED)) != 0) {
    462  1.3.2.3  rmind 		l->l_flag &= ~(LW_CANCELLED | LW_UNPARKED);
    463      1.2     ad 		sleepq_lwp_unlock(l);
    464      1.2     ad 		sleepq_unlock(sq);
    465      1.2     ad 		return EALREADY;
    466      1.2     ad 	}
    467  1.3.2.3  rmind #if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
    468  1.3.2.3  rmind 	lwp_unlock_to(l, sq->sq_mutex);
    469  1.3.2.3  rmind #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.3.2.3  rmind 	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.3.2.6   yamt 	switch (error) {
    481  1.3.2.6   yamt 	case EWOULDBLOCK:
    482  1.3.2.6   yamt 		error = ETIMEDOUT;
    483  1.3.2.6   yamt 		break;
    484  1.3.2.6   yamt 	case ERESTART:
    485  1.3.2.6   yamt 		error = EINTR;
    486  1.3.2.6   yamt 		break;
    487  1.3.2.6   yamt 	default:
    488  1.3.2.6   yamt 		/* nothing */
    489  1.3.2.6   yamt 		break;
    490  1.3.2.6   yamt 	}
    491  1.3.2.6   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.3.2.6   yamt 	if (__predict_true(t != NULL)) {
    523  1.3.2.6   yamt 		swapin = sleepq_remove(sq, t);
    524      1.2     ad 		sleepq_unlock(sq);
    525  1.3.2.6   yamt 		if (swapin)
    526  1.3.2.6   yamt 			uvm_kick_scheduler();
    527  1.3.2.6   yamt 		return 0;
    528  1.3.2.6   yamt 	}
    529  1.3.2.6   yamt 
    530  1.3.2.6   yamt 	/*
    531  1.3.2.6   yamt 	 * The LWP hasn't parked yet.  Take the hit and mark the
    532  1.3.2.6   yamt 	 * operation as pending.
    533  1.3.2.6   yamt 	 */
    534  1.3.2.6   yamt 	sleepq_unlock(sq);
    535  1.3.2.6   yamt 	mutex_enter(&p->p_smutex);
    536  1.3.2.6   yamt 	if ((t = lwp_find(p, target)) == NULL) {
    537      1.2     ad 		mutex_exit(&p->p_smutex);
    538  1.3.2.6   yamt 		return ESRCH;
    539  1.3.2.6   yamt 	}
    540  1.3.2.6   yamt 	lwp_lock(t);
    541      1.2     ad 
    542  1.3.2.6   yamt 	/*
    543  1.3.2.6   yamt 	 * It may not have parked yet, we may have raced, or it
    544  1.3.2.6   yamt 	 * is parked on a different user sync object.
    545  1.3.2.6   yamt 	 */
    546  1.3.2.6   yamt 	if (t->l_syncobj == &lwp_park_sobj) {
    547  1.3.2.6   yamt 		/* Releases the LWP lock. */
    548  1.3.2.6   yamt 		lwp_unsleep(t);
    549  1.3.2.6   yamt 	} else {
    550  1.3.2.6   yamt 		/*
    551  1.3.2.6   yamt 		 * Set the operation pending.  The next call to _lwp_park
    552  1.3.2.6   yamt 		 * will return early.
    553  1.3.2.6   yamt 		 */
    554  1.3.2.6   yamt 		t->l_flag |= LW_UNPARKED;
    555  1.3.2.6   yamt 		lwp_unlock(t);
    556      1.2     ad 	}
    557      1.2     ad 
    558  1.3.2.6   yamt 	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.3.2.6   yamt 	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.3.2.6   yamt 		/*
    651  1.3.2.6   yamt 		 * It may not have parked yet, we may have raced, or
    652  1.3.2.6   yamt 		 * it is parked on a different user sync object.
    653  1.3.2.6   yamt 		 */
    654  1.3.2.6   yamt 		if (t->l_syncobj == &lwp_park_sobj) {
    655  1.3.2.6   yamt 			/* Releases the LWP lock. */
    656  1.3.2.6   yamt 			lwp_unsleep(t);
    657      1.2     ad 		} else {
    658      1.2     ad 			/*
    659  1.3.2.6   yamt 			 * Set the operation pending.  The next call to
    660  1.3.2.6   yamt 			 * _lwp_park will return early.
    661      1.2     ad 			 */
    662  1.3.2.3  rmind 			t->l_flag |= LW_UNPARKED;
    663      1.2     ad 			lwp_unlock(t);
    664      1.2     ad 		}
    665  1.3.2.6   yamt 
    666  1.3.2.6   yamt 		mutex_exit(&p->p_smutex);
    667  1.3.2.6   yamt 		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.3.2.6   yamt 
    679      1.2     ad 	return 0;
    680      1.2     ad }
    681