2008-10-21 01:50:05 +04:00
/*
2009-12-13 23:30:48 +03:00
* rtc - twl . c - - TWL Real Time Clock interface
2008-10-21 01:50:05 +04:00
*
* 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>
2009-01-07 01:42:11 +03:00
# include <linux/errno.h>
2008-10-21 01:50:05 +04:00
# 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>
2009-12-13 22:05:51 +03:00
# include <linux/i2c/twl.h>
2008-10-21 01:50:05 +04:00
/*
* RTC block register offsets ( use TWL_MODULE_RTC )
*/
2009-12-14 00:16:31 +03:00
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 ,
} ;
2010-03-06 00:44:23 +03:00
static const u8 twl4030_rtc_reg_map [ ] = {
2009-12-14 00:16:31 +03:00
[ 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 ,
} ;
2010-03-06 00:44:23 +03:00
static const u8 twl6030_rtc_reg_map [ ] = {
2009-12-14 00:16:31 +03:00
[ 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 ,
} ;
2008-10-21 01:50:05 +04:00
/* 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
/*----------------------------------------------------------------------*/
2009-12-14 00:16:31 +03:00
static u8 * rtc_reg_map ;
2008-10-21 01:50:05 +04:00
/*
2009-12-13 23:30:48 +03:00
* Supports 1 byte read from TWL RTC register .
2008-10-21 01:50:05 +04:00
*/
2009-12-13 23:30:48 +03:00
static int twl_rtc_read_u8 ( u8 * data , u8 reg )
2008-10-21 01:50:05 +04:00
{
int ret ;
2009-12-14 00:16:31 +03:00
ret = twl_i2c_read_u8 ( TWL_MODULE_RTC , data , ( rtc_reg_map [ reg ] ) ) ;
2008-10-21 01:50:05 +04:00
if ( ret < 0 )
2009-12-13 23:30:48 +03:00
pr_err ( " twl_rtc: Could not read TWL "
2008-10-21 01:50:05 +04:00
" register %X - error %d \n " , reg , ret ) ;
return ret ;
}
/*
2009-12-13 23:30:48 +03:00
* Supports 1 byte write to TWL RTC registers .
2008-10-21 01:50:05 +04:00
*/
2009-12-13 23:30:48 +03:00
static int twl_rtc_write_u8 ( u8 data , u8 reg )
2008-10-21 01:50:05 +04:00
{
int ret ;
2009-12-14 00:16:31 +03:00
ret = twl_i2c_write_u8 ( TWL_MODULE_RTC , data , ( rtc_reg_map [ reg ] ) ) ;
2008-10-21 01:50:05 +04:00
if ( ret < 0 )
2009-12-13 23:30:48 +03:00
pr_err ( " twl_rtc: Could not write TWL "
2008-10-21 01:50:05 +04:00
" 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 ;
/*
2009-01-16 00:50:52 +03:00
* Enable 1 / second update and / or alarm interrupts .
2008-10-21 01:50:05 +04:00
*/
static int set_rtc_irq_bit ( unsigned char bit )
{
unsigned char val ;
int ret ;
val = rtc_irq_bits | bit ;
2009-01-16 00:50:52 +03:00
val & = ~ BIT_RTC_INTERRUPTS_REG_EVERY_M ;
2009-12-13 23:30:48 +03:00
ret = twl_rtc_write_u8 ( val , REG_RTC_INTERRUPTS_REG ) ;
2008-10-21 01:50:05 +04:00
if ( ret = = 0 )
rtc_irq_bits = val ;
return ret ;
}
/*
2009-01-16 00:50:52 +03:00
* Disable update and / or alarm interrupts .
2008-10-21 01:50:05 +04:00
*/
static int mask_rtc_irq_bit ( unsigned char bit )
{
unsigned char val ;
int ret ;
val = rtc_irq_bits & ~ bit ;
2009-12-13 23:30:48 +03:00
ret = twl_rtc_write_u8 ( val , REG_RTC_INTERRUPTS_REG ) ;
2008-10-21 01:50:05 +04:00
if ( ret = = 0 )
rtc_irq_bits = val ;
return ret ;
}
2009-12-13 23:30:48 +03:00
static int twl_rtc_alarm_irq_enable ( struct device * dev , unsigned enabled )
2008-10-21 01:50:05 +04:00
{
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 ;
}
/*
2009-12-13 23:30:48 +03:00
* Gets current TWL RTC time and date parameters .
2008-10-21 01:50:05 +04:00
*
* 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 21 st century )
*/
2009-12-13 23:30:48 +03:00
static int twl_rtc_read_time ( struct device * dev , struct rtc_time * tm )
2008-10-21 01:50:05 +04:00
{
unsigned char rtc_data [ ALL_TIME_REGS + 1 ] ;
int ret ;
u8 save_control ;
2009-12-13 23:30:48 +03:00
ret = twl_rtc_read_u8 ( & save_control , REG_RTC_CTRL_REG ) ;
2008-10-21 01:50:05 +04:00
if ( ret < 0 )
return ret ;
save_control | = BIT_RTC_CTRL_REG_GET_TIME_M ;
2009-12-13 23:30:48 +03:00
ret = twl_rtc_write_u8 ( save_control , REG_RTC_CTRL_REG ) ;
2008-10-21 01:50:05 +04:00
if ( ret < 0 )
return ret ;
2009-12-13 23:30:48 +03:00
ret = twl_i2c_read ( TWL_MODULE_RTC , rtc_data ,
2009-12-14 00:16:31 +03:00
( rtc_reg_map [ REG_SECONDS_REG ] ) , ALL_TIME_REGS ) ;
2008-10-21 01:50:05 +04:00
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 ;
}
2009-12-13 23:30:48 +03:00
static int twl_rtc_set_time ( struct device * dev , struct rtc_time * tm )
2008-10-21 01:50:05 +04:00
{
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 */
2009-12-13 23:30:48 +03:00
ret = twl_rtc_read_u8 ( & save_control , REG_RTC_CTRL_REG ) ;
2008-10-21 01:50:05 +04:00
if ( ret < 0 )
goto out ;
save_control & = ~ BIT_RTC_CTRL_REG_STOP_RTC_M ;
2011-07-26 04:13:34 +04:00
ret = twl_rtc_write_u8 ( save_control , REG_RTC_CTRL_REG ) ;
2008-10-21 01:50:05 +04:00
if ( ret < 0 )
goto out ;
/* update all the time registers in one shot */
2009-12-13 23:30:48 +03:00
ret = twl_i2c_write ( TWL_MODULE_RTC , rtc_data ,
2009-12-14 00:16:31 +03:00
( rtc_reg_map [ REG_SECONDS_REG ] ) , ALL_TIME_REGS ) ;
2008-10-21 01:50:05 +04:00
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 ;
2009-12-13 23:30:48 +03:00
ret = twl_rtc_write_u8 ( save_control , REG_RTC_CTRL_REG ) ;
2008-10-21 01:50:05 +04:00
out :
return ret ;
}
/*
2009-12-13 23:30:48 +03:00
* Gets current TWL RTC alarm time .
2008-10-21 01:50:05 +04:00
*/
2009-12-13 23:30:48 +03:00
static int twl_rtc_read_alarm ( struct device * dev , struct rtc_wkalrm * alm )
2008-10-21 01:50:05 +04:00
{
unsigned char rtc_data [ ALL_TIME_REGS + 1 ] ;
int ret ;
2009-12-13 23:30:48 +03:00
ret = twl_i2c_read ( TWL_MODULE_RTC , rtc_data ,
2009-12-14 00:16:31 +03:00
( rtc_reg_map [ REG_ALARM_SECONDS_REG ] ) , ALL_TIME_REGS ) ;
2008-10-21 01:50:05 +04:00
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 ;
}
2009-12-13 23:30:48 +03:00
static int twl_rtc_set_alarm ( struct device * dev , struct rtc_wkalrm * alm )
2008-10-21 01:50:05 +04:00
{
unsigned char alarm_data [ ALL_TIME_REGS + 1 ] ;
int ret ;
2009-12-13 23:30:48 +03:00
ret = twl_rtc_alarm_irq_enable ( dev , 0 ) ;
2008-10-21 01:50:05 +04:00
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 */
2009-12-13 23:30:48 +03:00
ret = twl_i2c_write ( TWL_MODULE_RTC , alarm_data ,
2009-12-14 00:16:31 +03:00
( rtc_reg_map [ REG_ALARM_SECONDS_REG ] ) , ALL_TIME_REGS ) ;
2008-10-21 01:50:05 +04:00
if ( ret ) {
dev_err ( dev , " rtc_set_alarm error %d \n " , ret ) ;
goto out ;
}
if ( alm - > enabled )
2009-12-13 23:30:48 +03:00
ret = twl_rtc_alarm_irq_enable ( dev , 1 ) ;
2008-10-21 01:50:05 +04:00
out :
return ret ;
}
2009-12-13 23:30:48 +03:00
static irqreturn_t twl_rtc_interrupt ( int irq , void * rtc )
2008-10-21 01:50:05 +04:00
{
unsigned long events = 0 ;
int ret = IRQ_NONE ;
int res ;
u8 rd_reg ;
2009-12-13 23:30:48 +03:00
res = twl_rtc_read_u8 ( & rd_reg , REG_RTC_STATUS_REG ) ;
2008-10-21 01:50:05 +04:00
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 ;
2009-12-13 23:30:48 +03:00
res = twl_rtc_write_u8 ( rd_reg | BIT_RTC_STATUS_REG_ALARM_M ,
2008-10-21 01:50:05 +04:00
REG_RTC_STATUS_REG ) ;
if ( res )
goto out ;
2009-12-14 00:16:31 +03:00
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 ,
2008-10-21 01:50:05 +04:00
& rd_reg , TWL4030_INT_PWR_ISR1 ) ;
2009-12-14 00:16:31 +03:00
if ( res )
goto out ;
}
2008-10-21 01:50:05 +04:00
/* Notify RTC core on event */
rtc_update_irq ( rtc , 1 , events ) ;
ret = IRQ_HANDLED ;
out :
return ret ;
}
2009-12-13 23:30:48 +03:00
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 ,
2008-10-21 01:50:05 +04:00
} ;
/*----------------------------------------------------------------------*/
2009-12-13 23:30:48 +03:00
static int __devinit twl_rtc_probe ( struct platform_device * pdev )
2008-10-21 01:50:05 +04:00
{
struct rtc_device * rtc ;
2011-08-11 07:20:36 +04:00
int ret = - EINVAL ;
2008-10-21 01:50:05 +04:00
int irq = platform_get_irq ( pdev , 0 ) ;
u8 rd_reg ;
2009-01-07 01:42:11 +03:00
if ( irq < = 0 )
2011-08-11 07:20:36 +04:00
goto out1 ;
2008-10-21 01:50:05 +04:00
2009-12-13 23:30:48 +03:00
ret = twl_rtc_read_u8 ( & rd_reg , REG_RTC_STATUS_REG ) ;
2008-10-21 01:50:05 +04:00
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 */
2009-12-13 23:30:48 +03:00
ret = twl_rtc_write_u8 ( rd_reg , REG_RTC_STATUS_REG ) ;
2008-10-21 01:50:05 +04:00
if ( ret < 0 )
goto out1 ;
2009-12-14 00:16:31 +03:00
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 ) ;
}
2008-10-21 01:50:05 +04:00
/* Check RTC module status, Enable if it is off */
2009-12-13 23:30:48 +03:00
ret = twl_rtc_read_u8 ( & rd_reg , REG_RTC_CTRL_REG ) ;
2008-10-21 01:50:05 +04:00
if ( ret < 0 )
2011-08-11 07:20:36 +04:00
goto out1 ;
2008-10-21 01:50:05 +04:00
if ( ! ( rd_reg & BIT_RTC_CTRL_REG_STOP_RTC_M ) ) {
2009-12-13 23:30:48 +03:00
dev_info ( & pdev - > dev , " Enabling TWL-RTC. \n " ) ;
2008-10-21 01:50:05 +04:00
rd_reg = BIT_RTC_CTRL_REG_STOP_RTC_M ;
2009-12-13 23:30:48 +03:00
ret = twl_rtc_write_u8 ( rd_reg , REG_RTC_CTRL_REG ) ;
2008-10-21 01:50:05 +04:00
if ( ret < 0 )
2011-08-11 07:20:36 +04:00
goto out1 ;
2008-10-21 01:50:05 +04:00
}
/* init cached IRQ enable bits */
2009-12-13 23:30:48 +03:00
ret = twl_rtc_read_u8 ( & rtc_irq_bits , REG_RTC_INTERRUPTS_REG ) ;
2008-10-21 01:50:05 +04:00
if ( ret < 0 )
2011-08-11 07:20:36 +04:00
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 \n " ,
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. \n " ) ;
2008-10-21 01:50:05 +04:00
goto out2 ;
2011-08-11 07:20:36 +04:00
}
2008-10-21 01:50:05 +04:00
2011-08-11 07:20:36 +04:00
platform_set_drvdata ( pdev , rtc ) ;
return 0 ;
2008-10-21 01:50:05 +04:00
out2 :
rtc_device_unregister ( rtc ) ;
2011-08-11 07:20:36 +04:00
out1 :
2008-10-21 01:50:05 +04:00
return ret ;
}
/*
2009-12-13 23:30:48 +03:00
* Disable all TWL RTC module interrupts .
2008-10-21 01:50:05 +04:00
* Sets status flag to free .
*/
2009-12-13 23:30:48 +03:00
static int __devexit twl_rtc_remove ( struct platform_device * pdev )
2008-10-21 01:50:05 +04:00
{
/* 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 ) ;
2009-12-14 00:16:31 +03:00
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 ) ;
}
2008-10-21 01:50:05 +04:00
free_irq ( irq , rtc ) ;
rtc_device_unregister ( rtc ) ;
platform_set_drvdata ( pdev , NULL ) ;
return 0 ;
}
2009-12-13 23:30:48 +03:00
static void twl_rtc_shutdown ( struct platform_device * pdev )
2008-10-21 01:50:05 +04:00
{
2009-01-16 00:50:56 +03:00
/* 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 ) ;
2008-10-21 01:50:05 +04:00
}
# ifdef CONFIG_PM
static unsigned char irqstat ;
2009-12-13 23:30:48 +03:00
static int twl_rtc_suspend ( struct platform_device * pdev , pm_message_t state )
2008-10-21 01:50:05 +04:00
{
irqstat = rtc_irq_bits ;
2009-05-13 00:19:38 +04:00
mask_rtc_irq_bit ( BIT_RTC_INTERRUPTS_REG_IT_TIMER_M ) ;
2008-10-21 01:50:05 +04:00
return 0 ;
}
2009-12-13 23:30:48 +03:00
static int twl_rtc_resume ( struct platform_device * pdev )
2008-10-21 01:50:05 +04:00
{
set_rtc_irq_bit ( irqstat ) ;
return 0 ;
}
# else
2009-12-13 23:30:48 +03:00
# define twl_rtc_suspend NULL
# define twl_rtc_resume NULL
2008-10-21 01:50:05 +04:00
# endif
2009-12-13 23:30:48 +03:00
MODULE_ALIAS ( " platform:twl_rtc " ) ;
2008-10-21 01:50:05 +04:00
static struct platform_driver twl4030rtc_driver = {
2009-12-13 23:30:48 +03:00
. probe = twl_rtc_probe ,
. remove = __devexit_p ( twl_rtc_remove ) ,
. shutdown = twl_rtc_shutdown ,
. suspend = twl_rtc_suspend ,
. resume = twl_rtc_resume ,
2008-10-21 01:50:05 +04:00
. driver = {
. owner = THIS_MODULE ,
2009-12-13 23:30:48 +03:00
. name = " twl_rtc " ,
2008-10-21 01:50:05 +04:00
} ,
} ;
2009-12-13 23:30:48 +03:00
static int __init twl_rtc_init ( void )
2008-10-21 01:50:05 +04:00
{
2009-12-14 00:16:31 +03:00
if ( twl_class_is_4030 ( ) )
rtc_reg_map = ( u8 * ) twl4030_rtc_reg_map ;
else
rtc_reg_map = ( u8 * ) twl6030_rtc_reg_map ;
2008-10-21 01:50:05 +04:00
return platform_driver_register ( & twl4030rtc_driver ) ;
}
2009-12-13 23:30:48 +03:00
module_init ( twl_rtc_init ) ;
2008-10-21 01:50:05 +04:00
2009-12-13 23:30:48 +03:00
static void __exit twl_rtc_exit ( void )
2008-10-21 01:50:05 +04:00
{
platform_driver_unregister ( & twl4030rtc_driver ) ;
}
2009-12-13 23:30:48 +03:00
module_exit ( twl_rtc_exit ) ;
2008-10-21 01:50:05 +04:00
MODULE_AUTHOR ( " Texas Instruments, MontaVista Software " ) ;
MODULE_LICENSE ( " GPL " ) ;