diff mbox series

[v2,3/4] PM / devfreq: tegra30: Use resource-managed helpers

Message ID 20210920172249.28206-4-digetx@gmail.com (mailing list archive)
State Not Applicable, archived
Headers show
Series Make probe() of Tegra devfreq driver completely resource-managed | expand

Commit Message

Dmitry Osipenko Sept. 20, 2021, 5:22 p.m. UTC 
Use resource-managed API helpers to simplify driver's probe() function,
making code cleaner.

Signed-off-by: Dmitry Osipenko <digetx@gmail.com>
---
 drivers/devfreq/tegra30-devfreq.c | 107 +++++++++++++-----------------
 1 file changed, 46 insertions(+), 61 deletions(-)

Comments

Chanwoo Choi Sept. 22, 2021, 8:11 a.m. UTC | #1 
On 21. 9. 21. 오전 2:22, Dmitry Osipenko wrote:
> Use resource-managed API helpers to simplify driver's probe() function,
> making code cleaner.
> 
> Signed-off-by: Dmitry Osipenko <digetx@gmail.com>
> ---
>   drivers/devfreq/tegra30-devfreq.c | 107 +++++++++++++-----------------
>   1 file changed, 46 insertions(+), 61 deletions(-)
> 
> diff --git a/drivers/devfreq/tegra30-devfreq.c b/drivers/devfreq/tegra30-devfreq.c
> index 10661eb2aed8..d83fdc2713ed 100644
> --- a/drivers/devfreq/tegra30-devfreq.c
> +++ b/drivers/devfreq/tegra30-devfreq.c
> @@ -178,7 +178,6 @@ struct tegra_devfreq_soc_data {
>   
>   struct tegra_devfreq {
>   	struct devfreq		*devfreq;
> -	struct opp_table	*opp_table;
>   
>   	struct reset_control	*reset;
>   	struct clk		*clock;
> @@ -789,6 +788,39 @@ static struct devfreq_governor tegra_devfreq_governor = {
>   	.event_handler = tegra_governor_event_handler,
>   };
>   
> +static void devm_tegra_devfreq_deinit_hw(void *data)
> +{
> +	struct tegra_devfreq *tegra = data;
> +
> +	reset_control_reset(tegra->reset);
> +	clk_disable_unprepare(tegra->clock);
> +}
> +
> +static int devm_tegra_devfreq_init_hw(struct device *dev,
> +				      struct tegra_devfreq *tegra)
> +{
> +	int err;
> +
> +	err = clk_prepare_enable(tegra->clock);
> +	if (err) {
> +		dev_err(dev, "Failed to prepare and enable ACTMON clock\n");
> +		return err;
> +	}
> +
> +	err = devm_add_action_or_reset(dev, devm_tegra_devfreq_deinit_hw,
> +				       tegra);
> +	if (err)
> +		return err;
> +
> +	err = reset_control_reset(tegra->reset);
> +	if (err) {
> +		dev_err(dev, "Failed to reset hardware: %d\n", err);
> +		return err;
> +	}
> +
> +	return err;
> +}
> +
>   static int tegra_devfreq_probe(struct platform_device *pdev)
>   {
>   	u32 hw_version = BIT(tegra_sku_info.soc_speedo_id);
> @@ -842,38 +874,26 @@ static int tegra_devfreq_probe(struct platform_device *pdev)
>   		return err;
>   	}
>   
> -	tegra->opp_table = dev_pm_opp_set_supported_hw(&pdev->dev,
> -						       &hw_version, 1);
> -	err = PTR_ERR_OR_ZERO(tegra->opp_table);
> +	err = devm_pm_opp_set_supported_hw(&pdev->dev, &hw_version, 1);
>   	if (err) {
>   		dev_err(&pdev->dev, "Failed to set supported HW: %d\n", err);
>   		return err;
>   	}
>   
> -	err = dev_pm_opp_of_add_table_noclk(&pdev->dev, 0);
> +	err = devm_pm_opp_of_add_table_noclk(&pdev->dev, 0);
>   	if (err) {
>   		dev_err(&pdev->dev, "Failed to add OPP table: %d\n", err);
> -		goto put_hw;
> -	}
> -
> -	err = clk_prepare_enable(tegra->clock);
> -	if (err) {
> -		dev_err(&pdev->dev,
> -			"Failed to prepare and enable ACTMON clock\n");
> -		goto remove_table;
> +		return err;
>   	}
>   
> -	err = reset_control_reset(tegra->reset);
> -	if (err) {
> -		dev_err(&pdev->dev, "Failed to reset hardware: %d\n", err);
> -		goto disable_clk;
> -	}
> +	err = devm_tegra_devfreq_init_hw(&pdev->dev, tegra);
> +	if (err)
> +		return err;
>   
>   	rate = clk_round_rate(tegra->emc_clock, ULONG_MAX);
>   	if (rate < 0) {
>   		dev_err(&pdev->dev, "Failed to round clock rate: %ld\n", rate);
> -		err = rate;
> -		goto disable_clk;
> +		return rate;
>   	}
>   
>   	tegra->max_freq = rate / KHZ;
> @@ -892,52 +912,18 @@ static int tegra_devfreq_probe(struct platform_device *pdev)
>   	INIT_DELAYED_WORK(&tegra->cpufreq_update_work,
>   			  tegra_actmon_delayed_update);
>   
> -	err = devfreq_add_governor(&tegra_devfreq_governor);
> +	err = devm_devfreq_add_governor(&pdev->dev, &tegra_devfreq_governor);
>   	if (err) {
>   		dev_err(&pdev->dev, "Failed to add governor: %d\n", err);
> -		goto remove_opps;
> +		return err;
>   	}
>   
>   	tegra_devfreq_profile.initial_freq = clk_get_rate(tegra->emc_clock);
>   
> -	devfreq = devfreq_add_device(&pdev->dev, &tegra_devfreq_profile,
> -				     "tegra_actmon", NULL);
> -	if (IS_ERR(devfreq)) {
> -		err = PTR_ERR(devfreq);
> -		goto remove_governor;
> -	}
> -
> -	return 0;
> -
> -remove_governor:
> -	devfreq_remove_governor(&tegra_devfreq_governor);
> -
> -remove_opps:
> -	dev_pm_opp_remove_all_dynamic(&pdev->dev);
> -
> -	reset_control_reset(tegra->reset);
> -disable_clk:
> -	clk_disable_unprepare(tegra->clock);
> -remove_table:
> -	dev_pm_opp_of_remove_table(&pdev->dev);
> -put_hw:
> -	dev_pm_opp_put_supported_hw(tegra->opp_table);
> -
> -	return err;
> -}
> -
> -static int tegra_devfreq_remove(struct platform_device *pdev)
> -{
> -	struct tegra_devfreq *tegra = platform_get_drvdata(pdev);
> -
> -	devfreq_remove_device(tegra->devfreq);
> -	devfreq_remove_governor(&tegra_devfreq_governor);
> -
> -	reset_control_reset(tegra->reset);
> -	clk_disable_unprepare(tegra->clock);
> -
> -	dev_pm_opp_of_remove_table(&pdev->dev);
> -	dev_pm_opp_put_supported_hw(tegra->opp_table);
> +	devfreq = devm_devfreq_add_device(&pdev->dev, &tegra_devfreq_profile,
> +					  "tegra_actmon", NULL);
> +	if (IS_ERR(devfreq))
> +		return PTR_ERR(devfreq);
>   
>   	return 0;
>   }
> @@ -967,7 +953,6 @@ MODULE_DEVICE_TABLE(of, tegra_devfreq_of_match);
>   
>   static struct platform_driver tegra_devfreq_driver = {
>   	.probe	= tegra_devfreq_probe,
> -	.remove	= tegra_devfreq_remove,
>   	.driver = {
>   		.name = "tegra-devfreq",
>   		.of_match_table = tegra_devfreq_of_match,
> 

It is more readable than before. Thanks.

Acked-by: Chanwoo Choi <cw00.choi@samsung.com>
diff mbox series

Patch

diff --git a/drivers/devfreq/tegra30-devfreq.c b/drivers/devfreq/tegra30-devfreq.c
index 10661eb2aed8..d83fdc2713ed 100644
--- a/drivers/devfreq/tegra30-devfreq.c
+++ b/drivers/devfreq/tegra30-devfreq.c
@@ -178,7 +178,6 @@  struct tegra_devfreq_soc_data {
 
 struct tegra_devfreq {
 	struct devfreq		*devfreq;
-	struct opp_table	*opp_table;
 
 	struct reset_control	*reset;
 	struct clk		*clock;
@@ -789,6 +788,39 @@  static struct devfreq_governor tegra_devfreq_governor = {
 	.event_handler = tegra_governor_event_handler,
 };
 
+static void devm_tegra_devfreq_deinit_hw(void *data)
+{
+	struct tegra_devfreq *tegra = data;
+
+	reset_control_reset(tegra->reset);
+	clk_disable_unprepare(tegra->clock);
+}
+
+static int devm_tegra_devfreq_init_hw(struct device *dev,
+				      struct tegra_devfreq *tegra)
+{
+	int err;
+
+	err = clk_prepare_enable(tegra->clock);
+	if (err) {
+		dev_err(dev, "Failed to prepare and enable ACTMON clock\n");
+		return err;
+	}
+
+	err = devm_add_action_or_reset(dev, devm_tegra_devfreq_deinit_hw,
+				       tegra);
+	if (err)
+		return err;
+
+	err = reset_control_reset(tegra->reset);
+	if (err) {
+		dev_err(dev, "Failed to reset hardware: %d\n", err);
+		return err;
+	}
+
+	return err;
+}
+
 static int tegra_devfreq_probe(struct platform_device *pdev)
 {
 	u32 hw_version = BIT(tegra_sku_info.soc_speedo_id);
@@ -842,38 +874,26 @@  static int tegra_devfreq_probe(struct platform_device *pdev)
 		return err;
 	}
 
-	tegra->opp_table = dev_pm_opp_set_supported_hw(&pdev->dev,
-						       &hw_version, 1);
-	err = PTR_ERR_OR_ZERO(tegra->opp_table);
+	err = devm_pm_opp_set_supported_hw(&pdev->dev, &hw_version, 1);
 	if (err) {
 		dev_err(&pdev->dev, "Failed to set supported HW: %d\n", err);
 		return err;
 	}
 
-	err = dev_pm_opp_of_add_table_noclk(&pdev->dev, 0);
+	err = devm_pm_opp_of_add_table_noclk(&pdev->dev, 0);
 	if (err) {
 		dev_err(&pdev->dev, "Failed to add OPP table: %d\n", err);
-		goto put_hw;
-	}
-
-	err = clk_prepare_enable(tegra->clock);
-	if (err) {
-		dev_err(&pdev->dev,
-			"Failed to prepare and enable ACTMON clock\n");
-		goto remove_table;
+		return err;
 	}
 
-	err = reset_control_reset(tegra->reset);
-	if (err) {
-		dev_err(&pdev->dev, "Failed to reset hardware: %d\n", err);
-		goto disable_clk;
-	}
+	err = devm_tegra_devfreq_init_hw(&pdev->dev, tegra);
+	if (err)
+		return err;
 
 	rate = clk_round_rate(tegra->emc_clock, ULONG_MAX);
 	if (rate < 0) {
 		dev_err(&pdev->dev, "Failed to round clock rate: %ld\n", rate);
-		err = rate;
-		goto disable_clk;
+		return rate;
 	}
 
 	tegra->max_freq = rate / KHZ;
@@ -892,52 +912,18 @@  static int tegra_devfreq_probe(struct platform_device *pdev)
 	INIT_DELAYED_WORK(&tegra->cpufreq_update_work,
 			  tegra_actmon_delayed_update);
 
-	err = devfreq_add_governor(&tegra_devfreq_governor);
+	err = devm_devfreq_add_governor(&pdev->dev, &tegra_devfreq_governor);
 	if (err) {
 		dev_err(&pdev->dev, "Failed to add governor: %d\n", err);
-		goto remove_opps;
+		return err;
 	}
 
 	tegra_devfreq_profile.initial_freq = clk_get_rate(tegra->emc_clock);
 
-	devfreq = devfreq_add_device(&pdev->dev, &tegra_devfreq_profile,
-				     "tegra_actmon", NULL);
-	if (IS_ERR(devfreq)) {
-		err = PTR_ERR(devfreq);
-		goto remove_governor;
-	}
-
-	return 0;
-
-remove_governor:
-	devfreq_remove_governor(&tegra_devfreq_governor);
-
-remove_opps:
-	dev_pm_opp_remove_all_dynamic(&pdev->dev);
-
-	reset_control_reset(tegra->reset);
-disable_clk:
-	clk_disable_unprepare(tegra->clock);
-remove_table:
-	dev_pm_opp_of_remove_table(&pdev->dev);
-put_hw:
-	dev_pm_opp_put_supported_hw(tegra->opp_table);
-
-	return err;
-}
-
-static int tegra_devfreq_remove(struct platform_device *pdev)
-{
-	struct tegra_devfreq *tegra = platform_get_drvdata(pdev);
-
-	devfreq_remove_device(tegra->devfreq);
-	devfreq_remove_governor(&tegra_devfreq_governor);
-
-	reset_control_reset(tegra->reset);
-	clk_disable_unprepare(tegra->clock);
-
-	dev_pm_opp_of_remove_table(&pdev->dev);
-	dev_pm_opp_put_supported_hw(tegra->opp_table);
+	devfreq = devm_devfreq_add_device(&pdev->dev, &tegra_devfreq_profile,
+					  "tegra_actmon", NULL);
+	if (IS_ERR(devfreq))
+		return PTR_ERR(devfreq);
 
 	return 0;
 }
@@ -967,7 +953,6 @@  MODULE_DEVICE_TABLE(of, tegra_devfreq_of_match);
 
 static struct platform_driver tegra_devfreq_driver = {
 	.probe	= tegra_devfreq_probe,
-	.remove	= tegra_devfreq_remove,
 	.driver = {
 		.name = "tegra-devfreq",
 		.of_match_table = tegra_devfreq_of_match,