/*	$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;
	}
}