Commit | Line | Data |
---|---|---|
2e774c7c MZ |
1 | /* |
2 | * ST M48T59 RTC driver | |
3 | * | |
4 | * Copyright (c) 2007 Wind River Systems, Inc. | |
5 | * | |
6 | * Author: Mark Zhan <rongkai.zhan@windriver.com> | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License version 2 as | |
10 | * published by the Free Software Foundation. | |
11 | */ | |
12 | ||
13 | #include <linux/kernel.h> | |
14 | #include <linux/module.h> | |
15 | #include <linux/init.h> | |
16 | #include <linux/io.h> | |
17 | #include <linux/device.h> | |
18 | #include <linux/platform_device.h> | |
19 | #include <linux/rtc.h> | |
20 | #include <linux/rtc/m48t59.h> | |
21 | #include <linux/bcd.h> | |
22 | ||
23 | #ifndef NO_IRQ | |
24 | #define NO_IRQ (-1) | |
25 | #endif | |
26 | ||
94fe7424 KH |
27 | #define M48T59_READ(reg) (pdata->read_byte(dev, pdata->offset + reg)) |
28 | #define M48T59_WRITE(val, reg) \ | |
29 | (pdata->write_byte(dev, pdata->offset + reg, val)) | |
2e774c7c MZ |
30 | |
31 | #define M48T59_SET_BITS(mask, reg) \ | |
32 | M48T59_WRITE((M48T59_READ(reg) | (mask)), (reg)) | |
33 | #define M48T59_CLEAR_BITS(mask, reg) \ | |
34 | M48T59_WRITE((M48T59_READ(reg) & ~(mask)), (reg)) | |
35 | ||
36 | struct m48t59_private { | |
37 | void __iomem *ioaddr; | |
0439208a | 38 | int irq; |
2e774c7c MZ |
39 | struct rtc_device *rtc; |
40 | spinlock_t lock; /* serialize the NVRAM and RTC access */ | |
41 | }; | |
42 | ||
43 | /* | |
44 | * This is the generic access method when the chip is memory-mapped | |
45 | */ | |
46 | static void | |
47 | m48t59_mem_writeb(struct device *dev, u32 ofs, u8 val) | |
48 | { | |
49 | struct platform_device *pdev = to_platform_device(dev); | |
50 | struct m48t59_private *m48t59 = platform_get_drvdata(pdev); | |
51 | ||
52 | writeb(val, m48t59->ioaddr+ofs); | |
53 | } | |
54 | ||
55 | static u8 | |
56 | m48t59_mem_readb(struct device *dev, u32 ofs) | |
57 | { | |
58 | struct platform_device *pdev = to_platform_device(dev); | |
59 | struct m48t59_private *m48t59 = platform_get_drvdata(pdev); | |
60 | ||
61 | return readb(m48t59->ioaddr+ofs); | |
62 | } | |
63 | ||
64 | /* | |
65 | * NOTE: M48T59 only uses BCD mode | |
66 | */ | |
67 | static int m48t59_rtc_read_time(struct device *dev, struct rtc_time *tm) | |
68 | { | |
69 | struct platform_device *pdev = to_platform_device(dev); | |
70 | struct m48t59_plat_data *pdata = pdev->dev.platform_data; | |
71 | struct m48t59_private *m48t59 = platform_get_drvdata(pdev); | |
72 | unsigned long flags; | |
73 | u8 val; | |
74 | ||
75 | spin_lock_irqsave(&m48t59->lock, flags); | |
76 | /* Issue the READ command */ | |
77 | M48T59_SET_BITS(M48T59_CNTL_READ, M48T59_CNTL); | |
78 | ||
fe20ba70 | 79 | tm->tm_year = bcd2bin(M48T59_READ(M48T59_YEAR)); |
2e774c7c | 80 | /* tm_mon is 0-11 */ |
fe20ba70 AB |
81 | tm->tm_mon = bcd2bin(M48T59_READ(M48T59_MONTH)) - 1; |
82 | tm->tm_mday = bcd2bin(M48T59_READ(M48T59_MDAY)); | |
2e774c7c MZ |
83 | |
84 | val = M48T59_READ(M48T59_WDAY); | |
833be4e1 RR |
85 | if ((pdata->type == M48T59RTC_TYPE_M48T59) && |
86 | (val & M48T59_WDAY_CEB) && (val & M48T59_WDAY_CB)) { | |
2e774c7c MZ |
87 | dev_dbg(dev, "Century bit is enabled\n"); |
88 | tm->tm_year += 100; /* one century */ | |
89 | } | |
12a9ee3c KH |
90 | #ifdef CONFIG_SPARC |
91 | /* Sun SPARC machines count years since 1968 */ | |
92 | tm->tm_year += 68; | |
93 | #endif | |
2e774c7c | 94 | |
fe20ba70 AB |
95 | tm->tm_wday = bcd2bin(val & 0x07); |
96 | tm->tm_hour = bcd2bin(M48T59_READ(M48T59_HOUR) & 0x3F); | |
97 | tm->tm_min = bcd2bin(M48T59_READ(M48T59_MIN) & 0x7F); | |
98 | tm->tm_sec = bcd2bin(M48T59_READ(M48T59_SEC) & 0x7F); | |
2e774c7c MZ |
99 | |
100 | /* Clear the READ bit */ | |
101 | M48T59_CLEAR_BITS(M48T59_CNTL_READ, M48T59_CNTL); | |
102 | spin_unlock_irqrestore(&m48t59->lock, flags); | |
103 | ||
104 | dev_dbg(dev, "RTC read time %04d-%02d-%02d %02d/%02d/%02d\n", | |
105 | tm->tm_year + 1900, tm->tm_mon, tm->tm_mday, | |
106 | tm->tm_hour, tm->tm_min, tm->tm_sec); | |
107 | return 0; | |
108 | } | |
109 | ||
110 | static int m48t59_rtc_set_time(struct device *dev, struct rtc_time *tm) | |
111 | { | |
112 | struct platform_device *pdev = to_platform_device(dev); | |
113 | struct m48t59_plat_data *pdata = pdev->dev.platform_data; | |
114 | struct m48t59_private *m48t59 = platform_get_drvdata(pdev); | |
115 | unsigned long flags; | |
116 | u8 val = 0; | |
12a9ee3c KH |
117 | int year = tm->tm_year; |
118 | ||
119 | #ifdef CONFIG_SPARC | |
120 | /* Sun SPARC machines count years since 1968 */ | |
121 | year -= 68; | |
122 | #endif | |
2e774c7c MZ |
123 | |
124 | dev_dbg(dev, "RTC set time %04d-%02d-%02d %02d/%02d/%02d\n", | |
12a9ee3c | 125 | year + 1900, tm->tm_mon, tm->tm_mday, |
2e774c7c MZ |
126 | tm->tm_hour, tm->tm_min, tm->tm_sec); |
127 | ||
12a9ee3c KH |
128 | if (year < 0) |
129 | return -EINVAL; | |
130 | ||
2e774c7c MZ |
131 | spin_lock_irqsave(&m48t59->lock, flags); |
132 | /* Issue the WRITE command */ | |
133 | M48T59_SET_BITS(M48T59_CNTL_WRITE, M48T59_CNTL); | |
134 | ||
fe20ba70 AB |
135 | M48T59_WRITE((bin2bcd(tm->tm_sec) & 0x7F), M48T59_SEC); |
136 | M48T59_WRITE((bin2bcd(tm->tm_min) & 0x7F), M48T59_MIN); | |
137 | M48T59_WRITE((bin2bcd(tm->tm_hour) & 0x3F), M48T59_HOUR); | |
138 | M48T59_WRITE((bin2bcd(tm->tm_mday) & 0x3F), M48T59_MDAY); | |
2e774c7c | 139 | /* tm_mon is 0-11 */ |
fe20ba70 | 140 | M48T59_WRITE((bin2bcd(tm->tm_mon + 1) & 0x1F), M48T59_MONTH); |
12a9ee3c | 141 | M48T59_WRITE(bin2bcd(year % 100), M48T59_YEAR); |
2e774c7c | 142 | |
12a9ee3c | 143 | if (pdata->type == M48T59RTC_TYPE_M48T59 && (year / 100)) |
2e774c7c | 144 | val = (M48T59_WDAY_CEB | M48T59_WDAY_CB); |
fe20ba70 | 145 | val |= (bin2bcd(tm->tm_wday) & 0x07); |
2e774c7c MZ |
146 | M48T59_WRITE(val, M48T59_WDAY); |
147 | ||
148 | /* Clear the WRITE bit */ | |
149 | M48T59_CLEAR_BITS(M48T59_CNTL_WRITE, M48T59_CNTL); | |
150 | spin_unlock_irqrestore(&m48t59->lock, flags); | |
151 | return 0; | |
152 | } | |
153 | ||
154 | /* | |
155 | * Read alarm time and date in RTC | |
156 | */ | |
157 | static int m48t59_rtc_readalarm(struct device *dev, struct rtc_wkalrm *alrm) | |
158 | { | |
159 | struct platform_device *pdev = to_platform_device(dev); | |
160 | struct m48t59_plat_data *pdata = pdev->dev.platform_data; | |
161 | struct m48t59_private *m48t59 = platform_get_drvdata(pdev); | |
162 | struct rtc_time *tm = &alrm->time; | |
163 | unsigned long flags; | |
164 | u8 val; | |
165 | ||
166 | /* If no irq, we don't support ALARM */ | |
167 | if (m48t59->irq == NO_IRQ) | |
168 | return -EIO; | |
169 | ||
170 | spin_lock_irqsave(&m48t59->lock, flags); | |
171 | /* Issue the READ command */ | |
172 | M48T59_SET_BITS(M48T59_CNTL_READ, M48T59_CNTL); | |
173 | ||
fe20ba70 | 174 | tm->tm_year = bcd2bin(M48T59_READ(M48T59_YEAR)); |
12a9ee3c KH |
175 | #ifdef CONFIG_SPARC |
176 | /* Sun SPARC machines count years since 1968 */ | |
177 | tm->tm_year += 68; | |
178 | #endif | |
2e774c7c | 179 | /* tm_mon is 0-11 */ |
fe20ba70 | 180 | tm->tm_mon = bcd2bin(M48T59_READ(M48T59_MONTH)) - 1; |
2e774c7c MZ |
181 | |
182 | val = M48T59_READ(M48T59_WDAY); | |
183 | if ((val & M48T59_WDAY_CEB) && (val & M48T59_WDAY_CB)) | |
184 | tm->tm_year += 100; /* one century */ | |
185 | ||
fe20ba70 AB |
186 | tm->tm_mday = bcd2bin(M48T59_READ(M48T59_ALARM_DATE)); |
187 | tm->tm_hour = bcd2bin(M48T59_READ(M48T59_ALARM_HOUR)); | |
188 | tm->tm_min = bcd2bin(M48T59_READ(M48T59_ALARM_MIN)); | |
189 | tm->tm_sec = bcd2bin(M48T59_READ(M48T59_ALARM_SEC)); | |
2e774c7c MZ |
190 | |
191 | /* Clear the READ bit */ | |
192 | M48T59_CLEAR_BITS(M48T59_CNTL_READ, M48T59_CNTL); | |
193 | spin_unlock_irqrestore(&m48t59->lock, flags); | |
194 | ||
195 | dev_dbg(dev, "RTC read alarm time %04d-%02d-%02d %02d/%02d/%02d\n", | |
196 | tm->tm_year + 1900, tm->tm_mon, tm->tm_mday, | |
197 | tm->tm_hour, tm->tm_min, tm->tm_sec); | |
198 | return 0; | |
199 | } | |
200 | ||
201 | /* | |
202 | * Set alarm time and date in RTC | |
203 | */ | |
204 | static int m48t59_rtc_setalarm(struct device *dev, struct rtc_wkalrm *alrm) | |
205 | { | |
206 | struct platform_device *pdev = to_platform_device(dev); | |
207 | struct m48t59_plat_data *pdata = pdev->dev.platform_data; | |
208 | struct m48t59_private *m48t59 = platform_get_drvdata(pdev); | |
209 | struct rtc_time *tm = &alrm->time; | |
210 | u8 mday, hour, min, sec; | |
211 | unsigned long flags; | |
12a9ee3c KH |
212 | int year = tm->tm_year; |
213 | ||
214 | #ifdef CONFIG_SPARC | |
215 | /* Sun SPARC machines count years since 1968 */ | |
216 | year -= 68; | |
217 | #endif | |
2e774c7c MZ |
218 | |
219 | /* If no irq, we don't support ALARM */ | |
220 | if (m48t59->irq == NO_IRQ) | |
221 | return -EIO; | |
222 | ||
12a9ee3c KH |
223 | if (year < 0) |
224 | return -EINVAL; | |
225 | ||
2e774c7c MZ |
226 | /* |
227 | * 0xff means "always match" | |
228 | */ | |
229 | mday = tm->tm_mday; | |
fe20ba70 | 230 | mday = (mday >= 1 && mday <= 31) ? bin2bcd(mday) : 0xff; |
2e774c7c MZ |
231 | if (mday == 0xff) |
232 | mday = M48T59_READ(M48T59_MDAY); | |
233 | ||
234 | hour = tm->tm_hour; | |
fe20ba70 | 235 | hour = (hour < 24) ? bin2bcd(hour) : 0x00; |
2e774c7c MZ |
236 | |
237 | min = tm->tm_min; | |
fe20ba70 | 238 | min = (min < 60) ? bin2bcd(min) : 0x00; |
2e774c7c MZ |
239 | |
240 | sec = tm->tm_sec; | |
fe20ba70 | 241 | sec = (sec < 60) ? bin2bcd(sec) : 0x00; |
2e774c7c MZ |
242 | |
243 | spin_lock_irqsave(&m48t59->lock, flags); | |
244 | /* Issue the WRITE command */ | |
245 | M48T59_SET_BITS(M48T59_CNTL_WRITE, M48T59_CNTL); | |
246 | ||
247 | M48T59_WRITE(mday, M48T59_ALARM_DATE); | |
248 | M48T59_WRITE(hour, M48T59_ALARM_HOUR); | |
249 | M48T59_WRITE(min, M48T59_ALARM_MIN); | |
250 | M48T59_WRITE(sec, M48T59_ALARM_SEC); | |
251 | ||
252 | /* Clear the WRITE bit */ | |
253 | M48T59_CLEAR_BITS(M48T59_CNTL_WRITE, M48T59_CNTL); | |
254 | spin_unlock_irqrestore(&m48t59->lock, flags); | |
255 | ||
256 | dev_dbg(dev, "RTC set alarm time %04d-%02d-%02d %02d/%02d/%02d\n", | |
12a9ee3c | 257 | year + 1900, tm->tm_mon, tm->tm_mday, |
2e774c7c MZ |
258 | tm->tm_hour, tm->tm_min, tm->tm_sec); |
259 | return 0; | |
260 | } | |
261 | ||
262 | /* | |
263 | * Handle commands from user-space | |
264 | */ | |
265 | static int m48t59_rtc_ioctl(struct device *dev, unsigned int cmd, | |
266 | unsigned long arg) | |
267 | { | |
268 | struct platform_device *pdev = to_platform_device(dev); | |
269 | struct m48t59_plat_data *pdata = pdev->dev.platform_data; | |
270 | struct m48t59_private *m48t59 = platform_get_drvdata(pdev); | |
271 | unsigned long flags; | |
272 | int ret = 0; | |
273 | ||
274 | spin_lock_irqsave(&m48t59->lock, flags); | |
275 | switch (cmd) { | |
276 | case RTC_AIE_OFF: /* alarm interrupt off */ | |
277 | M48T59_WRITE(0x00, M48T59_INTR); | |
278 | break; | |
279 | case RTC_AIE_ON: /* alarm interrupt on */ | |
280 | M48T59_WRITE(M48T59_INTR_AFE, M48T59_INTR); | |
281 | break; | |
282 | default: | |
283 | ret = -ENOIOCTLCMD; | |
284 | break; | |
285 | } | |
286 | spin_unlock_irqrestore(&m48t59->lock, flags); | |
287 | ||
288 | return ret; | |
289 | } | |
290 | ||
291 | static int m48t59_rtc_proc(struct device *dev, struct seq_file *seq) | |
292 | { | |
293 | struct platform_device *pdev = to_platform_device(dev); | |
294 | struct m48t59_plat_data *pdata = pdev->dev.platform_data; | |
295 | struct m48t59_private *m48t59 = platform_get_drvdata(pdev); | |
296 | unsigned long flags; | |
297 | u8 val; | |
298 | ||
299 | spin_lock_irqsave(&m48t59->lock, flags); | |
300 | val = M48T59_READ(M48T59_FLAGS); | |
301 | spin_unlock_irqrestore(&m48t59->lock, flags); | |
302 | ||
303 | seq_printf(seq, "battery\t\t: %s\n", | |
304 | (val & M48T59_FLAGS_BF) ? "low" : "normal"); | |
305 | return 0; | |
306 | } | |
307 | ||
308 | /* | |
309 | * IRQ handler for the RTC | |
310 | */ | |
311 | static irqreturn_t m48t59_rtc_interrupt(int irq, void *dev_id) | |
312 | { | |
313 | struct device *dev = (struct device *)dev_id; | |
314 | struct platform_device *pdev = to_platform_device(dev); | |
315 | struct m48t59_plat_data *pdata = pdev->dev.platform_data; | |
316 | struct m48t59_private *m48t59 = platform_get_drvdata(pdev); | |
317 | u8 event; | |
318 | ||
319 | spin_lock(&m48t59->lock); | |
320 | event = M48T59_READ(M48T59_FLAGS); | |
321 | spin_unlock(&m48t59->lock); | |
322 | ||
323 | if (event & M48T59_FLAGS_AF) { | |
324 | rtc_update_irq(m48t59->rtc, 1, (RTC_AF | RTC_IRQF)); | |
325 | return IRQ_HANDLED; | |
326 | } | |
327 | ||
328 | return IRQ_NONE; | |
329 | } | |
330 | ||
331 | static const struct rtc_class_ops m48t59_rtc_ops = { | |
332 | .ioctl = m48t59_rtc_ioctl, | |
333 | .read_time = m48t59_rtc_read_time, | |
334 | .set_time = m48t59_rtc_set_time, | |
335 | .read_alarm = m48t59_rtc_readalarm, | |
336 | .set_alarm = m48t59_rtc_setalarm, | |
337 | .proc = m48t59_rtc_proc, | |
338 | }; | |
339 | ||
94fe7424 KH |
340 | static const struct rtc_class_ops m48t02_rtc_ops = { |
341 | .read_time = m48t59_rtc_read_time, | |
342 | .set_time = m48t59_rtc_set_time, | |
343 | }; | |
344 | ||
2e774c7c MZ |
345 | static ssize_t m48t59_nvram_read(struct kobject *kobj, |
346 | struct bin_attribute *bin_attr, | |
347 | char *buf, loff_t pos, size_t size) | |
348 | { | |
349 | struct device *dev = container_of(kobj, struct device, kobj); | |
350 | struct platform_device *pdev = to_platform_device(dev); | |
351 | struct m48t59_plat_data *pdata = pdev->dev.platform_data; | |
352 | struct m48t59_private *m48t59 = platform_get_drvdata(pdev); | |
353 | ssize_t cnt = 0; | |
354 | unsigned long flags; | |
355 | ||
94fe7424 | 356 | for (; size > 0 && pos < pdata->offset; cnt++, size--) { |
2e774c7c MZ |
357 | spin_lock_irqsave(&m48t59->lock, flags); |
358 | *buf++ = M48T59_READ(cnt); | |
359 | spin_unlock_irqrestore(&m48t59->lock, flags); | |
360 | } | |
361 | ||
362 | return cnt; | |
363 | } | |
364 | ||
365 | static ssize_t m48t59_nvram_write(struct kobject *kobj, | |
366 | struct bin_attribute *bin_attr, | |
367 | char *buf, loff_t pos, size_t size) | |
368 | { | |
369 | struct device *dev = container_of(kobj, struct device, kobj); | |
370 | struct platform_device *pdev = to_platform_device(dev); | |
371 | struct m48t59_plat_data *pdata = pdev->dev.platform_data; | |
372 | struct m48t59_private *m48t59 = platform_get_drvdata(pdev); | |
373 | ssize_t cnt = 0; | |
374 | unsigned long flags; | |
375 | ||
94fe7424 | 376 | for (; size > 0 && pos < pdata->offset; cnt++, size--) { |
2e774c7c MZ |
377 | spin_lock_irqsave(&m48t59->lock, flags); |
378 | M48T59_WRITE(*buf++, cnt); | |
379 | spin_unlock_irqrestore(&m48t59->lock, flags); | |
380 | } | |
381 | ||
382 | return cnt; | |
383 | } | |
384 | ||
385 | static struct bin_attribute m48t59_nvram_attr = { | |
386 | .attr = { | |
387 | .name = "nvram", | |
a4b1d50e | 388 | .mode = S_IRUGO | S_IWUSR, |
2e774c7c MZ |
389 | }, |
390 | .read = m48t59_nvram_read, | |
391 | .write = m48t59_nvram_write, | |
392 | }; | |
393 | ||
394 | static int __devinit m48t59_rtc_probe(struct platform_device *pdev) | |
395 | { | |
396 | struct m48t59_plat_data *pdata = pdev->dev.platform_data; | |
397 | struct m48t59_private *m48t59 = NULL; | |
398 | struct resource *res; | |
399 | int ret = -ENOMEM; | |
94fe7424 KH |
400 | char *name; |
401 | const struct rtc_class_ops *ops; | |
2e774c7c MZ |
402 | |
403 | /* This chip could be memory-mapped or I/O-mapped */ | |
404 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
405 | if (!res) { | |
406 | res = platform_get_resource(pdev, IORESOURCE_IO, 0); | |
407 | if (!res) | |
408 | return -EINVAL; | |
409 | } | |
410 | ||
411 | if (res->flags & IORESOURCE_IO) { | |
412 | /* If we are I/O-mapped, the platform should provide | |
413 | * the operations accessing chip registers. | |
414 | */ | |
415 | if (!pdata || !pdata->write_byte || !pdata->read_byte) | |
416 | return -EINVAL; | |
417 | } else if (res->flags & IORESOURCE_MEM) { | |
418 | /* we are memory-mapped */ | |
419 | if (!pdata) { | |
420 | pdata = kzalloc(sizeof(*pdata), GFP_KERNEL); | |
421 | if (!pdata) | |
422 | return -ENOMEM; | |
423 | /* Ensure we only kmalloc platform data once */ | |
424 | pdev->dev.platform_data = pdata; | |
425 | } | |
94fe7424 KH |
426 | if (!pdata->type) |
427 | pdata->type = M48T59RTC_TYPE_M48T59; | |
2e774c7c MZ |
428 | |
429 | /* Try to use the generic memory read/write ops */ | |
430 | if (!pdata->write_byte) | |
431 | pdata->write_byte = m48t59_mem_writeb; | |
432 | if (!pdata->read_byte) | |
433 | pdata->read_byte = m48t59_mem_readb; | |
434 | } | |
435 | ||
436 | m48t59 = kzalloc(sizeof(*m48t59), GFP_KERNEL); | |
437 | if (!m48t59) | |
438 | return -ENOMEM; | |
439 | ||
64151ad5 KH |
440 | m48t59->ioaddr = pdata->ioaddr; |
441 | ||
442 | if (!m48t59->ioaddr) { | |
443 | /* ioaddr not mapped externally */ | |
444 | m48t59->ioaddr = ioremap(res->start, res->end - res->start + 1); | |
445 | if (!m48t59->ioaddr) | |
446 | goto out; | |
447 | } | |
2e774c7c MZ |
448 | |
449 | /* Try to get irq number. We also can work in | |
450 | * the mode without IRQ. | |
451 | */ | |
452 | m48t59->irq = platform_get_irq(pdev, 0); | |
2fac6674 | 453 | if (m48t59->irq <= 0) |
2e774c7c MZ |
454 | m48t59->irq = NO_IRQ; |
455 | ||
456 | if (m48t59->irq != NO_IRQ) { | |
457 | ret = request_irq(m48t59->irq, m48t59_rtc_interrupt, | |
458 | IRQF_SHARED, "rtc-m48t59", &pdev->dev); | |
459 | if (ret) | |
460 | goto out; | |
461 | } | |
94fe7424 KH |
462 | switch (pdata->type) { |
463 | case M48T59RTC_TYPE_M48T59: | |
464 | name = "m48t59"; | |
465 | ops = &m48t59_rtc_ops; | |
466 | pdata->offset = 0x1ff0; | |
467 | break; | |
468 | case M48T59RTC_TYPE_M48T02: | |
469 | name = "m48t02"; | |
470 | ops = &m48t02_rtc_ops; | |
471 | pdata->offset = 0x7f0; | |
472 | break; | |
473 | case M48T59RTC_TYPE_M48T08: | |
474 | name = "m48t08"; | |
475 | ops = &m48t02_rtc_ops; | |
476 | pdata->offset = 0x1ff0; | |
477 | break; | |
478 | default: | |
479 | dev_err(&pdev->dev, "Unknown RTC type\n"); | |
480 | ret = -ENODEV; | |
481 | goto out; | |
482 | } | |
2e774c7c | 483 | |
94fe7424 | 484 | m48t59->rtc = rtc_device_register(name, &pdev->dev, ops, THIS_MODULE); |
2e774c7c MZ |
485 | if (IS_ERR(m48t59->rtc)) { |
486 | ret = PTR_ERR(m48t59->rtc); | |
487 | goto out; | |
488 | } | |
489 | ||
94fe7424 KH |
490 | m48t59_nvram_attr.size = pdata->offset; |
491 | ||
2e774c7c MZ |
492 | ret = sysfs_create_bin_file(&pdev->dev.kobj, &m48t59_nvram_attr); |
493 | if (ret) | |
494 | goto out; | |
495 | ||
496 | spin_lock_init(&m48t59->lock); | |
497 | platform_set_drvdata(pdev, m48t59); | |
498 | return 0; | |
499 | ||
500 | out: | |
501 | if (!IS_ERR(m48t59->rtc)) | |
502 | rtc_device_unregister(m48t59->rtc); | |
503 | if (m48t59->irq != NO_IRQ) | |
504 | free_irq(m48t59->irq, &pdev->dev); | |
505 | if (m48t59->ioaddr) | |
506 | iounmap(m48t59->ioaddr); | |
507 | if (m48t59) | |
508 | kfree(m48t59); | |
509 | return ret; | |
510 | } | |
511 | ||
512 | static int __devexit m48t59_rtc_remove(struct platform_device *pdev) | |
513 | { | |
514 | struct m48t59_private *m48t59 = platform_get_drvdata(pdev); | |
64151ad5 | 515 | struct m48t59_plat_data *pdata = pdev->dev.platform_data; |
2e774c7c MZ |
516 | |
517 | sysfs_remove_bin_file(&pdev->dev.kobj, &m48t59_nvram_attr); | |
518 | if (!IS_ERR(m48t59->rtc)) | |
519 | rtc_device_unregister(m48t59->rtc); | |
64151ad5 | 520 | if (m48t59->ioaddr && !pdata->ioaddr) |
2e774c7c MZ |
521 | iounmap(m48t59->ioaddr); |
522 | if (m48t59->irq != NO_IRQ) | |
523 | free_irq(m48t59->irq, &pdev->dev); | |
524 | platform_set_drvdata(pdev, NULL); | |
525 | kfree(m48t59); | |
526 | return 0; | |
527 | } | |
528 | ||
ad28a07b KS |
529 | /* work with hotplug and coldplug */ |
530 | MODULE_ALIAS("platform:rtc-m48t59"); | |
531 | ||
12730926 | 532 | static struct platform_driver m48t59_rtc_driver = { |
2e774c7c MZ |
533 | .driver = { |
534 | .name = "rtc-m48t59", | |
535 | .owner = THIS_MODULE, | |
536 | }, | |
537 | .probe = m48t59_rtc_probe, | |
538 | .remove = __devexit_p(m48t59_rtc_remove), | |
539 | }; | |
540 | ||
541 | static int __init m48t59_rtc_init(void) | |
542 | { | |
12730926 | 543 | return platform_driver_register(&m48t59_rtc_driver); |
2e774c7c MZ |
544 | } |
545 | ||
546 | static void __exit m48t59_rtc_exit(void) | |
547 | { | |
12730926 | 548 | platform_driver_unregister(&m48t59_rtc_driver); |
2e774c7c MZ |
549 | } |
550 | ||
551 | module_init(m48t59_rtc_init); | |
552 | module_exit(m48t59_rtc_exit); | |
553 | ||
554 | MODULE_AUTHOR("Mark Zhan <rongkai.zhan@windriver.com>"); | |
94fe7424 | 555 | MODULE_DESCRIPTION("M48T59/M48T02/M48T08 RTC driver"); |
2e774c7c | 556 | MODULE_LICENSE("GPL"); |