Commit 12549e27 authored by Daniel Lezcano's avatar Daniel Lezcano

clocksource/drivers/time-armada-370-xp: 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>
parent 53978bba
...@@ -260,14 +260,22 @@ static struct delay_timer armada_370_delay_timer = { ...@@ -260,14 +260,22 @@ static struct delay_timer armada_370_delay_timer = {
.read_current_timer = armada_370_delay_timer_read, .read_current_timer = armada_370_delay_timer_read,
}; };
static void __init armada_370_xp_timer_common_init(struct device_node *np) static int __init armada_370_xp_timer_common_init(struct device_node *np)
{ {
u32 clr = 0, set = 0; u32 clr = 0, set = 0;
int res; int res;
timer_base = of_iomap(np, 0); timer_base = of_iomap(np, 0);
WARN_ON(!timer_base); if (!timer_base) {
pr_err("Failed to iomap");
return -ENXIO;
}
local_base = of_iomap(np, 1); local_base = of_iomap(np, 1);
if (!local_base) {
pr_err("Failed to iomap");
return -ENXIO;
}
if (timer25Mhz) { if (timer25Mhz) {
set = TIMER0_25MHZ; set = TIMER0_25MHZ;
...@@ -306,14 +314,19 @@ static void __init armada_370_xp_timer_common_init(struct device_node *np) ...@@ -306,14 +314,19 @@ static void __init armada_370_xp_timer_common_init(struct device_node *np)
*/ */
sched_clock_register(armada_370_xp_read_sched_clock, 32, timer_clk); sched_clock_register(armada_370_xp_read_sched_clock, 32, timer_clk);
clocksource_mmio_init(timer_base + TIMER0_VAL_OFF, res = clocksource_mmio_init(timer_base + TIMER0_VAL_OFF,
"armada_370_xp_clocksource", "armada_370_xp_clocksource",
timer_clk, 300, 32, clocksource_mmio_readl_down); timer_clk, 300, 32, clocksource_mmio_readl_down);
if (res) {
pr_err("Failed to initialize clocksource mmio");
return res;
}
register_cpu_notifier(&armada_370_xp_timer_cpu_nb); register_cpu_notifier(&armada_370_xp_timer_cpu_nb);
armada_370_xp_evt = alloc_percpu(struct clock_event_device); armada_370_xp_evt = alloc_percpu(struct clock_event_device);
if (!armada_370_xp_evt)
return -ENOMEM;
/* /*
* Setup clockevent timer (interrupt-driven). * Setup clockevent timer (interrupt-driven).
...@@ -323,33 +336,54 @@ static void __init armada_370_xp_timer_common_init(struct device_node *np) ...@@ -323,33 +336,54 @@ static void __init armada_370_xp_timer_common_init(struct device_node *np)
"armada_370_xp_per_cpu_tick", "armada_370_xp_per_cpu_tick",
armada_370_xp_evt); armada_370_xp_evt);
/* Immediately configure the timer on the boot CPU */ /* Immediately configure the timer on the boot CPU */
if (!res) if (res) {
armada_370_xp_timer_setup(this_cpu_ptr(armada_370_xp_evt)); pr_err("Failed to request percpu irq");
return res;
}
res = armada_370_xp_timer_setup(this_cpu_ptr(armada_370_xp_evt));
if (!res) {
pr_err("Failed to setup timer");
return res;
}
register_syscore_ops(&armada_370_xp_timer_syscore_ops); register_syscore_ops(&armada_370_xp_timer_syscore_ops);
return 0;
} }
static void __init armada_xp_timer_init(struct device_node *np) static int __init armada_xp_timer_init(struct device_node *np)
{ {
struct clk *clk = of_clk_get_by_name(np, "fixed"); struct clk *clk = of_clk_get_by_name(np, "fixed");
int ret;
clk = of_clk_get(np, 0);
if (IS_ERR(clk)) {
pr_err("Failed to get clock");
return PTR_ERR(clk);
}
ret = clk_prepare_enable(clk);
if (ret)
return ret;
/* The 25Mhz fixed clock is mandatory, and must always be available */
BUG_ON(IS_ERR(clk));
clk_prepare_enable(clk);
timer_clk = clk_get_rate(clk); timer_clk = clk_get_rate(clk);
armada_370_xp_timer_common_init(np); return armada_370_xp_timer_common_init(np);
} }
CLOCKSOURCE_OF_DECLARE(armada_xp, "marvell,armada-xp-timer", CLOCKSOURCE_OF_DECLARE_RET(armada_xp, "marvell,armada-xp-timer",
armada_xp_timer_init); armada_xp_timer_init);
static void __init armada_375_timer_init(struct device_node *np) static int __init armada_375_timer_init(struct device_node *np)
{ {
struct clk *clk; struct clk *clk;
int ret;
clk = of_clk_get_by_name(np, "fixed"); clk = of_clk_get_by_name(np, "fixed");
if (!IS_ERR(clk)) { if (!IS_ERR(clk)) {
clk_prepare_enable(clk); ret = clk_prepare_enable(clk);
if (ret)
return ret;
timer_clk = clk_get_rate(clk); timer_clk = clk_get_rate(clk);
} else { } else {
...@@ -360,27 +394,43 @@ static void __init armada_375_timer_init(struct device_node *np) ...@@ -360,27 +394,43 @@ static void __init armada_375_timer_init(struct device_node *np)
clk = of_clk_get(np, 0); clk = of_clk_get(np, 0);
/* Must have at least a clock */ /* Must have at least a clock */
BUG_ON(IS_ERR(clk)); if (IS_ERR(clk)) {
clk_prepare_enable(clk); pr_err("Failed to get clock");
return PTR_ERR(clk);
}
ret = clk_prepare_enable(clk);
if (ret)
return ret;
timer_clk = clk_get_rate(clk) / TIMER_DIVIDER; timer_clk = clk_get_rate(clk) / TIMER_DIVIDER;
timer25Mhz = false; timer25Mhz = false;
} }
armada_370_xp_timer_common_init(np); return armada_370_xp_timer_common_init(np);
} }
CLOCKSOURCE_OF_DECLARE(armada_375, "marvell,armada-375-timer", CLOCKSOURCE_OF_DECLARE_RET(armada_375, "marvell,armada-375-timer",
armada_375_timer_init); armada_375_timer_init);
static void __init armada_370_timer_init(struct device_node *np) static int __init armada_370_timer_init(struct device_node *np)
{ {
struct clk *clk = of_clk_get(np, 0); struct clk *clk;
int ret;
clk = of_clk_get(np, 0);
if (IS_ERR(clk)) {
pr_err("Failed to get clock");
return PTR_ERR(clk);
}
ret = clk_prepare_enable(clk);
if (ret)
return ret;
BUG_ON(IS_ERR(clk));
clk_prepare_enable(clk);
timer_clk = clk_get_rate(clk) / TIMER_DIVIDER; timer_clk = clk_get_rate(clk) / TIMER_DIVIDER;
timer25Mhz = false; timer25Mhz = false;
armada_370_xp_timer_common_init(np); return armada_370_xp_timer_common_init(np);
} }
CLOCKSOURCE_OF_DECLARE(armada_370, "marvell,armada-370-timer", CLOCKSOURCE_OF_DECLARE_RET(armada_370, "marvell,armada-370-timer",
armada_370_timer_init); armada_370_timer_init);
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