xref: /freebsd-11-stable/sys/arm/arm/intr.c

/*	$NetBSD: intr.c,v 1.12 2003/07/15 00:24:41 lukem Exp $	*/

/*-
 * Copyright (c) 2004 Olivier Houchard.
 * Copyright (c) 1994-1998 Mark Brinicombe.
 * All rights reserved.
 *
 * 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.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 *	This product includes software developed by Mark Brinicombe
 *	for the NetBSD Project.
 * 4. The name of the company nor the name of the author may be used to
 *    endorse or promote products derived from this software without specific
 *    prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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.
 *
 * Soft interrupt and other generic interrupt functions.
 */

#include <sys/cdefs.h>
__FBSDID("$FreeBSD: head/sys/arm/arm/intr.c 139735 2005-01-05 21:58:49Z imp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/syslog.h>
#include <sys/malloc.h>
#include <sys/proc.h>
#include <sys/bus.h>
#include <sys/interrupt.h>
#include <sys/conf.h>
#include <machine/atomic.h>
#include <machine/intr.h>
#include <machine/cpu.h>

static struct ithd *ithreads[NIRQ];
static int intrcnt_tab[NIRQ];
static int intrcnt_index = 0;
static int last_printed = 0;
struct arm_intr {
	driver_intr_t *handler;
	void *arg;
	void *cookiep;
	int irq;
};

static void
arm_intr_handler(void *arg)
{
	struct arm_intr *intr = (struct arm_intr *)arg;

	intr->handler(intr->arg);
	arm_unmask_irqs(1 << intr->irq);
}

void	arm_handler_execute(void *, int);

void
arm_setup_irqhandler(const char *name, void (*hand)(void*), void *arg,
    int irq, int flags, void **cookiep)
{
	struct ithd *cur_ith;
	struct arm_intr *intr = NULL;
	int error;

	if (irq < 0 || irq >= NIRQ)
		return;
	if (!(flags & INTR_FAST))
		intr = malloc(sizeof(*intr), M_DEVBUF, M_WAITOK);
	cur_ith = ithreads[irq];
	if (cur_ith == NULL) {
		error = ithread_create(&cur_ith, irq, 0, NULL, NULL, "intr%d:",
		    irq);
		if (error)
			return;
		ithreads[irq] = cur_ith;
		last_printed +=
		    snprintf(intrnames + last_printed,
		    MAXCOMLEN + 1,
		    "irq%d: %s", irq, name);
		last_printed++;
		intrcnt_tab[irq] = intrcnt_index;
		intrcnt_index++;

	}
	if (!(flags & INTR_FAST)) {
		intr->handler = hand;
		intr->arg = arg;
		intr->irq = irq;
		intr->cookiep = *cookiep;
		ithread_add_handler(cur_ith, name, arm_intr_handler, intr,
		    ithread_priority(flags), flags, cookiep);
	} else
		ithread_add_handler(cur_ith, name, hand, arg,
		    ithread_priority(flags), flags, cookiep);
}

void dosoftints(void);
void
dosoftints(void)
{
}

void
arm_handler_execute(void *frame, int irqnb)
{
	struct ithd *ithd;
	int i;
	struct intrhand *ih;
	struct thread *td = curthread;

	td->td_intr_nesting_level++;
	if (irqnb == 0)
		irqnb = arm_get_irqnb(frame);
	arm_mask_irqs(irqnb);
	enable_interrupts(I32_bit|F32_bit);
	while (irqnb != 0) {
		i = ffs(irqnb) - 1;
		intrcnt[intrcnt_tab[i]]++;
		irqnb &= ~(1U << i);
		ithd = ithreads[i];
		if (!ithd)
			continue;
		ih = TAILQ_FIRST(&ithd->it_handlers);
		if (ih && ih->ih_flags & IH_FAST) {
			TAILQ_FOREACH(ih, &ithd->it_handlers,
			    ih_next) {
				ih->ih_handler(ih->ih_argument ?
				    ih->ih_argument : frame);
			}
			arm_unmask_irqs(1 << i);
		} else if (ih)
			ithread_schedule(ithd);
		irqnb |= arm_get_irqnb(frame);
	}
	td->td_intr_nesting_level--;
}