[linux.git] / drivers / rtc / rtc-vr41xx.c

/*
 *  Driver for NEC VR4100 series Real Time Clock unit.
 *
 *  Copyright (C) 2003-2008  Yoichi Yuasa <[email protected]>
 *
 *  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.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */
#include <linux/err.h>
#include <linux/fs.h>
#include <linux/init.h>
#include <linux/io.h>
#include <linux/ioport.h>
#include <linux/interrupt.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/rtc.h>
#include <linux/spinlock.h>
#include <linux/types.h>
#include <linux/uaccess.h>
#include <linux/log2.h>

#include <asm/div64.h>

MODULE_AUTHOR("Yoichi Yuasa <[email protected]>");
MODULE_DESCRIPTION("NEC VR4100 series RTC driver");
MODULE_LICENSE("GPL v2");

/* RTC 1 registers */
#define ETIMELREG		0x00
#define ETIMEMREG		0x02
#define ETIMEHREG		0x04
/* RFU */
#define ECMPLREG		0x08
#define ECMPMREG		0x0a
#define ECMPHREG		0x0c
/* RFU */
#define RTCL1LREG		0x10
#define RTCL1HREG		0x12
#define RTCL1CNTLREG		0x14
#define RTCL1CNTHREG		0x16
#define RTCL2LREG		0x18
#define RTCL2HREG		0x1a
#define RTCL2CNTLREG		0x1c
#define RTCL2CNTHREG		0x1e

/* RTC 2 registers */
#define TCLKLREG		0x00
#define TCLKHREG		0x02
#define TCLKCNTLREG		0x04
#define TCLKCNTHREG		0x06
/* RFU */
#define RTCINTREG		0x1e
 #define TCLOCK_INT		0x08
 #define RTCLONG2_INT		0x04
 #define RTCLONG1_INT		0x02
 #define ELAPSEDTIME_INT	0x01

#define RTC_FREQUENCY		32768
#define MAX_PERIODIC_RATE	6553

static void __iomem *rtc1_base;
static void __iomem *rtc2_base;

#define rtc1_read(offset)		readw(rtc1_base + (offset))
#define rtc1_write(offset, value)	writew((value), rtc1_base + (offset))

#define rtc2_read(offset)		readw(rtc2_base + (offset))
#define rtc2_write(offset, value)	writew((value), rtc2_base + (offset))

static unsigned long epoch = 1970;	/* Jan 1 1970 00:00:00 */

static DEFINE_SPINLOCK(rtc_lock);
static char rtc_name[] = "RTC";
static unsigned long periodic_count;
static unsigned int alarm_enabled;
static int aie_irq;
static int pie_irq;

static inline unsigned long read_elapsed_second(void)
{

	unsigned long first_low, first_mid, first_high;

	unsigned long second_low, second_mid, second_high;

	do {
		first_low = rtc1_read(ETIMELREG);
		first_mid = rtc1_read(ETIMEMREG);
		first_high = rtc1_read(ETIMEHREG);
		second_low = rtc1_read(ETIMELREG);
		second_mid = rtc1_read(ETIMEMREG);
		second_high = rtc1_read(ETIMEHREG);
	} while (first_low != second_low || first_mid != second_mid ||
		 first_high != second_high);

	return (first_high << 17) | (first_mid << 1) | (first_low >> 15);
}

static inline void write_elapsed_second(unsigned long sec)
{
	spin_lock_irq(&rtc_lock);

	rtc1_write(ETIMELREG, (uint16_t)(sec << 15));
	rtc1_write(ETIMEMREG, (uint16_t)(sec >> 1));
	rtc1_write(ETIMEHREG, (uint16_t)(sec >> 17));

	spin_unlock_irq(&rtc_lock);
}

static int vr41xx_rtc_read_time(struct device *dev, struct rtc_time *time)
{
	unsigned long epoch_sec, elapsed_sec;

	epoch_sec = mktime(epoch, 1, 1, 0, 0, 0);
	elapsed_sec = read_elapsed_second();

	rtc_time_to_tm(epoch_sec + elapsed_sec, time);

	return 0;
}

static int vr41xx_rtc_set_time(struct device *dev, struct rtc_time *time)
{
	unsigned long epoch_sec, current_sec;

	epoch_sec = mktime(epoch, 1, 1, 0, 0, 0);
	current_sec = mktime(time->tm_year + 1900, time->tm_mon + 1, time->tm_mday,
			     time->tm_hour, time->tm_min, time->tm_sec);

	write_elapsed_second(current_sec - epoch_sec);

	return 0;
}

static int vr41xx_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *wkalrm)
{
	unsigned long low, mid, high;
	struct rtc_time *time = &wkalrm->time;

	spin_lock_irq(&rtc_lock);

	low = rtc1_read(ECMPLREG);
	mid = rtc1_read(ECMPMREG);
	high = rtc1_read(ECMPHREG);
	wkalrm->enabled = alarm_enabled;

	spin_unlock_irq(&rtc_lock);

	rtc_time_to_tm((high << 17) | (mid << 1) | (low >> 15), time);

	return 0;
}

static int vr41xx_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *wkalrm)
{
	unsigned long alarm_sec;
	struct rtc_time *time = &wkalrm->time;

	alarm_sec = mktime(time->tm_year + 1900, time->tm_mon + 1, time->tm_mday,
			   time->tm_hour, time->tm_min, time->tm_sec);

	spin_lock_irq(&rtc_lock);

	if (alarm_enabled)
		disable_irq(aie_irq);

	rtc1_write(ECMPLREG, (uint16_t)(alarm_sec << 15));
	rtc1_write(ECMPMREG, (uint16_t)(alarm_sec >> 1));
	rtc1_write(ECMPHREG, (uint16_t)(alarm_sec >> 17));

	if (wkalrm->enabled)
		enable_irq(aie_irq);

	alarm_enabled = wkalrm->enabled;

	spin_unlock_irq(&rtc_lock);

	return 0;
}

static int vr41xx_rtc_ioctl(struct device *dev, unsigned int cmd, unsigned long arg)
{
	switch (cmd) {
	case RTC_EPOCH_READ:
		return put_user(epoch, (unsigned long __user *)arg);
	case RTC_EPOCH_SET:
		/* Doesn't support before 1900 */
		if (arg < 1900)
			return -EINVAL;
		epoch = arg;
		break;
	default:
		return -ENOIOCTLCMD;
	}

	return 0;
}

static int vr41xx_rtc_alarm_irq_enable(struct device *dev, unsigned int enabled)
{
	spin_lock_irq(&rtc_lock);
	if (enabled) {
		if (!alarm_enabled) {
			enable_irq(aie_irq);
			alarm_enabled = 1;
		}
	} else {
		if (alarm_enabled) {
			disable_irq(aie_irq);
			alarm_enabled = 0;
		}
	}
	spin_unlock_irq(&rtc_lock);
	return 0;
}

static irqreturn_t elapsedtime_interrupt(int irq, void *dev_id)
{
	struct platform_device *pdev = (struct platform_device *)dev_id;
	struct rtc_device *rtc = platform_get_drvdata(pdev);

	rtc2_write(RTCINTREG, ELAPSEDTIME_INT);

	rtc_update_irq(rtc, 1, RTC_AF);

	return IRQ_HANDLED;
}

static irqreturn_t rtclong1_interrupt(int irq, void *dev_id)
{
	struct platform_device *pdev = (struct platform_device *)dev_id;
	struct rtc_device *rtc = platform_get_drvdata(pdev);
	unsigned long count = periodic_count;

	rtc2_write(RTCINTREG, RTCLONG1_INT);

	rtc1_write(RTCL1LREG, count);
	rtc1_write(RTCL1HREG, count >> 16);

	rtc_update_irq(rtc, 1, RTC_PF);

	return IRQ_HANDLED;
}

static const struct rtc_class_ops vr41xx_rtc_ops = {
	.ioctl			= vr41xx_rtc_ioctl,
	.read_time		= vr41xx_rtc_read_time,
	.set_time		= vr41xx_rtc_set_time,
	.read_alarm		= vr41xx_rtc_read_alarm,
	.set_alarm		= vr41xx_rtc_set_alarm,
	.alarm_irq_enable	= vr41xx_rtc_alarm_irq_enable,
};

static int rtc_probe(struct platform_device *pdev)
{
	struct resource *res;
	struct rtc_device *rtc;
	int retval;

	if (pdev->num_resources != 4)
		return -EBUSY;

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!res)
		return -EBUSY;

	rtc1_base = devm_ioremap(&pdev->dev, res->start, resource_size(res));
	if (!rtc1_base)
		return -EBUSY;

	res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
	if (!res) {
		retval = -EBUSY;
		goto err_rtc1_iounmap;
	}

	rtc2_base = devm_ioremap(&pdev->dev, res->start, resource_size(res));
	if (!rtc2_base) {
		retval = -EBUSY;
		goto err_rtc1_iounmap;
	}

	rtc = devm_rtc_device_register(&pdev->dev, rtc_name, &vr41xx_rtc_ops,
					THIS_MODULE);
	if (IS_ERR(rtc)) {
		retval = PTR_ERR(rtc);
		goto err_iounmap_all;
	}

	rtc->max_user_freq = MAX_PERIODIC_RATE;

	spin_lock_irq(&rtc_lock);

	rtc1_write(ECMPLREG, 0);
	rtc1_write(ECMPMREG, 0);
	rtc1_write(ECMPHREG, 0);
	rtc1_write(RTCL1LREG, 0);
	rtc1_write(RTCL1HREG, 0);

	spin_unlock_irq(&rtc_lock);

	aie_irq = platform_get_irq(pdev, 0);
	if (aie_irq <= 0) {
		retval = -EBUSY;
		goto err_iounmap_all;
	}

	retval = devm_request_irq(&pdev->dev, aie_irq, elapsedtime_interrupt, 0,
				"elapsed_time", pdev);
	if (retval < 0)
		goto err_iounmap_all;

	pie_irq = platform_get_irq(pdev, 1);
	if (pie_irq <= 0) {
		retval = -EBUSY;
		goto err_iounmap_all;
	}

	retval = devm_request_irq(&pdev->dev, pie_irq, rtclong1_interrupt, 0,
				"rtclong1", pdev);
	if (retval < 0)
		goto err_iounmap_all;

	platform_set_drvdata(pdev, rtc);

	disable_irq(aie_irq);
	disable_irq(pie_irq);

	dev_info(&pdev->dev, "Real Time Clock of NEC VR4100 series\n");

	return 0;

err_iounmap_all:
	rtc2_base = NULL;

err_rtc1_iounmap:
	rtc1_base = NULL;

	return retval;
}

/* work with hotplug and coldplug */
MODULE_ALIAS("platform:RTC");

static struct platform_driver rtc_platform_driver = {
	.probe		= rtc_probe,
	.driver		= {
		.name	= rtc_name,
	},
};

module_platform_driver(rtc_platform_driver);
Commit	Line	Data
1da177e4	1	/*
8417eb7a	2	* Driver for NEC VR4100 series Real Time Clock unit.
1da177e4	3	*
ada8e951	4	* Copyright (C) 2003-2008 Yoichi Yuasa <[email protected]>
1da177e4 LT	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License as published by
	8	* the Free Software Foundation; either version 2 of the License, or
	9	* (at your option) any later version.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*
	16	* You should have received a copy of the GNU General Public License
	17	* along with this program; if not, write to the Free Software
	18	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	19	*/
bd076509	20	#include <linux/err.h>
1da177e4 LT	21	#include <linux/fs.h>
1da177e4 LT	22	#include <linux/init.h>
4271e7ff	23	#include <linux/io.h>
1da177e4	24	#include <linux/ioport.h>
bd076509	25	#include <linux/interrupt.h>
1da177e4	26	#include <linux/module.h>
8417eb7a	27	#include <linux/platform_device.h>
1da177e4 LT	28	#include <linux/rtc.h>
	29	#include <linux/spinlock.h>
	30	#include <linux/types.h>
4271e7ff	31	#include <linux/uaccess.h>
5d2a5037	32	#include <linux/log2.h>
1da177e4 LT	33
1da177e4 LT	34	#include <asm/div64.h>
1da177e4	35
ada8e951	36	MODULE_AUTHOR("Yoichi Yuasa <[email protected]>");
1da177e4	37	MODULE_DESCRIPTION("NEC VR4100 series RTC driver");
4cad4431	38	MODULE_LICENSE("GPL v2");
1da177e4	39
1da177e4 LT	40	/* RTC 1 registers */
	41	#define ETIMELREG 0x00
	42	#define ETIMEMREG 0x02
	43	#define ETIMEHREG 0x04
	44	/* RFU */
	45	#define ECMPLREG 0x08
	46	#define ECMPMREG 0x0a
	47	#define ECMPHREG 0x0c
	48	/* RFU */
	49	#define RTCL1LREG 0x10
	50	#define RTCL1HREG 0x12
	51	#define RTCL1CNTLREG 0x14
	52	#define RTCL1CNTHREG 0x16
	53	#define RTCL2LREG 0x18
	54	#define RTCL2HREG 0x1a
	55	#define RTCL2CNTLREG 0x1c
	56	#define RTCL2CNTHREG 0x1e
	57
	58	/* RTC 2 registers */
	59	#define TCLKLREG 0x00
	60	#define TCLKHREG 0x02
	61	#define TCLKCNTLREG 0x04
	62	#define TCLKCNTHREG 0x06
	63	/* RFU */
	64	#define RTCINTREG 0x1e
	65	#define TCLOCK_INT 0x08
	66	#define RTCLONG2_INT 0x04
	67	#define RTCLONG1_INT 0x02
	68	#define ELAPSEDTIME_INT 0x01
	69
	70	#define RTC_FREQUENCY 32768
	71	#define MAX_PERIODIC_RATE 6553
1da177e4 LT	72
	73	static void __iomem *rtc1_base;
	74	static void __iomem *rtc2_base;
	75
	76	#define rtc1_read(offset) readw(rtc1_base + (offset))
	77	#define rtc1_write(offset, value) writew((value), rtc1_base + (offset))
	78
	79	#define rtc2_read(offset) readw(rtc2_base + (offset))
	80	#define rtc2_write(offset, value) writew((value), rtc2_base + (offset))
	81
	82	static unsigned long epoch = 1970; /* Jan 1 1970 00:00:00 */
	83
34af946a	84	static DEFINE_SPINLOCK(rtc_lock);
1da177e4	85	static char rtc_name[] = "RTC";
1da177e4	86	static unsigned long periodic_count;
9b5ef64a	87	static unsigned int alarm_enabled;
2fac6674 AV	88	static int aie_irq;
2fac6674 AV	89	static int pie_irq;
1da177e4	90
1da177e4 LT	91	static inline unsigned long read_elapsed_second(void)
1da177e4 LT	92	{
8417eb7a	93
1da177e4	94	unsigned long first_low, first_mid, first_high;
8417eb7a	95
1da177e4 LT	96	unsigned long second_low, second_mid, second_high;
	97
	98	do {
	99	first_low = rtc1_read(ETIMELREG);
	100	first_mid = rtc1_read(ETIMEMREG);
	101	first_high = rtc1_read(ETIMEHREG);
	102	second_low = rtc1_read(ETIMELREG);
	103	second_mid = rtc1_read(ETIMEMREG);
	104	second_high = rtc1_read(ETIMEHREG);
	105	} while (first_low != second_low \|\| first_mid != second_mid \|\|
0218bcf6	106	first_high != second_high);
1da177e4 LT	107
	108	return (first_high << 17) \| (first_mid << 1) \| (first_low >> 15);
	109	}
	110
	111	static inline void write_elapsed_second(unsigned long sec)
	112	{
	113	spin_lock_irq(&rtc_lock);
	114
	115	rtc1_write(ETIMELREG, (uint16_t)(sec << 15));
	116	rtc1_write(ETIMEMREG, (uint16_t)(sec >> 1));
	117	rtc1_write(ETIMEHREG, (uint16_t)(sec >> 17));
	118
	119	spin_unlock_irq(&rtc_lock);
	120	}
	121
8417eb7a	122	static int vr41xx_rtc_read_time(struct device dev, struct rtc_time time)
1da177e4 LT	123	{
	124	unsigned long epoch_sec, elapsed_sec;
	125
	126	epoch_sec = mktime(epoch, 1, 1, 0, 0, 0);
	127	elapsed_sec = read_elapsed_second();
	128
8417eb7a YY	129	rtc_time_to_tm(epoch_sec + elapsed_sec, time);
	130
	131	return 0;
1da177e4 LT	132	}
1da177e4 LT	133
8417eb7a	134	static int vr41xx_rtc_set_time(struct device dev, struct rtc_time time)
1da177e4 LT	135	{
	136	unsigned long epoch_sec, current_sec;
	137
	138	epoch_sec = mktime(epoch, 1, 1, 0, 0, 0);
	139	current_sec = mktime(time->tm_year + 1900, time->tm_mon + 1, time->tm_mday,
0218bcf6	140	time->tm_hour, time->tm_min, time->tm_sec);
1da177e4 LT	141
1da177e4 LT	142	write_elapsed_second(current_sec - epoch_sec);
8417eb7a YY	143
8417eb7a YY	144	return 0;
1da177e4 LT	145	}
1da177e4 LT	146
8417eb7a	147	static int vr41xx_rtc_read_alarm(struct device dev, struct rtc_wkalrm wkalrm)
1da177e4	148	{
8417eb7a YY	149	unsigned long low, mid, high;
8417eb7a YY	150	struct rtc_time *time = &wkalrm->time;
1da177e4	151
8417eb7a	152	spin_lock_irq(&rtc_lock);
1da177e4	153
8417eb7a YY	154	low = rtc1_read(ECMPLREG);
	155	mid = rtc1_read(ECMPMREG);
	156	high = rtc1_read(ECMPHREG);
9b5ef64a	157	wkalrm->enabled = alarm_enabled;
1da177e4	158
8417eb7a	159	spin_unlock_irq(&rtc_lock);
1da177e4	160
8417eb7a	161	rtc_time_to_tm((high << 17) \| (mid << 1) \| (low >> 15), time);
1da177e4	162
8417eb7a YY	163	return 0;
8417eb7a YY	164	}
1da177e4	165
8417eb7a YY	166	static int vr41xx_rtc_set_alarm(struct device dev, struct rtc_wkalrm wkalrm)
	167	{
	168	unsigned long alarm_sec;
	169	struct rtc_time *time = &wkalrm->time;
1da177e4	170
8417eb7a	171	alarm_sec = mktime(time->tm_year + 1900, time->tm_mon + 1, time->tm_mday,
0218bcf6	172	time->tm_hour, time->tm_min, time->tm_sec);
1da177e4	173
8417eb7a	174	spin_lock_irq(&rtc_lock);
1da177e4	175
9b5ef64a	176	if (alarm_enabled)
bd076509	177	disable_irq(aie_irq);
9b5ef64a	178
8417eb7a YY	179	rtc1_write(ECMPLREG, (uint16_t)(alarm_sec << 15));
	180	rtc1_write(ECMPMREG, (uint16_t)(alarm_sec >> 1));
	181	rtc1_write(ECMPHREG, (uint16_t)(alarm_sec >> 17));
1da177e4	182
9b5ef64a	183	if (wkalrm->enabled)
bd076509	184	enable_irq(aie_irq);
9b5ef64a YY	185
	186	alarm_enabled = wkalrm->enabled;
	187
8417eb7a	188	spin_unlock_irq(&rtc_lock);
1da177e4 LT	189
	190	return 0;
	191	}
	192
4cad4431 YY	193	static int vr41xx_rtc_ioctl(struct device *dev, unsigned int cmd, unsigned long arg)
4cad4431 YY	194	{
1da177e4	195	switch (cmd) {
1da177e4 LT	196	case RTC_EPOCH_READ:
	197	return put_user(epoch, (unsigned long __user *)arg);
	198	case RTC_EPOCH_SET:
	199	/* Doesn't support before 1900 */
	200	if (arg < 1900)
	201	return -EINVAL;
1da177e4 LT	202	epoch = arg;
	203	break;
	204	default:
b3969e58	205	return -ENOIOCTLCMD;
1da177e4 LT	206	}
	207
	208	return 0;
	209	}
	210
16380c15 JS	211	static int vr41xx_rtc_alarm_irq_enable(struct device *dev, unsigned int enabled)
	212	{
	213	spin_lock_irq(&rtc_lock);
	214	if (enabled) {
	215	if (!alarm_enabled) {
	216	enable_irq(aie_irq);
	217	alarm_enabled = 1;
	218	}
	219	} else {
	220	if (alarm_enabled) {
	221	disable_irq(aie_irq);
	222	alarm_enabled = 0;
	223	}
	224	}
	225	spin_unlock_irq(&rtc_lock);
	226	return 0;
	227	}
	228
7d12e780	229	static irqreturn_t elapsedtime_interrupt(int irq, void *dev_id)
1da177e4	230	{
8417eb7a YY	231	struct platform_device pdev = (struct platform_device )dev_id;
8417eb7a YY	232	struct rtc_device *rtc = platform_get_drvdata(pdev);
1da177e4	233
8417eb7a	234	rtc2_write(RTCINTREG, ELAPSEDTIME_INT);
1da177e4	235
ab6a2d70	236	rtc_update_irq(rtc, 1, RTC_AF);
1da177e4 LT	237
	238	return IRQ_HANDLED;
	239	}
	240
7d12e780	241	static irqreturn_t rtclong1_interrupt(int irq, void *dev_id)
1da177e4	242	{
8417eb7a YY	243	struct platform_device pdev = (struct platform_device )dev_id;
8417eb7a YY	244	struct rtc_device *rtc = platform_get_drvdata(pdev);
1da177e4 LT	245	unsigned long count = periodic_count;
1da177e4 LT	246
1da177e4 LT	247	rtc2_write(RTCINTREG, RTCLONG1_INT);
	248
	249	rtc1_write(RTCL1LREG, count);
	250	rtc1_write(RTCL1HREG, count >> 16);
	251
ab6a2d70	252	rtc_update_irq(rtc, 1, RTC_PF);
1da177e4 LT	253
	254	return IRQ_HANDLED;
	255	}
	256
ff8371ac	257	static const struct rtc_class_ops vr41xx_rtc_ops = {
a25f4a95 GU	258	.ioctl = vr41xx_rtc_ioctl,
	259	.read_time = vr41xx_rtc_read_time,
	260	.set_time = vr41xx_rtc_set_time,
	261	.read_alarm = vr41xx_rtc_read_alarm,
	262	.set_alarm = vr41xx_rtc_set_alarm,
	263	.alarm_irq_enable = vr41xx_rtc_alarm_irq_enable,
1da177e4 LT	264	};
1da177e4 LT	265
5a167f45	266	static int rtc_probe(struct platform_device *pdev)
1da177e4	267	{
bd076509	268	struct resource *res;
8417eb7a	269	struct rtc_device *rtc;
1da177e4 LT	270	int retval;
1da177e4 LT	271
bd076509	272	if (pdev->num_resources != 4)
1da177e4 LT	273	return -EBUSY;
1da177e4 LT	274
bd076509 YY	275	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
bd076509 YY	276	if (!res)
1da177e4 LT	277	return -EBUSY;
1da177e4 LT	278
bf6ce1a1	279	rtc1_base = devm_ioremap(&pdev->dev, res->start, resource_size(res));
bd076509	280	if (!rtc1_base)
1da177e4	281	return -EBUSY;
bd076509 YY	282
	283	res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
	284	if (!res) {
	285	retval = -EBUSY;
	286	goto err_rtc1_iounmap;
	287	}
	288
bf6ce1a1	289	rtc2_base = devm_ioremap(&pdev->dev, res->start, resource_size(res));
bd076509 YY	290	if (!rtc2_base) {
	291	retval = -EBUSY;
	292	goto err_rtc1_iounmap;
1da177e4 LT	293	}
1da177e4 LT	294
bf6ce1a1 JH	295	rtc = devm_rtc_device_register(&pdev->dev, rtc_name, &vr41xx_rtc_ops,
bf6ce1a1 JH	296	THIS_MODULE);
8417eb7a	297	if (IS_ERR(rtc)) {
bd076509 YY	298	retval = PTR_ERR(rtc);
bd076509 YY	299	goto err_iounmap_all;
1da177e4 LT	300	}
1da177e4 LT	301
4cad4431 YY	302	rtc->max_user_freq = MAX_PERIODIC_RATE;
4cad4431 YY	303
1da177e4 LT	304	spin_lock_irq(&rtc_lock);
	305
	306	rtc1_write(ECMPLREG, 0);
	307	rtc1_write(ECMPMREG, 0);
	308	rtc1_write(ECMPHREG, 0);
	309	rtc1_write(RTCL1LREG, 0);
	310	rtc1_write(RTCL1HREG, 0);
	311
1da177e4 LT	312	spin_unlock_irq(&rtc_lock);
1da177e4 LT	313
bd076509	314	aie_irq = platform_get_irq(pdev, 0);
2fac6674	315	if (aie_irq <= 0) {
bd076509	316	retval = -EBUSY;
bf6ce1a1	317	goto err_iounmap_all;
1da177e4 LT	318	}
1da177e4 LT	319
bf6ce1a1 JH	320	retval = devm_request_irq(&pdev->dev, aie_irq, elapsedtime_interrupt, 0,
bf6ce1a1 JH	321	"elapsed_time", pdev);
bd076509	322	if (retval < 0)
bf6ce1a1	323	goto err_iounmap_all;
bd076509 YY	324
bd076509 YY	325	pie_irq = platform_get_irq(pdev, 1);
812f1478 WY	326	if (pie_irq <= 0) {
812f1478 WY	327	retval = -EBUSY;
bf6ce1a1	328	goto err_iounmap_all;
812f1478	329	}
bd076509	330
bf6ce1a1 JH	331	retval = devm_request_irq(&pdev->dev, pie_irq, rtclong1_interrupt, 0,
bf6ce1a1 JH	332	"rtclong1", pdev);
bd076509	333	if (retval < 0)
bf6ce1a1	334	goto err_iounmap_all;
1da177e4	335
8417eb7a YY	336	platform_set_drvdata(pdev, rtc);
8417eb7a YY	337
bd076509 YY	338	disable_irq(aie_irq);
bd076509 YY	339	disable_irq(pie_irq);
1da177e4	340
d75dcd33	341	dev_info(&pdev->dev, "Real Time Clock of NEC VR4100 series\n");
1da177e4 LT	342
1da177e4 LT	343	return 0;
bd076509	344
bd076509	345	err_iounmap_all:
bd076509 YY	346	rtc2_base = NULL;
	347
	348	err_rtc1_iounmap:
bd076509 YY	349	rtc1_base = NULL;
	350
	351	return retval;
1da177e4 LT	352	}
1da177e4 LT	353
ad28a07b KS	354	/* work with hotplug and coldplug */
	355	MODULE_ALIAS("platform:RTC");
	356
8417eb7a	357	static struct platform_driver rtc_platform_driver = {
1da177e4	358	.probe = rtc_probe,
3ae5eaec RK	359	.driver = {
	360	.name = rtc_name,
	361	},
1da177e4 LT	362	};
1da177e4 LT	363
0c4eae66	364	module_platform_driver(rtc_platform_driver);