Add arch/nios2/cpu-nios2/interrupts.c
PATCH 6/54 Add arch/nios2/cpu-nios2/interrupts.c
From: Franck JULLIEN <[email protected]>
Add arch/nios2/cpu-nios2/interrupts.c
--- arch/nios2/cpu-nios2/interrupts.c | 140 +++++++++++++++++++++++++++++++++++++ 1 files changed, 140 insertions(+), 0 deletions(-) create mode 100644 arch/nios2/cpu-nios2/interrupts.c
arch/nios2/cpu-nios2/interrupts.c new file +140 -0
@@ -0,0 +1,140 @@ +/* +* (C) Copyright 2000-2002 +* Wolfgang Denk, DENX Software Engineering, [email protected]. +* +* (C) Copyright 2004, Psyent Corporation <www.psyent.com> +* Scott McNutt <[email protected]> +* +* See file CREDITS for list of people who contributed to this +* project. +* +* This program is free software; you can redistribute it and/or +* modify it under the terms of the GNU General Public License as +* published by the Free Software Foundation; either version 2 of +* the License, or (at your option) any later version. +* +* This program is distributed in the hope that it will be useful, +* but WITHOUT ANY WARRANTY; without even the implied warranty of +* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the +* GNU General Public License for more details. +* +* You should have received a copy of the GNU General Public License +* along with this program; if not, write to the Free Software +* Foundation, Inc., 59 Temple Place, Suite 330, Boston, +* MA 02111-1307 USA +*/ + +#include <nios2.h> +#include <asm/nios2-io.h> +#include <asm/types.h> +#include <asm/io.h> +#include <asm/ptrace.h> +#include <common.h> +#include <command.h> +#include <watchdog.h> + +/****************************************************************************/ + +struct irq_action { +interrupt_handler_t *handler; +void *arg; +int count; +}; + +static struct irq_action vecs[32 ]; + +/****************************************************************************/ + +int disable_interrupts (void ) +{ +int val =rdctl (CTL_STATUS ); +wrctl (CTL_STATUS , val & ~STATUS_IE ); +return (val &STATUS_IE ); +} + +void enable_interrupts (void ) +{ +int val =rdctl (CTL_STATUS ); +wrctl (CTL_STATUS , val |STATUS_IE ); +} + +void external_interrupt (struct pt_regs *regs) +{ + +unsigned irqs; +struct irq_action *act; + +/* Evaluate only irqs that are both enabled AND pending */ + irqs =rdctl (CTL_IENABLE ) &rdctl (CTL_IPENDING ); + act = vecs; + +/* Assume (as does the Nios2 HAL) that bit 0 is highest +* priority. NOTE: There is ALWAYS a handler assigned +* (the default if no other). +*/ +while (irqs) { +if (irqs &1 ) { + act->handler (act->arg); + act->count++; + } + irqs >>=1 ; + act++; + } + +} + +static void def_hdlr (void *arg) +{ +unsigned irqs =rdctl (CTL_IENABLE ); + +/* Disable the individual interrupt -- with gratuitous +* warning. +*/ + irqs &= ~(1 << (int )arg); +wrctl (CTL_IENABLE , irqs); +printf ("WARNING: Disabling unhandled interrupt: %d\n" , + (int )arg); +} + +/*************************************************************************/ +void irq_install_handler (int irq,interrupt_handler_t *hdlr,void *arg) +{ + +int flag; +struct irq_action *act; +unsigned ena =rdctl (CTL_IENABLE ); + +if ((irq <0 ) || (irq >31 )) +return ; + act = &vecs[irq]; + + flag =disable_interrupts (); +if (hdlr) { + act->handler = hdlr; + act->arg = arg; + ena |= (1 << irq);/* enable */ + }else { + act->handler = def_hdlr; + act->arg = (void *)irq; + ena &= ~(1 << irq);/* disable */ + } +wrctl (CTL_IENABLE , ena); +if (flag)enable_interrupts (); +} + + +int interrupt_init (void ) +{ +int i; + +/* Assign the default handler to all */ +for (i =0 ; i <32 ; i++) { + vecs[i].handler = def_hdlr; + vecs[i].arg = (void *)i; + vecs[i].count =0 ; + } + +enable_interrupts (); +return (0 ); +} +
Signature · 7 lines
1.7.3.4 _______________________________________________ barebox mailing list [email protected] http://lists.infradead.org/mailman/listinfo/barebox