Linux Audio

Check our new training course

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