mirror of
https://github.com/Stichting-MINIX-Research-Foundation/netbsd.git
synced 2025-08-08 05:29:10 -04:00
129 lines
3.4 KiB
C
129 lines
3.4 KiB
C
/* $NetBSD: hd6446xintc.c,v 1.8 2008/04/28 20:23:22 martin Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 2002 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by UCHIYAMA Yasushi.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
|
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
|
|
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
|
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
|
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
* POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: hd6446xintc.c,v 1.8 2008/04/28 20:23:22 martin Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
|
|
#include <sh3/devreg.h>
|
|
#include <hpcsh/dev/hd6446x/hd6446xintcreg.h>
|
|
#include <hpcsh/dev/hd6446x/hd6446xintcvar.h>
|
|
|
|
struct hd6446x_intrhand hd6446x_intrhand[_HD6446X_INTR_N];
|
|
uint16_t hd6446x_imask[_IPL_N];
|
|
uint16_t hd6446x_ienable;
|
|
|
|
static void hd6446x_intr_priority_update(void);
|
|
|
|
|
|
void
|
|
hd6446x_intr_init(void)
|
|
{
|
|
|
|
/* Initialize interrupt priority masks. */
|
|
hd6446x_intr_priority_update();
|
|
}
|
|
|
|
void *
|
|
hd6446x_intr_establish(int irq, int mode, int level,
|
|
int (*func)(void *), void *arg)
|
|
{
|
|
struct hd6446x_intrhand *hh = &hd6446x_intrhand[ffs(irq) - 1];
|
|
int s;
|
|
|
|
s = splhigh();
|
|
|
|
/* Register interrupt handler */
|
|
hh->hh_func = func;
|
|
hh->hh_arg = arg;
|
|
hh->hh_ipl = level << 4;
|
|
hh->hh_imask = irq;
|
|
hd6446x_ienable |= hh->hh_imask;
|
|
|
|
/* Update interrupt priority masks. */
|
|
hd6446x_intr_priority_update();
|
|
|
|
splx(s);
|
|
|
|
return (hh);
|
|
}
|
|
|
|
void
|
|
hd6446x_intr_disestablish(void *handle)
|
|
{
|
|
struct hd6446x_intrhand *hh = handle;
|
|
int s;
|
|
|
|
s = splhigh();
|
|
|
|
/* Update interrupt priority masks */
|
|
hd6446x_ienable &= ~hh->hh_imask;
|
|
memset(hh, 0, sizeof(*hh));
|
|
hd6446x_intr_priority_update();
|
|
|
|
splx(s);
|
|
}
|
|
|
|
void
|
|
hd6446x_intr_priority(int irq, int level)
|
|
{
|
|
struct hd6446x_intrhand *hh = &hd6446x_intrhand[ffs(irq) - 1];
|
|
int s;
|
|
|
|
KDASSERT(hh->hh_func != NULL);
|
|
s = splhigh();
|
|
hh->hh_ipl = level << 4;
|
|
hd6446x_intr_priority_update();
|
|
splx(s);
|
|
}
|
|
|
|
static void
|
|
hd6446x_intr_priority_update(void)
|
|
{
|
|
int ipl, src;
|
|
|
|
for (ipl = 0; ipl < _IPL_N; ipl++) {
|
|
uint16_t mask = ~hd6446x_ienable; /* mask disabled */
|
|
|
|
/* mask sources interrupting at <= ipl */
|
|
for (src = 0; src < _HD6446X_INTR_N; ++src) {
|
|
struct hd6446x_intrhand *hh = &hd6446x_intrhand[src];
|
|
|
|
if (hh->hh_func != NULL && hh->hh_ipl <= (ipl << 4))
|
|
mask |= 1 << src;
|
|
}
|
|
|
|
hd6446x_imask[ipl] = mask;
|
|
}
|
|
}
|