1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * SBSA(Server Base System Architecture) Generic Watchdog driver
4 *
5 * Copyright (c) 2015, Linaro Ltd.
6 * Author: Fu Wei <fu.wei@linaro.org>
7 * Suravee Suthikulpanit <Suravee.Suthikulpanit@amd.com>
8 * Al Stone <al.stone@linaro.org>
9 * Timur Tabi <timur@codeaurora.org>
10 *
11 * ARM SBSA Generic Watchdog has two stage timeouts:
12 * the first signal (WS0) is for alerting the system by interrupt,
13 * the second one (WS1) is a real hardware reset.
14 * More details about the hardware specification of this device:
15 * ARM DEN0029B - Server Base System Architecture (SBSA)
16 *
17 * This driver can operate ARM SBSA Generic Watchdog as a single stage watchdog
18 * or a two stages watchdog, it's set up by the module parameter "action".
19 * In the single stage mode, when the timeout is reached, your system
20 * will be reset by WS1. The first signal (WS0) is ignored.
21 * In the two stages mode, when the timeout is reached, the first signal (WS0)
22 * will trigger panic. If the system is getting into trouble and cannot be reset
23 * by panic or restart properly by the kdump kernel(if supported), then the
24 * second stage (as long as the first stage) will be reached, system will be
25 * reset by WS1. This function can help administrator to backup the system
26 * context info by panic console output or kdump.
27 *
28 * SBSA GWDT:
29 * if action is 1 (the two stages mode):
30 * |--------WOR-------WS0--------WOR-------WS1
31 * |----timeout-----(panic)----timeout-----reset
32 *
33 * if action is 0 (the single stage mode):
34 * |------WOR-----WS0(ignored)-----WOR------WS1
35 * |--------------timeout-------------------reset
36 *
37 * Note: Since this watchdog timer has two stages, and each stage is determined
38 * by WOR, in the single stage mode, the timeout is (WOR * 2); in the two
39 * stages mode, the timeout is WOR. The maximum timeout in the two stages mode
40 * is half of that in the single stage mode.
41 */
42
43 #include <linux/io.h>
44 #include <linux/io-64-nonatomic-lo-hi.h>
45 #include <linux/interrupt.h>
46 #include <linux/mod_devicetable.h>
47 #include <linux/module.h>
48 #include <linux/moduleparam.h>
49 #include <linux/platform_device.h>
50 #include <linux/uaccess.h>
51 #include <linux/watchdog.h>
52 #include <asm/arch_timer.h>
53
54 #define DRV_NAME "sbsa-gwdt"
55 #define WATCHDOG_NAME "SBSA Generic Watchdog"
56
57 /* SBSA Generic Watchdog register definitions */
58 /* refresh frame */
59 #define SBSA_GWDT_WRR 0x000
60
61 /* control frame */
62 #define SBSA_GWDT_WCS 0x000
63 #define SBSA_GWDT_WOR 0x008
64 #define SBSA_GWDT_WCV 0x010
65
66 /* refresh/control frame */
67 #define SBSA_GWDT_W_IIDR 0xfcc
68 #define SBSA_GWDT_IDR 0xfd0
69
70 /* Watchdog Control and Status Register */
71 #define SBSA_GWDT_WCS_EN BIT(0)
72 #define SBSA_GWDT_WCS_WS0 BIT(1)
73 #define SBSA_GWDT_WCS_WS1 BIT(2)
74
75 #define SBSA_GWDT_VERSION_MASK 0xF
76 #define SBSA_GWDT_VERSION_SHIFT 16
77
78 /**
79 * struct sbsa_gwdt - Internal representation of the SBSA GWDT
80 * @wdd: kernel watchdog_device structure
81 * @clk: store the System Counter clock frequency, in Hz.
82 * @version: store the architecture version
83 * @refresh_base: Virtual address of the watchdog refresh frame
84 * @control_base: Virtual address of the watchdog control frame
85 */
86 struct sbsa_gwdt {
87 struct watchdog_device wdd;
88 u32 clk;
89 int version;
90 void __iomem *refresh_base;
91 void __iomem *control_base;
92 };
93
94 #define DEFAULT_TIMEOUT 10 /* seconds */
95
96 static unsigned int timeout;
97 module_param(timeout, uint, 0);
98 MODULE_PARM_DESC(timeout,
99 "Watchdog timeout in seconds. (>=0, default="
100 __MODULE_STRING(DEFAULT_TIMEOUT) ")");
101
102 /*
103 * action refers to action taken when watchdog gets WS0
104 * 0 = skip
105 * 1 = panic
106 * defaults to skip (0)
107 */
108 static int action;
109 module_param(action, int, 0);
110 MODULE_PARM_DESC(action, "after watchdog gets WS0 interrupt, do: "
111 "0 = skip(*) 1 = panic");
112
113 static bool nowayout = WATCHDOG_NOWAYOUT;
114 module_param(nowayout, bool, S_IRUGO);
115 MODULE_PARM_DESC(nowayout,
116 "Watchdog cannot be stopped once started (default="
117 __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
118
119 /*
120 * Arm Base System Architecture 1.0 introduces watchdog v1 which
121 * increases the length watchdog offset register to 48 bits.
122 * - For version 0: WOR is 32 bits;
123 * - For version 1: WOR is 48 bits which comprises the register
124 * offset 0x8 and 0xC, and the bits [63:48] are reserved which are
125 * Read-As-Zero and Writes-Ignored.
126 */
sbsa_gwdt_reg_read(struct sbsa_gwdt * gwdt)127 static u64 sbsa_gwdt_reg_read(struct sbsa_gwdt *gwdt)
128 {
129 if (gwdt->version == 0)
130 return readl(gwdt->control_base + SBSA_GWDT_WOR);
131 else
132 return lo_hi_readq(gwdt->control_base + SBSA_GWDT_WOR);
133 }
134
sbsa_gwdt_reg_write(u64 val,struct sbsa_gwdt * gwdt)135 static void sbsa_gwdt_reg_write(u64 val, struct sbsa_gwdt *gwdt)
136 {
137 if (gwdt->version == 0)
138 writel((u32)val, gwdt->control_base + SBSA_GWDT_WOR);
139 else
140 lo_hi_writeq(val, gwdt->control_base + SBSA_GWDT_WOR);
141 }
142
143 /*
144 * watchdog operation functions
145 */
sbsa_gwdt_set_timeout(struct watchdog_device * wdd,unsigned int timeout)146 static int sbsa_gwdt_set_timeout(struct watchdog_device *wdd,
147 unsigned int timeout)
148 {
149 struct sbsa_gwdt *gwdt = watchdog_get_drvdata(wdd);
150
151 wdd->timeout = timeout;
152 timeout = clamp_t(unsigned int, timeout, 1, wdd->max_hw_heartbeat_ms / 1000);
153
154 if (action)
155 sbsa_gwdt_reg_write((u64)gwdt->clk * timeout, gwdt);
156 else
157 /*
158 * In the single stage mode, The first signal (WS0) is ignored,
159 * the timeout is (WOR * 2), so the WOR should be configured
160 * to half value of timeout.
161 */
162 sbsa_gwdt_reg_write(((u64)gwdt->clk / 2) * timeout, gwdt);
163
164 return 0;
165 }
166
sbsa_gwdt_get_timeleft(struct watchdog_device * wdd)167 static unsigned int sbsa_gwdt_get_timeleft(struct watchdog_device *wdd)
168 {
169 struct sbsa_gwdt *gwdt = watchdog_get_drvdata(wdd);
170 u64 timeleft = 0;
171
172 /*
173 * In the single stage mode, if WS0 is deasserted
174 * (watchdog is in the first stage),
175 * timeleft = WOR + (WCV - system counter)
176 */
177 if (!action &&
178 !(readl(gwdt->control_base + SBSA_GWDT_WCS) & SBSA_GWDT_WCS_WS0))
179 timeleft += sbsa_gwdt_reg_read(gwdt);
180
181 timeleft += lo_hi_readq(gwdt->control_base + SBSA_GWDT_WCV) -
182 arch_timer_read_counter();
183
184 do_div(timeleft, gwdt->clk);
185
186 return timeleft;
187 }
188
sbsa_gwdt_keepalive(struct watchdog_device * wdd)189 static int sbsa_gwdt_keepalive(struct watchdog_device *wdd)
190 {
191 struct sbsa_gwdt *gwdt = watchdog_get_drvdata(wdd);
192
193 /*
194 * Writing WRR for an explicit watchdog refresh.
195 * You can write anyting (like 0).
196 */
197 writel(0, gwdt->refresh_base + SBSA_GWDT_WRR);
198
199 return 0;
200 }
201
sbsa_gwdt_get_version(struct watchdog_device * wdd)202 static void sbsa_gwdt_get_version(struct watchdog_device *wdd)
203 {
204 struct sbsa_gwdt *gwdt = watchdog_get_drvdata(wdd);
205 int ver;
206
207 ver = readl(gwdt->control_base + SBSA_GWDT_W_IIDR);
208 ver = (ver >> SBSA_GWDT_VERSION_SHIFT) & SBSA_GWDT_VERSION_MASK;
209
210 gwdt->version = ver;
211 }
212
sbsa_gwdt_start(struct watchdog_device * wdd)213 static int sbsa_gwdt_start(struct watchdog_device *wdd)
214 {
215 struct sbsa_gwdt *gwdt = watchdog_get_drvdata(wdd);
216
217 /* writing WCS will cause an explicit watchdog refresh */
218 writel(SBSA_GWDT_WCS_EN, gwdt->control_base + SBSA_GWDT_WCS);
219
220 return 0;
221 }
222
sbsa_gwdt_stop(struct watchdog_device * wdd)223 static int sbsa_gwdt_stop(struct watchdog_device *wdd)
224 {
225 struct sbsa_gwdt *gwdt = watchdog_get_drvdata(wdd);
226
227 /* Simply write 0 to WCS to clean WCS_EN bit */
228 writel(0, gwdt->control_base + SBSA_GWDT_WCS);
229
230 return 0;
231 }
232
sbsa_gwdt_interrupt(int irq,void * dev_id)233 static irqreturn_t sbsa_gwdt_interrupt(int irq, void *dev_id)
234 {
235 panic(WATCHDOG_NAME " timeout");
236
237 return IRQ_HANDLED;
238 }
239
240 static const struct watchdog_info sbsa_gwdt_info = {
241 .identity = WATCHDOG_NAME,
242 .options = WDIOF_SETTIMEOUT |
243 WDIOF_KEEPALIVEPING |
244 WDIOF_MAGICCLOSE |
245 WDIOF_CARDRESET,
246 };
247
248 static const struct watchdog_ops sbsa_gwdt_ops = {
249 .owner = THIS_MODULE,
250 .start = sbsa_gwdt_start,
251 .stop = sbsa_gwdt_stop,
252 .ping = sbsa_gwdt_keepalive,
253 .set_timeout = sbsa_gwdt_set_timeout,
254 .get_timeleft = sbsa_gwdt_get_timeleft,
255 };
256
sbsa_gwdt_probe(struct platform_device * pdev)257 static int sbsa_gwdt_probe(struct platform_device *pdev)
258 {
259 void __iomem *rf_base, *cf_base;
260 struct device *dev = &pdev->dev;
261 struct watchdog_device *wdd;
262 struct sbsa_gwdt *gwdt;
263 int ret, irq;
264 u32 status;
265
266 gwdt = devm_kzalloc(dev, sizeof(*gwdt), GFP_KERNEL);
267 if (!gwdt)
268 return -ENOMEM;
269 platform_set_drvdata(pdev, gwdt);
270
271 cf_base = devm_platform_ioremap_resource(pdev, 0);
272 if (IS_ERR(cf_base))
273 return PTR_ERR(cf_base);
274
275 rf_base = devm_platform_ioremap_resource(pdev, 1);
276 if (IS_ERR(rf_base))
277 return PTR_ERR(rf_base);
278
279 /*
280 * Get the frequency of system counter from the cp15 interface of ARM
281 * Generic timer. We don't need to check it, because if it returns "0",
282 * system would panic in very early stage.
283 */
284 gwdt->clk = arch_timer_get_cntfrq();
285 gwdt->refresh_base = rf_base;
286 gwdt->control_base = cf_base;
287
288 wdd = &gwdt->wdd;
289 wdd->parent = dev;
290 wdd->info = &sbsa_gwdt_info;
291 wdd->ops = &sbsa_gwdt_ops;
292 wdd->min_timeout = 1;
293 wdd->timeout = DEFAULT_TIMEOUT;
294 watchdog_set_drvdata(wdd, gwdt);
295 watchdog_set_nowayout(wdd, nowayout);
296 sbsa_gwdt_get_version(wdd);
297 if (gwdt->version == 0)
298 wdd->max_hw_heartbeat_ms = U32_MAX / gwdt->clk * 1000;
299 else
300 wdd->max_hw_heartbeat_ms = GENMASK_ULL(47, 0) / gwdt->clk * 1000;
301
302 status = readl(cf_base + SBSA_GWDT_WCS);
303 if (status & SBSA_GWDT_WCS_WS1) {
304 dev_warn(dev, "System reset by WDT.\n");
305 wdd->bootstatus |= WDIOF_CARDRESET;
306 }
307 if (status & SBSA_GWDT_WCS_EN)
308 set_bit(WDOG_HW_RUNNING, &wdd->status);
309
310 if (action) {
311 irq = platform_get_irq(pdev, 0);
312 if (irq < 0) {
313 action = 0;
314 dev_warn(dev, "unable to get ws0 interrupt.\n");
315 } else {
316 /*
317 * In case there is a pending ws0 interrupt, just ping
318 * the watchdog before registering the interrupt routine
319 */
320 writel(0, rf_base + SBSA_GWDT_WRR);
321 if (devm_request_irq(dev, irq, sbsa_gwdt_interrupt, 0,
322 pdev->name, gwdt)) {
323 action = 0;
324 dev_warn(dev, "unable to request IRQ %d.\n",
325 irq);
326 }
327 }
328 if (!action)
329 dev_warn(dev, "falling back to single stage mode.\n");
330 }
331 /*
332 * In the single stage mode, The first signal (WS0) is ignored,
333 * the timeout is (WOR * 2), so the maximum timeout should be doubled.
334 */
335 if (!action)
336 wdd->max_hw_heartbeat_ms *= 2;
337
338 watchdog_init_timeout(wdd, timeout, dev);
339 /*
340 * Update timeout to WOR.
341 * Because of the explicit watchdog refresh mechanism,
342 * it's also a ping, if watchdog is enabled.
343 */
344 sbsa_gwdt_set_timeout(wdd, wdd->timeout);
345
346 watchdog_stop_on_reboot(wdd);
347 ret = devm_watchdog_register_device(dev, wdd);
348 if (ret)
349 return ret;
350
351 dev_info(dev, "Initialized with %ds timeout @ %u Hz, action=%d.%s\n",
352 wdd->timeout, gwdt->clk, action,
353 status & SBSA_GWDT_WCS_EN ? " [enabled]" : "");
354
355 return 0;
356 }
357
358 /* Disable watchdog if it is active during suspend */
sbsa_gwdt_suspend(struct device * dev)359 static int __maybe_unused sbsa_gwdt_suspend(struct device *dev)
360 {
361 struct sbsa_gwdt *gwdt = dev_get_drvdata(dev);
362
363 if (watchdog_hw_running(&gwdt->wdd))
364 sbsa_gwdt_stop(&gwdt->wdd);
365
366 return 0;
367 }
368
369 /* Enable watchdog if necessary */
sbsa_gwdt_resume(struct device * dev)370 static int __maybe_unused sbsa_gwdt_resume(struct device *dev)
371 {
372 struct sbsa_gwdt *gwdt = dev_get_drvdata(dev);
373
374 if (watchdog_hw_running(&gwdt->wdd))
375 sbsa_gwdt_start(&gwdt->wdd);
376
377 return 0;
378 }
379
380 static const struct dev_pm_ops sbsa_gwdt_pm_ops = {
381 SET_SYSTEM_SLEEP_PM_OPS(sbsa_gwdt_suspend, sbsa_gwdt_resume)
382 };
383
384 static const struct of_device_id sbsa_gwdt_of_match[] = {
385 { .compatible = "arm,sbsa-gwdt", },
386 {},
387 };
388 MODULE_DEVICE_TABLE(of, sbsa_gwdt_of_match);
389
390 static const struct platform_device_id sbsa_gwdt_pdev_match[] = {
391 { .name = DRV_NAME, },
392 {},
393 };
394 MODULE_DEVICE_TABLE(platform, sbsa_gwdt_pdev_match);
395
396 static struct platform_driver sbsa_gwdt_driver = {
397 .driver = {
398 .name = DRV_NAME,
399 .pm = &sbsa_gwdt_pm_ops,
400 .of_match_table = sbsa_gwdt_of_match,
401 },
402 .probe = sbsa_gwdt_probe,
403 .id_table = sbsa_gwdt_pdev_match,
404 };
405
406 module_platform_driver(sbsa_gwdt_driver);
407
408 MODULE_DESCRIPTION("SBSA Generic Watchdog Driver");
409 MODULE_AUTHOR("Fu Wei <fu.wei@linaro.org>");
410 MODULE_AUTHOR("Suravee Suthikulpanit <Suravee.Suthikulpanit@amd.com>");
411 MODULE_AUTHOR("Al Stone <al.stone@linaro.org>");
412 MODULE_AUTHOR("Timur Tabi <timur@codeaurora.org>");
413 MODULE_LICENSE("GPL v2");
414