1 /*
2  * Cadence WDT driver - Used by Xilinx Zynq
3  *
4  * Copyright (C) 2010 - 2014 Xilinx, Inc.
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; either version
9  * 2 of the License, or (at your option) any later version.
10  */
11 
12 #include <linux/clk.h>
13 #include <linux/init.h>
14 #include <linux/interrupt.h>
15 #include <linux/io.h>
16 #include <linux/irq.h>
17 #include <linux/kernel.h>
18 #include <linux/module.h>
19 #include <linux/of.h>
20 #include <linux/platform_device.h>
21 #include <linux/watchdog.h>
22 
23 #define CDNS_WDT_DEFAULT_TIMEOUT	10
24 /* Supports 1 - 516 sec */
25 #define CDNS_WDT_MIN_TIMEOUT	1
26 #define CDNS_WDT_MAX_TIMEOUT	516
27 
28 /* Restart key */
29 #define CDNS_WDT_RESTART_KEY 0x00001999
30 
31 /* Counter register access key */
32 #define CDNS_WDT_REGISTER_ACCESS_KEY 0x00920000
33 
34 /* Counter value divisor */
35 #define CDNS_WDT_COUNTER_VALUE_DIVISOR 0x1000
36 
37 /* Clock prescaler value and selection */
38 #define CDNS_WDT_PRESCALE_64	64
39 #define CDNS_WDT_PRESCALE_512	512
40 #define CDNS_WDT_PRESCALE_4096	4096
41 #define CDNS_WDT_PRESCALE_SELECT_64	1
42 #define CDNS_WDT_PRESCALE_SELECT_512	2
43 #define CDNS_WDT_PRESCALE_SELECT_4096	3
44 
45 /* Input clock frequency */
46 #define CDNS_WDT_CLK_10MHZ	10000000
47 #define CDNS_WDT_CLK_75MHZ	75000000
48 
49 /* Counter maximum value */
50 #define CDNS_WDT_COUNTER_MAX 0xFFF
51 
52 static int wdt_timeout;
53 static int nowayout = WATCHDOG_NOWAYOUT;
54 
55 module_param(wdt_timeout, int, 0644);
56 MODULE_PARM_DESC(wdt_timeout,
57 		 "Watchdog time in seconds. (default="
58 		 __MODULE_STRING(CDNS_WDT_DEFAULT_TIMEOUT) ")");
59 
60 module_param(nowayout, int, 0644);
61 MODULE_PARM_DESC(nowayout,
62 		 "Watchdog cannot be stopped once started (default="
63 		 __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
64 
65 /**
66  * struct cdns_wdt - Watchdog device structure
67  * @regs: baseaddress of device
68  * @rst: reset flag
69  * @clk: struct clk * of a clock source
70  * @prescaler: for saving prescaler value
71  * @ctrl_clksel: counter clock prescaler selection
72  * @io_lock: spinlock for IO register access
73  * @cdns_wdt_device: watchdog device structure
74  *
75  * Structure containing parameters specific to cadence watchdog.
76  */
77 struct cdns_wdt {
78 	void __iomem		*regs;
79 	bool			rst;
80 	struct clk		*clk;
81 	u32			prescaler;
82 	u32			ctrl_clksel;
83 	spinlock_t		io_lock;
84 	struct watchdog_device	cdns_wdt_device;
85 };
86 
87 /* Write access to Registers */
88 static inline void cdns_wdt_writereg(struct cdns_wdt *wdt, u32 offset, u32 val)
89 {
90 	writel_relaxed(val, wdt->regs + offset);
91 }
92 
93 /*************************Register Map**************************************/
94 
95 /* Register Offsets for the WDT */
96 #define CDNS_WDT_ZMR_OFFSET	0x0	/* Zero Mode Register */
97 #define CDNS_WDT_CCR_OFFSET	0x4	/* Counter Control Register */
98 #define CDNS_WDT_RESTART_OFFSET	0x8	/* Restart Register */
99 #define CDNS_WDT_SR_OFFSET	0xC	/* Status Register */
100 
101 /*
102  * Zero Mode Register - This register controls how the time out is indicated
103  * and also contains the access code to allow writes to the register (0xABC).
104  */
105 #define CDNS_WDT_ZMR_WDEN_MASK	0x00000001 /* Enable the WDT */
106 #define CDNS_WDT_ZMR_RSTEN_MASK	0x00000002 /* Enable the reset output */
107 #define CDNS_WDT_ZMR_IRQEN_MASK	0x00000004 /* Enable IRQ output */
108 #define CDNS_WDT_ZMR_RSTLEN_16	0x00000030 /* Reset pulse of 16 pclk cycles */
109 #define CDNS_WDT_ZMR_ZKEY_VAL	0x00ABC000 /* Access key, 0xABC << 12 */
110 /*
111  * Counter Control register - This register controls how fast the timer runs
112  * and the reset value and also contains the access code to allow writes to
113  * the register.
114  */
115 #define CDNS_WDT_CCR_CRV_MASK	0x00003FFC /* Counter reset value */
116 
117 /**
118  * cdns_wdt_stop - Stop the watchdog.
119  *
120  * @wdd: watchdog device
121  *
122  * Read the contents of the ZMR register, clear the WDEN bit
123  * in the register and set the access key for successful write.
124  *
125  * Return: always 0
126  */
127 static int cdns_wdt_stop(struct watchdog_device *wdd)
128 {
129 	struct cdns_wdt *wdt = watchdog_get_drvdata(wdd);
130 
131 	spin_lock(&wdt->io_lock);
132 	cdns_wdt_writereg(wdt, CDNS_WDT_ZMR_OFFSET,
133 			  CDNS_WDT_ZMR_ZKEY_VAL & (~CDNS_WDT_ZMR_WDEN_MASK));
134 	spin_unlock(&wdt->io_lock);
135 
136 	return 0;
137 }
138 
139 /**
140  * cdns_wdt_reload - Reload the watchdog timer (i.e. pat the watchdog).
141  *
142  * @wdd: watchdog device
143  *
144  * Write the restart key value (0x00001999) to the restart register.
145  *
146  * Return: always 0
147  */
148 static int cdns_wdt_reload(struct watchdog_device *wdd)
149 {
150 	struct cdns_wdt *wdt = watchdog_get_drvdata(wdd);
151 
152 	spin_lock(&wdt->io_lock);
153 	cdns_wdt_writereg(wdt, CDNS_WDT_RESTART_OFFSET,
154 			  CDNS_WDT_RESTART_KEY);
155 	spin_unlock(&wdt->io_lock);
156 
157 	return 0;
158 }
159 
160 /**
161  * cdns_wdt_start - Enable and start the watchdog.
162  *
163  * @wdd: watchdog device
164  *
165  * The counter value is calculated according to the formula:
166  *		calculated count = (timeout * clock) / prescaler + 1.
167  * The calculated count is divided by 0x1000 to obtain the field value
168  * to write to counter control register.
169  * Clears the contents of prescaler and counter reset value. Sets the
170  * prescaler to 4096 and the calculated count and access key
171  * to write to CCR Register.
172  * Sets the WDT (WDEN bit) and either the Reset signal(RSTEN bit)
173  * or Interrupt signal(IRQEN) with a specified cycles and the access
174  * key to write to ZMR Register.
175  *
176  * Return: always 0
177  */
178 static int cdns_wdt_start(struct watchdog_device *wdd)
179 {
180 	struct cdns_wdt *wdt = watchdog_get_drvdata(wdd);
181 	unsigned int data = 0;
182 	unsigned short count;
183 	unsigned long clock_f = clk_get_rate(wdt->clk);
184 
185 	/*
186 	 * Counter value divisor to obtain the value of
187 	 * counter reset to be written to control register.
188 	 */
189 	count = (wdd->timeout * (clock_f / wdt->prescaler)) /
190 		 CDNS_WDT_COUNTER_VALUE_DIVISOR + 1;
191 
192 	if (count > CDNS_WDT_COUNTER_MAX)
193 		count = CDNS_WDT_COUNTER_MAX;
194 
195 	spin_lock(&wdt->io_lock);
196 	cdns_wdt_writereg(wdt, CDNS_WDT_ZMR_OFFSET,
197 			  CDNS_WDT_ZMR_ZKEY_VAL);
198 
199 	count = (count << 2) & CDNS_WDT_CCR_CRV_MASK;
200 
201 	/* Write counter access key first to be able write to register */
202 	data = count | CDNS_WDT_REGISTER_ACCESS_KEY | wdt->ctrl_clksel;
203 	cdns_wdt_writereg(wdt, CDNS_WDT_CCR_OFFSET, data);
204 	data = CDNS_WDT_ZMR_WDEN_MASK | CDNS_WDT_ZMR_RSTLEN_16 |
205 	       CDNS_WDT_ZMR_ZKEY_VAL;
206 
207 	/* Reset on timeout if specified in device tree. */
208 	if (wdt->rst) {
209 		data |= CDNS_WDT_ZMR_RSTEN_MASK;
210 		data &= ~CDNS_WDT_ZMR_IRQEN_MASK;
211 	} else {
212 		data &= ~CDNS_WDT_ZMR_RSTEN_MASK;
213 		data |= CDNS_WDT_ZMR_IRQEN_MASK;
214 	}
215 	cdns_wdt_writereg(wdt, CDNS_WDT_ZMR_OFFSET, data);
216 	cdns_wdt_writereg(wdt, CDNS_WDT_RESTART_OFFSET,
217 			  CDNS_WDT_RESTART_KEY);
218 	spin_unlock(&wdt->io_lock);
219 
220 	return 0;
221 }
222 
223 /**
224  * cdns_wdt_settimeout - Set a new timeout value for the watchdog device.
225  *
226  * @wdd: watchdog device
227  * @new_time: new timeout value that needs to be set
228  * Return: 0 on success
229  *
230  * Update the watchdog_device timeout with new value which is used when
231  * cdns_wdt_start is called.
232  */
233 static int cdns_wdt_settimeout(struct watchdog_device *wdd,
234 			       unsigned int new_time)
235 {
236 	wdd->timeout = new_time;
237 
238 	return cdns_wdt_start(wdd);
239 }
240 
241 /**
242  * cdns_wdt_irq_handler - Notifies of watchdog timeout.
243  *
244  * @irq: interrupt number
245  * @dev_id: pointer to a platform device structure
246  * Return: IRQ_HANDLED
247  *
248  * The handler is invoked when the watchdog times out and a
249  * reset on timeout has not been enabled.
250  */
251 static irqreturn_t cdns_wdt_irq_handler(int irq, void *dev_id)
252 {
253 	struct platform_device *pdev = dev_id;
254 
255 	dev_info(&pdev->dev,
256 		 "Watchdog timed out. Internal reset not enabled\n");
257 
258 	return IRQ_HANDLED;
259 }
260 
261 /*
262  * Info structure used to indicate the features supported by the device
263  * to the upper layers. This is defined in watchdog.h header file.
264  */
265 static const struct watchdog_info cdns_wdt_info = {
266 	.identity	= "cdns_wdt watchdog",
267 	.options	= WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING |
268 			  WDIOF_MAGICCLOSE,
269 };
270 
271 /* Watchdog Core Ops */
272 static const struct watchdog_ops cdns_wdt_ops = {
273 	.owner = THIS_MODULE,
274 	.start = cdns_wdt_start,
275 	.stop = cdns_wdt_stop,
276 	.ping = cdns_wdt_reload,
277 	.set_timeout = cdns_wdt_settimeout,
278 };
279 
280 /************************Platform Operations*****************************/
281 /**
282  * cdns_wdt_probe - Probe call for the device.
283  *
284  * @pdev: handle to the platform device structure.
285  * Return: 0 on success, negative error otherwise.
286  *
287  * It does all the memory allocation and registration for the device.
288  */
289 static int cdns_wdt_probe(struct platform_device *pdev)
290 {
291 	struct resource *res;
292 	int ret, irq;
293 	unsigned long clock_f;
294 	struct cdns_wdt *wdt;
295 	struct watchdog_device *cdns_wdt_device;
296 
297 	wdt = devm_kzalloc(&pdev->dev, sizeof(*wdt), GFP_KERNEL);
298 	if (!wdt)
299 		return -ENOMEM;
300 
301 	cdns_wdt_device = &wdt->cdns_wdt_device;
302 	cdns_wdt_device->info = &cdns_wdt_info;
303 	cdns_wdt_device->ops = &cdns_wdt_ops;
304 	cdns_wdt_device->timeout = CDNS_WDT_DEFAULT_TIMEOUT;
305 	cdns_wdt_device->min_timeout = CDNS_WDT_MIN_TIMEOUT;
306 	cdns_wdt_device->max_timeout = CDNS_WDT_MAX_TIMEOUT;
307 
308 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
309 	wdt->regs = devm_ioremap_resource(&pdev->dev, res);
310 	if (IS_ERR(wdt->regs))
311 		return PTR_ERR(wdt->regs);
312 
313 	/* Register the interrupt */
314 	wdt->rst = of_property_read_bool(pdev->dev.of_node, "reset-on-timeout");
315 	irq = platform_get_irq(pdev, 0);
316 	if (!wdt->rst && irq >= 0) {
317 		ret = devm_request_irq(&pdev->dev, irq, cdns_wdt_irq_handler, 0,
318 				       pdev->name, pdev);
319 		if (ret) {
320 			dev_err(&pdev->dev,
321 				"cannot register interrupt handler err=%d\n",
322 				ret);
323 			return ret;
324 		}
325 	}
326 
327 	/* Initialize the members of cdns_wdt structure */
328 	cdns_wdt_device->parent = &pdev->dev;
329 
330 	ret = watchdog_init_timeout(cdns_wdt_device, wdt_timeout, &pdev->dev);
331 	if (ret) {
332 		dev_err(&pdev->dev, "unable to set timeout value\n");
333 		return ret;
334 	}
335 
336 	watchdog_set_nowayout(cdns_wdt_device, nowayout);
337 	watchdog_stop_on_reboot(cdns_wdt_device);
338 	watchdog_set_drvdata(cdns_wdt_device, wdt);
339 
340 	wdt->clk = devm_clk_get(&pdev->dev, NULL);
341 	if (IS_ERR(wdt->clk)) {
342 		dev_err(&pdev->dev, "input clock not found\n");
343 		ret = PTR_ERR(wdt->clk);
344 		return ret;
345 	}
346 
347 	ret = clk_prepare_enable(wdt->clk);
348 	if (ret) {
349 		dev_err(&pdev->dev, "unable to enable clock\n");
350 		return ret;
351 	}
352 
353 	clock_f = clk_get_rate(wdt->clk);
354 	if (clock_f <= CDNS_WDT_CLK_75MHZ) {
355 		wdt->prescaler = CDNS_WDT_PRESCALE_512;
356 		wdt->ctrl_clksel = CDNS_WDT_PRESCALE_SELECT_512;
357 	} else {
358 		wdt->prescaler = CDNS_WDT_PRESCALE_4096;
359 		wdt->ctrl_clksel = CDNS_WDT_PRESCALE_SELECT_4096;
360 	}
361 
362 	spin_lock_init(&wdt->io_lock);
363 
364 	ret = watchdog_register_device(cdns_wdt_device);
365 	if (ret) {
366 		dev_err(&pdev->dev, "Failed to register wdt device\n");
367 		goto err_clk_disable;
368 	}
369 	platform_set_drvdata(pdev, wdt);
370 
371 	dev_info(&pdev->dev, "Xilinx Watchdog Timer at %p with timeout %ds%s\n",
372 		 wdt->regs, cdns_wdt_device->timeout,
373 		 nowayout ? ", nowayout" : "");
374 
375 	return 0;
376 
377 err_clk_disable:
378 	clk_disable_unprepare(wdt->clk);
379 
380 	return ret;
381 }
382 
383 /**
384  * cdns_wdt_remove - Probe call for the device.
385  *
386  * @pdev: handle to the platform device structure.
387  * Return: 0 on success, otherwise negative error.
388  *
389  * Unregister the device after releasing the resources.
390  */
391 static int cdns_wdt_remove(struct platform_device *pdev)
392 {
393 	struct cdns_wdt *wdt = platform_get_drvdata(pdev);
394 
395 	cdns_wdt_stop(&wdt->cdns_wdt_device);
396 	watchdog_unregister_device(&wdt->cdns_wdt_device);
397 	clk_disable_unprepare(wdt->clk);
398 
399 	return 0;
400 }
401 
402 /**
403  * cdns_wdt_shutdown - Stop the device.
404  *
405  * @pdev: handle to the platform structure.
406  *
407  */
408 static void cdns_wdt_shutdown(struct platform_device *pdev)
409 {
410 	struct cdns_wdt *wdt = platform_get_drvdata(pdev);
411 
412 	cdns_wdt_stop(&wdt->cdns_wdt_device);
413 	clk_disable_unprepare(wdt->clk);
414 }
415 
416 /**
417  * cdns_wdt_suspend - Stop the device.
418  *
419  * @dev: handle to the device structure.
420  * Return: 0 always.
421  */
422 static int __maybe_unused cdns_wdt_suspend(struct device *dev)
423 {
424 	struct platform_device *pdev = to_platform_device(dev);
425 	struct cdns_wdt *wdt = platform_get_drvdata(pdev);
426 
427 	if (watchdog_active(&wdt->cdns_wdt_device)) {
428 		cdns_wdt_stop(&wdt->cdns_wdt_device);
429 		clk_disable_unprepare(wdt->clk);
430 	}
431 
432 	return 0;
433 }
434 
435 /**
436  * cdns_wdt_resume - Resume the device.
437  *
438  * @dev: handle to the device structure.
439  * Return: 0 on success, errno otherwise.
440  */
441 static int __maybe_unused cdns_wdt_resume(struct device *dev)
442 {
443 	int ret;
444 	struct platform_device *pdev = to_platform_device(dev);
445 	struct cdns_wdt *wdt = platform_get_drvdata(pdev);
446 
447 	if (watchdog_active(&wdt->cdns_wdt_device)) {
448 		ret = clk_prepare_enable(wdt->clk);
449 		if (ret) {
450 			dev_err(dev, "unable to enable clock\n");
451 			return ret;
452 		}
453 		cdns_wdt_start(&wdt->cdns_wdt_device);
454 	}
455 
456 	return 0;
457 }
458 
459 static SIMPLE_DEV_PM_OPS(cdns_wdt_pm_ops, cdns_wdt_suspend, cdns_wdt_resume);
460 
461 static const struct of_device_id cdns_wdt_of_match[] = {
462 	{ .compatible = "cdns,wdt-r1p2", },
463 	{ /* end of table */ }
464 };
465 MODULE_DEVICE_TABLE(of, cdns_wdt_of_match);
466 
467 /* Driver Structure */
468 static struct platform_driver cdns_wdt_driver = {
469 	.probe		= cdns_wdt_probe,
470 	.remove		= cdns_wdt_remove,
471 	.shutdown	= cdns_wdt_shutdown,
472 	.driver		= {
473 		.name	= "cdns-wdt",
474 		.of_match_table = cdns_wdt_of_match,
475 		.pm	= &cdns_wdt_pm_ops,
476 	},
477 };
478 
479 module_platform_driver(cdns_wdt_driver);
480 
481 MODULE_AUTHOR("Xilinx, Inc.");
482 MODULE_DESCRIPTION("Watchdog driver for Cadence WDT");
483 MODULE_LICENSE("GPL");
484