Commit 5a54c187 authored by Daniel Lezcano's avatar Daniel Lezcano

clocksource/drivers/arm_global_timer: Convert init function to return error

The init functions do not return any error. They behave as the following:

  - panic, thus leading to a kernel crash while another timer may work and
       make the system boot up correctly

  or

  - print an error and let the caller unaware if the state of the system

Change that by converting the init functions to return an error conforming
to the CLOCKSOURCE_OF_RET prototype.

Proper error handling (rollback, errno value) will be changed later case
by case, thus this change just return back an error or success in the init
function.
Signed-off-by: default avatarDaniel Lezcano <daniel.lezcano@linaro.org>
Acked-by: default avatarMaxime Coquelin <maxime.coquelin@st.com>
parent 3c0731db
...@@ -238,7 +238,7 @@ static void __init gt_delay_timer_init(void) ...@@ -238,7 +238,7 @@ static void __init gt_delay_timer_init(void)
register_current_timer_delay(&gt_delay_timer); register_current_timer_delay(&gt_delay_timer);
} }
static void __init gt_clocksource_init(void) static int __init gt_clocksource_init(void)
{ {
writel(0, gt_base + GT_CONTROL); writel(0, gt_base + GT_CONTROL);
writel(0, gt_base + GT_COUNTER0); writel(0, gt_base + GT_COUNTER0);
...@@ -249,7 +249,7 @@ static void __init gt_clocksource_init(void) ...@@ -249,7 +249,7 @@ static void __init gt_clocksource_init(void)
#ifdef CONFIG_CLKSRC_ARM_GLOBAL_TIMER_SCHED_CLOCK #ifdef CONFIG_CLKSRC_ARM_GLOBAL_TIMER_SCHED_CLOCK
sched_clock_register(gt_sched_clock_read, 64, gt_clk_rate); sched_clock_register(gt_sched_clock_read, 64, gt_clk_rate);
#endif #endif
clocksource_register_hz(&gt_clocksource, gt_clk_rate); return clocksource_register_hz(&gt_clocksource, gt_clk_rate);
} }
static int gt_cpu_notify(struct notifier_block *self, unsigned long action, static int gt_cpu_notify(struct notifier_block *self, unsigned long action,
...@@ -270,7 +270,7 @@ static struct notifier_block gt_cpu_nb = { ...@@ -270,7 +270,7 @@ static struct notifier_block gt_cpu_nb = {
.notifier_call = gt_cpu_notify, .notifier_call = gt_cpu_notify,
}; };
static void __init global_timer_of_register(struct device_node *np) static int __init global_timer_of_register(struct device_node *np)
{ {
struct clk *gt_clk; struct clk *gt_clk;
int err = 0; int err = 0;
...@@ -283,19 +283,19 @@ static void __init global_timer_of_register(struct device_node *np) ...@@ -283,19 +283,19 @@ static void __init global_timer_of_register(struct device_node *np)
if (read_cpuid_part() == ARM_CPU_PART_CORTEX_A9 if (read_cpuid_part() == ARM_CPU_PART_CORTEX_A9
&& (read_cpuid_id() & 0xf0000f) < 0x200000) { && (read_cpuid_id() & 0xf0000f) < 0x200000) {
pr_warn("global-timer: non support for this cpu version.\n"); pr_warn("global-timer: non support for this cpu version.\n");
return; return -ENOSYS;
} }
gt_ppi = irq_of_parse_and_map(np, 0); gt_ppi = irq_of_parse_and_map(np, 0);
if (!gt_ppi) { if (!gt_ppi) {
pr_warn("global-timer: unable to parse irq\n"); pr_warn("global-timer: unable to parse irq\n");
return; return -EINVAL;
} }
gt_base = of_iomap(np, 0); gt_base = of_iomap(np, 0);
if (!gt_base) { if (!gt_base) {
pr_warn("global-timer: invalid base address\n"); pr_warn("global-timer: invalid base address\n");
return; return -ENXIO;
} }
gt_clk = of_clk_get(np, 0); gt_clk = of_clk_get(np, 0);
...@@ -332,11 +332,17 @@ static void __init global_timer_of_register(struct device_node *np) ...@@ -332,11 +332,17 @@ static void __init global_timer_of_register(struct device_node *np)
} }
/* Immediately configure the timer on the boot CPU */ /* Immediately configure the timer on the boot CPU */
gt_clocksource_init(); err = gt_clocksource_init();
gt_clockevents_init(this_cpu_ptr(gt_evt)); if (err)
goto out_irq;
err = gt_clockevents_init(this_cpu_ptr(gt_evt));
if (err)
goto out_irq;
gt_delay_timer_init(); gt_delay_timer_init();
return; return 0;
out_irq: out_irq:
free_percpu_irq(gt_ppi, gt_evt); free_percpu_irq(gt_ppi, gt_evt);
...@@ -347,8 +353,10 @@ static void __init global_timer_of_register(struct device_node *np) ...@@ -347,8 +353,10 @@ static void __init global_timer_of_register(struct device_node *np)
out_unmap: out_unmap:
iounmap(gt_base); iounmap(gt_base);
WARN(err, "ARM Global timer register failed (%d)\n", err); WARN(err, "ARM Global timer register failed (%d)\n", err);
return err;
} }
/* Only tested on r2p2 and r3p0 */ /* Only tested on r2p2 and r3p0 */
CLOCKSOURCE_OF_DECLARE(arm_gt, "arm,cortex-a9-global-timer", CLOCKSOURCE_OF_DECLARE_RET(arm_gt, "arm,cortex-a9-global-timer",
global_timer_of_register); global_timer_of_register);
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment