![Amit Daniel Kachhap](/assets/img/avatar_default.png)
This patch adds some extra register bitfield definations and cleans up the code to prepare for moving register macros and definations inside the TMU data section. In this code cleanup the TMU enable bit is correctly used as bit0 and bit1 is taken care which is reserve bit. Acked-by: Kukjin Kim <kgene.kim@samsung.com> Acked-by: Jonghwa Lee <jonghwa3.lee@samsung.com> Signed-off-by: Amit Daniel Kachhap <amit.daniel@samsung.com> Acked-by: Eduardo Valentin <eduardo.valentin@ti.com> Signed-off-by: Eduardo Valentin <eduardo.valentin@ti.com>
623 lines
16 KiB
C
623 lines
16 KiB
C
/*
|
|
* exynos_tmu.c - Samsung EXYNOS TMU (Thermal Management Unit)
|
|
*
|
|
* Copyright (C) 2011 Samsung Electronics
|
|
* Donggeun Kim <dg77.kim@samsung.com>
|
|
* Amit Daniel Kachhap <amit.kachhap@linaro.org>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*
|
|
*/
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/io.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/platform_device.h>
|
|
|
|
#include "exynos_thermal_common.h"
|
|
#include "exynos_tmu.h"
|
|
#include "exynos_tmu_data.h"
|
|
|
|
/* Exynos generic registers */
|
|
#define EXYNOS_TMU_REG_TRIMINFO 0x0
|
|
#define EXYNOS_TMU_REG_CONTROL 0x20
|
|
#define EXYNOS_TMU_REG_STATUS 0x28
|
|
#define EXYNOS_TMU_REG_CURRENT_TEMP 0x40
|
|
#define EXYNOS_TMU_REG_INTEN 0x70
|
|
#define EXYNOS_TMU_REG_INTSTAT 0x74
|
|
#define EXYNOS_TMU_REG_INTCLEAR 0x78
|
|
|
|
#define EXYNOS_TMU_TRIM_TEMP_MASK 0xff
|
|
#define EXYNOS_TMU_GAIN_SHIFT 8
|
|
#define EXYNOS_TMU_GAIN_MASK 0xf
|
|
#define EXYNOS_TMU_REF_VOLTAGE_SHIFT 24
|
|
#define EXYNOS_TMU_REF_VOLTAGE_MASK 0x1f
|
|
#define EXYNOS_TMU_BUF_SLOPE_SEL_MASK 0xf
|
|
#define EXYNOS_TMU_BUF_SLOPE_SEL_SHIFT 8
|
|
#define EXYNOS_TMU_CORE_EN_SHIFT 0
|
|
#define EXYNOS_TMU_DEF_CODE_TO_TEMP_OFFSET 50
|
|
|
|
/* Exynos4210 specific registers */
|
|
#define EXYNOS4210_TMU_REG_THRESHOLD_TEMP 0x44
|
|
#define EXYNOS4210_TMU_REG_TRIG_LEVEL0 0x50
|
|
#define EXYNOS4210_TMU_REG_TRIG_LEVEL1 0x54
|
|
#define EXYNOS4210_TMU_REG_TRIG_LEVEL2 0x58
|
|
#define EXYNOS4210_TMU_REG_TRIG_LEVEL3 0x5C
|
|
#define EXYNOS4210_TMU_REG_PAST_TEMP0 0x60
|
|
#define EXYNOS4210_TMU_REG_PAST_TEMP1 0x64
|
|
#define EXYNOS4210_TMU_REG_PAST_TEMP2 0x68
|
|
#define EXYNOS4210_TMU_REG_PAST_TEMP3 0x6C
|
|
|
|
#define EXYNOS4210_TMU_TRIG_LEVEL0_MASK 0x1
|
|
#define EXYNOS4210_TMU_TRIG_LEVEL1_MASK 0x10
|
|
#define EXYNOS4210_TMU_TRIG_LEVEL2_MASK 0x100
|
|
#define EXYNOS4210_TMU_TRIG_LEVEL3_MASK 0x1000
|
|
#define EXYNOS4210_TMU_TRIG_LEVEL_MASK 0x1111
|
|
#define EXYNOS4210_TMU_INTCLEAR_VAL 0x1111
|
|
|
|
/* Exynos5250 and Exynos4412 specific registers */
|
|
#define EXYNOS_TMU_TRIMINFO_CON 0x14
|
|
#define EXYNOS_THD_TEMP_RISE 0x50
|
|
#define EXYNOS_THD_TEMP_FALL 0x54
|
|
#define EXYNOS_EMUL_CON 0x80
|
|
|
|
#define EXYNOS_TRIMINFO_RELOAD 0x1
|
|
#define EXYNOS_TRIMINFO_SHIFT 0x0
|
|
#define EXYNOS_TMU_RISE_INT_MASK 0x111
|
|
#define EXYNOS_TMU_RISE_INT_SHIFT 0
|
|
#define EXYNOS_TMU_FALL_INT_MASK 0x111
|
|
#define EXYNOS_TMU_FALL_INT_SHIFT 12
|
|
#define EXYNOS_TMU_CLEAR_RISE_INT 0x111
|
|
#define EXYNOS_TMU_CLEAR_FALL_INT (0x111 << 12)
|
|
#define EXYNOS_TMU_TRIP_MODE_SHIFT 13
|
|
#define EXYNOS_TMU_TRIP_MODE_MASK 0x7
|
|
|
|
#define EXYNOS_TMU_INTEN_RISE0_SHIFT 0
|
|
#define EXYNOS_TMU_INTEN_RISE1_SHIFT 4
|
|
#define EXYNOS_TMU_INTEN_RISE2_SHIFT 8
|
|
#define EXYNOS_TMU_INTEN_RISE3_SHIFT 12
|
|
#define EXYNOS_TMU_INTEN_FALL0_SHIFT 16
|
|
#define EXYNOS_TMU_INTEN_FALL1_SHIFT 20
|
|
#define EXYNOS_TMU_INTEN_FALL2_SHIFT 24
|
|
|
|
#define EFUSE_MIN_VALUE 40
|
|
#define EFUSE_MAX_VALUE 100
|
|
|
|
#ifdef CONFIG_THERMAL_EMULATION
|
|
#define EXYNOS_EMUL_TIME 0x57F0
|
|
#define EXYNOS_EMUL_TIME_MASK 0xffff
|
|
#define EXYNOS_EMUL_TIME_SHIFT 16
|
|
#define EXYNOS_EMUL_DATA_SHIFT 8
|
|
#define EXYNOS_EMUL_DATA_MASK 0xFF
|
|
#define EXYNOS_EMUL_ENABLE 0x1
|
|
#endif /* CONFIG_THERMAL_EMULATION */
|
|
|
|
struct exynos_tmu_data {
|
|
struct exynos_tmu_platform_data *pdata;
|
|
struct resource *mem;
|
|
void __iomem *base;
|
|
int irq;
|
|
enum soc_type soc;
|
|
struct work_struct irq_work;
|
|
struct mutex lock;
|
|
struct clk *clk;
|
|
u8 temp_error1, temp_error2;
|
|
};
|
|
|
|
/*
|
|
* TMU treats temperature as a mapped temperature code.
|
|
* The temperature is converted differently depending on the calibration type.
|
|
*/
|
|
static int temp_to_code(struct exynos_tmu_data *data, u8 temp)
|
|
{
|
|
struct exynos_tmu_platform_data *pdata = data->pdata;
|
|
int temp_code;
|
|
|
|
if (data->soc == SOC_ARCH_EXYNOS4210)
|
|
/* temp should range between 25 and 125 */
|
|
if (temp < 25 || temp > 125) {
|
|
temp_code = -EINVAL;
|
|
goto out;
|
|
}
|
|
|
|
switch (pdata->cal_type) {
|
|
case TYPE_TWO_POINT_TRIMMING:
|
|
temp_code = (temp - 25) *
|
|
(data->temp_error2 - data->temp_error1) /
|
|
(85 - 25) + data->temp_error1;
|
|
break;
|
|
case TYPE_ONE_POINT_TRIMMING:
|
|
temp_code = temp + data->temp_error1 - 25;
|
|
break;
|
|
default:
|
|
temp_code = temp + EXYNOS_TMU_DEF_CODE_TO_TEMP_OFFSET;
|
|
break;
|
|
}
|
|
out:
|
|
return temp_code;
|
|
}
|
|
|
|
/*
|
|
* Calculate a temperature value from a temperature code.
|
|
* The unit of the temperature is degree Celsius.
|
|
*/
|
|
static int code_to_temp(struct exynos_tmu_data *data, u8 temp_code)
|
|
{
|
|
struct exynos_tmu_platform_data *pdata = data->pdata;
|
|
int temp;
|
|
|
|
if (data->soc == SOC_ARCH_EXYNOS4210)
|
|
/* temp_code should range between 75 and 175 */
|
|
if (temp_code < 75 || temp_code > 175) {
|
|
temp = -ENODATA;
|
|
goto out;
|
|
}
|
|
|
|
switch (pdata->cal_type) {
|
|
case TYPE_TWO_POINT_TRIMMING:
|
|
temp = (temp_code - data->temp_error1) * (85 - 25) /
|
|
(data->temp_error2 - data->temp_error1) + 25;
|
|
break;
|
|
case TYPE_ONE_POINT_TRIMMING:
|
|
temp = temp_code - data->temp_error1 + 25;
|
|
break;
|
|
default:
|
|
temp = temp_code - EXYNOS_TMU_DEF_CODE_TO_TEMP_OFFSET;
|
|
break;
|
|
}
|
|
out:
|
|
return temp;
|
|
}
|
|
|
|
static int exynos_tmu_initialize(struct platform_device *pdev)
|
|
{
|
|
struct exynos_tmu_data *data = platform_get_drvdata(pdev);
|
|
struct exynos_tmu_platform_data *pdata = data->pdata;
|
|
unsigned int status, trim_info;
|
|
unsigned int rising_threshold = 0, falling_threshold = 0;
|
|
int ret = 0, threshold_code, i, trigger_levs = 0;
|
|
|
|
mutex_lock(&data->lock);
|
|
clk_enable(data->clk);
|
|
|
|
status = readb(data->base + EXYNOS_TMU_REG_STATUS);
|
|
if (!status) {
|
|
ret = -EBUSY;
|
|
goto out;
|
|
}
|
|
|
|
if (data->soc == SOC_ARCH_EXYNOS) {
|
|
__raw_writel(EXYNOS_TRIMINFO_RELOAD,
|
|
data->base + EXYNOS_TMU_TRIMINFO_CON);
|
|
}
|
|
/* Save trimming info in order to perform calibration */
|
|
trim_info = readl(data->base + EXYNOS_TMU_REG_TRIMINFO);
|
|
data->temp_error1 = trim_info & EXYNOS_TMU_TRIM_TEMP_MASK;
|
|
data->temp_error2 = ((trim_info >> 8) & EXYNOS_TMU_TRIM_TEMP_MASK);
|
|
|
|
if ((EFUSE_MIN_VALUE > data->temp_error1) ||
|
|
(data->temp_error1 > EFUSE_MAX_VALUE) ||
|
|
(data->temp_error2 != 0))
|
|
data->temp_error1 = pdata->efuse_value;
|
|
|
|
/* Count trigger levels to be enabled */
|
|
for (i = 0; i < MAX_THRESHOLD_LEVS; i++)
|
|
if (pdata->trigger_levels[i])
|
|
trigger_levs++;
|
|
|
|
if (data->soc == SOC_ARCH_EXYNOS4210) {
|
|
/* Write temperature code for threshold */
|
|
threshold_code = temp_to_code(data, pdata->threshold);
|
|
if (threshold_code < 0) {
|
|
ret = threshold_code;
|
|
goto out;
|
|
}
|
|
writeb(threshold_code,
|
|
data->base + EXYNOS4210_TMU_REG_THRESHOLD_TEMP);
|
|
for (i = 0; i < trigger_levs; i++)
|
|
writeb(pdata->trigger_levels[i],
|
|
data->base + EXYNOS4210_TMU_REG_TRIG_LEVEL0 + i * 4);
|
|
|
|
writel(EXYNOS4210_TMU_INTCLEAR_VAL,
|
|
data->base + EXYNOS_TMU_REG_INTCLEAR);
|
|
} else if (data->soc == SOC_ARCH_EXYNOS) {
|
|
/* Write temperature code for rising and falling threshold */
|
|
for (i = 0; i < trigger_levs; i++) {
|
|
threshold_code = temp_to_code(data,
|
|
pdata->trigger_levels[i]);
|
|
if (threshold_code < 0) {
|
|
ret = threshold_code;
|
|
goto out;
|
|
}
|
|
rising_threshold |= threshold_code << 8 * i;
|
|
if (pdata->threshold_falling) {
|
|
threshold_code = temp_to_code(data,
|
|
pdata->trigger_levels[i] -
|
|
pdata->threshold_falling);
|
|
if (threshold_code > 0)
|
|
falling_threshold |=
|
|
threshold_code << 8 * i;
|
|
}
|
|
}
|
|
|
|
writel(rising_threshold,
|
|
data->base + EXYNOS_THD_TEMP_RISE);
|
|
writel(falling_threshold,
|
|
data->base + EXYNOS_THD_TEMP_FALL);
|
|
|
|
writel(EXYNOS_TMU_CLEAR_RISE_INT | EXYNOS_TMU_CLEAR_FALL_INT,
|
|
data->base + EXYNOS_TMU_REG_INTCLEAR);
|
|
}
|
|
out:
|
|
clk_disable(data->clk);
|
|
mutex_unlock(&data->lock);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void exynos_tmu_control(struct platform_device *pdev, bool on)
|
|
{
|
|
struct exynos_tmu_data *data = platform_get_drvdata(pdev);
|
|
struct exynos_tmu_platform_data *pdata = data->pdata;
|
|
unsigned int con, interrupt_en;
|
|
|
|
mutex_lock(&data->lock);
|
|
clk_enable(data->clk);
|
|
|
|
con = readl(data->base + EXYNOS_TMU_REG_CONTROL);
|
|
|
|
if (pdata->reference_voltage) {
|
|
con &= ~(EXYNOS_TMU_REF_VOLTAGE_MASK <<
|
|
EXYNOS_TMU_REF_VOLTAGE_SHIFT);
|
|
con |= pdata->reference_voltage << EXYNOS_TMU_REF_VOLTAGE_SHIFT;
|
|
}
|
|
|
|
if (pdata->gain) {
|
|
con &= ~(EXYNOS_TMU_GAIN_MASK << EXYNOS_TMU_GAIN_SHIFT);
|
|
con |= (pdata->gain << EXYNOS_TMU_GAIN_SHIFT);
|
|
}
|
|
|
|
if (pdata->noise_cancel_mode) {
|
|
con &= ~(EXYNOS_TMU_TRIP_MODE_MASK <<
|
|
EXYNOS_TMU_TRIP_MODE_SHIFT);
|
|
con |= (pdata->noise_cancel_mode << EXYNOS_TMU_TRIP_MODE_SHIFT);
|
|
}
|
|
|
|
if (on) {
|
|
con |= (1 << EXYNOS_TMU_CORE_EN_SHIFT);
|
|
interrupt_en =
|
|
pdata->trigger_level3_en << EXYNOS_TMU_INTEN_RISE3_SHIFT |
|
|
pdata->trigger_level2_en << EXYNOS_TMU_INTEN_RISE2_SHIFT |
|
|
pdata->trigger_level1_en << EXYNOS_TMU_INTEN_RISE1_SHIFT |
|
|
pdata->trigger_level0_en << EXYNOS_TMU_INTEN_RISE0_SHIFT;
|
|
if (pdata->threshold_falling)
|
|
interrupt_en |=
|
|
interrupt_en << EXYNOS_TMU_INTEN_FALL0_SHIFT;
|
|
} else {
|
|
con &= ~(1 << EXYNOS_TMU_CORE_EN_SHIFT);
|
|
interrupt_en = 0; /* Disable all interrupts */
|
|
}
|
|
writel(interrupt_en, data->base + EXYNOS_TMU_REG_INTEN);
|
|
writel(con, data->base + EXYNOS_TMU_REG_CONTROL);
|
|
|
|
clk_disable(data->clk);
|
|
mutex_unlock(&data->lock);
|
|
}
|
|
|
|
static int exynos_tmu_read(struct exynos_tmu_data *data)
|
|
{
|
|
u8 temp_code;
|
|
int temp;
|
|
|
|
mutex_lock(&data->lock);
|
|
clk_enable(data->clk);
|
|
|
|
temp_code = readb(data->base + EXYNOS_TMU_REG_CURRENT_TEMP);
|
|
temp = code_to_temp(data, temp_code);
|
|
|
|
clk_disable(data->clk);
|
|
mutex_unlock(&data->lock);
|
|
|
|
return temp;
|
|
}
|
|
|
|
#ifdef CONFIG_THERMAL_EMULATION
|
|
static int exynos_tmu_set_emulation(void *drv_data, unsigned long temp)
|
|
{
|
|
struct exynos_tmu_data *data = drv_data;
|
|
unsigned int reg;
|
|
int ret = -EINVAL;
|
|
|
|
if (data->soc == SOC_ARCH_EXYNOS4210)
|
|
goto out;
|
|
|
|
if (temp && temp < MCELSIUS)
|
|
goto out;
|
|
|
|
mutex_lock(&data->lock);
|
|
clk_enable(data->clk);
|
|
|
|
reg = readl(data->base + EXYNOS_EMUL_CON);
|
|
|
|
if (temp) {
|
|
temp /= MCELSIUS;
|
|
|
|
reg = (EXYNOS_EMUL_TIME << EXYNOS_EMUL_TIME_SHIFT) |
|
|
(temp_to_code(data, temp)
|
|
<< EXYNOS_EMUL_DATA_SHIFT) | EXYNOS_EMUL_ENABLE;
|
|
} else {
|
|
reg &= ~EXYNOS_EMUL_ENABLE;
|
|
}
|
|
|
|
writel(reg, data->base + EXYNOS_EMUL_CON);
|
|
|
|
clk_disable(data->clk);
|
|
mutex_unlock(&data->lock);
|
|
return 0;
|
|
out:
|
|
return ret;
|
|
}
|
|
#else
|
|
static int exynos_tmu_set_emulation(void *drv_data, unsigned long temp)
|
|
{ return -EINVAL; }
|
|
#endif/*CONFIG_THERMAL_EMULATION*/
|
|
|
|
static void exynos_tmu_work(struct work_struct *work)
|
|
{
|
|
struct exynos_tmu_data *data = container_of(work,
|
|
struct exynos_tmu_data, irq_work);
|
|
|
|
exynos_report_trigger();
|
|
mutex_lock(&data->lock);
|
|
clk_enable(data->clk);
|
|
if (data->soc == SOC_ARCH_EXYNOS)
|
|
writel(EXYNOS_TMU_CLEAR_RISE_INT |
|
|
EXYNOS_TMU_CLEAR_FALL_INT,
|
|
data->base + EXYNOS_TMU_REG_INTCLEAR);
|
|
else
|
|
writel(EXYNOS4210_TMU_INTCLEAR_VAL,
|
|
data->base + EXYNOS_TMU_REG_INTCLEAR);
|
|
clk_disable(data->clk);
|
|
mutex_unlock(&data->lock);
|
|
|
|
enable_irq(data->irq);
|
|
}
|
|
|
|
static irqreturn_t exynos_tmu_irq(int irq, void *id)
|
|
{
|
|
struct exynos_tmu_data *data = id;
|
|
|
|
disable_irq_nosync(irq);
|
|
schedule_work(&data->irq_work);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
static struct thermal_sensor_conf exynos_sensor_conf = {
|
|
.name = "exynos-therm",
|
|
.read_temperature = (int (*)(void *))exynos_tmu_read,
|
|
.write_emul_temp = exynos_tmu_set_emulation,
|
|
};
|
|
|
|
#ifdef CONFIG_OF
|
|
static const struct of_device_id exynos_tmu_match[] = {
|
|
{
|
|
.compatible = "samsung,exynos4210-tmu",
|
|
.data = (void *)EXYNOS4210_TMU_DRV_DATA,
|
|
},
|
|
{
|
|
.compatible = "samsung,exynos4412-tmu",
|
|
.data = (void *)EXYNOS5250_TMU_DRV_DATA,
|
|
},
|
|
{
|
|
.compatible = "samsung,exynos5250-tmu",
|
|
.data = (void *)EXYNOS5250_TMU_DRV_DATA,
|
|
},
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, exynos_tmu_match);
|
|
#endif
|
|
|
|
static struct platform_device_id exynos_tmu_driver_ids[] = {
|
|
{
|
|
.name = "exynos4210-tmu",
|
|
.driver_data = (kernel_ulong_t)EXYNOS4210_TMU_DRV_DATA,
|
|
},
|
|
{
|
|
.name = "exynos5250-tmu",
|
|
.driver_data = (kernel_ulong_t)EXYNOS5250_TMU_DRV_DATA,
|
|
},
|
|
{ },
|
|
};
|
|
MODULE_DEVICE_TABLE(platform, exynos_tmu_driver_ids);
|
|
|
|
static inline struct exynos_tmu_platform_data *exynos_get_driver_data(
|
|
struct platform_device *pdev)
|
|
{
|
|
#ifdef CONFIG_OF
|
|
if (pdev->dev.of_node) {
|
|
const struct of_device_id *match;
|
|
match = of_match_node(exynos_tmu_match, pdev->dev.of_node);
|
|
if (!match)
|
|
return NULL;
|
|
return (struct exynos_tmu_platform_data *) match->data;
|
|
}
|
|
#endif
|
|
return (struct exynos_tmu_platform_data *)
|
|
platform_get_device_id(pdev)->driver_data;
|
|
}
|
|
|
|
static int exynos_tmu_probe(struct platform_device *pdev)
|
|
{
|
|
struct exynos_tmu_data *data;
|
|
struct exynos_tmu_platform_data *pdata = pdev->dev.platform_data;
|
|
int ret, i;
|
|
|
|
if (!pdata)
|
|
pdata = exynos_get_driver_data(pdev);
|
|
|
|
if (!pdata) {
|
|
dev_err(&pdev->dev, "No platform init data supplied.\n");
|
|
return -ENODEV;
|
|
}
|
|
data = devm_kzalloc(&pdev->dev, sizeof(struct exynos_tmu_data),
|
|
GFP_KERNEL);
|
|
if (!data) {
|
|
dev_err(&pdev->dev, "Failed to allocate driver structure\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
data->irq = platform_get_irq(pdev, 0);
|
|
if (data->irq < 0) {
|
|
dev_err(&pdev->dev, "Failed to get platform irq\n");
|
|
return data->irq;
|
|
}
|
|
|
|
INIT_WORK(&data->irq_work, exynos_tmu_work);
|
|
|
|
data->mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
data->base = devm_ioremap_resource(&pdev->dev, data->mem);
|
|
if (IS_ERR(data->base))
|
|
return PTR_ERR(data->base);
|
|
|
|
ret = devm_request_irq(&pdev->dev, data->irq, exynos_tmu_irq,
|
|
IRQF_TRIGGER_RISING, "exynos-tmu", data);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "Failed to request irq: %d\n", data->irq);
|
|
return ret;
|
|
}
|
|
|
|
data->clk = devm_clk_get(&pdev->dev, "tmu_apbif");
|
|
if (IS_ERR(data->clk)) {
|
|
dev_err(&pdev->dev, "Failed to get clock\n");
|
|
return PTR_ERR(data->clk);
|
|
}
|
|
|
|
ret = clk_prepare(data->clk);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (pdata->type == SOC_ARCH_EXYNOS ||
|
|
pdata->type == SOC_ARCH_EXYNOS4210)
|
|
data->soc = pdata->type;
|
|
else {
|
|
ret = -EINVAL;
|
|
dev_err(&pdev->dev, "Platform not supported\n");
|
|
goto err_clk;
|
|
}
|
|
|
|
data->pdata = pdata;
|
|
platform_set_drvdata(pdev, data);
|
|
mutex_init(&data->lock);
|
|
|
|
ret = exynos_tmu_initialize(pdev);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "Failed to initialize TMU\n");
|
|
goto err_clk;
|
|
}
|
|
|
|
exynos_tmu_control(pdev, true);
|
|
|
|
/* Register the sensor with thermal management interface */
|
|
(&exynos_sensor_conf)->private_data = data;
|
|
exynos_sensor_conf.trip_data.trip_count = pdata->trigger_level0_en +
|
|
pdata->trigger_level1_en + pdata->trigger_level2_en +
|
|
pdata->trigger_level3_en;
|
|
|
|
for (i = 0; i < exynos_sensor_conf.trip_data.trip_count; i++)
|
|
exynos_sensor_conf.trip_data.trip_val[i] =
|
|
pdata->threshold + pdata->trigger_levels[i];
|
|
|
|
exynos_sensor_conf.trip_data.trigger_falling = pdata->threshold_falling;
|
|
|
|
exynos_sensor_conf.cooling_data.freq_clip_count =
|
|
pdata->freq_tab_count;
|
|
for (i = 0; i < pdata->freq_tab_count; i++) {
|
|
exynos_sensor_conf.cooling_data.freq_data[i].freq_clip_max =
|
|
pdata->freq_tab[i].freq_clip_max;
|
|
exynos_sensor_conf.cooling_data.freq_data[i].temp_level =
|
|
pdata->freq_tab[i].temp_level;
|
|
}
|
|
|
|
ret = exynos_register_thermal(&exynos_sensor_conf);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "Failed to register thermal interface\n");
|
|
goto err_clk;
|
|
}
|
|
|
|
return 0;
|
|
err_clk:
|
|
clk_unprepare(data->clk);
|
|
return ret;
|
|
}
|
|
|
|
static int exynos_tmu_remove(struct platform_device *pdev)
|
|
{
|
|
struct exynos_tmu_data *data = platform_get_drvdata(pdev);
|
|
|
|
exynos_tmu_control(pdev, false);
|
|
|
|
exynos_unregister_thermal();
|
|
|
|
clk_unprepare(data->clk);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM_SLEEP
|
|
static int exynos_tmu_suspend(struct device *dev)
|
|
{
|
|
exynos_tmu_control(to_platform_device(dev), false);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int exynos_tmu_resume(struct device *dev)
|
|
{
|
|
struct platform_device *pdev = to_platform_device(dev);
|
|
|
|
exynos_tmu_initialize(pdev);
|
|
exynos_tmu_control(pdev, true);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static SIMPLE_DEV_PM_OPS(exynos_tmu_pm,
|
|
exynos_tmu_suspend, exynos_tmu_resume);
|
|
#define EXYNOS_TMU_PM (&exynos_tmu_pm)
|
|
#else
|
|
#define EXYNOS_TMU_PM NULL
|
|
#endif
|
|
|
|
static struct platform_driver exynos_tmu_driver = {
|
|
.driver = {
|
|
.name = "exynos-tmu",
|
|
.owner = THIS_MODULE,
|
|
.pm = EXYNOS_TMU_PM,
|
|
.of_match_table = of_match_ptr(exynos_tmu_match),
|
|
},
|
|
.probe = exynos_tmu_probe,
|
|
.remove = exynos_tmu_remove,
|
|
.id_table = exynos_tmu_driver_ids,
|
|
};
|
|
|
|
module_platform_driver(exynos_tmu_driver);
|
|
|
|
MODULE_DESCRIPTION("EXYNOS TMU Driver");
|
|
MODULE_AUTHOR("Donggeun Kim <dg77.kim@samsung.com>");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_ALIAS("platform:exynos-tmu");
|