tracing/core: remove unused parameter in tracing_fill_pipe_page()
[linux/fpc-iii.git] / drivers / rtc / rtc-sh.c
blob1c3fc6b428e9a705c8b711053401e859f52bca6d
1 /*
2 * SuperH On-Chip RTC Support
4 * Copyright (C) 2006, 2007, 2008 Paul Mundt
5 * Copyright (C) 2006 Jamie Lenehan
6 * Copyright (C) 2008 Angelo Castello
8 * Based on the old arch/sh/kernel/cpu/rtc.c by:
10 * Copyright (C) 2000 Philipp Rumpf <prumpf@tux.org>
11 * Copyright (C) 1999 Tetsuya Okada & Niibe Yutaka
13 * This file is subject to the terms and conditions of the GNU General Public
14 * License. See the file "COPYING" in the main directory of this archive
15 * for more details.
17 #include <linux/module.h>
18 #include <linux/kernel.h>
19 #include <linux/bcd.h>
20 #include <linux/rtc.h>
21 #include <linux/init.h>
22 #include <linux/platform_device.h>
23 #include <linux/seq_file.h>
24 #include <linux/interrupt.h>
25 #include <linux/spinlock.h>
26 #include <linux/io.h>
27 #include <linux/log2.h>
28 #include <asm/rtc.h>
30 #define DRV_NAME "sh-rtc"
31 #define DRV_VERSION "0.2.0"
33 #define RTC_REG(r) ((r) * rtc_reg_size)
35 #define R64CNT RTC_REG(0)
37 #define RSECCNT RTC_REG(1) /* RTC sec */
38 #define RMINCNT RTC_REG(2) /* RTC min */
39 #define RHRCNT RTC_REG(3) /* RTC hour */
40 #define RWKCNT RTC_REG(4) /* RTC week */
41 #define RDAYCNT RTC_REG(5) /* RTC day */
42 #define RMONCNT RTC_REG(6) /* RTC month */
43 #define RYRCNT RTC_REG(7) /* RTC year */
44 #define RSECAR RTC_REG(8) /* ALARM sec */
45 #define RMINAR RTC_REG(9) /* ALARM min */
46 #define RHRAR RTC_REG(10) /* ALARM hour */
47 #define RWKAR RTC_REG(11) /* ALARM week */
48 #define RDAYAR RTC_REG(12) /* ALARM day */
49 #define RMONAR RTC_REG(13) /* ALARM month */
50 #define RCR1 RTC_REG(14) /* Control */
51 #define RCR2 RTC_REG(15) /* Control */
54 * Note on RYRAR and RCR3: Up until this point most of the register
55 * definitions are consistent across all of the available parts. However,
56 * the placement of the optional RYRAR and RCR3 (the RYRAR control
57 * register used to control RYRCNT/RYRAR compare) varies considerably
58 * across various parts, occasionally being mapped in to a completely
59 * unrelated address space. For proper RYRAR support a separate resource
60 * would have to be handed off, but as this is purely optional in
61 * practice, we simply opt not to support it, thereby keeping the code
62 * quite a bit more simplified.
65 /* ALARM Bits - or with BCD encoded value */
66 #define AR_ENB 0x80 /* Enable for alarm cmp */
68 /* Period Bits */
69 #define PF_HP 0x100 /* Enable Half Period to support 8,32,128Hz */
70 #define PF_COUNT 0x200 /* Half periodic counter */
71 #define PF_OXS 0x400 /* Periodic One x Second */
72 #define PF_KOU 0x800 /* Kernel or User periodic request 1=kernel */
73 #define PF_MASK 0xf00
75 /* RCR1 Bits */
76 #define RCR1_CF 0x80 /* Carry Flag */
77 #define RCR1_CIE 0x10 /* Carry Interrupt Enable */
78 #define RCR1_AIE 0x08 /* Alarm Interrupt Enable */
79 #define RCR1_AF 0x01 /* Alarm Flag */
81 /* RCR2 Bits */
82 #define RCR2_PEF 0x80 /* PEriodic interrupt Flag */
83 #define RCR2_PESMASK 0x70 /* Periodic interrupt Set */
84 #define RCR2_RTCEN 0x08 /* ENable RTC */
85 #define RCR2_ADJ 0x04 /* ADJustment (30-second) */
86 #define RCR2_RESET 0x02 /* Reset bit */
87 #define RCR2_START 0x01 /* Start bit */
89 struct sh_rtc {
90 void __iomem *regbase;
91 unsigned long regsize;
92 struct resource *res;
93 int alarm_irq;
94 int periodic_irq;
95 int carry_irq;
96 struct rtc_device *rtc_dev;
97 spinlock_t lock;
98 unsigned long capabilities; /* See asm-sh/rtc.h for cap bits */
99 unsigned short periodic_freq;
102 static irqreturn_t sh_rtc_interrupt(int irq, void *dev_id)
104 struct sh_rtc *rtc = dev_id;
105 unsigned int tmp;
107 spin_lock(&rtc->lock);
109 tmp = readb(rtc->regbase + RCR1);
110 tmp &= ~RCR1_CF;
111 writeb(tmp, rtc->regbase + RCR1);
113 /* Users have requested One x Second IRQ */
114 if (rtc->periodic_freq & PF_OXS)
115 rtc_update_irq(rtc->rtc_dev, 1, RTC_UF | RTC_IRQF);
117 spin_unlock(&rtc->lock);
119 return IRQ_HANDLED;
122 static irqreturn_t sh_rtc_alarm(int irq, void *dev_id)
124 struct sh_rtc *rtc = dev_id;
125 unsigned int tmp;
127 spin_lock(&rtc->lock);
129 tmp = readb(rtc->regbase + RCR1);
130 tmp &= ~(RCR1_AF | RCR1_AIE);
131 writeb(tmp, rtc->regbase + RCR1);
133 rtc_update_irq(rtc->rtc_dev, 1, RTC_AF | RTC_IRQF);
135 spin_unlock(&rtc->lock);
137 return IRQ_HANDLED;
140 static irqreturn_t sh_rtc_periodic(int irq, void *dev_id)
142 struct sh_rtc *rtc = dev_id;
143 struct rtc_device *rtc_dev = rtc->rtc_dev;
144 unsigned int tmp;
146 spin_lock(&rtc->lock);
148 tmp = readb(rtc->regbase + RCR2);
149 tmp &= ~RCR2_PEF;
150 writeb(tmp, rtc->regbase + RCR2);
152 /* Half period enabled than one skipped and the next notified */
153 if ((rtc->periodic_freq & PF_HP) && (rtc->periodic_freq & PF_COUNT))
154 rtc->periodic_freq &= ~PF_COUNT;
155 else {
156 if (rtc->periodic_freq & PF_HP)
157 rtc->periodic_freq |= PF_COUNT;
158 if (rtc->periodic_freq & PF_KOU) {
159 spin_lock(&rtc_dev->irq_task_lock);
160 if (rtc_dev->irq_task)
161 rtc_dev->irq_task->func(rtc_dev->irq_task->private_data);
162 spin_unlock(&rtc_dev->irq_task_lock);
163 } else
164 rtc_update_irq(rtc->rtc_dev, 1, RTC_PF | RTC_IRQF);
167 spin_unlock(&rtc->lock);
169 return IRQ_HANDLED;
172 static inline void sh_rtc_setpie(struct device *dev, unsigned int enable)
174 struct sh_rtc *rtc = dev_get_drvdata(dev);
175 unsigned int tmp;
177 spin_lock_irq(&rtc->lock);
179 tmp = readb(rtc->regbase + RCR2);
181 if (enable) {
182 tmp &= ~RCR2_PEF; /* Clear PES bit */
183 tmp |= (rtc->periodic_freq & ~PF_HP); /* Set PES2-0 */
184 } else
185 tmp &= ~(RCR2_PESMASK | RCR2_PEF);
187 writeb(tmp, rtc->regbase + RCR2);
189 spin_unlock_irq(&rtc->lock);
192 static inline int sh_rtc_setfreq(struct device *dev, unsigned int freq)
194 struct sh_rtc *rtc = dev_get_drvdata(dev);
195 int tmp, ret = 0;
197 spin_lock_irq(&rtc->lock);
198 tmp = rtc->periodic_freq & PF_MASK;
200 switch (freq) {
201 case 0:
202 rtc->periodic_freq = 0x00;
203 break;
204 case 1:
205 rtc->periodic_freq = 0x60;
206 break;
207 case 2:
208 rtc->periodic_freq = 0x50;
209 break;
210 case 4:
211 rtc->periodic_freq = 0x40;
212 break;
213 case 8:
214 rtc->periodic_freq = 0x30 | PF_HP;
215 break;
216 case 16:
217 rtc->periodic_freq = 0x30;
218 break;
219 case 32:
220 rtc->periodic_freq = 0x20 | PF_HP;
221 break;
222 case 64:
223 rtc->periodic_freq = 0x20;
224 break;
225 case 128:
226 rtc->periodic_freq = 0x10 | PF_HP;
227 break;
228 case 256:
229 rtc->periodic_freq = 0x10;
230 break;
231 default:
232 ret = -ENOTSUPP;
235 if (ret == 0) {
236 rtc->periodic_freq |= tmp;
237 rtc->rtc_dev->irq_freq = freq;
240 spin_unlock_irq(&rtc->lock);
241 return ret;
244 static inline void sh_rtc_setaie(struct device *dev, unsigned int enable)
246 struct sh_rtc *rtc = dev_get_drvdata(dev);
247 unsigned int tmp;
249 spin_lock_irq(&rtc->lock);
251 tmp = readb(rtc->regbase + RCR1);
253 if (!enable)
254 tmp &= ~RCR1_AIE;
255 else
256 tmp |= RCR1_AIE;
258 writeb(tmp, rtc->regbase + RCR1);
260 spin_unlock_irq(&rtc->lock);
263 static int sh_rtc_proc(struct device *dev, struct seq_file *seq)
265 struct sh_rtc *rtc = dev_get_drvdata(dev);
266 unsigned int tmp;
268 tmp = readb(rtc->regbase + RCR1);
269 seq_printf(seq, "carry_IRQ\t: %s\n", (tmp & RCR1_CIE) ? "yes" : "no");
271 tmp = readb(rtc->regbase + RCR2);
272 seq_printf(seq, "periodic_IRQ\t: %s\n",
273 (tmp & RCR2_PESMASK) ? "yes" : "no");
275 return 0;
278 static int sh_rtc_ioctl(struct device *dev, unsigned int cmd, unsigned long arg)
280 struct sh_rtc *rtc = dev_get_drvdata(dev);
281 unsigned int ret = 0;
283 switch (cmd) {
284 case RTC_PIE_OFF:
285 case RTC_PIE_ON:
286 sh_rtc_setpie(dev, cmd == RTC_PIE_ON);
287 break;
288 case RTC_AIE_OFF:
289 case RTC_AIE_ON:
290 sh_rtc_setaie(dev, cmd == RTC_AIE_ON);
291 break;
292 case RTC_UIE_OFF:
293 rtc->periodic_freq &= ~PF_OXS;
294 break;
295 case RTC_UIE_ON:
296 rtc->periodic_freq |= PF_OXS;
297 break;
298 case RTC_IRQP_READ:
299 ret = put_user(rtc->rtc_dev->irq_freq,
300 (unsigned long __user *)arg);
301 break;
302 case RTC_IRQP_SET:
303 ret = sh_rtc_setfreq(dev, arg);
304 break;
305 default:
306 ret = -ENOIOCTLCMD;
309 return ret;
312 static int sh_rtc_read_time(struct device *dev, struct rtc_time *tm)
314 struct platform_device *pdev = to_platform_device(dev);
315 struct sh_rtc *rtc = platform_get_drvdata(pdev);
316 unsigned int sec128, sec2, yr, yr100, cf_bit;
318 do {
319 unsigned int tmp;
321 spin_lock_irq(&rtc->lock);
323 tmp = readb(rtc->regbase + RCR1);
324 tmp &= ~RCR1_CF; /* Clear CF-bit */
325 tmp |= RCR1_CIE;
326 writeb(tmp, rtc->regbase + RCR1);
328 sec128 = readb(rtc->regbase + R64CNT);
330 tm->tm_sec = bcd2bin(readb(rtc->regbase + RSECCNT));
331 tm->tm_min = bcd2bin(readb(rtc->regbase + RMINCNT));
332 tm->tm_hour = bcd2bin(readb(rtc->regbase + RHRCNT));
333 tm->tm_wday = bcd2bin(readb(rtc->regbase + RWKCNT));
334 tm->tm_mday = bcd2bin(readb(rtc->regbase + RDAYCNT));
335 tm->tm_mon = bcd2bin(readb(rtc->regbase + RMONCNT)) - 1;
337 if (rtc->capabilities & RTC_CAP_4_DIGIT_YEAR) {
338 yr = readw(rtc->regbase + RYRCNT);
339 yr100 = bcd2bin(yr >> 8);
340 yr &= 0xff;
341 } else {
342 yr = readb(rtc->regbase + RYRCNT);
343 yr100 = bcd2bin((yr == 0x99) ? 0x19 : 0x20);
346 tm->tm_year = (yr100 * 100 + bcd2bin(yr)) - 1900;
348 sec2 = readb(rtc->regbase + R64CNT);
349 cf_bit = readb(rtc->regbase + RCR1) & RCR1_CF;
351 spin_unlock_irq(&rtc->lock);
352 } while (cf_bit != 0 || ((sec128 ^ sec2) & RTC_BIT_INVERTED) != 0);
354 #if RTC_BIT_INVERTED != 0
355 if ((sec128 & RTC_BIT_INVERTED))
356 tm->tm_sec--;
357 #endif
359 dev_dbg(dev, "%s: tm is secs=%d, mins=%d, hours=%d, "
360 "mday=%d, mon=%d, year=%d, wday=%d\n",
361 __func__,
362 tm->tm_sec, tm->tm_min, tm->tm_hour,
363 tm->tm_mday, tm->tm_mon + 1, tm->tm_year, tm->tm_wday);
365 if (rtc_valid_tm(tm) < 0) {
366 dev_err(dev, "invalid date\n");
367 rtc_time_to_tm(0, tm);
370 return 0;
373 static int sh_rtc_set_time(struct device *dev, struct rtc_time *tm)
375 struct platform_device *pdev = to_platform_device(dev);
376 struct sh_rtc *rtc = platform_get_drvdata(pdev);
377 unsigned int tmp;
378 int year;
380 spin_lock_irq(&rtc->lock);
382 /* Reset pre-scaler & stop RTC */
383 tmp = readb(rtc->regbase + RCR2);
384 tmp |= RCR2_RESET;
385 tmp &= ~RCR2_START;
386 writeb(tmp, rtc->regbase + RCR2);
388 writeb(bin2bcd(tm->tm_sec), rtc->regbase + RSECCNT);
389 writeb(bin2bcd(tm->tm_min), rtc->regbase + RMINCNT);
390 writeb(bin2bcd(tm->tm_hour), rtc->regbase + RHRCNT);
391 writeb(bin2bcd(tm->tm_wday), rtc->regbase + RWKCNT);
392 writeb(bin2bcd(tm->tm_mday), rtc->regbase + RDAYCNT);
393 writeb(bin2bcd(tm->tm_mon + 1), rtc->regbase + RMONCNT);
395 if (rtc->capabilities & RTC_CAP_4_DIGIT_YEAR) {
396 year = (bin2bcd((tm->tm_year + 1900) / 100) << 8) |
397 bin2bcd(tm->tm_year % 100);
398 writew(year, rtc->regbase + RYRCNT);
399 } else {
400 year = tm->tm_year % 100;
401 writeb(bin2bcd(year), rtc->regbase + RYRCNT);
404 /* Start RTC */
405 tmp = readb(rtc->regbase + RCR2);
406 tmp &= ~RCR2_RESET;
407 tmp |= RCR2_RTCEN | RCR2_START;
408 writeb(tmp, rtc->regbase + RCR2);
410 spin_unlock_irq(&rtc->lock);
412 return 0;
415 static inline int sh_rtc_read_alarm_value(struct sh_rtc *rtc, int reg_off)
417 unsigned int byte;
418 int value = 0xff; /* return 0xff for ignored values */
420 byte = readb(rtc->regbase + reg_off);
421 if (byte & AR_ENB) {
422 byte &= ~AR_ENB; /* strip the enable bit */
423 value = bcd2bin(byte);
426 return value;
429 static int sh_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *wkalrm)
431 struct platform_device *pdev = to_platform_device(dev);
432 struct sh_rtc *rtc = platform_get_drvdata(pdev);
433 struct rtc_time *tm = &wkalrm->time;
435 spin_lock_irq(&rtc->lock);
437 tm->tm_sec = sh_rtc_read_alarm_value(rtc, RSECAR);
438 tm->tm_min = sh_rtc_read_alarm_value(rtc, RMINAR);
439 tm->tm_hour = sh_rtc_read_alarm_value(rtc, RHRAR);
440 tm->tm_wday = sh_rtc_read_alarm_value(rtc, RWKAR);
441 tm->tm_mday = sh_rtc_read_alarm_value(rtc, RDAYAR);
442 tm->tm_mon = sh_rtc_read_alarm_value(rtc, RMONAR);
443 if (tm->tm_mon > 0)
444 tm->tm_mon -= 1; /* RTC is 1-12, tm_mon is 0-11 */
445 tm->tm_year = 0xffff;
447 wkalrm->enabled = (readb(rtc->regbase + RCR1) & RCR1_AIE) ? 1 : 0;
449 spin_unlock_irq(&rtc->lock);
451 return 0;
454 static inline void sh_rtc_write_alarm_value(struct sh_rtc *rtc,
455 int value, int reg_off)
457 /* < 0 for a value that is ignored */
458 if (value < 0)
459 writeb(0, rtc->regbase + reg_off);
460 else
461 writeb(bin2bcd(value) | AR_ENB, rtc->regbase + reg_off);
464 static int sh_rtc_check_alarm(struct rtc_time *tm)
467 * The original rtc says anything > 0xc0 is "don't care" or "match
468 * all" - most users use 0xff but rtc-dev uses -1 for the same thing.
469 * The original rtc doesn't support years - some things use -1 and
470 * some 0xffff. We use -1 to make out tests easier.
472 if (tm->tm_year == 0xffff)
473 tm->tm_year = -1;
474 if (tm->tm_mon >= 0xff)
475 tm->tm_mon = -1;
476 if (tm->tm_mday >= 0xff)
477 tm->tm_mday = -1;
478 if (tm->tm_wday >= 0xff)
479 tm->tm_wday = -1;
480 if (tm->tm_hour >= 0xff)
481 tm->tm_hour = -1;
482 if (tm->tm_min >= 0xff)
483 tm->tm_min = -1;
484 if (tm->tm_sec >= 0xff)
485 tm->tm_sec = -1;
487 if (tm->tm_year > 9999 ||
488 tm->tm_mon >= 12 ||
489 tm->tm_mday == 0 || tm->tm_mday >= 32 ||
490 tm->tm_wday >= 7 ||
491 tm->tm_hour >= 24 ||
492 tm->tm_min >= 60 ||
493 tm->tm_sec >= 60)
494 return -EINVAL;
496 return 0;
499 static int sh_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *wkalrm)
501 struct platform_device *pdev = to_platform_device(dev);
502 struct sh_rtc *rtc = platform_get_drvdata(pdev);
503 unsigned int rcr1;
504 struct rtc_time *tm = &wkalrm->time;
505 int mon, err;
507 err = sh_rtc_check_alarm(tm);
508 if (unlikely(err < 0))
509 return err;
511 spin_lock_irq(&rtc->lock);
513 /* disable alarm interrupt and clear the alarm flag */
514 rcr1 = readb(rtc->regbase + RCR1);
515 rcr1 &= ~(RCR1_AF | RCR1_AIE);
516 writeb(rcr1, rtc->regbase + RCR1);
518 /* set alarm time */
519 sh_rtc_write_alarm_value(rtc, tm->tm_sec, RSECAR);
520 sh_rtc_write_alarm_value(rtc, tm->tm_min, RMINAR);
521 sh_rtc_write_alarm_value(rtc, tm->tm_hour, RHRAR);
522 sh_rtc_write_alarm_value(rtc, tm->tm_wday, RWKAR);
523 sh_rtc_write_alarm_value(rtc, tm->tm_mday, RDAYAR);
524 mon = tm->tm_mon;
525 if (mon >= 0)
526 mon += 1;
527 sh_rtc_write_alarm_value(rtc, mon, RMONAR);
529 if (wkalrm->enabled) {
530 rcr1 |= RCR1_AIE;
531 writeb(rcr1, rtc->regbase + RCR1);
534 spin_unlock_irq(&rtc->lock);
536 return 0;
539 static int sh_rtc_irq_set_state(struct device *dev, int enabled)
541 struct platform_device *pdev = to_platform_device(dev);
542 struct sh_rtc *rtc = platform_get_drvdata(pdev);
544 if (enabled) {
545 rtc->periodic_freq |= PF_KOU;
546 return sh_rtc_ioctl(dev, RTC_PIE_ON, 0);
547 } else {
548 rtc->periodic_freq &= ~PF_KOU;
549 return sh_rtc_ioctl(dev, RTC_PIE_OFF, 0);
553 static int sh_rtc_irq_set_freq(struct device *dev, int freq)
555 if (!is_power_of_2(freq))
556 return -EINVAL;
557 return sh_rtc_ioctl(dev, RTC_IRQP_SET, freq);
560 static struct rtc_class_ops sh_rtc_ops = {
561 .ioctl = sh_rtc_ioctl,
562 .read_time = sh_rtc_read_time,
563 .set_time = sh_rtc_set_time,
564 .read_alarm = sh_rtc_read_alarm,
565 .set_alarm = sh_rtc_set_alarm,
566 .irq_set_state = sh_rtc_irq_set_state,
567 .irq_set_freq = sh_rtc_irq_set_freq,
568 .proc = sh_rtc_proc,
571 static int __devinit sh_rtc_probe(struct platform_device *pdev)
573 struct sh_rtc *rtc;
574 struct resource *res;
575 unsigned int tmp;
576 int ret;
578 rtc = kzalloc(sizeof(struct sh_rtc), GFP_KERNEL);
579 if (unlikely(!rtc))
580 return -ENOMEM;
582 spin_lock_init(&rtc->lock);
584 /* get periodic/carry/alarm irqs */
585 ret = platform_get_irq(pdev, 0);
586 if (unlikely(ret <= 0)) {
587 ret = -ENOENT;
588 dev_err(&pdev->dev, "No IRQ for period\n");
589 goto err_badres;
591 rtc->periodic_irq = ret;
593 ret = platform_get_irq(pdev, 1);
594 if (unlikely(ret <= 0)) {
595 ret = -ENOENT;
596 dev_err(&pdev->dev, "No IRQ for carry\n");
597 goto err_badres;
599 rtc->carry_irq = ret;
601 ret = platform_get_irq(pdev, 2);
602 if (unlikely(ret <= 0)) {
603 ret = -ENOENT;
604 dev_err(&pdev->dev, "No IRQ for alarm\n");
605 goto err_badres;
607 rtc->alarm_irq = ret;
609 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
610 if (unlikely(res == NULL)) {
611 ret = -ENOENT;
612 dev_err(&pdev->dev, "No IO resource\n");
613 goto err_badres;
616 rtc->regsize = res->end - res->start + 1;
618 rtc->res = request_mem_region(res->start, rtc->regsize, pdev->name);
619 if (unlikely(!rtc->res)) {
620 ret = -EBUSY;
621 goto err_badres;
624 rtc->regbase = ioremap_nocache(rtc->res->start, rtc->regsize);
625 if (unlikely(!rtc->regbase)) {
626 ret = -EINVAL;
627 goto err_badmap;
630 rtc->rtc_dev = rtc_device_register("sh", &pdev->dev,
631 &sh_rtc_ops, THIS_MODULE);
632 if (IS_ERR(rtc->rtc_dev)) {
633 ret = PTR_ERR(rtc->rtc_dev);
634 goto err_unmap;
637 rtc->capabilities = RTC_DEF_CAPABILITIES;
638 if (pdev->dev.platform_data) {
639 struct sh_rtc_platform_info *pinfo = pdev->dev.platform_data;
642 * Some CPUs have special capabilities in addition to the
643 * default set. Add those in here.
645 rtc->capabilities |= pinfo->capabilities;
648 rtc->rtc_dev->max_user_freq = 256;
649 rtc->rtc_dev->irq_freq = 1;
650 rtc->periodic_freq = 0x60;
652 platform_set_drvdata(pdev, rtc);
654 /* register periodic/carry/alarm irqs */
655 ret = request_irq(rtc->periodic_irq, sh_rtc_periodic, IRQF_DISABLED,
656 "sh-rtc period", rtc);
657 if (unlikely(ret)) {
658 dev_err(&pdev->dev,
659 "request period IRQ failed with %d, IRQ %d\n", ret,
660 rtc->periodic_irq);
661 goto err_unmap;
664 ret = request_irq(rtc->carry_irq, sh_rtc_interrupt, IRQF_DISABLED,
665 "sh-rtc carry", rtc);
666 if (unlikely(ret)) {
667 dev_err(&pdev->dev,
668 "request carry IRQ failed with %d, IRQ %d\n", ret,
669 rtc->carry_irq);
670 free_irq(rtc->periodic_irq, rtc);
671 goto err_unmap;
674 ret = request_irq(rtc->alarm_irq, sh_rtc_alarm, IRQF_DISABLED,
675 "sh-rtc alarm", rtc);
676 if (unlikely(ret)) {
677 dev_err(&pdev->dev,
678 "request alarm IRQ failed with %d, IRQ %d\n", ret,
679 rtc->alarm_irq);
680 free_irq(rtc->carry_irq, rtc);
681 free_irq(rtc->periodic_irq, rtc);
682 goto err_unmap;
685 tmp = readb(rtc->regbase + RCR1);
686 tmp &= ~RCR1_CF;
687 tmp |= RCR1_CIE;
688 writeb(tmp, rtc->regbase + RCR1);
690 return 0;
692 err_unmap:
693 iounmap(rtc->regbase);
694 err_badmap:
695 release_resource(rtc->res);
696 err_badres:
697 kfree(rtc);
699 return ret;
702 static int __devexit sh_rtc_remove(struct platform_device *pdev)
704 struct sh_rtc *rtc = platform_get_drvdata(pdev);
706 if (likely(rtc->rtc_dev))
707 rtc_device_unregister(rtc->rtc_dev);
709 sh_rtc_setpie(&pdev->dev, 0);
710 sh_rtc_setaie(&pdev->dev, 0);
712 free_irq(rtc->carry_irq, rtc);
713 free_irq(rtc->periodic_irq, rtc);
714 free_irq(rtc->alarm_irq, rtc);
716 release_resource(rtc->res);
718 iounmap(rtc->regbase);
720 platform_set_drvdata(pdev, NULL);
722 kfree(rtc);
724 return 0;
726 static struct platform_driver sh_rtc_platform_driver = {
727 .driver = {
728 .name = DRV_NAME,
729 .owner = THIS_MODULE,
731 .probe = sh_rtc_probe,
732 .remove = __devexit_p(sh_rtc_remove),
735 static int __init sh_rtc_init(void)
737 return platform_driver_register(&sh_rtc_platform_driver);
740 static void __exit sh_rtc_exit(void)
742 platform_driver_unregister(&sh_rtc_platform_driver);
745 module_init(sh_rtc_init);
746 module_exit(sh_rtc_exit);
748 MODULE_DESCRIPTION("SuperH on-chip RTC driver");
749 MODULE_VERSION(DRV_VERSION);
750 MODULE_AUTHOR("Paul Mundt <lethal@linux-sh.org>, "
751 "Jamie Lenehan <lenehan@twibble.org>, "
752 "Angelo Castello <angelo.castello@st.com>");
753 MODULE_LICENSE("GPL");
754 MODULE_ALIAS("platform:" DRV_NAME);