Commit | Line | Data |
---|---|---|
0c86edc0 AZ |
1 | /* |
2 | * RTC subsystem, interface functions | |
3 | * | |
4 | * Copyright (C) 2005 Tower Technologies | |
5 | * Author: Alessandro Zummo <a.zummo@towertech.it> | |
6 | * | |
7 | * based on arch/arm/common/rtctime.c | |
8 | * | |
9 | * This program is free software; you can redistribute it and/or modify | |
10 | * it under the terms of the GNU General Public License version 2 as | |
11 | * published by the Free Software Foundation. | |
12 | */ | |
13 | ||
14 | #include <linux/rtc.h> | |
d43c36dc | 15 | #include <linux/sched.h> |
97144c67 | 16 | #include <linux/log2.h> |
6610e089 | 17 | #include <linux/workqueue.h> |
0c86edc0 | 18 | |
6610e089 | 19 | static int __rtc_read_time(struct rtc_device *rtc, struct rtc_time *tm) |
0c86edc0 AZ |
20 | { |
21 | int err; | |
0c86edc0 AZ |
22 | if (!rtc->ops) |
23 | err = -ENODEV; | |
24 | else if (!rtc->ops->read_time) | |
25 | err = -EINVAL; | |
26 | else { | |
27 | memset(tm, 0, sizeof(struct rtc_time)); | |
cd966209 | 28 | err = rtc->ops->read_time(rtc->dev.parent, tm); |
0c86edc0 | 29 | } |
6610e089 JS |
30 | return err; |
31 | } | |
32 | ||
33 | int rtc_read_time(struct rtc_device *rtc, struct rtc_time *tm) | |
34 | { | |
35 | int err; | |
0c86edc0 | 36 | |
6610e089 JS |
37 | err = mutex_lock_interruptible(&rtc->ops_lock); |
38 | if (err) | |
39 | return err; | |
40 | ||
41 | err = __rtc_read_time(rtc, tm); | |
0c86edc0 AZ |
42 | mutex_unlock(&rtc->ops_lock); |
43 | return err; | |
44 | } | |
45 | EXPORT_SYMBOL_GPL(rtc_read_time); | |
46 | ||
ab6a2d70 | 47 | int rtc_set_time(struct rtc_device *rtc, struct rtc_time *tm) |
0c86edc0 AZ |
48 | { |
49 | int err; | |
0c86edc0 AZ |
50 | |
51 | err = rtc_valid_tm(tm); | |
52 | if (err != 0) | |
53 | return err; | |
54 | ||
55 | err = mutex_lock_interruptible(&rtc->ops_lock); | |
56 | if (err) | |
b68bb263 | 57 | return err; |
0c86edc0 AZ |
58 | |
59 | if (!rtc->ops) | |
60 | err = -ENODEV; | |
bbccf83f | 61 | else if (rtc->ops->set_time) |
cd966209 | 62 | err = rtc->ops->set_time(rtc->dev.parent, tm); |
bbccf83f AZ |
63 | else if (rtc->ops->set_mmss) { |
64 | unsigned long secs; | |
65 | err = rtc_tm_to_time(tm, &secs); | |
66 | if (err == 0) | |
67 | err = rtc->ops->set_mmss(rtc->dev.parent, secs); | |
68 | } else | |
69 | err = -EINVAL; | |
0c86edc0 AZ |
70 | |
71 | mutex_unlock(&rtc->ops_lock); | |
72 | return err; | |
73 | } | |
74 | EXPORT_SYMBOL_GPL(rtc_set_time); | |
75 | ||
ab6a2d70 | 76 | int rtc_set_mmss(struct rtc_device *rtc, unsigned long secs) |
0c86edc0 AZ |
77 | { |
78 | int err; | |
0c86edc0 AZ |
79 | |
80 | err = mutex_lock_interruptible(&rtc->ops_lock); | |
81 | if (err) | |
b68bb263 | 82 | return err; |
0c86edc0 AZ |
83 | |
84 | if (!rtc->ops) | |
85 | err = -ENODEV; | |
86 | else if (rtc->ops->set_mmss) | |
cd966209 | 87 | err = rtc->ops->set_mmss(rtc->dev.parent, secs); |
0c86edc0 AZ |
88 | else if (rtc->ops->read_time && rtc->ops->set_time) { |
89 | struct rtc_time new, old; | |
90 | ||
cd966209 | 91 | err = rtc->ops->read_time(rtc->dev.parent, &old); |
0c86edc0 AZ |
92 | if (err == 0) { |
93 | rtc_time_to_tm(secs, &new); | |
94 | ||
95 | /* | |
96 | * avoid writing when we're going to change the day of | |
97 | * the month. We will retry in the next minute. This | |
98 | * basically means that if the RTC must not drift | |
99 | * by more than 1 minute in 11 minutes. | |
100 | */ | |
101 | if (!((old.tm_hour == 23 && old.tm_min == 59) || | |
102 | (new.tm_hour == 23 && new.tm_min == 59))) | |
cd966209 | 103 | err = rtc->ops->set_time(rtc->dev.parent, |
ab6a2d70 | 104 | &new); |
0c86edc0 AZ |
105 | } |
106 | } | |
107 | else | |
108 | err = -EINVAL; | |
109 | ||
110 | mutex_unlock(&rtc->ops_lock); | |
111 | ||
112 | return err; | |
113 | } | |
114 | EXPORT_SYMBOL_GPL(rtc_set_mmss); | |
115 | ||
6610e089 | 116 | int rtc_read_alarm(struct rtc_device *rtc, struct rtc_wkalrm *alarm) |
0c86edc0 AZ |
117 | { |
118 | int err; | |
0c86edc0 AZ |
119 | |
120 | err = mutex_lock_interruptible(&rtc->ops_lock); | |
121 | if (err) | |
b68bb263 | 122 | return err; |
6610e089 JS |
123 | alarm->enabled = rtc->aie_timer.enabled; |
124 | if (alarm->enabled) | |
125 | alarm->time = rtc_ktime_to_tm(rtc->aie_timer.node.expires); | |
0c86edc0 | 126 | mutex_unlock(&rtc->ops_lock); |
6610e089 JS |
127 | |
128 | return 0; | |
0c86edc0 | 129 | } |
6610e089 | 130 | EXPORT_SYMBOL_GPL(rtc_read_alarm); |
0e36a9a4 | 131 | |
6610e089 | 132 | int __rtc_set_alarm(struct rtc_device *rtc, struct rtc_wkalrm *alarm) |
0e36a9a4 | 133 | { |
6610e089 JS |
134 | struct rtc_time tm; |
135 | long now, scheduled; | |
0e36a9a4 | 136 | int err; |
0e36a9a4 | 137 | |
6610e089 JS |
138 | err = rtc_valid_tm(&alarm->time); |
139 | if (err) | |
0e36a9a4 | 140 | return err; |
6610e089 | 141 | rtc_tm_to_time(&alarm->time, &scheduled); |
a01cc657 | 142 | |
6610e089 JS |
143 | /* Make sure we're not setting alarms in the past */ |
144 | err = __rtc_read_time(rtc, &tm); | |
145 | rtc_tm_to_time(&tm, &now); | |
146 | if (scheduled <= now) | |
147 | return -ETIME; | |
148 | /* | |
149 | * XXX - We just checked to make sure the alarm time is not | |
150 | * in the past, but there is still a race window where if | |
151 | * the is alarm set for the next second and the second ticks | |
152 | * over right here, before we set the alarm. | |
a01cc657 | 153 | */ |
a01cc657 | 154 | |
6610e089 JS |
155 | if (!rtc->ops) |
156 | err = -ENODEV; | |
157 | else if (!rtc->ops->set_alarm) | |
158 | err = -EINVAL; | |
159 | else | |
160 | err = rtc->ops->set_alarm(rtc->dev.parent, alarm); | |
161 | ||
162 | return err; | |
0e36a9a4 | 163 | } |
0c86edc0 | 164 | |
ab6a2d70 | 165 | int rtc_set_alarm(struct rtc_device *rtc, struct rtc_wkalrm *alarm) |
0c86edc0 AZ |
166 | { |
167 | int err; | |
0c86edc0 | 168 | |
f8245c26 DB |
169 | err = rtc_valid_tm(&alarm->time); |
170 | if (err != 0) | |
171 | return err; | |
172 | ||
0c86edc0 AZ |
173 | err = mutex_lock_interruptible(&rtc->ops_lock); |
174 | if (err) | |
b68bb263 | 175 | return err; |
6610e089 | 176 | if (rtc->aie_timer.enabled) { |
96c8f06a | 177 | rtc_timer_remove(rtc, &rtc->aie_timer); |
6610e089 JS |
178 | rtc->aie_timer.enabled = 0; |
179 | } | |
180 | rtc->aie_timer.node.expires = rtc_tm_to_ktime(alarm->time); | |
181 | rtc->aie_timer.period = ktime_set(0, 0); | |
182 | if (alarm->enabled) { | |
183 | rtc->aie_timer.enabled = 1; | |
96c8f06a | 184 | rtc_timer_enqueue(rtc, &rtc->aie_timer); |
6610e089 | 185 | } |
0c86edc0 | 186 | mutex_unlock(&rtc->ops_lock); |
6610e089 | 187 | return 0; |
0c86edc0 AZ |
188 | } |
189 | EXPORT_SYMBOL_GPL(rtc_set_alarm); | |
190 | ||
099e6576 AZ |
191 | int rtc_alarm_irq_enable(struct rtc_device *rtc, unsigned int enabled) |
192 | { | |
193 | int err = mutex_lock_interruptible(&rtc->ops_lock); | |
194 | if (err) | |
195 | return err; | |
196 | ||
6610e089 JS |
197 | if (rtc->aie_timer.enabled != enabled) { |
198 | if (enabled) { | |
199 | rtc->aie_timer.enabled = 1; | |
96c8f06a | 200 | rtc_timer_enqueue(rtc, &rtc->aie_timer); |
6610e089 | 201 | } else { |
96c8f06a | 202 | rtc_timer_remove(rtc, &rtc->aie_timer); |
6610e089 JS |
203 | rtc->aie_timer.enabled = 0; |
204 | } | |
205 | } | |
206 | ||
099e6576 AZ |
207 | if (!rtc->ops) |
208 | err = -ENODEV; | |
209 | else if (!rtc->ops->alarm_irq_enable) | |
210 | err = -EINVAL; | |
211 | else | |
212 | err = rtc->ops->alarm_irq_enable(rtc->dev.parent, enabled); | |
213 | ||
214 | mutex_unlock(&rtc->ops_lock); | |
215 | return err; | |
216 | } | |
217 | EXPORT_SYMBOL_GPL(rtc_alarm_irq_enable); | |
218 | ||
219 | int rtc_update_irq_enable(struct rtc_device *rtc, unsigned int enabled) | |
220 | { | |
221 | int err = mutex_lock_interruptible(&rtc->ops_lock); | |
222 | if (err) | |
223 | return err; | |
224 | ||
6610e089 JS |
225 | /* make sure we're changing state */ |
226 | if (rtc->uie_rtctimer.enabled == enabled) | |
227 | goto out; | |
228 | ||
229 | if (enabled) { | |
230 | struct rtc_time tm; | |
231 | ktime_t now, onesec; | |
232 | ||
233 | __rtc_read_time(rtc, &tm); | |
234 | onesec = ktime_set(1, 0); | |
235 | now = rtc_tm_to_ktime(tm); | |
236 | rtc->uie_rtctimer.node.expires = ktime_add(now, onesec); | |
237 | rtc->uie_rtctimer.period = ktime_set(1, 0); | |
238 | rtc->uie_rtctimer.enabled = 1; | |
96c8f06a | 239 | rtc_timer_enqueue(rtc, &rtc->uie_rtctimer); |
6610e089 | 240 | } else { |
96c8f06a | 241 | rtc_timer_remove(rtc, &rtc->uie_rtctimer); |
6610e089 | 242 | rtc->uie_rtctimer.enabled = 0; |
099e6576 | 243 | } |
099e6576 | 244 | |
6610e089 | 245 | out: |
099e6576 | 246 | mutex_unlock(&rtc->ops_lock); |
099e6576 | 247 | return err; |
6610e089 | 248 | |
099e6576 AZ |
249 | } |
250 | EXPORT_SYMBOL_GPL(rtc_update_irq_enable); | |
251 | ||
6610e089 | 252 | |
d728b1e6 | 253 | /** |
6610e089 JS |
254 | * rtc_handle_legacy_irq - AIE, UIE and PIE event hook |
255 | * @rtc: pointer to the rtc device | |
256 | * | |
257 | * This function is called when an AIE, UIE or PIE mode interrupt | |
258 | * has occured (or been emulated). | |
259 | * | |
260 | * Triggers the registered irq_task function callback. | |
d728b1e6 | 261 | */ |
6610e089 | 262 | static void rtc_handle_legacy_irq(struct rtc_device *rtc, int num, int mode) |
0c86edc0 | 263 | { |
e6229bec AN |
264 | unsigned long flags; |
265 | ||
6610e089 | 266 | /* mark one irq of the appropriate mode */ |
e6229bec | 267 | spin_lock_irqsave(&rtc->irq_lock, flags); |
6610e089 | 268 | rtc->irq_data = (rtc->irq_data + (num << 8)) | (RTC_IRQF|mode); |
e6229bec | 269 | spin_unlock_irqrestore(&rtc->irq_lock, flags); |
0c86edc0 | 270 | |
6610e089 | 271 | /* call the task func */ |
e6229bec | 272 | spin_lock_irqsave(&rtc->irq_task_lock, flags); |
0c86edc0 AZ |
273 | if (rtc->irq_task) |
274 | rtc->irq_task->func(rtc->irq_task->private_data); | |
e6229bec | 275 | spin_unlock_irqrestore(&rtc->irq_task_lock, flags); |
0c86edc0 AZ |
276 | |
277 | wake_up_interruptible(&rtc->irq_queue); | |
278 | kill_fasync(&rtc->async_queue, SIGIO, POLL_IN); | |
279 | } | |
6610e089 JS |
280 | |
281 | ||
282 | /** | |
283 | * rtc_aie_update_irq - AIE mode rtctimer hook | |
284 | * @private: pointer to the rtc_device | |
285 | * | |
286 | * This functions is called when the aie_timer expires. | |
287 | */ | |
288 | void rtc_aie_update_irq(void *private) | |
289 | { | |
290 | struct rtc_device *rtc = (struct rtc_device *)private; | |
291 | rtc_handle_legacy_irq(rtc, 1, RTC_AF); | |
292 | } | |
293 | ||
294 | ||
295 | /** | |
296 | * rtc_uie_update_irq - UIE mode rtctimer hook | |
297 | * @private: pointer to the rtc_device | |
298 | * | |
299 | * This functions is called when the uie_timer expires. | |
300 | */ | |
301 | void rtc_uie_update_irq(void *private) | |
302 | { | |
303 | struct rtc_device *rtc = (struct rtc_device *)private; | |
304 | rtc_handle_legacy_irq(rtc, 1, RTC_UF); | |
305 | } | |
306 | ||
307 | ||
308 | /** | |
309 | * rtc_pie_update_irq - PIE mode hrtimer hook | |
310 | * @timer: pointer to the pie mode hrtimer | |
311 | * | |
312 | * This function is used to emulate PIE mode interrupts | |
313 | * using an hrtimer. This function is called when the periodic | |
314 | * hrtimer expires. | |
315 | */ | |
316 | enum hrtimer_restart rtc_pie_update_irq(struct hrtimer *timer) | |
317 | { | |
318 | struct rtc_device *rtc; | |
319 | ktime_t period; | |
320 | int count; | |
321 | rtc = container_of(timer, struct rtc_device, pie_timer); | |
322 | ||
323 | period = ktime_set(0, NSEC_PER_SEC/rtc->irq_freq); | |
324 | count = hrtimer_forward_now(timer, period); | |
325 | ||
326 | rtc_handle_legacy_irq(rtc, count, RTC_PF); | |
327 | ||
328 | return HRTIMER_RESTART; | |
329 | } | |
330 | ||
331 | /** | |
332 | * rtc_update_irq - Triggered when a RTC interrupt occurs. | |
333 | * @rtc: the rtc device | |
334 | * @num: how many irqs are being reported (usually one) | |
335 | * @events: mask of RTC_IRQF with one or more of RTC_PF, RTC_AF, RTC_UF | |
336 | * Context: any | |
337 | */ | |
338 | void rtc_update_irq(struct rtc_device *rtc, | |
339 | unsigned long num, unsigned long events) | |
340 | { | |
341 | schedule_work(&rtc->irqwork); | |
342 | } | |
0c86edc0 AZ |
343 | EXPORT_SYMBOL_GPL(rtc_update_irq); |
344 | ||
71da8905 DY |
345 | static int __rtc_match(struct device *dev, void *data) |
346 | { | |
347 | char *name = (char *)data; | |
348 | ||
d4afc76c | 349 | if (strcmp(dev_name(dev), name) == 0) |
71da8905 DY |
350 | return 1; |
351 | return 0; | |
352 | } | |
353 | ||
ab6a2d70 | 354 | struct rtc_device *rtc_class_open(char *name) |
0c86edc0 | 355 | { |
cd966209 | 356 | struct device *dev; |
ab6a2d70 | 357 | struct rtc_device *rtc = NULL; |
0c86edc0 | 358 | |
695794ae | 359 | dev = class_find_device(rtc_class, NULL, name, __rtc_match); |
71da8905 DY |
360 | if (dev) |
361 | rtc = to_rtc_device(dev); | |
0c86edc0 | 362 | |
ab6a2d70 DB |
363 | if (rtc) { |
364 | if (!try_module_get(rtc->owner)) { | |
cd966209 | 365 | put_device(dev); |
ab6a2d70 DB |
366 | rtc = NULL; |
367 | } | |
0c86edc0 | 368 | } |
0c86edc0 | 369 | |
ab6a2d70 | 370 | return rtc; |
0c86edc0 AZ |
371 | } |
372 | EXPORT_SYMBOL_GPL(rtc_class_open); | |
373 | ||
ab6a2d70 | 374 | void rtc_class_close(struct rtc_device *rtc) |
0c86edc0 | 375 | { |
ab6a2d70 | 376 | module_put(rtc->owner); |
cd966209 | 377 | put_device(&rtc->dev); |
0c86edc0 AZ |
378 | } |
379 | EXPORT_SYMBOL_GPL(rtc_class_close); | |
380 | ||
ab6a2d70 | 381 | int rtc_irq_register(struct rtc_device *rtc, struct rtc_task *task) |
0c86edc0 AZ |
382 | { |
383 | int retval = -EBUSY; | |
0c86edc0 AZ |
384 | |
385 | if (task == NULL || task->func == NULL) | |
386 | return -EINVAL; | |
387 | ||
d691eb90 | 388 | /* Cannot register while the char dev is in use */ |
372a302e | 389 | if (test_and_set_bit_lock(RTC_DEV_BUSY, &rtc->flags)) |
d691eb90 AZ |
390 | return -EBUSY; |
391 | ||
d728b1e6 | 392 | spin_lock_irq(&rtc->irq_task_lock); |
0c86edc0 AZ |
393 | if (rtc->irq_task == NULL) { |
394 | rtc->irq_task = task; | |
395 | retval = 0; | |
396 | } | |
d728b1e6 | 397 | spin_unlock_irq(&rtc->irq_task_lock); |
0c86edc0 | 398 | |
372a302e | 399 | clear_bit_unlock(RTC_DEV_BUSY, &rtc->flags); |
d691eb90 | 400 | |
0c86edc0 AZ |
401 | return retval; |
402 | } | |
403 | EXPORT_SYMBOL_GPL(rtc_irq_register); | |
404 | ||
ab6a2d70 | 405 | void rtc_irq_unregister(struct rtc_device *rtc, struct rtc_task *task) |
0c86edc0 | 406 | { |
d728b1e6 | 407 | spin_lock_irq(&rtc->irq_task_lock); |
0c86edc0 AZ |
408 | if (rtc->irq_task == task) |
409 | rtc->irq_task = NULL; | |
d728b1e6 | 410 | spin_unlock_irq(&rtc->irq_task_lock); |
0c86edc0 AZ |
411 | } |
412 | EXPORT_SYMBOL_GPL(rtc_irq_unregister); | |
413 | ||
97144c67 DB |
414 | /** |
415 | * rtc_irq_set_state - enable/disable 2^N Hz periodic IRQs | |
416 | * @rtc: the rtc device | |
417 | * @task: currently registered with rtc_irq_register() | |
418 | * @enabled: true to enable periodic IRQs | |
419 | * Context: any | |
420 | * | |
421 | * Note that rtc_irq_set_freq() should previously have been used to | |
422 | * specify the desired frequency of periodic IRQ task->func() callbacks. | |
423 | */ | |
ab6a2d70 | 424 | int rtc_irq_set_state(struct rtc_device *rtc, struct rtc_task *task, int enabled) |
0c86edc0 AZ |
425 | { |
426 | int err = 0; | |
427 | unsigned long flags; | |
0c86edc0 AZ |
428 | |
429 | spin_lock_irqsave(&rtc->irq_task_lock, flags); | |
d691eb90 AZ |
430 | if (rtc->irq_task != NULL && task == NULL) |
431 | err = -EBUSY; | |
0c86edc0 | 432 | if (rtc->irq_task != task) |
d691eb90 | 433 | err = -EACCES; |
0c86edc0 | 434 | |
6610e089 JS |
435 | if (enabled) { |
436 | ktime_t period = ktime_set(0, NSEC_PER_SEC/rtc->irq_freq); | |
437 | hrtimer_start(&rtc->pie_timer, period, HRTIMER_MODE_REL); | |
438 | } else { | |
439 | hrtimer_cancel(&rtc->pie_timer); | |
440 | } | |
441 | rtc->pie_enabled = enabled; | |
442 | spin_unlock_irqrestore(&rtc->irq_task_lock, flags); | |
0c86edc0 AZ |
443 | |
444 | return err; | |
445 | } | |
446 | EXPORT_SYMBOL_GPL(rtc_irq_set_state); | |
447 | ||
97144c67 DB |
448 | /** |
449 | * rtc_irq_set_freq - set 2^N Hz periodic IRQ frequency for IRQ | |
450 | * @rtc: the rtc device | |
451 | * @task: currently registered with rtc_irq_register() | |
452 | * @freq: positive frequency with which task->func() will be called | |
453 | * Context: any | |
454 | * | |
455 | * Note that rtc_irq_set_state() is used to enable or disable the | |
456 | * periodic IRQs. | |
457 | */ | |
ab6a2d70 | 458 | int rtc_irq_set_freq(struct rtc_device *rtc, struct rtc_task *task, int freq) |
0c86edc0 | 459 | { |
56f10c63 | 460 | int err = 0; |
0c86edc0 | 461 | unsigned long flags; |
0c86edc0 | 462 | |
0c86edc0 | 463 | spin_lock_irqsave(&rtc->irq_task_lock, flags); |
d691eb90 AZ |
464 | if (rtc->irq_task != NULL && task == NULL) |
465 | err = -EBUSY; | |
0c86edc0 | 466 | if (rtc->irq_task != task) |
d691eb90 | 467 | err = -EACCES; |
0c86edc0 | 468 | if (err == 0) { |
6610e089 JS |
469 | rtc->irq_freq = freq; |
470 | if (rtc->pie_enabled) { | |
471 | ktime_t period; | |
472 | hrtimer_cancel(&rtc->pie_timer); | |
473 | period = ktime_set(0, NSEC_PER_SEC/rtc->irq_freq); | |
474 | hrtimer_start(&rtc->pie_timer, period, | |
475 | HRTIMER_MODE_REL); | |
476 | } | |
0c86edc0 | 477 | } |
6610e089 | 478 | spin_unlock_irqrestore(&rtc->irq_task_lock, flags); |
0c86edc0 AZ |
479 | return err; |
480 | } | |
2601a464 | 481 | EXPORT_SYMBOL_GPL(rtc_irq_set_freq); |
6610e089 JS |
482 | |
483 | /** | |
96c8f06a | 484 | * rtc_timer_enqueue - Adds a rtc_timer to the rtc_device timerqueue |
6610e089 JS |
485 | * @rtc rtc device |
486 | * @timer timer being added. | |
487 | * | |
488 | * Enqueues a timer onto the rtc devices timerqueue and sets | |
489 | * the next alarm event appropriately. | |
490 | * | |
491 | * Must hold ops_lock for proper serialization of timerqueue | |
492 | */ | |
96c8f06a | 493 | void rtc_timer_enqueue(struct rtc_device *rtc, struct rtc_timer *timer) |
6610e089 JS |
494 | { |
495 | timerqueue_add(&rtc->timerqueue, &timer->node); | |
496 | if (&timer->node == timerqueue_getnext(&rtc->timerqueue)) { | |
497 | struct rtc_wkalrm alarm; | |
498 | int err; | |
499 | alarm.time = rtc_ktime_to_tm(timer->node.expires); | |
500 | alarm.enabled = 1; | |
501 | err = __rtc_set_alarm(rtc, &alarm); | |
502 | if (err == -ETIME) | |
503 | schedule_work(&rtc->irqwork); | |
504 | } | |
505 | } | |
506 | ||
507 | /** | |
96c8f06a | 508 | * rtc_timer_remove - Removes a rtc_timer from the rtc_device timerqueue |
6610e089 JS |
509 | * @rtc rtc device |
510 | * @timer timer being removed. | |
511 | * | |
512 | * Removes a timer onto the rtc devices timerqueue and sets | |
513 | * the next alarm event appropriately. | |
514 | * | |
515 | * Must hold ops_lock for proper serialization of timerqueue | |
516 | */ | |
96c8f06a | 517 | void rtc_timer_remove(struct rtc_device *rtc, struct rtc_timer *timer) |
6610e089 JS |
518 | { |
519 | struct timerqueue_node *next = timerqueue_getnext(&rtc->timerqueue); | |
520 | timerqueue_del(&rtc->timerqueue, &timer->node); | |
521 | ||
522 | if (next == &timer->node) { | |
523 | struct rtc_wkalrm alarm; | |
524 | int err; | |
525 | next = timerqueue_getnext(&rtc->timerqueue); | |
526 | if (!next) | |
527 | return; | |
528 | alarm.time = rtc_ktime_to_tm(next->expires); | |
529 | alarm.enabled = 1; | |
530 | err = __rtc_set_alarm(rtc, &alarm); | |
531 | if (err == -ETIME) | |
532 | schedule_work(&rtc->irqwork); | |
533 | } | |
534 | } | |
535 | ||
536 | /** | |
96c8f06a | 537 | * rtc_timer_do_work - Expires rtc timers |
6610e089 JS |
538 | * @rtc rtc device |
539 | * @timer timer being removed. | |
540 | * | |
541 | * Expires rtc timers. Reprograms next alarm event if needed. | |
542 | * Called via worktask. | |
543 | * | |
544 | * Serializes access to timerqueue via ops_lock mutex | |
545 | */ | |
96c8f06a | 546 | void rtc_timer_do_work(struct work_struct *work) |
6610e089 JS |
547 | { |
548 | struct rtc_timer *timer; | |
549 | struct timerqueue_node *next; | |
550 | ktime_t now; | |
551 | struct rtc_time tm; | |
552 | ||
553 | struct rtc_device *rtc = | |
554 | container_of(work, struct rtc_device, irqwork); | |
555 | ||
556 | mutex_lock(&rtc->ops_lock); | |
557 | again: | |
558 | __rtc_read_time(rtc, &tm); | |
559 | now = rtc_tm_to_ktime(tm); | |
560 | while ((next = timerqueue_getnext(&rtc->timerqueue))) { | |
561 | if (next->expires.tv64 > now.tv64) | |
562 | break; | |
563 | ||
564 | /* expire timer */ | |
565 | timer = container_of(next, struct rtc_timer, node); | |
566 | timerqueue_del(&rtc->timerqueue, &timer->node); | |
567 | timer->enabled = 0; | |
568 | if (timer->task.func) | |
569 | timer->task.func(timer->task.private_data); | |
570 | ||
571 | /* Re-add/fwd periodic timers */ | |
572 | if (ktime_to_ns(timer->period)) { | |
573 | timer->node.expires = ktime_add(timer->node.expires, | |
574 | timer->period); | |
575 | timer->enabled = 1; | |
576 | timerqueue_add(&rtc->timerqueue, &timer->node); | |
577 | } | |
578 | } | |
579 | ||
580 | /* Set next alarm */ | |
581 | if (next) { | |
582 | struct rtc_wkalrm alarm; | |
583 | int err; | |
584 | alarm.time = rtc_ktime_to_tm(next->expires); | |
585 | alarm.enabled = 1; | |
586 | err = __rtc_set_alarm(rtc, &alarm); | |
587 | if (err == -ETIME) | |
588 | goto again; | |
589 | } | |
590 | ||
591 | mutex_unlock(&rtc->ops_lock); | |
592 | } | |
593 | ||
594 | ||
96c8f06a | 595 | /* rtc_timer_init - Initializes an rtc_timer |
6610e089 JS |
596 | * @timer: timer to be intiialized |
597 | * @f: function pointer to be called when timer fires | |
598 | * @data: private data passed to function pointer | |
599 | * | |
600 | * Kernel interface to initializing an rtc_timer. | |
601 | */ | |
96c8f06a | 602 | void rtc_timer_init(struct rtc_timer *timer, void (*f)(void* p), void* data) |
6610e089 JS |
603 | { |
604 | timerqueue_init(&timer->node); | |
605 | timer->enabled = 0; | |
606 | timer->task.func = f; | |
607 | timer->task.private_data = data; | |
608 | } | |
609 | ||
96c8f06a | 610 | /* rtc_timer_start - Sets an rtc_timer to fire in the future |
6610e089 JS |
611 | * @ rtc: rtc device to be used |
612 | * @ timer: timer being set | |
613 | * @ expires: time at which to expire the timer | |
614 | * @ period: period that the timer will recur | |
615 | * | |
616 | * Kernel interface to set an rtc_timer | |
617 | */ | |
96c8f06a | 618 | int rtc_timer_start(struct rtc_device *rtc, struct rtc_timer* timer, |
6610e089 JS |
619 | ktime_t expires, ktime_t period) |
620 | { | |
621 | int ret = 0; | |
622 | mutex_lock(&rtc->ops_lock); | |
623 | if (timer->enabled) | |
96c8f06a | 624 | rtc_timer_remove(rtc, timer); |
6610e089 JS |
625 | |
626 | timer->node.expires = expires; | |
627 | timer->period = period; | |
628 | ||
629 | timer->enabled = 1; | |
96c8f06a | 630 | rtc_timer_enqueue(rtc, timer); |
6610e089 JS |
631 | |
632 | mutex_unlock(&rtc->ops_lock); | |
633 | return ret; | |
634 | } | |
635 | ||
96c8f06a | 636 | /* rtc_timer_cancel - Stops an rtc_timer |
6610e089 JS |
637 | * @ rtc: rtc device to be used |
638 | * @ timer: timer being set | |
639 | * | |
640 | * Kernel interface to cancel an rtc_timer | |
641 | */ | |
96c8f06a | 642 | int rtc_timer_cancel(struct rtc_device *rtc, struct rtc_timer* timer) |
6610e089 JS |
643 | { |
644 | int ret = 0; | |
645 | mutex_lock(&rtc->ops_lock); | |
646 | if (timer->enabled) | |
96c8f06a | 647 | rtc_timer_remove(rtc, timer); |
6610e089 JS |
648 | timer->enabled = 0; |
649 | mutex_unlock(&rtc->ops_lock); | |
650 | return ret; | |
651 | } | |
652 | ||
653 |