drivers/char/resetswitch.c-old

   1 /***************************************************************************/
   2
   3 /*
   4  *      linux/drivers/char/resetswitch.c
   5  *
   6  *      Basic driver to support the NETtel software reset button.
   7  *
   8  *      Copyright (C) 1999-2002, Greg Ungerer (gerg@snapgear.com)
   9  */
  10
  11 /***************************************************************************/
  12
  13 #include <linux/module.h>
  14 #include <linux/kernel.h>
  15 #include <linux/sched.h>
  16 #include <linux/param.h>
  17 #include <linux/init.h>
  18 #include <asm/irq.h>
  19 #include <asm/traps.h>
  20 #include <asm/machdep.h>
  21 #include <asm/coldfire.h>
  22 #include <asm/mcftimer.h>
  23 #include <asm/mcfsim.h>
  24 #include <asm/delay.h>
  25
  26 /***************************************************************************/
  27 #ifdef CONFIG_M5272
  28 /***************************************************************************/
  29
  30 /*
  31  *      Off-course the 5272 would have to deal with setting up and
  32  *      acknowledging interrupts differently to all other ColdFIre's!
  33  */
  34 #define SWITCH_IRQ      65
  35
  36 static void __inline__ mcf_enablevector(int vecnr)
  37 {
  38         volatile unsigned long  *icrp;
  39         icrp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_ICR1);
  40         *icrp = (*icrp & 0x07777777) | 0xf0000000;
  41 }
  42
  43 static void __inline__ mcf_disablevector(void)
  44 {
  45         volatile unsigned long  *icrp;
  46         icrp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_ICR1);
  47         *icrp = (*icrp & 0x07777777) | 0x80000000;
  48 }
  49
  50 static void __inline__ mcf_ackvector(void)
  51 {
  52         volatile unsigned long  *icrp;
  53         icrp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_ICR1);
  54         *icrp = (*icrp & 0x07777777) | 0xf0000000;
  55 }
  56
  57 static __inline__ int mcf_isvector(void)
  58 {
  59         return((*((volatile unsigned long *) (MCF_MBAR + MCFSIM_ISR)) & 0x80000000) == 0);
  60 }
  61
  62 /***************************************************************************/
  63 #else
  64 /***************************************************************************/
  65
  66 /*
  67  *      Common vector setup for 5206e, 5307 and 5407.
  68  */
  69 #define SWITCH_IRQ      31
  70
  71 static void __inline__ mcf_enablevector(int vecnr)
  72 {
  73 }
  74
  75 static void __inline__ mcf_disablevec(void)
  76 {
  77         mcf_setimr(mcf_getimr() | MCFSIM_IMR_EINT7);
  78 }
  79
  80 static void __inline__ mcf_ackvector(void)
  81 {
  82         mcf_setimr(mcf_getimr() & ~MCFSIM_IMR_EINT7);
  83 }
  84
  85 static __inline__ int mcf_isvector(void)
  86 {
  87         return(mcf_getipr() & MCFSIM_IMR_EINT7);
  88 }
  89
  90 /***************************************************************************/
  91 #endif /* !CONFIG_M5272 */
  92 /***************************************************************************/
  93
  94 void resetswitch_button(int irq, void *dev_id, struct pt_regs *regs)
  95 {
  96         extern void     flash_eraseconfig(void);
  97         static int      inbutton = 0;
  98
  99         /*
 100          *      IRQ7 is not maskable by the CPU core. It is possible
 101          *      that switch bounce mey get us back here before we have
 102          *      really serviced the interrupt.
 103          */
 104         if (inbutton)
 105                 return;
 106         inbutton = 1;
 107
 108         /* Disable interrupt at SIM - best we can do... */
 109 #if 0
 110         mcf_disablevec();
 111 #endif
 112
 113         /* Try and de-bounce the switch a little... */
 114         udelay(10000);
 115
 116 #ifdef CONFIG_BLK_DEV_BLKMEM
 117         flash_eraseconfig();
 118 #endif
 119
 120         /* Don't leave here 'till button is no longer pushed! */
 121         for (;;) {
 122                 if (mcf_isvector() != 0)
 123                         break;
 124         }
 125
 126         HARD_RESET_NOW();
 127         /* Should never get here... */
 128
 129         inbutton = 0;
 130
 131         mcf_ackvector();
 132 }
 133
 134 /***************************************************************************/
 135
 136 int resetswitch_init(void)
 137 {
 138         mcf_enablevector(SWITCH_IRQ);
 139         mcf_autovector(SWITCH_IRQ);
 140         request_irq(SWITCH_IRQ, resetswitch_button,
 141                 (SA_INTERRUPT | IRQ_FLG_FAST), "Reset Button", NULL);
 142         return(0);
 143 }
 144
 145 module_init(resetswitch_init);
 146
 147 /***************************************************************************/