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