aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/clocksource/qcom-timer.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/clocksource/qcom-timer.c')
-rw-r--r--drivers/clocksource/qcom-timer.c27
1 files changed, 15 insertions, 12 deletions
diff --git a/drivers/clocksource/qcom-timer.c b/drivers/clocksource/qcom-timer.c
index f8e09f923651..79f73bddc5f4 100644
--- a/drivers/clocksource/qcom-timer.c
+++ b/drivers/clocksource/qcom-timer.c
@@ -178,7 +178,7 @@ static struct delay_timer msm_delay_timer = {
178 .read_current_timer = msm_read_current_timer, 178 .read_current_timer = msm_read_current_timer,
179}; 179};
180 180
181static void __init msm_timer_init(u32 dgt_hz, int sched_bits, int irq, 181static int __init msm_timer_init(u32 dgt_hz, int sched_bits, int irq,
182 bool percpu) 182 bool percpu)
183{ 183{
184 struct clocksource *cs = &msm_clocksource; 184 struct clocksource *cs = &msm_clocksource;
@@ -218,12 +218,14 @@ err:
218 sched_clock_register(msm_sched_clock_read, sched_bits, dgt_hz); 218 sched_clock_register(msm_sched_clock_read, sched_bits, dgt_hz);
219 msm_delay_timer.freq = dgt_hz; 219 msm_delay_timer.freq = dgt_hz;
220 register_current_timer_delay(&msm_delay_timer); 220 register_current_timer_delay(&msm_delay_timer);
221
222 return res;
221} 223}
222 224
223static void __init msm_dt_timer_init(struct device_node *np) 225static int __init msm_dt_timer_init(struct device_node *np)
224{ 226{
225 u32 freq; 227 u32 freq;
226 int irq; 228 int irq, ret;
227 struct resource res; 229 struct resource res;
228 u32 percpu_offset; 230 u32 percpu_offset;
229 void __iomem *base; 231 void __iomem *base;
@@ -232,34 +234,35 @@ static void __init msm_dt_timer_init(struct device_node *np)
232 base = of_iomap(np, 0); 234 base = of_iomap(np, 0);
233 if (!base) { 235 if (!base) {
234 pr_err("Failed to map event base\n"); 236 pr_err("Failed to map event base\n");
235 return; 237 return -ENXIO;
236 } 238 }
237 239
238 /* We use GPT0 for the clockevent */ 240 /* We use GPT0 for the clockevent */
239 irq = irq_of_parse_and_map(np, 1); 241 irq = irq_of_parse_and_map(np, 1);
240 if (irq <= 0) { 242 if (irq <= 0) {
241 pr_err("Can't get irq\n"); 243 pr_err("Can't get irq\n");
242 return; 244 return -EINVAL;
243 } 245 }
244 246
245 /* We use CPU0's DGT for the clocksource */ 247 /* We use CPU0's DGT for the clocksource */
246 if (of_property_read_u32(np, "cpu-offset", &percpu_offset)) 248 if (of_property_read_u32(np, "cpu-offset", &percpu_offset))
247 percpu_offset = 0; 249 percpu_offset = 0;
248 250
249 if (of_address_to_resource(np, 0, &res)) { 251 ret = of_address_to_resource(np, 0, &res);
252 if (ret) {
250 pr_err("Failed to parse DGT resource\n"); 253 pr_err("Failed to parse DGT resource\n");
251 return; 254 return ret;
252 } 255 }
253 256
254 cpu0_base = ioremap(res.start + percpu_offset, resource_size(&res)); 257 cpu0_base = ioremap(res.start + percpu_offset, resource_size(&res));
255 if (!cpu0_base) { 258 if (!cpu0_base) {
256 pr_err("Failed to map source base\n"); 259 pr_err("Failed to map source base\n");
257 return; 260 return -EINVAL;
258 } 261 }
259 262
260 if (of_property_read_u32(np, "clock-frequency", &freq)) { 263 if (of_property_read_u32(np, "clock-frequency", &freq)) {
261 pr_err("Unknown frequency\n"); 264 pr_err("Unknown frequency\n");
262 return; 265 return -EINVAL;
263 } 266 }
264 267
265 event_base = base + 0x4; 268 event_base = base + 0x4;
@@ -268,7 +271,7 @@ static void __init msm_dt_timer_init(struct device_node *np)
268 freq /= 4; 271 freq /= 4;
269 writel_relaxed(DGT_CLK_CTL_DIV_4, source_base + DGT_CLK_CTL); 272 writel_relaxed(DGT_CLK_CTL_DIV_4, source_base + DGT_CLK_CTL);
270 273
271 msm_timer_init(freq, 32, irq, !!percpu_offset); 274 return msm_timer_init(freq, 32, irq, !!percpu_offset);
272} 275}
273CLOCKSOURCE_OF_DECLARE(kpss_timer, "qcom,kpss-timer", msm_dt_timer_init); 276CLOCKSOURCE_OF_DECLARE_RET(kpss_timer, "qcom,kpss-timer", msm_dt_timer_init);
274CLOCKSOURCE_OF_DECLARE(scss_timer, "qcom,scss-timer", msm_dt_timer_init); 277CLOCKSOURCE_OF_DECLARE_RET(scss_timer, "qcom,scss-timer", msm_dt_timer_init);