|
@@ -73,6 +73,9 @@ static int temp_to_code(struct exynos_tmu_data *data, u8 temp)
|
|
|
struct exynos_tmu_platform_data *pdata = data->pdata;
|
|
|
int temp_code;
|
|
|
|
|
|
+ if (pdata->cal_mode == HW_MODE)
|
|
|
+ return temp;
|
|
|
+
|
|
|
if (data->soc == SOC_ARCH_EXYNOS4210)
|
|
|
/* temp should range between 25 and 125 */
|
|
|
if (temp < 25 || temp > 125) {
|
|
@@ -107,6 +110,9 @@ static int code_to_temp(struct exynos_tmu_data *data, u8 temp_code)
|
|
|
struct exynos_tmu_platform_data *pdata = data->pdata;
|
|
|
int temp;
|
|
|
|
|
|
+ if (pdata->cal_mode == HW_MODE)
|
|
|
+ return temp_code;
|
|
|
+
|
|
|
if (data->soc == SOC_ARCH_EXYNOS4210)
|
|
|
/* temp_code should range between 75 and 175 */
|
|
|
if (temp_code < 75 || temp_code > 175) {
|
|
@@ -155,6 +161,9 @@ static int exynos_tmu_initialize(struct platform_device *pdev)
|
|
|
if (TMU_SUPPORTS(pdata, TRIM_RELOAD))
|
|
|
__raw_writel(1, data->base + reg->triminfo_ctrl);
|
|
|
|
|
|
+ if (pdata->cal_mode == HW_MODE)
|
|
|
+ goto skip_calib_data;
|
|
|
+
|
|
|
/* Save trimming info in order to perform calibration */
|
|
|
if (data->soc == SOC_ARCH_EXYNOS5440) {
|
|
|
/*
|
|
@@ -190,6 +199,7 @@ static int exynos_tmu_initialize(struct platform_device *pdev)
|
|
|
(pdata->efuse_value >> reg->triminfo_85_shift) &
|
|
|
EXYNOS_TMU_TEMP_MASK;
|
|
|
|
|
|
+skip_calib_data:
|
|
|
if (pdata->max_trigger_level > MAX_THRESHOLD_LEVS) {
|
|
|
dev_err(&pdev->dev, "Invalid max trigger level\n");
|
|
|
goto out;
|
|
@@ -297,7 +307,7 @@ 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;
|
|
|
const struct exynos_tmu_registers *reg = pdata->registers;
|
|
|
- unsigned int con, interrupt_en;
|
|
|
+ unsigned int con, interrupt_en, cal_val;
|
|
|
|
|
|
mutex_lock(&data->lock);
|
|
|
clk_enable(data->clk);
|
|
@@ -320,6 +330,27 @@ static void exynos_tmu_control(struct platform_device *pdev, bool on)
|
|
|
con |= (pdata->noise_cancel_mode << reg->therm_trip_mode_shift);
|
|
|
}
|
|
|
|
|
|
+ if (pdata->cal_mode == HW_MODE) {
|
|
|
+ con &= ~(reg->calib_mode_mask << reg->calib_mode_shift);
|
|
|
+ cal_val = 0;
|
|
|
+ switch (pdata->cal_type) {
|
|
|
+ case TYPE_TWO_POINT_TRIMMING:
|
|
|
+ cal_val = 3;
|
|
|
+ break;
|
|
|
+ case TYPE_ONE_POINT_TRIMMING_85:
|
|
|
+ cal_val = 2;
|
|
|
+ break;
|
|
|
+ case TYPE_ONE_POINT_TRIMMING_25:
|
|
|
+ cal_val = 1;
|
|
|
+ break;
|
|
|
+ case TYPE_NONE:
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ dev_err(&pdev->dev, "Invalid calibration type, using none\n");
|
|
|
+ }
|
|
|
+ con |= cal_val << reg->calib_mode_shift;
|
|
|
+ }
|
|
|
+
|
|
|
if (on) {
|
|
|
con |= (1 << reg->core_en_shift);
|
|
|
interrupt_en =
|