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