xref: /linux/drivers/rtc/rtc-sh.c (revision 99b5aa3c10c7cff1e97239fda93649222fc12d25)
1 /*
2  * SuperH On-Chip RTC Support
3  *
4  * Copyright (C) 2006  Paul Mundt
5  * Copyright (C) 2006  Jamie Lenehan
6  *
7  * Based on the old arch/sh/kernel/cpu/rtc.c by:
8  *
9  *  Copyright (C) 2000  Philipp Rumpf <prumpf@tux.org>
10  *  Copyright (C) 1999  Tetsuya Okada & Niibe Yutaka
11  *
12  * This file is subject to the terms and conditions of the GNU General Public
13  * License.  See the file "COPYING" in the main directory of this archive
14  * for more details.
15  */
16 #include <linux/module.h>
17 #include <linux/kernel.h>
18 #include <linux/bcd.h>
19 #include <linux/rtc.h>
20 #include <linux/init.h>
21 #include <linux/platform_device.h>
22 #include <linux/seq_file.h>
23 #include <linux/interrupt.h>
24 #include <linux/spinlock.h>
25 #include <linux/io.h>
26 
27 #define DRV_NAME	"sh-rtc"
28 #define DRV_VERSION	"0.1.2"
29 
30 #ifdef CONFIG_CPU_SH3
31 #define rtc_reg_size		sizeof(u16)
32 #define RTC_BIT_INVERTED	0	/* No bug on SH7708, SH7709A */
33 #elif defined(CONFIG_CPU_SH4)
34 #define rtc_reg_size		sizeof(u32)
35 #define RTC_BIT_INVERTED	0x40	/* bug on SH7750, SH7750S */
36 #endif
37 
38 #define RTC_REG(r)	((r) * rtc_reg_size)
39 
40 #define R64CNT		RTC_REG(0)
41 
42 #define RSECCNT		RTC_REG(1)	/* RTC sec */
43 #define RMINCNT		RTC_REG(2)	/* RTC min */
44 #define RHRCNT		RTC_REG(3)	/* RTC hour */
45 #define RWKCNT		RTC_REG(4)	/* RTC week */
46 #define RDAYCNT		RTC_REG(5)	/* RTC day */
47 #define RMONCNT		RTC_REG(6)	/* RTC month */
48 #define RYRCNT		RTC_REG(7)	/* RTC year */
49 #define RSECAR		RTC_REG(8)	/* ALARM sec */
50 #define RMINAR		RTC_REG(9)	/* ALARM min */
51 #define RHRAR		RTC_REG(10)	/* ALARM hour */
52 #define RWKAR		RTC_REG(11)	/* ALARM week */
53 #define RDAYAR		RTC_REG(12)	/* ALARM day */
54 #define RMONAR		RTC_REG(13)	/* ALARM month */
55 #define RCR1		RTC_REG(14)	/* Control */
56 #define RCR2		RTC_REG(15)	/* Control */
57 
58 /* ALARM Bits - or with BCD encoded value */
59 #define AR_ENB		0x80	/* Enable for alarm cmp   */
60 
61 /* RCR1 Bits */
62 #define RCR1_CF		0x80	/* Carry Flag             */
63 #define RCR1_CIE	0x10	/* Carry Interrupt Enable */
64 #define RCR1_AIE	0x08	/* Alarm Interrupt Enable */
65 #define RCR1_AF		0x01	/* Alarm Flag             */
66 
67 /* RCR2 Bits */
68 #define RCR2_PEF	0x80	/* PEriodic interrupt Flag */
69 #define RCR2_PESMASK	0x70	/* Periodic interrupt Set  */
70 #define RCR2_RTCEN	0x08	/* ENable RTC              */
71 #define RCR2_ADJ	0x04	/* ADJustment (30-second)  */
72 #define RCR2_RESET	0x02	/* Reset bit               */
73 #define RCR2_START	0x01	/* Start bit               */
74 
75 struct sh_rtc {
76 	void __iomem *regbase;
77 	unsigned long regsize;
78 	struct resource *res;
79 	unsigned int alarm_irq, periodic_irq, carry_irq;
80 	struct rtc_device *rtc_dev;
81 	spinlock_t lock;
82 	int rearm_aie;
83 };
84 
85 static irqreturn_t sh_rtc_interrupt(int irq, void *dev_id)
86 {
87 	struct platform_device *pdev = to_platform_device(dev_id);
88 	struct sh_rtc *rtc = platform_get_drvdata(pdev);
89 	unsigned int tmp, events = 0;
90 
91 	spin_lock(&rtc->lock);
92 
93 	tmp = readb(rtc->regbase + RCR1);
94 	tmp &= ~RCR1_CF;
95 
96 	if (rtc->rearm_aie) {
97 		if (tmp & RCR1_AF)
98 			tmp &= ~RCR1_AF;	/* try to clear AF again */
99 		else {
100 			tmp |= RCR1_AIE;	/* AF has cleared, rearm IRQ */
101 			rtc->rearm_aie = 0;
102 		}
103 	}
104 
105 	writeb(tmp, rtc->regbase + RCR1);
106 
107 	rtc_update_irq(&rtc->rtc_dev->class_dev, 1, events);
108 
109 	spin_unlock(&rtc->lock);
110 
111 	return IRQ_HANDLED;
112 }
113 
114 static irqreturn_t sh_rtc_alarm(int irq, void *dev_id)
115 {
116 	struct platform_device *pdev = to_platform_device(dev_id);
117 	struct sh_rtc *rtc = platform_get_drvdata(pdev);
118 	unsigned int tmp, events = 0;
119 
120 	spin_lock(&rtc->lock);
121 
122 	tmp = readb(rtc->regbase + RCR1);
123 
124 	/*
125 	 * If AF is set then the alarm has triggered. If we clear AF while
126 	 * the alarm time still matches the RTC time then AF will
127 	 * immediately be set again, and if AIE is enabled then the alarm
128 	 * interrupt will immediately be retrigger. So we clear AIE here
129 	 * and use rtc->rearm_aie so that the carry interrupt will keep
130 	 * trying to clear AF and once it stays cleared it'll re-enable
131 	 * AIE.
132 	 */
133 	if (tmp & RCR1_AF) {
134 		events |= RTC_AF | RTC_IRQF;
135 
136 		tmp &= ~(RCR1_AF|RCR1_AIE);
137 
138 		writeb(tmp, rtc->regbase + RCR1);
139 
140 		rtc->rearm_aie = 1;
141 
142 		rtc_update_irq(&rtc->rtc_dev->class_dev, 1, events);
143 	}
144 
145 	spin_unlock(&rtc->lock);
146 	return IRQ_HANDLED;
147 }
148 
149 static irqreturn_t sh_rtc_periodic(int irq, void *dev_id)
150 {
151 	struct platform_device *pdev = to_platform_device(dev_id);
152 	struct sh_rtc *rtc = platform_get_drvdata(pdev);
153 
154 	spin_lock(&rtc->lock);
155 
156 	rtc_update_irq(&rtc->rtc_dev->class_dev, 1, RTC_PF | RTC_IRQF);
157 
158 	spin_unlock(&rtc->lock);
159 
160 	return IRQ_HANDLED;
161 }
162 
163 static inline void sh_rtc_setpie(struct device *dev, unsigned int enable)
164 {
165 	struct sh_rtc *rtc = dev_get_drvdata(dev);
166 	unsigned int tmp;
167 
168 	spin_lock_irq(&rtc->lock);
169 
170 	tmp = readb(rtc->regbase + RCR2);
171 
172 	if (enable) {
173 		tmp &= ~RCR2_PESMASK;
174 		tmp |= RCR2_PEF | (2 << 4);
175 	} else
176 		tmp &= ~(RCR2_PESMASK | RCR2_PEF);
177 
178 	writeb(tmp, rtc->regbase + RCR2);
179 
180 	spin_unlock_irq(&rtc->lock);
181 }
182 
183 static inline void sh_rtc_setaie(struct device *dev, unsigned int enable)
184 {
185 	struct sh_rtc *rtc = dev_get_drvdata(dev);
186 	unsigned int tmp;
187 
188 	spin_lock_irq(&rtc->lock);
189 
190 	tmp = readb(rtc->regbase + RCR1);
191 
192 	if (!enable) {
193 		tmp &= ~RCR1_AIE;
194 		rtc->rearm_aie = 0;
195 	} else if (rtc->rearm_aie == 0)
196 		tmp |= RCR1_AIE;
197 
198 	writeb(tmp, rtc->regbase + RCR1);
199 
200 	spin_unlock_irq(&rtc->lock);
201 }
202 
203 static int sh_rtc_open(struct device *dev)
204 {
205 	struct sh_rtc *rtc = dev_get_drvdata(dev);
206 	unsigned int tmp;
207 	int ret;
208 
209 	tmp = readb(rtc->regbase + RCR1);
210 	tmp &= ~RCR1_CF;
211 	tmp |= RCR1_CIE;
212 	writeb(tmp, rtc->regbase + RCR1);
213 
214 	ret = request_irq(rtc->periodic_irq, sh_rtc_periodic, IRQF_DISABLED,
215 			  "sh-rtc period", dev);
216 	if (unlikely(ret)) {
217 		dev_err(dev, "request period IRQ failed with %d, IRQ %d\n",
218 			ret, rtc->periodic_irq);
219 		return ret;
220 	}
221 
222 	ret = request_irq(rtc->carry_irq, sh_rtc_interrupt, IRQF_DISABLED,
223 			  "sh-rtc carry", dev);
224 	if (unlikely(ret)) {
225 		dev_err(dev, "request carry IRQ failed with %d, IRQ %d\n",
226 			ret, rtc->carry_irq);
227 		free_irq(rtc->periodic_irq, dev);
228 		goto err_bad_carry;
229 	}
230 
231 	ret = request_irq(rtc->alarm_irq, sh_rtc_alarm, IRQF_DISABLED,
232 			  "sh-rtc alarm", dev);
233 	if (unlikely(ret)) {
234 		dev_err(dev, "request alarm IRQ failed with %d, IRQ %d\n",
235 			ret, rtc->alarm_irq);
236 		goto err_bad_alarm;
237 	}
238 
239 	return 0;
240 
241 err_bad_alarm:
242 	free_irq(rtc->carry_irq, dev);
243 err_bad_carry:
244 	free_irq(rtc->periodic_irq, dev);
245 
246 	return ret;
247 }
248 
249 static void sh_rtc_release(struct device *dev)
250 {
251 	struct sh_rtc *rtc = dev_get_drvdata(dev);
252 
253 	sh_rtc_setpie(dev, 0);
254 	sh_rtc_setaie(dev, 0);
255 
256 	free_irq(rtc->periodic_irq, dev);
257 	free_irq(rtc->carry_irq, dev);
258 	free_irq(rtc->alarm_irq, dev);
259 }
260 
261 static int sh_rtc_proc(struct device *dev, struct seq_file *seq)
262 {
263 	struct sh_rtc *rtc = dev_get_drvdata(dev);
264 	unsigned int tmp;
265 
266 	tmp = readb(rtc->regbase + RCR1);
267 	seq_printf(seq, "alarm_IRQ\t: %s\n",
268 		   (tmp & RCR1_AIE) ? "yes" : "no");
269 	seq_printf(seq, "carry_IRQ\t: %s\n",
270 		   (tmp & RCR1_CIE) ? "yes" : "no");
271 
272 	tmp = readb(rtc->regbase + RCR2);
273 	seq_printf(seq, "periodic_IRQ\t: %s\n",
274 		   (tmp & RCR2_PEF) ? "yes" : "no");
275 
276 	return 0;
277 }
278 
279 static int sh_rtc_ioctl(struct device *dev, unsigned int cmd, unsigned long arg)
280 {
281 	unsigned int ret = -ENOIOCTLCMD;
282 
283 	switch (cmd) {
284 	case RTC_PIE_OFF:
285 	case RTC_PIE_ON:
286 		sh_rtc_setpie(dev, cmd == RTC_PIE_ON);
287 		ret = 0;
288 		break;
289 	case RTC_AIE_OFF:
290 	case RTC_AIE_ON:
291 		sh_rtc_setaie(dev, cmd == RTC_AIE_ON);
292 		ret = 0;
293 		break;
294 	}
295 
296 	return ret;
297 }
298 
299 static int sh_rtc_read_time(struct device *dev, struct rtc_time *tm)
300 {
301 	struct platform_device *pdev = to_platform_device(dev);
302 	struct sh_rtc *rtc = platform_get_drvdata(pdev);
303 	unsigned int sec128, sec2, yr, yr100, cf_bit;
304 
305 	do {
306 		unsigned int tmp;
307 
308 		spin_lock_irq(&rtc->lock);
309 
310 		tmp = readb(rtc->regbase + RCR1);
311 		tmp &= ~RCR1_CF; /* Clear CF-bit */
312 		tmp |= RCR1_CIE;
313 		writeb(tmp, rtc->regbase + RCR1);
314 
315 		sec128 = readb(rtc->regbase + R64CNT);
316 
317 		tm->tm_sec	= BCD2BIN(readb(rtc->regbase + RSECCNT));
318 		tm->tm_min	= BCD2BIN(readb(rtc->regbase + RMINCNT));
319 		tm->tm_hour	= BCD2BIN(readb(rtc->regbase + RHRCNT));
320 		tm->tm_wday	= BCD2BIN(readb(rtc->regbase + RWKCNT));
321 		tm->tm_mday	= BCD2BIN(readb(rtc->regbase + RDAYCNT));
322 		tm->tm_mon	= BCD2BIN(readb(rtc->regbase + RMONCNT)) - 1;
323 
324 #if defined(CONFIG_CPU_SH4)
325 		yr  = readw(rtc->regbase + RYRCNT);
326 		yr100 = BCD2BIN(yr >> 8);
327 		yr &= 0xff;
328 #else
329 		yr  = readb(rtc->regbase + RYRCNT);
330 		yr100 = BCD2BIN((yr == 0x99) ? 0x19 : 0x20);
331 #endif
332 
333 		tm->tm_year = (yr100 * 100 + BCD2BIN(yr)) - 1900;
334 
335 		sec2 = readb(rtc->regbase + R64CNT);
336 		cf_bit = readb(rtc->regbase + RCR1) & RCR1_CF;
337 
338 		spin_unlock_irq(&rtc->lock);
339 	} while (cf_bit != 0 || ((sec128 ^ sec2) & RTC_BIT_INVERTED) != 0);
340 
341 #if RTC_BIT_INVERTED != 0
342 	if ((sec128 & RTC_BIT_INVERTED))
343 		tm->tm_sec--;
344 #endif
345 
346 	dev_dbg(&dev, "%s: tm is secs=%d, mins=%d, hours=%d, "
347 		"mday=%d, mon=%d, year=%d, wday=%d\n",
348 		__FUNCTION__,
349 		tm->tm_sec, tm->tm_min, tm->tm_hour,
350 		tm->tm_mday, tm->tm_mon + 1, tm->tm_year, tm->tm_wday);
351 
352 	if (rtc_valid_tm(tm) < 0)
353 		dev_err(dev, "invalid date\n");
354 
355 	return 0;
356 }
357 
358 static int sh_rtc_set_time(struct device *dev, struct rtc_time *tm)
359 {
360 	struct platform_device *pdev = to_platform_device(dev);
361 	struct sh_rtc *rtc = platform_get_drvdata(pdev);
362 	unsigned int tmp;
363 	int year;
364 
365 	spin_lock_irq(&rtc->lock);
366 
367 	/* Reset pre-scaler & stop RTC */
368 	tmp = readb(rtc->regbase + RCR2);
369 	tmp |= RCR2_RESET;
370 	writeb(tmp, rtc->regbase + RCR2);
371 
372 	writeb(BIN2BCD(tm->tm_sec),  rtc->regbase + RSECCNT);
373 	writeb(BIN2BCD(tm->tm_min),  rtc->regbase + RMINCNT);
374 	writeb(BIN2BCD(tm->tm_hour), rtc->regbase + RHRCNT);
375 	writeb(BIN2BCD(tm->tm_wday), rtc->regbase + RWKCNT);
376 	writeb(BIN2BCD(tm->tm_mday), rtc->regbase + RDAYCNT);
377 	writeb(BIN2BCD(tm->tm_mon + 1), rtc->regbase + RMONCNT);
378 
379 #ifdef CONFIG_CPU_SH3
380 	year = tm->tm_year % 100;
381 	writeb(BIN2BCD(year), rtc->regbase + RYRCNT);
382 #else
383 	year = (BIN2BCD((tm->tm_year + 1900) / 100) << 8) |
384 		BIN2BCD(tm->tm_year % 100);
385 	writew(year, rtc->regbase + RYRCNT);
386 #endif
387 
388 	/* Start RTC */
389 	tmp = readb(rtc->regbase + RCR2);
390 	tmp &= ~RCR2_RESET;
391 	tmp |= RCR2_RTCEN | RCR2_START;
392 	writeb(tmp, rtc->regbase + RCR2);
393 
394 	spin_unlock_irq(&rtc->lock);
395 
396 	return 0;
397 }
398 
399 static inline int sh_rtc_read_alarm_value(struct sh_rtc *rtc, int reg_off)
400 {
401 	unsigned int byte;
402 	int value = 0xff;	/* return 0xff for ignored values */
403 
404 	byte = readb(rtc->regbase + reg_off);
405 	if (byte & AR_ENB) {
406 		byte &= ~AR_ENB;	/* strip the enable bit */
407 		value = BCD2BIN(byte);
408 	}
409 
410 	return value;
411 }
412 
413 static int sh_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *wkalrm)
414 {
415 	struct platform_device *pdev = to_platform_device(dev);
416 	struct sh_rtc *rtc = platform_get_drvdata(pdev);
417 	struct rtc_time* tm = &wkalrm->time;
418 
419 	spin_lock_irq(&rtc->lock);
420 
421 	tm->tm_sec	= sh_rtc_read_alarm_value(rtc, RSECAR);
422 	tm->tm_min	= sh_rtc_read_alarm_value(rtc, RMINAR);
423 	tm->tm_hour	= sh_rtc_read_alarm_value(rtc, RHRAR);
424 	tm->tm_wday	= sh_rtc_read_alarm_value(rtc, RWKAR);
425 	tm->tm_mday	= sh_rtc_read_alarm_value(rtc, RDAYAR);
426 	tm->tm_mon	= sh_rtc_read_alarm_value(rtc, RMONAR);
427 	if (tm->tm_mon > 0)
428 		tm->tm_mon -= 1; /* RTC is 1-12, tm_mon is 0-11 */
429 	tm->tm_year     = 0xffff;
430 
431 	spin_unlock_irq(&rtc->lock);
432 
433 	return 0;
434 }
435 
436 static inline void sh_rtc_write_alarm_value(struct sh_rtc *rtc,
437 					    int value, int reg_off)
438 {
439 	/* < 0 for a value that is ignored */
440 	if (value < 0)
441 		writeb(0, rtc->regbase + reg_off);
442 	else
443 		writeb(BIN2BCD(value) | AR_ENB,  rtc->regbase + reg_off);
444 }
445 
446 static int sh_rtc_check_alarm(struct rtc_time* tm)
447 {
448 	/*
449 	 * The original rtc says anything > 0xc0 is "don't care" or "match
450 	 * all" - most users use 0xff but rtc-dev uses -1 for the same thing.
451 	 * The original rtc doesn't support years - some things use -1 and
452 	 * some 0xffff. We use -1 to make out tests easier.
453 	 */
454 	if (tm->tm_year == 0xffff)
455 		tm->tm_year = -1;
456 	if (tm->tm_mon >= 0xff)
457 		tm->tm_mon = -1;
458 	if (tm->tm_mday >= 0xff)
459 		tm->tm_mday = -1;
460 	if (tm->tm_wday >= 0xff)
461 		tm->tm_wday = -1;
462 	if (tm->tm_hour >= 0xff)
463 		tm->tm_hour = -1;
464 	if (tm->tm_min >= 0xff)
465 		tm->tm_min = -1;
466 	if (tm->tm_sec >= 0xff)
467 		tm->tm_sec = -1;
468 
469 	if (tm->tm_year > 9999 ||
470 		tm->tm_mon >= 12 ||
471 		tm->tm_mday == 0 || tm->tm_mday >= 32 ||
472 		tm->tm_wday >= 7 ||
473 		tm->tm_hour >= 24 ||
474 		tm->tm_min >= 60 ||
475 		tm->tm_sec >= 60)
476 		return -EINVAL;
477 
478 	return 0;
479 }
480 
481 static int sh_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *wkalrm)
482 {
483 	struct platform_device *pdev = to_platform_device(dev);
484 	struct sh_rtc *rtc = platform_get_drvdata(pdev);
485 	unsigned int rcr1;
486 	struct rtc_time *tm = &wkalrm->time;
487 	int mon, err;
488 
489 	err = sh_rtc_check_alarm(tm);
490 	if (unlikely(err < 0))
491 		return err;
492 
493 	spin_lock_irq(&rtc->lock);
494 
495 	/* disable alarm interrupt and clear flag */
496 	rcr1 = readb(rtc->regbase + RCR1);
497 	rcr1 &= ~RCR1_AF;
498 	writeb(rcr1 & ~RCR1_AIE, rtc->regbase + RCR1);
499 
500 	rtc->rearm_aie = 0;
501 
502 	/* set alarm time */
503 	sh_rtc_write_alarm_value(rtc, tm->tm_sec,  RSECAR);
504 	sh_rtc_write_alarm_value(rtc, tm->tm_min,  RMINAR);
505 	sh_rtc_write_alarm_value(rtc, tm->tm_hour, RHRAR);
506 	sh_rtc_write_alarm_value(rtc, tm->tm_wday, RWKAR);
507 	sh_rtc_write_alarm_value(rtc, tm->tm_mday, RDAYAR);
508 	mon = tm->tm_mon;
509 	if (mon >= 0)
510 		mon += 1;
511 	sh_rtc_write_alarm_value(rtc, mon, RMONAR);
512 
513 	/* Restore interrupt activation status */
514 	writeb(rcr1, rtc->regbase + RCR1);
515 
516 	spin_unlock_irq(&rtc->lock);
517 
518 	return 0;
519 }
520 
521 static struct rtc_class_ops sh_rtc_ops = {
522 	.open		= sh_rtc_open,
523 	.release	= sh_rtc_release,
524 	.ioctl		= sh_rtc_ioctl,
525 	.read_time	= sh_rtc_read_time,
526 	.set_time	= sh_rtc_set_time,
527 	.read_alarm	= sh_rtc_read_alarm,
528 	.set_alarm	= sh_rtc_set_alarm,
529 	.proc		= sh_rtc_proc,
530 };
531 
532 static int __devinit sh_rtc_probe(struct platform_device *pdev)
533 {
534 	struct sh_rtc *rtc;
535 	struct resource *res;
536 	int ret = -ENOENT;
537 
538 	rtc = kzalloc(sizeof(struct sh_rtc), GFP_KERNEL);
539 	if (unlikely(!rtc))
540 		return -ENOMEM;
541 
542 	spin_lock_init(&rtc->lock);
543 
544 	rtc->periodic_irq = platform_get_irq(pdev, 0);
545 	if (unlikely(rtc->periodic_irq < 0)) {
546 		dev_err(&pdev->dev, "No IRQ for period\n");
547 		goto err_badres;
548 	}
549 
550 	rtc->carry_irq = platform_get_irq(pdev, 1);
551 	if (unlikely(rtc->carry_irq < 0)) {
552 		dev_err(&pdev->dev, "No IRQ for carry\n");
553 		goto err_badres;
554 	}
555 
556 	rtc->alarm_irq = platform_get_irq(pdev, 2);
557 	if (unlikely(rtc->alarm_irq < 0)) {
558 		dev_err(&pdev->dev, "No IRQ for alarm\n");
559 		goto err_badres;
560 	}
561 
562 	res = platform_get_resource(pdev, IORESOURCE_IO, 0);
563 	if (unlikely(res == NULL)) {
564 		dev_err(&pdev->dev, "No IO resource\n");
565 		goto err_badres;
566 	}
567 
568 	rtc->regsize = res->end - res->start + 1;
569 
570 	rtc->res = request_mem_region(res->start, rtc->regsize, pdev->name);
571 	if (unlikely(!rtc->res)) {
572 		ret = -EBUSY;
573 		goto err_badres;
574 	}
575 
576 	rtc->regbase = (void __iomem *)rtc->res->start;
577 	if (unlikely(!rtc->regbase)) {
578 		ret = -EINVAL;
579 		goto err_badmap;
580 	}
581 
582 	rtc->rtc_dev = rtc_device_register("sh", &pdev->dev,
583 					   &sh_rtc_ops, THIS_MODULE);
584 	if (IS_ERR(rtc)) {
585 		ret = PTR_ERR(rtc->rtc_dev);
586 		goto err_badmap;
587 	}
588 
589 	platform_set_drvdata(pdev, rtc);
590 
591 	return 0;
592 
593 err_badmap:
594 	release_resource(rtc->res);
595 err_badres:
596 	kfree(rtc);
597 
598 	return ret;
599 }
600 
601 static int __devexit sh_rtc_remove(struct platform_device *pdev)
602 {
603 	struct sh_rtc *rtc = platform_get_drvdata(pdev);
604 
605 	if (likely(rtc->rtc_dev))
606 		rtc_device_unregister(rtc->rtc_dev);
607 
608 	sh_rtc_setpie(&pdev->dev, 0);
609 	sh_rtc_setaie(&pdev->dev, 0);
610 
611 	release_resource(rtc->res);
612 
613 	platform_set_drvdata(pdev, NULL);
614 
615 	kfree(rtc);
616 
617 	return 0;
618 }
619 static struct platform_driver sh_rtc_platform_driver = {
620 	.driver		= {
621 		.name	= DRV_NAME,
622 		.owner	= THIS_MODULE,
623 	},
624 	.probe		= sh_rtc_probe,
625 	.remove		= __devexit_p(sh_rtc_remove),
626 };
627 
628 static int __init sh_rtc_init(void)
629 {
630 	return platform_driver_register(&sh_rtc_platform_driver);
631 }
632 
633 static void __exit sh_rtc_exit(void)
634 {
635 	platform_driver_unregister(&sh_rtc_platform_driver);
636 }
637 
638 module_init(sh_rtc_init);
639 module_exit(sh_rtc_exit);
640 
641 MODULE_DESCRIPTION("SuperH on-chip RTC driver");
642 MODULE_VERSION(DRV_VERSION);
643 MODULE_AUTHOR("Paul Mundt <lethal@linux-sh.org>, Jamie Lenehan <lenehan@twibble.org>");
644 MODULE_LICENSE("GPL");
645