subr_callback.c revision 1.2.6.2 1 1.2.6.2 chap /* $NetBSD: subr_callback.c,v 1.2.6.2 2006/06/19 04:07:16 chap Exp $ */
2 1.2.6.2 chap
3 1.2.6.2 chap /*-
4 1.2.6.2 chap * Copyright (c)2006 YAMAMOTO Takashi,
5 1.2.6.2 chap * All rights reserved.
6 1.2.6.2 chap *
7 1.2.6.2 chap * Redistribution and use in source and binary forms, with or without
8 1.2.6.2 chap * modification, are permitted provided that the following conditions
9 1.2.6.2 chap * are met:
10 1.2.6.2 chap * 1. Redistributions of source code must retain the above copyright
11 1.2.6.2 chap * notice, this list of conditions and the following disclaimer.
12 1.2.6.2 chap * 2. Redistributions in binary form must reproduce the above copyright
13 1.2.6.2 chap * notice, this list of conditions and the following disclaimer in the
14 1.2.6.2 chap * documentation and/or other materials provided with the distribution.
15 1.2.6.2 chap *
16 1.2.6.2 chap * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 1.2.6.2 chap * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 1.2.6.2 chap * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 1.2.6.2 chap * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 1.2.6.2 chap * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 1.2.6.2 chap * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 1.2.6.2 chap * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 1.2.6.2 chap * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 1.2.6.2 chap * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.2.6.2 chap * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.2.6.2 chap * SUCH DAMAGE.
27 1.2.6.2 chap */
28 1.2.6.2 chap
29 1.2.6.2 chap #include <sys/cdefs.h>
30 1.2.6.2 chap __KERNEL_RCSID(0, "$NetBSD: subr_callback.c,v 1.2.6.2 2006/06/19 04:07:16 chap Exp $");
31 1.2.6.2 chap
32 1.2.6.2 chap #include <sys/param.h>
33 1.2.6.2 chap #include <sys/systm.h>
34 1.2.6.2 chap #include <sys/proc.h>
35 1.2.6.2 chap #include <sys/callback.h>
36 1.2.6.2 chap
37 1.2.6.2 chap #define CH_WANT 1
38 1.2.6.2 chap
39 1.2.6.2 chap void
40 1.2.6.2 chap callback_head_init(struct callback_head *ch)
41 1.2.6.2 chap {
42 1.2.6.2 chap
43 1.2.6.2 chap simple_lock_init(&ch->ch_lock);
44 1.2.6.2 chap TAILQ_INIT(&ch->ch_q);
45 1.2.6.2 chap ch->ch_next = NULL;
46 1.2.6.2 chap ch->ch_nentries = 0;
47 1.2.6.2 chap ch->ch_running = 0;
48 1.2.6.2 chap ch->ch_flags = 0;
49 1.2.6.2 chap }
50 1.2.6.2 chap
51 1.2.6.2 chap void
52 1.2.6.2 chap callback_register(struct callback_head *ch, struct callback_entry *ce,
53 1.2.6.2 chap void *obj, int (*fn)(struct callback_entry *, void *, void *))
54 1.2.6.2 chap {
55 1.2.6.2 chap
56 1.2.6.2 chap ce->ce_func = fn;
57 1.2.6.2 chap ce->ce_obj = obj;
58 1.2.6.2 chap simple_lock(&ch->ch_lock);
59 1.2.6.2 chap TAILQ_INSERT_TAIL(&ch->ch_q, ce, ce_q);
60 1.2.6.2 chap ch->ch_nentries++;
61 1.2.6.2 chap simple_unlock(&ch->ch_lock);
62 1.2.6.2 chap }
63 1.2.6.2 chap
64 1.2.6.2 chap void
65 1.2.6.2 chap callback_unregister(struct callback_head *ch, struct callback_entry *ce)
66 1.2.6.2 chap {
67 1.2.6.2 chap
68 1.2.6.2 chap simple_lock(&ch->ch_lock);
69 1.2.6.2 chap while (ch->ch_running > 0) {
70 1.2.6.2 chap ch->ch_flags |= CH_WANT;
71 1.2.6.2 chap ltsleep(&ch->ch_running, PVM, "recunreg", 0, &ch->ch_lock);
72 1.2.6.2 chap }
73 1.2.6.2 chap if (__predict_false(ch->ch_next == ce)) {
74 1.2.6.2 chap ch->ch_next = TAILQ_NEXT(ce, ce_q);
75 1.2.6.2 chap }
76 1.2.6.2 chap TAILQ_REMOVE(&ch->ch_q, ce, ce_q);
77 1.2.6.2 chap ch->ch_nentries--;
78 1.2.6.2 chap simple_unlock(&ch->ch_lock);
79 1.2.6.2 chap }
80 1.2.6.2 chap
81 1.2.6.2 chap static int
82 1.2.6.2 chap callback_runone(struct callback_head *ch, void *arg)
83 1.2.6.2 chap {
84 1.2.6.2 chap struct callback_entry *ce;
85 1.2.6.2 chap int result;
86 1.2.6.2 chap
87 1.2.6.2 chap KASSERT(ch->ch_nentries > 0);
88 1.2.6.2 chap KASSERT(ch->ch_running > 0);
89 1.2.6.2 chap
90 1.2.6.2 chap ce = ch->ch_next;
91 1.2.6.2 chap if (ce == NULL) {
92 1.2.6.2 chap ce = TAILQ_FIRST(&ch->ch_q);
93 1.2.6.2 chap }
94 1.2.6.2 chap KASSERT(ce != NULL);
95 1.2.6.2 chap result = (*ce->ce_func)(ce, ce->ce_obj, arg);
96 1.2.6.2 chap ch->ch_next = TAILQ_NEXT(ce, ce_q);
97 1.2.6.2 chap return result;
98 1.2.6.2 chap }
99 1.2.6.2 chap
100 1.2.6.2 chap static void
101 1.2.6.2 chap callback_run_enter(struct callback_head *ch)
102 1.2.6.2 chap {
103 1.2.6.2 chap
104 1.2.6.2 chap simple_lock(&ch->ch_lock);
105 1.2.6.2 chap ch->ch_running++;
106 1.2.6.2 chap simple_unlock(&ch->ch_lock);
107 1.2.6.2 chap }
108 1.2.6.2 chap
109 1.2.6.2 chap static void
110 1.2.6.2 chap callback_run_leave(struct callback_head *ch)
111 1.2.6.2 chap {
112 1.2.6.2 chap
113 1.2.6.2 chap simple_lock(&ch->ch_lock);
114 1.2.6.2 chap KASSERT(ch->ch_running > 0);
115 1.2.6.2 chap ch->ch_running--;
116 1.2.6.2 chap if (ch->ch_running == 0 && (ch->ch_flags & CH_WANT) != 0) {
117 1.2.6.2 chap ch->ch_flags &= ~CH_WANT;
118 1.2.6.2 chap wakeup(&ch->ch_running);
119 1.2.6.2 chap }
120 1.2.6.2 chap simple_unlock(&ch->ch_lock);
121 1.2.6.2 chap }
122 1.2.6.2 chap
123 1.2.6.2 chap int
124 1.2.6.2 chap callback_run_roundrobin(struct callback_head *ch, void *arg)
125 1.2.6.2 chap {
126 1.2.6.2 chap int i;
127 1.2.6.2 chap int n;
128 1.2.6.2 chap int result = 0;
129 1.2.6.2 chap
130 1.2.6.2 chap callback_run_enter(ch);
131 1.2.6.2 chap n = ch->ch_nentries;
132 1.2.6.2 chap for (i = 0; i < n; i++) {
133 1.2.6.2 chap result = callback_runone(ch, arg);
134 1.2.6.2 chap if (result != CALLBACK_CHAIN_CONTINUE) {
135 1.2.6.2 chap break;
136 1.2.6.2 chap }
137 1.2.6.2 chap }
138 1.2.6.2 chap callback_run_leave(ch);
139 1.2.6.2 chap
140 1.2.6.2 chap return result;
141 1.2.6.2 chap }
142