1
2
3
4
5
6
7
8
9
10
11#include <common.h>
12#include <command.h>
13#include <dm.h>
14#include <rtc.h>
15#include <asm/io.h>
16#include <linux/delay.h>
17#include "mvrtc.h"
18
19
20#define CENTURY 20
21
22static int __mv_rtc_get(struct mvrtc_registers *regs, struct rtc_time *t)
23{
24 u32 time;
25 u32 date;
26
27
28 time = readl(®s->time);
29
30
31 date = readl(®s->date);
32
33
34 if (time & MVRTC_HRFMT_MSK) {
35 printf("Error: RTC in 12 hour mode, can't determine AM/PM.\n");
36 return -1;
37 }
38
39
40 t->tm_sec = bcd2bin((time >> MVRTC_SEC_SFT) & MVRTC_SEC_MSK);
41 t->tm_min = bcd2bin((time >> MVRTC_MIN_SFT) & MVRTC_MIN_MSK);
42 t->tm_hour = bcd2bin((time >> MVRTC_HOUR_SFT) & MVRTC_HOUR_MSK);
43 t->tm_wday = bcd2bin((time >> MVRTC_DAY_SFT) & MVRTC_DAY_MSK);
44 t->tm_wday--;
45
46
47 t->tm_mday = bcd2bin((date >> MVRTC_DATE_SFT) & MVRTC_DATE_MSK);
48 t->tm_mon = bcd2bin((date >> MVRTC_MON_SFT) & MVRTC_MON_MSK);
49 t->tm_year = bcd2bin((date >> MVRTC_YEAR_SFT) & MVRTC_YEAR_MSK);
50 t->tm_year += CENTURY * 100;
51
52
53 t->tm_yday = 0;
54 t->tm_isdst = 0;
55
56 return 0;
57}
58
59#ifndef CONFIG_DM_RTC
60int rtc_get(struct rtc_time *t)
61{
62 struct mvrtc_registers *regs;
63
64 regs = (struct mvrtc_registers *)KW_RTC_BASE;
65 return __mv_rtc_get(regs, t);
66}
67#endif
68
69static int __mv_rtc_set(struct mvrtc_registers *regs, const struct rtc_time *t)
70{
71 u32 time = 0;
72 u32 date = 0;
73
74
75 if ((t->tm_year / 100) != CENTURY)
76 printf("Warning: Only century %d supported.\n", CENTURY);
77
78
79 time |= (bin2bcd(t->tm_sec) & MVRTC_SEC_MSK) << MVRTC_SEC_SFT;
80 time |= (bin2bcd(t->tm_min) & MVRTC_MIN_MSK) << MVRTC_MIN_SFT;
81 time |= (bin2bcd(t->tm_hour) & MVRTC_HOUR_MSK) << MVRTC_HOUR_SFT;
82 time |= (bin2bcd(t->tm_wday + 1) & MVRTC_DAY_MSK) << MVRTC_DAY_SFT;
83
84
85 date |= (bin2bcd(t->tm_mday) & MVRTC_DATE_MSK) << MVRTC_DATE_SFT;
86 date |= (bin2bcd(t->tm_mon) & MVRTC_MON_MSK) << MVRTC_MON_SFT;
87 date |= (bin2bcd(t->tm_year % 100) & MVRTC_YEAR_MSK) << MVRTC_YEAR_SFT;
88
89
90 writel(time, ®s->time);
91
92
93 writel(date, ®s->date);
94
95 return 0;
96}
97
98#ifndef CONFIG_DM_RTC
99int rtc_set(struct rtc_time *t)
100{
101 struct mvrtc_registers *regs;
102
103 regs = (struct mvrtc_registers *)KW_RTC_BASE;
104 return __mv_rtc_set(regs, t);
105}
106#endif
107
108static void __mv_rtc_reset(struct mvrtc_registers *regs)
109{
110 u32 time;
111 u32 sec;
112
113
114 time = readl(®s->time);
115 sec = bcd2bin((time >> MVRTC_SEC_SFT) & MVRTC_SEC_MSK);
116 udelay(1000000);
117 time = readl(®s->time);
118
119 if (sec == bcd2bin((time >> MVRTC_SEC_SFT) & MVRTC_SEC_MSK))
120 printf("Error: RTC did not increment.\n");
121}
122
123#ifndef CONFIG_DM_RTC
124void rtc_reset(void)
125{
126 struct mvrtc_registers *regs;
127
128 regs = (struct mvrtc_registers *)KW_RTC_BASE;
129 __mv_rtc_reset(regs);
130}
131#endif
132
133#ifdef CONFIG_DM_RTC
134static int mv_rtc_get(struct udevice *dev, struct rtc_time *tm)
135{
136 struct mvrtc_pdata *pdata = dev_get_plat(dev);
137 struct mvrtc_registers *regs = (struct mvrtc_registers *)pdata->iobase;
138
139 return __mv_rtc_get(regs, tm);
140}
141
142static int mv_rtc_set(struct udevice *dev, const struct rtc_time *tm)
143{
144 struct mvrtc_pdata *pdata = dev_get_plat(dev);
145 struct mvrtc_registers *regs = (struct mvrtc_registers *)pdata->iobase;
146
147 return __mv_rtc_set(regs, tm);
148}
149
150static int mv_rtc_reset(struct udevice *dev)
151{
152 struct mvrtc_pdata *pdata = dev_get_plat(dev);
153 struct mvrtc_registers *regs = (struct mvrtc_registers *)pdata->iobase;
154
155 __mv_rtc_reset(regs);
156 return 0;
157}
158
159static const struct rtc_ops mv_rtc_ops = {
160 .get = mv_rtc_get,
161 .set = mv_rtc_set,
162 .reset = mv_rtc_reset,
163};
164
165static const struct udevice_id mv_rtc_ids[] = {
166 { .compatible = "marvell,kirkwood-rtc" },
167 { .compatible = "marvell,orion-rtc" },
168 { }
169};
170
171static int mv_rtc_of_to_plat(struct udevice *dev)
172{
173 struct mvrtc_pdata *pdata = dev_get_plat(dev);
174
175 pdata->iobase = dev_read_addr(dev);
176 return 0;
177}
178
179U_BOOT_DRIVER(rtc_mv) = {
180 .name = "rtc-mv",
181 .id = UCLASS_RTC,
182 .of_to_plat = mv_rtc_of_to_plat,
183 .of_match = mv_rtc_ids,
184 .ops = &mv_rtc_ops,
185};
186#endif
187