Commit | Line | Data |
---|---|---|
c7080e20 | 1 | // SPDX-License-Identifier: GPL-2.0 |
a95579cd AZ |
2 | /* |
3 | * An RTC test device/driver | |
4 | * Copyright (C) 2005 Tower Technologies | |
5 | * Author: Alessandro Zummo <a.zummo@towertech.it> | |
a95579cd AZ |
6 | */ |
7 | ||
8 | #include <linux/module.h> | |
9 | #include <linux/err.h> | |
10 | #include <linux/rtc.h> | |
11 | #include <linux/platform_device.h> | |
12 | ||
5b257571 AB |
13 | #define MAX_RTC_TEST 3 |
14 | ||
4dc2403b AB |
15 | struct rtc_test_data { |
16 | struct rtc_device *rtc; | |
17 | time64_t offset; | |
8be09029 AB |
18 | struct timer_list alarm; |
19 | bool alarm_en; | |
4dc2403b AB |
20 | }; |
21 | ||
2b4f07e9 | 22 | static struct platform_device *pdev[MAX_RTC_TEST]; |
a95579cd | 23 | |
8be09029 | 24 | static int test_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm) |
a95579cd | 25 | { |
8be09029 AB |
26 | struct rtc_test_data *rtd = dev_get_drvdata(dev); |
27 | time64_t alarm; | |
28 | ||
29 | alarm = (rtd->alarm.expires - jiffies) / HZ; | |
30 | alarm += ktime_get_real_seconds() + rtd->offset; | |
31 | ||
32 | rtc_time64_to_tm(alarm, &alrm->time); | |
33 | alrm->enabled = rtd->alarm_en; | |
34 | ||
a95579cd AZ |
35 | return 0; |
36 | } | |
37 | ||
8be09029 | 38 | static int test_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm) |
a95579cd | 39 | { |
8be09029 AB |
40 | struct rtc_test_data *rtd = dev_get_drvdata(dev); |
41 | ktime_t timeout; | |
42 | u64 expires; | |
43 | ||
44 | timeout = rtc_tm_to_time64(&alrm->time) - ktime_get_real_seconds(); | |
45 | timeout -= rtd->offset; | |
46 | ||
47 | del_timer(&rtd->alarm); | |
48 | ||
49 | expires = jiffies + timeout * HZ; | |
50 | if (expires > U32_MAX) | |
51 | expires = U32_MAX; | |
52 | ||
8be09029 AB |
53 | rtd->alarm.expires = expires; |
54 | ||
55 | if (alrm->enabled) | |
56 | add_timer(&rtd->alarm); | |
57 | ||
58 | rtd->alarm_en = alrm->enabled; | |
59 | ||
a95579cd AZ |
60 | return 0; |
61 | } | |
62 | ||
4dc2403b | 63 | static int test_rtc_read_time(struct device *dev, struct rtc_time *tm) |
a95579cd | 64 | { |
4dc2403b AB |
65 | struct rtc_test_data *rtd = dev_get_drvdata(dev); |
66 | ||
67 | rtc_time64_to_tm(ktime_get_real_seconds() + rtd->offset, tm); | |
68 | ||
4d644ab8 XP |
69 | return 0; |
70 | } | |
71 | ||
43dae505 | 72 | static int test_rtc_set_time(struct device *dev, struct rtc_time *tm) |
4d644ab8 | 73 | { |
4dc2403b AB |
74 | struct rtc_test_data *rtd = dev_get_drvdata(dev); |
75 | ||
43dae505 | 76 | rtd->offset = rtc_tm_to_time64(tm) - ktime_get_real_seconds(); |
4dc2403b | 77 | |
a95579cd AZ |
78 | return 0; |
79 | } | |
80 | ||
16380c15 | 81 | static int test_rtc_alarm_irq_enable(struct device *dev, unsigned int enable) |
a95579cd | 82 | { |
8be09029 AB |
83 | struct rtc_test_data *rtd = dev_get_drvdata(dev); |
84 | ||
85 | rtd->alarm_en = enable; | |
86 | if (enable) | |
87 | add_timer(&rtd->alarm); | |
88 | else | |
89 | del_timer(&rtd->alarm); | |
90 | ||
16380c15 | 91 | return 0; |
a95579cd AZ |
92 | } |
93 | ||
1928906d AB |
94 | static const struct rtc_class_ops test_rtc_ops_noalm = { |
95 | .read_time = test_rtc_read_time, | |
43dae505 | 96 | .set_time = test_rtc_set_time, |
1928906d AB |
97 | .alarm_irq_enable = test_rtc_alarm_irq_enable, |
98 | }; | |
99 | ||
78417682 | 100 | static const struct rtc_class_ops test_rtc_ops = { |
a95579cd | 101 | .read_time = test_rtc_read_time, |
43dae505 | 102 | .set_time = test_rtc_set_time, |
a95579cd AZ |
103 | .read_alarm = test_rtc_read_alarm, |
104 | .set_alarm = test_rtc_set_alarm, | |
16380c15 | 105 | .alarm_irq_enable = test_rtc_alarm_irq_enable, |
a95579cd AZ |
106 | }; |
107 | ||
8be09029 AB |
108 | static void test_rtc_alarm_handler(struct timer_list *t) |
109 | { | |
110 | struct rtc_test_data *rtd = from_timer(rtd, t, alarm); | |
111 | ||
112 | rtc_update_irq(rtd->rtc, 1, RTC_AF | RTC_IRQF); | |
113 | } | |
114 | ||
a95579cd AZ |
115 | static int test_probe(struct platform_device *plat_dev) |
116 | { | |
4dc2403b | 117 | struct rtc_test_data *rtd; |
dd8d8137 | 118 | |
4dc2403b AB |
119 | rtd = devm_kzalloc(&plat_dev->dev, sizeof(*rtd), GFP_KERNEL); |
120 | if (!rtd) | |
121 | return -ENOMEM; | |
91046a8a | 122 | |
4dc2403b | 123 | platform_set_drvdata(plat_dev, rtd); |
a95579cd | 124 | |
0b472ad2 | 125 | rtd->rtc = devm_rtc_allocate_device(&plat_dev->dev); |
4dc2403b AB |
126 | if (IS_ERR(rtd->rtc)) |
127 | return PTR_ERR(rtd->rtc); | |
a95579cd | 128 | |
1928906d AB |
129 | switch (plat_dev->id) { |
130 | case 0: | |
131 | rtd->rtc->ops = &test_rtc_ops_noalm; | |
132 | break; | |
133 | default: | |
134 | rtd->rtc->ops = &test_rtc_ops; | |
c19623db | 135 | device_init_wakeup(&plat_dev->dev, 1); |
1928906d | 136 | } |
0b472ad2 | 137 | |
8be09029 AB |
138 | timer_setup(&rtd->alarm, test_rtc_alarm_handler, 0); |
139 | rtd->alarm.expires = 0; | |
140 | ||
fdcfd854 | 141 | return devm_rtc_register_device(rtd->rtc); |
a95579cd AZ |
142 | } |
143 | ||
c4646528 | 144 | static struct platform_driver test_driver = { |
a95579cd | 145 | .probe = test_probe, |
a95579cd AZ |
146 | .driver = { |
147 | .name = "rtc-test", | |
a95579cd AZ |
148 | }, |
149 | }; | |
150 | ||
151 | static int __init test_init(void) | |
152 | { | |
5b257571 | 153 | int i, err; |
a95579cd | 154 | |
540a11d8 AB |
155 | err = platform_driver_register(&test_driver); |
156 | if (err) | |
a95579cd AZ |
157 | return err; |
158 | ||
5b257571 AB |
159 | err = -ENOMEM; |
160 | for (i = 0; i < MAX_RTC_TEST; i++) { | |
161 | pdev[i] = platform_device_alloc("rtc-test", i); | |
162 | if (!pdev[i]) | |
163 | goto exit_free_mem; | |
a95579cd AZ |
164 | } |
165 | ||
5b257571 AB |
166 | for (i = 0; i < MAX_RTC_TEST; i++) { |
167 | err = platform_device_add(pdev[i]); | |
168 | if (err) | |
169 | goto exit_device_del; | |
a95579cd AZ |
170 | } |
171 | ||
a95579cd AZ |
172 | return 0; |
173 | ||
5b257571 AB |
174 | exit_device_del: |
175 | for (; i > 0; i--) | |
176 | platform_device_del(pdev[i - 1]); | |
a95579cd | 177 | |
5b257571 AB |
178 | exit_free_mem: |
179 | for (i = 0; i < MAX_RTC_TEST; i++) | |
180 | platform_device_put(pdev[i]); | |
a95579cd | 181 | |
c4646528 | 182 | platform_driver_unregister(&test_driver); |
a95579cd AZ |
183 | return err; |
184 | } | |
185 | ||
186 | static void __exit test_exit(void) | |
187 | { | |
5b257571 AB |
188 | int i; |
189 | ||
190 | for (i = 0; i < MAX_RTC_TEST; i++) | |
191 | platform_device_unregister(pdev[i]); | |
192 | ||
c4646528 | 193 | platform_driver_unregister(&test_driver); |
a95579cd AZ |
194 | } |
195 | ||
196 | MODULE_AUTHOR("Alessandro Zummo <a.zummo@towertech.it>"); | |
197 | MODULE_DESCRIPTION("RTC test driver/device"); | |
fd13c930 | 198 | MODULE_LICENSE("GPL v2"); |
a95579cd AZ |
199 | |
200 | module_init(test_init); | |
201 | module_exit(test_exit); |