[linux-2.6-block.git] / drivers / rtc / rtc-ls1x.c

/*
 * Copyright (c) 2011 Zhao Zhang <zhzhl555@gmail.com>
 *
 * Derived from driver/rtc/rtc-au1xxx.c
 *
 * 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.
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/rtc.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/delay.h>
#include <linux/types.h>
#include <linux/io.h>
#include <loongson1.h>

#define LS1X_RTC_REG_OFFSET	(LS1X_RTC_BASE + 0x20)
#define LS1X_RTC_REGS(x) \
		((void __iomem *)KSEG1ADDR(LS1X_RTC_REG_OFFSET + (x)))

/*RTC programmable counters 0 and 1*/
#define SYS_COUNTER_CNTRL		(LS1X_RTC_REGS(0x20))
#define SYS_CNTRL_ERS			(1 << 23)
#define SYS_CNTRL_RTS			(1 << 20)
#define SYS_CNTRL_RM2			(1 << 19)
#define SYS_CNTRL_RM1			(1 << 18)
#define SYS_CNTRL_RM0			(1 << 17)
#define SYS_CNTRL_RS			(1 << 16)
#define SYS_CNTRL_BP			(1 << 14)
#define SYS_CNTRL_REN			(1 << 13)
#define SYS_CNTRL_BRT			(1 << 12)
#define SYS_CNTRL_TEN			(1 << 11)
#define SYS_CNTRL_BTT			(1 << 10)
#define SYS_CNTRL_E0			(1 << 8)
#define SYS_CNTRL_ETS			(1 << 7)
#define SYS_CNTRL_32S			(1 << 5)
#define SYS_CNTRL_TTS			(1 << 4)
#define SYS_CNTRL_TM2			(1 << 3)
#define SYS_CNTRL_TM1			(1 << 2)
#define SYS_CNTRL_TM0			(1 << 1)
#define SYS_CNTRL_TS			(1 << 0)

/* Programmable Counter 0 Registers */
#define SYS_TOYTRIM		(LS1X_RTC_REGS(0))
#define SYS_TOYWRITE0		(LS1X_RTC_REGS(4))
#define SYS_TOYWRITE1		(LS1X_RTC_REGS(8))
#define SYS_TOYREAD0		(LS1X_RTC_REGS(0xC))
#define SYS_TOYREAD1		(LS1X_RTC_REGS(0x10))
#define SYS_TOYMATCH0		(LS1X_RTC_REGS(0x14))
#define SYS_TOYMATCH1		(LS1X_RTC_REGS(0x18))
#define SYS_TOYMATCH2		(LS1X_RTC_REGS(0x1C))

/* Programmable Counter 1 Registers */
#define SYS_RTCTRIM		(LS1X_RTC_REGS(0x40))
#define SYS_RTCWRITE0		(LS1X_RTC_REGS(0x44))
#define SYS_RTCREAD0		(LS1X_RTC_REGS(0x48))
#define SYS_RTCMATCH0		(LS1X_RTC_REGS(0x4C))
#define SYS_RTCMATCH1		(LS1X_RTC_REGS(0x50))
#define SYS_RTCMATCH2		(LS1X_RTC_REGS(0x54))

#define LS1X_SEC_OFFSET		(4)
#define LS1X_MIN_OFFSET		(10)
#define LS1X_HOUR_OFFSET	(16)
#define LS1X_DAY_OFFSET		(21)
#define LS1X_MONTH_OFFSET	(26)


#define LS1X_SEC_MASK		(0x3f)
#define LS1X_MIN_MASK		(0x3f)
#define LS1X_HOUR_MASK		(0x1f)
#define LS1X_DAY_MASK		(0x1f)
#define LS1X_MONTH_MASK		(0x3f)
#define LS1X_YEAR_MASK		(0xffffffff)

#define ls1x_get_sec(t)		(((t) >> LS1X_SEC_OFFSET) & LS1X_SEC_MASK)
#define ls1x_get_min(t)		(((t) >> LS1X_MIN_OFFSET) & LS1X_MIN_MASK)
#define ls1x_get_hour(t)	(((t) >> LS1X_HOUR_OFFSET) & LS1X_HOUR_MASK)
#define ls1x_get_day(t)		(((t) >> LS1X_DAY_OFFSET) & LS1X_DAY_MASK)
#define ls1x_get_month(t)	(((t) >> LS1X_MONTH_OFFSET) & LS1X_MONTH_MASK)

#define RTC_CNTR_OK (SYS_CNTRL_E0 | SYS_CNTRL_32S)

static int ls1x_rtc_read_time(struct device *dev, struct rtc_time *rtm)
{
	unsigned long v;
	time64_t t;

	v = readl(SYS_TOYREAD0);
	t = readl(SYS_TOYREAD1);

	memset(rtm, 0, sizeof(struct rtc_time));
	t  = mktime64((t & LS1X_YEAR_MASK), ls1x_get_month(v),
			ls1x_get_day(v), ls1x_get_hour(v),
			ls1x_get_min(v), ls1x_get_sec(v));
	rtc_time64_to_tm(t, rtm);

	return 0;
}

static int ls1x_rtc_set_time(struct device *dev, struct  rtc_time *rtm)
{
	unsigned long v, t, c;
	int ret = -ETIMEDOUT;

	v = ((rtm->tm_mon + 1)  << LS1X_MONTH_OFFSET)
		| (rtm->tm_mday << LS1X_DAY_OFFSET)
		| (rtm->tm_hour << LS1X_HOUR_OFFSET)
		| (rtm->tm_min  << LS1X_MIN_OFFSET)
		| (rtm->tm_sec  << LS1X_SEC_OFFSET);

	writel(v, SYS_TOYWRITE0);
	c = 0x10000;
	/* add timeout check counter, for more safe */
	while ((readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_TS) && --c)
		usleep_range(1000, 3000);

	if (!c) {
		dev_err(dev, "set time timeout!\n");
		goto err;
	}

	t = rtm->tm_year + 1900;
	writel(t, SYS_TOYWRITE1);
	c = 0x10000;
	while ((readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_TS) && --c)
		usleep_range(1000, 3000);

	if (!c) {
		dev_err(dev, "set time timeout!\n");
		goto err;
	}
	return 0;
err:
	return ret;
}

static const struct rtc_class_ops  ls1x_rtc_ops = {
	.read_time	= ls1x_rtc_read_time,
	.set_time	= ls1x_rtc_set_time,
};

static int ls1x_rtc_probe(struct platform_device *pdev)
{
	struct rtc_device *rtcdev;
	unsigned long v;

	v = readl(SYS_COUNTER_CNTRL);
	if (!(v & RTC_CNTR_OK)) {
		dev_err(&pdev->dev, "rtc counters not working\n");
		return -ENODEV;
	}

	/* set to 1 HZ if needed */
	if (readl(SYS_TOYTRIM) != 32767) {
		v = 0x100000;
		while ((readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_TTS) && --v)
			usleep_range(1000, 3000);

		if (!v) {
			dev_err(&pdev->dev, "time out\n");
			return -ETIMEDOUT;
		}
		writel(32767, SYS_TOYTRIM);
	}
	/* this loop coundn't be endless */
	while (readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_TTS)
		usleep_range(1000, 3000);

	rtcdev = devm_rtc_allocate_device(&pdev->dev);
	if (IS_ERR(rtcdev))
		return PTR_ERR(rtcdev);

	platform_set_drvdata(pdev, rtcdev);
	rtcdev->ops = &ls1x_rtc_ops;
	rtcdev->range_min = RTC_TIMESTAMP_BEGIN_1900;
	rtcdev->range_max = RTC_TIMESTAMP_END_2099;

	return rtc_register_device(rtcdev);
}

static struct platform_driver  ls1x_rtc_driver = {
	.driver		= {
		.name	= "ls1x-rtc",
	},
	.probe		= ls1x_rtc_probe,
};

module_platform_driver(ls1x_rtc_driver);

MODULE_AUTHOR("zhao zhang <zhzhl555@gmail.com>");
MODULE_LICENSE("GPL");
Commit	Line	Data
b4f0b880	1	/*
	2	* Copyright (c) 2011 Zhao Zhang <zhzhl555@gmail.com>
	3	*
	4	* Derived from driver/rtc/rtc-au1xxx.c
	5	*
	6	* This program is free software; you can redistribute it and/or modify it
	7	* under the terms of the GNU General Public License as published by the
	8	* Free Software Foundation; either version 2 of the License, or (at your
	9	* option) any later version.
	10	*/
	11
	12	#include <linux/module.h>
	13	#include <linux/kernel.h>
	14	#include <linux/rtc.h>
	15	#include <linux/init.h>
	16	#include <linux/platform_device.h>
	17	#include <linux/delay.h>
	18	#include <linux/types.h>
	19	#include <linux/io.h>
30ad29bb	20	#include <loongson1.h>
b4f0b880	21
	22	#define LS1X_RTC_REG_OFFSET (LS1X_RTC_BASE + 0x20)
	23	#define LS1X_RTC_REGS(x) \
	24	((void __iomem *)KSEG1ADDR(LS1X_RTC_REG_OFFSET + (x)))
	25
	26	/RTC programmable counters 0 and 1/
	27	#define SYS_COUNTER_CNTRL (LS1X_RTC_REGS(0x20))
	28	#define SYS_CNTRL_ERS (1 << 23)
	29	#define SYS_CNTRL_RTS (1 << 20)
	30	#define SYS_CNTRL_RM2 (1 << 19)
	31	#define SYS_CNTRL_RM1 (1 << 18)
	32	#define SYS_CNTRL_RM0 (1 << 17)
	33	#define SYS_CNTRL_RS (1 << 16)
	34	#define SYS_CNTRL_BP (1 << 14)
	35	#define SYS_CNTRL_REN (1 << 13)
	36	#define SYS_CNTRL_BRT (1 << 12)
	37	#define SYS_CNTRL_TEN (1 << 11)
	38	#define SYS_CNTRL_BTT (1 << 10)
	39	#define SYS_CNTRL_E0 (1 << 8)
	40	#define SYS_CNTRL_ETS (1 << 7)
	41	#define SYS_CNTRL_32S (1 << 5)
	42	#define SYS_CNTRL_TTS (1 << 4)
	43	#define SYS_CNTRL_TM2 (1 << 3)
	44	#define SYS_CNTRL_TM1 (1 << 2)
	45	#define SYS_CNTRL_TM0 (1 << 1)
	46	#define SYS_CNTRL_TS (1 << 0)
	47
	48	/* Programmable Counter 0 Registers */
	49	#define SYS_TOYTRIM (LS1X_RTC_REGS(0))
	50	#define SYS_TOYWRITE0 (LS1X_RTC_REGS(4))
	51	#define SYS_TOYWRITE1 (LS1X_RTC_REGS(8))
	52	#define SYS_TOYREAD0 (LS1X_RTC_REGS(0xC))
	53	#define SYS_TOYREAD1 (LS1X_RTC_REGS(0x10))
	54	#define SYS_TOYMATCH0 (LS1X_RTC_REGS(0x14))
	55	#define SYS_TOYMATCH1 (LS1X_RTC_REGS(0x18))
	56	#define SYS_TOYMATCH2 (LS1X_RTC_REGS(0x1C))
	57
	58	/* Programmable Counter 1 Registers */
	59	#define SYS_RTCTRIM (LS1X_RTC_REGS(0x40))
	60	#define SYS_RTCWRITE0 (LS1X_RTC_REGS(0x44))
	61	#define SYS_RTCREAD0 (LS1X_RTC_REGS(0x48))
	62	#define SYS_RTCMATCH0 (LS1X_RTC_REGS(0x4C))
	63	#define SYS_RTCMATCH1 (LS1X_RTC_REGS(0x50))
	64	#define SYS_RTCMATCH2 (LS1X_RTC_REGS(0x54))
	65
	66	#define LS1X_SEC_OFFSET (4)
	67	#define LS1X_MIN_OFFSET (10)
	68	#define LS1X_HOUR_OFFSET (16)
	69	#define LS1X_DAY_OFFSET (21)
	70	#define LS1X_MONTH_OFFSET (26)
	71
	72
	73	#define LS1X_SEC_MASK (0x3f)
	74	#define LS1X_MIN_MASK (0x3f)
	75	#define LS1X_HOUR_MASK (0x1f)
	76	#define LS1X_DAY_MASK (0x1f)
	77	#define LS1X_MONTH_MASK (0x3f)
	78	#define LS1X_YEAR_MASK (0xffffffff)
	79
	80	#define ls1x_get_sec(t) (((t) >> LS1X_SEC_OFFSET) & LS1X_SEC_MASK)
	81	#define ls1x_get_min(t) (((t) >> LS1X_MIN_OFFSET) & LS1X_MIN_MASK)
	82	#define ls1x_get_hour(t) (((t) >> LS1X_HOUR_OFFSET) & LS1X_HOUR_MASK)
	83	#define ls1x_get_day(t) (((t) >> LS1X_DAY_OFFSET) & LS1X_DAY_MASK)
	84	#define ls1x_get_month(t) (((t) >> LS1X_MONTH_OFFSET) & LS1X_MONTH_MASK)
85
86	#define RTC_CNTR_OK (SYS_CNTRL_E0 \| SYS_CNTRL_32S)
87
88	static int ls1x_rtc_read_time(struct device dev, struct rtc_time rtm)
89	{
337fa19c AB	90	unsigned long v;
337fa19c AB	91	time64_t t;
b4f0b880	92
	93	v = readl(SYS_TOYREAD0);
	94	t = readl(SYS_TOYREAD1);
	95
	96	memset(rtm, 0, sizeof(struct rtc_time));
337fa19c	97	t = mktime64((t & LS1X_YEAR_MASK), ls1x_get_month(v),
b4f0b880	98	ls1x_get_day(v), ls1x_get_hour(v),
b4f0b880	99	ls1x_get_min(v), ls1x_get_sec(v));
337fa19c	100	rtc_time64_to_tm(t, rtm);
b4f0b880	101
ab62670e	102	return 0;
b4f0b880	103	}
	104
	105	static int ls1x_rtc_set_time(struct device dev, struct rtc_time rtm)
	106	{
	107	unsigned long v, t, c;
	108	int ret = -ETIMEDOUT;
	109
	110	v = ((rtm->tm_mon + 1) << LS1X_MONTH_OFFSET)
	111	\| (rtm->tm_mday << LS1X_DAY_OFFSET)
	112	\| (rtm->tm_hour << LS1X_HOUR_OFFSET)
	113	\| (rtm->tm_min << LS1X_MIN_OFFSET)
	114	\| (rtm->tm_sec << LS1X_SEC_OFFSET);
	115
	116	writel(v, SYS_TOYWRITE0);
	117	c = 0x10000;
	118	/* add timeout check counter, for more safe */
	119	while ((readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_TS) && --c)
	120	usleep_range(1000, 3000);
	121
	122	if (!c) {
	123	dev_err(dev, "set time timeout!\n");
	124	goto err;
	125	}
	126
	127	t = rtm->tm_year + 1900;
	128	writel(t, SYS_TOYWRITE1);
	129	c = 0x10000;
	130	while ((readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_TS) && --c)
	131	usleep_range(1000, 3000);
	132
	133	if (!c) {
	134	dev_err(dev, "set time timeout!\n");
	135	goto err;
	136	}
	137	return 0;
	138	err:
	139	return ret;
	140	}
	141
8bc57e7f	142	static const struct rtc_class_ops ls1x_rtc_ops = {
b4f0b880	143	.read_time = ls1x_rtc_read_time,
	144	.set_time = ls1x_rtc_set_time,
	145	};
	146
5a167f45	147	static int ls1x_rtc_probe(struct platform_device *pdev)
b4f0b880	148	{
	149	struct rtc_device *rtcdev;
	150	unsigned long v;
b4f0b880	151
	152	v = readl(SYS_COUNTER_CNTRL);
	153	if (!(v & RTC_CNTR_OK)) {
	154	dev_err(&pdev->dev, "rtc counters not working\n");
14dc3ec5	155	return -ENODEV;
b4f0b880	156	}
14dc3ec5	157
b4f0b880	158	/* set to 1 HZ if needed */
	159	if (readl(SYS_TOYTRIM) != 32767) {
	160	v = 0x100000;
	161	while ((readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_TTS) && --v)
	162	usleep_range(1000, 3000);
	163
	164	if (!v) {
	165	dev_err(&pdev->dev, "time out\n");
14dc3ec5	166	return -ETIMEDOUT;
b4f0b880	167	}
	168	writel(32767, SYS_TOYTRIM);
	169	}
	170	/* this loop coundn't be endless */
	171	while (readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_TTS)
	172	usleep_range(1000, 3000);
	173
52f0e7bc AB	174	rtcdev = devm_rtc_allocate_device(&pdev->dev);
	175	if (IS_ERR(rtcdev))
	176	return PTR_ERR(rtcdev);
b4f0b880	177
b4f0b880	178	platform_set_drvdata(pdev, rtcdev);
52f0e7bc	179	rtcdev->ops = &ls1x_rtc_ops;
d7599245 AB	180	rtcdev->range_min = RTC_TIMESTAMP_BEGIN_1900;
d7599245 AB	181	rtcdev->range_max = RTC_TIMESTAMP_END_2099;
52f0e7bc AB	182
52f0e7bc AB	183	return rtc_register_device(rtcdev);
b4f0b880	184	}
b4f0b880	185
b4f0b880	186	static struct platform_driver ls1x_rtc_driver = {
	187	.driver = {
	188	.name = "ls1x-rtc",
b4f0b880	189	},
b4f0b880	190	.probe = ls1x_rtc_probe,
	191	};
	192
	193	module_platform_driver(ls1x_rtc_driver);
	194
	195	MODULE_AUTHOR("zhao zhang <zhzhl555@gmail.com>");
	196	MODULE_LICENSE("GPL");