diff options
Diffstat (limited to 'drivers/rtc/rtc-ds1511.c')
| -rw-r--r-- | drivers/rtc/rtc-ds1511.c | 174 | 
1 files changed, 65 insertions, 109 deletions
diff --git a/drivers/rtc/rtc-ds1511.c b/drivers/rtc/rtc-ds1511.c index 37268e97de4..b13d1399b81 100644 --- a/drivers/rtc/rtc-ds1511.c +++ b/drivers/rtc/rtc-ds1511.c @@ -23,6 +23,7 @@  #include <linux/rtc.h>  #include <linux/platform_device.h>  #include <linux/io.h> +#include <linux/module.h>  #define DRV_VERSION "0.6" @@ -88,7 +89,6 @@ enum ds1511reg {  struct rtc_plat_data {  	struct rtc_device *rtc;  	void __iomem *ioaddr;		/* virtual base address */ -	int size;				/* amount of memory mapped */  	int irq;  	unsigned int irqen;  	int alrm_sec; @@ -103,31 +103,31 @@ static DEFINE_SPINLOCK(ds1511_lock);  static __iomem char *ds1511_base;  static u32 reg_spacing = 1; - static noinline void +static noinline void  rtc_write(uint8_t val, uint32_t reg)  {  	writeb(val, ds1511_base + (reg * reg_spacing));  } - static inline void +static inline void  rtc_write_alarm(uint8_t val, enum ds1511reg reg)  {  	rtc_write((val | 0x80), reg);  } - static noinline uint8_t +static noinline uint8_t  rtc_read(enum ds1511reg reg)  {  	return readb(ds1511_base + (reg * reg_spacing));  } - static inline void +static inline void  rtc_disable_update(void)  {  	rtc_write((rtc_read(RTC_CMD) & ~RTC_TE), RTC_CMD);  } - static void +static void  rtc_enable_update(void)  {  	rtc_write((rtc_read(RTC_CMD) | RTC_TE), RTC_CMD); @@ -144,7 +144,7 @@ rtc_enable_update(void)   * just enough code to set the watchdog timer so that it   * will reboot the system   */ - void +void  ds1511_wdog_set(unsigned long deciseconds)  {  	/* @@ -162,7 +162,7 @@ ds1511_wdog_set(unsigned long deciseconds)  	rtc_write(DS1511_WDE | DS1511_WDS, RTC_CMD);  } - void +void  ds1511_wdog_disable(void)  {  	/* @@ -190,13 +190,12 @@ static int ds1511_rtc_set_time(struct device *dev, struct rtc_time *rtc_tm)  	/*  	 * won't have to change this for a while  	 */ -	if (rtc_tm->tm_year < 1900) { +	if (rtc_tm->tm_year < 1900)  		rtc_tm->tm_year += 1900; -	} -	if (rtc_tm->tm_year < 1970) { +	if (rtc_tm->tm_year < 1970)  		return -EINVAL; -	} +  	yrs = rtc_tm->tm_year % 100;  	cen = rtc_tm->tm_year / 100;  	mon = rtc_tm->tm_mon + 1;   /* tm_mon starts at zero */ @@ -206,17 +205,14 @@ static int ds1511_rtc_set_time(struct device *dev, struct rtc_time *rtc_tm)  	min = rtc_tm->tm_min;  	sec = rtc_tm->tm_sec; -	if ((mon > 12) || (day == 0)) { +	if ((mon > 12) || (day == 0))  		return -EINVAL; -	} -	if (day > rtc_month_days(rtc_tm->tm_mon, rtc_tm->tm_year)) { +	if (day > rtc_month_days(rtc_tm->tm_mon, rtc_tm->tm_year))  		return -EINVAL; -	} -	if ((hrs >= 24) || (min >= 60) || (sec >= 60)) { +	if ((hrs >= 24) || (min >= 60) || (sec >= 60))  		return -EINVAL; -	}  	/*  	 * each register is a different number of valid bits @@ -298,7 +294,7 @@ static int ds1511_rtc_read_time(struct device *dev, struct rtc_time *rtc_tm)   * date/hours/mins/secs matches.  the ds1511 has many more   * permutations, but the kernel doesn't.   */ - static void +static void  ds1511_rtc_update_alarm(struct rtc_plat_data *pdata)  {  	unsigned long flags; @@ -321,7 +317,7 @@ ds1511_rtc_update_alarm(struct rtc_plat_data *pdata)  	spin_unlock_irqrestore(&pdata->lock, flags);  } - static int +static int  ds1511_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm)  {  	struct platform_device *pdev = to_platform_device(dev); @@ -334,14 +330,14 @@ ds1511_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm)  	pdata->alrm_hour = alrm->time.tm_hour;  	pdata->alrm_min = alrm->time.tm_min;  	pdata->alrm_sec = alrm->time.tm_sec; -	if (alrm->enabled) { +	if (alrm->enabled)  		pdata->irqen |= RTC_AF; -	} +  	ds1511_rtc_update_alarm(pdata);  	return 0;  } - static int +static int  ds1511_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm)  {  	struct platform_device *pdev = to_platform_device(dev); @@ -358,7 +354,7 @@ ds1511_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm)  	return 0;  } - static irqreturn_t +static irqreturn_t  ds1511_interrupt(int irq, void *dev_id)  {  	struct platform_device *pdev = dev_id; @@ -375,8 +371,7 @@ ds1511_interrupt(int irq, void *dev_id)  			events |= RTC_UF;  		else  			events |= RTC_AF; -		if (likely(pdata->rtc)) -			rtc_update_irq(pdata->rtc, 1, events); +		rtc_update_irq(pdata->rtc, 1, events);  	}  	spin_unlock(&pdata->lock);  	return events ? IRQ_HANDLED : IRQ_NONE; @@ -397,32 +392,15 @@ static int ds1511_rtc_alarm_irq_enable(struct device *dev, unsigned int enabled)  	return 0;  } -static int ds1511_rtc_update_irq_enable(struct device *dev, -	unsigned int enabled) -{ -	struct platform_device *pdev = to_platform_device(dev); -	struct rtc_plat_data *pdata = platform_get_drvdata(pdev); - -	if (pdata->irq <= 0) -		return -EINVAL; -	if (enabled) -		pdata->irqen |= RTC_UF; -	else -		pdata->irqen &= ~RTC_UF; -	ds1511_rtc_update_alarm(pdata); -	return 0; -} -  static const struct rtc_class_ops ds1511_rtc_ops = {  	.read_time		= ds1511_rtc_read_time,  	.set_time		= ds1511_rtc_set_time,  	.read_alarm		= ds1511_rtc_read_alarm,  	.set_alarm		= ds1511_rtc_set_alarm,  	.alarm_irq_enable	= ds1511_rtc_alarm_irq_enable, -	.update_irq_enable	= ds1511_rtc_update_irq_enable,  }; - static ssize_t +static ssize_t  ds1511_nvram_read(struct file *filp, struct kobject *kobj,  		  struct bin_attribute *ba,  		  char *buf, loff_t pos, size_t size) @@ -433,26 +411,26 @@ ds1511_nvram_read(struct file *filp, struct kobject *kobj,  	 * if count is more than one, turn on "burst" mode  	 * turn it off when you're done  	 */ -	if (size > 1) { +	if (size > 1)  		rtc_write((rtc_read(RTC_CMD) | DS1511_BME), RTC_CMD); -	} -	if (pos > DS1511_RAM_MAX) { + +	if (pos > DS1511_RAM_MAX)  		pos = DS1511_RAM_MAX; -	} -	if (size + pos > DS1511_RAM_MAX + 1) { + +	if (size + pos > DS1511_RAM_MAX + 1)  		size = DS1511_RAM_MAX - pos + 1; -	} +  	rtc_write(pos, DS1511_RAMADDR_LSB); -	for (count = 0; size > 0; count++, size--) { +	for (count = 0; size > 0; count++, size--)  		*buf++ = rtc_read(DS1511_RAMDATA); -	} -	if (count > 1) { + +	if (count > 1)  		rtc_write((rtc_read(RTC_CMD) & ~DS1511_BME), RTC_CMD); -	} +  	return count;  } - static ssize_t +static ssize_t  ds1511_nvram_write(struct file *filp, struct kobject *kobj,  		   struct bin_attribute *bin_attr,  		   char *buf, loff_t pos, size_t size) @@ -463,57 +441,49 @@ ds1511_nvram_write(struct file *filp, struct kobject *kobj,  	 * if count is more than one, turn on "burst" mode  	 * turn it off when you're done  	 */ -	if (size > 1) { +	if (size > 1)  		rtc_write((rtc_read(RTC_CMD) | DS1511_BME), RTC_CMD); -	} -	if (pos > DS1511_RAM_MAX) { + +	if (pos > DS1511_RAM_MAX)  		pos = DS1511_RAM_MAX; -	} -	if (size + pos > DS1511_RAM_MAX + 1) { + +	if (size + pos > DS1511_RAM_MAX + 1)  		size = DS1511_RAM_MAX - pos + 1; -	} +  	rtc_write(pos, DS1511_RAMADDR_LSB); -	for (count = 0; size > 0; count++, size--) { +	for (count = 0; size > 0; count++, size--)  		rtc_write(*buf++, DS1511_RAMDATA); -	} -	if (count > 1) { + +	if (count > 1)  		rtc_write((rtc_read(RTC_CMD) & ~DS1511_BME), RTC_CMD); -	} +  	return count;  }  static struct bin_attribute ds1511_nvram_attr = {  	.attr = {  		.name = "nvram", -		.mode = S_IRUGO | S_IWUGO, +		.mode = S_IRUGO | S_IWUSR,  	},  	.size = DS1511_RAM_MAX,  	.read = ds1511_nvram_read,  	.write = ds1511_nvram_write,  }; - static int __devinit -ds1511_rtc_probe(struct platform_device *pdev) +static int ds1511_rtc_probe(struct platform_device *pdev)  { -	struct rtc_device *rtc;  	struct resource *res;  	struct rtc_plat_data *pdata;  	int ret = 0; -	res = platform_get_resource(pdev, IORESOURCE_MEM, 0); -	if (!res) { -		return -ENODEV; -	}  	pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);  	if (!pdata)  		return -ENOMEM; -	pdata->size = res->end - res->start + 1; -	if (!devm_request_mem_region(&pdev->dev, res->start, pdata->size, -			pdev->name)) -		return -EBUSY; -	ds1511_base = devm_ioremap(&pdev->dev, res->start, pdata->size); -	if (!ds1511_base) -		return -ENOMEM; + +	res = platform_get_resource(pdev, IORESOURCE_MEM, 0); +	ds1511_base = devm_ioremap_resource(&pdev->dev, res); +	if (IS_ERR(ds1511_base)) +		return PTR_ERR(ds1511_base);  	pdata->ioaddr = ds1511_base;  	pdata->irq = platform_get_irq(pdev, 0); @@ -535,12 +505,17 @@ ds1511_rtc_probe(struct platform_device *pdev)  	/*  	 * check for a dying bat-tree  	 */ -	if (rtc_read(RTC_CMD1) & DS1511_BLF1) { +	if (rtc_read(RTC_CMD1) & DS1511_BLF1)  		dev_warn(&pdev->dev, "voltage-low detected.\n"); -	}  	spin_lock_init(&pdata->lock);  	platform_set_drvdata(pdev, pdata); + +	pdata->rtc = devm_rtc_device_register(&pdev->dev, pdev->name, +					      &ds1511_rtc_ops, THIS_MODULE); +	if (IS_ERR(pdata->rtc)) +		return PTR_ERR(pdata->rtc); +  	/*  	 * if the platform has an interrupt in mind for this device,  	 * then by all means, set it @@ -548,32 +523,26 @@ ds1511_rtc_probe(struct platform_device *pdev)  	if (pdata->irq > 0) {  		rtc_read(RTC_CMD1);  		if (devm_request_irq(&pdev->dev, pdata->irq, ds1511_interrupt, -			IRQF_DISABLED | IRQF_SHARED, pdev->name, pdev) < 0) { +			IRQF_SHARED, pdev->name, pdev) < 0) {  			dev_warn(&pdev->dev, "interrupt not available.\n");  			pdata->irq = 0;  		}  	} -	rtc = rtc_device_register(pdev->name, &pdev->dev, &ds1511_rtc_ops, -		THIS_MODULE); -	if (IS_ERR(rtc)) -		return PTR_ERR(rtc); -	pdata->rtc = rtc; -  	ret = sysfs_create_bin_file(&pdev->dev.kobj, &ds1511_nvram_attr);  	if (ret) -		rtc_device_unregister(pdata->rtc); -	return ret; +		dev_err(&pdev->dev, "Unable to create sysfs entry: %s\n", +			ds1511_nvram_attr.attr.name); + +	return 0;  } - static int __devexit -ds1511_rtc_remove(struct platform_device *pdev) +static int ds1511_rtc_remove(struct platform_device *pdev)  {  	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);  	sysfs_remove_bin_file(&pdev->dev.kobj, &ds1511_nvram_attr); -	rtc_device_unregister(pdata->rtc);  	if (pdata->irq > 0) {  		/*  		 * disable the alarm interrupt @@ -589,27 +558,14 @@ MODULE_ALIAS("platform:ds1511");  static struct platform_driver ds1511_rtc_driver = {  	.probe		= ds1511_rtc_probe, -	.remove		= __devexit_p(ds1511_rtc_remove), +	.remove		= ds1511_rtc_remove,  	.driver		= {  		.name	= "ds1511",  		.owner	= THIS_MODULE,  	},  }; - static int __init -ds1511_rtc_init(void) -{ -	return platform_driver_register(&ds1511_rtc_driver); -} - - static void __exit -ds1511_rtc_exit(void) -{ -	platform_driver_unregister(&ds1511_rtc_driver); -} - -module_init(ds1511_rtc_init); -module_exit(ds1511_rtc_exit); +module_platform_driver(ds1511_rtc_driver);  MODULE_AUTHOR("Andrew Sharp <andy.sharp@lsi.com>");  MODULE_DESCRIPTION("Dallas DS1511 RTC driver");  | 
