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