diff mbox

Re: [PATCH 2/3] ARM: MXC: add driver for MXC's internal RTC module

Message ID 20090519164802.GM25674@buzzloop.caiaq.de
State Superseded, archived
Headers show

Commit Message

Daniel Mack May 19, 2009, 4:48 p.m. UTC
Hi Alessandro,

On Tue, May 19, 2009 at 05:23:08PM +0200, Alessandro Zummo wrote:
> > +#include <linux/io.h>
> > +#include <linux/rtc.h>
> > +#include <linux/module.h>
> > +#include <linux/fs.h>
> > +#include <linux/init.h>
> > +#include <linux/interrupt.h>
> > +#include <linux/platform_device.h>
> > +#include <linux/clk.h>
> > +#include <linux/uaccess.h>
> 
>  need all of those?

Cleaned.

> > +static u32 rtc_freq = 2;	/* minimun value for PIE */
> 
>  minimum

Fixed.

> > +static unsigned long rtc_status;
> > +
> > +static struct rtc_time g_rtc_alarm = {
> > +	.tm_year = 0,
> > +	.tm_mon = 0,
> > +	.tm_mday = 0,
> > +	.tm_hour = 0,
> > +	.tm_mon = 0,
> > +	.tm_sec = 0,
> > +};
> 
>  gcc will probably write zeroing code by itself,
>  but I can't remember the rules (maybe if the thing goes into .bss).

Yes, you're right. The variable is static, no init needed.

> > +static DEFINE_SPINLOCK(rtc_lock);
> 
>  you probably don't need your own lock. check what
>  the other drivers do. 

I'll take rtc->irq_lock

> > +	if (time_alarm == MXC_RTC_TIME) {
> > +		day = readw(ioaddr + RTC_DAYR);
> > +		hr_min = readw(ioaddr + RTC_HOURMIN);
> > +		sec = readw(ioaddr + RTC_SECOND);
> > +	} else if (time_alarm == MXC_RTC_ALARM) {
> > +		day = readw(ioaddr + RTC_DAYALARM);
> > +		hr_min = readw(ioaddr + RTC_ALRM_HM) & 0xffff;
> > +		sec = readw(ioaddr + RTC_ALRM_SEC);
> > +	} else {
> > +		dev_err(dev, "wrong value for time_alarm=%d\n", time_alarm);
> > +		return 0;
> > +	}
> 
>  if you are the only caller of this function there's no need to check
>  that time_alarm is out of specs

Agreed, fixed.

> > + * This function is used to open the RTC driver by registering the RTC
> > + * interrupt service routine.
> > + */
> > +static int mxc_rtc_open(struct device *dev)
> > +{
> > +	if (test_and_set_bit(1, &rtc_status))
> > +		return -EBUSY;
> > +	
> > +	return 0;
> > +}
> 
>  ? 
> 
>  the overlaying subsystem should take care of that,

Ok.

> > +	case RTC_IRQP_SET:
> > +		if (arg < 2 || arg > MAX_PIE_FREQ || (arg % 2) != 0)
> > +			return -EINVAL;	/* Also make sure a power of 2Hz */
> > +		if ((arg > 64) && (!capable(CAP_SYS_RESOURCE)))
> > +			return -EACCES;
> > +		rtc_freq = arg;
> > +		return 0;
> > +
> > +	case RTC_IRQP_READ:
> > +		return put_user(rtc_freq, (u32 *) arg);
> > +
> > +	case RTC_PIE_ON:
> > +		for (i = 0; i < MAX_PIE_NUM; i++)
> > +			if (PIE_BIT_DEF[i][0] == rtc_freq)
> > +				break;
> > +		
> > +		if (i == MAX_PIE_NUM)
> > +			return -EACCES;
> > +
> > +		spin_lock_irq(&rtc_lock);
> > +		writew((readw(ioaddr + RTC_RTCIENR) | PIE_BIT_DEF[i][1]),
> > +		       ioaddr + RTC_RTCIENR);
> > +		spin_unlock_irq(&rtc_lock);
> > +		return 0;
> > +
> > +	case RTC_AIE_OFF:
> > +		spin_lock_irq(&rtc_lock);
> > +		writew((readw(ioaddr + RTC_RTCIENR) & ~RTC_ALM_BIT),
> > +		       ioaddr + RTC_RTCIENR);
> > +		spin_unlock_irq(&rtc_lock);
> > +		return 0;
> > +
> > +	case RTC_AIE_ON:
> > +		spin_lock_irq(&rtc_lock);
> > +		writew((readw(ioaddr + RTC_RTCIENR) | RTC_ALM_BIT),
> > +		       ioaddr + RTC_RTCIENR);
> > +		spin_unlock_irq(&rtc_lock);
> > +		return 0;
> > +
> > +	case RTC_UIE_OFF:	/* UIE is for the 1Hz interrupt */
> > +		spin_lock_irq(&rtc_lock);
> > +		writew((readw(ioaddr + RTC_RTCIENR) & ~RTC_1HZ_BIT),
> > +		       ioaddr + RTC_RTCIENR);
> > +		spin_unlock_irq(&rtc_lock);
> > +		return 0;
> > +
> > +	case RTC_UIE_ON:
> > +		spin_lock_irq(&rtc_lock);
> > +		writew((readw(ioaddr + RTC_RTCIENR) | RTC_1HZ_BIT),
> > +		       ioaddr + RTC_RTCIENR);
> > +		spin_unlock_irq(&rtc_lock);
> > +		return 0;
> > +	}
> > +
> > +	return -ENOIOCTLCMD;
> > +}
> 
>  please only use ioctl for functions that are not already available
>  within the rtc ->ops .

Not quite sure what you mean here - I don't see any overlapping call.
But I don't know the RTC API too well though ...

> > +static int mxc_rtc_set_time(struct device *dev, struct rtc_time *tm)
> > +{
> > +	unsigned long time;
> > +	int ret = rtc_tm_to_time(tm, &time);
> > +
> > +	if (ret)
> > +		return ret;
> > +
> > +	/* Avoid roll-over from reading the different registers */
> > +	do {
> > +		set_alarm_or_time(dev, MXC_RTC_TIME, time);
> > +	} while (time != get_alarm_or_time(dev, MXC_RTC_TIME));
> > +
> > +	return 0;
> > +}
> 
>  you need to implement set_mmss instead of set_time

Done.

> > +/* Proc fs layer */
> > +static int mxc_rtc_proc(struct device *dev, struct seq_file *sq)
> > +{
> > +	struct platform_device *pdev = to_platform_device(dev);
> > +	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
> > +	void __iomem *ioaddr = pdata->ioaddr;
> > +	char *p = sq->buf;
> > +
> > +	p += sprintf(p, "alarm_IRQ\t: %s\n",
> > +		     (((readw(ioaddr + RTC_RTCIENR)) & RTC_ALM_BIT) !=
> > +		      0) ? "yes" : "no");
> > +	p += sprintf(p, "update_IRQ\t: %s\n",
> > +		     (((readw(ioaddr + RTC_RTCIENR)) & RTC_1HZ_BIT) !=
> > +		      0) ? "yes" : "no");
> > +	p += sprintf(p, "periodic_IRQ\t: %s\n",
> > +		     (((readw(ioaddr + RTC_RTCIENR)) & PIT_ALL_ON) !=
> > +		      0) ? "yes" : "no");
> > +	p += sprintf(p, "periodic_freq\t: %d\n", rtc_freq);
> > +
> > +	return p - (sq->buf);
> > +}
> 
>  this is deprecated. do you really need it? better do it
>  via sysfs.

Yes, legacy from copied code. Removed that.

> > +	/* Configure and enable the RTC */
> > +	pdata->irq = platform_get_irq(pdev, 0);
> > +
> > +	if (pdata->irq >= 0) {
> > +		if (request_irq(pdata->irq, mxc_rtc_interrupt, IRQF_SHARED,
> > +				pdev->name, pdev) < 0) {
> > +			dev_warn(&pdev->dev, "interrupt not available.\n");
> > +			pdata->irq = -1;
> > +		}
> > +	}
> 
>  request irq should come after rtc_register

Yep, cleaned up the whole function. Should be better now.

> > +static int __init mxc_rtc_init(void)
> > +{
> > +	return platform_driver_register(&mxc_rtc_driver);
> > +}
> > +
> 
>  you can use platform_driver_probe. __exit_p/__init/__exit are only
>  correct with oplatform_DriveR_probe, otherwise you have to use
>  the dev variant.

Ok, fixed.

> > +static void __exit mxc_rtc_exit(void)
> > +{
> > +	platform_driver_unregister(&mxc_rtc_driver);
> > +
> > +}
> > +
> > +module_init(mxc_rtc_init);
> > +module_exit(mxc_rtc_exit);
> > +
> > +MODULE_AUTHOR("Freescale Semiconductor, Inc.");
> 
>  email here please.

Hmm. I can't find any reference to the original author, and I'm just the
one who cleans up behind him. Don't know ...

> > +MODULE_DESCRIPTION("Realtime Clock Driver (RTC)");
> 
>  bad description

Fixed.

New version attached - thanks for your review!

Daniel


From 30465d9b966db1ac727850aa5223f35eea61e661 Mon Sep 17 00:00:00 2001
From: Daniel Mack <daniel@caiaq.de>
Date: Mon, 18 May 2009 21:41:44 +0200
Subject: [PATCH] ARM: MXC: add driver for MXC's internal RTC module

This adds a driver for Freescale's MXC internal real time clock modules.

The code is taken from Freescale's BSPs, but modified to fit the current
kernel coding mechanisms. Also, the PMIC external clock function was
removed for now to not add dead bits and keep the code as simple as
possible.

Signed-off-by: Daniel Mack <daniel@caiaq.de>
Cc: Sascha Hauer <s.hauer@pengutronix.de>
Cc: Alessandro Zummo <a.zummo@towertech.it>
---
 drivers/rtc/Kconfig   |   11 +
 drivers/rtc/Makefile  |    1 +
 drivers/rtc/rtc-mxc.c |  611 +++++++++++++++++++++++++++++++++++++++++++++++++
 3 files changed, 623 insertions(+), 0 deletions(-)
 create mode 100644 drivers/rtc/rtc-mxc.c

Comments

Alessandro Zummo May 19, 2009, 5:03 p.m. UTC | #1
On Tue, 19 May 2009 18:48:02 +0200
Daniel Mack <daniel@caiaq.de> wrote:

> > 
> >  please only use ioctl for functions that are not already available
> >  within the rtc ->ops .
> 
> Not quite sure what you mean here - I don't see any overlapping call.
> But I don't know the RTC API too well though ...

 check the irq and alarm enable ops in the other drivers

> > > +MODULE_AUTHOR("Freescale Semiconductor, Inc.");
> > 
> >  email here please.
> 
> Hmm. I can't find any reference to the original author, and I'm just the
> one who cleans up behind him. Don't know ...

 Then I guess you'll have to take care of it ;)
diff mbox

Patch

diff --git a/drivers/rtc/Kconfig b/drivers/rtc/Kconfig
index 4e9851f..7f2a663 100644
--- a/drivers/rtc/Kconfig
+++ b/drivers/rtc/Kconfig
@@ -491,6 +491,17 @@  config RTC_DRV_M48T59
 	  This driver can also be built as a module, if so, the module
 	  will be called "rtc-m48t59".
 
+config RTC_MXC
+	tristate "Freescale MXC Real Time Clock"
+	depends on ARCH_MXC
+	depends on RTC_CLASS
+	help
+	   If you say yes here you get support for the Freescale MXC
+	   RTC module.
+
+	   This driver can also be built as a module, if so, the module
+	   will be called "rtc-mxc".
+
 config RTC_DRV_BQ4802
 	tristate "TI BQ4802"
 	help
diff --git a/drivers/rtc/Makefile b/drivers/rtc/Makefile
index 6c0639a..018a908 100644
--- a/drivers/rtc/Makefile
+++ b/drivers/rtc/Makefile
@@ -45,6 +45,7 @@  obj-$(CONFIG_RTC_DRV_M41T94)	+= rtc-m41t94.o
 obj-$(CONFIG_RTC_DRV_M48T35)	+= rtc-m48t35.o
 obj-$(CONFIG_RTC_DRV_M48T59)	+= rtc-m48t59.o
 obj-$(CONFIG_RTC_DRV_M48T86)	+= rtc-m48t86.o
+obj-$(CONFIG_RTC_MXC)		+= rtc-mxc.o
 obj-$(CONFIG_RTC_DRV_BQ4802)	+= rtc-bq4802.o
 obj-$(CONFIG_RTC_DRV_SUN4V)	+= rtc-sun4v.o
 obj-$(CONFIG_RTC_DRV_STARFIRE)	+= rtc-starfire.o
diff --git a/drivers/rtc/rtc-mxc.c b/drivers/rtc/rtc-mxc.c
new file mode 100644
index 0000000..f400e09
--- /dev/null
+++ b/drivers/rtc/rtc-mxc.c
@@ -0,0 +1,611 @@ 
+/*
+ * Copyright 2004-2008 Freescale Semiconductor, Inc. All Rights Reserved.
+ *
+ * The code contained herein is licensed under the GNU General Public
+ * License. You may obtain a copy of the GNU General Public License
+ * Version 2 or later at the following locations:
+ *
+ * http://www.opensource.org/licenses/gpl-license.html
+ * http://www.gnu.org/copyleft/gpl.html
+ */
+
+#include <linux/io.h>
+#include <linux/rtc.h>
+#include <linux/module.h>
+#include <linux/interrupt.h>
+#include <linux/platform_device.h>
+#include <linux/clk.h>
+
+#include <mach/hardware.h>
+
+#define RTC_INPUT_CLK_32768HZ	(0x00 << 5)
+#define RTC_INPUT_CLK_32000HZ	(0x01 << 5)
+#define RTC_INPUT_CLK_38400HZ	(0x02 << 5)
+
+#define RTC_SW_BIT      (1 << 0)
+#define RTC_ALM_BIT     (1 << 2)
+#define RTC_1HZ_BIT     (1 << 4)
+#define RTC_2HZ_BIT     (1 << 7)
+#define RTC_SAM0_BIT    (1 << 8)
+#define RTC_SAM1_BIT    (1 << 9)
+#define RTC_SAM2_BIT    (1 << 10)
+#define RTC_SAM3_BIT    (1 << 11)
+#define RTC_SAM4_BIT    (1 << 12)
+#define RTC_SAM5_BIT    (1 << 13)
+#define RTC_SAM6_BIT    (1 << 14)
+#define RTC_SAM7_BIT    (1 << 15)
+#define PIT_ALL_ON      (RTC_2HZ_BIT | RTC_SAM0_BIT | RTC_SAM1_BIT | \
+			 RTC_SAM2_BIT | RTC_SAM3_BIT | RTC_SAM4_BIT | \
+			 RTC_SAM5_BIT | RTC_SAM6_BIT | RTC_SAM7_BIT)
+
+#define RTC_ENABLE_BIT  (1 << 7)
+
+#define MAX_PIE_NUM     9
+#define MAX_PIE_FREQ    512
+const u32 PIE_BIT_DEF[MAX_PIE_NUM][2] = {
+	{ 2,		RTC_2HZ_BIT },
+	{ 4,		RTC_SAM0_BIT },
+	{ 8,		RTC_SAM1_BIT },
+	{ 16,		RTC_SAM2_BIT },
+	{ 32,		RTC_SAM3_BIT },
+	{ 64,		RTC_SAM4_BIT },
+	{ 128,		RTC_SAM5_BIT },
+	{ 256,		RTC_SAM6_BIT },
+	{ MAX_PIE_FREQ,	RTC_SAM7_BIT },
+};
+
+/* Those are the bits from a classic RTC we want to mimic */
+#define RTC_IRQF	0x80	/* any of the following 3 is active */
+#define RTC_PF		0x40	/* Periodic interrupt */
+#define RTC_AF		0x20	/* Alarm interrupt */
+#define RTC_UF		0x10	/* Update interrupt for 1Hz RTC */
+
+#define MXC_RTC_TIME	0
+#define MXC_RTC_ALARM	1
+
+#define RTC_HOURMIN	0x00	/*  32bit rtc hour/min counter reg */
+#define RTC_SECOND	0x04	/*  32bit rtc seconds counter reg */
+#define RTC_ALRM_HM	0x08	/*  32bit rtc alarm hour/min reg */
+#define RTC_ALRM_SEC	0x0C	/*  32bit rtc alarm seconds reg */
+#define RTC_RTCCTL	0x10	/*  32bit rtc control reg */
+#define RTC_RTCISR	0x14	/*  32bit rtc interrupt status reg */
+#define RTC_RTCIENR	0x18	/*  32bit rtc interrupt enable reg */
+#define RTC_STPWCH	0x1C	/*  32bit rtc stopwatch min reg */
+#define RTC_DAYR	0x20	/*  32bit rtc days counter reg */
+#define RTC_DAYALARM	0x24	/*  32bit rtc day alarm reg */
+#define RTC_TEST1	0x28	/*  32bit rtc test reg 1 */
+#define RTC_TEST2	0x2C	/*  32bit rtc test reg 2 */
+#define RTC_TEST3	0x30	/*  32bit rtc test reg 3 */
+
+#define RTC_VERSION	"1.0"
+
+struct rtc_plat_data {
+	struct rtc_device *rtc;
+	void __iomem *ioaddr;
+	unsigned long baseaddr;
+	int irq;
+	struct clk *clk;
+	unsigned int irqen;
+	int alrm_sec;
+	int alrm_min;
+	int alrm_hour;
+	int alrm_mday;
+	struct timespec mxc_rtc_delta;
+};
+
+static u32 rtc_freq = 2;	/* minimum value for PIE */
+
+static struct rtc_time g_rtc_alarm;
+
+/*
+ * This function is used to obtain the RTC time or the alarm value in
+ * second.
+ */
+static u32 get_alarm_or_time(struct device *dev, int time_alarm)
+{
+	struct platform_device *pdev = to_platform_device(dev);
+	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
+	void __iomem *ioaddr = pdata->ioaddr;
+	u32 day = 0, hr = 0, min = 0, sec = 0, hr_min = 0;
+
+	switch (time_alarm) {
+	case MXC_RTC_TIME:
+		day = readw(ioaddr + RTC_DAYR);
+		hr_min = readw(ioaddr + RTC_HOURMIN);
+		sec = readw(ioaddr + RTC_SECOND);
+		break;
+	case MXC_RTC_ALARM:
+		day = readw(ioaddr + RTC_DAYALARM);
+		hr_min = readw(ioaddr + RTC_ALRM_HM) & 0xffff;
+		sec = readw(ioaddr + RTC_ALRM_SEC);
+		break;
+	}
+
+	hr = hr_min >> 8;
+	min = hr_min & 0xff;
+
+	return (((day * 24 + hr) * 60) + min) * 60 + sec;
+}
+
+/*
+ * This function sets the RTC alarm value or the time value.
+ */
+static void set_alarm_or_time(struct device *dev, int time_alarm, u32 time)
+{
+	u32 day, hr, min, sec, temp;
+	struct platform_device *pdev = to_platform_device(dev);
+	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
+	void __iomem *ioaddr = pdata->ioaddr;
+
+	day = time / 86400;
+	time -= day * 86400;
+
+	/* time is within a day now */
+	hr = time / 3600;
+	time -= hr * 3600;
+
+	/* time is within an hour now */
+	min = time / 60;
+	sec = time - min * 60;
+
+	temp = (hr << 8) + min;
+
+	switch (time_alarm) {
+	case MXC_RTC_TIME:
+		writew(day, ioaddr + RTC_DAYR);
+		writew(sec, ioaddr + RTC_SECOND);
+		writew(temp, ioaddr + RTC_HOURMIN);
+		break;
+	case MXC_RTC_ALARM:
+		writew(day, ioaddr + RTC_DAYALARM);
+		writew(sec, ioaddr + RTC_ALRM_SEC);
+		writew(temp, ioaddr + RTC_ALRM_HM);
+		break;
+	}
+}
+
+/*
+ * This function updates the RTC alarm registers and then clears all the
+ * interrupt status bits.
+ */
+static int rtc_update_alarm(struct device *dev, struct rtc_time *alrm)
+{
+	struct rtc_time alarm_tm, now_tm;
+	unsigned long now, time;
+	int ret;
+	struct platform_device *pdev = to_platform_device(dev);
+	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
+	void __iomem *ioaddr = pdata->ioaddr;
+
+	now = get_alarm_or_time(dev, MXC_RTC_TIME);
+	rtc_time_to_tm(now, &now_tm);
+	alarm_tm.tm_year = now_tm.tm_year;
+	alarm_tm.tm_mon = now_tm.tm_mon;
+	alarm_tm.tm_mday = now_tm.tm_mday;
+	alarm_tm.tm_hour = alrm->tm_hour;
+	alarm_tm.tm_min = alrm->tm_min;
+	alarm_tm.tm_sec = alrm->tm_sec;
+	rtc_tm_to_time(&now_tm, &now);
+	rtc_tm_to_time(&alarm_tm, &time);
+
+	if (time < now) {
+		time += 60 * 60 * 24;
+		rtc_time_to_tm(time, &alarm_tm);
+	}
+
+	ret = rtc_tm_to_time(&alarm_tm, &time);
+
+	/* clear all the interrupt status bits */
+	writew(readw(ioaddr + RTC_RTCISR), ioaddr + RTC_RTCISR);
+	set_alarm_or_time(dev, MXC_RTC_ALARM, time);
+
+	return ret;
+}
+
+/* This function is the RTC interrupt service routine. */
+static irqreturn_t mxc_rtc_interrupt(int irq, void *dev_id)
+{
+	struct platform_device *pdev = dev_id;
+	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
+	void __iomem *ioaddr = pdata->ioaddr;
+	u32 status;
+	u32 events = 0;
+
+	spin_lock_irq(&pdata->rtc->irq_lock);
+	status = readw(ioaddr + RTC_RTCISR) & readw(ioaddr + RTC_RTCIENR);
+	/* clear interrupt sources */
+	writew(status, ioaddr + RTC_RTCISR);
+
+	/* clear alarm interrupt if it has occurred */
+	if (status & RTC_ALM_BIT)
+		status &= ~RTC_ALM_BIT;
+
+	/* update irq data & counter */
+	if (status & RTC_ALM_BIT)
+		events |= (RTC_AF | RTC_IRQF);
+
+	if (status & RTC_1HZ_BIT)
+		events |= (RTC_UF | RTC_IRQF);
+
+	if (status & PIT_ALL_ON)
+		events |= (RTC_PF | RTC_IRQF);
+
+	if ((status & RTC_ALM_BIT) && rtc_valid_tm(&g_rtc_alarm))
+		rtc_update_alarm(&pdev->dev, &g_rtc_alarm);
+
+	rtc_update_irq(pdata->rtc, 1, events);
+	spin_unlock_irq(&pdata->rtc->irq_lock);
+
+	return IRQ_HANDLED;
+}
+
+static int mxc_rtc_open(struct device *dev)
+{
+	return 0;
+}
+
+/*
+ * Clear all interrupts and release the IRQ
+ */
+static void mxc_rtc_release(struct device *dev)
+{
+	struct platform_device *pdev = to_platform_device(dev);
+	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
+	void __iomem *ioaddr = pdata->ioaddr;
+
+	spin_lock_irq(&pdata->rtc->irq_lock);
+
+	/* Disable all rtc interrupts */
+	writew(0, ioaddr + RTC_RTCIENR);
+
+	/* Clear all interrupt status */
+	writew(0xffffffff, ioaddr + RTC_RTCISR);
+
+	spin_unlock_irq(&pdata->rtc->irq_lock);
+}
+
+/*
+ * This function is used to support some ioctl calls directly.
+ * Other ioctl calls are supported indirectly through the
+ * arm/common/rtctime.c file.
+ */
+static int mxc_rtc_ioctl(struct device *dev, unsigned int cmd,
+			 unsigned long arg)
+{
+	struct platform_device *pdev = to_platform_device(dev);
+	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
+	void __iomem *ioaddr = pdata->ioaddr;
+	int i;
+
+	switch (cmd) {
+	case RTC_PIE_OFF:
+		writew((readw(ioaddr + RTC_RTCIENR) & ~PIT_ALL_ON),
+		       ioaddr + RTC_RTCIENR);
+		return 0;
+
+	case RTC_IRQP_SET:
+		if (arg < 2 || arg > MAX_PIE_FREQ || (arg % 2) != 0)
+			return -EINVAL;	/* Also make sure a power of 2Hz */
+		if ((arg > 64) && (!capable(CAP_SYS_RESOURCE)))
+			return -EACCES;
+		rtc_freq = arg;
+		return 0;
+
+	case RTC_IRQP_READ:
+		return put_user(rtc_freq, (u32 *) arg);
+
+	case RTC_PIE_ON:
+		for (i = 0; i < MAX_PIE_NUM; i++)
+			if (PIE_BIT_DEF[i][0] == rtc_freq)
+				break;
+
+		if (i == MAX_PIE_NUM)
+			return -EACCES;
+
+		spin_lock_irq(&pdata->rtc->irq_lock);
+		writew((readw(ioaddr + RTC_RTCIENR) | PIE_BIT_DEF[i][1]),
+		       ioaddr + RTC_RTCIENR);
+		spin_unlock_irq(&pdata->rtc->irq_lock);
+		return 0;
+
+	case RTC_AIE_OFF:
+		spin_lock_irq(&pdata->rtc->irq_lock);
+		writew((readw(ioaddr + RTC_RTCIENR) & ~RTC_ALM_BIT),
+		       ioaddr + RTC_RTCIENR);
+		spin_unlock_irq(&pdata->rtc->irq_lock);
+		return 0;
+
+	case RTC_AIE_ON:
+		spin_lock_irq(&pdata->rtc->irq_lock);
+		writew((readw(ioaddr + RTC_RTCIENR) | RTC_ALM_BIT),
+		       ioaddr + RTC_RTCIENR);
+		spin_unlock_irq(&pdata->rtc->irq_lock);
+		return 0;
+
+	case RTC_UIE_OFF:	/* UIE is for the 1Hz interrupt */
+		spin_lock_irq(&pdata->rtc->irq_lock);
+		writew((readw(ioaddr + RTC_RTCIENR) & ~RTC_1HZ_BIT),
+		       ioaddr + RTC_RTCIENR);
+		spin_unlock_irq(&pdata->rtc->irq_lock);
+		return 0;
+
+	case RTC_UIE_ON:
+		spin_lock_irq(&pdata->rtc->irq_lock);
+		writew((readw(ioaddr + RTC_RTCIENR) | RTC_1HZ_BIT),
+		       ioaddr + RTC_RTCIENR);
+		spin_unlock_irq(&pdata->rtc->irq_lock);
+		return 0;
+	}
+
+	return -ENOIOCTLCMD;
+}
+
+/*
+ * This function reads the current RTC time into tm in Gregorian date.
+ */
+static int mxc_rtc_read_time(struct device *dev, struct rtc_time *tm)
+{
+	u32 val;
+
+	/* Avoid roll-over from reading the different registers */
+	do {
+		val = get_alarm_or_time(dev, MXC_RTC_TIME);
+	} while (val != get_alarm_or_time(dev, MXC_RTC_TIME));
+
+	rtc_time_to_tm(val, tm);
+
+	return 0;
+}
+
+/*
+ * This function sets the internal RTC time based on tm in Gregorian date.
+ */
+static int mxc_rtc_set_mmss(struct device *dev, unsigned long time)
+{
+	/* Avoid roll-over from reading the different registers */
+	do {
+		set_alarm_or_time(dev, MXC_RTC_TIME, time);
+	} while (time != get_alarm_or_time(dev, MXC_RTC_TIME));
+
+	return 0;
+}
+
+/*
+ * This function reads the current alarm value into the passed in 'alrm'
+ * argument. It updates the alrm's pending field value based on the whether
+ * an alarm interrupt occurs or not.
+ */
+static int mxc_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm)
+{
+	struct platform_device *pdev = to_platform_device(dev);
+	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
+	void __iomem *ioaddr = pdata->ioaddr;
+
+	rtc_time_to_tm(get_alarm_or_time(dev, MXC_RTC_ALARM), &alrm->time);
+	alrm->pending = ((readw(ioaddr + RTC_RTCISR) & RTC_ALM_BIT)) ? 1 : 0;
+
+	return 0;
+}
+
+/*
+ * This function sets the RTC alarm based on passed in alrm.
+ */
+static int mxc_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm)
+{
+	struct platform_device *pdev = to_platform_device(dev);
+	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
+	void __iomem *ioaddr = pdata->ioaddr;
+	int ret;
+
+	spin_lock_irq(&pdata->rtc->irq_lock);
+	if (rtc_valid_tm(&alrm->time)) {
+		if (alrm->time.tm_sec > 59 ||
+		    alrm->time.tm_hour > 23 ||
+		    alrm->time.tm_min > 59) {
+			ret = -EINVAL;
+			goto out;
+		}
+		ret = rtc_update_alarm(dev, &alrm->time);
+	} else {
+		ret = rtc_valid_tm(&alrm->time);
+		if (ret)
+			goto out;
+
+		ret = rtc_update_alarm(dev, &alrm->time);
+	}
+
+	if (ret)
+		goto out;
+
+	memcpy(&g_rtc_alarm, &alrm->time, sizeof(struct rtc_time));
+
+	if (alrm->enabled)
+		writew((readw(ioaddr + RTC_RTCIENR) | RTC_ALM_BIT),
+		       ioaddr + RTC_RTCIENR);
+	else
+		writew((readw(ioaddr + RTC_RTCIENR) & ~RTC_ALM_BIT),
+		       ioaddr + RTC_RTCIENR);
+
+out:
+	spin_unlock_irq(&pdata->rtc->irq_lock);
+	return ret;
+}
+
+/* RTC layer */
+static struct rtc_class_ops mxc_rtc_ops = {
+	.open		= mxc_rtc_open,
+	.release	= mxc_rtc_release,
+	.ioctl		= mxc_rtc_ioctl,
+	.read_time	= mxc_rtc_read_time,
+	.set_mmss	= mxc_rtc_set_mmss,
+	.read_alarm	= mxc_rtc_read_alarm,
+	.set_alarm	= mxc_rtc_set_alarm,
+};
+
+static int __init mxc_rtc_probe(struct platform_device *pdev)
+{
+	struct clk *clk;
+	struct timespec tv;
+	struct resource *res;
+	struct rtc_device *rtc;
+	struct rtc_plat_data *pdata = NULL;
+	u32 reg;
+	int rate;
+
+	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+	if (!res)
+		return -ENODEV;
+
+	pdata = kzalloc(sizeof(*pdata), GFP_KERNEL);
+	if (!pdata)
+		return -ENOMEM;
+
+	pdata->baseaddr = res->start;
+	pdata->ioaddr = ((void *)(IO_ADDRESS(pdata->baseaddr)));
+
+	clk = clk_get(&pdev->dev, "ckil");
+	rate = clk_get_rate(clk);
+	clk_put(clk);
+
+	if (rate == 32768)
+		reg = RTC_INPUT_CLK_32768HZ;
+	else if (rate == 32000)
+		reg = RTC_INPUT_CLK_32000HZ;
+	else if (rate == 38400)
+		reg = RTC_INPUT_CLK_38400HZ;
+	else {
+		dev_err(&pdev->dev, "rtc clock is not valid (%lu)\n",
+			clk_get_rate(clk));
+		return -EINVAL;
+	}
+
+	reg |= RTC_ENABLE_BIT;
+	writew(reg, (pdata->ioaddr + RTC_RTCCTL));
+	if (((readw(pdata->ioaddr + RTC_RTCCTL)) & RTC_ENABLE_BIT) == 0) {
+		dev_err(&pdev->dev, "hardware module can't be enabled!\n");
+		return -EIO;
+	}
+
+	pdata->clk = clk_get(&pdev->dev, "rtc");
+	if (!pdata->clk) {
+		dev_err(&pdev->dev, "unable to get clock!\n");
+		return -ENODEV;
+	}
+
+	clk_enable(pdata->clk);
+
+	rtc = rtc_device_register(pdev->name, &pdev->dev, &mxc_rtc_ops,
+				  THIS_MODULE);
+	if (IS_ERR(rtc)) {
+		if (pdata->irq >= 0)
+			free_irq(pdata->irq, pdev);
+		kfree(pdata);
+		return PTR_ERR(rtc);
+	}
+
+	pdata->rtc = rtc;
+	platform_set_drvdata(pdev, pdata);
+
+	/* Configure and enable the RTC */
+	pdata->irq = platform_get_irq(pdev, 0);
+
+	if (pdata->irq >= 0) {
+		if (request_irq(pdata->irq, mxc_rtc_interrupt, IRQF_SHARED,
+				pdev->name, pdev) < 0) {
+			dev_warn(&pdev->dev, "interrupt not available.\n");
+			pdata->irq = -1;
+		}
+	}
+
+	tv.tv_nsec = 0;
+	tv.tv_sec = get_alarm_or_time(&pdev->dev, MXC_RTC_TIME);
+
+	return 0;
+}
+
+static int __exit mxc_rtc_remove(struct platform_device *pdev)
+{
+	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
+
+	rtc_device_unregister(pdata->rtc);
+
+	if (pdata->irq)
+		free_irq(pdata->irq, pdev);
+
+	clk_disable(pdata->clk);
+	clk_put(pdata->clk);
+	kfree(pdata);
+	mxc_rtc_release(NULL);
+
+	return 0;
+}
+
+#if defined(CONFIG_SUSPEND)
+
+static int mxc_rtc_suspend(struct platform_device *pdev, pm_message_t state)
+{
+	struct timespec tv;
+	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
+
+	/* calculate time delta for suspend */
+	/* RTC precision is 1 second; adjust delta for avg 1/2 sec err */
+	tv.tv_nsec = NSEC_PER_SEC >> 1;
+	tv.tv_sec = get_alarm_or_time(&pdev->dev, MXC_RTC_TIME);
+	set_normalized_timespec(&pdata->mxc_rtc_delta,
+				xtime.tv_sec - tv.tv_sec,
+				xtime.tv_nsec - tv.tv_nsec);
+	return 0;
+}
+
+static int mxc_rtc_resume(struct platform_device *pdev)
+{
+	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
+	struct timespec tv;
+	struct timespec ts;
+
+	tv.tv_nsec = 0;
+	tv.tv_sec = get_alarm_or_time(&pdev->dev, MXC_RTC_TIME);
+
+	/* restore wall clock using delta against this RTC;
+	 * adjust again for avg 1/2 second RTC sampling error */
+	set_normalized_timespec(&ts,
+				tv.tv_sec + pdata->mxc_rtc_delta.tv_sec,
+				(NSEC_PER_SEC >> 1)
+				 + pdata->mxc_rtc_delta.tv_nsec);
+	do_settimeofday(&ts);
+	return 0;
+}
+
+#else
+#define mxc_rtc_suspend NULL
+#define mxc_rtc_resume  NULL
+#endif /* CONFIG_SUSPEND */
+
+static struct platform_driver mxc_rtc_driver = {
+	.driver = {
+		   .name	= "mxc_rtc",
+		   .owner	= THIS_MODULE,
+	},
+	.remove		= __exit_p(mxc_rtc_remove),
+	.suspend	= mxc_rtc_suspend,
+	.resume		= mxc_rtc_resume,
+};
+
+static int __init mxc_rtc_init(void)
+{
+	return platform_driver_probe(&mxc_rtc_driver, mxc_rtc_probe);
+}
+
+static void __exit mxc_rtc_exit(void)
+{
+	platform_driver_unregister(&mxc_rtc_driver);
+
+}
+
+module_init(mxc_rtc_init);
+module_exit(mxc_rtc_exit);
+
+MODULE_AUTHOR("Freescale Semiconductor");
+MODULE_DESCRIPTION("RTC driver for Freescale MXC SoCs");
+MODULE_LICENSE("GPL");
+