Blame view

drivers/watchdog/davinci_wdt.c 7.28 KB
d01732789   Guenter Roeck   watchdog: convert...
1
  // SPDX-License-Identifier: GPL-2.0
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
2
3
4
5
6
  /*
   * drivers/char/watchdog/davinci_wdt.c
   *
   * Watchdog driver for DaVinci DM644x/DM646x processors
   *
f48f3ceab   Ivan Khoronzhuk   watchdog: davinci...
7
   * Copyright (C) 2006-2013 Texas Instruments.
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
8
   *
d01732789   Guenter Roeck   watchdog: convert...
9
   * 2007 (c) MontaVista Software, Inc.
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
10
11
12
13
   */
  
  #include <linux/module.h>
  #include <linux/moduleparam.h>
ac3167257   Randy Dunlap   headers: separate...
14
  #include <linux/mod_devicetable.h>
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
15
16
  #include <linux/types.h>
  #include <linux/kernel.h>
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
17
  #include <linux/watchdog.h>
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
18
  #include <linux/platform_device.h>
f78b0a8f2   Alan Cox   [WATCHDOG 08/57] ...
19
  #include <linux/io.h>
371d3525e   Kevin Hilman   [WATCHDOG] davinc...
20
  #include <linux/device.h>
9fd868f44   Kevin Hilman   [WATCHDOG] davinc...
21
  #include <linux/clk.h>
6330c7070   Sachin Kamat   watchdog: Convert...
22
  #include <linux/err.h>
7d831bf59   Vladimir Barinov   [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   Ivan Khoronzhuk   watchdog: davinci...
55
  static int heartbeat;
6d9a6cf5c   Ivan Khoronzhuk   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   Vladimir Barinov   [WATCHDOG] davinc...
68

f48f3ceab   Ivan Khoronzhuk   watchdog: davinci...
69
  static int davinci_wdt_start(struct watchdog_device *wdd)
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
70
71
72
  {
  	u32 tgcr;
  	u32 timer_margin;
9fd868f44   Kevin Hilman   [WATCHDOG] davinc...
73
  	unsigned long wdt_freq;
6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
74
  	struct davinci_wdt_device *davinci_wdt = watchdog_get_drvdata(wdd);
9fd868f44   Kevin Hilman   [WATCHDOG] davinc...
75

6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
76
  	wdt_freq = clk_get_rate(davinci_wdt->clk);
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
77

7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
78
  	/* disable, internal clock source */
6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
79
  	iowrite32(0, davinci_wdt->base + TCR);
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
80
  	/* reset timer, set mode to 64-bit watchdog, and unreset */
6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
81
  	iowrite32(0, davinci_wdt->base + TGCR);
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
82
  	tgcr = TIMMODE_64BIT_WDOG | TIM12RS_UNRESET | TIM34RS_UNRESET;
6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
83
  	iowrite32(tgcr, davinci_wdt->base + TGCR);
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
84
  	/* clear counter regs */
6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
85
86
  	iowrite32(0, davinci_wdt->base + TIM12);
  	iowrite32(0, davinci_wdt->base + TIM34);
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
87
  	/* set timeout period */
f48f3ceab   Ivan Khoronzhuk   watchdog: davinci...
88
  	timer_margin = (((u64)wdd->timeout * wdt_freq) & 0xffffffff);
6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
89
  	iowrite32(timer_margin, davinci_wdt->base + PRD12);
f48f3ceab   Ivan Khoronzhuk   watchdog: davinci...
90
  	timer_margin = (((u64)wdd->timeout * wdt_freq) >> 32);
6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
91
  	iowrite32(timer_margin, davinci_wdt->base + PRD34);
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
92
  	/* enable run continuously */
6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
93
  	iowrite32(ENAMODE12_PERIODIC, davinci_wdt->base + TCR);
7d831bf59   Vladimir Barinov   [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   Ivan Khoronzhuk   watchdog: davinci...
99
  	iowrite32(WDKEY_SEQ0 | WDEN, davinci_wdt->base + WDTCR);
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
100
  	/* put watchdog in active state */
6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
101
  	iowrite32(WDKEY_SEQ1 | WDEN, davinci_wdt->base + WDTCR);
f48f3ceab   Ivan Khoronzhuk   watchdog: davinci...
102
  	return 0;
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
103
  }
f48f3ceab   Ivan Khoronzhuk   watchdog: davinci...
104
  static int davinci_wdt_ping(struct watchdog_device *wdd)
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
105
  {
6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
106
  	struct davinci_wdt_device *davinci_wdt = watchdog_get_drvdata(wdd);
f48f3ceab   Ivan Khoronzhuk   watchdog: davinci...
107
  	/* put watchdog in service state */
6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
108
  	iowrite32(WDKEY_SEQ0, davinci_wdt->base + WDTCR);
f48f3ceab   Ivan Khoronzhuk   watchdog: davinci...
109
  	/* put watchdog in active state */
6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
110
  	iowrite32(WDKEY_SEQ1, davinci_wdt->base + WDTCR);
f48f3ceab   Ivan Khoronzhuk   watchdog: davinci...
111
  	return 0;
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
112
  }
a77199490   Ivan Khoronzhuk   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   David Lechner   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   Ivan Khoronzhuk   watchdog: davinci...
172
  static const struct watchdog_info davinci_wdt_info = {
f1a08cc9a   Wim Van Sebroeck   [WATCHDOG] davinc...
173
  	.options = WDIOF_KEEPALIVEPING,
8832b2009   Ivan Khoronzhuk   watchdog: davinci...
174
  	.identity = "DaVinci/Keystone Watchdog",
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
175
  };
f48f3ceab   Ivan Khoronzhuk   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   Ivan Khoronzhuk   watchdog: davinci...
181
  	.get_timeleft	= davinci_wdt_get_timeleft,
71d1f0588   David Lechner   watchdog: davinci...
182
  	.restart	= davinci_wdt_restart,
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
183
  };
cecda0105   Guenter Roeck   watchdog: davinci...
184
185
186
187
  static void davinci_clk_disable_unprepare(void *data)
  {
  	clk_disable_unprepare(data);
  }
2d991a164   Bill Pemberton   watchdog: remove ...
188
  static int davinci_wdt_probe(struct platform_device *pdev)
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
189
  {
e20880e60   Kumar, Anil   watchdog: davinci...
190
  	int ret = 0;
371d3525e   Kevin Hilman   [WATCHDOG] davinc...
191
  	struct device *dev = &pdev->dev;
f48f3ceab   Ivan Khoronzhuk   watchdog: davinci...
192
  	struct watchdog_device *wdd;
6d9a6cf5c   Ivan Khoronzhuk   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   Vladimir Barinov   [WATCHDOG] davinc...
198

6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
199
  	davinci_wdt->clk = devm_clk_get(dev, NULL);
fc7720400   Krzysztof Kozlowski   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   Kevin Hilman   [WATCHDOG] davinc...
204

8f11eb58a   Arvind Yadav   watchdog: davinci...
205
206
  	ret = clk_prepare_enable(davinci_wdt->clk);
  	if (ret) {
cecda0105   Guenter Roeck   watchdog: davinci...
207
208
  		dev_err(dev, "failed to prepare clock
  ");
8f11eb58a   Arvind Yadav   watchdog: davinci...
209
210
  		return ret;
  	}
cecda0105   Guenter Roeck   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   Kevin Hilman   [WATCHDOG] davinc...
215

6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
216
217
218
  	platform_set_drvdata(pdev, davinci_wdt);
  
  	wdd			= &davinci_wdt->wdd;
f48f3ceab   Ivan Khoronzhuk   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   Guenter Roeck   watchdog: davinci...
224
  	wdd->parent		= dev;
f48f3ceab   Ivan Khoronzhuk   watchdog: davinci...
225
226
227
228
229
  
  	watchdog_init_timeout(wdd, heartbeat, dev);
  
  	dev_info(dev, "heartbeat %d sec
  ", wdd->timeout);
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
230

6d9a6cf5c   Ivan Khoronzhuk   watchdog: davinci...
231
  	watchdog_set_drvdata(wdd, davinci_wdt);
f48f3ceab   Ivan Khoronzhuk   watchdog: davinci...
232
  	watchdog_set_nowayout(wdd, 1);
71d1f0588   David Lechner   watchdog: davinci...
233
  	watchdog_set_restart_priority(wdd, 128);
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
234

0f0a6a285   Guenter Roeck   watchdog: Convert...
235
  	davinci_wdt->base = devm_platform_ioremap_resource(pdev, 0);
cecda0105   Guenter Roeck   watchdog: davinci...
236
237
  	if (IS_ERR(davinci_wdt->base))
  		return PTR_ERR(davinci_wdt->base);
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
238

6ab6d33ee   Wolfram Sang   watchdog: davinci...
239
  	return devm_watchdog_register_device(dev, wdd);
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
240
  }
902e2e7d4   Murali Karicheri   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   Vladimir Barinov   [WATCHDOG] davinc...
246
247
  static struct platform_driver platform_wdt_driver = {
  	.driver = {
843748123   Ivan Khoronzhuk   watchdog: davinci...
248
  		.name = "davinci-wdt",
902e2e7d4   Murali Karicheri   watchdog: davinci...
249
  		.of_match_table = davinci_wdt_of_match,
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
250
251
  	},
  	.probe = davinci_wdt_probe,
7d831bf59   Vladimir Barinov   [WATCHDOG] davinc...
252
  };
b8ec61189   Axel Lin   watchdog: convert...
253
  module_platform_driver(platform_wdt_driver);
7d831bf59   Vladimir Barinov   [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   Ivan Khoronzhuk   watchdog: davinci...
265
  MODULE_ALIAS("platform:davinci-wdt");