|  | /* | 
|  | *  Ricoh RP5C01 RTC Driver | 
|  | * | 
|  | *  Copyright 2009 Geert Uytterhoeven | 
|  | * | 
|  | *  Based on the A3000 TOD code in arch/m68k/amiga/config.c | 
|  | *  Copyright (C) 1993 Hamish Macdonald | 
|  | */ | 
|  |  | 
|  | #include <linux/io.h> | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/platform_device.h> | 
|  | #include <linux/rtc.h> | 
|  | #include <linux/slab.h> | 
|  |  | 
|  |  | 
|  | enum { | 
|  | RP5C01_1_SECOND		= 0x0,	/* MODE 00 */ | 
|  | RP5C01_10_SECOND	= 0x1,	/* MODE 00 */ | 
|  | RP5C01_1_MINUTE		= 0x2,	/* MODE 00 and MODE 01 */ | 
|  | RP5C01_10_MINUTE	= 0x3,	/* MODE 00 and MODE 01 */ | 
|  | RP5C01_1_HOUR		= 0x4,	/* MODE 00 and MODE 01 */ | 
|  | RP5C01_10_HOUR		= 0x5,	/* MODE 00 and MODE 01 */ | 
|  | RP5C01_DAY_OF_WEEK	= 0x6,	/* MODE 00 and MODE 01 */ | 
|  | RP5C01_1_DAY		= 0x7,	/* MODE 00 and MODE 01 */ | 
|  | RP5C01_10_DAY		= 0x8,	/* MODE 00 and MODE 01 */ | 
|  | RP5C01_1_MONTH		= 0x9,	/* MODE 00 */ | 
|  | RP5C01_10_MONTH		= 0xa,	/* MODE 00 */ | 
|  | RP5C01_1_YEAR		= 0xb,	/* MODE 00 */ | 
|  | RP5C01_10_YEAR		= 0xc,	/* MODE 00 */ | 
|  |  | 
|  | RP5C01_12_24_SELECT	= 0xa,	/* MODE 01 */ | 
|  | RP5C01_LEAP_YEAR	= 0xb,	/* MODE 01 */ | 
|  |  | 
|  | RP5C01_MODE		= 0xd,	/* all modes */ | 
|  | RP5C01_TEST		= 0xe,	/* all modes */ | 
|  | RP5C01_RESET		= 0xf,	/* all modes */ | 
|  | }; | 
|  |  | 
|  | #define RP5C01_12_24_SELECT_12	(0 << 0) | 
|  | #define RP5C01_12_24_SELECT_24	(1 << 0) | 
|  |  | 
|  | #define RP5C01_10_HOUR_AM	(0 << 1) | 
|  | #define RP5C01_10_HOUR_PM	(1 << 1) | 
|  |  | 
|  | #define RP5C01_MODE_TIMER_EN	(1 << 3)	/* timer enable */ | 
|  | #define RP5C01_MODE_ALARM_EN	(1 << 2)	/* alarm enable */ | 
|  |  | 
|  | #define RP5C01_MODE_MODE_MASK	(3 << 0) | 
|  | #define RP5C01_MODE_MODE00	(0 << 0)	/* time */ | 
|  | #define RP5C01_MODE_MODE01	(1 << 0)	/* alarm, 12h/24h, leap year */ | 
|  | #define RP5C01_MODE_RAM_BLOCK10	(2 << 0)	/* RAM 4 bits x 13 */ | 
|  | #define RP5C01_MODE_RAM_BLOCK11	(3 << 0)	/* RAM 4 bits x 13 */ | 
|  |  | 
|  | #define RP5C01_RESET_1HZ_PULSE	(1 << 3) | 
|  | #define RP5C01_RESET_16HZ_PULSE	(1 << 2) | 
|  | #define RP5C01_RESET_SECOND	(1 << 1)	/* reset divider stages for */ | 
|  | /* seconds or smaller units */ | 
|  | #define RP5C01_RESET_ALARM	(1 << 0)	/* reset all alarm registers */ | 
|  |  | 
|  |  | 
|  | struct rp5c01_priv { | 
|  | u32 __iomem *regs; | 
|  | struct rtc_device *rtc; | 
|  | spinlock_t lock;	/* against concurrent RTC/NVRAM access */ | 
|  | struct bin_attribute nvram_attr; | 
|  | }; | 
|  |  | 
|  | static inline unsigned int rp5c01_read(struct rp5c01_priv *priv, | 
|  | unsigned int reg) | 
|  | { | 
|  | return __raw_readl(&priv->regs[reg]) & 0xf; | 
|  | } | 
|  |  | 
|  | static inline void rp5c01_write(struct rp5c01_priv *priv, unsigned int val, | 
|  | unsigned int reg) | 
|  | { | 
|  | __raw_writel(val, &priv->regs[reg]); | 
|  | } | 
|  |  | 
|  | static void rp5c01_lock(struct rp5c01_priv *priv) | 
|  | { | 
|  | rp5c01_write(priv, RP5C01_MODE_MODE00, RP5C01_MODE); | 
|  | } | 
|  |  | 
|  | static void rp5c01_unlock(struct rp5c01_priv *priv) | 
|  | { | 
|  | rp5c01_write(priv, RP5C01_MODE_TIMER_EN | RP5C01_MODE_MODE01, | 
|  | RP5C01_MODE); | 
|  | } | 
|  |  | 
|  | static int rp5c01_read_time(struct device *dev, struct rtc_time *tm) | 
|  | { | 
|  | struct rp5c01_priv *priv = dev_get_drvdata(dev); | 
|  |  | 
|  | spin_lock_irq(&priv->lock); | 
|  | rp5c01_lock(priv); | 
|  |  | 
|  | tm->tm_sec  = rp5c01_read(priv, RP5C01_10_SECOND) * 10 + | 
|  | rp5c01_read(priv, RP5C01_1_SECOND); | 
|  | tm->tm_min  = rp5c01_read(priv, RP5C01_10_MINUTE) * 10 + | 
|  | rp5c01_read(priv, RP5C01_1_MINUTE); | 
|  | tm->tm_hour = rp5c01_read(priv, RP5C01_10_HOUR) * 10 + | 
|  | rp5c01_read(priv, RP5C01_1_HOUR); | 
|  | tm->tm_mday = rp5c01_read(priv, RP5C01_10_DAY) * 10 + | 
|  | rp5c01_read(priv, RP5C01_1_DAY); | 
|  | tm->tm_wday = rp5c01_read(priv, RP5C01_DAY_OF_WEEK); | 
|  | tm->tm_mon  = rp5c01_read(priv, RP5C01_10_MONTH) * 10 + | 
|  | rp5c01_read(priv, RP5C01_1_MONTH) - 1; | 
|  | tm->tm_year = rp5c01_read(priv, RP5C01_10_YEAR) * 10 + | 
|  | rp5c01_read(priv, RP5C01_1_YEAR); | 
|  | if (tm->tm_year <= 69) | 
|  | tm->tm_year += 100; | 
|  |  | 
|  | rp5c01_unlock(priv); | 
|  | spin_unlock_irq(&priv->lock); | 
|  |  | 
|  | return rtc_valid_tm(tm); | 
|  | } | 
|  |  | 
|  | static int rp5c01_set_time(struct device *dev, struct rtc_time *tm) | 
|  | { | 
|  | struct rp5c01_priv *priv = dev_get_drvdata(dev); | 
|  |  | 
|  | spin_lock_irq(&priv->lock); | 
|  | rp5c01_lock(priv); | 
|  |  | 
|  | rp5c01_write(priv, tm->tm_sec / 10, RP5C01_10_SECOND); | 
|  | rp5c01_write(priv, tm->tm_sec % 10, RP5C01_1_SECOND); | 
|  | rp5c01_write(priv, tm->tm_min / 10, RP5C01_10_MINUTE); | 
|  | rp5c01_write(priv, tm->tm_min % 10, RP5C01_1_MINUTE); | 
|  | rp5c01_write(priv, tm->tm_hour / 10, RP5C01_10_HOUR); | 
|  | rp5c01_write(priv, tm->tm_hour % 10, RP5C01_1_HOUR); | 
|  | rp5c01_write(priv, tm->tm_mday / 10, RP5C01_10_DAY); | 
|  | rp5c01_write(priv, tm->tm_mday % 10, RP5C01_1_DAY); | 
|  | if (tm->tm_wday != -1) | 
|  | rp5c01_write(priv, tm->tm_wday, RP5C01_DAY_OF_WEEK); | 
|  | rp5c01_write(priv, (tm->tm_mon + 1) / 10, RP5C01_10_MONTH); | 
|  | rp5c01_write(priv, (tm->tm_mon + 1) % 10, RP5C01_1_MONTH); | 
|  | if (tm->tm_year >= 100) | 
|  | tm->tm_year -= 100; | 
|  | rp5c01_write(priv, tm->tm_year / 10, RP5C01_10_YEAR); | 
|  | rp5c01_write(priv, tm->tm_year % 10, RP5C01_1_YEAR); | 
|  |  | 
|  | rp5c01_unlock(priv); | 
|  | spin_unlock_irq(&priv->lock); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static const struct rtc_class_ops rp5c01_rtc_ops = { | 
|  | .read_time	= rp5c01_read_time, | 
|  | .set_time	= rp5c01_set_time, | 
|  | }; | 
|  |  | 
|  |  | 
|  | /* | 
|  | * The NVRAM is organized as 2 blocks of 13 nibbles of 4 bits. | 
|  | * We provide access to them like AmigaOS does: the high nibble of each 8-bit | 
|  | * byte is stored in BLOCK10, the low nibble in BLOCK11. | 
|  | */ | 
|  |  | 
|  | static ssize_t rp5c01_nvram_read(struct file *filp, struct kobject *kobj, | 
|  | struct bin_attribute *bin_attr, | 
|  | char *buf, loff_t pos, size_t size) | 
|  | { | 
|  | struct device *dev = container_of(kobj, struct device, kobj); | 
|  | struct rp5c01_priv *priv = dev_get_drvdata(dev); | 
|  | ssize_t count; | 
|  |  | 
|  | spin_lock_irq(&priv->lock); | 
|  |  | 
|  | for (count = 0; size > 0 && pos < RP5C01_MODE; count++, size--) { | 
|  | u8 data; | 
|  |  | 
|  | rp5c01_write(priv, | 
|  | RP5C01_MODE_TIMER_EN | RP5C01_MODE_RAM_BLOCK10, | 
|  | RP5C01_MODE); | 
|  | data = rp5c01_read(priv, pos) << 4; | 
|  | rp5c01_write(priv, | 
|  | RP5C01_MODE_TIMER_EN | RP5C01_MODE_RAM_BLOCK11, | 
|  | RP5C01_MODE); | 
|  | data |= rp5c01_read(priv, pos++); | 
|  | rp5c01_write(priv, RP5C01_MODE_TIMER_EN | RP5C01_MODE_MODE01, | 
|  | RP5C01_MODE); | 
|  | *buf++ = data; | 
|  | } | 
|  |  | 
|  | spin_unlock_irq(&priv->lock); | 
|  | return count; | 
|  | } | 
|  |  | 
|  | static ssize_t rp5c01_nvram_write(struct file *filp, struct kobject *kobj, | 
|  | struct bin_attribute *bin_attr, | 
|  | char *buf, loff_t pos, size_t size) | 
|  | { | 
|  | struct device *dev = container_of(kobj, struct device, kobj); | 
|  | struct rp5c01_priv *priv = dev_get_drvdata(dev); | 
|  | ssize_t count; | 
|  |  | 
|  | spin_lock_irq(&priv->lock); | 
|  |  | 
|  | for (count = 0; size > 0 && pos < RP5C01_MODE; count++, size--) { | 
|  | u8 data = *buf++; | 
|  |  | 
|  | rp5c01_write(priv, | 
|  | RP5C01_MODE_TIMER_EN | RP5C01_MODE_RAM_BLOCK10, | 
|  | RP5C01_MODE); | 
|  | rp5c01_write(priv, data >> 4, pos); | 
|  | rp5c01_write(priv, | 
|  | RP5C01_MODE_TIMER_EN | RP5C01_MODE_RAM_BLOCK11, | 
|  | RP5C01_MODE); | 
|  | rp5c01_write(priv, data & 0xf, pos++); | 
|  | rp5c01_write(priv, RP5C01_MODE_TIMER_EN | RP5C01_MODE_MODE01, | 
|  | RP5C01_MODE); | 
|  | } | 
|  |  | 
|  | spin_unlock_irq(&priv->lock); | 
|  | return count; | 
|  | } | 
|  |  | 
|  | static int __init rp5c01_rtc_probe(struct platform_device *dev) | 
|  | { | 
|  | struct resource *res; | 
|  | struct rp5c01_priv *priv; | 
|  | struct rtc_device *rtc; | 
|  | int error; | 
|  |  | 
|  | res = platform_get_resource(dev, IORESOURCE_MEM, 0); | 
|  | if (!res) | 
|  | return -ENODEV; | 
|  |  | 
|  | priv = kzalloc(sizeof(*priv), GFP_KERNEL); | 
|  | if (!priv) | 
|  | return -ENOMEM; | 
|  |  | 
|  | priv->regs = ioremap(res->start, resource_size(res)); | 
|  | if (!priv->regs) { | 
|  | error = -ENOMEM; | 
|  | goto out_free_priv; | 
|  | } | 
|  |  | 
|  | sysfs_bin_attr_init(&priv->nvram_attr); | 
|  | priv->nvram_attr.attr.name = "nvram"; | 
|  | priv->nvram_attr.attr.mode = S_IRUGO | S_IWUSR; | 
|  | priv->nvram_attr.read = rp5c01_nvram_read; | 
|  | priv->nvram_attr.write = rp5c01_nvram_write; | 
|  | priv->nvram_attr.size = RP5C01_MODE; | 
|  |  | 
|  | spin_lock_init(&priv->lock); | 
|  |  | 
|  | platform_set_drvdata(dev, priv); | 
|  |  | 
|  | rtc = rtc_device_register("rtc-rp5c01", &dev->dev, &rp5c01_rtc_ops, | 
|  | THIS_MODULE); | 
|  | if (IS_ERR(rtc)) { | 
|  | error = PTR_ERR(rtc); | 
|  | goto out_unmap; | 
|  | } | 
|  | priv->rtc = rtc; | 
|  |  | 
|  | error = sysfs_create_bin_file(&dev->dev.kobj, &priv->nvram_attr); | 
|  | if (error) | 
|  | goto out_unregister; | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | out_unregister: | 
|  | rtc_device_unregister(rtc); | 
|  | out_unmap: | 
|  | platform_set_drvdata(dev, NULL); | 
|  | iounmap(priv->regs); | 
|  | out_free_priv: | 
|  | kfree(priv); | 
|  | return error; | 
|  | } | 
|  |  | 
|  | static int __exit rp5c01_rtc_remove(struct platform_device *dev) | 
|  | { | 
|  | struct rp5c01_priv *priv = platform_get_drvdata(dev); | 
|  |  | 
|  | sysfs_remove_bin_file(&dev->dev.kobj, &priv->nvram_attr); | 
|  | rtc_device_unregister(priv->rtc); | 
|  | iounmap(priv->regs); | 
|  | kfree(priv); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static struct platform_driver rp5c01_rtc_driver = { | 
|  | .driver	= { | 
|  | .name	= "rtc-rp5c01", | 
|  | .owner	= THIS_MODULE, | 
|  | }, | 
|  | .remove	= __exit_p(rp5c01_rtc_remove), | 
|  | }; | 
|  |  | 
|  | static int __init rp5c01_rtc_init(void) | 
|  | { | 
|  | return platform_driver_probe(&rp5c01_rtc_driver, rp5c01_rtc_probe); | 
|  | } | 
|  |  | 
|  | static void __exit rp5c01_rtc_fini(void) | 
|  | { | 
|  | platform_driver_unregister(&rp5c01_rtc_driver); | 
|  | } | 
|  |  | 
|  | module_init(rp5c01_rtc_init); | 
|  | module_exit(rp5c01_rtc_fini); | 
|  |  | 
|  | MODULE_AUTHOR("Geert Uytterhoeven <geert@linux-m68k.org>"); | 
|  | MODULE_LICENSE("GPL"); | 
|  | MODULE_DESCRIPTION("Ricoh RP5C01 RTC driver"); | 
|  | MODULE_ALIAS("platform:rtc-rp5c01"); |