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