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