Loading...
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * An RTC test device/driver
4 * Copyright (C) 2005 Tower Technologies
5 * Author: Alessandro Zummo <a.zummo@towertech.it>
6 */
7
8#include <linux/module.h>
9#include <linux/err.h>
10#include <linux/rtc.h>
11#include <linux/platform_device.h>
12
13#define MAX_RTC_TEST 3
14
15struct rtc_test_data {
16 struct rtc_device *rtc;
17 time64_t offset;
18 struct timer_list alarm;
19 bool alarm_en;
20};
21
22static struct platform_device *pdev[MAX_RTC_TEST];
23
24static int test_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm)
25{
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
35 return 0;
36}
37
38static int test_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm)
39{
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
53 rtd->alarm.expires = expires;
54
55 if (alrm->enabled)
56 add_timer(&rtd->alarm);
57
58 rtd->alarm_en = alrm->enabled;
59
60 return 0;
61}
62
63static int test_rtc_read_time(struct device *dev, struct rtc_time *tm)
64{
65 struct rtc_test_data *rtd = dev_get_drvdata(dev);
66
67 rtc_time64_to_tm(ktime_get_real_seconds() + rtd->offset, tm);
68
69 return 0;
70}
71
72static int test_rtc_set_time(struct device *dev, struct rtc_time *tm)
73{
74 struct rtc_test_data *rtd = dev_get_drvdata(dev);
75
76 rtd->offset = rtc_tm_to_time64(tm) - ktime_get_real_seconds();
77
78 return 0;
79}
80
81static int test_rtc_alarm_irq_enable(struct device *dev, unsigned int enable)
82{
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
91 return 0;
92}
93
94static const struct rtc_class_ops test_rtc_ops_noalm = {
95 .read_time = test_rtc_read_time,
96 .set_time = test_rtc_set_time,
97 .alarm_irq_enable = test_rtc_alarm_irq_enable,
98};
99
100static const struct rtc_class_ops test_rtc_ops = {
101 .read_time = test_rtc_read_time,
102 .set_time = test_rtc_set_time,
103 .read_alarm = test_rtc_read_alarm,
104 .set_alarm = test_rtc_set_alarm,
105 .alarm_irq_enable = test_rtc_alarm_irq_enable,
106};
107
108static 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
115static int test_probe(struct platform_device *plat_dev)
116{
117 struct rtc_test_data *rtd;
118
119 rtd = devm_kzalloc(&plat_dev->dev, sizeof(*rtd), GFP_KERNEL);
120 if (!rtd)
121 return -ENOMEM;
122
123 platform_set_drvdata(plat_dev, rtd);
124
125 rtd->rtc = devm_rtc_allocate_device(&plat_dev->dev);
126 if (IS_ERR(rtd->rtc))
127 return PTR_ERR(rtd->rtc);
128
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;
135 device_init_wakeup(&plat_dev->dev, 1);
136 }
137
138 timer_setup(&rtd->alarm, test_rtc_alarm_handler, 0);
139 rtd->alarm.expires = 0;
140
141 return devm_rtc_register_device(rtd->rtc);
142}
143
144static struct platform_driver test_driver = {
145 .probe = test_probe,
146 .driver = {
147 .name = "rtc-test",
148 },
149};
150
151static int __init test_init(void)
152{
153 int i, err;
154
155 err = platform_driver_register(&test_driver);
156 if (err)
157 return err;
158
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;
164 }
165
166 for (i = 0; i < MAX_RTC_TEST; i++) {
167 err = platform_device_add(pdev[i]);
168 if (err)
169 goto exit_device_del;
170 }
171
172 return 0;
173
174exit_device_del:
175 for (; i > 0; i--)
176 platform_device_del(pdev[i - 1]);
177
178exit_free_mem:
179 for (i = 0; i < MAX_RTC_TEST; i++)
180 platform_device_put(pdev[i]);
181
182 platform_driver_unregister(&test_driver);
183 return err;
184}
185
186static void __exit test_exit(void)
187{
188 int i;
189
190 for (i = 0; i < MAX_RTC_TEST; i++)
191 platform_device_unregister(pdev[i]);
192
193 platform_driver_unregister(&test_driver);
194}
195
196MODULE_AUTHOR("Alessandro Zummo <a.zummo@towertech.it>");
197MODULE_DESCRIPTION("RTC test driver/device");
198MODULE_LICENSE("GPL v2");
199
200module_init(test_init);
201module_exit(test_exit);
1/*
2 * An RTC test device/driver
3 * Copyright (C) 2005 Tower Technologies
4 * Author: Alessandro Zummo <a.zummo@towertech.it>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
10
11#include <linux/module.h>
12#include <linux/err.h>
13#include <linux/rtc.h>
14#include <linux/platform_device.h>
15
16static struct platform_device *test0 = NULL, *test1 = NULL;
17
18static int test_rtc_read_alarm(struct device *dev,
19 struct rtc_wkalrm *alrm)
20{
21 return 0;
22}
23
24static int test_rtc_set_alarm(struct device *dev,
25 struct rtc_wkalrm *alrm)
26{
27 return 0;
28}
29
30static int test_rtc_read_time(struct device *dev,
31 struct rtc_time *tm)
32{
33 rtc_time_to_tm(get_seconds(), tm);
34 return 0;
35}
36
37static int test_rtc_set_mmss(struct device *dev, unsigned long secs)
38{
39 dev_info(dev, "%s, secs = %lu\n", __func__, secs);
40 return 0;
41}
42
43static int test_rtc_proc(struct device *dev, struct seq_file *seq)
44{
45 struct platform_device *plat_dev = to_platform_device(dev);
46
47 seq_printf(seq, "test\t\t: yes\n");
48 seq_printf(seq, "id\t\t: %d\n", plat_dev->id);
49
50 return 0;
51}
52
53static int test_rtc_alarm_irq_enable(struct device *dev, unsigned int enable)
54{
55 return 0;
56}
57
58static const struct rtc_class_ops test_rtc_ops = {
59 .proc = test_rtc_proc,
60 .read_time = test_rtc_read_time,
61 .read_alarm = test_rtc_read_alarm,
62 .set_alarm = test_rtc_set_alarm,
63 .set_mmss = test_rtc_set_mmss,
64 .alarm_irq_enable = test_rtc_alarm_irq_enable,
65};
66
67static ssize_t test_irq_show(struct device *dev,
68 struct device_attribute *attr, char *buf)
69{
70 return sprintf(buf, "%d\n", 42);
71}
72static ssize_t test_irq_store(struct device *dev,
73 struct device_attribute *attr,
74 const char *buf, size_t count)
75{
76 int retval;
77 struct platform_device *plat_dev = to_platform_device(dev);
78 struct rtc_device *rtc = platform_get_drvdata(plat_dev);
79
80 retval = count;
81 if (strncmp(buf, "tick", 4) == 0 && rtc->pie_enabled)
82 rtc_update_irq(rtc, 1, RTC_PF | RTC_IRQF);
83 else if (strncmp(buf, "alarm", 5) == 0) {
84 struct rtc_wkalrm alrm;
85 int err = rtc_read_alarm(rtc, &alrm);
86
87 if (!err && alrm.enabled)
88 rtc_update_irq(rtc, 1, RTC_AF | RTC_IRQF);
89
90 } else if (strncmp(buf, "update", 6) == 0 && rtc->uie_rtctimer.enabled)
91 rtc_update_irq(rtc, 1, RTC_UF | RTC_IRQF);
92 else
93 retval = -EINVAL;
94
95 return retval;
96}
97static DEVICE_ATTR(irq, S_IRUGO | S_IWUSR, test_irq_show, test_irq_store);
98
99static int test_probe(struct platform_device *plat_dev)
100{
101 int err;
102 struct rtc_device *rtc = rtc_device_register("test", &plat_dev->dev,
103 &test_rtc_ops, THIS_MODULE);
104 if (IS_ERR(rtc)) {
105 err = PTR_ERR(rtc);
106 return err;
107 }
108
109 err = device_create_file(&plat_dev->dev, &dev_attr_irq);
110 if (err)
111 goto err;
112
113 platform_set_drvdata(plat_dev, rtc);
114
115 return 0;
116
117err:
118 rtc_device_unregister(rtc);
119 return err;
120}
121
122static int __devexit test_remove(struct platform_device *plat_dev)
123{
124 struct rtc_device *rtc = platform_get_drvdata(plat_dev);
125
126 rtc_device_unregister(rtc);
127 device_remove_file(&plat_dev->dev, &dev_attr_irq);
128
129 return 0;
130}
131
132static struct platform_driver test_driver = {
133 .probe = test_probe,
134 .remove = __devexit_p(test_remove),
135 .driver = {
136 .name = "rtc-test",
137 .owner = THIS_MODULE,
138 },
139};
140
141static int __init test_init(void)
142{
143 int err;
144
145 if ((err = platform_driver_register(&test_driver)))
146 return err;
147
148 if ((test0 = platform_device_alloc("rtc-test", 0)) == NULL) {
149 err = -ENOMEM;
150 goto exit_driver_unregister;
151 }
152
153 if ((test1 = platform_device_alloc("rtc-test", 1)) == NULL) {
154 err = -ENOMEM;
155 goto exit_free_test0;
156 }
157
158 if ((err = platform_device_add(test0)))
159 goto exit_free_test1;
160
161 if ((err = platform_device_add(test1)))
162 goto exit_device_unregister;
163
164 return 0;
165
166exit_device_unregister:
167 platform_device_unregister(test0);
168
169exit_free_test1:
170 platform_device_put(test1);
171
172exit_free_test0:
173 platform_device_put(test0);
174
175exit_driver_unregister:
176 platform_driver_unregister(&test_driver);
177 return err;
178}
179
180static void __exit test_exit(void)
181{
182 platform_device_unregister(test0);
183 platform_device_unregister(test1);
184 platform_driver_unregister(&test_driver);
185}
186
187MODULE_AUTHOR("Alessandro Zummo <a.zummo@towertech.it>");
188MODULE_DESCRIPTION("RTC test driver/device");
189MODULE_LICENSE("GPL");
190
191module_init(test_init);
192module_exit(test_exit);