|
@@ -185,6 +185,7 @@
|
|
|
* @regulator: pointer to the TMU regulator structure.
|
|
|
* @reg_conf: pointer to structure to register with core thermal.
|
|
|
* @ntrip: number of supported trip points.
|
|
|
+ * @enabled: current status of TMU device
|
|
|
* @tmu_initialize: SoC specific TMU initialization method
|
|
|
* @tmu_control: SoC specific TMU control method
|
|
|
* @tmu_read: SoC specific TMU temperature read method
|
|
@@ -205,6 +206,7 @@ struct exynos_tmu_data {
|
|
|
struct regulator *regulator;
|
|
|
struct thermal_zone_device *tzd;
|
|
|
unsigned int ntrip;
|
|
|
+ bool enabled;
|
|
|
|
|
|
int (*tmu_initialize)(struct platform_device *pdev);
|
|
|
void (*tmu_control)(struct platform_device *pdev, bool on);
|
|
@@ -398,6 +400,7 @@ static void exynos_tmu_control(struct platform_device *pdev, bool on)
|
|
|
mutex_lock(&data->lock);
|
|
|
clk_enable(data->clk);
|
|
|
data->tmu_control(pdev, on);
|
|
|
+ data->enabled = on;
|
|
|
clk_disable(data->clk);
|
|
|
mutex_unlock(&data->lock);
|
|
|
}
|
|
@@ -889,19 +892,24 @@ static void exynos7_tmu_control(struct platform_device *pdev, bool on)
|
|
|
static int exynos_get_temp(void *p, int *temp)
|
|
|
{
|
|
|
struct exynos_tmu_data *data = p;
|
|
|
+ int value, ret = 0;
|
|
|
|
|
|
- if (!data || !data->tmu_read)
|
|
|
+ if (!data || !data->tmu_read || !data->enabled)
|
|
|
return -EINVAL;
|
|
|
|
|
|
mutex_lock(&data->lock);
|
|
|
clk_enable(data->clk);
|
|
|
|
|
|
- *temp = code_to_temp(data, data->tmu_read(data)) * MCELSIUS;
|
|
|
+ value = data->tmu_read(data);
|
|
|
+ if (value < 0)
|
|
|
+ ret = value;
|
|
|
+ else
|
|
|
+ *temp = code_to_temp(data, value) * MCELSIUS;
|
|
|
|
|
|
clk_disable(data->clk);
|
|
|
mutex_unlock(&data->lock);
|
|
|
|
|
|
- return 0;
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
#ifdef CONFIG_THERMAL_EMULATION
|