11802d0beSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2c4f07eceSBrian Norris /*
3*e5a8fc34SDoug Berger * Copyright © 2014-2023 Broadcom
4c4f07eceSBrian Norris */
5c4f07eceSBrian Norris
6c4f07eceSBrian Norris #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
7c4f07eceSBrian Norris
8c4f07eceSBrian Norris #include <linux/clk.h>
9c4f07eceSBrian Norris #include <linux/device.h>
10c4f07eceSBrian Norris #include <linux/err.h>
11c4f07eceSBrian Norris #include <linux/init.h>
12c4f07eceSBrian Norris #include <linux/interrupt.h>
13c4f07eceSBrian Norris #include <linux/io.h>
14c4f07eceSBrian Norris #include <linux/irqreturn.h>
15c4f07eceSBrian Norris #include <linux/kernel.h>
16c4f07eceSBrian Norris #include <linux/module.h>
17c4f07eceSBrian Norris #include <linux/of.h>
18c4f07eceSBrian Norris #include <linux/platform_device.h>
19c4f07eceSBrian Norris #include <linux/pm.h>
20c4f07eceSBrian Norris #include <linux/pm_wakeup.h>
21c4f07eceSBrian Norris #include <linux/reboot.h>
22c4f07eceSBrian Norris #include <linux/rtc.h>
23c4f07eceSBrian Norris #include <linux/stat.h>
24c4f07eceSBrian Norris #include <linux/suspend.h>
25c4f07eceSBrian Norris
26c4f07eceSBrian Norris struct brcmstb_waketmr {
27c4f07eceSBrian Norris struct rtc_device *rtc;
28c4f07eceSBrian Norris struct device *dev;
29c4f07eceSBrian Norris void __iomem *base;
30eae258edSDoug Berger unsigned int wake_irq;
3124304a87SDoug Berger unsigned int alarm_irq;
32c4f07eceSBrian Norris struct notifier_block reboot_notifier;
33c4f07eceSBrian Norris struct clk *clk;
34c4f07eceSBrian Norris u32 rate;
35516ae02cSDoug Berger unsigned long rtc_alarm;
36516ae02cSDoug Berger bool alarm_en;
37*e5a8fc34SDoug Berger bool alarm_expired;
38c4f07eceSBrian Norris };
39c4f07eceSBrian Norris
40c4f07eceSBrian Norris #define BRCMSTB_WKTMR_EVENT 0x00
4190226f6bSDoug Berger #define WKTMR_ALARM_EVENT BIT(0)
42c4f07eceSBrian Norris #define BRCMSTB_WKTMR_COUNTER 0x04
43c4f07eceSBrian Norris #define BRCMSTB_WKTMR_ALARM 0x08
44c4f07eceSBrian Norris #define BRCMSTB_WKTMR_PRESCALER 0x0C
45c4f07eceSBrian Norris #define BRCMSTB_WKTMR_PRESCALER_VAL 0x10
46c4f07eceSBrian Norris
47c4f07eceSBrian Norris #define BRCMSTB_WKTMR_DEFAULT_FREQ 27000000
48c4f07eceSBrian Norris
brcmstb_waketmr_is_pending(struct brcmstb_waketmr * timer)4990226f6bSDoug Berger static inline bool brcmstb_waketmr_is_pending(struct brcmstb_waketmr *timer)
5090226f6bSDoug Berger {
5190226f6bSDoug Berger u32 reg;
5290226f6bSDoug Berger
5390226f6bSDoug Berger reg = readl_relaxed(timer->base + BRCMSTB_WKTMR_EVENT);
5490226f6bSDoug Berger return !!(reg & WKTMR_ALARM_EVENT);
5590226f6bSDoug Berger }
5690226f6bSDoug Berger
brcmstb_waketmr_clear_alarm(struct brcmstb_waketmr * timer)57c4f07eceSBrian Norris static inline void brcmstb_waketmr_clear_alarm(struct brcmstb_waketmr *timer)
58c4f07eceSBrian Norris {
59516ae02cSDoug Berger u32 reg;
60516ae02cSDoug Berger
6124304a87SDoug Berger if (timer->alarm_en && timer->alarm_irq)
6224304a87SDoug Berger disable_irq(timer->alarm_irq);
63516ae02cSDoug Berger timer->alarm_en = false;
64516ae02cSDoug Berger reg = readl_relaxed(timer->base + BRCMSTB_WKTMR_COUNTER);
65516ae02cSDoug Berger writel_relaxed(reg - 1, timer->base + BRCMSTB_WKTMR_ALARM);
6690226f6bSDoug Berger writel_relaxed(WKTMR_ALARM_EVENT, timer->base + BRCMSTB_WKTMR_EVENT);
67c4f07eceSBrian Norris (void)readl_relaxed(timer->base + BRCMSTB_WKTMR_EVENT);
68*e5a8fc34SDoug Berger if (timer->alarm_expired) {
69*e5a8fc34SDoug Berger timer->alarm_expired = false;
70*e5a8fc34SDoug Berger /* maintain call balance */
71*e5a8fc34SDoug Berger enable_irq(timer->alarm_irq);
72*e5a8fc34SDoug Berger }
73c4f07eceSBrian Norris }
74c4f07eceSBrian Norris
brcmstb_waketmr_set_alarm(struct brcmstb_waketmr * timer,unsigned int secs)75c4f07eceSBrian Norris static void brcmstb_waketmr_set_alarm(struct brcmstb_waketmr *timer,
76c4f07eceSBrian Norris unsigned int secs)
77c4f07eceSBrian Norris {
78516ae02cSDoug Berger unsigned int now;
79516ae02cSDoug Berger
80c4f07eceSBrian Norris brcmstb_waketmr_clear_alarm(timer);
81c4f07eceSBrian Norris
8258d3d5e7SJustin Chen /* Make sure we are actually counting in seconds */
8358d3d5e7SJustin Chen writel_relaxed(timer->rate, timer->base + BRCMSTB_WKTMR_PRESCALER);
8458d3d5e7SJustin Chen
85516ae02cSDoug Berger writel_relaxed(secs, timer->base + BRCMSTB_WKTMR_ALARM);
86516ae02cSDoug Berger now = readl_relaxed(timer->base + BRCMSTB_WKTMR_COUNTER);
87516ae02cSDoug Berger
88516ae02cSDoug Berger while ((int)(secs - now) <= 0 &&
89516ae02cSDoug Berger !brcmstb_waketmr_is_pending(timer)) {
90516ae02cSDoug Berger secs = now + 1;
91516ae02cSDoug Berger writel_relaxed(secs, timer->base + BRCMSTB_WKTMR_ALARM);
92516ae02cSDoug Berger now = readl_relaxed(timer->base + BRCMSTB_WKTMR_COUNTER);
93516ae02cSDoug Berger }
94c4f07eceSBrian Norris }
95c4f07eceSBrian Norris
brcmstb_waketmr_irq(int irq,void * data)96c4f07eceSBrian Norris static irqreturn_t brcmstb_waketmr_irq(int irq, void *data)
97c4f07eceSBrian Norris {
98c4f07eceSBrian Norris struct brcmstb_waketmr *timer = data;
99c4f07eceSBrian Norris
10024304a87SDoug Berger if (!timer->alarm_irq)
101c4f07eceSBrian Norris pm_wakeup_event(timer->dev, 0);
10224304a87SDoug Berger return IRQ_HANDLED;
10324304a87SDoug Berger }
10424304a87SDoug Berger
brcmstb_alarm_irq(int irq,void * data)10524304a87SDoug Berger static irqreturn_t brcmstb_alarm_irq(int irq, void *data)
10624304a87SDoug Berger {
10724304a87SDoug Berger struct brcmstb_waketmr *timer = data;
10824304a87SDoug Berger
10924304a87SDoug Berger /* Ignore spurious interrupts */
11024304a87SDoug Berger if (!brcmstb_waketmr_is_pending(timer))
11124304a87SDoug Berger return IRQ_HANDLED;
11224304a87SDoug Berger
11324304a87SDoug Berger if (timer->alarm_en) {
114*e5a8fc34SDoug Berger if (device_may_wakeup(timer->dev)) {
115*e5a8fc34SDoug Berger disable_irq_nosync(irq);
116*e5a8fc34SDoug Berger timer->alarm_expired = true;
117*e5a8fc34SDoug Berger } else {
11824304a87SDoug Berger writel_relaxed(WKTMR_ALARM_EVENT,
11924304a87SDoug Berger timer->base + BRCMSTB_WKTMR_EVENT);
120*e5a8fc34SDoug Berger }
12124304a87SDoug Berger rtc_update_irq(timer->rtc, 1, RTC_IRQF | RTC_AF);
122*e5a8fc34SDoug Berger } else {
123*e5a8fc34SDoug Berger writel_relaxed(WKTMR_ALARM_EVENT,
124*e5a8fc34SDoug Berger timer->base + BRCMSTB_WKTMR_EVENT);
12524304a87SDoug Berger }
126c4f07eceSBrian Norris
127c4f07eceSBrian Norris return IRQ_HANDLED;
128c4f07eceSBrian Norris }
129c4f07eceSBrian Norris
130c4f07eceSBrian Norris struct wktmr_time {
131c4f07eceSBrian Norris u32 sec;
132c4f07eceSBrian Norris u32 pre;
133c4f07eceSBrian Norris };
134c4f07eceSBrian Norris
wktmr_read(struct brcmstb_waketmr * timer,struct wktmr_time * t)135c4f07eceSBrian Norris static void wktmr_read(struct brcmstb_waketmr *timer,
136c4f07eceSBrian Norris struct wktmr_time *t)
137c4f07eceSBrian Norris {
138c4f07eceSBrian Norris u32 tmp;
139c4f07eceSBrian Norris
140c4f07eceSBrian Norris do {
141c4f07eceSBrian Norris t->sec = readl_relaxed(timer->base + BRCMSTB_WKTMR_COUNTER);
142c4f07eceSBrian Norris tmp = readl_relaxed(timer->base + BRCMSTB_WKTMR_PRESCALER_VAL);
143c4f07eceSBrian Norris } while (tmp >= timer->rate);
144c4f07eceSBrian Norris
145c4f07eceSBrian Norris t->pre = timer->rate - tmp;
146c4f07eceSBrian Norris }
147c4f07eceSBrian Norris
brcmstb_waketmr_prepare_suspend(struct brcmstb_waketmr * timer)148c4f07eceSBrian Norris static int brcmstb_waketmr_prepare_suspend(struct brcmstb_waketmr *timer)
149c4f07eceSBrian Norris {
150c4f07eceSBrian Norris struct device *dev = timer->dev;
15124304a87SDoug Berger int ret;
152c4f07eceSBrian Norris
153c4f07eceSBrian Norris if (device_may_wakeup(dev)) {
154eae258edSDoug Berger ret = enable_irq_wake(timer->wake_irq);
155c4f07eceSBrian Norris if (ret) {
156c4f07eceSBrian Norris dev_err(dev, "failed to enable wake-up interrupt\n");
157c4f07eceSBrian Norris return ret;
158c4f07eceSBrian Norris }
15924304a87SDoug Berger if (timer->alarm_en && timer->alarm_irq) {
16024304a87SDoug Berger ret = enable_irq_wake(timer->alarm_irq);
16124304a87SDoug Berger if (ret) {
16224304a87SDoug Berger dev_err(dev, "failed to enable rtc interrupt\n");
16324304a87SDoug Berger disable_irq_wake(timer->wake_irq);
16424304a87SDoug Berger return ret;
16524304a87SDoug Berger }
16624304a87SDoug Berger }
167c4f07eceSBrian Norris }
168c4f07eceSBrian Norris
16924304a87SDoug Berger return 0;
170c4f07eceSBrian Norris }
171c4f07eceSBrian Norris
172c4f07eceSBrian Norris /* If enabled as a wakeup-source, arm the timer when powering off */
brcmstb_waketmr_reboot(struct notifier_block * nb,unsigned long action,void * data)173c4f07eceSBrian Norris static int brcmstb_waketmr_reboot(struct notifier_block *nb,
174c4f07eceSBrian Norris unsigned long action, void *data)
175c4f07eceSBrian Norris {
176c4f07eceSBrian Norris struct brcmstb_waketmr *timer;
177c4f07eceSBrian Norris
178c4f07eceSBrian Norris timer = container_of(nb, struct brcmstb_waketmr, reboot_notifier);
179c4f07eceSBrian Norris
180c4f07eceSBrian Norris /* Set timer for cold boot */
181c4f07eceSBrian Norris if (action == SYS_POWER_OFF)
182c4f07eceSBrian Norris brcmstb_waketmr_prepare_suspend(timer);
183c4f07eceSBrian Norris
184c4f07eceSBrian Norris return NOTIFY_DONE;
185c4f07eceSBrian Norris }
186c4f07eceSBrian Norris
brcmstb_waketmr_gettime(struct device * dev,struct rtc_time * tm)187c4f07eceSBrian Norris static int brcmstb_waketmr_gettime(struct device *dev,
188c4f07eceSBrian Norris struct rtc_time *tm)
189c4f07eceSBrian Norris {
190c4f07eceSBrian Norris struct brcmstb_waketmr *timer = dev_get_drvdata(dev);
191c4f07eceSBrian Norris struct wktmr_time now;
192c4f07eceSBrian Norris
193c4f07eceSBrian Norris wktmr_read(timer, &now);
194c4f07eceSBrian Norris
1959a8f2d12SAlexandre Belloni rtc_time64_to_tm(now.sec, tm);
196c4f07eceSBrian Norris
197c4f07eceSBrian Norris return 0;
198c4f07eceSBrian Norris }
199c4f07eceSBrian Norris
brcmstb_waketmr_settime(struct device * dev,struct rtc_time * tm)200c4f07eceSBrian Norris static int brcmstb_waketmr_settime(struct device *dev,
201c4f07eceSBrian Norris struct rtc_time *tm)
202c4f07eceSBrian Norris {
203c4f07eceSBrian Norris struct brcmstb_waketmr *timer = dev_get_drvdata(dev);
204c4f07eceSBrian Norris time64_t sec;
205c4f07eceSBrian Norris
206c4f07eceSBrian Norris sec = rtc_tm_to_time64(tm);
207c4f07eceSBrian Norris
208c4f07eceSBrian Norris writel_relaxed(sec, timer->base + BRCMSTB_WKTMR_COUNTER);
209c4f07eceSBrian Norris
210c4f07eceSBrian Norris return 0;
211c4f07eceSBrian Norris }
212c4f07eceSBrian Norris
brcmstb_waketmr_getalarm(struct device * dev,struct rtc_wkalrm * alarm)213c4f07eceSBrian Norris static int brcmstb_waketmr_getalarm(struct device *dev,
214c4f07eceSBrian Norris struct rtc_wkalrm *alarm)
215c4f07eceSBrian Norris {
216c4f07eceSBrian Norris struct brcmstb_waketmr *timer = dev_get_drvdata(dev);
217c4f07eceSBrian Norris
218516ae02cSDoug Berger alarm->enabled = timer->alarm_en;
219516ae02cSDoug Berger rtc_time64_to_tm(timer->rtc_alarm, &alarm->time);
220c4f07eceSBrian Norris
22190226f6bSDoug Berger alarm->pending = brcmstb_waketmr_is_pending(timer);
222c4f07eceSBrian Norris
223c4f07eceSBrian Norris return 0;
224c4f07eceSBrian Norris }
225c4f07eceSBrian Norris
brcmstb_waketmr_alarm_enable(struct device * dev,unsigned int enabled)2262cd98b22SDoug Berger static int brcmstb_waketmr_alarm_enable(struct device *dev,
2272cd98b22SDoug Berger unsigned int enabled)
2282cd98b22SDoug Berger {
229516ae02cSDoug Berger struct brcmstb_waketmr *timer = dev_get_drvdata(dev);
230516ae02cSDoug Berger
231516ae02cSDoug Berger if (enabled && !timer->alarm_en) {
232516ae02cSDoug Berger if ((int)(readl_relaxed(timer->base + BRCMSTB_WKTMR_COUNTER) -
233516ae02cSDoug Berger readl_relaxed(timer->base + BRCMSTB_WKTMR_ALARM)) >= 0 &&
234516ae02cSDoug Berger !brcmstb_waketmr_is_pending(timer))
235516ae02cSDoug Berger return -EINVAL;
236516ae02cSDoug Berger timer->alarm_en = true;
237*e5a8fc34SDoug Berger if (timer->alarm_irq) {
238*e5a8fc34SDoug Berger if (timer->alarm_expired) {
239*e5a8fc34SDoug Berger timer->alarm_expired = false;
240*e5a8fc34SDoug Berger /* maintain call balance */
24124304a87SDoug Berger enable_irq(timer->alarm_irq);
242*e5a8fc34SDoug Berger }
243*e5a8fc34SDoug Berger enable_irq(timer->alarm_irq);
244*e5a8fc34SDoug Berger }
245516ae02cSDoug Berger } else if (!enabled && timer->alarm_en) {
24624304a87SDoug Berger if (timer->alarm_irq)
24724304a87SDoug Berger disable_irq(timer->alarm_irq);
248516ae02cSDoug Berger timer->alarm_en = false;
249516ae02cSDoug Berger }
250516ae02cSDoug Berger
2512cd98b22SDoug Berger return 0;
2522cd98b22SDoug Berger }
2532cd98b22SDoug Berger
brcmstb_waketmr_setalarm(struct device * dev,struct rtc_wkalrm * alarm)254c4f07eceSBrian Norris static int brcmstb_waketmr_setalarm(struct device *dev,
255c4f07eceSBrian Norris struct rtc_wkalrm *alarm)
256c4f07eceSBrian Norris {
257c4f07eceSBrian Norris struct brcmstb_waketmr *timer = dev_get_drvdata(dev);
258c4f07eceSBrian Norris
259516ae02cSDoug Berger timer->rtc_alarm = rtc_tm_to_time64(&alarm->time);
260c4f07eceSBrian Norris
261516ae02cSDoug Berger brcmstb_waketmr_set_alarm(timer, timer->rtc_alarm);
262c4f07eceSBrian Norris
2632cd98b22SDoug Berger return brcmstb_waketmr_alarm_enable(dev, alarm->enabled);
264c4f07eceSBrian Norris }
265c4f07eceSBrian Norris
266c4f07eceSBrian Norris static const struct rtc_class_ops brcmstb_waketmr_ops = {
267c4f07eceSBrian Norris .read_time = brcmstb_waketmr_gettime,
268c4f07eceSBrian Norris .set_time = brcmstb_waketmr_settime,
269c4f07eceSBrian Norris .read_alarm = brcmstb_waketmr_getalarm,
270c4f07eceSBrian Norris .set_alarm = brcmstb_waketmr_setalarm,
271c4f07eceSBrian Norris .alarm_irq_enable = brcmstb_waketmr_alarm_enable,
272c4f07eceSBrian Norris };
273c4f07eceSBrian Norris
brcmstb_waketmr_probe(struct platform_device * pdev)274c4f07eceSBrian Norris static int brcmstb_waketmr_probe(struct platform_device *pdev)
275c4f07eceSBrian Norris {
276c4f07eceSBrian Norris struct device *dev = &pdev->dev;
277c4f07eceSBrian Norris struct brcmstb_waketmr *timer;
278c4f07eceSBrian Norris int ret;
279c4f07eceSBrian Norris
280c4f07eceSBrian Norris timer = devm_kzalloc(dev, sizeof(*timer), GFP_KERNEL);
281c4f07eceSBrian Norris if (!timer)
282c4f07eceSBrian Norris return -ENOMEM;
283c4f07eceSBrian Norris
284c4f07eceSBrian Norris platform_set_drvdata(pdev, timer);
285c4f07eceSBrian Norris timer->dev = dev;
286c4f07eceSBrian Norris
28709ef18bcSYueHaibing timer->base = devm_platform_ioremap_resource(pdev, 0);
288c4f07eceSBrian Norris if (IS_ERR(timer->base))
289c4f07eceSBrian Norris return PTR_ERR(timer->base);
290c4f07eceSBrian Norris
2912abf286aSAlexandre Belloni timer->rtc = devm_rtc_allocate_device(dev);
2922abf286aSAlexandre Belloni if (IS_ERR(timer->rtc))
2932abf286aSAlexandre Belloni return PTR_ERR(timer->rtc);
2942abf286aSAlexandre Belloni
295c4f07eceSBrian Norris /*
296c4f07eceSBrian Norris * Set wakeup capability before requesting wakeup interrupt, so we can
297c4f07eceSBrian Norris * process boot-time "wakeups" (e.g., from S5 soft-off)
298c4f07eceSBrian Norris */
2992cd98b22SDoug Berger device_init_wakeup(dev, true);
300c4f07eceSBrian Norris
301eae258edSDoug Berger ret = platform_get_irq(pdev, 0);
302eae258edSDoug Berger if (ret < 0)
303c4f07eceSBrian Norris return -ENODEV;
304eae258edSDoug Berger timer->wake_irq = (unsigned int)ret;
305c4f07eceSBrian Norris
306c4f07eceSBrian Norris timer->clk = devm_clk_get(dev, NULL);
307c4f07eceSBrian Norris if (!IS_ERR(timer->clk)) {
308c4f07eceSBrian Norris ret = clk_prepare_enable(timer->clk);
309c4f07eceSBrian Norris if (ret)
310c4f07eceSBrian Norris return ret;
311c4f07eceSBrian Norris timer->rate = clk_get_rate(timer->clk);
312c4f07eceSBrian Norris if (!timer->rate)
313c4f07eceSBrian Norris timer->rate = BRCMSTB_WKTMR_DEFAULT_FREQ;
314c4f07eceSBrian Norris } else {
315c4f07eceSBrian Norris timer->rate = BRCMSTB_WKTMR_DEFAULT_FREQ;
316c4f07eceSBrian Norris timer->clk = NULL;
317c4f07eceSBrian Norris }
318c4f07eceSBrian Norris
319eae258edSDoug Berger ret = devm_request_irq(dev, timer->wake_irq, brcmstb_waketmr_irq, 0,
320c4f07eceSBrian Norris "brcmstb-waketimer", timer);
321c4f07eceSBrian Norris if (ret < 0)
322f2eef045SAlexey Khoroshilov goto err_clk;
323c4f07eceSBrian Norris
32424304a87SDoug Berger brcmstb_waketmr_clear_alarm(timer);
32524304a87SDoug Berger
32624304a87SDoug Berger /* Attempt to initialize non-wake irq */
32724304a87SDoug Berger ret = platform_get_irq(pdev, 1);
32824304a87SDoug Berger if (ret > 0) {
32924304a87SDoug Berger timer->alarm_irq = (unsigned int)ret;
33024304a87SDoug Berger ret = devm_request_irq(dev, timer->alarm_irq, brcmstb_alarm_irq,
33124304a87SDoug Berger IRQF_NO_AUTOEN, "brcmstb-waketimer-rtc",
33224304a87SDoug Berger timer);
33324304a87SDoug Berger if (ret < 0)
33424304a87SDoug Berger timer->alarm_irq = 0;
33524304a87SDoug Berger }
33624304a87SDoug Berger
337c4f07eceSBrian Norris timer->reboot_notifier.notifier_call = brcmstb_waketmr_reboot;
338c4f07eceSBrian Norris register_reboot_notifier(&timer->reboot_notifier);
339c4f07eceSBrian Norris
3402abf286aSAlexandre Belloni timer->rtc->ops = &brcmstb_waketmr_ops;
341ded67666SAlexandre Belloni timer->rtc->range_max = U32_MAX;
3422abf286aSAlexandre Belloni
343fdcfd854SBartosz Golaszewski ret = devm_rtc_register_device(timer->rtc);
34444c638ceSAlexandre Belloni if (ret)
345f2eef045SAlexey Khoroshilov goto err_notifier;
346c4f07eceSBrian Norris
347f2eef045SAlexey Khoroshilov return 0;
348f2eef045SAlexey Khoroshilov
349f2eef045SAlexey Khoroshilov err_notifier:
350f2eef045SAlexey Khoroshilov unregister_reboot_notifier(&timer->reboot_notifier);
351f2eef045SAlexey Khoroshilov
352f2eef045SAlexey Khoroshilov err_clk:
353f2eef045SAlexey Khoroshilov clk_disable_unprepare(timer->clk);
354f2eef045SAlexey Khoroshilov
355c4f07eceSBrian Norris return ret;
356c4f07eceSBrian Norris }
357c4f07eceSBrian Norris
brcmstb_waketmr_remove(struct platform_device * pdev)358d64906b3SUwe Kleine-König static void brcmstb_waketmr_remove(struct platform_device *pdev)
359c4f07eceSBrian Norris {
360c4f07eceSBrian Norris struct brcmstb_waketmr *timer = dev_get_drvdata(&pdev->dev);
361c4f07eceSBrian Norris
362c4f07eceSBrian Norris unregister_reboot_notifier(&timer->reboot_notifier);
36394303f89SChuhong Yuan clk_disable_unprepare(timer->clk);
364c4f07eceSBrian Norris }
365c4f07eceSBrian Norris
366c4f07eceSBrian Norris #ifdef CONFIG_PM_SLEEP
brcmstb_waketmr_suspend(struct device * dev)367c4f07eceSBrian Norris static int brcmstb_waketmr_suspend(struct device *dev)
368c4f07eceSBrian Norris {
369c4f07eceSBrian Norris struct brcmstb_waketmr *timer = dev_get_drvdata(dev);
370c4f07eceSBrian Norris
371c4f07eceSBrian Norris return brcmstb_waketmr_prepare_suspend(timer);
372c4f07eceSBrian Norris }
373c4f07eceSBrian Norris
brcmstb_waketmr_suspend_noirq(struct device * dev)374*e5a8fc34SDoug Berger static int brcmstb_waketmr_suspend_noirq(struct device *dev)
375*e5a8fc34SDoug Berger {
376*e5a8fc34SDoug Berger struct brcmstb_waketmr *timer = dev_get_drvdata(dev);
377*e5a8fc34SDoug Berger
378*e5a8fc34SDoug Berger /* Catch any alarms occurring prior to noirq */
379*e5a8fc34SDoug Berger if (timer->alarm_expired && device_may_wakeup(dev))
380*e5a8fc34SDoug Berger return -EBUSY;
381*e5a8fc34SDoug Berger
382*e5a8fc34SDoug Berger return 0;
383*e5a8fc34SDoug Berger }
384*e5a8fc34SDoug Berger
brcmstb_waketmr_resume(struct device * dev)385c4f07eceSBrian Norris static int brcmstb_waketmr_resume(struct device *dev)
386c4f07eceSBrian Norris {
387c4f07eceSBrian Norris struct brcmstb_waketmr *timer = dev_get_drvdata(dev);
388c4f07eceSBrian Norris int ret;
389c4f07eceSBrian Norris
390c4f07eceSBrian Norris if (!device_may_wakeup(dev))
391c4f07eceSBrian Norris return 0;
392c4f07eceSBrian Norris
393eae258edSDoug Berger ret = disable_irq_wake(timer->wake_irq);
39424304a87SDoug Berger if (timer->alarm_en && timer->alarm_irq)
39524304a87SDoug Berger disable_irq_wake(timer->alarm_irq);
396c4f07eceSBrian Norris
397c4f07eceSBrian Norris brcmstb_waketmr_clear_alarm(timer);
398c4f07eceSBrian Norris
399c4f07eceSBrian Norris return ret;
400c4f07eceSBrian Norris }
401*e5a8fc34SDoug Berger #else
402*e5a8fc34SDoug Berger #define brcmstb_waketmr_suspend NULL
403*e5a8fc34SDoug Berger #define brcmstb_waketmr_suspend_noirq NULL
404*e5a8fc34SDoug Berger #define brcmstb_waketmr_resume NULL
405c4f07eceSBrian Norris #endif /* CONFIG_PM_SLEEP */
406c4f07eceSBrian Norris
407*e5a8fc34SDoug Berger static const struct dev_pm_ops brcmstb_waketmr_pm_ops = {
408*e5a8fc34SDoug Berger .suspend = brcmstb_waketmr_suspend,
409*e5a8fc34SDoug Berger .suspend_noirq = brcmstb_waketmr_suspend_noirq,
410*e5a8fc34SDoug Berger .resume = brcmstb_waketmr_resume,
411*e5a8fc34SDoug Berger };
412c4f07eceSBrian Norris
413ae1247f7SAlexandre Belloni static const __maybe_unused struct of_device_id brcmstb_waketmr_of_match[] = {
414c4f07eceSBrian Norris { .compatible = "brcm,brcmstb-waketimer" },
415c4f07eceSBrian Norris { /* sentinel */ },
416c4f07eceSBrian Norris };
417c4f07eceSBrian Norris
418c4f07eceSBrian Norris static struct platform_driver brcmstb_waketmr_driver = {
419c4f07eceSBrian Norris .probe = brcmstb_waketmr_probe,
420d64906b3SUwe Kleine-König .remove_new = brcmstb_waketmr_remove,
421c4f07eceSBrian Norris .driver = {
422c4f07eceSBrian Norris .name = "brcmstb-waketimer",
423c4f07eceSBrian Norris .pm = &brcmstb_waketmr_pm_ops,
424c4f07eceSBrian Norris .of_match_table = of_match_ptr(brcmstb_waketmr_of_match),
425c4f07eceSBrian Norris }
426c4f07eceSBrian Norris };
427c4f07eceSBrian Norris module_platform_driver(brcmstb_waketmr_driver);
428c4f07eceSBrian Norris
429c4f07eceSBrian Norris MODULE_LICENSE("GPL v2");
430c4f07eceSBrian Norris MODULE_AUTHOR("Brian Norris");
431c4f07eceSBrian Norris MODULE_AUTHOR("Markus Mayer");
43224304a87SDoug Berger MODULE_AUTHOR("Doug Berger");
433c4f07eceSBrian Norris MODULE_DESCRIPTION("Wake-up timer driver for STB chips");
434