Home | History | Annotate | Line # | Download | only in rumpkern
sleepq.c revision 1.1
      1  1.1  pooka /*	$NetBSD: sleepq.c,v 1.1 2008/10/10 13:14:41 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.1  pooka #include <sys/param.h>
     29  1.1  pooka #include <sys/condvar.h>
     30  1.1  pooka #include <sys/mutex.h>
     31  1.1  pooka #include <sys/queue.h>
     32  1.1  pooka #include <sys/sleepq.h>
     33  1.1  pooka #include <sys/syncobj.h>
     34  1.1  pooka 
     35  1.1  pooka /*
     36  1.1  pooka  * Flimsy and minimalistic sleepq implementation.  This is implemented
     37  1.1  pooka  * only for the use of callouts in kern_timeout.c.  locking etc is
     38  1.1  pooka  * completely incorrect, horrible, etc etc etc.
     39  1.1  pooka  */
     40  1.1  pooka 
     41  1.1  pooka syncobj_t sleep_syncobj;
     42  1.1  pooka static kcondvar_t sq_cv;
     43  1.1  pooka static kmutex_t sq_mtx;
     44  1.1  pooka 
     45  1.1  pooka void
     46  1.1  pooka sleepq_init(sleepq_t *sq)
     47  1.1  pooka {
     48  1.1  pooka 
     49  1.1  pooka 	TAILQ_INIT(sq);
     50  1.1  pooka 
     51  1.1  pooka 	cv_init(&sq_cv, "sleepq"); /* XXX */
     52  1.1  pooka 	mutex_init(&sq_mtx, MUTEX_DEFAULT, IPL_NONE); /* multi-XXX */
     53  1.1  pooka }
     54  1.1  pooka 
     55  1.1  pooka void
     56  1.1  pooka sleepq_enqueue(sleepq_t *sq, wchan_t wc, const char *wmsg, syncobj_t *sob)
     57  1.1  pooka {
     58  1.1  pooka 	struct lwp *l = curlwp;
     59  1.1  pooka 
     60  1.1  pooka 	if (__predict_false(sob != &sleep_syncobj || strcmp(wmsg, "callout"))) {
     61  1.1  pooka 		panic("sleepq: unsupported enqueue");
     62  1.1  pooka 	}
     63  1.1  pooka 
     64  1.1  pooka 	l->l_wchan = wc;
     65  1.1  pooka 	TAILQ_INSERT_TAIL(sq, l, l_sleepchain);
     66  1.1  pooka }
     67  1.1  pooka 
     68  1.1  pooka int
     69  1.1  pooka sleepq_block(int timo, bool hatch)
     70  1.1  pooka {
     71  1.1  pooka 	struct lwp *l = curlwp;
     72  1.1  pooka 
     73  1.1  pooka 	KASSERT(timo == 0 && !hatch);
     74  1.1  pooka 
     75  1.1  pooka 	mutex_enter(&sq_mtx);
     76  1.1  pooka 	while (l->l_wchan)
     77  1.1  pooka 		cv_wait(&sq_cv, &sq_mtx);
     78  1.1  pooka 	mutex_exit(&sq_mtx);
     79  1.1  pooka 
     80  1.1  pooka 	return 0;
     81  1.1  pooka }
     82  1.1  pooka 
     83  1.1  pooka lwp_t *
     84  1.1  pooka sleepq_wake(sleepq_t *sq, wchan_t wchan, u_int expected, kmutex_t *mp)
     85  1.1  pooka {
     86  1.1  pooka 	struct lwp *l;
     87  1.1  pooka 	bool found = false;
     88  1.1  pooka 
     89  1.1  pooka 	TAILQ_FOREACH(l, sq, l_sleepchain) {
     90  1.1  pooka 		if (l->l_wchan == wchan) {
     91  1.1  pooka 			found = true;
     92  1.1  pooka 			l->l_wchan = NULL;
     93  1.1  pooka 		}
     94  1.1  pooka 	}
     95  1.1  pooka 	if (found)
     96  1.1  pooka 		cv_broadcast(&sq_cv);
     97  1.1  pooka 
     98  1.1  pooka 	mutex_spin_exit(mp);
     99  1.1  pooka 	return NULL;
    100  1.1  pooka }
    101  1.1  pooka 
    102  1.1  pooka /*
    103  1.1  pooka  * XXX: used only by callout, therefore here
    104  1.1  pooka  *
    105  1.1  pooka  * We don't fudge around with the lwp mutex at all, therefore
    106  1.1  pooka  * this is enough.
    107  1.1  pooka  */
    108  1.1  pooka kmutex_t *
    109  1.1  pooka lwp_lock_retry(struct lwp *l, kmutex_t *old)
    110  1.1  pooka {
    111  1.1  pooka 
    112  1.1  pooka 	return old;
    113  1.1  pooka }
    114