Home | History | Annotate | Line # | Download | only in rumpkern
sleepq.c revision 1.2
      1  1.2  pooka /*	$NetBSD: sleepq.c,v 1.2 2008/12/18 00:24:12 pooka 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.2  pooka #include <sys/cdefs.h>
     29  1.2  pooka __KERNEL_RCSID(0, "$NetBSD: sleepq.c,v 1.2 2008/12/18 00:24:12 pooka Exp $");
     30  1.2  pooka 
     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