00001 /* 00002 * Copyright (C) 2005-2006 by egnite Software GmbH. All rights reserved. 00003 * 00004 * Redistribution and use in source and binary forms, with or without 00005 * modification, are permitted provided that the following conditions 00006 * are met: 00007 * 00008 * 1. Redistributions of source code must retain the above copyright 00009 * notice, this list of conditions and the following disclaimer. 00010 * 2. Redistributions in binary form must reproduce the above copyright 00011 * notice, this list of conditions and the following disclaimer in the 00012 * documentation and/or other materials provided with the distribution. 00013 * 3. Neither the name of the copyright holders nor the names of 00014 * contributors may be used to endorse or promote products derived 00015 * from this software without specific prior written permission. 00016 * 00017 * THIS SOFTWARE IS PROVIDED BY EGNITE SOFTWARE GMBH AND CONTRIBUTORS 00018 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 00019 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 00020 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL EGNITE 00021 * SOFTWARE GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 00022 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 00023 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 00024 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 00025 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 00026 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 00027 * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 00028 * SUCH DAMAGE. 00029 * 00030 * For additional information see http://www.ethernut.de/ 00031 * 00032 */ 00033 00034 /* 00035 * $Log: ih_at91pio.c,v $ 00036 * Revision 1.3 2006/07/05 07:56:34 haraldkipp 00037 * Interrupt handler will be included only, if the related interrupt 00038 * ID is defined in the platform specific header file. 00039 * 00040 * Revision 1.2 2006/06/28 17:10:15 haraldkipp 00041 * Include more general header file for ARM. 00042 * 00043 * Revision 1.1 2005/10/24 08:56:09 haraldkipp 00044 * First check in. 00045 * 00046 */ 00047 00048 #include <arch/arm.h> 00049 #include <dev/irqreg.h> 00050 00051 #if defined(PIO_ID) 00052 00053 #ifndef NUT_IRQPRI_PIO 00054 #define NUT_IRQPRI_PIO 4 00055 #endif 00056 00057 static int PortIoIrqCtl(int cmd, void *param); 00058 00059 IRQ_HANDLER sig_PIO = { 00060 #ifdef NUT_PERFMON 00061 0, /* Interrupt counter, ir_count. */ 00062 #endif 00063 NULL, /* Passed argument, ir_arg. */ 00064 NULL, /* Handler subroutine, ir_handler. */ 00065 PortIoIrqCtl /* Interrupt control, ir_ctl. */ 00066 }; 00067 00071 static void PortIoIrqEntry(void) __attribute__ ((naked)); 00072 void PortIoIrqEntry(void) 00073 { 00074 IRQ_ENTRY(); 00075 #ifdef NUT_PERFMON 00076 sig_PIO.ir_count++; 00077 #endif 00078 if (sig_PIO.ir_handler) { 00079 (sig_PIO.ir_handler) (sig_PIO.ir_arg); 00080 } 00081 IRQ_EXIT(); 00082 } 00083 00099 static int PortIoIrqCtl(int cmd, void *param) 00100 { 00101 int rc = 0; 00102 u_int *ival = (u_int *)param; 00103 int enabled = inr(AIC_IMR) & _BV(PIO_ID); 00104 00105 /* Disable interrupt. */ 00106 if (enabled) { 00107 outr(AIC_IDCR, _BV(PIO_ID)); 00108 } 00109 00110 switch(cmd) { 00111 case NUT_IRQCTL_INIT: 00112 /* Set the vector. */ 00113 outr(AIC_SVR(PIO_ID), (unsigned int)PortIoIrqEntry); 00114 /* Initialize to edge triggered with defined priority. */ 00115 outr(AIC_SMR(PIO_ID), AIC_SRCTYPE_INT_EDGE_TRIGGERED | NUT_IRQPRI_PIO); 00116 /* Clear interrupt */ 00117 outr(AIC_ICCR, _BV(PIO_ID)); 00118 break; 00119 case NUT_IRQCTL_STATUS: 00120 if (enabled) { 00121 *ival |= 1; 00122 } 00123 else { 00124 *ival &= ~1; 00125 } 00126 break; 00127 case NUT_IRQCTL_ENABLE: 00128 enabled = 1; 00129 break; 00130 case NUT_IRQCTL_DISABLE: 00131 enabled = 0; 00132 break; 00133 case NUT_IRQCTL_GETPRIO: 00134 *ival = inr(AIC_SMR(PIO_ID)) & AIC_PRIOR; 00135 break; 00136 case NUT_IRQCTL_SETPRIO: 00137 outr(AIC_SMR(PIO_ID), (inr(AIC_SMR(PIO_ID)) & ~AIC_PRIOR) | *ival); 00138 break; 00139 #ifdef NUT_PERFMON 00140 case NUT_IRQCTL_GETCOUNT: 00141 *ival = (u_int)sig_PIO.ir_count; 00142 sig_PIO.ir_count = 0; 00143 break; 00144 #endif 00145 default: 00146 rc = -1; 00147 break; 00148 } 00149 00150 /* Enable interrupt. */ 00151 if (enabled) { 00152 outr(AIC_IECR, _BV(PIO_ID)); 00153 } 00154 return rc; 00155 } 00156 00157 #endif /* PIO_ID */