00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041 #include <arch/arm.h>
00042 #include <dev/irqreg.h>
00043
00044 #ifndef NUT_IRQPRI_SPI0
00045 #define NUT_IRQPRI_SPI0 4
00046 #endif
00047
00048 static int SerialPeripheral0IrqCtl(int cmd, void *param);
00049
00050 IRQ_HANDLER sig_SPI0 = {
00051 #ifdef NUT_PERFMON
00052 0,
00053 #endif
00054 NULL,
00055 NULL,
00056 SerialPeripheral0IrqCtl
00057 };
00058
00062 static void SerialPeripheral0IrqEntry(void) __attribute__ ((naked));
00063 void SerialPeripheral0IrqEntry(void)
00064 {
00065 IRQ_ENTRY();
00066 #ifdef NUT_PERFMON
00067 sig_SPI0.ir_count++;
00068 #endif
00069 if (sig_SPI0.ir_handler) {
00070 (sig_SPI0.ir_handler) (sig_SPI0.ir_arg);
00071 }
00072 IRQ_EXIT();
00073 }
00074
00090 static int SerialPeripheral0IrqCtl(int cmd, void *param)
00091 {
00092 int rc = 0;
00093 u_int *ival = (u_int *) param;
00094 int enabled = inr(AIC_IMR) & _BV(SPI0_ID);
00095
00096
00097 if (enabled) {
00098 outr(AIC_IDCR, _BV(SPI0_ID));
00099 }
00100
00101 switch (cmd) {
00102 case NUT_IRQCTL_INIT:
00103
00104 outr(AIC_SVR(SPI0_ID), (unsigned int) SerialPeripheral0IrqEntry);
00105
00106 outr(AIC_SMR(SPI0_ID), AIC_SRCTYPE_INT_EDGE_TRIGGERED | NUT_IRQPRI_SPI0);
00107
00108 outr(AIC_ICCR, _BV(SPI0_ID));
00109 break;
00110 case NUT_IRQCTL_STATUS:
00111 if (enabled) {
00112 *ival |= 1;
00113 } else {
00114 *ival &= ~1;
00115 }
00116 break;
00117 case NUT_IRQCTL_ENABLE:
00118 enabled = 1;
00119 break;
00120 case NUT_IRQCTL_DISABLE:
00121 enabled = 0;
00122 break;
00123 case NUT_IRQCTL_GETPRIO:
00124 *ival = inr(AIC_SMR(SPI0_ID)) & AIC_PRIOR;
00125 break;
00126 case NUT_IRQCTL_SETPRIO:
00127 outr(AIC_SMR(SPI0_ID), (inr(AIC_SMR(SPI0_ID)) & ~AIC_PRIOR) | *ival);
00128 break;
00129 #ifdef NUT_PERFMON
00130 case NUT_IRQCTL_GETCOUNT:
00131 *ival = (u_int) sig_SPI0.ir_count;
00132 sig_SPI0.ir_count = 0;
00133 break;
00134 #endif
00135 default:
00136 rc = -1;
00137 break;
00138 }
00139
00140
00141 if (enabled) {
00142 outr(AIC_IECR, _BV(SPI0_ID));
00143 }
00144 return rc;
00145 }