1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (C) 2019 BayLibre, SAS
4 * Author: Neil Armstrong <narmstrong@baylibre.com>
5 * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
6 */
7 #include <linux/module.h>
8 #include <linux/platform_device.h>
9 #include <linux/rtc.h>
10 #include <linux/io.h>
11 #include <linux/of.h>
12 #include <linux/time64.h>
13
14 struct meson_vrtc_data {
15 void __iomem *io_alarm;
16 unsigned long alarm_time;
17 bool enabled;
18 };
19
meson_vrtc_read_time(struct device * dev,struct rtc_time * tm)20 static int meson_vrtc_read_time(struct device *dev, struct rtc_time *tm)
21 {
22 struct timespec64 time;
23
24 dev_dbg(dev, "%s\n", __func__);
25 ktime_get_real_ts64(&time);
26 rtc_time64_to_tm(time.tv_sec, tm);
27
28 return 0;
29 }
30
meson_vrtc_set_wakeup_time(struct meson_vrtc_data * vrtc,unsigned long time)31 static void meson_vrtc_set_wakeup_time(struct meson_vrtc_data *vrtc,
32 unsigned long time)
33 {
34 writel_relaxed(time, vrtc->io_alarm);
35 }
36
meson_vrtc_set_alarm(struct device * dev,struct rtc_wkalrm * alarm)37 static int meson_vrtc_set_alarm(struct device *dev, struct rtc_wkalrm *alarm)
38 {
39 struct meson_vrtc_data *vrtc = dev_get_drvdata(dev);
40
41 dev_dbg(dev, "%s: alarm->enabled=%d\n", __func__, alarm->enabled);
42 if (alarm->enabled)
43 vrtc->alarm_time = rtc_tm_to_time64(&alarm->time);
44 else
45 vrtc->alarm_time = 0;
46
47 return 0;
48 }
49
meson_vrtc_alarm_irq_enable(struct device * dev,unsigned int enabled)50 static int meson_vrtc_alarm_irq_enable(struct device *dev, unsigned int enabled)
51 {
52 struct meson_vrtc_data *vrtc = dev_get_drvdata(dev);
53
54 vrtc->enabled = enabled;
55 return 0;
56 }
57
58 static const struct rtc_class_ops meson_vrtc_ops = {
59 .read_time = meson_vrtc_read_time,
60 .set_alarm = meson_vrtc_set_alarm,
61 .alarm_irq_enable = meson_vrtc_alarm_irq_enable,
62 };
63
meson_vrtc_probe(struct platform_device * pdev)64 static int meson_vrtc_probe(struct platform_device *pdev)
65 {
66 struct meson_vrtc_data *vrtc;
67 struct rtc_device *rtc;
68
69 vrtc = devm_kzalloc(&pdev->dev, sizeof(*vrtc), GFP_KERNEL);
70 if (!vrtc)
71 return -ENOMEM;
72
73 vrtc->io_alarm = devm_platform_ioremap_resource(pdev, 0);
74 if (IS_ERR(vrtc->io_alarm))
75 return PTR_ERR(vrtc->io_alarm);
76
77 device_init_wakeup(&pdev->dev, true);
78
79 platform_set_drvdata(pdev, vrtc);
80
81 rtc = devm_rtc_allocate_device(&pdev->dev);
82 if (IS_ERR(rtc))
83 return PTR_ERR(rtc);
84
85 rtc->ops = &meson_vrtc_ops;
86 return devm_rtc_register_device(rtc);
87 }
88
meson_vrtc_suspend(struct device * dev)89 static int __maybe_unused meson_vrtc_suspend(struct device *dev)
90 {
91 struct meson_vrtc_data *vrtc = dev_get_drvdata(dev);
92
93 dev_dbg(dev, "%s\n", __func__);
94 if (vrtc->alarm_time) {
95 unsigned long local_time;
96 long alarm_secs;
97 struct timespec64 time;
98
99 ktime_get_real_ts64(&time);
100 local_time = time.tv_sec;
101
102 dev_dbg(dev, "alarm_time = %lus, local_time=%lus\n",
103 vrtc->alarm_time, local_time);
104 alarm_secs = vrtc->alarm_time - local_time;
105 if (alarm_secs > 0) {
106 meson_vrtc_set_wakeup_time(vrtc, alarm_secs);
107 dev_dbg(dev, "system will wakeup in %lds.\n",
108 alarm_secs);
109 } else {
110 dev_err(dev, "alarm time already passed: %lds.\n",
111 alarm_secs);
112 }
113 }
114
115 return 0;
116 }
117
meson_vrtc_resume(struct device * dev)118 static int __maybe_unused meson_vrtc_resume(struct device *dev)
119 {
120 struct meson_vrtc_data *vrtc = dev_get_drvdata(dev);
121
122 dev_dbg(dev, "%s\n", __func__);
123
124 vrtc->alarm_time = 0;
125 meson_vrtc_set_wakeup_time(vrtc, 0);
126 return 0;
127 }
128
129 static SIMPLE_DEV_PM_OPS(meson_vrtc_pm_ops,
130 meson_vrtc_suspend, meson_vrtc_resume);
131
132 static const struct of_device_id meson_vrtc_dt_match[] = {
133 { .compatible = "amlogic,meson-vrtc"},
134 {},
135 };
136 MODULE_DEVICE_TABLE(of, meson_vrtc_dt_match);
137
138 static struct platform_driver meson_vrtc_driver = {
139 .probe = meson_vrtc_probe,
140 .driver = {
141 .name = "meson-vrtc",
142 .of_match_table = meson_vrtc_dt_match,
143 .pm = &meson_vrtc_pm_ops,
144 },
145 };
146
147 module_platform_driver(meson_vrtc_driver);
148
149 MODULE_DESCRIPTION("Amlogic Virtual Wakeup RTC Timer driver");
150 MODULE_LICENSE("GPL");
151