1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include <linux/kernel.h>
22#include <linux/errno.h>
23#include <linux/init.h>
24#include <linux/module.h>
25#include <linux/types.h>
26#include <linux/rtc.h>
27#include <linux/bcd.h>
28#include <linux/platform_device.h>
29#include <linux/interrupt.h>
30
31#include <linux/i2c/twl4030.h>
32
33
34
35
36
37#define REG_SECONDS_REG 0x00
38#define REG_MINUTES_REG 0x01
39#define REG_HOURS_REG 0x02
40#define REG_DAYS_REG 0x03
41#define REG_MONTHS_REG 0x04
42#define REG_YEARS_REG 0x05
43#define REG_WEEKS_REG 0x06
44
45#define REG_ALARM_SECONDS_REG 0x07
46#define REG_ALARM_MINUTES_REG 0x08
47#define REG_ALARM_HOURS_REG 0x09
48#define REG_ALARM_DAYS_REG 0x0A
49#define REG_ALARM_MONTHS_REG 0x0B
50#define REG_ALARM_YEARS_REG 0x0C
51
52#define REG_RTC_CTRL_REG 0x0D
53#define REG_RTC_STATUS_REG 0x0E
54#define REG_RTC_INTERRUPTS_REG 0x0F
55
56#define REG_RTC_COMP_LSB_REG 0x10
57#define REG_RTC_COMP_MSB_REG 0x11
58
59
60#define BIT_RTC_CTRL_REG_STOP_RTC_M 0x01
61#define BIT_RTC_CTRL_REG_ROUND_30S_M 0x02
62#define BIT_RTC_CTRL_REG_AUTO_COMP_M 0x04
63#define BIT_RTC_CTRL_REG_MODE_12_24_M 0x08
64#define BIT_RTC_CTRL_REG_TEST_MODE_M 0x10
65#define BIT_RTC_CTRL_REG_SET_32_COUNTER_M 0x20
66#define BIT_RTC_CTRL_REG_GET_TIME_M 0x40
67
68
69#define BIT_RTC_STATUS_REG_RUN_M 0x02
70#define BIT_RTC_STATUS_REG_1S_EVENT_M 0x04
71#define BIT_RTC_STATUS_REG_1M_EVENT_M 0x08
72#define BIT_RTC_STATUS_REG_1H_EVENT_M 0x10
73#define BIT_RTC_STATUS_REG_1D_EVENT_M 0x20
74#define BIT_RTC_STATUS_REG_ALARM_M 0x40
75#define BIT_RTC_STATUS_REG_POWER_UP_M 0x80
76
77
78#define BIT_RTC_INTERRUPTS_REG_EVERY_M 0x03
79#define BIT_RTC_INTERRUPTS_REG_IT_TIMER_M 0x04
80#define BIT_RTC_INTERRUPTS_REG_IT_ALARM_M 0x08
81
82
83
84#define ALL_TIME_REGS 6
85
86
87
88
89
90
91static int twl4030_rtc_read_u8(u8 *data, u8 reg)
92{
93 int ret;
94
95 ret = twl4030_i2c_read_u8(TWL4030_MODULE_RTC, data, reg);
96 if (ret < 0)
97 pr_err("twl4030_rtc: Could not read TWL4030"
98 "register %X - error %d\n", reg, ret);
99 return ret;
100}
101
102
103
104
105static int twl4030_rtc_write_u8(u8 data, u8 reg)
106{
107 int ret;
108
109 ret = twl4030_i2c_write_u8(TWL4030_MODULE_RTC, data, reg);
110 if (ret < 0)
111 pr_err("twl4030_rtc: Could not write TWL4030"
112 "register %X - error %d\n", reg, ret);
113 return ret;
114}
115
116
117
118
119
120static unsigned char rtc_irq_bits;
121
122
123
124
125static int set_rtc_irq_bit(unsigned char bit)
126{
127 unsigned char val;
128 int ret;
129
130 val = rtc_irq_bits | bit;
131 val &= ~BIT_RTC_INTERRUPTS_REG_EVERY_M;
132 ret = twl4030_rtc_write_u8(val, REG_RTC_INTERRUPTS_REG);
133 if (ret == 0)
134 rtc_irq_bits = val;
135
136 return ret;
137}
138
139
140
141
142static int mask_rtc_irq_bit(unsigned char bit)
143{
144 unsigned char val;
145 int ret;
146
147 val = rtc_irq_bits & ~bit;
148 ret = twl4030_rtc_write_u8(val, REG_RTC_INTERRUPTS_REG);
149 if (ret == 0)
150 rtc_irq_bits = val;
151
152 return ret;
153}
154
155static int twl4030_rtc_alarm_irq_enable(struct device *dev, unsigned enabled)
156{
157 int ret;
158
159 if (enabled)
160 ret = set_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_ALARM_M);
161 else
162 ret = mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_ALARM_M);
163
164 return ret;
165}
166
167static int twl4030_rtc_update_irq_enable(struct device *dev, unsigned enabled)
168{
169 int ret;
170
171 if (enabled)
172 ret = set_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_TIMER_M);
173 else
174 ret = mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_TIMER_M);
175
176 return ret;
177}
178
179
180
181
182
183
184
185
186
187
188static int twl4030_rtc_read_time(struct device *dev, struct rtc_time *tm)
189{
190 unsigned char rtc_data[ALL_TIME_REGS + 1];
191 int ret;
192 u8 save_control;
193
194 ret = twl4030_rtc_read_u8(&save_control, REG_RTC_CTRL_REG);
195 if (ret < 0)
196 return ret;
197
198 save_control |= BIT_RTC_CTRL_REG_GET_TIME_M;
199
200 ret = twl4030_rtc_write_u8(save_control, REG_RTC_CTRL_REG);
201 if (ret < 0)
202 return ret;
203
204 ret = twl4030_i2c_read(TWL4030_MODULE_RTC, rtc_data,
205 REG_SECONDS_REG, ALL_TIME_REGS);
206
207 if (ret < 0) {
208 dev_err(dev, "rtc_read_time error %d\n", ret);
209 return ret;
210 }
211
212 tm->tm_sec = bcd2bin(rtc_data[0]);
213 tm->tm_min = bcd2bin(rtc_data[1]);
214 tm->tm_hour = bcd2bin(rtc_data[2]);
215 tm->tm_mday = bcd2bin(rtc_data[3]);
216 tm->tm_mon = bcd2bin(rtc_data[4]) - 1;
217 tm->tm_year = bcd2bin(rtc_data[5]) + 100;
218
219 return ret;
220}
221
222static int twl4030_rtc_set_time(struct device *dev, struct rtc_time *tm)
223{
224 unsigned char save_control;
225 unsigned char rtc_data[ALL_TIME_REGS + 1];
226 int ret;
227
228 rtc_data[1] = bin2bcd(tm->tm_sec);
229 rtc_data[2] = bin2bcd(tm->tm_min);
230 rtc_data[3] = bin2bcd(tm->tm_hour);
231 rtc_data[4] = bin2bcd(tm->tm_mday);
232 rtc_data[5] = bin2bcd(tm->tm_mon + 1);
233 rtc_data[6] = bin2bcd(tm->tm_year - 100);
234
235
236 ret = twl4030_rtc_read_u8(&save_control, REG_RTC_CTRL_REG);
237 if (ret < 0)
238 goto out;
239
240 save_control &= ~BIT_RTC_CTRL_REG_STOP_RTC_M;
241 twl4030_rtc_write_u8(save_control, REG_RTC_CTRL_REG);
242 if (ret < 0)
243 goto out;
244
245
246 ret = twl4030_i2c_write(TWL4030_MODULE_RTC, rtc_data,
247 REG_SECONDS_REG, ALL_TIME_REGS);
248 if (ret < 0) {
249 dev_err(dev, "rtc_set_time error %d\n", ret);
250 goto out;
251 }
252
253
254 save_control |= BIT_RTC_CTRL_REG_STOP_RTC_M;
255 ret = twl4030_rtc_write_u8(save_control, REG_RTC_CTRL_REG);
256
257out:
258 return ret;
259}
260
261
262
263
264static int twl4030_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alm)
265{
266 unsigned char rtc_data[ALL_TIME_REGS + 1];
267 int ret;
268
269 ret = twl4030_i2c_read(TWL4030_MODULE_RTC, rtc_data,
270 REG_ALARM_SECONDS_REG, ALL_TIME_REGS);
271 if (ret < 0) {
272 dev_err(dev, "rtc_read_alarm error %d\n", ret);
273 return ret;
274 }
275
276
277 alm->time.tm_sec = bcd2bin(rtc_data[0]);
278 alm->time.tm_min = bcd2bin(rtc_data[1]);
279 alm->time.tm_hour = bcd2bin(rtc_data[2]);
280 alm->time.tm_mday = bcd2bin(rtc_data[3]);
281 alm->time.tm_mon = bcd2bin(rtc_data[4]) - 1;
282 alm->time.tm_year = bcd2bin(rtc_data[5]) + 100;
283
284
285 if (rtc_irq_bits & BIT_RTC_INTERRUPTS_REG_IT_ALARM_M)
286 alm->enabled = 1;
287
288 return ret;
289}
290
291static int twl4030_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alm)
292{
293 unsigned char alarm_data[ALL_TIME_REGS + 1];
294 int ret;
295
296 ret = twl4030_rtc_alarm_irq_enable(dev, 0);
297 if (ret)
298 goto out;
299
300 alarm_data[1] = bin2bcd(alm->time.tm_sec);
301 alarm_data[2] = bin2bcd(alm->time.tm_min);
302 alarm_data[3] = bin2bcd(alm->time.tm_hour);
303 alarm_data[4] = bin2bcd(alm->time.tm_mday);
304 alarm_data[5] = bin2bcd(alm->time.tm_mon + 1);
305 alarm_data[6] = bin2bcd(alm->time.tm_year - 100);
306
307
308 ret = twl4030_i2c_write(TWL4030_MODULE_RTC, alarm_data,
309 REG_ALARM_SECONDS_REG, ALL_TIME_REGS);
310 if (ret) {
311 dev_err(dev, "rtc_set_alarm error %d\n", ret);
312 goto out;
313 }
314
315 if (alm->enabled)
316 ret = twl4030_rtc_alarm_irq_enable(dev, 1);
317out:
318 return ret;
319}
320
321static irqreturn_t twl4030_rtc_interrupt(int irq, void *rtc)
322{
323 unsigned long events = 0;
324 int ret = IRQ_NONE;
325 int res;
326 u8 rd_reg;
327
328#ifdef CONFIG_LOCKDEP
329
330
331
332
333 local_irq_enable();
334#endif
335
336 res = twl4030_rtc_read_u8(&rd_reg, REG_RTC_STATUS_REG);
337 if (res)
338 goto out;
339
340
341
342
343
344
345 if (rd_reg & BIT_RTC_STATUS_REG_ALARM_M)
346 events |= RTC_IRQF | RTC_AF;
347 else
348 events |= RTC_IRQF | RTC_UF;
349
350 res = twl4030_rtc_write_u8(rd_reg | BIT_RTC_STATUS_REG_ALARM_M,
351 REG_RTC_STATUS_REG);
352 if (res)
353 goto out;
354
355
356
357
358
359
360
361
362
363
364
365
366 res = twl4030_i2c_read_u8(TWL4030_MODULE_INT,
367 &rd_reg, TWL4030_INT_PWR_ISR1);
368 if (res)
369 goto out;
370
371
372 rtc_update_irq(rtc, 1, events);
373
374 ret = IRQ_HANDLED;
375out:
376 return ret;
377}
378
379static struct rtc_class_ops twl4030_rtc_ops = {
380 .read_time = twl4030_rtc_read_time,
381 .set_time = twl4030_rtc_set_time,
382 .read_alarm = twl4030_rtc_read_alarm,
383 .set_alarm = twl4030_rtc_set_alarm,
384 .alarm_irq_enable = twl4030_rtc_alarm_irq_enable,
385 .update_irq_enable = twl4030_rtc_update_irq_enable,
386};
387
388
389
390static int __devinit twl4030_rtc_probe(struct platform_device *pdev)
391{
392 struct rtc_device *rtc;
393 int ret = 0;
394 int irq = platform_get_irq(pdev, 0);
395 u8 rd_reg;
396
397 if (irq <= 0)
398 return -EINVAL;
399
400 rtc = rtc_device_register(pdev->name,
401 &pdev->dev, &twl4030_rtc_ops, THIS_MODULE);
402 if (IS_ERR(rtc)) {
403 ret = PTR_ERR(rtc);
404 dev_err(&pdev->dev, "can't register RTC device, err %ld\n",
405 PTR_ERR(rtc));
406 goto out0;
407
408 }
409
410 platform_set_drvdata(pdev, rtc);
411
412 ret = twl4030_rtc_read_u8(&rd_reg, REG_RTC_STATUS_REG);
413 if (ret < 0)
414 goto out1;
415
416 if (rd_reg & BIT_RTC_STATUS_REG_POWER_UP_M)
417 dev_warn(&pdev->dev, "Power up reset detected.\n");
418
419 if (rd_reg & BIT_RTC_STATUS_REG_ALARM_M)
420 dev_warn(&pdev->dev, "Pending Alarm interrupt detected.\n");
421
422
423 ret = twl4030_rtc_write_u8(rd_reg, REG_RTC_STATUS_REG);
424 if (ret < 0)
425 goto out1;
426
427 ret = request_irq(irq, twl4030_rtc_interrupt,
428 IRQF_TRIGGER_RISING,
429 dev_name(&rtc->dev), rtc);
430 if (ret < 0) {
431 dev_err(&pdev->dev, "IRQ is not free.\n");
432 goto out1;
433 }
434
435
436 ret = twl4030_rtc_read_u8(&rd_reg, REG_RTC_CTRL_REG);
437 if (ret < 0)
438 goto out2;
439
440 if (!(rd_reg & BIT_RTC_CTRL_REG_STOP_RTC_M)) {
441 dev_info(&pdev->dev, "Enabling TWL4030-RTC.\n");
442 rd_reg = BIT_RTC_CTRL_REG_STOP_RTC_M;
443 ret = twl4030_rtc_write_u8(rd_reg, REG_RTC_CTRL_REG);
444 if (ret < 0)
445 goto out2;
446 }
447
448
449 ret = twl4030_rtc_read_u8(&rtc_irq_bits, REG_RTC_INTERRUPTS_REG);
450 if (ret < 0)
451 goto out2;
452
453 return ret;
454
455out2:
456 free_irq(irq, rtc);
457out1:
458 rtc_device_unregister(rtc);
459out0:
460 return ret;
461}
462
463
464
465
466
467static int __devexit twl4030_rtc_remove(struct platform_device *pdev)
468{
469
470 struct rtc_device *rtc = platform_get_drvdata(pdev);
471 int irq = platform_get_irq(pdev, 0);
472
473 mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_ALARM_M);
474 mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_TIMER_M);
475
476 free_irq(irq, rtc);
477
478 rtc_device_unregister(rtc);
479 platform_set_drvdata(pdev, NULL);
480 return 0;
481}
482
483static void twl4030_rtc_shutdown(struct platform_device *pdev)
484{
485
486
487 mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_TIMER_M);
488}
489
490#ifdef CONFIG_PM
491
492static unsigned char irqstat;
493
494static int twl4030_rtc_suspend(struct platform_device *pdev, pm_message_t state)
495{
496 irqstat = rtc_irq_bits;
497
498 mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_TIMER_M);
499 return 0;
500}
501
502static int twl4030_rtc_resume(struct platform_device *pdev)
503{
504 set_rtc_irq_bit(irqstat);
505 return 0;
506}
507
508#else
509#define twl4030_rtc_suspend NULL
510#define twl4030_rtc_resume NULL
511#endif
512
513MODULE_ALIAS("platform:twl4030_rtc");
514
515static struct platform_driver twl4030rtc_driver = {
516 .probe = twl4030_rtc_probe,
517 .remove = __devexit_p(twl4030_rtc_remove),
518 .shutdown = twl4030_rtc_shutdown,
519 .suspend = twl4030_rtc_suspend,
520 .resume = twl4030_rtc_resume,
521 .driver = {
522 .owner = THIS_MODULE,
523 .name = "twl4030_rtc",
524 },
525};
526
527static int __init twl4030_rtc_init(void)
528{
529 return platform_driver_register(&twl4030rtc_driver);
530}
531module_init(twl4030_rtc_init);
532
533static void __exit twl4030_rtc_exit(void)
534{
535 platform_driver_unregister(&twl4030rtc_driver);
536}
537module_exit(twl4030_rtc_exit);
538
539MODULE_AUTHOR("Texas Instruments, MontaVista Software");
540MODULE_LICENSE("GPL");
541