mm: vma_adjust: remove superfluous check for next not NULL
[linux/fpc-iii.git] / drivers / rtc / rtc-ls1x.c
blob22a9ec4f2b836c53585880ec6cd65b222ed522df
1 /*
2 * Copyright (c) 2011 Zhao Zhang <zhzhl555@gmail.com>
4 * Derived from driver/rtc/rtc-au1xxx.c
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.
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 <loongson1.h>
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)))
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)
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))
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))
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)
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)
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)
86 #define RTC_CNTR_OK (SYS_CNTRL_E0 | SYS_CNTRL_32S)
88 static int ls1x_rtc_read_time(struct device *dev, struct rtc_time *rtm)
90 unsigned long v, t;
92 v = readl(SYS_TOYREAD0);
93 t = readl(SYS_TOYREAD1);
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);
101 return rtc_valid_tm(rtm);
104 static int ls1x_rtc_set_time(struct device *dev, struct rtc_time *rtm)
106 unsigned long v, t, c;
107 int ret = -ETIMEDOUT;
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);
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);
121 if (!c) {
122 dev_err(dev, "set time timeout!\n");
123 goto err;
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);
132 if (!c) {
133 dev_err(dev, "set time timeout!\n");
134 goto err;
136 return 0;
137 err:
138 return ret;
141 static struct rtc_class_ops ls1x_rtc_ops = {
142 .read_time = ls1x_rtc_read_time,
143 .set_time = ls1x_rtc_set_time,
146 static int ls1x_rtc_probe(struct platform_device *pdev)
148 struct rtc_device *rtcdev;
149 unsigned long v;
150 int ret;
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;
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);
165 if (!v) {
166 dev_err(&pdev->dev, "time out\n");
167 goto err;
169 writel(32767, SYS_TOYTRIM);
171 /* this loop coundn't be endless */
172 while (readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_TTS)
173 usleep_range(1000, 3000);
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;
182 platform_set_drvdata(pdev, rtcdev);
183 return 0;
184 err:
185 return ret;
188 static struct platform_driver ls1x_rtc_driver = {
189 .driver = {
190 .name = "ls1x-rtc",
192 .probe = ls1x_rtc_probe,
195 module_platform_driver(ls1x_rtc_driver);
197 MODULE_AUTHOR("zhao zhang <zhzhl555@gmail.com>");
198 MODULE_LICENSE("GPL");