1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/module.h>
15#include <linux/rtc.h>
16#include <linux/kdev_t.h>
17#include <linux/idr.h>
18#include <linux/slab.h>
19#include <linux/workqueue.h>
20
21#include "rtc-core.h"
22
23
24static DEFINE_IDR(rtc_idr);
25static DEFINE_MUTEX(idr_lock);
26struct class *rtc_class;
27
28static void rtc_device_release(struct device *dev)
29{
30 struct rtc_device *rtc = to_rtc_device(dev);
31 mutex_lock(&idr_lock);
32 idr_remove(&rtc_idr, rtc->id);
33 mutex_unlock(&idr_lock);
34 kfree(rtc);
35}
36
37#if defined(CONFIG_PM) && defined(CONFIG_RTC_HCTOSYS_DEVICE)
38
39
40
41
42
43
44static struct timespec delta;
45static time_t oldtime;
46
47static int rtc_suspend(struct device *dev, pm_message_t mesg)
48{
49 struct rtc_device *rtc = to_rtc_device(dev);
50 struct rtc_time tm;
51 struct timespec ts = current_kernel_time();
52
53 if (strcmp(dev_name(&rtc->dev), CONFIG_RTC_HCTOSYS_DEVICE) != 0)
54 return 0;
55
56 rtc_read_time(rtc, &tm);
57 rtc_tm_to_time(&tm, &oldtime);
58
59
60 set_normalized_timespec(&delta,
61 ts.tv_sec - oldtime,
62 ts.tv_nsec - (NSEC_PER_SEC >> 1));
63
64 return 0;
65}
66
67static int rtc_resume(struct device *dev)
68{
69 struct rtc_device *rtc = to_rtc_device(dev);
70 struct rtc_time tm;
71 time_t newtime;
72 struct timespec time;
73
74 if (strcmp(dev_name(&rtc->dev), CONFIG_RTC_HCTOSYS_DEVICE) != 0)
75 return 0;
76
77 rtc_read_time(rtc, &tm);
78 if (rtc_valid_tm(&tm) != 0) {
79 pr_debug("%s: bogus resume time\n", dev_name(&rtc->dev));
80 return 0;
81 }
82 rtc_tm_to_time(&tm, &newtime);
83 if (newtime <= oldtime) {
84 if (newtime < oldtime)
85 pr_debug("%s: time travel!\n", dev_name(&rtc->dev));
86 return 0;
87 }
88
89
90
91
92 set_normalized_timespec(&time,
93 newtime + delta.tv_sec,
94 (NSEC_PER_SEC >> 1) + delta.tv_nsec);
95 do_settimeofday(&time);
96
97 return 0;
98}
99
100#else
101#define rtc_suspend NULL
102#define rtc_resume NULL
103#endif
104
105
106
107
108
109
110
111
112
113
114
115struct rtc_device *rtc_device_register(const char *name, struct device *dev,
116 const struct rtc_class_ops *ops,
117 struct module *owner)
118{
119 struct rtc_device *rtc;
120 int id, err;
121
122 if (idr_pre_get(&rtc_idr, GFP_KERNEL) == 0) {
123 err = -ENOMEM;
124 goto exit;
125 }
126
127
128 mutex_lock(&idr_lock);
129 err = idr_get_new(&rtc_idr, NULL, &id);
130 mutex_unlock(&idr_lock);
131
132 if (err < 0)
133 goto exit;
134
135 id = id & MAX_ID_MASK;
136
137 rtc = kzalloc(sizeof(struct rtc_device), GFP_KERNEL);
138 if (rtc == NULL) {
139 err = -ENOMEM;
140 goto exit_idr;
141 }
142
143 rtc->id = id;
144 rtc->ops = ops;
145 rtc->owner = owner;
146 rtc->irq_freq = 1;
147 rtc->max_user_freq = 64;
148 rtc->dev.parent = dev;
149 rtc->dev.class = rtc_class;
150 rtc->dev.release = rtc_device_release;
151
152 mutex_init(&rtc->ops_lock);
153 spin_lock_init(&rtc->irq_lock);
154 spin_lock_init(&rtc->irq_task_lock);
155 init_waitqueue_head(&rtc->irq_queue);
156
157
158 timerqueue_init_head(&rtc->timerqueue);
159 INIT_WORK(&rtc->irqwork, rtc_timer_do_work);
160
161 rtc_timer_init(&rtc->aie_timer, rtc_aie_update_irq, (void *)rtc);
162
163 rtc_timer_init(&rtc->uie_rtctimer, rtc_uie_update_irq, (void *)rtc);
164
165 hrtimer_init(&rtc->pie_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
166 rtc->pie_timer.function = rtc_pie_update_irq;
167 rtc->pie_enabled = 0;
168
169 strlcpy(rtc->name, name, RTC_DEVICE_NAME_SIZE);
170 dev_set_name(&rtc->dev, "rtc%d", id);
171
172 rtc_dev_prepare(rtc);
173
174 err = device_register(&rtc->dev);
175 if (err) {
176 put_device(&rtc->dev);
177 goto exit_kfree;
178 }
179
180 rtc_dev_add_device(rtc);
181 rtc_sysfs_add_device(rtc);
182 rtc_proc_add_device(rtc);
183
184 dev_info(dev, "rtc core: registered %s as %s\n",
185 rtc->name, dev_name(&rtc->dev));
186
187 return rtc;
188
189exit_kfree:
190 kfree(rtc);
191
192exit_idr:
193 mutex_lock(&idr_lock);
194 idr_remove(&rtc_idr, id);
195 mutex_unlock(&idr_lock);
196
197exit:
198 dev_err(dev, "rtc core: unable to register %s, err = %d\n",
199 name, err);
200 return ERR_PTR(err);
201}
202EXPORT_SYMBOL_GPL(rtc_device_register);
203
204
205
206
207
208
209
210void rtc_device_unregister(struct rtc_device *rtc)
211{
212 if (get_device(&rtc->dev) != NULL) {
213 mutex_lock(&rtc->ops_lock);
214
215
216
217 rtc_sysfs_del_device(rtc);
218 rtc_dev_del_device(rtc);
219 rtc_proc_del_device(rtc);
220 device_unregister(&rtc->dev);
221 rtc->ops = NULL;
222 mutex_unlock(&rtc->ops_lock);
223 put_device(&rtc->dev);
224 }
225}
226EXPORT_SYMBOL_GPL(rtc_device_unregister);
227
228static int __init rtc_init(void)
229{
230 rtc_class = class_create(THIS_MODULE, "rtc");
231 if (IS_ERR(rtc_class)) {
232 printk(KERN_ERR "%s: couldn't create class\n", __FILE__);
233 return PTR_ERR(rtc_class);
234 }
235 rtc_class->suspend = rtc_suspend;
236 rtc_class->resume = rtc_resume;
237 rtc_dev_init();
238 rtc_sysfs_init(rtc_class);
239 return 0;
240}
241
242static void __exit rtc_exit(void)
243{
244 rtc_dev_exit();
245 class_destroy(rtc_class);
246 idr_destroy(&rtc_idr);
247}
248
249subsys_initcall(rtc_init);
250module_exit(rtc_exit);
251
252MODULE_AUTHOR("Alessandro Zummo <a.zummo@towertech.it>");
253MODULE_DESCRIPTION("RTC class support");
254MODULE_LICENSE("GPL");
255