Home | History | Annotate | Line # | Download | only in hd6446x
hd6446xintc.c revision 1.2.16.2
      1  1.2.16.2   yamt /*	$NetBSD: hd6446xintc.c,v 1.2.16.2 2006/12/30 20:46:04 yamt Exp $	*/
      2       1.1    uch 
      3       1.1    uch /*-
      4       1.1    uch  * Copyright (c) 2002 The NetBSD Foundation, Inc.
      5       1.1    uch  * All rights reserved.
      6       1.1    uch  *
      7       1.1    uch  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1    uch  * by UCHIYAMA Yasushi.
      9       1.1    uch  *
     10       1.1    uch  * Redistribution and use in source and binary forms, with or without
     11       1.1    uch  * modification, are permitted provided that the following conditions
     12       1.1    uch  * are met:
     13       1.1    uch  * 1. Redistributions of source code must retain the above copyright
     14       1.1    uch  *    notice, this list of conditions and the following disclaimer.
     15       1.1    uch  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1    uch  *    notice, this list of conditions and the following disclaimer in the
     17       1.1    uch  *    documentation and/or other materials provided with the distribution.
     18       1.1    uch  * 3. All advertising materials mentioning features or use of this software
     19       1.1    uch  *    must display the following acknowledgement:
     20       1.1    uch  *        This product includes software developed by the NetBSD
     21       1.1    uch  *        Foundation, Inc. and its contributors.
     22       1.1    uch  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23       1.1    uch  *    contributors may be used to endorse or promote products derived
     24       1.1    uch  *    from this software without specific prior written permission.
     25       1.1    uch  *
     26       1.1    uch  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27       1.1    uch  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28       1.1    uch  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29       1.1    uch  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30       1.1    uch  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31       1.1    uch  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32       1.1    uch  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33       1.1    uch  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34       1.1    uch  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35       1.1    uch  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36       1.1    uch  * POSSIBILITY OF SUCH DAMAGE.
     37       1.1    uch  */
     38       1.2  lukem 
     39       1.2  lukem #include <sys/cdefs.h>
     40  1.2.16.2   yamt __KERNEL_RCSID(0, "$NetBSD: hd6446xintc.c,v 1.2.16.2 2006/12/30 20:46:04 yamt Exp $");
     41       1.1    uch 
     42       1.1    uch #include <sys/param.h>
     43       1.1    uch #include <sys/systm.h>
     44       1.1    uch 
     45       1.1    uch #include <sh3/devreg.h>
     46       1.1    uch #include <hpcsh/dev/hd6446x/hd6446xintcreg.h>
     47  1.2.16.1   yamt #include <hpcsh/dev/hd6446x/hd6446xintcvar.h>
     48       1.1    uch 
     49       1.1    uch struct hd6446x_intrhand hd6446x_intrhand[_HD6446X_INTR_N];
     50  1.2.16.1   yamt uint16_t hd6446x_imask[_IPL_N];
     51  1.2.16.1   yamt uint16_t hd6446x_ienable;
     52  1.2.16.1   yamt 
     53  1.2.16.1   yamt static void hd6446x_intr_priority_update(void);
     54  1.2.16.1   yamt 
     55       1.1    uch 
     56       1.1    uch void
     57  1.2.16.1   yamt hd6446x_intr_init(void)
     58       1.1    uch {
     59       1.1    uch 
     60       1.1    uch 	/* Initialize interrupt priority masks. */
     61       1.1    uch 	hd6446x_intr_priority_update();
     62       1.1    uch }
     63       1.1    uch 
     64       1.1    uch void *
     65       1.1    uch hd6446x_intr_establish(int irq, int mode, int level,
     66       1.1    uch     int (*func)(void *), void *arg)
     67       1.1    uch {
     68       1.1    uch 	struct hd6446x_intrhand *hh = &hd6446x_intrhand[ffs(irq) - 1];
     69       1.1    uch 	int s;
     70       1.1    uch 
     71       1.1    uch 	s = splhigh();
     72       1.1    uch 
     73       1.1    uch 	/* Register interrupt handler */
     74       1.1    uch 	hh->hh_func = func;
     75       1.1    uch 	hh->hh_arg = arg;
     76       1.1    uch 	hh->hh_ipl = level << 4;
     77       1.1    uch 	hh->hh_imask = irq;
     78       1.1    uch 	hd6446x_ienable |= hh->hh_imask;
     79       1.1    uch 
     80       1.1    uch 	/* Update interrupt priority masks. */
     81       1.1    uch 	hd6446x_intr_priority_update();
     82       1.1    uch 
     83       1.1    uch 	splx(s);
     84       1.1    uch 
     85       1.1    uch 	return (hh);
     86       1.1    uch }
     87       1.1    uch 
     88       1.1    uch void
     89       1.1    uch hd6446x_intr_disestablish(void *handle)
     90       1.1    uch {
     91       1.1    uch 	struct hd6446x_intrhand *hh = handle;
     92       1.1    uch 	int s;
     93       1.1    uch 
     94       1.1    uch 	s = splhigh();
     95       1.1    uch 
     96       1.1    uch 	/* Update interrupt priority masks */
     97       1.1    uch 	hd6446x_ienable &= ~hh->hh_imask;
     98       1.1    uch 	memset(hh, 0, sizeof(*hh));
     99       1.1    uch 	hd6446x_intr_priority_update();
    100       1.1    uch 
    101       1.1    uch 	splx(s);
    102       1.1    uch }
    103       1.1    uch 
    104       1.1    uch void
    105       1.1    uch hd6446x_intr_priority(int irq, int level)
    106       1.1    uch {
    107       1.1    uch 	struct hd6446x_intrhand *hh = &hd6446x_intrhand[ffs(irq) - 1];
    108       1.1    uch 	int s;
    109       1.1    uch 
    110       1.1    uch 	KDASSERT(hh->hh_func != NULL);
    111       1.1    uch 	s = splhigh();
    112       1.1    uch 	hh->hh_ipl = level << 4;
    113       1.1    uch 	hd6446x_intr_priority_update();
    114       1.1    uch 	splx(s);
    115       1.1    uch }
    116       1.1    uch 
    117  1.2.16.1   yamt static void
    118  1.2.16.1   yamt hd6446x_intr_priority_update(void)
    119       1.1    uch {
    120  1.2.16.2   yamt 	int ipl, src;
    121  1.2.16.2   yamt 
    122       1.1    uch 	for (ipl = 0; ipl < _IPL_N; ipl++) {
    123  1.2.16.2   yamt 		uint16_t mask = ~hd6446x_ienable; /* mask disabled */
    124  1.2.16.2   yamt 
    125  1.2.16.2   yamt 		/* mask sources interrupting at <= ipl */
    126  1.2.16.2   yamt 		for (src = 0; src < _HD6446X_INTR_N; ++src) {
    127  1.2.16.2   yamt 			struct hd6446x_intrhand *hh = &hd6446x_intrhand[src];
    128  1.2.16.2   yamt 
    129  1.2.16.2   yamt 			if (hh->hh_func != NULL && hh->hh_ipl <= (ipl << 4))
    130  1.2.16.2   yamt 				mask |= 1 << src;
    131       1.1    uch 		}
    132       1.1    uch 
    133  1.2.16.2   yamt 		hd6446x_imask[ipl] = mask;
    134  1.2.16.2   yamt 	}
    135       1.1    uch }
    136