Home | History | Annotate | Line # | Download | only in kern
sys_lwp.c revision 1.41
      1  1.41       ad /*	$NetBSD: sys_lwp.c,v 1.41 2008/05/26 12:08:39 ad Exp $	*/
      2   1.2       ad 
      3   1.2       ad /*-
      4  1.36       ad  * Copyright (c) 2001, 2006, 2007, 2008 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  *
     19   1.2       ad  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.2       ad  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.2       ad  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.2       ad  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.2       ad  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.2       ad  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.2       ad  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.2       ad  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.2       ad  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.2       ad  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.2       ad  * POSSIBILITY OF SUCH DAMAGE.
     30   1.2       ad  */
     31   1.2       ad 
     32   1.2       ad /*
     33   1.2       ad  * Lightweight process (LWP) system calls.  See kern_lwp.c for a description
     34   1.2       ad  * of LWPs.
     35   1.2       ad  */
     36   1.2       ad 
     37   1.2       ad #include <sys/cdefs.h>
     38  1.41       ad __KERNEL_RCSID(0, "$NetBSD: sys_lwp.c,v 1.41 2008/05/26 12:08:39 ad Exp $");
     39   1.2       ad 
     40   1.2       ad #include <sys/param.h>
     41   1.2       ad #include <sys/systm.h>
     42   1.2       ad #include <sys/pool.h>
     43   1.2       ad #include <sys/proc.h>
     44   1.2       ad #include <sys/types.h>
     45   1.2       ad #include <sys/syscallargs.h>
     46   1.2       ad #include <sys/kauth.h>
     47   1.2       ad #include <sys/kmem.h>
     48   1.2       ad #include <sys/sleepq.h>
     49  1.30       ad #include <sys/lwpctl.h>
     50   1.2       ad 
     51   1.2       ad #include <uvm/uvm_extern.h>
     52   1.2       ad 
     53   1.2       ad #define	LWP_UNPARK_MAX		1024
     54   1.2       ad 
     55   1.2       ad syncobj_t lwp_park_sobj = {
     56  1.26       ad 	SOBJ_SLEEPQ_LIFO,
     57   1.2       ad 	sleepq_unsleep,
     58   1.7     yamt 	sleepq_changepri,
     59   1.7     yamt 	sleepq_lendpri,
     60   1.7     yamt 	syncobj_noowner,
     61   1.2       ad };
     62   1.2       ad 
     63   1.2       ad sleeptab_t	lwp_park_tab;
     64   1.2       ad 
     65   1.2       ad void
     66   1.2       ad lwp_sys_init(void)
     67   1.2       ad {
     68   1.2       ad 	sleeptab_init(&lwp_park_tab);
     69   1.2       ad }
     70   1.2       ad 
     71   1.2       ad /* ARGSUSED */
     72   1.2       ad int
     73  1.32      dsl sys__lwp_create(struct lwp *l, const struct sys__lwp_create_args *uap, register_t *retval)
     74   1.2       ad {
     75  1.32      dsl 	/* {
     76   1.2       ad 		syscallarg(const ucontext_t *) ucp;
     77   1.2       ad 		syscallarg(u_long) flags;
     78   1.2       ad 		syscallarg(lwpid_t *) new_lwp;
     79  1.32      dsl 	} */
     80   1.2       ad 	struct proc *p = l->l_proc;
     81   1.2       ad 	struct lwp *l2;
     82   1.2       ad 	vaddr_t uaddr;
     83   1.6  thorpej 	bool inmem;
     84   1.2       ad 	ucontext_t *newuc;
     85   1.2       ad 	int error, lid;
     86   1.2       ad 
     87   1.2       ad 	newuc = pool_get(&lwp_uc_pool, PR_WAITOK);
     88   1.2       ad 
     89   1.2       ad 	error = copyin(SCARG(uap, ucp), newuc, p->p_emul->e_ucsize);
     90   1.2       ad 	if (error) {
     91   1.2       ad 		pool_put(&lwp_uc_pool, newuc);
     92   1.2       ad 		return error;
     93   1.2       ad 	}
     94   1.2       ad 
     95   1.2       ad 	/* XXX check against resource limits */
     96   1.2       ad 
     97   1.2       ad 	inmem = uvm_uarea_alloc(&uaddr);
     98   1.2       ad 	if (__predict_false(uaddr == 0)) {
     99   1.2       ad 		pool_put(&lwp_uc_pool, newuc);
    100   1.2       ad 		return ENOMEM;
    101   1.2       ad 	}
    102   1.2       ad 
    103  1.27       ad 	error = lwp_create(l, p, uaddr, inmem, SCARG(uap, flags) & LWP_DETACHED,
    104  1.27       ad 	    NULL, 0, p->p_emul->e_startlwp, newuc, &l2, l->l_class);
    105  1.18    rmind 	if (error) {
    106  1.27       ad 		uvm_uarea_free(uaddr, curcpu());
    107  1.18    rmind 		pool_put(&lwp_uc_pool, newuc);
    108  1.18    rmind 		return error;
    109  1.18    rmind 	}
    110   1.2       ad 
    111  1.21    rmind 	lid = l2->l_lid;
    112  1.21    rmind 	error = copyout(&lid, SCARG(uap, new_lwp), sizeof(lid));
    113  1.21    rmind 	if (error) {
    114  1.21    rmind 		lwp_exit(l2);
    115  1.21    rmind 		pool_put(&lwp_uc_pool, newuc);
    116  1.21    rmind 		return error;
    117  1.21    rmind 	}
    118  1.21    rmind 
    119   1.2       ad 	/*
    120   1.2       ad 	 * Set the new LWP running, unless the caller has requested that
    121   1.2       ad 	 * it be created in suspended state.  If the process is stopping,
    122   1.2       ad 	 * then the LWP is created stopped.
    123   1.2       ad 	 */
    124  1.39       ad 	mutex_enter(p->p_lock);
    125   1.2       ad 	lwp_lock(l2);
    126   1.2       ad 	if ((SCARG(uap, flags) & LWP_SUSPENDED) == 0 &&
    127   1.4    pavel 	    (l->l_flag & (LW_WREBOOT | LW_WSUSPEND | LW_WEXIT)) == 0) {
    128   1.2       ad 	    	if (p->p_stat == SSTOP || (p->p_sflag & PS_STOPPING) != 0)
    129   1.2       ad 	    		l2->l_stat = LSSTOP;
    130   1.2       ad 		else {
    131  1.19     yamt 			KASSERT(lwp_locked(l2, l2->l_cpu->ci_schedstate.spc_mutex));
    132   1.2       ad 			p->p_nrlwps++;
    133   1.2       ad 			l2->l_stat = LSRUN;
    134  1.19     yamt 			sched_enqueue(l2, false);
    135   1.2       ad 		}
    136  1.31       ad 		lwp_unlock(l2);
    137  1.31       ad 	} else {
    138   1.2       ad 		l2->l_stat = LSSUSPENDED;
    139  1.34       ad 		lwp_unlock_to(l2, l2->l_cpu->ci_schedstate.spc_lwplock);
    140  1.31       ad 	}
    141  1.39       ad 	mutex_exit(p->p_lock);
    142   1.2       ad 
    143   1.2       ad 	return 0;
    144   1.2       ad }
    145   1.2       ad 
    146   1.2       ad int
    147  1.32      dsl sys__lwp_exit(struct lwp *l, const void *v, register_t *retval)
    148   1.2       ad {
    149   1.2       ad 
    150   1.2       ad 	lwp_exit(l);
    151   1.2       ad 	return 0;
    152   1.2       ad }
    153   1.2       ad 
    154   1.2       ad int
    155  1.32      dsl sys__lwp_self(struct lwp *l, const void *v, register_t *retval)
    156   1.2       ad {
    157   1.2       ad 
    158   1.2       ad 	*retval = l->l_lid;
    159   1.2       ad 	return 0;
    160   1.2       ad }
    161   1.2       ad 
    162   1.2       ad int
    163  1.32      dsl sys__lwp_getprivate(struct lwp *l, const void *v, register_t *retval)
    164   1.2       ad {
    165   1.2       ad 
    166   1.2       ad 	*retval = (uintptr_t)l->l_private;
    167   1.2       ad 	return 0;
    168   1.2       ad }
    169   1.2       ad 
    170   1.2       ad int
    171  1.32      dsl sys__lwp_setprivate(struct lwp *l, const struct sys__lwp_setprivate_args *uap, register_t *retval)
    172   1.2       ad {
    173  1.32      dsl 	/* {
    174   1.2       ad 		syscallarg(void *) ptr;
    175  1.32      dsl 	} */
    176   1.2       ad 
    177   1.2       ad 	l->l_private = SCARG(uap, ptr);
    178   1.2       ad 	return 0;
    179   1.2       ad }
    180   1.2       ad 
    181   1.2       ad int
    182  1.32      dsl sys__lwp_suspend(struct lwp *l, const struct sys__lwp_suspend_args *uap, register_t *retval)
    183   1.2       ad {
    184  1.32      dsl 	/* {
    185   1.2       ad 		syscallarg(lwpid_t) target;
    186  1.32      dsl 	} */
    187   1.2       ad 	struct proc *p = l->l_proc;
    188   1.2       ad 	struct lwp *t;
    189   1.2       ad 	int error;
    190   1.2       ad 
    191  1.39       ad 	mutex_enter(p->p_lock);
    192   1.2       ad 	if ((t = lwp_find(p, SCARG(uap, target))) == NULL) {
    193  1.39       ad 		mutex_exit(p->p_lock);
    194   1.2       ad 		return ESRCH;
    195   1.2       ad 	}
    196   1.2       ad 
    197   1.2       ad 	/*
    198   1.2       ad 	 * Check for deadlock, which is only possible when we're suspending
    199   1.2       ad 	 * ourself.  XXX There is a short race here, as p_nrlwps is only
    200   1.2       ad 	 * incremented when an LWP suspends itself on the kernel/user
    201   1.2       ad 	 * boundary.  It's still possible to kill -9 the process so we
    202   1.2       ad 	 * don't bother checking further.
    203   1.2       ad 	 */
    204   1.2       ad 	lwp_lock(t);
    205   1.2       ad 	if ((t == l && p->p_nrlwps == 1) ||
    206   1.4    pavel 	    (l->l_flag & (LW_WCORE | LW_WEXIT)) != 0) {
    207   1.2       ad 		lwp_unlock(t);
    208  1.39       ad 		mutex_exit(p->p_lock);
    209   1.2       ad 		return EDEADLK;
    210   1.2       ad 	}
    211   1.2       ad 
    212   1.2       ad 	/*
    213   1.2       ad 	 * Suspend the LWP.  XXX If it's on a different CPU, we should wait
    214   1.2       ad 	 * for it to be preempted, where it will put itself to sleep.
    215   1.2       ad 	 *
    216   1.2       ad 	 * Suspension of the current LWP will happen on return to userspace.
    217   1.2       ad 	 */
    218   1.2       ad 	error = lwp_suspend(l, t);
    219  1.23    rmind 	if (error) {
    220  1.39       ad 		mutex_exit(p->p_lock);
    221  1.23    rmind 		return error;
    222  1.23    rmind 	}
    223  1.23    rmind 
    224  1.23    rmind 	/*
    225  1.23    rmind 	 * Wait for:
    226  1.23    rmind 	 *  o process exiting
    227  1.23    rmind 	 *  o target LWP suspended
    228  1.23    rmind 	 *  o target LWP not suspended and L_WSUSPEND clear
    229  1.23    rmind 	 *  o target LWP exited
    230  1.23    rmind 	 */
    231  1.23    rmind 	for (;;) {
    232  1.39       ad 		error = cv_wait_sig(&p->p_lwpcv, p->p_lock);
    233  1.23    rmind 		if (error) {
    234  1.23    rmind 			error = ERESTART;
    235  1.23    rmind 			break;
    236  1.23    rmind 		}
    237  1.25    rmind 		if (lwp_find(p, SCARG(uap, target)) == NULL) {
    238  1.25    rmind 			error = ESRCH;
    239  1.25    rmind 			break;
    240  1.25    rmind 		}
    241  1.23    rmind 		if ((l->l_flag | t->l_flag) & (LW_WCORE | LW_WEXIT)) {
    242  1.23    rmind 			error = ERESTART;
    243  1.23    rmind 			break;
    244  1.23    rmind 		}
    245  1.23    rmind 		if (t->l_stat == LSSUSPENDED ||
    246  1.23    rmind 		    (t->l_flag & LW_WSUSPEND) == 0)
    247  1.23    rmind 			break;
    248  1.23    rmind 	}
    249  1.39       ad 	mutex_exit(p->p_lock);
    250   1.2       ad 
    251   1.2       ad 	return error;
    252   1.2       ad }
    253   1.2       ad 
    254   1.2       ad int
    255  1.32      dsl sys__lwp_continue(struct lwp *l, const struct sys__lwp_continue_args *uap, register_t *retval)
    256   1.2       ad {
    257  1.32      dsl 	/* {
    258   1.2       ad 		syscallarg(lwpid_t) target;
    259  1.32      dsl 	} */
    260   1.2       ad 	int error;
    261   1.2       ad 	struct proc *p = l->l_proc;
    262   1.2       ad 	struct lwp *t;
    263   1.2       ad 
    264   1.2       ad 	error = 0;
    265   1.2       ad 
    266  1.39       ad 	mutex_enter(p->p_lock);
    267   1.2       ad 	if ((t = lwp_find(p, SCARG(uap, target))) == NULL) {
    268  1.39       ad 		mutex_exit(p->p_lock);
    269   1.2       ad 		return ESRCH;
    270   1.2       ad 	}
    271   1.2       ad 
    272   1.2       ad 	lwp_lock(t);
    273   1.2       ad 	lwp_continue(t);
    274  1.39       ad 	mutex_exit(p->p_lock);
    275   1.2       ad 
    276   1.2       ad 	return error;
    277   1.2       ad }
    278   1.2       ad 
    279   1.2       ad int
    280  1.32      dsl sys__lwp_wakeup(struct lwp *l, const struct sys__lwp_wakeup_args *uap, register_t *retval)
    281   1.2       ad {
    282  1.32      dsl 	/* {
    283   1.2       ad 		syscallarg(lwpid_t) target;
    284  1.32      dsl 	} */
    285   1.2       ad 	struct lwp *t;
    286   1.2       ad 	struct proc *p;
    287   1.2       ad 	int error;
    288   1.2       ad 
    289   1.2       ad 	p = l->l_proc;
    290  1.39       ad 	mutex_enter(p->p_lock);
    291   1.2       ad 
    292   1.2       ad 	if ((t = lwp_find(p, SCARG(uap, target))) == NULL) {
    293  1.39       ad 		mutex_exit(p->p_lock);
    294   1.2       ad 		return ESRCH;
    295   1.2       ad 	}
    296   1.2       ad 
    297   1.2       ad 	lwp_lock(t);
    298  1.15       ad 	t->l_flag |= (LW_CANCELLED | LW_UNPARKED);
    299   1.2       ad 
    300   1.2       ad 	if (t->l_stat != LSSLEEP) {
    301  1.16       ad 		lwp_unlock(t);
    302   1.2       ad 		error = ENODEV;
    303  1.16       ad 	} else if ((t->l_flag & LW_SINTR) == 0) {
    304  1.16       ad 		lwp_unlock(t);
    305   1.2       ad 		error = EBUSY;
    306  1.16       ad 	} else {
    307  1.16       ad 		/* Wake it up.  lwp_unsleep() will release the LWP lock. */
    308  1.37       ad 		(void)lwp_unsleep(t, true);
    309  1.16       ad 		error = 0;
    310   1.2       ad 	}
    311   1.2       ad 
    312  1.39       ad 	mutex_exit(p->p_lock);
    313   1.2       ad 
    314   1.2       ad 	return error;
    315   1.2       ad }
    316   1.2       ad 
    317   1.2       ad int
    318  1.32      dsl sys__lwp_wait(struct lwp *l, const struct sys__lwp_wait_args *uap, register_t *retval)
    319   1.2       ad {
    320  1.32      dsl 	/* {
    321   1.2       ad 		syscallarg(lwpid_t) wait_for;
    322   1.2       ad 		syscallarg(lwpid_t *) departed;
    323  1.32      dsl 	} */
    324   1.2       ad 	struct proc *p = l->l_proc;
    325   1.2       ad 	int error;
    326   1.2       ad 	lwpid_t dep;
    327   1.2       ad 
    328  1.39       ad 	mutex_enter(p->p_lock);
    329   1.2       ad 	error = lwp_wait1(l, SCARG(uap, wait_for), &dep, 0);
    330  1.39       ad 	mutex_exit(p->p_lock);
    331   1.2       ad 
    332   1.2       ad 	if (error)
    333   1.2       ad 		return error;
    334   1.2       ad 
    335   1.2       ad 	if (SCARG(uap, departed)) {
    336   1.2       ad 		error = copyout(&dep, SCARG(uap, departed), sizeof(dep));
    337   1.2       ad 		if (error)
    338   1.2       ad 			return error;
    339   1.2       ad 	}
    340   1.2       ad 
    341   1.2       ad 	return 0;
    342   1.2       ad }
    343   1.2       ad 
    344   1.2       ad /* ARGSUSED */
    345   1.2       ad int
    346  1.32      dsl sys__lwp_kill(struct lwp *l, const struct sys__lwp_kill_args *uap, register_t *retval)
    347   1.2       ad {
    348  1.32      dsl 	/* {
    349   1.2       ad 		syscallarg(lwpid_t)	target;
    350   1.2       ad 		syscallarg(int)		signo;
    351  1.32      dsl 	} */
    352   1.2       ad 	struct proc *p = l->l_proc;
    353   1.2       ad 	struct lwp *t;
    354   1.2       ad 	ksiginfo_t ksi;
    355   1.2       ad 	int signo = SCARG(uap, signo);
    356   1.2       ad 	int error = 0;
    357   1.2       ad 
    358   1.2       ad 	if ((u_int)signo >= NSIG)
    359   1.2       ad 		return EINVAL;
    360   1.2       ad 
    361   1.2       ad 	KSI_INIT(&ksi);
    362   1.2       ad 	ksi.ksi_signo = signo;
    363   1.2       ad 	ksi.ksi_code = SI_USER;
    364   1.2       ad 	ksi.ksi_pid = p->p_pid;
    365   1.2       ad 	ksi.ksi_uid = kauth_cred_geteuid(l->l_cred);
    366   1.2       ad 	ksi.ksi_lid = SCARG(uap, target);
    367   1.2       ad 
    368  1.38       ad 	mutex_enter(proc_lock);
    369  1.39       ad 	mutex_enter(p->p_lock);
    370   1.2       ad 	if ((t = lwp_find(p, ksi.ksi_lid)) == NULL)
    371   1.2       ad 		error = ESRCH;
    372   1.2       ad 	else if (signo != 0)
    373   1.2       ad 		kpsignal2(p, &ksi);
    374  1.39       ad 	mutex_exit(p->p_lock);
    375  1.38       ad 	mutex_exit(proc_lock);
    376   1.2       ad 
    377   1.2       ad 	return error;
    378   1.2       ad }
    379   1.2       ad 
    380   1.2       ad int
    381  1.32      dsl sys__lwp_detach(struct lwp *l, const struct sys__lwp_detach_args *uap, register_t *retval)
    382   1.2       ad {
    383  1.32      dsl 	/* {
    384   1.2       ad 		syscallarg(lwpid_t)	target;
    385  1.32      dsl 	} */
    386   1.2       ad 	struct proc *p;
    387   1.2       ad 	struct lwp *t;
    388   1.2       ad 	lwpid_t target;
    389   1.2       ad 	int error;
    390   1.2       ad 
    391   1.2       ad 	target = SCARG(uap, target);
    392   1.2       ad 	p = l->l_proc;
    393   1.2       ad 
    394  1.39       ad 	mutex_enter(p->p_lock);
    395   1.2       ad 
    396   1.2       ad 	if (l->l_lid == target)
    397   1.2       ad 		t = l;
    398   1.2       ad 	else {
    399   1.2       ad 		/*
    400   1.2       ad 		 * We can't use lwp_find() here because the target might
    401   1.2       ad 		 * be a zombie.
    402   1.2       ad 		 */
    403   1.2       ad 		LIST_FOREACH(t, &p->p_lwps, l_sibling)
    404   1.2       ad 			if (t->l_lid == target)
    405   1.2       ad 				break;
    406   1.2       ad 	}
    407   1.2       ad 
    408   1.2       ad 	/*
    409   1.2       ad 	 * If the LWP is already detached, there's nothing to do.
    410   1.2       ad 	 * If it's a zombie, we need to clean up after it.  LSZOMB
    411   1.2       ad 	 * is visible with the proc mutex held.
    412   1.2       ad 	 *
    413   1.2       ad 	 * After we have detached or released the LWP, kick any
    414   1.2       ad 	 * other LWPs that may be sitting in _lwp_wait(), waiting
    415   1.2       ad 	 * for the target LWP to exit.
    416   1.2       ad 	 */
    417   1.2       ad 	if (t != NULL && t->l_stat != LSIDL) {
    418   1.2       ad 		if ((t->l_prflag & LPR_DETACHED) == 0) {
    419   1.2       ad 			p->p_ndlwps++;
    420   1.2       ad 			t->l_prflag |= LPR_DETACHED;
    421   1.2       ad 			if (t->l_stat == LSZOMB) {
    422  1.17       ad 				/* Releases proc mutex. */
    423  1.17       ad 				lwp_free(t, false, false);
    424   1.2       ad 				return 0;
    425   1.2       ad 			}
    426   1.2       ad 			error = 0;
    427  1.17       ad 
    428  1.17       ad 			/*
    429  1.17       ad 			 * Have any LWPs sleeping in lwp_wait() recheck
    430  1.17       ad 			 * for deadlock.
    431  1.17       ad 			 */
    432  1.17       ad 			cv_broadcast(&p->p_lwpcv);
    433   1.2       ad 		} else
    434   1.2       ad 			error = EINVAL;
    435   1.2       ad 	} else
    436   1.2       ad 		error = ESRCH;
    437   1.2       ad 
    438  1.39       ad 	mutex_exit(p->p_lock);
    439   1.2       ad 
    440   1.2       ad 	return error;
    441   1.2       ad }
    442   1.2       ad 
    443   1.2       ad static inline wchan_t
    444   1.2       ad lwp_park_wchan(struct proc *p, const void *hint)
    445   1.2       ad {
    446  1.22       ad 
    447   1.2       ad 	return (wchan_t)((uintptr_t)p ^ (uintptr_t)hint);
    448   1.2       ad }
    449   1.2       ad 
    450   1.2       ad int
    451  1.24       ad lwp_unpark(lwpid_t target, const void *hint)
    452   1.2       ad {
    453  1.24       ad 	sleepq_t *sq;
    454  1.24       ad 	wchan_t wchan;
    455  1.24       ad 	int swapin;
    456  1.41       ad 	kmutex_t *mp;
    457  1.24       ad 	proc_t *p;
    458  1.24       ad 	lwp_t *t;
    459  1.24       ad 
    460  1.24       ad 	/*
    461  1.24       ad 	 * Easy case: search for the LWP on the sleep queue.  If
    462  1.24       ad 	 * it's parked, remove it from the queue and set running.
    463  1.24       ad 	 */
    464  1.24       ad 	p = curproc;
    465  1.24       ad 	wchan = lwp_park_wchan(p, hint);
    466  1.41       ad 	sq = sleeptab_lookup(&lwp_park_tab, wchan, &mp);
    467  1.24       ad 
    468  1.41       ad 	TAILQ_FOREACH(t, sq, l_sleepchain)
    469  1.24       ad 		if (t->l_proc == p && t->l_lid == target)
    470  1.24       ad 			break;
    471  1.24       ad 
    472  1.24       ad 	if (__predict_true(t != NULL)) {
    473  1.24       ad 		swapin = sleepq_remove(sq, t);
    474  1.41       ad 		mutex_spin_exit(mp);
    475  1.24       ad 		if (swapin)
    476  1.24       ad 			uvm_kick_scheduler();
    477  1.24       ad 		return 0;
    478  1.24       ad 	}
    479  1.24       ad 
    480  1.24       ad 	/*
    481  1.24       ad 	 * The LWP hasn't parked yet.  Take the hit and mark the
    482  1.24       ad 	 * operation as pending.
    483  1.24       ad 	 */
    484  1.41       ad 	mutex_spin_exit(mp);
    485  1.20      dsl 
    486  1.39       ad 	mutex_enter(p->p_lock);
    487  1.24       ad 	if ((t = lwp_find(p, target)) == NULL) {
    488  1.39       ad 		mutex_exit(p->p_lock);
    489  1.24       ad 		return ESRCH;
    490  1.24       ad 	}
    491  1.20      dsl 
    492  1.24       ad 	/*
    493  1.24       ad 	 * It may not have parked yet, we may have raced, or it
    494  1.24       ad 	 * is parked on a different user sync object.
    495  1.24       ad 	 */
    496  1.24       ad 	lwp_lock(t);
    497  1.24       ad 	if (t->l_syncobj == &lwp_park_sobj) {
    498  1.24       ad 		/* Releases the LWP lock. */
    499  1.37       ad 		(void)lwp_unsleep(t, true);
    500  1.24       ad 	} else {
    501  1.24       ad 		/*
    502  1.24       ad 		 * Set the operation pending.  The next call to _lwp_park
    503  1.24       ad 		 * will return early.
    504  1.24       ad 		 */
    505  1.24       ad 		t->l_flag |= LW_UNPARKED;
    506  1.24       ad 		lwp_unlock(t);
    507  1.24       ad 	}
    508  1.20      dsl 
    509  1.39       ad 	mutex_exit(p->p_lock);
    510  1.24       ad 	return 0;
    511  1.20      dsl }
    512  1.20      dsl 
    513  1.20      dsl int
    514  1.24       ad lwp_park(struct timespec *ts, const void *hint)
    515  1.20      dsl {
    516  1.20      dsl 	struct timespec tsx;
    517   1.2       ad 	sleepq_t *sq;
    518  1.41       ad 	kmutex_t *mp;
    519   1.2       ad 	wchan_t wchan;
    520   1.2       ad 	int timo, error;
    521  1.24       ad 	lwp_t *l;
    522   1.2       ad 
    523   1.2       ad 	/* Fix up the given timeout value. */
    524  1.20      dsl 	if (ts != NULL) {
    525   1.2       ad 		getnanotime(&tsx);
    526  1.24       ad 		timespecsub(ts, &tsx, &tsx);
    527  1.24       ad 		if (tsx.tv_sec < 0 || (tsx.tv_sec == 0 && tsx.tv_nsec <= 0))
    528   1.2       ad 			return ETIMEDOUT;
    529  1.24       ad 		if ((error = itimespecfix(&tsx)) != 0)
    530   1.2       ad 			return error;
    531  1.24       ad 		timo = tstohz(&tsx);
    532  1.24       ad 		KASSERT(timo != 0);
    533   1.2       ad 	} else
    534   1.2       ad 		timo = 0;
    535   1.2       ad 
    536   1.2       ad 	/* Find and lock the sleep queue. */
    537  1.24       ad 	l = curlwp;
    538  1.20      dsl 	wchan = lwp_park_wchan(l->l_proc, hint);
    539  1.41       ad 	sq = sleeptab_lookup(&lwp_park_tab, wchan, &mp);
    540   1.2       ad 
    541   1.2       ad 	/*
    542   1.2       ad 	 * Before going the full route and blocking, check to see if an
    543   1.2       ad 	 * unpark op is pending.
    544   1.2       ad 	 */
    545  1.19     yamt 	lwp_lock(l);
    546   1.8       ad 	if ((l->l_flag & (LW_CANCELLED | LW_UNPARKED)) != 0) {
    547   1.8       ad 		l->l_flag &= ~(LW_CANCELLED | LW_UNPARKED);
    548  1.19     yamt 		lwp_unlock(l);
    549  1.41       ad 		mutex_spin_exit(mp);
    550   1.2       ad 		return EALREADY;
    551   1.2       ad 	}
    552  1.41       ad 	lwp_unlock_to(l, mp);
    553  1.24       ad 	l->l_biglocks = 0;
    554  1.27       ad 	sleepq_enqueue(sq, wchan, "parked", &lwp_park_sobj);
    555  1.19     yamt 	error = sleepq_block(timo, true);
    556  1.13     yamt 	switch (error) {
    557  1.14     yamt 	case EWOULDBLOCK:
    558  1.14     yamt 		error = ETIMEDOUT;
    559  1.14     yamt 		break;
    560  1.14     yamt 	case ERESTART:
    561  1.14     yamt 		error = EINTR;
    562  1.14     yamt 		break;
    563  1.14     yamt 	default:
    564  1.14     yamt 		/* nothing */
    565  1.14     yamt 		break;
    566  1.13     yamt 	}
    567  1.13     yamt 	return error;
    568   1.2       ad }
    569   1.2       ad 
    570  1.24       ad /*
    571  1.24       ad  * 'park' an LWP waiting on a user-level synchronisation object.  The LWP
    572  1.24       ad  * will remain parked until another LWP in the same process calls in and
    573  1.24       ad  * requests that it be unparked.
    574  1.24       ad  */
    575   1.2       ad int
    576  1.32      dsl sys__lwp_park(struct lwp *l, const struct sys__lwp_park_args *uap, register_t *retval)
    577   1.2       ad {
    578  1.32      dsl 	/* {
    579  1.24       ad 		syscallarg(const struct timespec *)	ts;
    580  1.24       ad 		syscallarg(lwpid_t)			unpark;
    581  1.24       ad 		syscallarg(const void *)		hint;
    582  1.24       ad 		syscallarg(const void *)		unparkhint;
    583  1.32      dsl 	} */
    584  1.24       ad 	struct timespec ts, *tsp;
    585  1.24       ad 	int error;
    586   1.2       ad 
    587  1.24       ad 	if (SCARG(uap, ts) == NULL)
    588  1.24       ad 		tsp = NULL;
    589  1.24       ad 	else {
    590  1.24       ad 		error = copyin(SCARG(uap, ts), &ts, sizeof(ts));
    591  1.24       ad 		if (error != 0)
    592  1.24       ad 			return error;
    593  1.24       ad 		tsp = &ts;
    594  1.24       ad 	}
    595   1.2       ad 
    596  1.24       ad 	if (SCARG(uap, unpark) != 0) {
    597  1.24       ad 		error = lwp_unpark(SCARG(uap, unpark), SCARG(uap, unparkhint));
    598  1.24       ad 		if (error != 0)
    599  1.24       ad 			return error;
    600  1.15       ad 	}
    601  1.15       ad 
    602  1.24       ad 	return lwp_park(tsp, SCARG(uap, hint));
    603  1.24       ad }
    604   1.2       ad 
    605  1.24       ad int
    606  1.32      dsl sys__lwp_unpark(struct lwp *l, const struct sys__lwp_unpark_args *uap, register_t *retval)
    607  1.24       ad {
    608  1.32      dsl 	/* {
    609  1.24       ad 		syscallarg(lwpid_t)		target;
    610  1.24       ad 		syscallarg(const void *)	hint;
    611  1.32      dsl 	} */
    612   1.2       ad 
    613  1.24       ad 	return lwp_unpark(SCARG(uap, target), SCARG(uap, hint));
    614   1.2       ad }
    615   1.2       ad 
    616   1.2       ad int
    617  1.32      dsl sys__lwp_unpark_all(struct lwp *l, const struct sys__lwp_unpark_all_args *uap, register_t *retval)
    618   1.2       ad {
    619  1.32      dsl 	/* {
    620   1.2       ad 		syscallarg(const lwpid_t *)	targets;
    621   1.2       ad 		syscallarg(size_t)		ntargets;
    622   1.2       ad 		syscallarg(const void *)	hint;
    623  1.32      dsl 	} */
    624   1.2       ad 	struct proc *p;
    625   1.2       ad 	struct lwp *t;
    626   1.2       ad 	sleepq_t *sq;
    627   1.2       ad 	wchan_t wchan;
    628   1.2       ad 	lwpid_t targets[32], *tp, *tpp, *tmax, target;
    629   1.2       ad 	int swapin, error;
    630  1.41       ad 	kmutex_t *mp;
    631  1.15       ad 	u_int ntargets;
    632   1.2       ad 	size_t sz;
    633   1.2       ad 
    634   1.2       ad 	p = l->l_proc;
    635   1.2       ad 	ntargets = SCARG(uap, ntargets);
    636   1.2       ad 
    637   1.2       ad 	if (SCARG(uap, targets) == NULL) {
    638   1.2       ad 		/*
    639   1.2       ad 		 * Let the caller know how much we are willing to do, and
    640   1.2       ad 		 * let it unpark the LWPs in blocks.
    641   1.2       ad 		 */
    642   1.2       ad 		*retval = LWP_UNPARK_MAX;
    643   1.2       ad 		return 0;
    644   1.2       ad 	}
    645   1.2       ad 	if (ntargets > LWP_UNPARK_MAX || ntargets == 0)
    646   1.2       ad 		return EINVAL;
    647   1.2       ad 
    648   1.2       ad 	/*
    649   1.2       ad 	 * Copy in the target array.  If it's a small number of LWPs, then
    650   1.2       ad 	 * place the numbers on the stack.
    651   1.2       ad 	 */
    652   1.2       ad 	sz = sizeof(target) * ntargets;
    653   1.2       ad 	if (sz <= sizeof(targets))
    654   1.2       ad 		tp = targets;
    655   1.2       ad 	else {
    656   1.2       ad 		tp = kmem_alloc(sz, KM_SLEEP);
    657   1.2       ad 		if (tp == NULL)
    658   1.2       ad 			return ENOMEM;
    659   1.2       ad 	}
    660   1.2       ad 	error = copyin(SCARG(uap, targets), tp, sz);
    661   1.2       ad 	if (error != 0) {
    662   1.2       ad 		if (tp != targets) {
    663   1.2       ad 			kmem_free(tp, sz);
    664   1.2       ad 		}
    665   1.2       ad 		return error;
    666   1.2       ad 	}
    667   1.2       ad 
    668   1.2       ad 	swapin = 0;
    669   1.2       ad 	wchan = lwp_park_wchan(p, SCARG(uap, hint));
    670  1.41       ad 	sq = sleeptab_lookup(&lwp_park_tab, wchan, &mp);
    671   1.2       ad 
    672   1.2       ad 	for (tmax = tp + ntargets, tpp = tp; tpp < tmax; tpp++) {
    673   1.2       ad 		target = *tpp;
    674   1.2       ad 
    675   1.2       ad 		/*
    676   1.2       ad 		 * Easy case: search for the LWP on the sleep queue.  If
    677   1.2       ad 		 * it's parked, remove it from the queue and set running.
    678   1.2       ad 		 */
    679  1.41       ad 		TAILQ_FOREACH(t, sq, l_sleepchain)
    680   1.2       ad 			if (t->l_proc == p && t->l_lid == target)
    681   1.2       ad 				break;
    682   1.2       ad 
    683   1.2       ad 		if (t != NULL) {
    684   1.2       ad 			swapin |= sleepq_remove(sq, t);
    685   1.2       ad 			continue;
    686   1.2       ad 		}
    687   1.2       ad 
    688   1.2       ad 		/*
    689   1.2       ad 		 * The LWP hasn't parked yet.  Take the hit and
    690   1.2       ad 		 * mark the operation as pending.
    691   1.2       ad 		 */
    692  1.41       ad 		mutex_spin_exit(mp);
    693  1.39       ad 		mutex_enter(p->p_lock);
    694   1.2       ad 		if ((t = lwp_find(p, target)) == NULL) {
    695  1.39       ad 			mutex_exit(p->p_lock);
    696  1.41       ad 			mutex_spin_enter(mp);
    697   1.2       ad 			continue;
    698   1.2       ad 		}
    699   1.2       ad 		lwp_lock(t);
    700   1.2       ad 
    701  1.15       ad 		/*
    702  1.15       ad 		 * It may not have parked yet, we may have raced, or
    703  1.15       ad 		 * it is parked on a different user sync object.
    704  1.15       ad 		 */
    705  1.15       ad 		if (t->l_syncobj == &lwp_park_sobj) {
    706  1.15       ad 			/* Releases the LWP lock. */
    707  1.37       ad 			(void)lwp_unsleep(t, true);
    708   1.2       ad 		} else {
    709   1.2       ad 			/*
    710  1.15       ad 			 * Set the operation pending.  The next call to
    711  1.15       ad 			 * _lwp_park will return early.
    712   1.2       ad 			 */
    713   1.8       ad 			t->l_flag |= LW_UNPARKED;
    714   1.2       ad 			lwp_unlock(t);
    715   1.2       ad 		}
    716  1.15       ad 
    717  1.39       ad 		mutex_exit(p->p_lock);
    718  1.41       ad 		mutex_spin_enter(mp);
    719   1.2       ad 	}
    720   1.2       ad 
    721  1.41       ad 	mutex_spin_exit(mp);
    722  1.33       ad 	if (tp != targets)
    723   1.2       ad 		kmem_free(tp, sz);
    724   1.2       ad 	if (swapin)
    725   1.3       ad 		uvm_kick_scheduler();
    726  1.15       ad 
    727   1.2       ad 	return 0;
    728   1.2       ad }
    729  1.28       ad 
    730  1.28       ad int
    731  1.32      dsl sys__lwp_setname(struct lwp *l, const struct sys__lwp_setname_args *uap, register_t *retval)
    732  1.28       ad {
    733  1.32      dsl 	/* {
    734  1.28       ad 		syscallarg(lwpid_t)		target;
    735  1.28       ad 		syscallarg(const char *)	name;
    736  1.32      dsl 	} */
    737  1.28       ad 	char *name, *oname;
    738  1.30       ad 	lwpid_t target;
    739  1.28       ad 	proc_t *p;
    740  1.28       ad 	lwp_t *t;
    741  1.28       ad 	int error;
    742  1.28       ad 
    743  1.30       ad 	if ((target = SCARG(uap, target)) == 0)
    744  1.30       ad 		target = l->l_lid;
    745  1.30       ad 
    746  1.28       ad 	name = kmem_alloc(MAXCOMLEN, KM_SLEEP);
    747  1.28       ad 	if (name == NULL)
    748  1.28       ad 		return ENOMEM;
    749  1.28       ad 	error = copyinstr(SCARG(uap, name), name, MAXCOMLEN, NULL);
    750  1.28       ad 	switch (error) {
    751  1.28       ad 	case ENAMETOOLONG:
    752  1.28       ad 	case 0:
    753  1.28       ad 		name[MAXCOMLEN - 1] = '\0';
    754  1.28       ad 		break;
    755  1.28       ad 	default:
    756  1.28       ad 		kmem_free(name, MAXCOMLEN);
    757  1.28       ad 		return error;
    758  1.28       ad 	}
    759  1.28       ad 
    760  1.28       ad 	p = curproc;
    761  1.39       ad 	mutex_enter(p->p_lock);
    762  1.30       ad 	if ((t = lwp_find(p, target)) == NULL) {
    763  1.39       ad 		mutex_exit(p->p_lock);
    764  1.28       ad 		kmem_free(name, MAXCOMLEN);
    765  1.28       ad 		return ESRCH;
    766  1.28       ad 	}
    767  1.28       ad 	lwp_lock(t);
    768  1.28       ad 	oname = t->l_name;
    769  1.28       ad 	t->l_name = name;
    770  1.28       ad 	lwp_unlock(t);
    771  1.39       ad 	mutex_exit(p->p_lock);
    772  1.28       ad 
    773  1.28       ad 	if (oname != NULL)
    774  1.28       ad 		kmem_free(oname, MAXCOMLEN);
    775  1.28       ad 
    776  1.28       ad 	return 0;
    777  1.28       ad }
    778  1.28       ad 
    779  1.28       ad int
    780  1.32      dsl sys__lwp_getname(struct lwp *l, const struct sys__lwp_getname_args *uap, register_t *retval)
    781  1.28       ad {
    782  1.32      dsl 	/* {
    783  1.28       ad 		syscallarg(lwpid_t)		target;
    784  1.28       ad 		syscallarg(char *)		name;
    785  1.28       ad 		syscallarg(size_t)		len;
    786  1.32      dsl 	} */
    787  1.28       ad 	char name[MAXCOMLEN];
    788  1.30       ad 	lwpid_t target;
    789  1.28       ad 	proc_t *p;
    790  1.28       ad 	lwp_t *t;
    791  1.28       ad 
    792  1.30       ad 	if ((target = SCARG(uap, target)) == 0)
    793  1.30       ad 		target = l->l_lid;
    794  1.30       ad 
    795  1.28       ad 	p = curproc;
    796  1.39       ad 	mutex_enter(p->p_lock);
    797  1.30       ad 	if ((t = lwp_find(p, target)) == NULL) {
    798  1.39       ad 		mutex_exit(p->p_lock);
    799  1.28       ad 		return ESRCH;
    800  1.28       ad 	}
    801  1.28       ad 	lwp_lock(t);
    802  1.28       ad 	if (t->l_name == NULL)
    803  1.28       ad 		name[0] = '\0';
    804  1.28       ad 	else
    805  1.28       ad 		strcpy(name, t->l_name);
    806  1.28       ad 	lwp_unlock(t);
    807  1.39       ad 	mutex_exit(p->p_lock);
    808  1.28       ad 
    809  1.28       ad 	return copyoutstr(name, SCARG(uap, name), SCARG(uap, len), NULL);
    810  1.28       ad }
    811  1.30       ad 
    812  1.30       ad int
    813  1.32      dsl sys__lwp_ctl(struct lwp *l, const struct sys__lwp_ctl_args *uap, register_t *retval)
    814  1.30       ad {
    815  1.32      dsl 	/* {
    816  1.30       ad 		syscallarg(int)			features;
    817  1.30       ad 		syscallarg(struct lwpctl **)	address;
    818  1.32      dsl 	} */
    819  1.30       ad 	int error, features;
    820  1.30       ad 	vaddr_t vaddr;
    821  1.30       ad 
    822  1.30       ad 	features = SCARG(uap, features);
    823  1.35       ad 	features &= ~(LWPCTL_FEATURE_CURCPU | LWPCTL_FEATURE_PCTR);
    824  1.35       ad 	if (features != 0)
    825  1.30       ad 		return ENODEV;
    826  1.30       ad 	if ((error = lwp_ctl_alloc(&vaddr)) != 0)
    827  1.30       ad 		return error;
    828  1.30       ad 	return copyout(&vaddr, SCARG(uap, address), sizeof(void *));
    829  1.30       ad }
    830