Commit 84309e0a authored by Daniel Lezcano's avatar Daniel Lezcano

clocksource/drivers/st_lpc: 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 avatarPatrice Chotard <patrice.chotard@st.com>
Acked-by: default avatarMaxime Coquelin <maxime.coquelin@st.com>
parent 70504f31
...@@ -92,7 +92,7 @@ static int __init st_clksrc_setup_clk(struct device_node *np) ...@@ -92,7 +92,7 @@ static int __init st_clksrc_setup_clk(struct device_node *np)
return 0; return 0;
} }
static void __init st_clksrc_of_register(struct device_node *np) static int __init st_clksrc_of_register(struct device_node *np)
{ {
int ret; int ret;
uint32_t mode; uint32_t mode;
...@@ -100,32 +100,36 @@ static void __init st_clksrc_of_register(struct device_node *np) ...@@ -100,32 +100,36 @@ static void __init st_clksrc_of_register(struct device_node *np)
ret = of_property_read_u32(np, "st,lpc-mode", &mode); ret = of_property_read_u32(np, "st,lpc-mode", &mode);
if (ret) { if (ret) {
pr_err("clksrc-st-lpc: An LPC mode must be provided\n"); pr_err("clksrc-st-lpc: An LPC mode must be provided\n");
return; return ret;
} }
/* LPC can either run as a Clocksource or in RTC or WDT mode */ /* LPC can either run as a Clocksource or in RTC or WDT mode */
if (mode != ST_LPC_MODE_CLKSRC) if (mode != ST_LPC_MODE_CLKSRC)
return; return 0;
ddata.base = of_iomap(np, 0); ddata.base = of_iomap(np, 0);
if (!ddata.base) { if (!ddata.base) {
pr_err("clksrc-st-lpc: Unable to map iomem\n"); pr_err("clksrc-st-lpc: Unable to map iomem\n");
return; return -ENXIO;
} }
if (st_clksrc_setup_clk(np)) { ret = st_clksrc_setup_clk(np);
if (ret) {
iounmap(ddata.base); iounmap(ddata.base);
return; return ret;
} }
if (st_clksrc_init()) { ret = st_clksrc_init();
if (ret) {
clk_disable_unprepare(ddata.clk); clk_disable_unprepare(ddata.clk);
clk_put(ddata.clk); clk_put(ddata.clk);
iounmap(ddata.base); iounmap(ddata.base);
return; return ret;
} }
pr_info("clksrc-st-lpc: clocksource initialised - running @ %luHz\n", pr_info("clksrc-st-lpc: clocksource initialised - running @ %luHz\n",
clk_get_rate(ddata.clk)); clk_get_rate(ddata.clk));
return ret;
} }
CLOCKSOURCE_OF_DECLARE(ddata, "st,stih407-lpc", st_clksrc_of_register); CLOCKSOURCE_OF_DECLARE_RET(ddata, "st,stih407-lpc", st_clksrc_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