clk: socfpga: use of_clk_add_hw_provider and improve error handling

The function of_clk_add_provider() has been deprecated, so use its
suggested replacement of_clk_add_hw_provider() instead.

Since of_clk_add_hw_provider() can fail, like of_clk_add_provider(),
check its return value and do the error handling.

The indentation of the init function parameters has been aligned
to match open parenthesis, as suggested by checkpatch, and the __init
macro moved before the function name, as specified in init.h.

Signed-off-by: Marco Pagani <marpagan@redhat.com>
Link: https://lore.kernel.org/r/20221209152913.1335068-2-marpagan@redhat.com
Signed-off-by: Stephen Boyd <sboyd@kernel.org>

diff --git a/drivers/clk/socfpga/clk-periph.c b/drivers/clk/socfpga/clk-periph.c
index 43707e2d724840dfaabc0473d25f9c1c3843b32f..6a4075147b9c13e66371b6cdebf031c07deea7c6 100644 (file)
--- a/drivers/clk/socfpga/clk-periph.c
+++ b/drivers/clk/socfpga/clk-periph.c
@@ -47,8 +47,8 @@ static const struct clk_ops periclk_ops = {
        .get_parent = clk_periclk_get_parent,
 };
 
-static __init void __socfpga_periph_init(struct device_node *node,
-       const struct clk_ops *ops)
+static void __init __socfpga_periph_init(struct device_node *node,
+                                        const struct clk_ops *ops)
 {
        u32 reg;
        struct clk_hw *hw_clk;
@@ -96,11 +96,25 @@ static __init void __socfpga_periph_init(struct device_node *node,
        periph_clk->hw.hw.init = &init;
        hw_clk = &periph_clk->hw.hw;
 
-       if (clk_hw_register(NULL, hw_clk)) {
-               kfree(periph_clk);
-               return;
+       rc = clk_hw_register(NULL, hw_clk);
+       if (rc) {
+               pr_err("Could not register clock:%s\n", clk_name);
+               goto err_clk_hw_register;
+       }
+
+       rc = of_clk_add_hw_provider(node, of_clk_hw_simple_get, hw_clk);
+       if (rc) {
+               pr_err("Could not register clock provider for node:%s\n",
+                      clk_name);
+               goto err_of_clk_add_hw_provider;
        }
-       rc = of_clk_add_provider(node, of_clk_src_simple_get, hw_clk);
+
+       return;
+
+err_of_clk_add_hw_provider:
+       clk_hw_unregister(hw_clk);
+err_clk_hw_register:
+       kfree(periph_clk);
 }
 
 void __init socfpga_periph_init(struct device_node *node)