aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
authorThomas Gleixner <tglx@linutronix.de>2017-06-27 06:29:32 -0400
committerThomas Gleixner <tglx@linutronix.de>2017-06-27 06:29:32 -0400
commitf5b816786f7687a2ec0f485a1138b009d2020352 (patch)
treeeb5ce868accdb73fe1e768c1ccadb90e9895ab18
parent9902747ec57d11b27c98e53d66112ecceed43c82 (diff)
parent8c3ecd60e2ee6268e1735952e5b544f05b4dbb5a (diff)
Merge branch 'clockevents/4.13' of https://git.linaro.org/people/daniel.lezcano/linux into timers/core
Pull clockevents updates from Daniel Lezcano: - Made the tcb_clksrc endianess agnostic as the AVR32 support is gone (Alexandre Belloni) - Unmap io region on failure at init time in the fsl_ftm_timer (Arvind Yadav) - Fix a bad return value for the mips-gic-timer at init time (Christophe Jaillet) - Fix invalid iomap check and switch the sun4i timer to use the common timer init routine (Daniel Lezcano)
-rw-r--r--drivers/clocksource/Kconfig1
-rw-r--r--drivers/clocksource/fsl_ftm_timer.c8
-rw-r--r--drivers/clocksource/mips-gic-timer.c5
-rw-r--r--drivers/clocksource/sun4i_timer.c171
-rw-r--r--drivers/clocksource/tcb_clksrc.c58
-rw-r--r--drivers/clocksource/timer-of.c2
6 files changed, 117 insertions, 128 deletions
diff --git a/drivers/clocksource/Kconfig b/drivers/clocksource/Kconfig
index 4be163bca8a8..88818a43d6e9 100644
--- a/drivers/clocksource/Kconfig
+++ b/drivers/clocksource/Kconfig
@@ -108,6 +108,7 @@ config SUN4I_TIMER
108 depends on GENERIC_CLOCKEVENTS 108 depends on GENERIC_CLOCKEVENTS
109 depends on HAS_IOMEM 109 depends on HAS_IOMEM
110 select CLKSRC_MMIO 110 select CLKSRC_MMIO
111 select TIMER_OF
111 help 112 help
112 Enables support for the Sun4i timer. 113 Enables support for the Sun4i timer.
113 114
diff --git a/drivers/clocksource/fsl_ftm_timer.c b/drivers/clocksource/fsl_ftm_timer.c
index 3121e2d96c91..3ee7e6fea621 100644
--- a/drivers/clocksource/fsl_ftm_timer.c
+++ b/drivers/clocksource/fsl_ftm_timer.c
@@ -329,13 +329,13 @@ static int __init ftm_timer_init(struct device_node *np)
329 priv->clkevt_base = of_iomap(np, 0); 329 priv->clkevt_base = of_iomap(np, 0);
330 if (!priv->clkevt_base) { 330 if (!priv->clkevt_base) {
331 pr_err("ftm: unable to map event timer registers\n"); 331 pr_err("ftm: unable to map event timer registers\n");
332 goto err; 332 goto err_clkevt;
333 } 333 }
334 334
335 priv->clksrc_base = of_iomap(np, 1); 335 priv->clksrc_base = of_iomap(np, 1);
336 if (!priv->clksrc_base) { 336 if (!priv->clksrc_base) {
337 pr_err("ftm: unable to map source timer registers\n"); 337 pr_err("ftm: unable to map source timer registers\n");
338 goto err; 338 goto err_clksrc;
339 } 339 }
340 340
341 ret = -EINVAL; 341 ret = -EINVAL;
@@ -366,6 +366,10 @@ static int __init ftm_timer_init(struct device_node *np)
366 return 0; 366 return 0;
367 367
368err: 368err:
369 iounmap(priv->clksrc_base);
370err_clksrc:
371 iounmap(priv->clkevt_base);
372err_clkevt:
369 kfree(priv); 373 kfree(priv);
370 return ret; 374 return ret;
371} 375}
diff --git a/drivers/clocksource/mips-gic-timer.c b/drivers/clocksource/mips-gic-timer.c
index e31e08326024..17b861ea2626 100644
--- a/drivers/clocksource/mips-gic-timer.c
+++ b/drivers/clocksource/mips-gic-timer.c
@@ -167,10 +167,11 @@ static int __init gic_clocksource_of_init(struct device_node *node)
167 167
168 clk = of_clk_get(node, 0); 168 clk = of_clk_get(node, 0);
169 if (!IS_ERR(clk)) { 169 if (!IS_ERR(clk)) {
170 if (clk_prepare_enable(clk) < 0) { 170 ret = clk_prepare_enable(clk);
171 if (ret < 0) {
171 pr_err("GIC failed to enable clock\n"); 172 pr_err("GIC failed to enable clock\n");
172 clk_put(clk); 173 clk_put(clk);
173 return PTR_ERR(clk); 174 return ret;
174 } 175 }
175 176
176 gic_frequency = clk_get_rate(clk); 177 gic_frequency = clk_get_rate(clk);
diff --git a/drivers/clocksource/sun4i_timer.c b/drivers/clocksource/sun4i_timer.c
index 3e4bc64ff176..6e0180aaf784 100644
--- a/drivers/clocksource/sun4i_timer.c
+++ b/drivers/clocksource/sun4i_timer.c
@@ -24,6 +24,8 @@
24#include <linux/of_address.h> 24#include <linux/of_address.h>
25#include <linux/of_irq.h> 25#include <linux/of_irq.h>
26 26
27#include "timer-of.h"
28
27#define TIMER_IRQ_EN_REG 0x00 29#define TIMER_IRQ_EN_REG 0x00
28#define TIMER_IRQ_EN(val) BIT(val) 30#define TIMER_IRQ_EN(val) BIT(val)
29#define TIMER_IRQ_ST_REG 0x04 31#define TIMER_IRQ_ST_REG 0x04
@@ -39,38 +41,37 @@
39 41
40#define TIMER_SYNC_TICKS 3 42#define TIMER_SYNC_TICKS 3
41 43
42static void __iomem *timer_base;
43static u32 ticks_per_jiffy;
44
45/* 44/*
46 * When we disable a timer, we need to wait at least for 2 cycles of 45 * When we disable a timer, we need to wait at least for 2 cycles of
47 * the timer source clock. We will use for that the clocksource timer 46 * the timer source clock. We will use for that the clocksource timer
48 * that is already setup and runs at the same frequency than the other 47 * that is already setup and runs at the same frequency than the other
49 * timers, and we never will be disabled. 48 * timers, and we never will be disabled.
50 */ 49 */
51static void sun4i_clkevt_sync(void) 50static void sun4i_clkevt_sync(void __iomem *base)
52{ 51{
53 u32 old = readl(timer_base + TIMER_CNTVAL_REG(1)); 52 u32 old = readl(base + TIMER_CNTVAL_REG(1));
54 53
55 while ((old - readl(timer_base + TIMER_CNTVAL_REG(1))) < TIMER_SYNC_TICKS) 54 while ((old - readl(base + TIMER_CNTVAL_REG(1))) < TIMER_SYNC_TICKS)
56 cpu_relax(); 55 cpu_relax();
57} 56}
58 57
59static void sun4i_clkevt_time_stop(u8 timer) 58static void sun4i_clkevt_time_stop(void __iomem *base, u8 timer)
60{ 59{
61 u32 val = readl(timer_base + TIMER_CTL_REG(timer)); 60 u32 val = readl(base + TIMER_CTL_REG(timer));
62 writel(val & ~TIMER_CTL_ENABLE, timer_base + TIMER_CTL_REG(timer)); 61 writel(val & ~TIMER_CTL_ENABLE, base + TIMER_CTL_REG(timer));
63 sun4i_clkevt_sync(); 62 sun4i_clkevt_sync(base);
64} 63}
65 64
66static void sun4i_clkevt_time_setup(u8 timer, unsigned long delay) 65static void sun4i_clkevt_time_setup(void __iomem *base, u8 timer,
66 unsigned long delay)
67{ 67{
68 writel(delay, timer_base + TIMER_INTVAL_REG(timer)); 68 writel(delay, base + TIMER_INTVAL_REG(timer));
69} 69}
70 70
71static void sun4i_clkevt_time_start(u8 timer, bool periodic) 71static void sun4i_clkevt_time_start(void __iomem *base, u8 timer,
72 bool periodic)
72{ 73{
73 u32 val = readl(timer_base + TIMER_CTL_REG(timer)); 74 u32 val = readl(base + TIMER_CTL_REG(timer));
74 75
75 if (periodic) 76 if (periodic)
76 val &= ~TIMER_CTL_ONESHOT; 77 val &= ~TIMER_CTL_ONESHOT;
@@ -78,115 +79,106 @@ static void sun4i_clkevt_time_start(u8 timer, bool periodic)
78 val |= TIMER_CTL_ONESHOT; 79 val |= TIMER_CTL_ONESHOT;
79 80
80 writel(val | TIMER_CTL_ENABLE | TIMER_CTL_RELOAD, 81 writel(val | TIMER_CTL_ENABLE | TIMER_CTL_RELOAD,
81 timer_base + TIMER_CTL_REG(timer)); 82 base + TIMER_CTL_REG(timer));
82} 83}
83 84
84static int sun4i_clkevt_shutdown(struct clock_event_device *evt) 85static int sun4i_clkevt_shutdown(struct clock_event_device *evt)
85{ 86{
86 sun4i_clkevt_time_stop(0); 87 struct timer_of *to = to_timer_of(evt);
88
89 sun4i_clkevt_time_stop(timer_of_base(to), 0);
90
87 return 0; 91 return 0;
88} 92}
89 93
90static int sun4i_clkevt_set_oneshot(struct clock_event_device *evt) 94static int sun4i_clkevt_set_oneshot(struct clock_event_device *evt)
91{ 95{
92 sun4i_clkevt_time_stop(0); 96 struct timer_of *to = to_timer_of(evt);
93 sun4i_clkevt_time_start(0, false); 97
98 sun4i_clkevt_time_stop(timer_of_base(to), 0);
99 sun4i_clkevt_time_start(timer_of_base(to), 0, false);
100
94 return 0; 101 return 0;
95} 102}
96 103
97static int sun4i_clkevt_set_periodic(struct clock_event_device *evt) 104static int sun4i_clkevt_set_periodic(struct clock_event_device *evt)
98{ 105{
99 sun4i_clkevt_time_stop(0); 106 struct timer_of *to = to_timer_of(evt);
100 sun4i_clkevt_time_setup(0, ticks_per_jiffy); 107
101 sun4i_clkevt_time_start(0, true); 108 sun4i_clkevt_time_stop(timer_of_base(to), 0);
109 sun4i_clkevt_time_setup(timer_of_base(to), 0, timer_of_period(to));
110 sun4i_clkevt_time_start(timer_of_base(to), 0, true);
111
102 return 0; 112 return 0;
103} 113}
104 114
105static int sun4i_clkevt_next_event(unsigned long evt, 115static int sun4i_clkevt_next_event(unsigned long evt,
106 struct clock_event_device *unused) 116 struct clock_event_device *clkevt)
107{ 117{
108 sun4i_clkevt_time_stop(0); 118 struct timer_of *to = to_timer_of(clkevt);
109 sun4i_clkevt_time_setup(0, evt - TIMER_SYNC_TICKS); 119
110 sun4i_clkevt_time_start(0, false); 120 sun4i_clkevt_time_stop(timer_of_base(to), 0);
121 sun4i_clkevt_time_setup(timer_of_base(to), 0, evt - TIMER_SYNC_TICKS);
122 sun4i_clkevt_time_start(timer_of_base(to), 0, false);
111 123
112 return 0; 124 return 0;
113} 125}
114 126
115static struct clock_event_device sun4i_clockevent = { 127static void sun4i_timer_clear_interrupt(void __iomem *base)
116 .name = "sun4i_tick",
117 .rating = 350,
118 .features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT,
119 .set_state_shutdown = sun4i_clkevt_shutdown,
120 .set_state_periodic = sun4i_clkevt_set_periodic,
121 .set_state_oneshot = sun4i_clkevt_set_oneshot,
122 .tick_resume = sun4i_clkevt_shutdown,
123 .set_next_event = sun4i_clkevt_next_event,
124};
125
126static void sun4i_timer_clear_interrupt(void)
127{ 128{
128 writel(TIMER_IRQ_EN(0), timer_base + TIMER_IRQ_ST_REG); 129 writel(TIMER_IRQ_EN(0), base + TIMER_IRQ_ST_REG);
129} 130}
130 131
131static irqreturn_t sun4i_timer_interrupt(int irq, void *dev_id) 132static irqreturn_t sun4i_timer_interrupt(int irq, void *dev_id)
132{ 133{
133 struct clock_event_device *evt = (struct clock_event_device *)dev_id; 134 struct clock_event_device *evt = (struct clock_event_device *)dev_id;
135 struct timer_of *to = to_timer_of(evt);
134 136
135 sun4i_timer_clear_interrupt(); 137 sun4i_timer_clear_interrupt(timer_of_base(to));
136 evt->event_handler(evt); 138 evt->event_handler(evt);
137 139
138 return IRQ_HANDLED; 140 return IRQ_HANDLED;
139} 141}
140 142
141static struct irqaction sun4i_timer_irq = { 143static struct timer_of to = {
142 .name = "sun4i_timer0", 144 .flags = TIMER_OF_IRQ | TIMER_OF_CLOCK | TIMER_OF_BASE,
143 .flags = IRQF_TIMER | IRQF_IRQPOLL, 145
144 .handler = sun4i_timer_interrupt, 146 .clkevt = {
145 .dev_id = &sun4i_clockevent, 147 .name = "sun4i_tick",
148 .rating = 350,
149 .features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT,
150 .set_state_shutdown = sun4i_clkevt_shutdown,
151 .set_state_periodic = sun4i_clkevt_set_periodic,
152 .set_state_oneshot = sun4i_clkevt_set_oneshot,
153 .tick_resume = sun4i_clkevt_shutdown,
154 .set_next_event = sun4i_clkevt_next_event,
155 .cpumask = cpu_possible_mask,
156 },
157
158 .of_irq = {
159 .handler = sun4i_timer_interrupt,
160 .flags = IRQF_TIMER | IRQF_IRQPOLL,
161 },
146}; 162};
147 163
148static u64 notrace sun4i_timer_sched_read(void) 164static u64 notrace sun4i_timer_sched_read(void)
149{ 165{
150 return ~readl(timer_base + TIMER_CNTVAL_REG(1)); 166 return ~readl(timer_of_base(&to) + TIMER_CNTVAL_REG(1));
151} 167}
152 168
153static int __init sun4i_timer_init(struct device_node *node) 169static int __init sun4i_timer_init(struct device_node *node)
154{ 170{
155 unsigned long rate = 0; 171 int ret;
156 struct clk *clk;
157 int ret, irq;
158 u32 val; 172 u32 val;
159 173
160 timer_base = of_iomap(node, 0); 174 ret = timer_of_init(node, &to);
161 if (!timer_base) { 175 if (ret)
162 pr_crit("Can't map registers\n");
163 return -ENXIO;
164 }
165
166 irq = irq_of_parse_and_map(node, 0);
167 if (irq <= 0) {
168 pr_crit("Can't parse IRQ\n");
169 return -EINVAL;
170 }
171
172 clk = of_clk_get(node, 0);
173 if (IS_ERR(clk)) {
174 pr_crit("Can't get timer clock\n");
175 return PTR_ERR(clk);
176 }
177
178 ret = clk_prepare_enable(clk);
179 if (ret) {
180 pr_err("Failed to prepare clock\n");
181 return ret; 176 return ret;
182 }
183
184 rate = clk_get_rate(clk);
185 177
186 writel(~0, timer_base + TIMER_INTVAL_REG(1)); 178 writel(~0, timer_of_base(&to) + TIMER_INTVAL_REG(1));
187 writel(TIMER_CTL_ENABLE | TIMER_CTL_RELOAD | 179 writel(TIMER_CTL_ENABLE | TIMER_CTL_RELOAD |
188 TIMER_CTL_CLK_SRC(TIMER_CTL_CLK_SRC_OSC24M), 180 TIMER_CTL_CLK_SRC(TIMER_CTL_CLK_SRC_OSC24M),
189 timer_base + TIMER_CTL_REG(1)); 181 timer_of_base(&to) + TIMER_CTL_REG(1));
190 182
191 /* 183 /*
192 * sched_clock_register does not have priorities, and on sun6i and 184 * sched_clock_register does not have priorities, and on sun6i and
@@ -195,41 +187,32 @@ static int __init sun4i_timer_init(struct device_node *node)
195 if (of_machine_is_compatible("allwinner,sun4i-a10") || 187 if (of_machine_is_compatible("allwinner,sun4i-a10") ||
196 of_machine_is_compatible("allwinner,sun5i-a13") || 188 of_machine_is_compatible("allwinner,sun5i-a13") ||
197 of_machine_is_compatible("allwinner,sun5i-a10s")) 189 of_machine_is_compatible("allwinner,sun5i-a10s"))
198 sched_clock_register(sun4i_timer_sched_read, 32, rate); 190 sched_clock_register(sun4i_timer_sched_read, 32,
191 timer_of_rate(&to));
199 192
200 ret = clocksource_mmio_init(timer_base + TIMER_CNTVAL_REG(1), node->name, 193 ret = clocksource_mmio_init(timer_of_base(&to) + TIMER_CNTVAL_REG(1),
201 rate, 350, 32, clocksource_mmio_readl_down); 194 node->name, timer_of_rate(&to), 350, 32,
195 clocksource_mmio_readl_down);
202 if (ret) { 196 if (ret) {
203 pr_err("Failed to register clocksource\n"); 197 pr_err("Failed to register clocksource\n");
204 return ret; 198 return ret;
205 } 199 }
206 200
207 ticks_per_jiffy = DIV_ROUND_UP(rate, HZ);
208
209 writel(TIMER_CTL_CLK_SRC(TIMER_CTL_CLK_SRC_OSC24M), 201 writel(TIMER_CTL_CLK_SRC(TIMER_CTL_CLK_SRC_OSC24M),
210 timer_base + TIMER_CTL_REG(0)); 202 timer_of_base(&to) + TIMER_CTL_REG(0));
211 203
212 /* Make sure timer is stopped before playing with interrupts */ 204 /* Make sure timer is stopped before playing with interrupts */
213 sun4i_clkevt_time_stop(0); 205 sun4i_clkevt_time_stop(timer_of_base(&to), 0);
214 206
215 /* clear timer0 interrupt */ 207 /* clear timer0 interrupt */
216 sun4i_timer_clear_interrupt(); 208 sun4i_timer_clear_interrupt(timer_of_base(&to));
217
218 sun4i_clockevent.cpumask = cpu_possible_mask;
219 sun4i_clockevent.irq = irq;
220 209
221 clockevents_config_and_register(&sun4i_clockevent, rate, 210 clockevents_config_and_register(&to.clkevt, timer_of_rate(&to),
222 TIMER_SYNC_TICKS, 0xffffffff); 211 TIMER_SYNC_TICKS, 0xffffffff);
223 212
224 ret = setup_irq(irq, &sun4i_timer_irq);
225 if (ret) {
226 pr_err("failed to setup irq %d\n", irq);
227 return ret;
228 }
229
230 /* Enable timer0 interrupt */ 213 /* Enable timer0 interrupt */
231 val = readl(timer_base + TIMER_IRQ_EN_REG); 214 val = readl(timer_of_base(&to) + TIMER_IRQ_EN_REG);
232 writel(val | TIMER_IRQ_EN(0), timer_base + TIMER_IRQ_EN_REG); 215 writel(val | TIMER_IRQ_EN(0), timer_of_base(&to) + TIMER_IRQ_EN_REG);
233 216
234 return ret; 217 return ret;
235} 218}
diff --git a/drivers/clocksource/tcb_clksrc.c b/drivers/clocksource/tcb_clksrc.c
index 828729c70a0c..59e8aee0ec16 100644
--- a/drivers/clocksource/tcb_clksrc.c
+++ b/drivers/clocksource/tcb_clksrc.c
@@ -57,9 +57,9 @@ static u64 tc_get_cycles(struct clocksource *cs)
57 57
58 raw_local_irq_save(flags); 58 raw_local_irq_save(flags);
59 do { 59 do {
60 upper = __raw_readl(tcaddr + ATMEL_TC_REG(1, CV)); 60 upper = readl_relaxed(tcaddr + ATMEL_TC_REG(1, CV));
61 lower = __raw_readl(tcaddr + ATMEL_TC_REG(0, CV)); 61 lower = readl_relaxed(tcaddr + ATMEL_TC_REG(0, CV));
62 } while (upper != __raw_readl(tcaddr + ATMEL_TC_REG(1, CV))); 62 } while (upper != readl_relaxed(tcaddr + ATMEL_TC_REG(1, CV)));
63 63
64 raw_local_irq_restore(flags); 64 raw_local_irq_restore(flags);
65 return (upper << 16) | lower; 65 return (upper << 16) | lower;
@@ -67,7 +67,7 @@ static u64 tc_get_cycles(struct clocksource *cs)
67 67
68static u64 tc_get_cycles32(struct clocksource *cs) 68static u64 tc_get_cycles32(struct clocksource *cs)
69{ 69{
70 return __raw_readl(tcaddr + ATMEL_TC_REG(0, CV)); 70 return readl_relaxed(tcaddr + ATMEL_TC_REG(0, CV));
71} 71}
72 72
73void tc_clksrc_suspend(struct clocksource *cs) 73void tc_clksrc_suspend(struct clocksource *cs)
@@ -147,8 +147,8 @@ static int tc_shutdown(struct clock_event_device *d)
147 struct tc_clkevt_device *tcd = to_tc_clkevt(d); 147 struct tc_clkevt_device *tcd = to_tc_clkevt(d);
148 void __iomem *regs = tcd->regs; 148 void __iomem *regs = tcd->regs;
149 149
150 __raw_writel(0xff, regs + ATMEL_TC_REG(2, IDR)); 150 writel(0xff, regs + ATMEL_TC_REG(2, IDR));
151 __raw_writel(ATMEL_TC_CLKDIS, regs + ATMEL_TC_REG(2, CCR)); 151 writel(ATMEL_TC_CLKDIS, regs + ATMEL_TC_REG(2, CCR));
152 if (!clockevent_state_detached(d)) 152 if (!clockevent_state_detached(d))
153 clk_disable(tcd->clk); 153 clk_disable(tcd->clk);
154 154
@@ -166,9 +166,9 @@ static int tc_set_oneshot(struct clock_event_device *d)
166 clk_enable(tcd->clk); 166 clk_enable(tcd->clk);
167 167
168 /* slow clock, count up to RC, then irq and stop */ 168 /* slow clock, count up to RC, then irq and stop */
169 __raw_writel(timer_clock | ATMEL_TC_CPCSTOP | ATMEL_TC_WAVE | 169 writel(timer_clock | ATMEL_TC_CPCSTOP | ATMEL_TC_WAVE |
170 ATMEL_TC_WAVESEL_UP_AUTO, regs + ATMEL_TC_REG(2, CMR)); 170 ATMEL_TC_WAVESEL_UP_AUTO, regs + ATMEL_TC_REG(2, CMR));
171 __raw_writel(ATMEL_TC_CPCS, regs + ATMEL_TC_REG(2, IER)); 171 writel(ATMEL_TC_CPCS, regs + ATMEL_TC_REG(2, IER));
172 172
173 /* set_next_event() configures and starts the timer */ 173 /* set_next_event() configures and starts the timer */
174 return 0; 174 return 0;
@@ -188,25 +188,25 @@ static int tc_set_periodic(struct clock_event_device *d)
188 clk_enable(tcd->clk); 188 clk_enable(tcd->clk);
189 189
190 /* slow clock, count up to RC, then irq and restart */ 190 /* slow clock, count up to RC, then irq and restart */
191 __raw_writel(timer_clock | ATMEL_TC_WAVE | ATMEL_TC_WAVESEL_UP_AUTO, 191 writel(timer_clock | ATMEL_TC_WAVE | ATMEL_TC_WAVESEL_UP_AUTO,
192 regs + ATMEL_TC_REG(2, CMR)); 192 regs + ATMEL_TC_REG(2, CMR));
193 __raw_writel((32768 + HZ / 2) / HZ, tcaddr + ATMEL_TC_REG(2, RC)); 193 writel((32768 + HZ / 2) / HZ, tcaddr + ATMEL_TC_REG(2, RC));
194 194
195 /* Enable clock and interrupts on RC compare */ 195 /* Enable clock and interrupts on RC compare */
196 __raw_writel(ATMEL_TC_CPCS, regs + ATMEL_TC_REG(2, IER)); 196 writel(ATMEL_TC_CPCS, regs + ATMEL_TC_REG(2, IER));
197 197
198 /* go go gadget! */ 198 /* go go gadget! */
199 __raw_writel(ATMEL_TC_CLKEN | ATMEL_TC_SWTRG, regs + 199 writel(ATMEL_TC_CLKEN | ATMEL_TC_SWTRG, regs +
200 ATMEL_TC_REG(2, CCR)); 200 ATMEL_TC_REG(2, CCR));
201 return 0; 201 return 0;
202} 202}
203 203
204static int tc_next_event(unsigned long delta, struct clock_event_device *d) 204static int tc_next_event(unsigned long delta, struct clock_event_device *d)
205{ 205{
206 __raw_writel(delta, tcaddr + ATMEL_TC_REG(2, RC)); 206 writel_relaxed(delta, tcaddr + ATMEL_TC_REG(2, RC));
207 207
208 /* go go gadget! */ 208 /* go go gadget! */
209 __raw_writel(ATMEL_TC_CLKEN | ATMEL_TC_SWTRG, 209 writel_relaxed(ATMEL_TC_CLKEN | ATMEL_TC_SWTRG,
210 tcaddr + ATMEL_TC_REG(2, CCR)); 210 tcaddr + ATMEL_TC_REG(2, CCR));
211 return 0; 211 return 0;
212} 212}
@@ -230,7 +230,7 @@ static irqreturn_t ch2_irq(int irq, void *handle)
230 struct tc_clkevt_device *dev = handle; 230 struct tc_clkevt_device *dev = handle;
231 unsigned int sr; 231 unsigned int sr;
232 232
233 sr = __raw_readl(dev->regs + ATMEL_TC_REG(2, SR)); 233 sr = readl_relaxed(dev->regs + ATMEL_TC_REG(2, SR));
234 if (sr & ATMEL_TC_CPCS) { 234 if (sr & ATMEL_TC_CPCS) {
235 dev->clkevt.event_handler(&dev->clkevt); 235 dev->clkevt.event_handler(&dev->clkevt);
236 return IRQ_HANDLED; 236 return IRQ_HANDLED;
@@ -290,43 +290,43 @@ static int __init setup_clkevents(struct atmel_tc *tc, int clk32k_divisor_idx)
290static void __init tcb_setup_dual_chan(struct atmel_tc *tc, int mck_divisor_idx) 290static void __init tcb_setup_dual_chan(struct atmel_tc *tc, int mck_divisor_idx)
291{ 291{
292 /* channel 0: waveform mode, input mclk/8, clock TIOA0 on overflow */ 292 /* channel 0: waveform mode, input mclk/8, clock TIOA0 on overflow */
293 __raw_writel(mck_divisor_idx /* likely divide-by-8 */ 293 writel(mck_divisor_idx /* likely divide-by-8 */
294 | ATMEL_TC_WAVE 294 | ATMEL_TC_WAVE
295 | ATMEL_TC_WAVESEL_UP /* free-run */ 295 | ATMEL_TC_WAVESEL_UP /* free-run */
296 | ATMEL_TC_ACPA_SET /* TIOA0 rises at 0 */ 296 | ATMEL_TC_ACPA_SET /* TIOA0 rises at 0 */
297 | ATMEL_TC_ACPC_CLEAR, /* (duty cycle 50%) */ 297 | ATMEL_TC_ACPC_CLEAR, /* (duty cycle 50%) */
298 tcaddr + ATMEL_TC_REG(0, CMR)); 298 tcaddr + ATMEL_TC_REG(0, CMR));
299 __raw_writel(0x0000, tcaddr + ATMEL_TC_REG(0, RA)); 299 writel(0x0000, tcaddr + ATMEL_TC_REG(0, RA));
300 __raw_writel(0x8000, tcaddr + ATMEL_TC_REG(0, RC)); 300 writel(0x8000, tcaddr + ATMEL_TC_REG(0, RC));
301 __raw_writel(0xff, tcaddr + ATMEL_TC_REG(0, IDR)); /* no irqs */ 301 writel(0xff, tcaddr + ATMEL_TC_REG(0, IDR)); /* no irqs */
302 __raw_writel(ATMEL_TC_CLKEN, tcaddr + ATMEL_TC_REG(0, CCR)); 302 writel(ATMEL_TC_CLKEN, tcaddr + ATMEL_TC_REG(0, CCR));
303 303
304 /* channel 1: waveform mode, input TIOA0 */ 304 /* channel 1: waveform mode, input TIOA0 */
305 __raw_writel(ATMEL_TC_XC1 /* input: TIOA0 */ 305 writel(ATMEL_TC_XC1 /* input: TIOA0 */
306 | ATMEL_TC_WAVE 306 | ATMEL_TC_WAVE
307 | ATMEL_TC_WAVESEL_UP, /* free-run */ 307 | ATMEL_TC_WAVESEL_UP, /* free-run */
308 tcaddr + ATMEL_TC_REG(1, CMR)); 308 tcaddr + ATMEL_TC_REG(1, CMR));
309 __raw_writel(0xff, tcaddr + ATMEL_TC_REG(1, IDR)); /* no irqs */ 309 writel(0xff, tcaddr + ATMEL_TC_REG(1, IDR)); /* no irqs */
310 __raw_writel(ATMEL_TC_CLKEN, tcaddr + ATMEL_TC_REG(1, CCR)); 310 writel(ATMEL_TC_CLKEN, tcaddr + ATMEL_TC_REG(1, CCR));
311 311
312 /* chain channel 0 to channel 1*/ 312 /* chain channel 0 to channel 1*/
313 __raw_writel(ATMEL_TC_TC1XC1S_TIOA0, tcaddr + ATMEL_TC_BMR); 313 writel(ATMEL_TC_TC1XC1S_TIOA0, tcaddr + ATMEL_TC_BMR);
314 /* then reset all the timers */ 314 /* then reset all the timers */
315 __raw_writel(ATMEL_TC_SYNC, tcaddr + ATMEL_TC_BCR); 315 writel(ATMEL_TC_SYNC, tcaddr + ATMEL_TC_BCR);
316} 316}
317 317
318static void __init tcb_setup_single_chan(struct atmel_tc *tc, int mck_divisor_idx) 318static void __init tcb_setup_single_chan(struct atmel_tc *tc, int mck_divisor_idx)
319{ 319{
320 /* channel 0: waveform mode, input mclk/8 */ 320 /* channel 0: waveform mode, input mclk/8 */
321 __raw_writel(mck_divisor_idx /* likely divide-by-8 */ 321 writel(mck_divisor_idx /* likely divide-by-8 */
322 | ATMEL_TC_WAVE 322 | ATMEL_TC_WAVE
323 | ATMEL_TC_WAVESEL_UP, /* free-run */ 323 | ATMEL_TC_WAVESEL_UP, /* free-run */
324 tcaddr + ATMEL_TC_REG(0, CMR)); 324 tcaddr + ATMEL_TC_REG(0, CMR));
325 __raw_writel(0xff, tcaddr + ATMEL_TC_REG(0, IDR)); /* no irqs */ 325 writel(0xff, tcaddr + ATMEL_TC_REG(0, IDR)); /* no irqs */
326 __raw_writel(ATMEL_TC_CLKEN, tcaddr + ATMEL_TC_REG(0, CCR)); 326 writel(ATMEL_TC_CLKEN, tcaddr + ATMEL_TC_REG(0, CCR));
327 327
328 /* then reset all the timers */ 328 /* then reset all the timers */
329 __raw_writel(ATMEL_TC_SYNC, tcaddr + ATMEL_TC_BCR); 329 writel(ATMEL_TC_SYNC, tcaddr + ATMEL_TC_BCR);
330} 330}
331 331
332static int __init tcb_clksrc_init(void) 332static int __init tcb_clksrc_init(void)
diff --git a/drivers/clocksource/timer-of.c b/drivers/clocksource/timer-of.c
index 64b1c2081a67..f6e7491c873c 100644
--- a/drivers/clocksource/timer-of.c
+++ b/drivers/clocksource/timer-of.c
@@ -120,7 +120,7 @@ static __init int timer_base_init(struct device_node *np,
120 const char *name = of_base->name ? of_base->name : np->full_name; 120 const char *name = of_base->name ? of_base->name : np->full_name;
121 121
122 of_base->base = of_io_request_and_map(np, of_base->index, name); 122 of_base->base = of_io_request_and_map(np, of_base->index, name);
123 if (of_base->base) { 123 if (!of_base->base) {
124 pr_err("Failed to iomap (%s)\n", name); 124 pr_err("Failed to iomap (%s)\n", name);
125 return -ENXIO; 125 return -ENXIO;
126 } 126 }