Blame view
drivers/watchdog/davinci_wdt.c
7.28 KB
d01732789 watchdog: convert... |
1 |
// SPDX-License-Identifier: GPL-2.0 |
7d831bf59 [WATCHDOG] davinc... |
2 3 4 5 6 |
/* * drivers/char/watchdog/davinci_wdt.c * * Watchdog driver for DaVinci DM644x/DM646x processors * |
f48f3ceab watchdog: davinci... |
7 |
* Copyright (C) 2006-2013 Texas Instruments. |
7d831bf59 [WATCHDOG] davinc... |
8 |
* |
d01732789 watchdog: convert... |
9 |
* 2007 (c) MontaVista Software, Inc. |
7d831bf59 [WATCHDOG] davinc... |
10 11 12 13 |
*/ #include <linux/module.h> #include <linux/moduleparam.h> |
ac3167257 headers: separate... |
14 |
#include <linux/mod_devicetable.h> |
7d831bf59 [WATCHDOG] davinc... |
15 16 |
#include <linux/types.h> #include <linux/kernel.h> |
7d831bf59 [WATCHDOG] davinc... |
17 |
#include <linux/watchdog.h> |
7d831bf59 [WATCHDOG] davinc... |
18 |
#include <linux/platform_device.h> |
f78b0a8f2 [WATCHDOG 08/57] ... |
19 |
#include <linux/io.h> |
371d3525e [WATCHDOG] davinc... |
20 |
#include <linux/device.h> |
9fd868f44 [WATCHDOG] davinc... |
21 |
#include <linux/clk.h> |
6330c7070 watchdog: Convert... |
22 |
#include <linux/err.h> |
7d831bf59 [WATCHDOG] davinc... |
23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 |
#define MODULE_NAME "DAVINCI-WDT: " #define DEFAULT_HEARTBEAT 60 #define MAX_HEARTBEAT 600 /* really the max margin is 264/27MHz*/ /* Timer register set definition */ #define PID12 (0x0) #define EMUMGT (0x4) #define TIM12 (0x10) #define TIM34 (0x14) #define PRD12 (0x18) #define PRD34 (0x1C) #define TCR (0x20) #define TGCR (0x24) #define WDTCR (0x28) /* TCR bit definitions */ #define ENAMODE12_DISABLED (0 << 6) #define ENAMODE12_ONESHOT (1 << 6) #define ENAMODE12_PERIODIC (2 << 6) /* TGCR bit definitions */ #define TIM12RS_UNRESET (1 << 0) #define TIM34RS_UNRESET (1 << 1) #define TIMMODE_64BIT_WDOG (2 << 2) /* WDTCR bit definitions */ #define WDEN (1 << 14) #define WDFLAG (1 << 15) #define WDKEY_SEQ0 (0xa5c6 << 16) #define WDKEY_SEQ1 (0xda7e << 16) |
f48f3ceab watchdog: davinci... |
55 |
static int heartbeat; |
6d9a6cf5c watchdog: davinci... |
56 57 58 59 60 61 62 63 64 65 66 67 |
/* * struct to hold data for each WDT device * @base - base io address of WD device * @clk - source clock of WDT * @wdd - hold watchdog device as is in WDT core */ struct davinci_wdt_device { void __iomem *base; struct clk *clk; struct watchdog_device wdd; }; |
7d831bf59 [WATCHDOG] davinc... |
68 |
|
f48f3ceab watchdog: davinci... |
69 |
static int davinci_wdt_start(struct watchdog_device *wdd) |
7d831bf59 [WATCHDOG] davinc... |
70 71 72 |
{ u32 tgcr; u32 timer_margin; |
9fd868f44 [WATCHDOG] davinc... |
73 |
unsigned long wdt_freq; |
6d9a6cf5c watchdog: davinci... |
74 |
struct davinci_wdt_device *davinci_wdt = watchdog_get_drvdata(wdd); |
9fd868f44 [WATCHDOG] davinc... |
75 |
|
6d9a6cf5c watchdog: davinci... |
76 |
wdt_freq = clk_get_rate(davinci_wdt->clk); |
7d831bf59 [WATCHDOG] davinc... |
77 |
|
7d831bf59 [WATCHDOG] davinc... |
78 |
/* disable, internal clock source */ |
6d9a6cf5c watchdog: davinci... |
79 |
iowrite32(0, davinci_wdt->base + TCR); |
7d831bf59 [WATCHDOG] davinc... |
80 |
/* reset timer, set mode to 64-bit watchdog, and unreset */ |
6d9a6cf5c watchdog: davinci... |
81 |
iowrite32(0, davinci_wdt->base + TGCR); |
7d831bf59 [WATCHDOG] davinc... |
82 |
tgcr = TIMMODE_64BIT_WDOG | TIM12RS_UNRESET | TIM34RS_UNRESET; |
6d9a6cf5c watchdog: davinci... |
83 |
iowrite32(tgcr, davinci_wdt->base + TGCR); |
7d831bf59 [WATCHDOG] davinc... |
84 |
/* clear counter regs */ |
6d9a6cf5c watchdog: davinci... |
85 86 |
iowrite32(0, davinci_wdt->base + TIM12); iowrite32(0, davinci_wdt->base + TIM34); |
7d831bf59 [WATCHDOG] davinc... |
87 |
/* set timeout period */ |
f48f3ceab watchdog: davinci... |
88 |
timer_margin = (((u64)wdd->timeout * wdt_freq) & 0xffffffff); |
6d9a6cf5c watchdog: davinci... |
89 |
iowrite32(timer_margin, davinci_wdt->base + PRD12); |
f48f3ceab watchdog: davinci... |
90 |
timer_margin = (((u64)wdd->timeout * wdt_freq) >> 32); |
6d9a6cf5c watchdog: davinci... |
91 |
iowrite32(timer_margin, davinci_wdt->base + PRD34); |
7d831bf59 [WATCHDOG] davinc... |
92 |
/* enable run continuously */ |
6d9a6cf5c watchdog: davinci... |
93 |
iowrite32(ENAMODE12_PERIODIC, davinci_wdt->base + TCR); |
7d831bf59 [WATCHDOG] davinc... |
94 95 96 97 98 |
/* Once the WDT is in pre-active state write to * TIM12, TIM34, PRD12, PRD34, TCR, TGCR, WDTCR are * write protected (except for the WDKEY field) */ /* put watchdog in pre-active state */ |
6d9a6cf5c watchdog: davinci... |
99 |
iowrite32(WDKEY_SEQ0 | WDEN, davinci_wdt->base + WDTCR); |
7d831bf59 [WATCHDOG] davinc... |
100 |
/* put watchdog in active state */ |
6d9a6cf5c watchdog: davinci... |
101 |
iowrite32(WDKEY_SEQ1 | WDEN, davinci_wdt->base + WDTCR); |
f48f3ceab watchdog: davinci... |
102 |
return 0; |
7d831bf59 [WATCHDOG] davinc... |
103 |
} |
f48f3ceab watchdog: davinci... |
104 |
static int davinci_wdt_ping(struct watchdog_device *wdd) |
7d831bf59 [WATCHDOG] davinc... |
105 |
{ |
6d9a6cf5c watchdog: davinci... |
106 |
struct davinci_wdt_device *davinci_wdt = watchdog_get_drvdata(wdd); |
f48f3ceab watchdog: davinci... |
107 |
/* put watchdog in service state */ |
6d9a6cf5c watchdog: davinci... |
108 |
iowrite32(WDKEY_SEQ0, davinci_wdt->base + WDTCR); |
f48f3ceab watchdog: davinci... |
109 |
/* put watchdog in active state */ |
6d9a6cf5c watchdog: davinci... |
110 |
iowrite32(WDKEY_SEQ1, davinci_wdt->base + WDTCR); |
f48f3ceab watchdog: davinci... |
111 |
return 0; |
7d831bf59 [WATCHDOG] davinc... |
112 |
} |
a77199490 watchdog: davinci... |
113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 |
static unsigned int davinci_wdt_get_timeleft(struct watchdog_device *wdd) { u64 timer_counter; unsigned long freq; u32 val; struct davinci_wdt_device *davinci_wdt = watchdog_get_drvdata(wdd); /* if timeout has occured then return 0 */ val = ioread32(davinci_wdt->base + WDTCR); if (val & WDFLAG) return 0; freq = clk_get_rate(davinci_wdt->clk); if (!freq) return 0; timer_counter = ioread32(davinci_wdt->base + TIM12); timer_counter |= ((u64)ioread32(davinci_wdt->base + TIM34) << 32); do_div(timer_counter, freq); return wdd->timeout - timer_counter; } |
71d1f0588 watchdog: davinci... |
137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 |
static int davinci_wdt_restart(struct watchdog_device *wdd, unsigned long action, void *data) { struct davinci_wdt_device *davinci_wdt = watchdog_get_drvdata(wdd); u32 tgcr, wdtcr; /* disable, internal clock source */ iowrite32(0, davinci_wdt->base + TCR); /* reset timer, set mode to 64-bit watchdog, and unreset */ tgcr = 0; iowrite32(tgcr, davinci_wdt->base + TGCR); tgcr = TIMMODE_64BIT_WDOG | TIM12RS_UNRESET | TIM34RS_UNRESET; iowrite32(tgcr, davinci_wdt->base + TGCR); /* clear counter and period regs */ iowrite32(0, davinci_wdt->base + TIM12); iowrite32(0, davinci_wdt->base + TIM34); iowrite32(0, davinci_wdt->base + PRD12); iowrite32(0, davinci_wdt->base + PRD34); /* put watchdog in pre-active state */ wdtcr = WDKEY_SEQ0 | WDEN; iowrite32(wdtcr, davinci_wdt->base + WDTCR); /* put watchdog in active state */ wdtcr = WDKEY_SEQ1 | WDEN; iowrite32(wdtcr, davinci_wdt->base + WDTCR); /* write an invalid value to the WDKEY field to trigger a restart */ wdtcr = 0x00004000; iowrite32(wdtcr, davinci_wdt->base + WDTCR); return 0; } |
f48f3ceab watchdog: davinci... |
172 |
static const struct watchdog_info davinci_wdt_info = { |
f1a08cc9a [WATCHDOG] davinc... |
173 |
.options = WDIOF_KEEPALIVEPING, |
8832b2009 watchdog: davinci... |
174 |
.identity = "DaVinci/Keystone Watchdog", |
7d831bf59 [WATCHDOG] davinc... |
175 |
}; |
f48f3ceab watchdog: davinci... |
176 177 178 179 180 |
static const struct watchdog_ops davinci_wdt_ops = { .owner = THIS_MODULE, .start = davinci_wdt_start, .stop = davinci_wdt_ping, .ping = davinci_wdt_ping, |
a77199490 watchdog: davinci... |
181 |
.get_timeleft = davinci_wdt_get_timeleft, |
71d1f0588 watchdog: davinci... |
182 |
.restart = davinci_wdt_restart, |
7d831bf59 [WATCHDOG] davinc... |
183 |
}; |
cecda0105 watchdog: davinci... |
184 185 186 187 |
static void davinci_clk_disable_unprepare(void *data) { clk_disable_unprepare(data); } |
2d991a164 watchdog: remove ... |
188 |
static int davinci_wdt_probe(struct platform_device *pdev) |
7d831bf59 [WATCHDOG] davinc... |
189 |
{ |
e20880e60 watchdog: davinci... |
190 |
int ret = 0; |
371d3525e [WATCHDOG] davinc... |
191 |
struct device *dev = &pdev->dev; |
f48f3ceab watchdog: davinci... |
192 |
struct watchdog_device *wdd; |
6d9a6cf5c watchdog: davinci... |
193 194 195 196 197 |
struct davinci_wdt_device *davinci_wdt; davinci_wdt = devm_kzalloc(dev, sizeof(*davinci_wdt), GFP_KERNEL); if (!davinci_wdt) return -ENOMEM; |
7d831bf59 [WATCHDOG] davinc... |
198 |
|
6d9a6cf5c watchdog: davinci... |
199 |
davinci_wdt->clk = devm_clk_get(dev, NULL); |
fc7720400 watchdog: davinci... |
200 201 202 203 |
if (IS_ERR(davinci_wdt->clk)) return dev_err_probe(dev, PTR_ERR(davinci_wdt->clk), "failed to get clock node "); |
9fd868f44 [WATCHDOG] davinc... |
204 |
|
8f11eb58a watchdog: davinci... |
205 206 |
ret = clk_prepare_enable(davinci_wdt->clk); if (ret) { |
cecda0105 watchdog: davinci... |
207 208 |
dev_err(dev, "failed to prepare clock "); |
8f11eb58a watchdog: davinci... |
209 210 |
return ret; } |
cecda0105 watchdog: davinci... |
211 212 213 214 |
ret = devm_add_action_or_reset(dev, davinci_clk_disable_unprepare, davinci_wdt->clk); if (ret) return ret; |
9fd868f44 [WATCHDOG] davinc... |
215 |
|
6d9a6cf5c watchdog: davinci... |
216 217 218 |
platform_set_drvdata(pdev, davinci_wdt); wdd = &davinci_wdt->wdd; |
f48f3ceab watchdog: davinci... |
219 220 221 222 223 |
wdd->info = &davinci_wdt_info; wdd->ops = &davinci_wdt_ops; wdd->min_timeout = 1; wdd->max_timeout = MAX_HEARTBEAT; wdd->timeout = DEFAULT_HEARTBEAT; |
cecda0105 watchdog: davinci... |
224 |
wdd->parent = dev; |
f48f3ceab watchdog: davinci... |
225 226 227 228 229 |
watchdog_init_timeout(wdd, heartbeat, dev); dev_info(dev, "heartbeat %d sec ", wdd->timeout); |
7d831bf59 [WATCHDOG] davinc... |
230 |
|
6d9a6cf5c watchdog: davinci... |
231 |
watchdog_set_drvdata(wdd, davinci_wdt); |
f48f3ceab watchdog: davinci... |
232 |
watchdog_set_nowayout(wdd, 1); |
71d1f0588 watchdog: davinci... |
233 |
watchdog_set_restart_priority(wdd, 128); |
7d831bf59 [WATCHDOG] davinc... |
234 |
|
0f0a6a285 watchdog: Convert... |
235 |
davinci_wdt->base = devm_platform_ioremap_resource(pdev, 0); |
cecda0105 watchdog: davinci... |
236 237 |
if (IS_ERR(davinci_wdt->base)) return PTR_ERR(davinci_wdt->base); |
7d831bf59 [WATCHDOG] davinc... |
238 |
|
6ab6d33ee watchdog: davinci... |
239 |
return devm_watchdog_register_device(dev, wdd); |
7d831bf59 [WATCHDOG] davinc... |
240 |
} |
902e2e7d4 watchdog: davinci... |
241 242 243 244 245 |
static const struct of_device_id davinci_wdt_of_match[] = { { .compatible = "ti,davinci-wdt", }, {}, }; MODULE_DEVICE_TABLE(of, davinci_wdt_of_match); |
7d831bf59 [WATCHDOG] davinc... |
246 247 |
static struct platform_driver platform_wdt_driver = { .driver = { |
843748123 watchdog: davinci... |
248 |
.name = "davinci-wdt", |
902e2e7d4 watchdog: davinci... |
249 |
.of_match_table = davinci_wdt_of_match, |
7d831bf59 [WATCHDOG] davinc... |
250 251 |
}, .probe = davinci_wdt_probe, |
7d831bf59 [WATCHDOG] davinc... |
252 |
}; |
b8ec61189 watchdog: convert... |
253 |
module_platform_driver(platform_wdt_driver); |
7d831bf59 [WATCHDOG] davinc... |
254 255 256 257 258 259 260 261 262 263 264 |
MODULE_AUTHOR("Texas Instruments"); MODULE_DESCRIPTION("DaVinci Watchdog Driver"); module_param(heartbeat, int, 0); MODULE_PARM_DESC(heartbeat, "Watchdog heartbeat period in seconds from 1 to " __MODULE_STRING(MAX_HEARTBEAT) ", default " __MODULE_STRING(DEFAULT_HEARTBEAT)); MODULE_LICENSE("GPL"); |
843748123 watchdog: davinci... |
265 |
MODULE_ALIAS("platform:davinci-wdt"); |