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