Blame view
drivers/watchdog/da9063_wdt.c
5.4 KB
5e9c16e37 watchdog: Add DA9... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 |
/* * Watchdog driver for DA9063 PMICs. * * Copyright(c) 2012 Dialog Semiconductor Ltd. * * Author: Mariusz Wojtasik <mariusz.wojtasik@diasemi.com> * * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the * Free Software Foundation; either version 2 of the License, or (at your * option) any later version. */ #include <linux/kernel.h> #include <linux/module.h> #include <linux/watchdog.h> #include <linux/platform_device.h> #include <linux/uaccess.h> #include <linux/slab.h> #include <linux/delay.h> #include <linux/mfd/da9063/registers.h> #include <linux/mfd/da9063/core.h> #include <linux/regmap.h> /* * Watchdog selector to timeout in seconds. * 0: WDT disabled; * others: timeout = 2048 ms * 2^(TWDSCALE-1). */ static const unsigned int wdt_timeout[] = { 0, 2, 4, 8, 16, 32, 65, 131 }; #define DA9063_TWDSCALE_DISABLE 0 #define DA9063_TWDSCALE_MIN 1 #define DA9063_TWDSCALE_MAX (ARRAY_SIZE(wdt_timeout) - 1) #define DA9063_WDT_MIN_TIMEOUT wdt_timeout[DA9063_TWDSCALE_MIN] #define DA9063_WDT_MAX_TIMEOUT wdt_timeout[DA9063_TWDSCALE_MAX] #define DA9063_WDG_TIMEOUT wdt_timeout[3] |
a74cab40b watchdog: da9063_... |
37 |
#define DA9063_RESET_PROTECTION_MS 256 |
5e9c16e37 watchdog: Add DA9... |
38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 |
struct da9063_watchdog { struct da9063 *da9063; struct watchdog_device wdtdev; }; static unsigned int da9063_wdt_timeout_to_sel(unsigned int secs) { unsigned int i; for (i = DA9063_TWDSCALE_MIN; i <= DA9063_TWDSCALE_MAX; i++) { if (wdt_timeout[i] >= secs) return i; } return DA9063_TWDSCALE_MAX; } static int _da9063_wdt_set_timeout(struct da9063 *da9063, unsigned int regval) { return regmap_update_bits(da9063->regmap, DA9063_REG_CONTROL_D, DA9063_TWDSCALE_MASK, regval); } static int da9063_wdt_start(struct watchdog_device *wdd) { struct da9063_watchdog *wdt = watchdog_get_drvdata(wdd); unsigned int selector; int ret; selector = da9063_wdt_timeout_to_sel(wdt->wdtdev.timeout); ret = _da9063_wdt_set_timeout(wdt->da9063, selector); if (ret) dev_err(wdt->da9063->dev, "Watchdog failed to start (err = %d) ", ret); return ret; } static int da9063_wdt_stop(struct watchdog_device *wdd) { struct da9063_watchdog *wdt = watchdog_get_drvdata(wdd); int ret; ret = regmap_update_bits(wdt->da9063->regmap, DA9063_REG_CONTROL_D, DA9063_TWDSCALE_MASK, DA9063_TWDSCALE_DISABLE); if (ret) dev_alert(wdt->da9063->dev, "Watchdog failed to stop (err = %d) ", ret); return ret; } static int da9063_wdt_ping(struct watchdog_device *wdd) { struct da9063_watchdog *wdt = watchdog_get_drvdata(wdd); int ret; ret = regmap_write(wdt->da9063->regmap, DA9063_REG_CONTROL_F, DA9063_WATCHDOG); if (ret) dev_alert(wdt->da9063->dev, "Failed to ping the watchdog (err = %d) ", ret); return ret; } static int da9063_wdt_set_timeout(struct watchdog_device *wdd, unsigned int timeout) { struct da9063_watchdog *wdt = watchdog_get_drvdata(wdd); unsigned int selector; int ret; selector = da9063_wdt_timeout_to_sel(timeout); ret = _da9063_wdt_set_timeout(wdt->da9063, selector); if (ret) dev_err(wdt->da9063->dev, "Failed to set watchdog timeout (err = %d) ", ret); else wdd->timeout = wdt_timeout[selector]; return ret; } |
4d8b229d5 watchdog: Add 'ac... |
126 127 |
static int da9063_wdt_restart(struct watchdog_device *wdd, unsigned long action, void *data) |
396f163ce watchdog: da9063:... |
128 |
{ |
f79781cea watchdog: da9063_... |
129 |
struct da9063_watchdog *wdt = watchdog_get_drvdata(wdd); |
396f163ce watchdog: da9063:... |
130 131 132 133 134 135 136 137 |
int ret; ret = regmap_write(wdt->da9063->regmap, DA9063_REG_CONTROL_F, DA9063_SHUTDOWN); if (ret) dev_alert(wdt->da9063->dev, "Failed to shutdown (err = %d) ", ret); |
f79781cea watchdog: da9063_... |
138 |
return ret; |
396f163ce watchdog: da9063:... |
139 |
} |
5e9c16e37 watchdog: Add DA9... |
140 141 142 143 144 145 146 147 148 149 150 |
static const struct watchdog_info da9063_watchdog_info = { .options = WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING, .identity = "DA9063 Watchdog", }; static const struct watchdog_ops da9063_watchdog_ops = { .owner = THIS_MODULE, .start = da9063_wdt_start, .stop = da9063_wdt_stop, .ping = da9063_wdt_ping, .set_timeout = da9063_wdt_set_timeout, |
f79781cea watchdog: da9063_... |
151 |
.restart = da9063_wdt_restart, |
5e9c16e37 watchdog: Add DA9... |
152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 |
}; static int da9063_wdt_probe(struct platform_device *pdev) { int ret; struct da9063 *da9063; struct da9063_watchdog *wdt; if (!pdev->dev.parent) return -EINVAL; da9063 = dev_get_drvdata(pdev->dev.parent); if (!da9063) return -EINVAL; wdt = devm_kzalloc(&pdev->dev, sizeof(*wdt), GFP_KERNEL); if (!wdt) return -ENOMEM; wdt->da9063 = da9063; wdt->wdtdev.info = &da9063_watchdog_info; wdt->wdtdev.ops = &da9063_watchdog_ops; wdt->wdtdev.min_timeout = DA9063_WDT_MIN_TIMEOUT; wdt->wdtdev.max_timeout = DA9063_WDT_MAX_TIMEOUT; |
a74cab40b watchdog: da9063_... |
177 |
wdt->wdtdev.min_hw_heartbeat_ms = DA9063_RESET_PROTECTION_MS; |
5e9c16e37 watchdog: Add DA9... |
178 |
wdt->wdtdev.timeout = DA9063_WDG_TIMEOUT; |
6551881c8 Watchdog: Fix par... |
179 |
wdt->wdtdev.parent = &pdev->dev; |
5e9c16e37 watchdog: Add DA9... |
180 181 |
wdt->wdtdev.status = WATCHDOG_NOWAYOUT_INIT_STATUS; |
f79781cea watchdog: da9063_... |
182 |
watchdog_set_restart_priority(&wdt->wdtdev, 128); |
5e9c16e37 watchdog: Add DA9... |
183 184 185 186 |
watchdog_set_drvdata(&wdt->wdtdev, wdt); dev_set_drvdata(&pdev->dev, wdt); ret = watchdog_register_device(&wdt->wdtdev); |
396f163ce watchdog: da9063:... |
187 188 |
if (ret) return ret; |
5e9c16e37 watchdog: Add DA9... |
189 |
|
396f163ce watchdog: da9063:... |
190 |
return 0; |
5e9c16e37 watchdog: Add DA9... |
191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 |
} static int da9063_wdt_remove(struct platform_device *pdev) { struct da9063_watchdog *wdt = dev_get_drvdata(&pdev->dev); watchdog_unregister_device(&wdt->wdtdev); return 0; } static struct platform_driver da9063_wdt_driver = { .probe = da9063_wdt_probe, .remove = da9063_wdt_remove, .driver = { .name = DA9063_DRVNAME_WATCHDOG, }, }; module_platform_driver(da9063_wdt_driver); MODULE_AUTHOR("Mariusz Wojtasik <mariusz.wojtasik@diasemi.com>"); MODULE_DESCRIPTION("Watchdog driver for Dialog DA9063"); MODULE_LICENSE("GPL"); MODULE_ALIAS("platform:" DA9063_DRVNAME_WATCHDOG); |