[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / rtc / rtc-mrst.c

/*
 * rtc-mrst.c: Driver for Moorestown virtual RTC
 *
 * (C) Copyright 2009 Intel Corporation
 * Author: Jacob Pan (jacob.jun.pan@intel.com)
 *	   Feng Tang (feng.tang@intel.com)
 *
 * 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; version 2
 * of the License.
 *
 * Note:
 * VRTC is emulated by system controller firmware, the real HW
 * RTC is located in the PMIC device. SCU FW shadows PMIC RTC
 * in a memory mapped IO space that is visible to the host IA
 * processor.
 *
 * This driver is based upon drivers/rtc/rtc-cmos.c
 */

/*
 * Note:
 *  * vRTC only supports binary mode and 24H mode
 *  * vRTC only support PIE and AIE, no UIE, and its PIE only happens
 *    at 23:59:59pm everyday, no support for adjustable frequency
 *  * Alarm function is also limited to hr/min/sec.
 */

#include <linux/mod_devicetable.h>
#include <linux/platform_device.h>
#include <linux/interrupt.h>
#include <linux/spinlock.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/sfi.h>

#include <asm-generic/rtc.h>
#include <asm/intel_scu_ipc.h>
#include <asm/mrst.h>
#include <asm/mrst-vrtc.h>

struct mrst_rtc {
	struct rtc_device	*rtc;
	struct device		*dev;
	int			irq;
	struct resource		*iomem;

	u8			enabled_wake;
	u8			suspend_ctrl;
};

static const char driver_name[] = "rtc_mrst";

#define	RTC_IRQMASK	(RTC_PF | RTC_AF)

static inline int is_intr(u8 rtc_intr)
{
	if (!(rtc_intr & RTC_IRQF))
		return 0;
	return rtc_intr & RTC_IRQMASK;
}

static inline unsigned char vrtc_is_updating(void)
{
	unsigned char uip;
	unsigned long flags;

	spin_lock_irqsave(&rtc_lock, flags);
	uip = (vrtc_cmos_read(RTC_FREQ_SELECT) & RTC_UIP);
	spin_unlock_irqrestore(&rtc_lock, flags);
	return uip;
}

/*
 * rtc_time's year contains the increment over 1900, but vRTC's YEAR
 * register can't be programmed to value larger than 0x64, so vRTC
 * driver chose to use 1972 (1970 is UNIX time start point) as the base,
 * and does the translation at read/write time.
 *
 * Why not just use 1970 as the offset? it's because using 1972 will
 * make it consistent in leap year setting for both vrtc and low-level
 * physical rtc devices. Then why not use 1960 as the offset? If we use
 * 1960, for a device's first use, its YEAR register is 0 and the system
 * year will be parsed as 1960 which is not a valid UNIX time and will
 * cause many applications to fail mysteriously.
 */
static int mrst_read_time(struct device *dev, struct rtc_time *time)
{
	unsigned long flags;

	if (vrtc_is_updating())
		mdelay(20);

	spin_lock_irqsave(&rtc_lock, flags);
	time->tm_sec = vrtc_cmos_read(RTC_SECONDS);
	time->tm_min = vrtc_cmos_read(RTC_MINUTES);
	time->tm_hour = vrtc_cmos_read(RTC_HOURS);
	time->tm_mday = vrtc_cmos_read(RTC_DAY_OF_MONTH);
	time->tm_mon = vrtc_cmos_read(RTC_MONTH);
	time->tm_year = vrtc_cmos_read(RTC_YEAR);
	spin_unlock_irqrestore(&rtc_lock, flags);

	/* Adjust for the 1972/1900 */
	time->tm_year += 72;
	time->tm_mon--;
	return rtc_valid_tm(time);
}

static int mrst_set_time(struct device *dev, struct rtc_time *time)
{
	int ret;
	unsigned long flags;
	unsigned char mon, day, hrs, min, sec;
	unsigned int yrs;

	yrs = time->tm_year;
	mon = time->tm_mon + 1;   /* tm_mon starts at zero */
	day = time->tm_mday;
	hrs = time->tm_hour;
	min = time->tm_min;
	sec = time->tm_sec;

	if (yrs < 72 || yrs > 138)
		return -EINVAL;
	yrs -= 72;

	spin_lock_irqsave(&rtc_lock, flags);

	vrtc_cmos_write(yrs, RTC_YEAR);
	vrtc_cmos_write(mon, RTC_MONTH);
	vrtc_cmos_write(day, RTC_DAY_OF_MONTH);
	vrtc_cmos_write(hrs, RTC_HOURS);
	vrtc_cmos_write(min, RTC_MINUTES);
	vrtc_cmos_write(sec, RTC_SECONDS);

	spin_unlock_irqrestore(&rtc_lock, flags);

	ret = intel_scu_ipc_simple_command(IPCMSG_VRTC, IPC_CMD_VRTC_SETTIME);
	return ret;
}

static int mrst_read_alarm(struct device *dev, struct rtc_wkalrm *t)
{
	struct mrst_rtc	*mrst = dev_get_drvdata(dev);
	unsigned char rtc_control;

	if (mrst->irq <= 0)
		return -EIO;

	/* Basic alarms only support hour, minute, and seconds fields.
	 * Some also support day and month, for alarms up to a year in
	 * the future.
	 */
	t->time.tm_mday = -1;
	t->time.tm_mon = -1;
	t->time.tm_year = -1;

	/* vRTC only supports binary mode */
	spin_lock_irq(&rtc_lock);
	t->time.tm_sec = vrtc_cmos_read(RTC_SECONDS_ALARM);
	t->time.tm_min = vrtc_cmos_read(RTC_MINUTES_ALARM);
	t->time.tm_hour = vrtc_cmos_read(RTC_HOURS_ALARM);

	rtc_control = vrtc_cmos_read(RTC_CONTROL);
	spin_unlock_irq(&rtc_lock);

	t->enabled = !!(rtc_control & RTC_AIE);
	t->pending = 0;

	return 0;
}

static void mrst_checkintr(struct mrst_rtc *mrst, unsigned char rtc_control)
{
	unsigned char	rtc_intr;

	/*
	 * NOTE after changing RTC_xIE bits we always read INTR_FLAGS;
	 * allegedly some older rtcs need that to handle irqs properly
	 */
	rtc_intr = vrtc_cmos_read(RTC_INTR_FLAGS);
	rtc_intr &= (rtc_control & RTC_IRQMASK) | RTC_IRQF;
	if (is_intr(rtc_intr))
		rtc_update_irq(mrst->rtc, 1, rtc_intr);
}

static void mrst_irq_enable(struct mrst_rtc *mrst, unsigned char mask)
{
	unsigned char	rtc_control;

	/*
	 * Flush any pending IRQ status, notably for update irqs,
	 * before we enable new IRQs
	 */
	rtc_control = vrtc_cmos_read(RTC_CONTROL);
	mrst_checkintr(mrst, rtc_control);

	rtc_control |= mask;
	vrtc_cmos_write(rtc_control, RTC_CONTROL);

	mrst_checkintr(mrst, rtc_control);
}

static void mrst_irq_disable(struct mrst_rtc *mrst, unsigned char mask)
{
	unsigned char	rtc_control;

	rtc_control = vrtc_cmos_read(RTC_CONTROL);
	rtc_control &= ~mask;
	vrtc_cmos_write(rtc_control, RTC_CONTROL);
	mrst_checkintr(mrst, rtc_control);
}

static int mrst_set_alarm(struct device *dev, struct rtc_wkalrm *t)
{
	struct mrst_rtc	*mrst = dev_get_drvdata(dev);
	unsigned char hrs, min, sec;
	int ret = 0;

	if (!mrst->irq)
		return -EIO;

	hrs = t->time.tm_hour;
	min = t->time.tm_min;
	sec = t->time.tm_sec;

	spin_lock_irq(&rtc_lock);
	/* Next rtc irq must not be from previous alarm setting */
	mrst_irq_disable(mrst, RTC_AIE);

	/* Update alarm */
	vrtc_cmos_write(hrs, RTC_HOURS_ALARM);
	vrtc_cmos_write(min, RTC_MINUTES_ALARM);
	vrtc_cmos_write(sec, RTC_SECONDS_ALARM);

	spin_unlock_irq(&rtc_lock);

	ret = intel_scu_ipc_simple_command(IPCMSG_VRTC, IPC_CMD_VRTC_SETALARM);
	if (ret)
		return ret;

	spin_lock_irq(&rtc_lock);
	if (t->enabled)
		mrst_irq_enable(mrst, RTC_AIE);

	spin_unlock_irq(&rtc_lock);

	return 0;
}

/* Currently, the vRTC doesn't support UIE ON/OFF */
static int mrst_rtc_alarm_irq_enable(struct device *dev, unsigned int enabled)
{
	struct mrst_rtc	*mrst = dev_get_drvdata(dev);
	unsigned long	flags;

	spin_lock_irqsave(&rtc_lock, flags);
	if (enabled)
		mrst_irq_enable(mrst, RTC_AIE);
	else
		mrst_irq_disable(mrst, RTC_AIE);
	spin_unlock_irqrestore(&rtc_lock, flags);
	return 0;
}


#if defined(CONFIG_RTC_INTF_PROC) || defined(CONFIG_RTC_INTF_PROC_MODULE)

static int mrst_procfs(struct device *dev, struct seq_file *seq)
{
	unsigned char	rtc_control, valid;

	spin_lock_irq(&rtc_lock);
	rtc_control = vrtc_cmos_read(RTC_CONTROL);
	valid = vrtc_cmos_read(RTC_VALID);
	spin_unlock_irq(&rtc_lock);

	return seq_printf(seq,
			"periodic_IRQ\t: %s\n"
			"alarm\t\t: %s\n"
			"BCD\t\t: no\n"
			"periodic_freq\t: daily (not adjustable)\n",
			(rtc_control & RTC_PIE) ? "on" : "off",
			(rtc_control & RTC_AIE) ? "on" : "off");
}

#else
#define	mrst_procfs	NULL
#endif

static const struct rtc_class_ops mrst_rtc_ops = {
	.read_time	= mrst_read_time,
	.set_time	= mrst_set_time,
	.read_alarm	= mrst_read_alarm,
	.set_alarm	= mrst_set_alarm,
	.proc		= mrst_procfs,
	.alarm_irq_enable = mrst_rtc_alarm_irq_enable,
};

static struct mrst_rtc	mrst_rtc;

/*
 * When vRTC IRQ is captured by SCU FW, FW will clear the AIE bit in
 * Reg B, so no need for this driver to clear it
 */
static irqreturn_t mrst_rtc_irq(int irq, void *p)
{
	u8 irqstat;

	spin_lock(&rtc_lock);
	/* This read will clear all IRQ flags inside Reg C */
	irqstat = vrtc_cmos_read(RTC_INTR_FLAGS);
	spin_unlock(&rtc_lock);

	irqstat &= RTC_IRQMASK | RTC_IRQF;
	if (is_intr(irqstat)) {
		rtc_update_irq(p, 1, irqstat);
		return IRQ_HANDLED;
	}
	return IRQ_NONE;
}

static int vrtc_mrst_do_probe(struct device *dev, struct resource *iomem,
			      int rtc_irq)
{
	int retval = 0;
	unsigned char rtc_control;

	/* There can be only one ... */
	if (mrst_rtc.dev)
		return -EBUSY;

	if (!iomem)
		return -ENODEV;

	iomem = request_mem_region(iomem->start, resource_size(iomem),
				   driver_name);
	if (!iomem) {
		dev_dbg(dev, "i/o mem already in use.\n");
		return -EBUSY;
	}

	mrst_rtc.irq = rtc_irq;
	mrst_rtc.iomem = iomem;
	mrst_rtc.dev = dev;
	dev_set_drvdata(dev, &mrst_rtc);

	mrst_rtc.rtc = rtc_device_register(driver_name, dev,
				&mrst_rtc_ops, THIS_MODULE);
	if (IS_ERR(mrst_rtc.rtc)) {
		retval = PTR_ERR(mrst_rtc.rtc);
		goto cleanup0;
	}

	rename_region(iomem, dev_name(&mrst_rtc.rtc->dev));

	spin_lock_irq(&rtc_lock);
	mrst_irq_disable(&mrst_rtc, RTC_PIE | RTC_AIE);
	rtc_control = vrtc_cmos_read(RTC_CONTROL);
	spin_unlock_irq(&rtc_lock);

	if (!(rtc_control & RTC_24H) || (rtc_control & (RTC_DM_BINARY)))
		dev_dbg(dev, "TODO: support more than 24-hr BCD mode\n");

	if (rtc_irq) {
		retval = request_irq(rtc_irq, mrst_rtc_irq,
				0, dev_name(&mrst_rtc.rtc->dev),
				mrst_rtc.rtc);
		if (retval < 0) {
			dev_dbg(dev, "IRQ %d is already in use, err %d\n",
				rtc_irq, retval);
			goto cleanup1;
		}
	}
	dev_dbg(dev, "initialised\n");
	return 0;

cleanup1:
	rtc_device_unregister(mrst_rtc.rtc);
cleanup0:
	dev_set_drvdata(dev, NULL);
	mrst_rtc.dev = NULL;
	release_mem_region(iomem->start, resource_size(iomem));
	dev_err(dev, "rtc-mrst: unable to initialise\n");
	return retval;
}

static void rtc_mrst_do_shutdown(void)
{
	spin_lock_irq(&rtc_lock);
	mrst_irq_disable(&mrst_rtc, RTC_IRQMASK);
	spin_unlock_irq(&rtc_lock);
}

static void rtc_mrst_do_remove(struct device *dev)
{
	struct mrst_rtc	*mrst = dev_get_drvdata(dev);
	struct resource *iomem;

	rtc_mrst_do_shutdown();

	if (mrst->irq)
		free_irq(mrst->irq, mrst->rtc);

	rtc_device_unregister(mrst->rtc);
	mrst->rtc = NULL;

	iomem = mrst->iomem;
	release_mem_region(iomem->start, resource_size(iomem));
	mrst->iomem = NULL;

	mrst->dev = NULL;
	dev_set_drvdata(dev, NULL);
}

#ifdef	CONFIG_PM
static int mrst_suspend(struct device *dev, pm_message_t mesg)
{
	struct mrst_rtc	*mrst = dev_get_drvdata(dev);
	unsigned char	tmp;

	/* Only the alarm might be a wakeup event source */
	spin_lock_irq(&rtc_lock);
	mrst->suspend_ctrl = tmp = vrtc_cmos_read(RTC_CONTROL);
	if (tmp & (RTC_PIE | RTC_AIE)) {
		unsigned char	mask;

		if (device_may_wakeup(dev))
			mask = RTC_IRQMASK & ~RTC_AIE;
		else
			mask = RTC_IRQMASK;
		tmp &= ~mask;
		vrtc_cmos_write(tmp, RTC_CONTROL);

		mrst_checkintr(mrst, tmp);
	}
	spin_unlock_irq(&rtc_lock);

	if (tmp & RTC_AIE) {
		mrst->enabled_wake = 1;
		enable_irq_wake(mrst->irq);
	}

	dev_dbg(&mrst_rtc.rtc->dev, "suspend%s, ctrl %02x\n",
			(tmp & RTC_AIE) ? ", alarm may wake" : "",
			tmp);

	return 0;
}

/*
 * We want RTC alarms to wake us from the deep power saving state
 */
static inline int mrst_poweroff(struct device *dev)
{
	return mrst_suspend(dev, PMSG_HIBERNATE);
}

static int mrst_resume(struct device *dev)
{
	struct mrst_rtc	*mrst = dev_get_drvdata(dev);
	unsigned char tmp = mrst->suspend_ctrl;

	/* Re-enable any irqs previously active */
	if (tmp & RTC_IRQMASK) {
		unsigned char	mask;

		if (mrst->enabled_wake) {
			disable_irq_wake(mrst->irq);
			mrst->enabled_wake = 0;
		}

		spin_lock_irq(&rtc_lock);
		do {
			vrtc_cmos_write(tmp, RTC_CONTROL);

			mask = vrtc_cmos_read(RTC_INTR_FLAGS);
			mask &= (tmp & RTC_IRQMASK) | RTC_IRQF;
			if (!is_intr(mask))
				break;

			rtc_update_irq(mrst->rtc, 1, mask);
			tmp &= ~RTC_AIE;
		} while (mask & RTC_AIE);
		spin_unlock_irq(&rtc_lock);
	}

	dev_dbg(&mrst_rtc.rtc->dev, "resume, ctrl %02x\n", tmp);

	return 0;
}

#else
#define	mrst_suspend	NULL
#define	mrst_resume	NULL

static inline int mrst_poweroff(struct device *dev)
{
	return -ENOSYS;
}

#endif

static int vrtc_mrst_platform_probe(struct platform_device *pdev)
{
	return vrtc_mrst_do_probe(&pdev->dev,
			platform_get_resource(pdev, IORESOURCE_MEM, 0),
			platform_get_irq(pdev, 0));
}

static int vrtc_mrst_platform_remove(struct platform_device *pdev)
{
	rtc_mrst_do_remove(&pdev->dev);
	return 0;
}

static void vrtc_mrst_platform_shutdown(struct platform_device *pdev)
{
	if (system_state == SYSTEM_POWER_OFF && !mrst_poweroff(&pdev->dev))
		return;

	rtc_mrst_do_shutdown();
}

MODULE_ALIAS("platform:vrtc_mrst");

static struct platform_driver vrtc_mrst_platform_driver = {
	.probe		= vrtc_mrst_platform_probe,
	.remove		= vrtc_mrst_platform_remove,
	.shutdown	= vrtc_mrst_platform_shutdown,
	.driver = {
		.name		= (char *) driver_name,
		.suspend	= mrst_suspend,
		.resume		= mrst_resume,
	}
};

module_platform_driver(vrtc_mrst_platform_driver);

MODULE_AUTHOR("Jacob Pan; Feng Tang");
MODULE_DESCRIPTION("Driver for Moorestown virtual RTC");
MODULE_LICENSE("GPL");
Commit	Line	Data
0146f261 FT	1	/*
	2	* rtc-mrst.c: Driver for Moorestown virtual RTC
	3	*
	4	* (C) Copyright 2009 Intel Corporation
	5	* Author: Jacob Pan (jacob.jun.pan@intel.com)
	6	* Feng Tang (feng.tang@intel.com)
	7	*
	8	* This program is free software; you can redistribute it and/or
	9	* modify it under the terms of the GNU General Public License
	10	* as published by the Free Software Foundation; version 2
	11	* of the License.
	12	*
	13	* Note:
	14	* VRTC is emulated by system controller firmware, the real HW
	15	* RTC is located in the PMIC device. SCU FW shadows PMIC RTC
	16	* in a memory mapped IO space that is visible to the host IA
	17	* processor.
	18	*
	19	* This driver is based upon drivers/rtc/rtc-cmos.c
	20	*/
	21
	22	/*
	23	* Note:
	24	* * vRTC only supports binary mode and 24H mode
	25	* * vRTC only support PIE and AIE, no UIE, and its PIE only happens
	26	* at 23:59:59pm everyday, no support for adjustable frequency
	27	* * Alarm function is also limited to hr/min/sec.
	28	*/
	29
	30	#include <linux/mod_devicetable.h>
	31	#include <linux/platform_device.h>
	32	#include <linux/interrupt.h>
	33	#include <linux/spinlock.h>
	34	#include <linux/kernel.h>
	35	#include <linux/module.h>
	36	#include <linux/init.h>
	37	#include <linux/sfi.h>
	38
	39	#include <asm-generic/rtc.h>
	40	#include <asm/intel_scu_ipc.h>
	41	#include <asm/mrst.h>
	42	#include <asm/mrst-vrtc.h>
	43
	44	struct mrst_rtc {
	45	struct rtc_device *rtc;
	46	struct device *dev;
	47	int irq;
	48	struct resource *iomem;
	49
	50	u8 enabled_wake;
	51	u8 suspend_ctrl;
	52	};
	53
	54	static const char driver_name[] = "rtc_mrst";
	55
	56	#define RTC_IRQMASK (RTC_PF \| RTC_AF)
	57
	58	static inline int is_intr(u8 rtc_intr)
	59	{
	60	if (!(rtc_intr & RTC_IRQF))
	61	return 0;
	62	return rtc_intr & RTC_IRQMASK;
	63	}
	64
168202c7 FT	65	static inline unsigned char vrtc_is_updating(void)
	66	{
	67	unsigned char uip;
	68	unsigned long flags;
	69
	70	spin_lock_irqsave(&rtc_lock, flags);
	71	uip = (vrtc_cmos_read(RTC_FREQ_SELECT) & RTC_UIP);
	72	spin_unlock_irqrestore(&rtc_lock, flags);
	73	return uip;
	74	}
	75
0146f261 FT	76	/*
	77	* rtc_time's year contains the increment over 1900, but vRTC's YEAR
	78	* register can't be programmed to value larger than 0x64, so vRTC
57e6319d	79	* driver chose to use 1972 (1970 is UNIX time start point) as the base,
d3e1884b FT	80	* and does the translation at read/write time.
d3e1884b FT	81	*
57e6319d	82	* Why not just use 1970 as the offset? it's because using 1972 will
d3e1884b	83	* make it consistent in leap year setting for both vrtc and low-level
57e6319d FT	84	* physical rtc devices. Then why not use 1960 as the offset? If we use
	85	* 1960, for a device's first use, its YEAR register is 0 and the system
	86	* year will be parsed as 1960 which is not a valid UNIX time and will
	87	* cause many applications to fail mysteriously.
0146f261 FT	88	*/
	89	static int mrst_read_time(struct device dev, struct rtc_time time)
	90	{
	91	unsigned long flags;
	92
168202c7	93	if (vrtc_is_updating())
0146f261 FT	94	mdelay(20);
	95
	96	spin_lock_irqsave(&rtc_lock, flags);
	97	time->tm_sec = vrtc_cmos_read(RTC_SECONDS);
	98	time->tm_min = vrtc_cmos_read(RTC_MINUTES);
	99	time->tm_hour = vrtc_cmos_read(RTC_HOURS);
	100	time->tm_mday = vrtc_cmos_read(RTC_DAY_OF_MONTH);
	101	time->tm_mon = vrtc_cmos_read(RTC_MONTH);
	102	time->tm_year = vrtc_cmos_read(RTC_YEAR);
	103	spin_unlock_irqrestore(&rtc_lock, flags);
	104
57e6319d FT	105	/* Adjust for the 1972/1900 */
57e6319d FT	106	time->tm_year += 72;
0146f261	107	time->tm_mon--;
57e6319d	108	return rtc_valid_tm(time);
0146f261 FT	109	}
	110
	111	static int mrst_set_time(struct device dev, struct rtc_time time)
	112	{
	113	int ret;
	114	unsigned long flags;
	115	unsigned char mon, day, hrs, min, sec;
	116	unsigned int yrs;
	117
	118	yrs = time->tm_year;
	119	mon = time->tm_mon + 1; /* tm_mon starts at zero */
	120	day = time->tm_mday;
	121	hrs = time->tm_hour;
	122	min = time->tm_min;
	123	sec = time->tm_sec;
	124
57e6319d	125	if (yrs < 72 \|\| yrs > 138)
0146f261	126	return -EINVAL;
57e6319d	127	yrs -= 72;
0146f261 FT	128
	129	spin_lock_irqsave(&rtc_lock, flags);
	130
	131	vrtc_cmos_write(yrs, RTC_YEAR);
	132	vrtc_cmos_write(mon, RTC_MONTH);
	133	vrtc_cmos_write(day, RTC_DAY_OF_MONTH);
	134	vrtc_cmos_write(hrs, RTC_HOURS);
	135	vrtc_cmos_write(min, RTC_MINUTES);
	136	vrtc_cmos_write(sec, RTC_SECONDS);
	137
	138	spin_unlock_irqrestore(&rtc_lock, flags);
	139
	140	ret = intel_scu_ipc_simple_command(IPCMSG_VRTC, IPC_CMD_VRTC_SETTIME);
	141	return ret;
	142	}
	143
	144	static int mrst_read_alarm(struct device dev, struct rtc_wkalrm t)
	145	{
	146	struct mrst_rtc *mrst = dev_get_drvdata(dev);
	147	unsigned char rtc_control;
	148
	149	if (mrst->irq <= 0)
	150	return -EIO;
	151
	152	/* Basic alarms only support hour, minute, and seconds fields.
	153	* Some also support day and month, for alarms up to a year in
	154	* the future.
	155	*/
	156	t->time.tm_mday = -1;
	157	t->time.tm_mon = -1;
	158	t->time.tm_year = -1;
	159
	160	/* vRTC only supports binary mode */
	161	spin_lock_irq(&rtc_lock);
	162	t->time.tm_sec = vrtc_cmos_read(RTC_SECONDS_ALARM);
	163	t->time.tm_min = vrtc_cmos_read(RTC_MINUTES_ALARM);
	164	t->time.tm_hour = vrtc_cmos_read(RTC_HOURS_ALARM);
	165
	166	rtc_control = vrtc_cmos_read(RTC_CONTROL);
	167	spin_unlock_irq(&rtc_lock);
	168
	169	t->enabled = !!(rtc_control & RTC_AIE);
	170	t->pending = 0;
	171
	172	return 0;
	173	}
	174
	175	static void mrst_checkintr(struct mrst_rtc *mrst, unsigned char rtc_control)
	176	{
	177	unsigned char rtc_intr;
	178
	179	/*
	180	* NOTE after changing RTC_xIE bits we always read INTR_FLAGS;
	181	* allegedly some older rtcs need that to handle irqs properly
	182	*/
	183	rtc_intr = vrtc_cmos_read(RTC_INTR_FLAGS);
	184	rtc_intr &= (rtc_control & RTC_IRQMASK) \| RTC_IRQF;
	185	if (is_intr(rtc_intr))
	186	rtc_update_irq(mrst->rtc, 1, rtc_intr);
	187	}
	188
	189	static void mrst_irq_enable(struct mrst_rtc *mrst, unsigned char mask)
	190	{
	191	unsigned char rtc_control;
192
193	/*
194	* Flush any pending IRQ status, notably for update irqs,
195	* before we enable new IRQs
196	*/
197	rtc_control = vrtc_cmos_read(RTC_CONTROL);
198	mrst_checkintr(mrst, rtc_control);
199
200	rtc_control \|= mask;
201	vrtc_cmos_write(rtc_control, RTC_CONTROL);
202
203	mrst_checkintr(mrst, rtc_control);
204	}
205
206	static void mrst_irq_disable(struct mrst_rtc *mrst, unsigned char mask)
207	{
208	unsigned char rtc_control;
209
210	rtc_control = vrtc_cmos_read(RTC_CONTROL);
211	rtc_control &= ~mask;
212	vrtc_cmos_write(rtc_control, RTC_CONTROL);
213	mrst_checkintr(mrst, rtc_control);
214	}
215
216	static int mrst_set_alarm(struct device dev, struct rtc_wkalrm t)
217	{
218	struct mrst_rtc *mrst = dev_get_drvdata(dev);
219	unsigned char hrs, min, sec;
220	int ret = 0;
221
222	if (!mrst->irq)
223	return -EIO;
224
225	hrs = t->time.tm_hour;
226	min = t->time.tm_min;
227	sec = t->time.tm_sec;
228
229	spin_lock_irq(&rtc_lock);
230	/* Next rtc irq must not be from previous alarm setting */
231	mrst_irq_disable(mrst, RTC_AIE);
232
233	/* Update alarm */
234	vrtc_cmos_write(hrs, RTC_HOURS_ALARM);
235	vrtc_cmos_write(min, RTC_MINUTES_ALARM);
236	vrtc_cmos_write(sec, RTC_SECONDS_ALARM);
237
238	spin_unlock_irq(&rtc_lock);
239
240	ret = intel_scu_ipc_simple_command(IPCMSG_VRTC, IPC_CMD_VRTC_SETALARM);
241	if (ret)
242	return ret;
243
244	spin_lock_irq(&rtc_lock);
245	if (t->enabled)
246	mrst_irq_enable(mrst, RTC_AIE);
247
248	spin_unlock_irq(&rtc_lock);
249
250	return 0;
251	}
252
0146f261	253	/* Currently, the vRTC doesn't support UIE ON/OFF */
16380c15	254	static int mrst_rtc_alarm_irq_enable(struct device *dev, unsigned int enabled)
0146f261 FT	255	{
	256	struct mrst_rtc *mrst = dev_get_drvdata(dev);
	257	unsigned long flags;
	258
0146f261	259	spin_lock_irqsave(&rtc_lock, flags);
16380c15	260	if (enabled)
0146f261	261	mrst_irq_enable(mrst, RTC_AIE);
16380c15 JS	262	else
16380c15 JS	263	mrst_irq_disable(mrst, RTC_AIE);
0146f261 FT	264	spin_unlock_irqrestore(&rtc_lock, flags);
	265	return 0;
	266	}
	267
0146f261 FT	268
	269	#if defined(CONFIG_RTC_INTF_PROC) \|\| defined(CONFIG_RTC_INTF_PROC_MODULE)
	270
	271	static int mrst_procfs(struct device dev, struct seq_file seq)
	272	{
	273	unsigned char rtc_control, valid;
	274
	275	spin_lock_irq(&rtc_lock);
	276	rtc_control = vrtc_cmos_read(RTC_CONTROL);
	277	valid = vrtc_cmos_read(RTC_VALID);
	278	spin_unlock_irq(&rtc_lock);
	279
	280	return seq_printf(seq,
	281	"periodic_IRQ\t: %s\n"
	282	"alarm\t\t: %s\n"
	283	"BCD\t\t: no\n"
	284	"periodic_freq\t: daily (not adjustable)\n",
	285	(rtc_control & RTC_PIE) ? "on" : "off",
	286	(rtc_control & RTC_AIE) ? "on" : "off");
	287	}
	288
	289	#else
	290	#define mrst_procfs NULL
	291	#endif
	292
	293	static const struct rtc_class_ops mrst_rtc_ops = {
0146f261 FT	294	.read_time = mrst_read_time,
	295	.set_time = mrst_set_time,
	296	.read_alarm = mrst_read_alarm,
	297	.set_alarm = mrst_set_alarm,
	298	.proc = mrst_procfs,
16380c15	299	.alarm_irq_enable = mrst_rtc_alarm_irq_enable,
0146f261 FT	300	};
	301
	302	static struct mrst_rtc mrst_rtc;
	303
	304	/*
	305	* When vRTC IRQ is captured by SCU FW, FW will clear the AIE bit in
	306	* Reg B, so no need for this driver to clear it
	307	*/
	308	static irqreturn_t mrst_rtc_irq(int irq, void *p)
	309	{
	310	u8 irqstat;
	311
	312	spin_lock(&rtc_lock);
	313	/* This read will clear all IRQ flags inside Reg C */
	314	irqstat = vrtc_cmos_read(RTC_INTR_FLAGS);
	315	spin_unlock(&rtc_lock);
	316
	317	irqstat &= RTC_IRQMASK \| RTC_IRQF;
	318	if (is_intr(irqstat)) {
	319	rtc_update_irq(p, 1, irqstat);
	320	return IRQ_HANDLED;
	321	}
	322	return IRQ_NONE;
	323	}
	324
5a167f45 GKH	325	static int vrtc_mrst_do_probe(struct device dev, struct resource iomem,
5a167f45 GKH	326	int rtc_irq)
0146f261 FT	327	{
	328	int retval = 0;
	329	unsigned char rtc_control;
	330
	331	/* There can be only one ... */
	332	if (mrst_rtc.dev)
	333	return -EBUSY;
	334
	335	if (!iomem)
	336	return -ENODEV;
	337
28f65c11 JP	338	iomem = request_mem_region(iomem->start, resource_size(iomem),
28f65c11 JP	339	driver_name);
0146f261 FT	340	if (!iomem) {
	341	dev_dbg(dev, "i/o mem already in use.\n");
	342	return -EBUSY;
	343	}
	344
	345	mrst_rtc.irq = rtc_irq;
	346	mrst_rtc.iomem = iomem;
de97a21a FT	347	mrst_rtc.dev = dev;
de97a21a FT	348	dev_set_drvdata(dev, &mrst_rtc);
0146f261 FT	349
	350	mrst_rtc.rtc = rtc_device_register(driver_name, dev,
	351	&mrst_rtc_ops, THIS_MODULE);
	352	if (IS_ERR(mrst_rtc.rtc)) {
	353	retval = PTR_ERR(mrst_rtc.rtc);
	354	goto cleanup0;
	355	}
	356
0146f261 FT	357	rename_region(iomem, dev_name(&mrst_rtc.rtc->dev));
	358
	359	spin_lock_irq(&rtc_lock);
	360	mrst_irq_disable(&mrst_rtc, RTC_PIE \| RTC_AIE);
	361	rtc_control = vrtc_cmos_read(RTC_CONTROL);
	362	spin_unlock_irq(&rtc_lock);
	363
	364	if (!(rtc_control & RTC_24H) \|\| (rtc_control & (RTC_DM_BINARY)))
	365	dev_dbg(dev, "TODO: support more than 24-hr BCD mode\n");
	366
	367	if (rtc_irq) {
	368	retval = request_irq(rtc_irq, mrst_rtc_irq,
2f6e5f94	369	0, dev_name(&mrst_rtc.rtc->dev),
0146f261 FT	370	mrst_rtc.rtc);
	371	if (retval < 0) {
	372	dev_dbg(dev, "IRQ %d is already in use, err %d\n",
	373	rtc_irq, retval);
	374	goto cleanup1;
	375	}
	376	}
	377	dev_dbg(dev, "initialised\n");
	378	return 0;
	379
	380	cleanup1:
0146f261 FT	381	rtc_device_unregister(mrst_rtc.rtc);
0146f261 FT	382	cleanup0:
de97a21a FT	383	dev_set_drvdata(dev, NULL);
de97a21a FT	384	mrst_rtc.dev = NULL;
c258f9a0	385	release_mem_region(iomem->start, resource_size(iomem));
0146f261 FT	386	dev_err(dev, "rtc-mrst: unable to initialise\n");
	387	return retval;
	388	}
	389
	390	static void rtc_mrst_do_shutdown(void)
	391	{
	392	spin_lock_irq(&rtc_lock);
	393	mrst_irq_disable(&mrst_rtc, RTC_IRQMASK);
	394	spin_unlock_irq(&rtc_lock);
	395	}
	396
5a167f45	397	static void rtc_mrst_do_remove(struct device *dev)
0146f261 FT	398	{
	399	struct mrst_rtc *mrst = dev_get_drvdata(dev);
	400	struct resource *iomem;
	401
	402	rtc_mrst_do_shutdown();
	403
	404	if (mrst->irq)
	405	free_irq(mrst->irq, mrst->rtc);
	406
	407	rtc_device_unregister(mrst->rtc);
	408	mrst->rtc = NULL;
	409
	410	iomem = mrst->iomem;
c258f9a0	411	release_mem_region(iomem->start, resource_size(iomem));
0146f261 FT	412	mrst->iomem = NULL;
	413
	414	mrst->dev = NULL;
	415	dev_set_drvdata(dev, NULL);
	416	}
	417
	418	#ifdef CONFIG_PM
	419	static int mrst_suspend(struct device *dev, pm_message_t mesg)
	420	{
	421	struct mrst_rtc *mrst = dev_get_drvdata(dev);
	422	unsigned char tmp;
	423
	424	/* Only the alarm might be a wakeup event source */
	425	spin_lock_irq(&rtc_lock);
	426	mrst->suspend_ctrl = tmp = vrtc_cmos_read(RTC_CONTROL);
	427	if (tmp & (RTC_PIE \| RTC_AIE)) {
	428	unsigned char mask;
	429
	430	if (device_may_wakeup(dev))
	431	mask = RTC_IRQMASK & ~RTC_AIE;
	432	else
	433	mask = RTC_IRQMASK;
	434	tmp &= ~mask;
	435	vrtc_cmos_write(tmp, RTC_CONTROL);
	436
	437	mrst_checkintr(mrst, tmp);
	438	}
	439	spin_unlock_irq(&rtc_lock);
	440
	441	if (tmp & RTC_AIE) {
	442	mrst->enabled_wake = 1;
	443	enable_irq_wake(mrst->irq);
	444	}
	445
	446	dev_dbg(&mrst_rtc.rtc->dev, "suspend%s, ctrl %02x\n",
	447	(tmp & RTC_AIE) ? ", alarm may wake" : "",
	448	tmp);
	449
	450	return 0;
	451	}
	452
	453	/*
	454	* We want RTC alarms to wake us from the deep power saving state
	455	*/
	456	static inline int mrst_poweroff(struct device *dev)
	457	{
	458	return mrst_suspend(dev, PMSG_HIBERNATE);
	459	}
	460
	461	static int mrst_resume(struct device *dev)
	462	{
	463	struct mrst_rtc *mrst = dev_get_drvdata(dev);
	464	unsigned char tmp = mrst->suspend_ctrl;
	465
	466	/* Re-enable any irqs previously active */
	467	if (tmp & RTC_IRQMASK) {
	468	unsigned char mask;
	469
	470	if (mrst->enabled_wake) {
	471	disable_irq_wake(mrst->irq);
	472	mrst->enabled_wake = 0;
	473	}
	474
	475	spin_lock_irq(&rtc_lock);
476	do {
477	vrtc_cmos_write(tmp, RTC_CONTROL);
478
479	mask = vrtc_cmos_read(RTC_INTR_FLAGS);
480	mask &= (tmp & RTC_IRQMASK) \| RTC_IRQF;
481	if (!is_intr(mask))
482	break;
483
484	rtc_update_irq(mrst->rtc, 1, mask);
485	tmp &= ~RTC_AIE;
486	} while (mask & RTC_AIE);
487	spin_unlock_irq(&rtc_lock);
488	}
489
490	dev_dbg(&mrst_rtc.rtc->dev, "resume, ctrl %02x\n", tmp);
491
492	return 0;
493	}
494
495	#else
496	#define mrst_suspend NULL
497	#define mrst_resume NULL
498
499	static inline int mrst_poweroff(struct device *dev)
500	{
501	return -ENOSYS;
502	}
503
504	#endif
505
5a167f45	506	static int vrtc_mrst_platform_probe(struct platform_device *pdev)
0146f261 FT	507	{
	508	return vrtc_mrst_do_probe(&pdev->dev,
	509	platform_get_resource(pdev, IORESOURCE_MEM, 0),
	510	platform_get_irq(pdev, 0));
	511	}
	512
5a167f45	513	static int vrtc_mrst_platform_remove(struct platform_device *pdev)
0146f261 FT	514	{
	515	rtc_mrst_do_remove(&pdev->dev);
	516	return 0;
	517	}
	518
	519	static void vrtc_mrst_platform_shutdown(struct platform_device *pdev)
	520	{
	521	if (system_state == SYSTEM_POWER_OFF && !mrst_poweroff(&pdev->dev))
	522	return;
	523
	524	rtc_mrst_do_shutdown();
	525	}
	526
	527	MODULE_ALIAS("platform:vrtc_mrst");
	528
	529	static struct platform_driver vrtc_mrst_platform_driver = {
	530	.probe = vrtc_mrst_platform_probe,
5a167f45	531	.remove = vrtc_mrst_platform_remove,
0146f261 FT	532	.shutdown = vrtc_mrst_platform_shutdown,
	533	.driver = {
	534	.name = (char *) driver_name,
	535	.suspend = mrst_suspend,
	536	.resume = mrst_resume,
	537	}
	538	};
	539
0c4eae66	540	module_platform_driver(vrtc_mrst_platform_driver);
0146f261 FT	541
	542	MODULE_AUTHOR("Jacob Pan; Feng Tang");
	543	MODULE_DESCRIPTION("Driver for Moorestown virtual RTC");
	544	MODULE_LICENSE("GPL");