diff options
Diffstat (limited to 'drivers/clocksource/qcom-timer.c')
-rw-r--r-- | drivers/clocksource/qcom-timer.c | 27 |
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 | ||
181 | static void __init msm_timer_init(u32 dgt_hz, int sched_bits, int irq, | 181 | static 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 | ||
223 | static void __init msm_dt_timer_init(struct device_node *np) | 225 | static 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 | } |
273 | CLOCKSOURCE_OF_DECLARE(kpss_timer, "qcom,kpss-timer", msm_dt_timer_init); | 276 | CLOCKSOURCE_OF_DECLARE_RET(kpss_timer, "qcom,kpss-timer", msm_dt_timer_init); |
274 | CLOCKSOURCE_OF_DECLARE(scss_timer, "qcom,scss-timer", msm_dt_timer_init); | 277 | CLOCKSOURCE_OF_DECLARE_RET(scss_timer, "qcom,scss-timer", msm_dt_timer_init); |