Commit c318c7ac49f9139f55da619bbace6137e1509390
Committed by
Linus Torvalds
1 parent
b4870bc5ee
Exists in
master
and in
7 other branches
rtc: t reaches -1, tested 0
With a postfix decrement t will reach -1 rather than 0, so neither the warning nor the `goto error_out' will occur. Signed-off-by: Roel Kluin <roel.kluin@gmail.com> Acked-by: Manuel Lauss <mano@roarinelk.homelinux.net> Acked-by: Alessandro Zummo <a.zummo@towertech.it> Cc: David Brownell <david-b@pacbell.net> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
Showing 1 changed file with 1 additions and 1 deletions Inline Diff
drivers/rtc/rtc-au1xxx.c
1 | /* | 1 | /* |
2 | * Au1xxx counter0 (aka Time-Of-Year counter) RTC interface driver. | 2 | * Au1xxx counter0 (aka Time-Of-Year counter) RTC interface driver. |
3 | * | 3 | * |
4 | * Copyright (C) 2008 Manuel Lauss <mano@roarinelk.homelinux.net> | 4 | * Copyright (C) 2008 Manuel Lauss <mano@roarinelk.homelinux.net> |
5 | * | 5 | * |
6 | * This file is subject to the terms and conditions of the GNU General Public | 6 | * This file is subject to the terms and conditions of the GNU General Public |
7 | * License. See the file "COPYING" in the main directory of this archive | 7 | * License. See the file "COPYING" in the main directory of this archive |
8 | * for more details. | 8 | * for more details. |
9 | */ | 9 | */ |
10 | 10 | ||
11 | /* All current Au1xxx SoCs have 2 counters fed by an external 32.768 kHz | 11 | /* All current Au1xxx SoCs have 2 counters fed by an external 32.768 kHz |
12 | * crystal. Counter 0, which keeps counting during sleep/powerdown, is | 12 | * crystal. Counter 0, which keeps counting during sleep/powerdown, is |
13 | * used to count seconds since the beginning of the unix epoch. | 13 | * used to count seconds since the beginning of the unix epoch. |
14 | * | 14 | * |
15 | * The counters must be configured and enabled by bootloader/board code; | 15 | * The counters must be configured and enabled by bootloader/board code; |
16 | * no checks as to whether they really get a proper 32.768kHz clock are | 16 | * no checks as to whether they really get a proper 32.768kHz clock are |
17 | * made as this would take far too long. | 17 | * made as this would take far too long. |
18 | */ | 18 | */ |
19 | 19 | ||
20 | #include <linux/module.h> | 20 | #include <linux/module.h> |
21 | #include <linux/kernel.h> | 21 | #include <linux/kernel.h> |
22 | #include <linux/rtc.h> | 22 | #include <linux/rtc.h> |
23 | #include <linux/init.h> | 23 | #include <linux/init.h> |
24 | #include <linux/platform_device.h> | 24 | #include <linux/platform_device.h> |
25 | #include <linux/io.h> | 25 | #include <linux/io.h> |
26 | #include <asm/mach-au1x00/au1000.h> | 26 | #include <asm/mach-au1x00/au1000.h> |
27 | 27 | ||
28 | /* 32kHz clock enabled and detected */ | 28 | /* 32kHz clock enabled and detected */ |
29 | #define CNTR_OK (SYS_CNTRL_E0 | SYS_CNTRL_32S) | 29 | #define CNTR_OK (SYS_CNTRL_E0 | SYS_CNTRL_32S) |
30 | 30 | ||
31 | static int au1xtoy_rtc_read_time(struct device *dev, struct rtc_time *tm) | 31 | static int au1xtoy_rtc_read_time(struct device *dev, struct rtc_time *tm) |
32 | { | 32 | { |
33 | unsigned long t; | 33 | unsigned long t; |
34 | 34 | ||
35 | t = au_readl(SYS_TOYREAD); | 35 | t = au_readl(SYS_TOYREAD); |
36 | 36 | ||
37 | rtc_time_to_tm(t, tm); | 37 | rtc_time_to_tm(t, tm); |
38 | 38 | ||
39 | return rtc_valid_tm(tm); | 39 | return rtc_valid_tm(tm); |
40 | } | 40 | } |
41 | 41 | ||
42 | static int au1xtoy_rtc_set_time(struct device *dev, struct rtc_time *tm) | 42 | static int au1xtoy_rtc_set_time(struct device *dev, struct rtc_time *tm) |
43 | { | 43 | { |
44 | unsigned long t; | 44 | unsigned long t; |
45 | 45 | ||
46 | rtc_tm_to_time(tm, &t); | 46 | rtc_tm_to_time(tm, &t); |
47 | 47 | ||
48 | au_writel(t, SYS_TOYWRITE); | 48 | au_writel(t, SYS_TOYWRITE); |
49 | au_sync(); | 49 | au_sync(); |
50 | 50 | ||
51 | /* wait for the pending register write to succeed. This can | 51 | /* wait for the pending register write to succeed. This can |
52 | * take up to 6 seconds... | 52 | * take up to 6 seconds... |
53 | */ | 53 | */ |
54 | while (au_readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_C0S) | 54 | while (au_readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_C0S) |
55 | msleep(1); | 55 | msleep(1); |
56 | 56 | ||
57 | return 0; | 57 | return 0; |
58 | } | 58 | } |
59 | 59 | ||
60 | static struct rtc_class_ops au1xtoy_rtc_ops = { | 60 | static struct rtc_class_ops au1xtoy_rtc_ops = { |
61 | .read_time = au1xtoy_rtc_read_time, | 61 | .read_time = au1xtoy_rtc_read_time, |
62 | .set_time = au1xtoy_rtc_set_time, | 62 | .set_time = au1xtoy_rtc_set_time, |
63 | }; | 63 | }; |
64 | 64 | ||
65 | static int __devinit au1xtoy_rtc_probe(struct platform_device *pdev) | 65 | static int __devinit au1xtoy_rtc_probe(struct platform_device *pdev) |
66 | { | 66 | { |
67 | struct rtc_device *rtcdev; | 67 | struct rtc_device *rtcdev; |
68 | unsigned long t; | 68 | unsigned long t; |
69 | int ret; | 69 | int ret; |
70 | 70 | ||
71 | t = au_readl(SYS_COUNTER_CNTRL); | 71 | t = au_readl(SYS_COUNTER_CNTRL); |
72 | if (!(t & CNTR_OK)) { | 72 | if (!(t & CNTR_OK)) { |
73 | dev_err(&pdev->dev, "counters not working; aborting.\n"); | 73 | dev_err(&pdev->dev, "counters not working; aborting.\n"); |
74 | ret = -ENODEV; | 74 | ret = -ENODEV; |
75 | goto out_err; | 75 | goto out_err; |
76 | } | 76 | } |
77 | 77 | ||
78 | ret = -ETIMEDOUT; | 78 | ret = -ETIMEDOUT; |
79 | 79 | ||
80 | /* set counter0 tickrate to 1Hz if necessary */ | 80 | /* set counter0 tickrate to 1Hz if necessary */ |
81 | if (au_readl(SYS_TOYTRIM) != 32767) { | 81 | if (au_readl(SYS_TOYTRIM) != 32767) { |
82 | /* wait until hardware gives access to TRIM register */ | 82 | /* wait until hardware gives access to TRIM register */ |
83 | t = 0x00100000; | 83 | t = 0x00100000; |
84 | while ((au_readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_T0S) && t--) | 84 | while ((au_readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_T0S) && --t) |
85 | msleep(1); | 85 | msleep(1); |
86 | 86 | ||
87 | if (!t) { | 87 | if (!t) { |
88 | /* timed out waiting for register access; assume | 88 | /* timed out waiting for register access; assume |
89 | * counters are unusable. | 89 | * counters are unusable. |
90 | */ | 90 | */ |
91 | dev_err(&pdev->dev, "timeout waiting for access\n"); | 91 | dev_err(&pdev->dev, "timeout waiting for access\n"); |
92 | goto out_err; | 92 | goto out_err; |
93 | } | 93 | } |
94 | 94 | ||
95 | /* set 1Hz TOY tick rate */ | 95 | /* set 1Hz TOY tick rate */ |
96 | au_writel(32767, SYS_TOYTRIM); | 96 | au_writel(32767, SYS_TOYTRIM); |
97 | au_sync(); | 97 | au_sync(); |
98 | } | 98 | } |
99 | 99 | ||
100 | /* wait until the hardware allows writes to the counter reg */ | 100 | /* wait until the hardware allows writes to the counter reg */ |
101 | while (au_readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_C0S) | 101 | while (au_readl(SYS_COUNTER_CNTRL) & SYS_CNTRL_C0S) |
102 | msleep(1); | 102 | msleep(1); |
103 | 103 | ||
104 | rtcdev = rtc_device_register("rtc-au1xxx", &pdev->dev, | 104 | rtcdev = rtc_device_register("rtc-au1xxx", &pdev->dev, |
105 | &au1xtoy_rtc_ops, THIS_MODULE); | 105 | &au1xtoy_rtc_ops, THIS_MODULE); |
106 | if (IS_ERR(rtcdev)) { | 106 | if (IS_ERR(rtcdev)) { |
107 | ret = PTR_ERR(rtcdev); | 107 | ret = PTR_ERR(rtcdev); |
108 | goto out_err; | 108 | goto out_err; |
109 | } | 109 | } |
110 | 110 | ||
111 | platform_set_drvdata(pdev, rtcdev); | 111 | platform_set_drvdata(pdev, rtcdev); |
112 | 112 | ||
113 | return 0; | 113 | return 0; |
114 | 114 | ||
115 | out_err: | 115 | out_err: |
116 | return ret; | 116 | return ret; |
117 | } | 117 | } |
118 | 118 | ||
119 | static int __devexit au1xtoy_rtc_remove(struct platform_device *pdev) | 119 | static int __devexit au1xtoy_rtc_remove(struct platform_device *pdev) |
120 | { | 120 | { |
121 | struct rtc_device *rtcdev = platform_get_drvdata(pdev); | 121 | struct rtc_device *rtcdev = platform_get_drvdata(pdev); |
122 | 122 | ||
123 | rtc_device_unregister(rtcdev); | 123 | rtc_device_unregister(rtcdev); |
124 | platform_set_drvdata(pdev, NULL); | 124 | platform_set_drvdata(pdev, NULL); |
125 | 125 | ||
126 | return 0; | 126 | return 0; |
127 | } | 127 | } |
128 | 128 | ||
129 | static struct platform_driver au1xrtc_driver = { | 129 | static struct platform_driver au1xrtc_driver = { |
130 | .driver = { | 130 | .driver = { |
131 | .name = "rtc-au1xxx", | 131 | .name = "rtc-au1xxx", |
132 | .owner = THIS_MODULE, | 132 | .owner = THIS_MODULE, |
133 | }, | 133 | }, |
134 | .remove = __devexit_p(au1xtoy_rtc_remove), | 134 | .remove = __devexit_p(au1xtoy_rtc_remove), |
135 | }; | 135 | }; |
136 | 136 | ||
137 | static int __init au1xtoy_rtc_init(void) | 137 | static int __init au1xtoy_rtc_init(void) |
138 | { | 138 | { |
139 | return platform_driver_probe(&au1xrtc_driver, au1xtoy_rtc_probe); | 139 | return platform_driver_probe(&au1xrtc_driver, au1xtoy_rtc_probe); |
140 | } | 140 | } |
141 | 141 | ||
142 | static void __exit au1xtoy_rtc_exit(void) | 142 | static void __exit au1xtoy_rtc_exit(void) |
143 | { | 143 | { |
144 | platform_driver_unregister(&au1xrtc_driver); | 144 | platform_driver_unregister(&au1xrtc_driver); |
145 | } | 145 | } |
146 | 146 | ||
147 | module_init(au1xtoy_rtc_init); | 147 | module_init(au1xtoy_rtc_init); |
148 | module_exit(au1xtoy_rtc_exit); | 148 | module_exit(au1xtoy_rtc_exit); |
149 | 149 | ||
150 | MODULE_DESCRIPTION("Au1xxx TOY-counter-based RTC driver"); | 150 | MODULE_DESCRIPTION("Au1xxx TOY-counter-based RTC driver"); |
151 | MODULE_AUTHOR("Manuel Lauss <manuel.lauss@gmail.com>"); | 151 | MODULE_AUTHOR("Manuel Lauss <manuel.lauss@gmail.com>"); |
152 | MODULE_LICENSE("GPL"); | 152 | MODULE_LICENSE("GPL"); |
153 | MODULE_ALIAS("platform:rtc-au1xxx"); | 153 | MODULE_ALIAS("platform:rtc-au1xxx"); |
154 | 154 |