Loading...
1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Realtek RTD129x watchdog
4 *
5 * Copyright (c) 2017 Andreas Färber
6 *
7 */
8
9#include <linux/bitops.h>
10#include <linux/clk.h>
11#include <linux/io.h>
12#include <linux/of.h>
13#include <linux/of_address.h>
14#include <linux/platform_device.h>
15#include <linux/watchdog.h>
16
17#define RTD119X_TCWCR 0x0
18#define RTD119X_TCWTR 0x4
19#define RTD119X_TCWOV 0xc
20
21#define RTD119X_TCWCR_WDEN_DISABLED 0xa5
22#define RTD119X_TCWCR_WDEN_ENABLED 0xff
23#define RTD119X_TCWCR_WDEN_MASK 0xff
24
25#define RTD119X_TCWTR_WDCLR BIT(0)
26
27struct rtd119x_watchdog_device {
28 struct watchdog_device wdt_dev;
29 void __iomem *base;
30 struct clk *clk;
31};
32
33static int rtd119x_wdt_start(struct watchdog_device *wdev)
34{
35 struct rtd119x_watchdog_device *data = watchdog_get_drvdata(wdev);
36 u32 val;
37
38 val = readl_relaxed(data->base + RTD119X_TCWCR);
39 val &= ~RTD119X_TCWCR_WDEN_MASK;
40 val |= RTD119X_TCWCR_WDEN_ENABLED;
41 writel(val, data->base + RTD119X_TCWCR);
42
43 return 0;
44}
45
46static int rtd119x_wdt_stop(struct watchdog_device *wdev)
47{
48 struct rtd119x_watchdog_device *data = watchdog_get_drvdata(wdev);
49 u32 val;
50
51 val = readl_relaxed(data->base + RTD119X_TCWCR);
52 val &= ~RTD119X_TCWCR_WDEN_MASK;
53 val |= RTD119X_TCWCR_WDEN_DISABLED;
54 writel(val, data->base + RTD119X_TCWCR);
55
56 return 0;
57}
58
59static int rtd119x_wdt_ping(struct watchdog_device *wdev)
60{
61 struct rtd119x_watchdog_device *data = watchdog_get_drvdata(wdev);
62
63 writel_relaxed(RTD119X_TCWTR_WDCLR, data->base + RTD119X_TCWTR);
64
65 return rtd119x_wdt_start(wdev);
66}
67
68static int rtd119x_wdt_set_timeout(struct watchdog_device *wdev, unsigned int val)
69{
70 struct rtd119x_watchdog_device *data = watchdog_get_drvdata(wdev);
71
72 writel(val * clk_get_rate(data->clk), data->base + RTD119X_TCWOV);
73
74 data->wdt_dev.timeout = val;
75
76 return 0;
77}
78
79static const struct watchdog_ops rtd119x_wdt_ops = {
80 .owner = THIS_MODULE,
81 .start = rtd119x_wdt_start,
82 .stop = rtd119x_wdt_stop,
83 .ping = rtd119x_wdt_ping,
84 .set_timeout = rtd119x_wdt_set_timeout,
85};
86
87static const struct watchdog_info rtd119x_wdt_info = {
88 .identity = "rtd119x-wdt",
89 .options = 0,
90};
91
92static const struct of_device_id rtd119x_wdt_dt_ids[] = {
93 { .compatible = "realtek,rtd1295-watchdog" },
94 { }
95};
96
97static int rtd119x_wdt_probe(struct platform_device *pdev)
98{
99 struct device *dev = &pdev->dev;
100 struct rtd119x_watchdog_device *data;
101
102 data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
103 if (!data)
104 return -ENOMEM;
105
106 data->base = devm_platform_ioremap_resource(pdev, 0);
107 if (IS_ERR(data->base))
108 return PTR_ERR(data->base);
109
110 data->clk = devm_clk_get_enabled(dev, NULL);
111 if (IS_ERR(data->clk))
112 return PTR_ERR(data->clk);
113
114 data->wdt_dev.info = &rtd119x_wdt_info;
115 data->wdt_dev.ops = &rtd119x_wdt_ops;
116 data->wdt_dev.timeout = 120;
117 data->wdt_dev.max_timeout = 0xffffffff / clk_get_rate(data->clk);
118 data->wdt_dev.min_timeout = 1;
119 data->wdt_dev.parent = dev;
120
121 watchdog_stop_on_reboot(&data->wdt_dev);
122 watchdog_set_drvdata(&data->wdt_dev, data);
123 platform_set_drvdata(pdev, data);
124
125 writel_relaxed(RTD119X_TCWTR_WDCLR, data->base + RTD119X_TCWTR);
126 rtd119x_wdt_set_timeout(&data->wdt_dev, data->wdt_dev.timeout);
127 rtd119x_wdt_stop(&data->wdt_dev);
128
129 return devm_watchdog_register_device(dev, &data->wdt_dev);
130}
131
132static struct platform_driver rtd119x_wdt_driver = {
133 .probe = rtd119x_wdt_probe,
134 .driver = {
135 .name = "rtd1295-watchdog",
136 .of_match_table = rtd119x_wdt_dt_ids,
137 },
138};
139builtin_platform_driver(rtd119x_wdt_driver);
1/*
2 * Realtek RTD129x watchdog
3 *
4 * Copyright (c) 2017 Andreas Färber
5 *
6 * SPDX-License-Identifier: GPL-2.0+
7 */
8
9#include <linux/bitops.h>
10#include <linux/clk.h>
11#include <linux/io.h>
12#include <linux/module.h>
13#include <linux/of.h>
14#include <linux/of_address.h>
15#include <linux/platform_device.h>
16#include <linux/watchdog.h>
17
18#define RTD119X_TCWCR 0x0
19#define RTD119X_TCWTR 0x4
20#define RTD119X_TCWOV 0xc
21
22#define RTD119X_TCWCR_WDEN_DISABLED 0xa5
23#define RTD119X_TCWCR_WDEN_ENABLED 0xff
24#define RTD119X_TCWCR_WDEN_MASK 0xff
25
26#define RTD119X_TCWTR_WDCLR BIT(0)
27
28struct rtd119x_watchdog_device {
29 struct watchdog_device wdt_dev;
30 void __iomem *base;
31 struct clk *clk;
32};
33
34static int rtd119x_wdt_start(struct watchdog_device *wdev)
35{
36 struct rtd119x_watchdog_device *data = watchdog_get_drvdata(wdev);
37 u32 val;
38
39 val = readl_relaxed(data->base + RTD119X_TCWCR);
40 val &= ~RTD119X_TCWCR_WDEN_MASK;
41 val |= RTD119X_TCWCR_WDEN_ENABLED;
42 writel(val, data->base + RTD119X_TCWCR);
43
44 return 0;
45}
46
47static int rtd119x_wdt_stop(struct watchdog_device *wdev)
48{
49 struct rtd119x_watchdog_device *data = watchdog_get_drvdata(wdev);
50 u32 val;
51
52 val = readl_relaxed(data->base + RTD119X_TCWCR);
53 val &= ~RTD119X_TCWCR_WDEN_MASK;
54 val |= RTD119X_TCWCR_WDEN_DISABLED;
55 writel(val, data->base + RTD119X_TCWCR);
56
57 return 0;
58}
59
60static int rtd119x_wdt_ping(struct watchdog_device *wdev)
61{
62 struct rtd119x_watchdog_device *data = watchdog_get_drvdata(wdev);
63
64 writel_relaxed(RTD119X_TCWTR_WDCLR, data->base + RTD119X_TCWTR);
65
66 return rtd119x_wdt_start(wdev);
67}
68
69static int rtd119x_wdt_set_timeout(struct watchdog_device *wdev, unsigned int val)
70{
71 struct rtd119x_watchdog_device *data = watchdog_get_drvdata(wdev);
72
73 writel(val * clk_get_rate(data->clk), data->base + RTD119X_TCWOV);
74
75 data->wdt_dev.timeout = val;
76
77 return 0;
78}
79
80static const struct watchdog_ops rtd119x_wdt_ops = {
81 .owner = THIS_MODULE,
82 .start = rtd119x_wdt_start,
83 .stop = rtd119x_wdt_stop,
84 .ping = rtd119x_wdt_ping,
85 .set_timeout = rtd119x_wdt_set_timeout,
86};
87
88static const struct watchdog_info rtd119x_wdt_info = {
89 .identity = "rtd119x-wdt",
90 .options = 0,
91};
92
93static const struct of_device_id rtd119x_wdt_dt_ids[] = {
94 { .compatible = "realtek,rtd1295-watchdog" },
95 { }
96};
97
98static int rtd119x_wdt_probe(struct platform_device *pdev)
99{
100 struct rtd119x_watchdog_device *data;
101 struct resource *res;
102 int ret;
103
104 data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
105 if (!data)
106 return -ENOMEM;
107
108 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
109 data->base = devm_ioremap_resource(&pdev->dev, res);
110 if (IS_ERR(data->base))
111 return PTR_ERR(data->base);
112
113 data->clk = of_clk_get(pdev->dev.of_node, 0);
114 if (IS_ERR(data->clk))
115 return PTR_ERR(data->clk);
116
117 ret = clk_prepare_enable(data->clk);
118 if (ret) {
119 clk_put(data->clk);
120 return ret;
121 }
122
123 data->wdt_dev.info = &rtd119x_wdt_info;
124 data->wdt_dev.ops = &rtd119x_wdt_ops;
125 data->wdt_dev.timeout = 120;
126 data->wdt_dev.max_timeout = 0xffffffff / clk_get_rate(data->clk);
127 data->wdt_dev.min_timeout = 1;
128 data->wdt_dev.parent = &pdev->dev;
129
130 watchdog_stop_on_reboot(&data->wdt_dev);
131 watchdog_set_drvdata(&data->wdt_dev, data);
132 platform_set_drvdata(pdev, data);
133
134 writel_relaxed(RTD119X_TCWTR_WDCLR, data->base + RTD119X_TCWTR);
135 rtd119x_wdt_set_timeout(&data->wdt_dev, data->wdt_dev.timeout);
136 rtd119x_wdt_stop(&data->wdt_dev);
137
138 ret = devm_watchdog_register_device(&pdev->dev, &data->wdt_dev);
139 if (ret) {
140 clk_disable_unprepare(data->clk);
141 clk_put(data->clk);
142 return ret;
143 }
144
145 return 0;
146}
147
148static int rtd119x_wdt_remove(struct platform_device *pdev)
149{
150 struct rtd119x_watchdog_device *data = platform_get_drvdata(pdev);
151
152 watchdog_unregister_device(&data->wdt_dev);
153
154 clk_disable_unprepare(data->clk);
155 clk_put(data->clk);
156
157 return 0;
158}
159
160static struct platform_driver rtd119x_wdt_driver = {
161 .probe = rtd119x_wdt_probe,
162 .remove = rtd119x_wdt_remove,
163 .driver = {
164 .name = "rtd1295-watchdog",
165 .of_match_table = rtd119x_wdt_dt_ids,
166 },
167};
168builtin_platform_driver(rtd119x_wdt_driver);