git.oblomov.eu Git - linux-2.6/blob - arch/ppc/syslib/m8xx_wdt.c

   1 /*
   2  * m8xx_wdt.c - MPC8xx watchdog driver
   3  *
   4  * Author: Florian Schirmer <jolt@tuxbox.org>
   5  *
   6  * 2002 (c) Florian Schirmer <jolt@tuxbox.org> This file is licensed under
   7  * the terms of the GNU General Public License version 2. This program
   8  * is licensed "as is" without any warranty of any kind, whether express
   9  * or implied.
  10  */
  11
  12 #include <linux/init.h>
  13 #include <linux/interrupt.h>
  14 #include <linux/irq.h>
  15 #include <linux/kernel.h>
  16 #include <linux/sched.h>
  17 #include <asm/io.h>
  18 #include <asm/8xx_immap.h>
  19 #include <syslib/m8xx_wdt.h>
  20
  21 static int wdt_timeout;
  22 int m8xx_has_internal_rtc = 0;
  23
  24 static irqreturn_t m8xx_wdt_interrupt(int, void *, struct pt_regs *);
  25 static struct irqaction m8xx_wdt_irqaction = {
  26         .handler = m8xx_wdt_interrupt,
  27         .name = "watchdog",
  28 };
  29
  30 void m8xx_wdt_reset(void)
  31 {
  32         volatile immap_t *imap = (volatile immap_t *)IMAP_ADDR;
  33
  34         out_be16(&imap->im_siu_conf.sc_swsr, 0x556c);   /* write magic1 */
  35         out_be16(&imap->im_siu_conf.sc_swsr, 0xaa39);   /* write magic2 */
  36 }
  37
  38 static irqreturn_t m8xx_wdt_interrupt(int irq, void *dev, struct pt_regs *regs)
  39 {
  40         volatile immap_t *imap = (volatile immap_t *)IMAP_ADDR;
  41
  42         m8xx_wdt_reset();
  43
  44         out_be16(&imap->im_sit.sit_piscr, in_be16(&imap->im_sit.sit_piscr) | PISCR_PS); /* clear irq */
  45
  46         return IRQ_HANDLED;
  47 }
  48
  49 #define SYPCR_SWP 0x1
  50 #define SYPCR_SWE 0x4
  51
  52
  53 void __init m8xx_wdt_install_irq(volatile immap_t *imap, bd_t *binfo)
  54 {
  55         u32 pitc;
  56         u32 pitrtclk;
  57
  58         /*
  59          * Fire trigger if half of the wdt ticked down
  60          */
  61
  62         if (imap->im_sit.sit_rtcsc & RTCSC_38K)
  63                 pitrtclk = 9600;
  64         else
  65                 pitrtclk = 8192;
  66
  67         if ((wdt_timeout) > (UINT_MAX / pitrtclk))
  68                 pitc = wdt_timeout / binfo->bi_intfreq * pitrtclk / 2;
  69         else
  70                 pitc = pitrtclk * wdt_timeout / binfo->bi_intfreq / 2;
  71
  72         out_be32(&imap->im_sit.sit_pitc, pitc << 16);
  73
  74         out_be16(&imap->im_sit.sit_piscr, (mk_int_int_mask(PIT_INTERRUPT) << 8) | PISCR_PIE | PISCR_PTE);
  75
  76         if (setup_irq(PIT_INTERRUPT, &m8xx_wdt_irqaction))
  77                 panic("m8xx_wdt: error setting up the watchdog irq!");
  78
  79         printk(KERN_NOTICE
  80                "m8xx_wdt: keep-alive trigger installed (PITC: 0x%04X)\n", pitc);
  81
  82 }
  83
  84 static void m8xx_wdt_timer_func(unsigned long data);
  85
  86 static struct timer_list m8xx_wdt_timer =
  87         TIMER_INITIALIZER(m8xx_wdt_timer_func, 0, 0);
  88
  89 void m8xx_wdt_stop_timer(void)
  90 {
  91         del_timer(&m8xx_wdt_timer);
  92 }
  93
  94 void m8xx_wdt_install_timer(void)
  95 {
  96         m8xx_wdt_timer.expires = jiffies + (HZ/2);
  97         add_timer(&m8xx_wdt_timer);
  98 }
  99
 100 static void m8xx_wdt_timer_func(unsigned long data)
 101 {
 102         m8xx_wdt_reset();
 103         m8xx_wdt_install_timer();
 104 }
 105
 106 void __init m8xx_wdt_handler_install(bd_t * binfo)
 107 {
 108         volatile immap_t *imap = (volatile immap_t *)IMAP_ADDR;
 109         u32 sypcr;
 110
 111         sypcr = in_be32(&imap->im_siu_conf.sc_sypcr);
 112
 113         if (!(sypcr & SYPCR_SWE)) {
 114                 printk(KERN_NOTICE "m8xx_wdt: wdt disabled (SYPCR: 0x%08X)\n",
 115                        sypcr);
 116                 return;
 117         }
 118
 119         m8xx_wdt_reset();
 120
 121         printk(KERN_NOTICE
 122                "m8xx_wdt: active wdt found (SWTC: 0x%04X, SWP: 0x%01X)\n",
 123                (sypcr >> 16), sypcr & SYPCR_SWP);
 124
 125         wdt_timeout = (sypcr >> 16) & 0xFFFF;
 126
 127         if (!wdt_timeout)
 128                 wdt_timeout = 0xFFFF;
 129
 130         if (sypcr & SYPCR_SWP)
 131                 wdt_timeout *= 2048;
 132
 133         m8xx_has_internal_rtc = in_be16(&imap->im_sit.sit_rtcsc) & RTCSC_RTE;
 134
 135         /* if the internal RTC is off use a kernel timer */
 136         if (!m8xx_has_internal_rtc) {
 137                 if (wdt_timeout < (binfo->bi_intfreq/HZ))
 138                         printk(KERN_ERR "m8xx_wdt: timeout too short for ktimer!\n");
 139                 m8xx_wdt_install_timer();
 140         } else
 141                 m8xx_wdt_install_irq(imap, binfo);
 142
 143         wdt_timeout /= binfo->bi_intfreq;
 144 }
 145
 146 int m8xx_wdt_get_timeout(void)
 147 {
 148         return wdt_timeout;
 149 }