146 static int starfive_wdt_enable_clock(struct starfive_wdt *wdt)  in starfive_wdt_enable_clock()  argument
150 	ret = clk_prepare_enable(wdt->apb_clk);  in starfive_wdt_enable_clock()
152 		return dev_err_probe(wdt->wdd.parent, ret, "failed to enable apb clock\n");  in starfive_wdt_enable_clock()
154 	ret = clk_prepare_enable(wdt->core_clk);  in starfive_wdt_enable_clock()
156 		return dev_err_probe(wdt->wdd.parent, ret, "failed to enable core clock\n");  in starfive_wdt_enable_clock()
161 static void starfive_wdt_disable_clock(struct starfive_wdt *wdt)  in starfive_wdt_disable_clock()  argument
163 	clk_disable_unprepare(wdt->core_clk);  in starfive_wdt_disable_clock()
164 	clk_disable_unprepare(wdt->apb_clk);  in starfive_wdt_disable_clock()
167 static inline int starfive_wdt_get_clock(struct starfive_wdt *wdt)  in starfive_wdt_get_clock()  argument
169 	struct device *dev = wdt->wdd.parent;  in starfive_wdt_get_clock()
171 	wdt->apb_clk = devm_clk_get(dev, "apb");  in starfive_wdt_get_clock()
172 	if (IS_ERR(wdt->apb_clk))  in starfive_wdt_get_clock()
173 		return dev_err_probe(dev, PTR_ERR(wdt->apb_clk), "failed to get apb clock\n");  in starfive_wdt_get_clock()
175 	wdt->core_clk = devm_clk_get(dev, "core");  in starfive_wdt_get_clock()
176 	if (IS_ERR(wdt->core_clk))  in starfive_wdt_get_clock()
177 		return dev_err_probe(dev, PTR_ERR(wdt->core_clk), "failed to get core clock\n");  in starfive_wdt_get_clock()
198 static u32 starfive_wdt_ticks_to_sec(struct starfive_wdt *wdt, u32 ticks)  in starfive_wdt_ticks_to_sec()  argument
200 	return DIV_ROUND_CLOSEST(ticks, wdt->freq);  in starfive_wdt_ticks_to_sec()
204 static void starfive_wdt_unlock(struct starfive_wdt *wdt)  in starfive_wdt_unlock()  argument
205 	__acquires(&wdt->lock)  in starfive_wdt_unlock()
207 	spin_lock(&wdt->lock);  in starfive_wdt_unlock()
208 	writel(wdt->variant->unlock_key, wdt->base + wdt->variant->unlock);  in starfive_wdt_unlock()
211 static void starfive_wdt_lock(struct starfive_wdt *wdt)  in starfive_wdt_lock()  argument
212 	__releases(&wdt->lock)  in starfive_wdt_lock()
214 	writel(~wdt->variant->unlock_key, wdt->base + wdt->variant->unlock);  in starfive_wdt_lock()
215 	spin_unlock(&wdt->lock);  in starfive_wdt_lock()
219 static void starfive_wdt_enable_reset(struct starfive_wdt *wdt)  in starfive_wdt_enable_reset()  argument
223 	val = readl(wdt->base + wdt->variant->control);  in starfive_wdt_enable_reset()
224 	val |= STARFIVE_WDT_RESET_EN << wdt->variant->enrst_shift;  in starfive_wdt_enable_reset()
225 	writel(val, wdt->base + wdt->variant->control);  in starfive_wdt_enable_reset()
229 static bool starfive_wdt_raise_irq_status(struct starfive_wdt *wdt)  in starfive_wdt_raise_irq_status()  argument
231 	return !!readl(wdt->base + wdt->variant->int_status);  in starfive_wdt_raise_irq_status()
235 static int starfive_wdt_wait_int_free(struct starfive_wdt *wdt)  in starfive_wdt_wait_int_free()  argument
239 	return readl_poll_timeout_atomic(wdt->base + wdt->variant->int_clr, value,  in starfive_wdt_wait_int_free()
240 					 !(value & BIT(wdt->variant->intclr_ava_shift)),  in starfive_wdt_wait_int_free()
245 static int starfive_wdt_int_clr(struct starfive_wdt *wdt)  in starfive_wdt_int_clr()  argument
249 	if (wdt->variant->intclr_check) {  in starfive_wdt_int_clr()
250 		ret = starfive_wdt_wait_int_free(wdt);  in starfive_wdt_int_clr()
252 			return dev_err_probe(wdt->wdd.parent, ret,  in starfive_wdt_int_clr()
255 	writel(STARFIVE_WDT_INTCLR, wdt->base + wdt->variant->int_clr);  in starfive_wdt_int_clr()
260 static inline void starfive_wdt_set_count(struct starfive_wdt *wdt, u32 val)  in starfive_wdt_set_count()  argument
262 	writel(val, wdt->base + wdt->variant->load);  in starfive_wdt_set_count()
265 static inline u32 starfive_wdt_get_count(struct starfive_wdt *wdt)  in starfive_wdt_get_count()  argument
267 	return readl(wdt->base + wdt->variant->value);  in starfive_wdt_get_count()
271 static inline void starfive_wdt_enable(struct starfive_wdt *wdt)  in starfive_wdt_enable()  argument
275 	val = readl(wdt->base + wdt->variant->enable);  in starfive_wdt_enable()
276 	val |= STARFIVE_WDT_ENABLE << wdt->variant->en_shift;  in starfive_wdt_enable()
277 	writel(val, wdt->base + wdt->variant->enable);  in starfive_wdt_enable()
281 static inline void starfive_wdt_disable(struct starfive_wdt *wdt)  in starfive_wdt_disable()  argument
285 	val = readl(wdt->base + wdt->variant->enable);  in starfive_wdt_disable()
286 	val &= ~(STARFIVE_WDT_ENABLE << wdt->variant->en_shift);  in starfive_wdt_disable()
287 	writel(val, wdt->base + wdt->variant->enable);  in starfive_wdt_disable()
290 static inline void starfive_wdt_set_reload_count(struct starfive_wdt *wdt, u32 count)  in starfive_wdt_set_reload_count()  argument
292 	starfive_wdt_set_count(wdt, count);  in starfive_wdt_set_reload_count()
295 	if (wdt->variant->reload)  in starfive_wdt_set_reload_count()
296 		writel(0x1, wdt->base + wdt->variant->reload);  in starfive_wdt_set_reload_count()
299 static unsigned int starfive_wdt_max_timeout(struct starfive_wdt *wdt)  in starfive_wdt_max_timeout()  argument
301 	if (wdt->variant->double_timeout)  in starfive_wdt_max_timeout()
302 		return DIV_ROUND_UP(STARFIVE_WDT_MAXCNT, (wdt->freq / 2)) - 1;  in starfive_wdt_max_timeout()
304 	return DIV_ROUND_UP(STARFIVE_WDT_MAXCNT, wdt->freq) - 1;  in starfive_wdt_max_timeout()
309 	struct starfive_wdt *wdt = watchdog_get_drvdata(wdd);  in starfive_wdt_get_timeleft()  local
316 	count = starfive_wdt_get_count(wdt);  in starfive_wdt_get_timeleft()
317 	if (wdt->variant->double_timeout && !starfive_wdt_raise_irq_status(wdt))  in starfive_wdt_get_timeleft()
318 		count += wdt->count;  in starfive_wdt_get_timeleft()
320 	return starfive_wdt_ticks_to_sec(wdt, count);  in starfive_wdt_get_timeleft()
325 	struct starfive_wdt *wdt = watchdog_get_drvdata(wdd);  in starfive_wdt_keepalive()  local
328 	starfive_wdt_unlock(wdt);  in starfive_wdt_keepalive()
329 	ret = starfive_wdt_int_clr(wdt);  in starfive_wdt_keepalive()
333 	starfive_wdt_set_reload_count(wdt, wdt->count);  in starfive_wdt_keepalive()
337 	starfive_wdt_lock(wdt);  in starfive_wdt_keepalive()
341 static int starfive_wdt_start(struct starfive_wdt *wdt)  in starfive_wdt_start()  argument
345 	starfive_wdt_unlock(wdt);  in starfive_wdt_start()
347 	starfive_wdt_disable(wdt);  in starfive_wdt_start()
349 	starfive_wdt_enable_reset(wdt);  in starfive_wdt_start()
350 	ret = starfive_wdt_int_clr(wdt);  in starfive_wdt_start()
354 	starfive_wdt_set_count(wdt, wdt->count);  in starfive_wdt_start()
355 	starfive_wdt_enable(wdt);  in starfive_wdt_start()
358 	starfive_wdt_lock(wdt);  in starfive_wdt_start()
362 static void starfive_wdt_stop(struct starfive_wdt *wdt)  in starfive_wdt_stop()  argument
364 	starfive_wdt_unlock(wdt);  in starfive_wdt_stop()
365 	starfive_wdt_disable(wdt);  in starfive_wdt_stop()
366 	starfive_wdt_lock(wdt);  in starfive_wdt_stop()
371 	struct starfive_wdt *wdt = watchdog_get_drvdata(wdd);  in starfive_wdt_pm_start()  local
377 	return starfive_wdt_start(wdt);  in starfive_wdt_pm_start()
382 	struct starfive_wdt *wdt = watchdog_get_drvdata(wdd);  in starfive_wdt_pm_stop()  local
384 	starfive_wdt_stop(wdt);  in starfive_wdt_pm_stop()
391 	struct starfive_wdt *wdt = watchdog_get_drvdata(wdd);  in starfive_wdt_set_timeout()  local
392 	unsigned long count = timeout * wdt->freq;  in starfive_wdt_set_timeout()
395 	if (wdt->variant->double_timeout)  in starfive_wdt_set_timeout()
398 	wdt->count = count;  in starfive_wdt_set_timeout()
401 	starfive_wdt_unlock(wdt);  in starfive_wdt_set_timeout()
402 	starfive_wdt_disable(wdt);  in starfive_wdt_set_timeout()
403 	starfive_wdt_set_reload_count(wdt, wdt->count);  in starfive_wdt_set_timeout()
404 	starfive_wdt_enable(wdt);  in starfive_wdt_set_timeout()
405 	starfive_wdt_lock(wdt);  in starfive_wdt_set_timeout()
428 	struct starfive_wdt *wdt;  in starfive_wdt_probe()  local
431 	wdt = devm_kzalloc(&pdev->dev, sizeof(*wdt), GFP_KERNEL);  in starfive_wdt_probe()
432 	if (!wdt)  in starfive_wdt_probe()
435 	wdt->base = devm_platform_ioremap_resource(pdev, 0);  in starfive_wdt_probe()
436 	if (IS_ERR(wdt->base))  in starfive_wdt_probe()
437 		return dev_err_probe(&pdev->dev, PTR_ERR(wdt->base), "error mapping registers\n");  in starfive_wdt_probe()
439 	wdt->wdd.parent = &pdev->dev;  in starfive_wdt_probe()
440 	ret = starfive_wdt_get_clock(wdt);  in starfive_wdt_probe()
444 	platform_set_drvdata(pdev, wdt);  in starfive_wdt_probe()
452 		ret = starfive_wdt_enable_clock(wdt);  in starfive_wdt_probe()
461 	watchdog_set_drvdata(&wdt->wdd, wdt);  in starfive_wdt_probe()
462 	wdt->wdd.info = &starfive_wdt_info;  in starfive_wdt_probe()
463 	wdt->wdd.ops = &starfive_wdt_ops;  in starfive_wdt_probe()
464 	wdt->variant = of_device_get_match_data(&pdev->dev);  in starfive_wdt_probe()
465 	spin_lock_init(&wdt->lock);  in starfive_wdt_probe()
467 	wdt->freq = clk_get_rate(wdt->core_clk);  in starfive_wdt_probe()
468 	if (!wdt->freq) {  in starfive_wdt_probe()
474 	wdt->wdd.min_timeout = 1;  in starfive_wdt_probe()
475 	wdt->wdd.max_timeout = starfive_wdt_max_timeout(wdt);  in starfive_wdt_probe()
476 	wdt->wdd.timeout = STARFIVE_WDT_DEFAULT_TIME;  in starfive_wdt_probe()
477 	watchdog_init_timeout(&wdt->wdd, heartbeat, &pdev->dev);  in starfive_wdt_probe()
478 	starfive_wdt_set_timeout(&wdt->wdd, wdt->wdd.timeout);  in starfive_wdt_probe()
480 	watchdog_set_nowayout(&wdt->wdd, nowayout);  in starfive_wdt_probe()
481 	watchdog_stop_on_reboot(&wdt->wdd);  in starfive_wdt_probe()
482 	watchdog_stop_on_unregister(&wdt->wdd);  in starfive_wdt_probe()
485 		ret = starfive_wdt_start(wdt);  in starfive_wdt_probe()
488 		set_bit(WDOG_HW_RUNNING, &wdt->wdd.status);  in starfive_wdt_probe()
490 		starfive_wdt_stop(wdt);  in starfive_wdt_probe()
493 	ret = watchdog_register_device(&wdt->wdd);  in starfive_wdt_probe()
508 	starfive_wdt_disable_clock(wdt);  in starfive_wdt_probe()
516 	struct starfive_wdt *wdt = platform_get_drvdata(pdev);  in starfive_wdt_remove()  local
518 	starfive_wdt_stop(wdt);  in starfive_wdt_remove()
519 	watchdog_unregister_device(&wdt->wdd);  in starfive_wdt_remove()
525 		starfive_wdt_disable_clock(wdt);  in starfive_wdt_remove()
532 	struct starfive_wdt *wdt = platform_get_drvdata(pdev);  in starfive_wdt_shutdown()  local
534 	starfive_wdt_pm_stop(&wdt->wdd);  in starfive_wdt_shutdown()
539 	struct starfive_wdt *wdt = dev_get_drvdata(dev);  in starfive_wdt_suspend()  local
542 	wdt->reload = starfive_wdt_get_count(wdt);  in starfive_wdt_suspend()
545 	starfive_wdt_stop(wdt);  in starfive_wdt_suspend()
552 	struct starfive_wdt *wdt = dev_get_drvdata(dev);  in starfive_wdt_resume()  local
559 	starfive_wdt_unlock(wdt);  in starfive_wdt_resume()
561 	starfive_wdt_set_reload_count(wdt, wdt->reload);  in starfive_wdt_resume()
562 	starfive_wdt_lock(wdt);  in starfive_wdt_resume()
564 	return starfive_wdt_start(wdt);  in starfive_wdt_resume()
569 	struct starfive_wdt *wdt = dev_get_drvdata(dev);  in starfive_wdt_runtime_suspend()  local
571 	starfive_wdt_disable_clock(wdt);  in starfive_wdt_runtime_suspend()
578 	struct starfive_wdt *wdt = dev_get_drvdata(dev);  in starfive_wdt_runtime_resume()  local
580 	return starfive_wdt_enable_clock(wdt);  in starfive_wdt_runtime_resume()
589 	{ .compatible = "starfive,jh7100-wdt", .data = &starfive_wdt_jh7100_variant },
590 	{ .compatible = "starfive,jh7110-wdt", .data = &starfive_wdt_jh7110_variant },
600 		.name = "starfive-wdt",