Home | History | Annotate | Line # | Download | only in rumpkern
sleepq.c revision 1.1.6.1
      1  1.1.6.1  skrll /*	$NetBSD: sleepq.c,v 1.1.6.1 2009/01/19 13:20:25 skrll Exp $	*/
      2      1.1  pooka 
      3      1.1  pooka /*
      4      1.1  pooka  * Copyright (c) 2008 Antti Kantee.  All Rights Reserved.
      5      1.1  pooka  *
      6      1.1  pooka  * Redistribution and use in source and binary forms, with or without
      7      1.1  pooka  * modification, are permitted provided that the following conditions
      8      1.1  pooka  * are met:
      9      1.1  pooka  * 1. Redistributions of source code must retain the above copyright
     10      1.1  pooka  *    notice, this list of conditions and the following disclaimer.
     11      1.1  pooka  * 2. Redistributions in binary form must reproduce the above copyright
     12      1.1  pooka  *    notice, this list of conditions and the following disclaimer in the
     13      1.1  pooka  *    documentation and/or other materials provided with the distribution.
     14      1.1  pooka  *
     15      1.1  pooka  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
     16      1.1  pooka  * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     17      1.1  pooka  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     18      1.1  pooka  * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     19      1.1  pooka  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     20      1.1  pooka  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     21      1.1  pooka  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     22      1.1  pooka  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     23      1.1  pooka  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     24      1.1  pooka  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     25      1.1  pooka  * SUCH DAMAGE.
     26      1.1  pooka  */
     27      1.1  pooka 
     28  1.1.6.1  skrll #include <sys/cdefs.h>
     29  1.1.6.1  skrll __KERNEL_RCSID(0, "$NetBSD: sleepq.c,v 1.1.6.1 2009/01/19 13:20:25 skrll Exp $");
     30  1.1.6.1  skrll 
     31      1.1  pooka #include <sys/param.h>
     32      1.1  pooka #include <sys/condvar.h>
     33      1.1  pooka #include <sys/mutex.h>
     34      1.1  pooka #include <sys/queue.h>
     35      1.1  pooka #include <sys/sleepq.h>
     36      1.1  pooka #include <sys/syncobj.h>
     37      1.1  pooka 
     38      1.1  pooka /*
     39      1.1  pooka  * Flimsy and minimalistic sleepq implementation.  This is implemented
     40      1.1  pooka  * only for the use of callouts in kern_timeout.c.  locking etc is
     41      1.1  pooka  * completely incorrect, horrible, etc etc etc.
     42      1.1  pooka  */
     43      1.1  pooka 
     44      1.1  pooka syncobj_t sleep_syncobj;
     45      1.1  pooka static kcondvar_t sq_cv;
     46      1.1  pooka static kmutex_t sq_mtx;
     47      1.1  pooka 
     48      1.1  pooka void
     49      1.1  pooka sleepq_init(sleepq_t *sq)
     50      1.1  pooka {
     51      1.1  pooka 
     52      1.1  pooka 	TAILQ_INIT(sq);
     53      1.1  pooka 
     54      1.1  pooka 	cv_init(&sq_cv, "sleepq"); /* XXX */
     55      1.1  pooka 	mutex_init(&sq_mtx, MUTEX_DEFAULT, IPL_NONE); /* multi-XXX */
     56      1.1  pooka }
     57      1.1  pooka 
     58      1.1  pooka void
     59      1.1  pooka sleepq_enqueue(sleepq_t *sq, wchan_t wc, const char *wmsg, syncobj_t *sob)
     60      1.1  pooka {
     61      1.1  pooka 	struct lwp *l = curlwp;
     62      1.1  pooka 
     63      1.1  pooka 	if (__predict_false(sob != &sleep_syncobj || strcmp(wmsg, "callout"))) {
     64      1.1  pooka 		panic("sleepq: unsupported enqueue");
     65      1.1  pooka 	}
     66      1.1  pooka 
     67      1.1  pooka 	l->l_wchan = wc;
     68      1.1  pooka 	TAILQ_INSERT_TAIL(sq, l, l_sleepchain);
     69      1.1  pooka }
     70      1.1  pooka 
     71      1.1  pooka int
     72      1.1  pooka sleepq_block(int timo, bool hatch)
     73      1.1  pooka {
     74      1.1  pooka 	struct lwp *l = curlwp;
     75      1.1  pooka 
     76      1.1  pooka 	KASSERT(timo == 0 && !hatch);
     77      1.1  pooka 
     78      1.1  pooka 	mutex_enter(&sq_mtx);
     79      1.1  pooka 	while (l->l_wchan)
     80      1.1  pooka 		cv_wait(&sq_cv, &sq_mtx);
     81      1.1  pooka 	mutex_exit(&sq_mtx);
     82      1.1  pooka 
     83      1.1  pooka 	return 0;
     84      1.1  pooka }
     85      1.1  pooka 
     86      1.1  pooka lwp_t *
     87      1.1  pooka sleepq_wake(sleepq_t *sq, wchan_t wchan, u_int expected, kmutex_t *mp)
     88      1.1  pooka {
     89      1.1  pooka 	struct lwp *l;
     90      1.1  pooka 	bool found = false;
     91      1.1  pooka 
     92      1.1  pooka 	TAILQ_FOREACH(l, sq, l_sleepchain) {
     93      1.1  pooka 		if (l->l_wchan == wchan) {
     94      1.1  pooka 			found = true;
     95      1.1  pooka 			l->l_wchan = NULL;
     96      1.1  pooka 		}
     97      1.1  pooka 	}
     98      1.1  pooka 	if (found)
     99      1.1  pooka 		cv_broadcast(&sq_cv);
    100      1.1  pooka 
    101      1.1  pooka 	mutex_spin_exit(mp);
    102      1.1  pooka 	return NULL;
    103      1.1  pooka }
    104      1.1  pooka 
    105      1.1  pooka /*
    106      1.1  pooka  * XXX: used only by callout, therefore here
    107      1.1  pooka  *
    108      1.1  pooka  * We don't fudge around with the lwp mutex at all, therefore
    109      1.1  pooka  * this is enough.
    110      1.1  pooka  */
    111      1.1  pooka kmutex_t *
    112      1.1  pooka lwp_lock_retry(struct lwp *l, kmutex_t *old)
    113      1.1  pooka {
    114      1.1  pooka 
    115      1.1  pooka 	return old;
    116      1.1  pooka }
    117