Pileus Git - ~andy/linux/blob - drivers/watchdog/wm8350_wdt.c

   1 /*
   2  * Watchdog driver for the wm8350
   3  *
   4  * Copyright (C) 2007, 2008 Wolfson Microelectronics <linux@wolfsonmicro.com>
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU General Public License
   8  * as published by the Free Software Foundation
   9  */
  10
  11 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  12
  13 #include <linux/module.h>
  14 #include <linux/moduleparam.h>
  15 #include <linux/types.h>
  16 #include <linux/kernel.h>
  17 #include <linux/platform_device.h>
  18 #include <linux/watchdog.h>
  19 #include <linux/uaccess.h>
  20 #include <linux/mfd/wm8350/core.h>
  21
  22 static bool nowayout = WATCHDOG_NOWAYOUT;
  23 module_param(nowayout, bool, 0);
  24 MODULE_PARM_DESC(nowayout,
  25                  "Watchdog cannot be stopped once started (default="
  26                  __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
  27
  28 static DEFINE_MUTEX(wdt_mutex);
  29
  30 static struct {
  31         unsigned int time;  /* Seconds */
  32         u16 val;            /* To be set in WM8350_SYSTEM_CONTROL_2 */
  33 } wm8350_wdt_cfgs[] = {
  34         { 1, 0x02 },
  35         { 2, 0x04 },
  36         { 4, 0x05 },
  37 };
  38
  39 static int wm8350_wdt_set_timeout(struct watchdog_device *wdt_dev,
  40                                   unsigned int timeout)
  41 {
  42         struct wm8350 *wm8350 = watchdog_get_drvdata(wdt_dev);
  43         int ret, i;
  44         u16 reg;
  45
  46         for (i = 0; i < ARRAY_SIZE(wm8350_wdt_cfgs); i++)
  47                 if (wm8350_wdt_cfgs[i].time == timeout)
  48                         break;
  49         if (i == ARRAY_SIZE(wm8350_wdt_cfgs))
  50                 return -EINVAL;
  51
  52         mutex_lock(&wdt_mutex);
  53         wm8350_reg_unlock(wm8350);
  54
  55         reg = wm8350_reg_read(wm8350, WM8350_SYSTEM_CONTROL_2);
  56         reg &= ~WM8350_WDOG_TO_MASK;
  57         reg |= wm8350_wdt_cfgs[i].val;
  58         ret = wm8350_reg_write(wm8350, WM8350_SYSTEM_CONTROL_2, reg);
  59
  60         wm8350_reg_lock(wm8350);
  61         mutex_unlock(&wdt_mutex);
  62
  63         return ret;
  64 }
  65
  66 static int wm8350_wdt_start(struct watchdog_device *wdt_dev)
  67 {
  68         struct wm8350 *wm8350 = watchdog_get_drvdata(wdt_dev);
  69         int ret;
  70         u16 reg;
  71
  72         mutex_lock(&wdt_mutex);
  73         wm8350_reg_unlock(wm8350);
  74
  75         reg = wm8350_reg_read(wm8350, WM8350_SYSTEM_CONTROL_2);
  76         reg &= ~WM8350_WDOG_MODE_MASK;
  77         reg |= 0x20;
  78         ret = wm8350_reg_write(wm8350, WM8350_SYSTEM_CONTROL_2, reg);
  79
  80         wm8350_reg_lock(wm8350);
  81         mutex_unlock(&wdt_mutex);
  82
  83         return ret;
  84 }
  85
  86 static int wm8350_wdt_stop(struct watchdog_device *wdt_dev)
  87 {
  88         struct wm8350 *wm8350 = watchdog_get_drvdata(wdt_dev);
  89         int ret;
  90         u16 reg;
  91
  92         mutex_lock(&wdt_mutex);
  93         wm8350_reg_unlock(wm8350);
  94
  95         reg = wm8350_reg_read(wm8350, WM8350_SYSTEM_CONTROL_2);
  96         reg &= ~WM8350_WDOG_MODE_MASK;
  97         ret = wm8350_reg_write(wm8350, WM8350_SYSTEM_CONTROL_2, reg);
  98
  99         wm8350_reg_lock(wm8350);
 100         mutex_unlock(&wdt_mutex);
 101
 102         return ret;
 103 }
 104
 105 static int wm8350_wdt_ping(struct watchdog_device *wdt_dev)
 106 {
 107         struct wm8350 *wm8350 = watchdog_get_drvdata(wdt_dev);
 108         int ret;
 109         u16 reg;
 110
 111         mutex_lock(&wdt_mutex);
 112
 113         reg = wm8350_reg_read(wm8350, WM8350_SYSTEM_CONTROL_2);
 114         ret = wm8350_reg_write(wm8350, WM8350_SYSTEM_CONTROL_2, reg);
 115
 116         mutex_unlock(&wdt_mutex);
 117
 118         return ret;
 119 }
 120
 121 static const struct watchdog_info wm8350_wdt_info = {
 122         .options = WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING | WDIOF_MAGICCLOSE,
 123         .identity = "WM8350 Watchdog",
 124 };
 125
 126 static const struct watchdog_ops wm8350_wdt_ops = {
 127         .owner = THIS_MODULE,
 128         .start = wm8350_wdt_start,
 129         .stop = wm8350_wdt_stop,
 130         .ping = wm8350_wdt_ping,
 131         .set_timeout = wm8350_wdt_set_timeout,
 132 };
 133
 134 static struct watchdog_device wm8350_wdt = {
 135         .info = &wm8350_wdt_info,
 136         .ops = &wm8350_wdt_ops,
 137         .timeout = 4,
 138         .min_timeout = 1,
 139         .max_timeout = 4,
 140 };
 141
 142 static int __devinit wm8350_wdt_probe(struct platform_device *pdev)
 143 {
 144         struct wm8350 *wm8350 = platform_get_drvdata(pdev);
 145
 146         if (!wm8350) {
 147                 pr_err("No driver data supplied\n");
 148                 return -ENODEV;
 149         }
 150
 151         watchdog_set_nowayout(&wm8350_wdt, nowayout);
 152         watchdog_set_drvdata(&wm8350_wdt, wm8350);
 153
 154         /* Default to 4s timeout */
 155         wm8350_wdt_set_timeout(&wm8350_wdt, 4);
 156
 157         return watchdog_register_device(&wm8350_wdt);
 158 }
 159
 160 static int __devexit wm8350_wdt_remove(struct platform_device *pdev)
 161 {
 162         watchdog_unregister_device(&wm8350_wdt);
 163         return 0;
 164 }
 165
 166 static struct platform_driver wm8350_wdt_driver = {
 167         .probe = wm8350_wdt_probe,
 168         .remove = __devexit_p(wm8350_wdt_remove),
 169         .driver = {
 170                 .name = "wm8350-wdt",
 171         },
 172 };
 173
 174 module_platform_driver(wm8350_wdt_driver);
 175
 176 MODULE_AUTHOR("Mark Brown");
 177 MODULE_DESCRIPTION("WM8350 Watchdog");
 178 MODULE_LICENSE("GPL");
 179 MODULE_ALIAS("platform:wm8350-wdt");