rtc-twl.c 14.7 KB
Newer Older
D
David Brownell 已提交
1
/*
2
 * rtc-twl.c -- TWL Real Time Clock interface
D
David Brownell 已提交
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
 *
 * Copyright (C) 2007 MontaVista Software, Inc
 * Author: Alexandre Rusev <source@mvista.com>
 *
 * Based on original TI driver twl4030-rtc.c
 *   Copyright (C) 2006 Texas Instruments, Inc.
 *
 * Based on rtc-omap.c
 *   Copyright (C) 2003 MontaVista Software, Inc.
 *   Author: George G. Davis <gdavis@mvista.com> or <source@mvista.com>
 *   Copyright (C) 2006 David Brownell
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version
 * 2 of the License, or (at your option) any later version.
 */

#include <linux/kernel.h>
22
#include <linux/errno.h>
D
David Brownell 已提交
23 24 25 26 27 28 29 30
#include <linux/init.h>
#include <linux/module.h>
#include <linux/types.h>
#include <linux/rtc.h>
#include <linux/bcd.h>
#include <linux/platform_device.h>
#include <linux/interrupt.h>

31
#include <linux/i2c/twl.h>
D
David Brownell 已提交
32 33 34 35 36


/*
 * RTC block register offsets (use TWL_MODULE_RTC)
 */
B
Balaji T K 已提交
37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59
enum {
	REG_SECONDS_REG = 0,
	REG_MINUTES_REG,
	REG_HOURS_REG,
	REG_DAYS_REG,
	REG_MONTHS_REG,
	REG_YEARS_REG,
	REG_WEEKS_REG,

	REG_ALARM_SECONDS_REG,
	REG_ALARM_MINUTES_REG,
	REG_ALARM_HOURS_REG,
	REG_ALARM_DAYS_REG,
	REG_ALARM_MONTHS_REG,
	REG_ALARM_YEARS_REG,

	REG_RTC_CTRL_REG,
	REG_RTC_STATUS_REG,
	REG_RTC_INTERRUPTS_REG,

	REG_RTC_COMP_LSB_REG,
	REG_RTC_COMP_MSB_REG,
};
60
static const u8 twl4030_rtc_reg_map[] = {
B
Balaji T K 已提交
61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82
	[REG_SECONDS_REG] = 0x00,
	[REG_MINUTES_REG] = 0x01,
	[REG_HOURS_REG] = 0x02,
	[REG_DAYS_REG] = 0x03,
	[REG_MONTHS_REG] = 0x04,
	[REG_YEARS_REG] = 0x05,
	[REG_WEEKS_REG] = 0x06,

	[REG_ALARM_SECONDS_REG] = 0x07,
	[REG_ALARM_MINUTES_REG] = 0x08,
	[REG_ALARM_HOURS_REG] = 0x09,
	[REG_ALARM_DAYS_REG] = 0x0A,
	[REG_ALARM_MONTHS_REG] = 0x0B,
	[REG_ALARM_YEARS_REG] = 0x0C,

	[REG_RTC_CTRL_REG] = 0x0D,
	[REG_RTC_STATUS_REG] = 0x0E,
	[REG_RTC_INTERRUPTS_REG] = 0x0F,

	[REG_RTC_COMP_LSB_REG] = 0x10,
	[REG_RTC_COMP_MSB_REG] = 0x11,
};
83
static const u8 twl6030_rtc_reg_map[] = {
B
Balaji T K 已提交
84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105
	[REG_SECONDS_REG] = 0x00,
	[REG_MINUTES_REG] = 0x01,
	[REG_HOURS_REG] = 0x02,
	[REG_DAYS_REG] = 0x03,
	[REG_MONTHS_REG] = 0x04,
	[REG_YEARS_REG] = 0x05,
	[REG_WEEKS_REG] = 0x06,

	[REG_ALARM_SECONDS_REG] = 0x08,
	[REG_ALARM_MINUTES_REG] = 0x09,
	[REG_ALARM_HOURS_REG] = 0x0A,
	[REG_ALARM_DAYS_REG] = 0x0B,
	[REG_ALARM_MONTHS_REG] = 0x0C,
	[REG_ALARM_YEARS_REG] = 0x0D,

	[REG_RTC_CTRL_REG] = 0x10,
	[REG_RTC_STATUS_REG] = 0x11,
	[REG_RTC_INTERRUPTS_REG] = 0x12,

	[REG_RTC_COMP_LSB_REG] = 0x13,
	[REG_RTC_COMP_MSB_REG] = 0x14,
};
D
David Brownell 已提交
106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134

/* RTC_CTRL_REG bitfields */
#define BIT_RTC_CTRL_REG_STOP_RTC_M              0x01
#define BIT_RTC_CTRL_REG_ROUND_30S_M             0x02
#define BIT_RTC_CTRL_REG_AUTO_COMP_M             0x04
#define BIT_RTC_CTRL_REG_MODE_12_24_M            0x08
#define BIT_RTC_CTRL_REG_TEST_MODE_M             0x10
#define BIT_RTC_CTRL_REG_SET_32_COUNTER_M        0x20
#define BIT_RTC_CTRL_REG_GET_TIME_M              0x40

/* RTC_STATUS_REG bitfields */
#define BIT_RTC_STATUS_REG_RUN_M                 0x02
#define BIT_RTC_STATUS_REG_1S_EVENT_M            0x04
#define BIT_RTC_STATUS_REG_1M_EVENT_M            0x08
#define BIT_RTC_STATUS_REG_1H_EVENT_M            0x10
#define BIT_RTC_STATUS_REG_1D_EVENT_M            0x20
#define BIT_RTC_STATUS_REG_ALARM_M               0x40
#define BIT_RTC_STATUS_REG_POWER_UP_M            0x80

/* RTC_INTERRUPTS_REG bitfields */
#define BIT_RTC_INTERRUPTS_REG_EVERY_M           0x03
#define BIT_RTC_INTERRUPTS_REG_IT_TIMER_M        0x04
#define BIT_RTC_INTERRUPTS_REG_IT_ALARM_M        0x08


/* REG_SECONDS_REG through REG_YEARS_REG is how many registers? */
#define ALL_TIME_REGS		6

/*----------------------------------------------------------------------*/
B
Balaji T K 已提交
135
static u8  *rtc_reg_map;
D
David Brownell 已提交
136 137

/*
138
 * Supports 1 byte read from TWL RTC register.
D
David Brownell 已提交
139
 */
140
static int twl_rtc_read_u8(u8 *data, u8 reg)
D
David Brownell 已提交
141 142 143
{
	int ret;

B
Balaji T K 已提交
144
	ret = twl_i2c_read_u8(TWL_MODULE_RTC, data, (rtc_reg_map[reg]));
D
David Brownell 已提交
145
	if (ret < 0)
146
		pr_err("twl_rtc: Could not read TWL"
D
David Brownell 已提交
147 148 149 150 151
		       "register %X - error %d\n", reg, ret);
	return ret;
}

/*
152
 * Supports 1 byte write to TWL RTC registers.
D
David Brownell 已提交
153
 */
154
static int twl_rtc_write_u8(u8 data, u8 reg)
D
David Brownell 已提交
155 156 157
{
	int ret;

B
Balaji T K 已提交
158
	ret = twl_i2c_write_u8(TWL_MODULE_RTC, data, (rtc_reg_map[reg]));
D
David Brownell 已提交
159
	if (ret < 0)
160
		pr_err("twl_rtc: Could not write TWL"
D
David Brownell 已提交
161 162 163 164 165 166 167 168 169 170 171
		       "register %X - error %d\n", reg, ret);
	return ret;
}

/*
 * Cache the value for timer/alarm interrupts register; this is
 * only changed by callers holding rtc ops lock (or resume).
 */
static unsigned char rtc_irq_bits;

/*
172
 * Enable 1/second update and/or alarm interrupts.
D
David Brownell 已提交
173 174 175 176 177 178 179
 */
static int set_rtc_irq_bit(unsigned char bit)
{
	unsigned char val;
	int ret;

	val = rtc_irq_bits | bit;
180
	val &= ~BIT_RTC_INTERRUPTS_REG_EVERY_M;
181
	ret = twl_rtc_write_u8(val, REG_RTC_INTERRUPTS_REG);
D
David Brownell 已提交
182 183 184 185 186 187 188
	if (ret == 0)
		rtc_irq_bits = val;

	return ret;
}

/*
189
 * Disable update and/or alarm interrupts.
D
David Brownell 已提交
190 191 192 193 194 195 196
 */
static int mask_rtc_irq_bit(unsigned char bit)
{
	unsigned char val;
	int ret;

	val = rtc_irq_bits & ~bit;
197
	ret = twl_rtc_write_u8(val, REG_RTC_INTERRUPTS_REG);
D
David Brownell 已提交
198 199 200 201 202 203
	if (ret == 0)
		rtc_irq_bits = val;

	return ret;
}

204
static int twl_rtc_alarm_irq_enable(struct device *dev, unsigned enabled)
D
David Brownell 已提交
205 206 207 208 209 210 211 212 213 214 215
{
	int ret;

	if (enabled)
		ret = set_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_ALARM_M);
	else
		ret = mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_ALARM_M);

	return ret;
}

216
static int twl_rtc_update_irq_enable(struct device *dev, unsigned enabled)
D
David Brownell 已提交
217 218 219 220 221 222 223 224 225 226 227 228
{
	int ret;

	if (enabled)
		ret = set_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_TIMER_M);
	else
		ret = mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_TIMER_M);

	return ret;
}

/*
229
 * Gets current TWL RTC time and date parameters.
D
David Brownell 已提交
230 231 232 233 234 235 236
 *
 * The RTC's time/alarm representation is not what gmtime(3) requires
 * Linux to use:
 *
 *  - Months are 1..12 vs Linux 0-11
 *  - Years are 0..99 vs Linux 1900..N (we assume 21st century)
 */
237
static int twl_rtc_read_time(struct device *dev, struct rtc_time *tm)
D
David Brownell 已提交
238 239 240 241 242
{
	unsigned char rtc_data[ALL_TIME_REGS + 1];
	int ret;
	u8 save_control;

243
	ret = twl_rtc_read_u8(&save_control, REG_RTC_CTRL_REG);
D
David Brownell 已提交
244 245 246 247 248
	if (ret < 0)
		return ret;

	save_control |= BIT_RTC_CTRL_REG_GET_TIME_M;

249
	ret = twl_rtc_write_u8(save_control, REG_RTC_CTRL_REG);
D
David Brownell 已提交
250 251 252
	if (ret < 0)
		return ret;

253
	ret = twl_i2c_read(TWL_MODULE_RTC, rtc_data,
B
Balaji T K 已提交
254
			(rtc_reg_map[REG_SECONDS_REG]), ALL_TIME_REGS);
D
David Brownell 已提交
255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270

	if (ret < 0) {
		dev_err(dev, "rtc_read_time error %d\n", ret);
		return ret;
	}

	tm->tm_sec = bcd2bin(rtc_data[0]);
	tm->tm_min = bcd2bin(rtc_data[1]);
	tm->tm_hour = bcd2bin(rtc_data[2]);
	tm->tm_mday = bcd2bin(rtc_data[3]);
	tm->tm_mon = bcd2bin(rtc_data[4]) - 1;
	tm->tm_year = bcd2bin(rtc_data[5]) + 100;

	return ret;
}

271
static int twl_rtc_set_time(struct device *dev, struct rtc_time *tm)
D
David Brownell 已提交
272 273 274 275 276 277 278 279 280 281 282 283 284
{
	unsigned char save_control;
	unsigned char rtc_data[ALL_TIME_REGS + 1];
	int ret;

	rtc_data[1] = bin2bcd(tm->tm_sec);
	rtc_data[2] = bin2bcd(tm->tm_min);
	rtc_data[3] = bin2bcd(tm->tm_hour);
	rtc_data[4] = bin2bcd(tm->tm_mday);
	rtc_data[5] = bin2bcd(tm->tm_mon + 1);
	rtc_data[6] = bin2bcd(tm->tm_year - 100);

	/* Stop RTC while updating the TC registers */
285
	ret = twl_rtc_read_u8(&save_control, REG_RTC_CTRL_REG);
D
David Brownell 已提交
286 287 288 289
	if (ret < 0)
		goto out;

	save_control &= ~BIT_RTC_CTRL_REG_STOP_RTC_M;
290
	twl_rtc_write_u8(save_control, REG_RTC_CTRL_REG);
D
David Brownell 已提交
291 292 293 294
	if (ret < 0)
		goto out;

	/* update all the time registers in one shot */
295
	ret = twl_i2c_write(TWL_MODULE_RTC, rtc_data,
B
Balaji T K 已提交
296
		(rtc_reg_map[REG_SECONDS_REG]), ALL_TIME_REGS);
D
David Brownell 已提交
297 298 299 300 301 302 303
	if (ret < 0) {
		dev_err(dev, "rtc_set_time error %d\n", ret);
		goto out;
	}

	/* Start back RTC */
	save_control |= BIT_RTC_CTRL_REG_STOP_RTC_M;
304
	ret = twl_rtc_write_u8(save_control, REG_RTC_CTRL_REG);
D
David Brownell 已提交
305 306 307 308 309 310

out:
	return ret;
}

/*
311
 * Gets current TWL RTC alarm time.
D
David Brownell 已提交
312
 */
313
static int twl_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alm)
D
David Brownell 已提交
314 315 316 317
{
	unsigned char rtc_data[ALL_TIME_REGS + 1];
	int ret;

318
	ret = twl_i2c_read(TWL_MODULE_RTC, rtc_data,
B
Balaji T K 已提交
319
			(rtc_reg_map[REG_ALARM_SECONDS_REG]), ALL_TIME_REGS);
D
David Brownell 已提交
320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339
	if (ret < 0) {
		dev_err(dev, "rtc_read_alarm error %d\n", ret);
		return ret;
	}

	/* some of these fields may be wildcard/"match all" */
	alm->time.tm_sec = bcd2bin(rtc_data[0]);
	alm->time.tm_min = bcd2bin(rtc_data[1]);
	alm->time.tm_hour = bcd2bin(rtc_data[2]);
	alm->time.tm_mday = bcd2bin(rtc_data[3]);
	alm->time.tm_mon = bcd2bin(rtc_data[4]) - 1;
	alm->time.tm_year = bcd2bin(rtc_data[5]) + 100;

	/* report cached alarm enable state */
	if (rtc_irq_bits & BIT_RTC_INTERRUPTS_REG_IT_ALARM_M)
		alm->enabled = 1;

	return ret;
}

340
static int twl_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alm)
D
David Brownell 已提交
341 342 343 344
{
	unsigned char alarm_data[ALL_TIME_REGS + 1];
	int ret;

345
	ret = twl_rtc_alarm_irq_enable(dev, 0);
D
David Brownell 已提交
346 347 348 349 350 351 352 353 354 355 356
	if (ret)
		goto out;

	alarm_data[1] = bin2bcd(alm->time.tm_sec);
	alarm_data[2] = bin2bcd(alm->time.tm_min);
	alarm_data[3] = bin2bcd(alm->time.tm_hour);
	alarm_data[4] = bin2bcd(alm->time.tm_mday);
	alarm_data[5] = bin2bcd(alm->time.tm_mon + 1);
	alarm_data[6] = bin2bcd(alm->time.tm_year - 100);

	/* update all the alarm registers in one shot */
357
	ret = twl_i2c_write(TWL_MODULE_RTC, alarm_data,
B
Balaji T K 已提交
358
		(rtc_reg_map[REG_ALARM_SECONDS_REG]), ALL_TIME_REGS);
D
David Brownell 已提交
359 360 361 362 363 364
	if (ret) {
		dev_err(dev, "rtc_set_alarm error %d\n", ret);
		goto out;
	}

	if (alm->enabled)
365
		ret = twl_rtc_alarm_irq_enable(dev, 1);
D
David Brownell 已提交
366 367 368 369
out:
	return ret;
}

370
static irqreturn_t twl_rtc_interrupt(int irq, void *rtc)
D
David Brownell 已提交
371 372 373 374 375 376 377 378 379 380 381 382 383 384
{
	unsigned long events = 0;
	int ret = IRQ_NONE;
	int res;
	u8 rd_reg;

#ifdef CONFIG_LOCKDEP
	/* WORKAROUND for lockdep forcing IRQF_DISABLED on us, which
	 * we don't want and can't tolerate.  Although it might be
	 * friendlier not to borrow this thread context...
	 */
	local_irq_enable();
#endif

385
	res = twl_rtc_read_u8(&rd_reg, REG_RTC_STATUS_REG);
D
David Brownell 已提交
386 387 388 389 390 391 392 393 394 395 396 397 398
	if (res)
		goto out;
	/*
	 * Figure out source of interrupt: ALARM or TIMER in RTC_STATUS_REG.
	 * only one (ALARM or RTC) interrupt source may be enabled
	 * at time, we also could check our results
	 * by reading RTS_INTERRUPTS_REGISTER[IT_TIMER,IT_ALARM]
	 */
	if (rd_reg & BIT_RTC_STATUS_REG_ALARM_M)
		events |= RTC_IRQF | RTC_AF;
	else
		events |= RTC_IRQF | RTC_UF;

399
	res = twl_rtc_write_u8(rd_reg | BIT_RTC_STATUS_REG_ALARM_M,
D
David Brownell 已提交
400 401 402 403
				   REG_RTC_STATUS_REG);
	if (res)
		goto out;

B
Balaji T K 已提交
404 405 406 407 408 409 410 411 412 413 414 415 416
	if (twl_class_is_4030()) {
		/* Clear on Read enabled. RTC_IT bit of TWL4030_INT_PWR_ISR1
		 * needs 2 reads to clear the interrupt. One read is done in
		 * do_twl_pwrirq(). Doing the second read, to clear
		 * the bit.
		 *
		 * FIXME the reason PWR_ISR1 needs an extra read is that
		 * RTC_IF retriggered until we cleared REG_ALARM_M above.
		 * But re-reading like this is a bad hack; by doing so we
		 * risk wrongly clearing status for some other IRQ (losing
		 * the interrupt).  Be smarter about handling RTC_UF ...
		 */
		res = twl_i2c_read_u8(TWL4030_MODULE_INT,
D
David Brownell 已提交
417
			&rd_reg, TWL4030_INT_PWR_ISR1);
B
Balaji T K 已提交
418 419 420
		if (res)
			goto out;
	}
D
David Brownell 已提交
421 422 423 424 425 426 427 428 429

	/* Notify RTC core on event */
	rtc_update_irq(rtc, 1, events);

	ret = IRQ_HANDLED;
out:
	return ret;
}

430 431 432 433 434 435 436
static struct rtc_class_ops twl_rtc_ops = {
	.read_time	= twl_rtc_read_time,
	.set_time	= twl_rtc_set_time,
	.read_alarm	= twl_rtc_read_alarm,
	.set_alarm	= twl_rtc_set_alarm,
	.alarm_irq_enable = twl_rtc_alarm_irq_enable,
	.update_irq_enable = twl_rtc_update_irq_enable,
D
David Brownell 已提交
437 438 439 440
};

/*----------------------------------------------------------------------*/

441
static int __devinit twl_rtc_probe(struct platform_device *pdev)
D
David Brownell 已提交
442 443 444 445 446 447
{
	struct rtc_device *rtc;
	int ret = 0;
	int irq = platform_get_irq(pdev, 0);
	u8 rd_reg;

448 449
	if (irq <= 0)
		return -EINVAL;
D
David Brownell 已提交
450 451

	rtc = rtc_device_register(pdev->name,
452
				  &pdev->dev, &twl_rtc_ops, THIS_MODULE);
D
David Brownell 已提交
453
	if (IS_ERR(rtc)) {
454
		ret = PTR_ERR(rtc);
D
David Brownell 已提交
455 456 457 458 459 460 461 462
		dev_err(&pdev->dev, "can't register RTC device, err %ld\n",
			PTR_ERR(rtc));
		goto out0;

	}

	platform_set_drvdata(pdev, rtc);

463
	ret = twl_rtc_read_u8(&rd_reg, REG_RTC_STATUS_REG);
D
David Brownell 已提交
464 465 466 467 468 469 470 471 472 473
	if (ret < 0)
		goto out1;

	if (rd_reg & BIT_RTC_STATUS_REG_POWER_UP_M)
		dev_warn(&pdev->dev, "Power up reset detected.\n");

	if (rd_reg & BIT_RTC_STATUS_REG_ALARM_M)
		dev_warn(&pdev->dev, "Pending Alarm interrupt detected.\n");

	/* Clear RTC Power up reset and pending alarm interrupts */
474
	ret = twl_rtc_write_u8(rd_reg, REG_RTC_STATUS_REG);
D
David Brownell 已提交
475 476 477
	if (ret < 0)
		goto out1;

478
	ret = request_irq(irq, twl_rtc_interrupt,
D
David Brownell 已提交
479
				IRQF_TRIGGER_RISING,
480
				dev_name(&rtc->dev), rtc);
D
David Brownell 已提交
481 482 483 484 485
	if (ret < 0) {
		dev_err(&pdev->dev, "IRQ is not free.\n");
		goto out1;
	}

B
Balaji T K 已提交
486 487 488 489 490 491 492
	if (twl_class_is_6030()) {
		twl6030_interrupt_unmask(TWL6030_RTC_INT_MASK,
			REG_INT_MSK_LINE_A);
		twl6030_interrupt_unmask(TWL6030_RTC_INT_MASK,
			REG_INT_MSK_STS_A);
	}

D
David Brownell 已提交
493
	/* Check RTC module status, Enable if it is off */
494
	ret = twl_rtc_read_u8(&rd_reg, REG_RTC_CTRL_REG);
D
David Brownell 已提交
495 496 497 498
	if (ret < 0)
		goto out2;

	if (!(rd_reg & BIT_RTC_CTRL_REG_STOP_RTC_M)) {
499
		dev_info(&pdev->dev, "Enabling TWL-RTC.\n");
D
David Brownell 已提交
500
		rd_reg = BIT_RTC_CTRL_REG_STOP_RTC_M;
501
		ret = twl_rtc_write_u8(rd_reg, REG_RTC_CTRL_REG);
D
David Brownell 已提交
502 503 504 505 506
		if (ret < 0)
			goto out2;
	}

	/* init cached IRQ enable bits */
507
	ret = twl_rtc_read_u8(&rtc_irq_bits, REG_RTC_INTERRUPTS_REG);
D
David Brownell 已提交
508 509 510 511 512 513 514 515 516 517 518 519 520 521
	if (ret < 0)
		goto out2;

	return ret;

out2:
	free_irq(irq, rtc);
out1:
	rtc_device_unregister(rtc);
out0:
	return ret;
}

/*
522
 * Disable all TWL RTC module interrupts.
D
David Brownell 已提交
523 524
 * Sets status flag to free.
 */
525
static int __devexit twl_rtc_remove(struct platform_device *pdev)
D
David Brownell 已提交
526 527 528 529 530 531 532
{
	/* leave rtc running, but disable irqs */
	struct rtc_device *rtc = platform_get_drvdata(pdev);
	int irq = platform_get_irq(pdev, 0);

	mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_ALARM_M);
	mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_TIMER_M);
B
Balaji T K 已提交
533 534 535 536 537 538 539
	if (twl_class_is_6030()) {
		twl6030_interrupt_mask(TWL6030_RTC_INT_MASK,
			REG_INT_MSK_LINE_A);
		twl6030_interrupt_mask(TWL6030_RTC_INT_MASK,
			REG_INT_MSK_STS_A);
	}

D
David Brownell 已提交
540 541 542 543 544 545 546 547

	free_irq(irq, rtc);

	rtc_device_unregister(rtc);
	platform_set_drvdata(pdev, NULL);
	return 0;
}

548
static void twl_rtc_shutdown(struct platform_device *pdev)
D
David Brownell 已提交
549
{
550 551 552
	/* mask timer interrupts, but leave alarm interrupts on to enable
	   power-on when alarm is triggered */
	mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_TIMER_M);
D
David Brownell 已提交
553 554 555 556 557 558
}

#ifdef CONFIG_PM

static unsigned char irqstat;

559
static int twl_rtc_suspend(struct platform_device *pdev, pm_message_t state)
D
David Brownell 已提交
560 561 562
{
	irqstat = rtc_irq_bits;

563
	mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_TIMER_M);
D
David Brownell 已提交
564 565 566
	return 0;
}

567
static int twl_rtc_resume(struct platform_device *pdev)
D
David Brownell 已提交
568 569 570 571 572 573
{
	set_rtc_irq_bit(irqstat);
	return 0;
}

#else
574 575
#define twl_rtc_suspend NULL
#define twl_rtc_resume  NULL
D
David Brownell 已提交
576 577
#endif

578
MODULE_ALIAS("platform:twl_rtc");
D
David Brownell 已提交
579 580

static struct platform_driver twl4030rtc_driver = {
581 582 583 584 585
	.probe		= twl_rtc_probe,
	.remove		= __devexit_p(twl_rtc_remove),
	.shutdown	= twl_rtc_shutdown,
	.suspend	= twl_rtc_suspend,
	.resume		= twl_rtc_resume,
D
David Brownell 已提交
586 587
	.driver		= {
		.owner	= THIS_MODULE,
588
		.name	= "twl_rtc",
D
David Brownell 已提交
589 590 591
	},
};

592
static int __init twl_rtc_init(void)
D
David Brownell 已提交
593
{
B
Balaji T K 已提交
594 595 596 597 598
	if (twl_class_is_4030())
		rtc_reg_map = (u8 *) twl4030_rtc_reg_map;
	else
		rtc_reg_map = (u8 *) twl6030_rtc_reg_map;

D
David Brownell 已提交
599 600
	return platform_driver_register(&twl4030rtc_driver);
}
601
module_init(twl_rtc_init);
D
David Brownell 已提交
602

603
static void __exit twl_rtc_exit(void)
D
David Brownell 已提交
604 605 606
{
	platform_driver_unregister(&twl4030rtc_driver);
}
607
module_exit(twl_rtc_exit);
D
David Brownell 已提交
608 609 610

MODULE_AUTHOR("Texas Instruments, MontaVista Software");
MODULE_LICENSE("GPL");