Blame view
drivers/rtc/rtc-twl.c
14.4 KB
f96411ab7 mfd: rtc-twl4030 ... |
1 |
/* |
ef3b7d0d3 mfd: Rename twl40... |
2 |
* rtc-twl.c -- TWL Real Time Clock interface |
f96411ab7 mfd: rtc-twl4030 ... |
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> |
2fac6674d rtc: bunch of dri... |
22 |
#include <linux/errno.h> |
f96411ab7 mfd: rtc-twl4030 ... |
23 24 25 26 27 28 29 |
#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> |
b07682b60 mfd: Rename twl40... |
30 |
#include <linux/i2c/twl.h> |
f96411ab7 mfd: rtc-twl4030 ... |
31 32 33 34 35 |
/* * RTC block register offsets (use TWL_MODULE_RTC) */ |
a6b49ffd2 rtc: Add twl6030 ... |
36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 |
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, }; |
2e84067b6 rtc-twl: Storage ... |
59 |
static const u8 twl4030_rtc_reg_map[] = { |
a6b49ffd2 rtc: Add twl6030 ... |
60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 |
[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, }; |
2e84067b6 rtc-twl: Storage ... |
82 |
static const u8 twl6030_rtc_reg_map[] = { |
a6b49ffd2 rtc: Add twl6030 ... |
83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 |
[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, }; |
f96411ab7 mfd: rtc-twl4030 ... |
105 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 |
/* 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 /*----------------------------------------------------------------------*/ |
a6b49ffd2 rtc: Add twl6030 ... |
134 |
static u8 *rtc_reg_map; |
f96411ab7 mfd: rtc-twl4030 ... |
135 136 |
/* |
ef3b7d0d3 mfd: Rename twl40... |
137 |
* Supports 1 byte read from TWL RTC register. |
f96411ab7 mfd: rtc-twl4030 ... |
138 |
*/ |
ef3b7d0d3 mfd: Rename twl40... |
139 |
static int twl_rtc_read_u8(u8 *data, u8 reg) |
f96411ab7 mfd: rtc-twl4030 ... |
140 141 |
{ int ret; |
a6b49ffd2 rtc: Add twl6030 ... |
142 |
ret = twl_i2c_read_u8(TWL_MODULE_RTC, data, (rtc_reg_map[reg])); |
f96411ab7 mfd: rtc-twl4030 ... |
143 |
if (ret < 0) |
ef3b7d0d3 mfd: Rename twl40... |
144 |
pr_err("twl_rtc: Could not read TWL" |
f96411ab7 mfd: rtc-twl4030 ... |
145 146 147 148 149 150 |
"register %X - error %d ", reg, ret); return ret; } /* |
ef3b7d0d3 mfd: Rename twl40... |
151 |
* Supports 1 byte write to TWL RTC registers. |
f96411ab7 mfd: rtc-twl4030 ... |
152 |
*/ |
ef3b7d0d3 mfd: Rename twl40... |
153 |
static int twl_rtc_write_u8(u8 data, u8 reg) |
f96411ab7 mfd: rtc-twl4030 ... |
154 155 |
{ int ret; |
a6b49ffd2 rtc: Add twl6030 ... |
156 |
ret = twl_i2c_write_u8(TWL_MODULE_RTC, data, (rtc_reg_map[reg])); |
f96411ab7 mfd: rtc-twl4030 ... |
157 |
if (ret < 0) |
ef3b7d0d3 mfd: Rename twl40... |
158 |
pr_err("twl_rtc: Could not write TWL" |
f96411ab7 mfd: rtc-twl4030 ... |
159 160 161 162 163 164 165 166 167 168 169 170 |
"register %X - error %d ", 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; /* |
a748384bb rtc: tw4030 add a... |
171 |
* Enable 1/second update and/or alarm interrupts. |
f96411ab7 mfd: rtc-twl4030 ... |
172 173 174 175 176 177 178 |
*/ static int set_rtc_irq_bit(unsigned char bit) { unsigned char val; int ret; val = rtc_irq_bits | bit; |
a748384bb rtc: tw4030 add a... |
179 |
val &= ~BIT_RTC_INTERRUPTS_REG_EVERY_M; |
ef3b7d0d3 mfd: Rename twl40... |
180 |
ret = twl_rtc_write_u8(val, REG_RTC_INTERRUPTS_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
181 182 183 184 185 186 187 |
if (ret == 0) rtc_irq_bits = val; return ret; } /* |
a748384bb rtc: tw4030 add a... |
188 |
* Disable update and/or alarm interrupts. |
f96411ab7 mfd: rtc-twl4030 ... |
189 190 191 192 193 194 195 |
*/ static int mask_rtc_irq_bit(unsigned char bit) { unsigned char val; int ret; val = rtc_irq_bits & ~bit; |
ef3b7d0d3 mfd: Rename twl40... |
196 |
ret = twl_rtc_write_u8(val, REG_RTC_INTERRUPTS_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
197 198 199 200 201 |
if (ret == 0) rtc_irq_bits = val; return ret; } |
ef3b7d0d3 mfd: Rename twl40... |
202 |
static int twl_rtc_alarm_irq_enable(struct device *dev, unsigned enabled) |
f96411ab7 mfd: rtc-twl4030 ... |
203 204 205 206 207 208 209 210 211 212 |
{ 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; } |
f96411ab7 mfd: rtc-twl4030 ... |
213 |
/* |
ef3b7d0d3 mfd: Rename twl40... |
214 |
* Gets current TWL RTC time and date parameters. |
f96411ab7 mfd: rtc-twl4030 ... |
215 216 217 218 219 220 221 |
* * 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) */ |
ef3b7d0d3 mfd: Rename twl40... |
222 |
static int twl_rtc_read_time(struct device *dev, struct rtc_time *tm) |
f96411ab7 mfd: rtc-twl4030 ... |
223 224 225 226 |
{ unsigned char rtc_data[ALL_TIME_REGS + 1]; int ret; u8 save_control; |
ef3b7d0d3 mfd: Rename twl40... |
227 |
ret = twl_rtc_read_u8(&save_control, REG_RTC_CTRL_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
228 229 230 231 |
if (ret < 0) return ret; save_control |= BIT_RTC_CTRL_REG_GET_TIME_M; |
ef3b7d0d3 mfd: Rename twl40... |
232 |
ret = twl_rtc_write_u8(save_control, REG_RTC_CTRL_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
233 234 |
if (ret < 0) return ret; |
ef3b7d0d3 mfd: Rename twl40... |
235 |
ret = twl_i2c_read(TWL_MODULE_RTC, rtc_data, |
a6b49ffd2 rtc: Add twl6030 ... |
236 |
(rtc_reg_map[REG_SECONDS_REG]), ALL_TIME_REGS); |
f96411ab7 mfd: rtc-twl4030 ... |
237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 |
if (ret < 0) { dev_err(dev, "rtc_read_time error %d ", 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; } |
ef3b7d0d3 mfd: Rename twl40... |
253 |
static int twl_rtc_set_time(struct device *dev, struct rtc_time *tm) |
f96411ab7 mfd: rtc-twl4030 ... |
254 255 256 257 258 259 260 261 262 263 264 265 266 |
{ 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 */ |
ef3b7d0d3 mfd: Rename twl40... |
267 |
ret = twl_rtc_read_u8(&save_control, REG_RTC_CTRL_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
268 269 270 271 |
if (ret < 0) goto out; save_control &= ~BIT_RTC_CTRL_REG_STOP_RTC_M; |
8f6b0dd36 drivers/rtc/rtc-t... |
272 |
ret = twl_rtc_write_u8(save_control, REG_RTC_CTRL_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
273 274 275 276 |
if (ret < 0) goto out; /* update all the time registers in one shot */ |
ef3b7d0d3 mfd: Rename twl40... |
277 |
ret = twl_i2c_write(TWL_MODULE_RTC, rtc_data, |
a6b49ffd2 rtc: Add twl6030 ... |
278 |
(rtc_reg_map[REG_SECONDS_REG]), ALL_TIME_REGS); |
f96411ab7 mfd: rtc-twl4030 ... |
279 280 281 282 283 284 285 286 |
if (ret < 0) { dev_err(dev, "rtc_set_time error %d ", ret); goto out; } /* Start back RTC */ save_control |= BIT_RTC_CTRL_REG_STOP_RTC_M; |
ef3b7d0d3 mfd: Rename twl40... |
287 |
ret = twl_rtc_write_u8(save_control, REG_RTC_CTRL_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
288 289 290 291 292 293 |
out: return ret; } /* |
ef3b7d0d3 mfd: Rename twl40... |
294 |
* Gets current TWL RTC alarm time. |
f96411ab7 mfd: rtc-twl4030 ... |
295 |
*/ |
ef3b7d0d3 mfd: Rename twl40... |
296 |
static int twl_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alm) |
f96411ab7 mfd: rtc-twl4030 ... |
297 298 299 |
{ unsigned char rtc_data[ALL_TIME_REGS + 1]; int ret; |
ef3b7d0d3 mfd: Rename twl40... |
300 |
ret = twl_i2c_read(TWL_MODULE_RTC, rtc_data, |
a6b49ffd2 rtc: Add twl6030 ... |
301 |
(rtc_reg_map[REG_ALARM_SECONDS_REG]), ALL_TIME_REGS); |
f96411ab7 mfd: rtc-twl4030 ... |
302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 |
if (ret < 0) { dev_err(dev, "rtc_read_alarm error %d ", 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; } |
ef3b7d0d3 mfd: Rename twl40... |
322 |
static int twl_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alm) |
f96411ab7 mfd: rtc-twl4030 ... |
323 324 325 |
{ unsigned char alarm_data[ALL_TIME_REGS + 1]; int ret; |
ef3b7d0d3 mfd: Rename twl40... |
326 |
ret = twl_rtc_alarm_irq_enable(dev, 0); |
f96411ab7 mfd: rtc-twl4030 ... |
327 328 329 330 331 332 333 334 335 336 337 |
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 */ |
ef3b7d0d3 mfd: Rename twl40... |
338 |
ret = twl_i2c_write(TWL_MODULE_RTC, alarm_data, |
a6b49ffd2 rtc: Add twl6030 ... |
339 |
(rtc_reg_map[REG_ALARM_SECONDS_REG]), ALL_TIME_REGS); |
f96411ab7 mfd: rtc-twl4030 ... |
340 341 342 343 344 345 346 |
if (ret) { dev_err(dev, "rtc_set_alarm error %d ", ret); goto out; } if (alm->enabled) |
ef3b7d0d3 mfd: Rename twl40... |
347 |
ret = twl_rtc_alarm_irq_enable(dev, 1); |
f96411ab7 mfd: rtc-twl4030 ... |
348 349 350 |
out: return ret; } |
ef3b7d0d3 mfd: Rename twl40... |
351 |
static irqreturn_t twl_rtc_interrupt(int irq, void *rtc) |
f96411ab7 mfd: rtc-twl4030 ... |
352 353 354 355 356 |
{ unsigned long events = 0; int ret = IRQ_NONE; int res; u8 rd_reg; |
ef3b7d0d3 mfd: Rename twl40... |
357 |
res = twl_rtc_read_u8(&rd_reg, REG_RTC_STATUS_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
358 359 360 361 362 363 364 365 366 367 368 369 |
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; |
ef3b7d0d3 mfd: Rename twl40... |
370 |
res = twl_rtc_write_u8(rd_reg | BIT_RTC_STATUS_REG_ALARM_M, |
f96411ab7 mfd: rtc-twl4030 ... |
371 372 373 |
REG_RTC_STATUS_REG); if (res) goto out; |
a6b49ffd2 rtc: Add twl6030 ... |
374 375 376 377 378 379 380 381 382 383 384 385 386 |
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, |
f96411ab7 mfd: rtc-twl4030 ... |
387 |
&rd_reg, TWL4030_INT_PWR_ISR1); |
a6b49ffd2 rtc: Add twl6030 ... |
388 389 390 |
if (res) goto out; } |
f96411ab7 mfd: rtc-twl4030 ... |
391 392 393 394 395 396 397 398 |
/* Notify RTC core on event */ rtc_update_irq(rtc, 1, events); ret = IRQ_HANDLED; out: return ret; } |
ef3b7d0d3 mfd: Rename twl40... |
399 400 401 402 403 404 |
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, |
f96411ab7 mfd: rtc-twl4030 ... |
405 406 407 |
}; /*----------------------------------------------------------------------*/ |
ef3b7d0d3 mfd: Rename twl40... |
408 |
static int __devinit twl_rtc_probe(struct platform_device *pdev) |
f96411ab7 mfd: rtc-twl4030 ... |
409 410 |
{ struct rtc_device *rtc; |
7e72c6863 rtc: twl: Fix reg... |
411 |
int ret = -EINVAL; |
f96411ab7 mfd: rtc-twl4030 ... |
412 413 |
int irq = platform_get_irq(pdev, 0); u8 rd_reg; |
2fac6674d rtc: bunch of dri... |
414 |
if (irq <= 0) |
7e72c6863 rtc: twl: Fix reg... |
415 |
goto out1; |
f96411ab7 mfd: rtc-twl4030 ... |
416 |
|
ef3b7d0d3 mfd: Rename twl40... |
417 |
ret = twl_rtc_read_u8(&rd_reg, REG_RTC_STATUS_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
418 419 420 421 422 423 424 425 426 427 428 429 |
if (ret < 0) goto out1; if (rd_reg & BIT_RTC_STATUS_REG_POWER_UP_M) dev_warn(&pdev->dev, "Power up reset detected. "); if (rd_reg & BIT_RTC_STATUS_REG_ALARM_M) dev_warn(&pdev->dev, "Pending Alarm interrupt detected. "); /* Clear RTC Power up reset and pending alarm interrupts */ |
ef3b7d0d3 mfd: Rename twl40... |
430 |
ret = twl_rtc_write_u8(rd_reg, REG_RTC_STATUS_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
431 432 |
if (ret < 0) goto out1; |
a6b49ffd2 rtc: Add twl6030 ... |
433 434 435 436 437 438 |
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); } |
f96411ab7 mfd: rtc-twl4030 ... |
439 |
/* Check RTC module status, Enable if it is off */ |
ef3b7d0d3 mfd: Rename twl40... |
440 |
ret = twl_rtc_read_u8(&rd_reg, REG_RTC_CTRL_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
441 |
if (ret < 0) |
7e72c6863 rtc: twl: Fix reg... |
442 |
goto out1; |
f96411ab7 mfd: rtc-twl4030 ... |
443 444 |
if (!(rd_reg & BIT_RTC_CTRL_REG_STOP_RTC_M)) { |
ef3b7d0d3 mfd: Rename twl40... |
445 446 |
dev_info(&pdev->dev, "Enabling TWL-RTC. "); |
f96411ab7 mfd: rtc-twl4030 ... |
447 |
rd_reg = BIT_RTC_CTRL_REG_STOP_RTC_M; |
ef3b7d0d3 mfd: Rename twl40... |
448 |
ret = twl_rtc_write_u8(rd_reg, REG_RTC_CTRL_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
449 |
if (ret < 0) |
7e72c6863 rtc: twl: Fix reg... |
450 |
goto out1; |
f96411ab7 mfd: rtc-twl4030 ... |
451 452 453 |
} /* init cached IRQ enable bits */ |
ef3b7d0d3 mfd: Rename twl40... |
454 |
ret = twl_rtc_read_u8(&rtc_irq_bits, REG_RTC_INTERRUPTS_REG); |
f96411ab7 mfd: rtc-twl4030 ... |
455 |
if (ret < 0) |
7e72c6863 rtc: twl: Fix reg... |
456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 |
goto out1; rtc = rtc_device_register(pdev->name, &pdev->dev, &twl_rtc_ops, THIS_MODULE); if (IS_ERR(rtc)) { ret = PTR_ERR(rtc); dev_err(&pdev->dev, "can't register RTC device, err %ld ", PTR_ERR(rtc)); goto out1; } ret = request_threaded_irq(irq, NULL, twl_rtc_interrupt, IRQF_TRIGGER_RISING, dev_name(&rtc->dev), rtc); if (ret < 0) { dev_err(&pdev->dev, "IRQ is not free. "); |
f96411ab7 mfd: rtc-twl4030 ... |
474 |
goto out2; |
7e72c6863 rtc: twl: Fix reg... |
475 |
} |
f96411ab7 mfd: rtc-twl4030 ... |
476 |
|
7e72c6863 rtc: twl: Fix reg... |
477 478 |
platform_set_drvdata(pdev, rtc); return 0; |
f96411ab7 mfd: rtc-twl4030 ... |
479 |
|
f96411ab7 mfd: rtc-twl4030 ... |
480 |
out2: |
f96411ab7 mfd: rtc-twl4030 ... |
481 |
rtc_device_unregister(rtc); |
7e72c6863 rtc: twl: Fix reg... |
482 |
out1: |
f96411ab7 mfd: rtc-twl4030 ... |
483 484 485 486 |
return ret; } /* |
ef3b7d0d3 mfd: Rename twl40... |
487 |
* Disable all TWL RTC module interrupts. |
f96411ab7 mfd: rtc-twl4030 ... |
488 489 |
* Sets status flag to free. */ |
ef3b7d0d3 mfd: Rename twl40... |
490 |
static int __devexit twl_rtc_remove(struct platform_device *pdev) |
f96411ab7 mfd: rtc-twl4030 ... |
491 492 493 494 495 496 497 |
{ /* 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); |
a6b49ffd2 rtc: Add twl6030 ... |
498 499 500 501 502 503 |
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); } |
f96411ab7 mfd: rtc-twl4030 ... |
504 505 506 507 508 509 510 |
free_irq(irq, rtc); rtc_device_unregister(rtc); platform_set_drvdata(pdev, NULL); return 0; } |
ef3b7d0d3 mfd: Rename twl40... |
511 |
static void twl_rtc_shutdown(struct platform_device *pdev) |
f96411ab7 mfd: rtc-twl4030 ... |
512 |
{ |
cafa1d8b0 rtc: rtc-twl4030 ... |
513 514 515 |
/* 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); |
f96411ab7 mfd: rtc-twl4030 ... |
516 517 518 519 520 |
} #ifdef CONFIG_PM static unsigned char irqstat; |
ef3b7d0d3 mfd: Rename twl40... |
521 |
static int twl_rtc_suspend(struct platform_device *pdev, pm_message_t state) |
f96411ab7 mfd: rtc-twl4030 ... |
522 523 |
{ irqstat = rtc_irq_bits; |
f993004d7 rtc: rtc-twl4030 ... |
524 |
mask_rtc_irq_bit(BIT_RTC_INTERRUPTS_REG_IT_TIMER_M); |
f96411ab7 mfd: rtc-twl4030 ... |
525 526 |
return 0; } |
ef3b7d0d3 mfd: Rename twl40... |
527 |
static int twl_rtc_resume(struct platform_device *pdev) |
f96411ab7 mfd: rtc-twl4030 ... |
528 529 530 531 532 533 |
{ set_rtc_irq_bit(irqstat); return 0; } #else |
ef3b7d0d3 mfd: Rename twl40... |
534 535 |
#define twl_rtc_suspend NULL #define twl_rtc_resume NULL |
f96411ab7 mfd: rtc-twl4030 ... |
536 |
#endif |
948170f89 drivers/rtc/rtc-t... |
537 538 539 540 541 |
static const struct of_device_id twl_rtc_of_match[] = { {.compatible = "ti,twl4030-rtc", }, { }, }; MODULE_DEVICE_TABLE(of, twl_rtc_of_match); |
ef3b7d0d3 mfd: Rename twl40... |
542 |
MODULE_ALIAS("platform:twl_rtc"); |
f96411ab7 mfd: rtc-twl4030 ... |
543 544 |
static struct platform_driver twl4030rtc_driver = { |
ef3b7d0d3 mfd: Rename twl40... |
545 546 547 548 549 |
.probe = twl_rtc_probe, .remove = __devexit_p(twl_rtc_remove), .shutdown = twl_rtc_shutdown, .suspend = twl_rtc_suspend, .resume = twl_rtc_resume, |
f96411ab7 mfd: rtc-twl4030 ... |
550 |
.driver = { |
948170f89 drivers/rtc/rtc-t... |
551 552 553 |
.owner = THIS_MODULE, .name = "twl_rtc", .of_match_table = twl_rtc_of_match, |
f96411ab7 mfd: rtc-twl4030 ... |
554 555 |
}, }; |
ef3b7d0d3 mfd: Rename twl40... |
556 |
static int __init twl_rtc_init(void) |
f96411ab7 mfd: rtc-twl4030 ... |
557 |
{ |
a6b49ffd2 rtc: Add twl6030 ... |
558 559 560 561 |
if (twl_class_is_4030()) rtc_reg_map = (u8 *) twl4030_rtc_reg_map; else rtc_reg_map = (u8 *) twl6030_rtc_reg_map; |
f96411ab7 mfd: rtc-twl4030 ... |
562 563 |
return platform_driver_register(&twl4030rtc_driver); } |
ef3b7d0d3 mfd: Rename twl40... |
564 |
module_init(twl_rtc_init); |
f96411ab7 mfd: rtc-twl4030 ... |
565 |
|
ef3b7d0d3 mfd: Rename twl40... |
566 |
static void __exit twl_rtc_exit(void) |
f96411ab7 mfd: rtc-twl4030 ... |
567 568 569 |
{ platform_driver_unregister(&twl4030rtc_driver); } |
ef3b7d0d3 mfd: Rename twl40... |
570 |
module_exit(twl_rtc_exit); |
f96411ab7 mfd: rtc-twl4030 ... |
571 572 573 |
MODULE_AUTHOR("Texas Instruments, MontaVista Software"); MODULE_LICENSE("GPL"); |