1*ea0364f1SPeter Tyser /* 2*ea0364f1SPeter Tyser * (C) Copyright 2000-2004 3*ea0364f1SPeter Tyser * Wolfgang Denk, DENX Software Engineering, wd@denx.de. 4*ea0364f1SPeter Tyser * 5*ea0364f1SPeter Tyser * (C) Copyright 2007 Freescale Semiconductor Inc 6*ea0364f1SPeter Tyser * TsiChung Liew (Tsi-Chung.Liew@freescale.com) 7*ea0364f1SPeter Tyser * 8*ea0364f1SPeter Tyser * See file CREDITS for list of people who contributed to this 9*ea0364f1SPeter Tyser * project. 10*ea0364f1SPeter Tyser * 11*ea0364f1SPeter Tyser * This program is free software; you can redistribute it and/or 12*ea0364f1SPeter Tyser * modify it under the terms of the GNU General Public License as 13*ea0364f1SPeter Tyser * published by the Free Software Foundation; either version 2 of 14*ea0364f1SPeter Tyser * the License, or (at your option) any later version. 15*ea0364f1SPeter Tyser * 16*ea0364f1SPeter Tyser * This program is distributed in the hope that it will be useful, 17*ea0364f1SPeter Tyser * but WITHOUT ANY WARRANTY; without even the implied warranty of 18*ea0364f1SPeter Tyser * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 19*ea0364f1SPeter Tyser * GNU General Public License for more details. 20*ea0364f1SPeter Tyser * 21*ea0364f1SPeter Tyser * You should have received a copy of the GNU General Public License 22*ea0364f1SPeter Tyser * along with this program; if not, write to the Free Software 23*ea0364f1SPeter Tyser * Foundation, Inc., 59 Temple Place, Suite 330, Boston, 24*ea0364f1SPeter Tyser * MA 02111-1307 USA 25*ea0364f1SPeter Tyser */ 26*ea0364f1SPeter Tyser 27*ea0364f1SPeter Tyser #include <common.h> 28*ea0364f1SPeter Tyser #include <watchdog.h> 29*ea0364f1SPeter Tyser #include <asm/processor.h> 30*ea0364f1SPeter Tyser #include <asm/immap.h> 31*ea0364f1SPeter Tyser 32*ea0364f1SPeter Tyser #define NR_IRQS (CONFIG_SYS_NUM_IRQS) 33*ea0364f1SPeter Tyser 34*ea0364f1SPeter Tyser /* 35*ea0364f1SPeter Tyser * Interrupt vector functions. 36*ea0364f1SPeter Tyser */ 37*ea0364f1SPeter Tyser struct interrupt_action { 38*ea0364f1SPeter Tyser interrupt_handler_t *handler; 39*ea0364f1SPeter Tyser void *arg; 40*ea0364f1SPeter Tyser }; 41*ea0364f1SPeter Tyser 42*ea0364f1SPeter Tyser static struct interrupt_action irq_vecs[NR_IRQS]; 43*ea0364f1SPeter Tyser 44*ea0364f1SPeter Tyser static __inline__ unsigned short get_sr (void) 45*ea0364f1SPeter Tyser { 46*ea0364f1SPeter Tyser unsigned short sr; 47*ea0364f1SPeter Tyser 48*ea0364f1SPeter Tyser asm volatile ("move.w %%sr,%0":"=r" (sr):); 49*ea0364f1SPeter Tyser 50*ea0364f1SPeter Tyser return sr; 51*ea0364f1SPeter Tyser } 52*ea0364f1SPeter Tyser 53*ea0364f1SPeter Tyser static __inline__ void set_sr (unsigned short sr) 54*ea0364f1SPeter Tyser { 55*ea0364f1SPeter Tyser asm volatile ("move.w %0,%%sr"::"r" (sr)); 56*ea0364f1SPeter Tyser } 57*ea0364f1SPeter Tyser 58*ea0364f1SPeter Tyser /************************************************************************/ 59*ea0364f1SPeter Tyser /* 60*ea0364f1SPeter Tyser * Install and free an interrupt handler 61*ea0364f1SPeter Tyser */ 62*ea0364f1SPeter Tyser void irq_install_handler (int vec, interrupt_handler_t * handler, void *arg) 63*ea0364f1SPeter Tyser { 64*ea0364f1SPeter Tyser if ((vec < 0) || (vec >= NR_IRQS)) { 65*ea0364f1SPeter Tyser printf ("irq_install_handler: wrong interrupt vector %d\n", 66*ea0364f1SPeter Tyser vec); 67*ea0364f1SPeter Tyser return; 68*ea0364f1SPeter Tyser } 69*ea0364f1SPeter Tyser 70*ea0364f1SPeter Tyser irq_vecs[vec].handler = handler; 71*ea0364f1SPeter Tyser irq_vecs[vec].arg = arg; 72*ea0364f1SPeter Tyser } 73*ea0364f1SPeter Tyser 74*ea0364f1SPeter Tyser void irq_free_handler (int vec) 75*ea0364f1SPeter Tyser { 76*ea0364f1SPeter Tyser if ((vec < 0) || (vec >= NR_IRQS)) { 77*ea0364f1SPeter Tyser return; 78*ea0364f1SPeter Tyser } 79*ea0364f1SPeter Tyser 80*ea0364f1SPeter Tyser irq_vecs[vec].handler = NULL; 81*ea0364f1SPeter Tyser irq_vecs[vec].arg = NULL; 82*ea0364f1SPeter Tyser } 83*ea0364f1SPeter Tyser 84*ea0364f1SPeter Tyser void enable_interrupts (void) 85*ea0364f1SPeter Tyser { 86*ea0364f1SPeter Tyser unsigned short sr; 87*ea0364f1SPeter Tyser 88*ea0364f1SPeter Tyser sr = get_sr (); 89*ea0364f1SPeter Tyser set_sr (sr & ~0x0700); 90*ea0364f1SPeter Tyser } 91*ea0364f1SPeter Tyser 92*ea0364f1SPeter Tyser int disable_interrupts (void) 93*ea0364f1SPeter Tyser { 94*ea0364f1SPeter Tyser unsigned short sr; 95*ea0364f1SPeter Tyser 96*ea0364f1SPeter Tyser sr = get_sr (); 97*ea0364f1SPeter Tyser set_sr (sr | 0x0700); 98*ea0364f1SPeter Tyser 99*ea0364f1SPeter Tyser return ((sr & 0x0700) == 0); /* return TRUE, if interrupts were enabled before */ 100*ea0364f1SPeter Tyser } 101*ea0364f1SPeter Tyser 102*ea0364f1SPeter Tyser void int_handler (struct pt_regs *fp) 103*ea0364f1SPeter Tyser { 104*ea0364f1SPeter Tyser int vec; 105*ea0364f1SPeter Tyser 106*ea0364f1SPeter Tyser vec = (fp->vector >> 2) & 0xff; 107*ea0364f1SPeter Tyser if (vec > 0x40) 108*ea0364f1SPeter Tyser vec -= 0x40; 109*ea0364f1SPeter Tyser 110*ea0364f1SPeter Tyser if (irq_vecs[vec].handler != NULL) { 111*ea0364f1SPeter Tyser irq_vecs[vec].handler (irq_vecs[vec].arg); 112*ea0364f1SPeter Tyser } else { 113*ea0364f1SPeter Tyser printf ("\nBogus External Interrupt Vector %d\n", vec); 114*ea0364f1SPeter Tyser } 115*ea0364f1SPeter Tyser } 116