rtc: driver for Marvell's SoCs 88F6281 and 88F6192

Driver for the on-chip RTC found in some of Marvell's SoCs such as the Kirkwood 88F6281 and 88F6192 devices. Signed-off-by: Saeed Bishara <saeed@marvell.com> Signed-off-by: Lennert Buytenhek <buytenh@marvell.com> Signed-off-by: Nicolas Pitre <nico@marvell.com> Signed-off-by: Alessandro Zummo <a.zummo@towertech.it> Cc: David Brownell <david-b@pacbell.net> Cc: Russell King <rmk@arm.linux.org.uk> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>

rtc: driver for Marvell's SoCs 88F6281 and 88F6192
Driver for the on-chip RTC found in some of Marvell's SoCs such as the Kirkwood 88F6281 and 88F6192 devices. Signed-off-by: Saeed Bishara <saeed@marvell.com> Signed-off-by: Lennert Buytenhek <buytenh@marvell.com> Signed-off-by: Nicolas Pitre <nico@marvell.com> Signed-off-by: Alessandro Zummo <a.zummo@towertech.it> Cc: David Brownell <david-b@pacbell.net> Cc: Russell King <rmk@arm.linux.org.uk> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
Saeed Bishara · Linus Torvalds
1 parent 97a1f9532e
Showing 3 changed files with 175 additions and 0 deletions Side-by-side Diff
drivers/rtc/Kconfig
drivers/rtc/Makefile
drivers/rtc/rtc-mv.c
@@ -712,5 +712,16 @@
 	  Driver for the internal RTC (Realtime Clock) module found on
 	  Toshiba TX4939 SoC.
  
+config RTC_DRV_MV
+	tristate "Marvell SoC RTC"
+	depends on ARCH_KIRKWOOD
+	help
+	  If you say yes here you will get support for the in-chip RTC
+	  that can be found in some of Marvell's SoC devices, such as
+	  the Kirkwood 88F6281 and 88F6192.
+
+	  This driver can also be built as a module. If so, the module
+	  will be called rtc-mv.
+
 endif # RTC_CLASS
@@ -48,6 +48,7 @@
 obj-$(CONFIG_RTC_DRV_STARFIRE)	+= rtc-starfire.o
 obj-$(CONFIG_RTC_DRV_MAX6900)	+= rtc-max6900.o
 obj-$(CONFIG_RTC_DRV_MAX6902)	+= rtc-max6902.o
+obj-$(CONFIG_RTC_DRV_MV)	+= rtc-mv.o
 obj-$(CONFIG_RTC_DRV_OMAP)	+= rtc-omap.o
 obj-$(CONFIG_RTC_DRV_PCF8563)	+= rtc-pcf8563.o
 obj-$(CONFIG_RTC_DRV_PCF8583)	+= rtc-pcf8583.o
+/*
+ * Driver for the RTC in Marvell SoCs.
+ *
+ * This file is licensed under the terms of the GNU General Public
+ * License version 2.  This program is licensed "as is" without any
+ * warranty of any kind, whether express or implied.
+ */
+
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/rtc.h>
+#include <linux/bcd.h>
+#include <linux/io.h>
+#include <linux/platform_device.h>
+
+
+#define RTC_TIME_REG_OFFS	0
+#define RTC_SECONDS_OFFS	0
+#define RTC_MINUTES_OFFS	8
+#define RTC_HOURS_OFFS		16
+#define RTC_WDAY_OFFS		24
+#define RTC_HOURS_12H_MODE		(1 << 22) /* 12 hours mode */
+
+#define RTC_DATE_REG_OFFS	4
+#define RTC_MDAY_OFFS		0
+#define RTC_MONTH_OFFS		8
+#define RTC_YEAR_OFFS		16
+
+
+struct rtc_plat_data {
+	struct rtc_device *rtc;
+	void __iomem *ioaddr;
+};
+
+static int mv_rtc_set_time(struct device *dev, struct rtc_time *tm)
+{
+	struct rtc_plat_data *pdata = dev_get_drvdata(dev);
+	void __iomem *ioaddr = pdata->ioaddr;
+	u32	rtc_reg;
+
+	rtc_reg = (bin2bcd(tm->tm_sec) << RTC_SECONDS_OFFS) |
+		(bin2bcd(tm->tm_min) << RTC_MINUTES_OFFS) |
+		(bin2bcd(tm->tm_hour) << RTC_HOURS_OFFS) |
+		(bin2bcd(tm->tm_wday) << RTC_WDAY_OFFS);
+	writel(rtc_reg, ioaddr + RTC_TIME_REG_OFFS);
+
+	rtc_reg = (bin2bcd(tm->tm_mday) << RTC_MDAY_OFFS) |
+		(bin2bcd(tm->tm_mon + 1) << RTC_MONTH_OFFS) |
+		(bin2bcd(tm->tm_year % 100) << RTC_YEAR_OFFS);
+	writel(rtc_reg, ioaddr + RTC_DATE_REG_OFFS);
+
+	return 0;
+}
+
+static int mv_rtc_read_time(struct device *dev, struct rtc_time *tm)
+{
+	struct rtc_plat_data *pdata = dev_get_drvdata(dev);
+	void __iomem *ioaddr = pdata->ioaddr;
+	u32	rtc_time, rtc_date;
+	unsigned int year, month, day, hour, minute, second, wday;
+
+	rtc_time = readl(ioaddr + RTC_TIME_REG_OFFS);
+	rtc_date = readl(ioaddr + RTC_DATE_REG_OFFS);
+
+	second = rtc_time & 0x7f;
+	minute = (rtc_time >> RTC_MINUTES_OFFS) & 0x7f;
+	hour = (rtc_time >> RTC_HOURS_OFFS) & 0x3f; /* assume 24 hours mode */
+	wday = (rtc_time >> RTC_WDAY_OFFS) & 0x7;
+
+	day = rtc_date & 0x3f;
+	month = (rtc_date >> RTC_MONTH_OFFS) & 0x3f;
+	year = (rtc_date >> RTC_YEAR_OFFS) & 0xff;
+
+	tm->tm_sec = bcd2bin(second);
+	tm->tm_min = bcd2bin(minute);
+	tm->tm_hour = bcd2bin(hour);
+	tm->tm_mday = bcd2bin(day);
+	tm->tm_wday = bcd2bin(wday);
+	tm->tm_mon = bcd2bin(month) - 1;
+	/* hw counts from year 2000, but tm_year is relative to 1900 */
+	tm->tm_year = bcd2bin(year) + 100;
+
+	return rtc_valid_tm(tm);
+}
+
+static const struct rtc_class_ops mv_rtc_ops = {
+	.read_time	= mv_rtc_read_time,
+	.set_time	= mv_rtc_set_time,
+};
+
+static int __init mv_rtc_probe(struct platform_device *pdev)
+{
+	struct resource *res;
+	struct rtc_plat_data *pdata;
+	resource_size_t size;
+	u32 rtc_time;
+
+	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;
+
+	size = resource_size(res);
+	if (!devm_request_mem_region(&pdev->dev, res->start, size,
+				     pdev->name))
+		return -EBUSY;
+
+	pdata->ioaddr = devm_ioremap(&pdev->dev, res->start, size);
+	if (!pdata->ioaddr)
+		return -ENOMEM;
+
+	/* make sure the 24 hours mode is enabled */
+	rtc_time = readl(pdata->ioaddr + RTC_TIME_REG_OFFS);
+	if (rtc_time & RTC_HOURS_12H_MODE) {
+		dev_err(&pdev->dev, "24 Hours mode not supported.\n");
+		return -EINVAL;
+	}
+
+	platform_set_drvdata(pdev, pdata);
+	pdata->rtc = rtc_device_register(pdev->name, &pdev->dev,
+					 &mv_rtc_ops, THIS_MODULE);
+	if (IS_ERR(pdata->rtc))
+		return PTR_ERR(pdata->rtc);
+
+	return 0;
+}
+
+static int __exit mv_rtc_remove(struct platform_device *pdev)
+{
+	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
+
+	rtc_device_unregister(pdata->rtc);
+	return 0;
+}
+
+static struct platform_driver mv_rtc_driver = {
+	.remove		= __exit_p(mv_rtc_remove),
+	.driver		= {
+		.name	= "rtc-mv",
+		.owner	= THIS_MODULE,
+	},
+};
+
+static __init int mv_init(void)
+{
+	return platform_driver_probe(&mv_rtc_driver, mv_rtc_probe);
+}
+
+static __exit void mv_exit(void)
+{
+	platform_driver_unregister(&mv_rtc_driver);
+}
+
+module_init(mv_init);
+module_exit(mv_exit);
+
+MODULE_AUTHOR("Saeed Bishara <saeed@marvell.com>");
+MODULE_DESCRIPTION("Marvell RTC driver");
+MODULE_LICENSE("GPL");
+MODULE_ALIAS("platform:rtc-mv");
...	...	@@ -712,5 +712,16 @@
712	712	Driver for the internal RTC (Realtime Clock) module found on
713	713	Toshiba TX4939 SoC.
714	714
	715	+config RTC_DRV_MV
	716	+ tristate "Marvell SoC RTC"
	717	+ depends on ARCH_KIRKWOOD
	718	+ help
	719	+ If you say yes here you will get support for the in-chip RTC
	720	+ that can be found in some of Marvell's SoC devices, such as
	721	+ the Kirkwood 88F6281 and 88F6192.
	722	+
	723	+ This driver can also be built as a module. If so, the module
	724	+ will be called rtc-mv.
	725	+
715	726	endif # RTC_CLASS
...	...	@@ -48,6 +48,7 @@
48	48	obj-$(CONFIG_RTC_DRV_STARFIRE) += rtc-starfire.o
49	49	obj-$(CONFIG_RTC_DRV_MAX6900) += rtc-max6900.o
50	50	obj-$(CONFIG_RTC_DRV_MAX6902) += rtc-max6902.o
	51	+obj-$(CONFIG_RTC_DRV_MV) += rtc-mv.o
51	52	obj-$(CONFIG_RTC_DRV_OMAP) += rtc-omap.o
52	53	obj-$(CONFIG_RTC_DRV_PCF8563) += rtc-pcf8563.o
53	54	obj-$(CONFIG_RTC_DRV_PCF8583) += rtc-pcf8583.o
	1	+/*
	2	+ * Driver for the RTC in Marvell SoCs.
	3	+ *
	4	+ * This file is licensed under the terms of the GNU General Public
	5	+ * License version 2. This program is licensed "as is" without any
	6	+ * warranty of any kind, whether express or implied.
	7	+ */
	8	+
	9	+#include <linux/init.h>
	10	+#include <linux/kernel.h>
	11	+#include <linux/rtc.h>
	12	+#include <linux/bcd.h>
	13	+#include <linux/io.h>
	14	+#include <linux/platform_device.h>
	15	+
	16	+
	17	+#define RTC_TIME_REG_OFFS 0
	18	+#define RTC_SECONDS_OFFS 0
	19	+#define RTC_MINUTES_OFFS 8
	20	+#define RTC_HOURS_OFFS 16
	21	+#define RTC_WDAY_OFFS 24
	22	+#define RTC_HOURS_12H_MODE (1 << 22) /* 12 hours mode */
	23	+
	24	+#define RTC_DATE_REG_OFFS 4
	25	+#define RTC_MDAY_OFFS 0
	26	+#define RTC_MONTH_OFFS 8
	27	+#define RTC_YEAR_OFFS 16
	28	+
	29	+
	30	+struct rtc_plat_data {
	31	+ struct rtc_device *rtc;
	32	+ void __iomem *ioaddr;
	33	+};
	34	+
	35	+static int mv_rtc_set_time(struct device dev, struct rtc_time tm)
	36	+{
	37	+ struct rtc_plat_data *pdata = dev_get_drvdata(dev);
	38	+ void __iomem *ioaddr = pdata->ioaddr;
	39	+ u32 rtc_reg;
	40	+
	41	+ rtc_reg = (bin2bcd(tm->tm_sec) << RTC_SECONDS_OFFS) \|
	42	+ (bin2bcd(tm->tm_min) << RTC_MINUTES_OFFS) \|
	43	+ (bin2bcd(tm->tm_hour) << RTC_HOURS_OFFS) \|
	44	+ (bin2bcd(tm->tm_wday) << RTC_WDAY_OFFS);
	45	+ writel(rtc_reg, ioaddr + RTC_TIME_REG_OFFS);
	46	+
	47	+ rtc_reg = (bin2bcd(tm->tm_mday) << RTC_MDAY_OFFS) \|
	48	+ (bin2bcd(tm->tm_mon + 1) << RTC_MONTH_OFFS) \|
	49	+ (bin2bcd(tm->tm_year % 100) << RTC_YEAR_OFFS);
	50	+ writel(rtc_reg, ioaddr + RTC_DATE_REG_OFFS);
	51	+
	52	+ return 0;
	53	+}
	54	+
	55	+static int mv_rtc_read_time(struct device dev, struct rtc_time tm)
	56	+{
	57	+ struct rtc_plat_data *pdata = dev_get_drvdata(dev);
	58	+ void __iomem *ioaddr = pdata->ioaddr;
	59	+ u32 rtc_time, rtc_date;
	60	+ unsigned int year, month, day, hour, minute, second, wday;
	61	+
	62	+ rtc_time = readl(ioaddr + RTC_TIME_REG_OFFS);
	63	+ rtc_date = readl(ioaddr + RTC_DATE_REG_OFFS);
	64	+
	65	+ second = rtc_time & 0x7f;
	66	+ minute = (rtc_time >> RTC_MINUTES_OFFS) & 0x7f;
	67	+ hour = (rtc_time >> RTC_HOURS_OFFS) & 0x3f; /* assume 24 hours mode */
	68	+ wday = (rtc_time >> RTC_WDAY_OFFS) & 0x7;
	69	+
	70	+ day = rtc_date & 0x3f;
	71	+ month = (rtc_date >> RTC_MONTH_OFFS) & 0x3f;
	72	+ year = (rtc_date >> RTC_YEAR_OFFS) & 0xff;
	73	+
	74	+ tm->tm_sec = bcd2bin(second);
	75	+ tm->tm_min = bcd2bin(minute);
	76	+ tm->tm_hour = bcd2bin(hour);
	77	+ tm->tm_mday = bcd2bin(day);
	78	+ tm->tm_wday = bcd2bin(wday);
	79	+ tm->tm_mon = bcd2bin(month) - 1;
	80	+ /* hw counts from year 2000, but tm_year is relative to 1900 */
	81	+ tm->tm_year = bcd2bin(year) + 100;
	82	+
	83	+ return rtc_valid_tm(tm);
	84	+}
	85	+
	86	+static const struct rtc_class_ops mv_rtc_ops = {
	87	+ .read_time = mv_rtc_read_time,
	88	+ .set_time = mv_rtc_set_time,
	89	+};
	90	+
	91	+static int __init mv_rtc_probe(struct platform_device *pdev)
	92	+{
	93	+ struct resource *res;
	94	+ struct rtc_plat_data *pdata;
	95	+ resource_size_t size;
	96	+ u32 rtc_time;
	97	+
	98	+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	99	+ if (!res)
	100	+ return -ENODEV;
	101	+
	102	+ pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
	103	+ if (!pdata)
	104	+ return -ENOMEM;
	105	+
	106	+ size = resource_size(res);
	107	+ if (!devm_request_mem_region(&pdev->dev, res->start, size,
	108	+ pdev->name))
	109	+ return -EBUSY;
	110	+
	111	+ pdata->ioaddr = devm_ioremap(&pdev->dev, res->start, size);
	112	+ if (!pdata->ioaddr)
	113	+ return -ENOMEM;
	114	+
	115	+ /* make sure the 24 hours mode is enabled */
	116	+ rtc_time = readl(pdata->ioaddr + RTC_TIME_REG_OFFS);
	117	+ if (rtc_time & RTC_HOURS_12H_MODE) {
	118	+ dev_err(&pdev->dev, "24 Hours mode not supported.\n");
	119	+ return -EINVAL;
	120	+ }
	121	+
	122	+ platform_set_drvdata(pdev, pdata);
	123	+ pdata->rtc = rtc_device_register(pdev->name, &pdev->dev,
	124	+ &mv_rtc_ops, THIS_MODULE);
	125	+ if (IS_ERR(pdata->rtc))
	126	+ return PTR_ERR(pdata->rtc);
	127	+
	128	+ return 0;
	129	+}
	130	+
	131	+static int __exit mv_rtc_remove(struct platform_device *pdev)
	132	+{
	133	+ struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
	134	+
	135	+ rtc_device_unregister(pdata->rtc);
	136	+ return 0;
	137	+}
	138	+
	139	+static struct platform_driver mv_rtc_driver = {
	140	+ .remove = __exit_p(mv_rtc_remove),
	141	+ .driver = {
	142	+ .name = "rtc-mv",
	143	+ .owner = THIS_MODULE,
	144	+ },
	145	+};
	146	+
	147	+static __init int mv_init(void)
	148	+{
	149	+ return platform_driver_probe(&mv_rtc_driver, mv_rtc_probe);
	150	+}
	151	+
	152	+static __exit void mv_exit(void)
	153	+{
	154	+ platform_driver_unregister(&mv_rtc_driver);
	155	+}
	156	+
	157	+module_init(mv_init);
	158	+module_exit(mv_exit);
	159	+
	160	+MODULE_AUTHOR("Saeed Bishara <saeed@marvell.com>");
	161	+MODULE_DESCRIPTION("Marvell RTC driver");
	162	+MODULE_LICENSE("GPL");
	163	+MODULE_ALIAS("platform:rtc-mv");