clocksource/drivers/samsung_pwm: Cleanup on init error

Failure of timer initialization is likely to be fatal for the system, so
cleanup in such case is not strictly necessary.  However the code might
be refactored or reused, so better not to rely on such assumption that
system won't continue init failure.

Unmap the IO memory and put the clock on initialization failures from
devicetree.

Signed-off-by: Krzysztof Kozlowski <krzysztof.kozlowski@canonical.com>
Signed-off-by: Daniel Lezcano <daniel.lezcano@linaro.org>
Link: https://lore.kernel.org/r/20210506202729.157260-3-krzysztof.kozlowski@canonical.com

diff --git a/drivers/clocksource/samsung_pwm_timer.c b/drivers/clocksource/samsung_pwm_timer.c
index bfad61b509f93d6100e111b49120a13deebde262..55e2f9fa2a15e9a894aaca22b601b81670267e34 100644 (file)
--- a/drivers/clocksource/samsung_pwm_timer.c
+++ b/drivers/clocksource/samsung_pwm_timer.c
@@ -421,7 +421,7 @@ static int __init samsung_pwm_alloc(struct device_node *np,
        struct property *prop;
        const __be32 *cur;
        u32 val;
-       int i;
+       int i, ret;
 
        memcpy(&pwm.variant, variant, sizeof(pwm.variant));
        for (i = 0; i < SAMSUNG_PWM_NUM; ++i)
@@ -444,10 +444,24 @@ static int __init samsung_pwm_alloc(struct device_node *np,
        pwm.timerclk = of_clk_get_by_name(np, "timers");
        if (IS_ERR(pwm.timerclk)) {
                pr_crit("failed to get timers clock for timer\n");
-               return PTR_ERR(pwm.timerclk);
+               ret = PTR_ERR(pwm.timerclk);
+               goto err_clk;
        }
 
-       return _samsung_pwm_clocksource_init();
+       ret = _samsung_pwm_clocksource_init();
+       if (ret)
+               goto err_clocksource;
+
+       return 0;
+
+err_clocksource:
+       clk_put(pwm.timerclk);
+       pwm.timerclk = NULL;
+err_clk:
+       iounmap(pwm.base);
+       pwm.base = NULL;
+
+       return ret;
 }
 
 static const struct samsung_pwm_variant s3c24xx_variant = {