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