Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit b4f0b880 authored by zhao zhang's avatar zhao zhang Committed by Linus Torvalds
Browse files

MIPS: add RTC support for loongson1B 



Add RTC support(TOY counter0) for loongson1B SOC

Signed-off-by: default avatarzhao zhang <zhzhl555@gmail.com>
Cc: Alessandro Zummo <a.zummo@towertech.it>
Cc: Ralf Baechle <ralf@linux-mips.org>
Acked-by: default avatarLinus Walleij <linus.walleij@linaro.org>
Signed-off-by: default avatarAndrew Morton <akpm@linux-foundation.org>
Signed-off-by: default avatarLinus Torvalds <torvalds@linux-foundation.org>
parent 0abc9201

drivers/rtc/Kconfig

+10 −0
Original line number Diff line number Diff line
@@ -1070,4 +1070,14 @@ config RTC_DRV_PUV3 
	  This drive can also be built as a module. If so, the module

	  will be called rtc-puv3.



config RTC_DRV_LOONGSON1

	tristate "loongson1 RTC support"

	depends on MACH_LOONGSON1

	help

	  This is a driver for the loongson1 on-chip Counter0 (Time-Of-Year

	  counter) to be used as a RTC.



	  This driver can also be built as a module. If so, the module

	  will be called rtc-ls1x.



endif # RTC_CLASS

drivers/rtc/Makefile

+1 −0
Original line number Diff line number Diff line
@@ -53,6 +53,7 @@ obj-$(CONFIG_RTC_DRV_ISL1208) += rtc-isl1208.o 
obj-$(CONFIG_RTC_DRV_ISL12022)	+= rtc-isl12022.o

obj-$(CONFIG_RTC_DRV_JZ4740)	+= rtc-jz4740.o

obj-$(CONFIG_RTC_DRV_LPC32XX)	+= rtc-lpc32xx.o

obj-$(CONFIG_RTC_DRV_LOONGSON1)	+= rtc-ls1x.o

obj-$(CONFIG_RTC_DRV_M41T80)	+= rtc-m41t80.o

obj-$(CONFIG_RTC_DRV_M41T93)	+= rtc-m41t93.o

obj-$(CONFIG_RTC_DRV_M41T94)	+= rtc-m41t94.o

drivers/rtc/rtc-ls1x.c

0 → 100644
+210 −0
Original line number Diff line number Diff line 
/*

 * 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 <asm/mach-loongson1/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, t;



	v = readl(SYS_TOYREAD0);

	t = readl(SYS_TOYREAD1);



	memset(rtm, 0, sizeof(struct rtc_time));

	t  = mktime((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_time_to_tm(t, rtm);



	return rtc_valid_tm(rtm);

}



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 struct rtc_class_ops  ls1x_rtc_ops = {

	.read_time	= ls1x_rtc_read_time,

	.set_time	= ls1x_rtc_set_time,

};



static int __devinit ls1x_rtc_probe(struct platform_device *pdev)

{

	struct rtc_device *rtcdev;

	unsigned long v;

	int ret;



	v = readl(SYS_COUNTER_CNTRL);

	if (!(v & RTC_CNTR_OK)) {

		dev_err(&pdev->dev, "rtc counters not working\n");

		ret = -ENODEV;

		goto err;

	}

	ret = -ETIMEDOUT;

	/* 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");

			goto err;

		}

		writel(32767, SYS_TOYTRIM);

	}

	/* this loop coundn't be endless */

	while (readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_TTS)

		usleep_range(1000, 3000);



	rtcdev = rtc_device_register("ls1x-rtc", &pdev->dev,

					&ls1x_rtc_ops , THIS_MODULE);

	if (IS_ERR(rtcdev)) {

		ret = PTR_ERR(rtcdev);

		goto err;

	}



	platform_set_drvdata(pdev, rtcdev);

	return 0;

err:

	return ret;

}



static int __devexit ls1x_rtc_remove(struct platform_device *pdev)

{

	struct rtc_device *rtcdev = platform_get_drvdata(pdev);



	rtc_device_unregister(rtcdev);

	platform_set_drvdata(pdev, NULL);



	return 0;

}



static struct platform_driver  ls1x_rtc_driver = {

	.driver		= {

		.name	= "ls1x-rtc",

		.owner	= THIS_MODULE,

	},

	.remove		= __devexit_p(ls1x_rtc_remove),

	.probe		= ls1x_rtc_probe,

};



module_platform_driver(ls1x_rtc_driver);



MODULE_AUTHOR("zhao zhang <zhzhl555@gmail.com>");

MODULE_LICENSE("GPL");