thermal/drivers/hisi: Move the clk setup in the corresponding functions

The sensor's clock is enabled and disabled outside of the probe and
disable function. Moving the corresponding action in the
hisi_thermal_setup() and hisi_thermal_disable_sensor(), factors out
some lines of code and makes the code more symmetric.

Signed-off-by: Kevin Wangtao <kevin.wangtao@linaro.org>
Tested-by: Daniel Lezcano <daniel.lezcano@linaro.org> # hikey6220
Signed-off-by: Daniel Lezcano <daniel.lezcano@linaro.org>
Signed-off-by: Eduardo Valentin <edubezval@gmail.com>
This commit is contained in:
Kevin Wangtao 2017-10-19 19:05:56 +02:00 committed by Eduardo Valentin
parent cc1ab38d2b
commit 943c0f6abf

View File

@ -203,6 +203,8 @@ static void hisi_thermal_disable_sensor(struct hisi_thermal_data *data)
hisi_thermal_enable(data->regs, 0); hisi_thermal_enable(data->regs, 0);
hisi_thermal_alarm_enable(data->regs, 0); hisi_thermal_alarm_enable(data->regs, 0);
hisi_thermal_reset_enable(data->regs, 0); hisi_thermal_reset_enable(data->regs, 0);
clk_disable_unprepare(data->clk);
} }
static int hisi_thermal_get_temp(void *__data, int *temp) static int hisi_thermal_get_temp(void *__data, int *temp)
@ -297,9 +299,13 @@ static void hisi_thermal_toggle_sensor(struct hisi_thermal_sensor *sensor,
static int hisi_thermal_setup(struct hisi_thermal_data *data) static int hisi_thermal_setup(struct hisi_thermal_data *data)
{ {
struct hisi_thermal_sensor *sensor; struct hisi_thermal_sensor *sensor = &data->sensor;
int ret;
sensor = &data->sensor; /* enable clock for tsensor */
ret = clk_prepare_enable(data->clk);
if (ret)
return ret;
/* disable module firstly */ /* disable module firstly */
hisi_thermal_reset_enable(data->regs, 0); hisi_thermal_reset_enable(data->regs, 0);
@ -363,13 +369,6 @@ static int hisi_thermal_probe(struct platform_device *pdev)
return ret; return ret;
} }
/* enable clock for thermal */
ret = clk_prepare_enable(data->clk);
if (ret) {
dev_err(&pdev->dev, "failed to enable thermal clk: %d\n", ret);
return ret;
}
ret = hisi_thermal_register_sensor(pdev, data, ret = hisi_thermal_register_sensor(pdev, data,
&data->sensor, &data->sensor,
HISI_DEFAULT_SENSOR); HISI_DEFAULT_SENSOR);
@ -405,7 +404,6 @@ static int hisi_thermal_remove(struct platform_device *pdev)
hisi_thermal_toggle_sensor(sensor, false); hisi_thermal_toggle_sensor(sensor, false);
hisi_thermal_disable_sensor(data); hisi_thermal_disable_sensor(data);
clk_disable_unprepare(data->clk);
return 0; return 0;
} }
@ -417,23 +415,14 @@ static int hisi_thermal_suspend(struct device *dev)
hisi_thermal_disable_sensor(data); hisi_thermal_disable_sensor(data);
clk_disable_unprepare(data->clk);
return 0; return 0;
} }
static int hisi_thermal_resume(struct device *dev) static int hisi_thermal_resume(struct device *dev)
{ {
struct hisi_thermal_data *data = dev_get_drvdata(dev); struct hisi_thermal_data *data = dev_get_drvdata(dev);
int ret;
ret = clk_prepare_enable(data->clk); return hisi_thermal_setup(data);
if (ret)
return ret;
hisi_thermal_setup(data);
return 0;
} }
#endif #endif