xref: /linux/drivers/thermal/samsung/exynos_tmu.c (revision 99d67fb993bbe2f27b0004332218108d66c78af4)
159dfa54cSAmit Daniel Kachhap /*
259dfa54cSAmit Daniel Kachhap  * exynos_tmu.c - Samsung EXYNOS TMU (Thermal Management Unit)
359dfa54cSAmit Daniel Kachhap  *
459dfa54cSAmit Daniel Kachhap  *  Copyright (C) 2011 Samsung Electronics
559dfa54cSAmit Daniel Kachhap  *  Donggeun Kim <dg77.kim@samsung.com>
659dfa54cSAmit Daniel Kachhap  *  Amit Daniel Kachhap <amit.kachhap@linaro.org>
759dfa54cSAmit Daniel Kachhap  *
859dfa54cSAmit Daniel Kachhap  * This program is free software; you can redistribute it and/or modify
959dfa54cSAmit Daniel Kachhap  * it under the terms of the GNU General Public License as published by
1059dfa54cSAmit Daniel Kachhap  * the Free Software Foundation; either version 2 of the License, or
1159dfa54cSAmit Daniel Kachhap  * (at your option) any later version.
1259dfa54cSAmit Daniel Kachhap  *
1359dfa54cSAmit Daniel Kachhap  * This program is distributed in the hope that it will be useful,
1459dfa54cSAmit Daniel Kachhap  * but WITHOUT ANY WARRANTY; without even the implied warranty of
1559dfa54cSAmit Daniel Kachhap  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
1659dfa54cSAmit Daniel Kachhap  * GNU General Public License for more details.
1759dfa54cSAmit Daniel Kachhap  *
1859dfa54cSAmit Daniel Kachhap  * You should have received a copy of the GNU General Public License
1959dfa54cSAmit Daniel Kachhap  * along with this program; if not, write to the Free Software
2059dfa54cSAmit Daniel Kachhap  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
2159dfa54cSAmit Daniel Kachhap  *
2259dfa54cSAmit Daniel Kachhap  */
2359dfa54cSAmit Daniel Kachhap 
2459dfa54cSAmit Daniel Kachhap #include <linux/clk.h>
2559dfa54cSAmit Daniel Kachhap #include <linux/io.h>
2659dfa54cSAmit Daniel Kachhap #include <linux/interrupt.h>
2759dfa54cSAmit Daniel Kachhap #include <linux/module.h>
2859dfa54cSAmit Daniel Kachhap #include <linux/of.h>
29cebe7373SAmit Daniel Kachhap #include <linux/of_address.h>
30cebe7373SAmit Daniel Kachhap #include <linux/of_irq.h>
3159dfa54cSAmit Daniel Kachhap #include <linux/platform_device.h>
32498d22f6SAmit Daniel Kachhap #include <linux/regulator/consumer.h>
3359dfa54cSAmit Daniel Kachhap 
3459dfa54cSAmit Daniel Kachhap #include "exynos_thermal_common.h"
350c1836a6SAmit Daniel Kachhap #include "exynos_tmu.h"
36e6b7991eSAmit Daniel Kachhap #include "exynos_tmu_data.h"
3759dfa54cSAmit Daniel Kachhap 
38cebe7373SAmit Daniel Kachhap /**
39cebe7373SAmit Daniel Kachhap  * struct exynos_tmu_data : A structure to hold the private data of the TMU
40cebe7373SAmit Daniel Kachhap 	driver
41cebe7373SAmit Daniel Kachhap  * @id: identifier of the one instance of the TMU controller.
42cebe7373SAmit Daniel Kachhap  * @pdata: pointer to the tmu platform/configuration data
43cebe7373SAmit Daniel Kachhap  * @base: base address of the single instance of the TMU controller.
449025d563SNaveen Krishna Chatradhi  * @base_second: base address of the common registers of the TMU controller.
45cebe7373SAmit Daniel Kachhap  * @irq: irq number of the TMU controller.
46cebe7373SAmit Daniel Kachhap  * @soc: id of the SOC type.
47cebe7373SAmit Daniel Kachhap  * @irq_work: pointer to the irq work structure.
48cebe7373SAmit Daniel Kachhap  * @lock: lock to implement synchronization.
49cebe7373SAmit Daniel Kachhap  * @clk: pointer to the clock structure.
5014a11dc7SNaveen Krishna Chatradhi  * @clk_sec: pointer to the clock structure for accessing the base_second.
51cebe7373SAmit Daniel Kachhap  * @temp_error1: fused value of the first point trim.
52cebe7373SAmit Daniel Kachhap  * @temp_error2: fused value of the second point trim.
53498d22f6SAmit Daniel Kachhap  * @regulator: pointer to the TMU regulator structure.
54cebe7373SAmit Daniel Kachhap  * @reg_conf: pointer to structure to register with core thermal.
55cebe7373SAmit Daniel Kachhap  */
5659dfa54cSAmit Daniel Kachhap struct exynos_tmu_data {
57cebe7373SAmit Daniel Kachhap 	int id;
5859dfa54cSAmit Daniel Kachhap 	struct exynos_tmu_platform_data *pdata;
5959dfa54cSAmit Daniel Kachhap 	void __iomem *base;
609025d563SNaveen Krishna Chatradhi 	void __iomem *base_second;
6159dfa54cSAmit Daniel Kachhap 	int irq;
6259dfa54cSAmit Daniel Kachhap 	enum soc_type soc;
6359dfa54cSAmit Daniel Kachhap 	struct work_struct irq_work;
6459dfa54cSAmit Daniel Kachhap 	struct mutex lock;
6514a11dc7SNaveen Krishna Chatradhi 	struct clk *clk, *clk_sec;
6659dfa54cSAmit Daniel Kachhap 	u8 temp_error1, temp_error2;
67498d22f6SAmit Daniel Kachhap 	struct regulator *regulator;
68cebe7373SAmit Daniel Kachhap 	struct thermal_sensor_conf *reg_conf;
6959dfa54cSAmit Daniel Kachhap };
7059dfa54cSAmit Daniel Kachhap 
7159dfa54cSAmit Daniel Kachhap /*
7259dfa54cSAmit Daniel Kachhap  * TMU treats temperature as a mapped temperature code.
7359dfa54cSAmit Daniel Kachhap  * The temperature is converted differently depending on the calibration type.
7459dfa54cSAmit Daniel Kachhap  */
7559dfa54cSAmit Daniel Kachhap static int temp_to_code(struct exynos_tmu_data *data, u8 temp)
7659dfa54cSAmit Daniel Kachhap {
7759dfa54cSAmit Daniel Kachhap 	struct exynos_tmu_platform_data *pdata = data->pdata;
7859dfa54cSAmit Daniel Kachhap 	int temp_code;
7959dfa54cSAmit Daniel Kachhap 
8059dfa54cSAmit Daniel Kachhap 	switch (pdata->cal_type) {
8159dfa54cSAmit Daniel Kachhap 	case TYPE_TWO_POINT_TRIMMING:
82bb34b4c8SAmit Daniel Kachhap 		temp_code = (temp - pdata->first_point_trim) *
8359dfa54cSAmit Daniel Kachhap 			(data->temp_error2 - data->temp_error1) /
84bb34b4c8SAmit Daniel Kachhap 			(pdata->second_point_trim - pdata->first_point_trim) +
85bb34b4c8SAmit Daniel Kachhap 			data->temp_error1;
8659dfa54cSAmit Daniel Kachhap 		break;
8759dfa54cSAmit Daniel Kachhap 	case TYPE_ONE_POINT_TRIMMING:
88bb34b4c8SAmit Daniel Kachhap 		temp_code = temp + data->temp_error1 - pdata->first_point_trim;
8959dfa54cSAmit Daniel Kachhap 		break;
9059dfa54cSAmit Daniel Kachhap 	default:
91bb34b4c8SAmit Daniel Kachhap 		temp_code = temp + pdata->default_temp_offset;
9259dfa54cSAmit Daniel Kachhap 		break;
9359dfa54cSAmit Daniel Kachhap 	}
94ddb31d43SBartlomiej Zolnierkiewicz 
9559dfa54cSAmit Daniel Kachhap 	return temp_code;
9659dfa54cSAmit Daniel Kachhap }
9759dfa54cSAmit Daniel Kachhap 
9859dfa54cSAmit Daniel Kachhap /*
9959dfa54cSAmit Daniel Kachhap  * Calculate a temperature value from a temperature code.
10059dfa54cSAmit Daniel Kachhap  * The unit of the temperature is degree Celsius.
10159dfa54cSAmit Daniel Kachhap  */
10259dfa54cSAmit Daniel Kachhap static int code_to_temp(struct exynos_tmu_data *data, u8 temp_code)
10359dfa54cSAmit Daniel Kachhap {
10459dfa54cSAmit Daniel Kachhap 	struct exynos_tmu_platform_data *pdata = data->pdata;
10559dfa54cSAmit Daniel Kachhap 	int temp;
10659dfa54cSAmit Daniel Kachhap 
10759dfa54cSAmit Daniel Kachhap 	switch (pdata->cal_type) {
10859dfa54cSAmit Daniel Kachhap 	case TYPE_TWO_POINT_TRIMMING:
109bb34b4c8SAmit Daniel Kachhap 		temp = (temp_code - data->temp_error1) *
110bb34b4c8SAmit Daniel Kachhap 			(pdata->second_point_trim - pdata->first_point_trim) /
111bb34b4c8SAmit Daniel Kachhap 			(data->temp_error2 - data->temp_error1) +
112bb34b4c8SAmit Daniel Kachhap 			pdata->first_point_trim;
11359dfa54cSAmit Daniel Kachhap 		break;
11459dfa54cSAmit Daniel Kachhap 	case TYPE_ONE_POINT_TRIMMING:
115bb34b4c8SAmit Daniel Kachhap 		temp = temp_code - data->temp_error1 + pdata->first_point_trim;
11659dfa54cSAmit Daniel Kachhap 		break;
11759dfa54cSAmit Daniel Kachhap 	default:
118bb34b4c8SAmit Daniel Kachhap 		temp = temp_code - pdata->default_temp_offset;
11959dfa54cSAmit Daniel Kachhap 		break;
12059dfa54cSAmit Daniel Kachhap 	}
121ddb31d43SBartlomiej Zolnierkiewicz 
12259dfa54cSAmit Daniel Kachhap 	return temp;
12359dfa54cSAmit Daniel Kachhap }
12459dfa54cSAmit Daniel Kachhap 
12559dfa54cSAmit Daniel Kachhap static int exynos_tmu_initialize(struct platform_device *pdev)
12659dfa54cSAmit Daniel Kachhap {
12759dfa54cSAmit Daniel Kachhap 	struct exynos_tmu_data *data = platform_get_drvdata(pdev);
12859dfa54cSAmit Daniel Kachhap 	struct exynos_tmu_platform_data *pdata = data->pdata;
129b8d582b9SAmit Daniel Kachhap 	const struct exynos_tmu_registers *reg = pdata->registers;
1307ca04e58SAmit Daniel Kachhap 	unsigned int status, trim_info = 0, con;
13159dfa54cSAmit Daniel Kachhap 	unsigned int rising_threshold = 0, falling_threshold = 0;
132ac951af5SBartlomiej Zolnierkiewicz 	int ret = 0, threshold_code, i;
13359dfa54cSAmit Daniel Kachhap 
13459dfa54cSAmit Daniel Kachhap 	mutex_lock(&data->lock);
13559dfa54cSAmit Daniel Kachhap 	clk_enable(data->clk);
13614a11dc7SNaveen Krishna Chatradhi 	if (!IS_ERR(data->clk_sec))
13714a11dc7SNaveen Krishna Chatradhi 		clk_enable(data->clk_sec);
13859dfa54cSAmit Daniel Kachhap 
139f4dae753SAmit Daniel Kachhap 	if (TMU_SUPPORTS(pdata, READY_STATUS)) {
140b8d582b9SAmit Daniel Kachhap 		status = readb(data->base + reg->tmu_status);
14159dfa54cSAmit Daniel Kachhap 		if (!status) {
14259dfa54cSAmit Daniel Kachhap 			ret = -EBUSY;
14359dfa54cSAmit Daniel Kachhap 			goto out;
14459dfa54cSAmit Daniel Kachhap 		}
145f4dae753SAmit Daniel Kachhap 	}
14659dfa54cSAmit Daniel Kachhap 
147f4dae753SAmit Daniel Kachhap 	if (TMU_SUPPORTS(pdata, TRIM_RELOAD))
148b8d582b9SAmit Daniel Kachhap 		__raw_writel(1, data->base + reg->triminfo_ctrl);
149b8d582b9SAmit Daniel Kachhap 
15059dfa54cSAmit Daniel Kachhap 	/* Save trimming info in order to perform calibration */
151a0395eeeSAmit Daniel Kachhap 	if (data->soc == SOC_ARCH_EXYNOS5440) {
152a0395eeeSAmit Daniel Kachhap 		/*
153a0395eeeSAmit Daniel Kachhap 		 * For exynos5440 soc triminfo value is swapped between TMU0 and
154a0395eeeSAmit Daniel Kachhap 		 * TMU2, so the below logic is needed.
155a0395eeeSAmit Daniel Kachhap 		 */
156a0395eeeSAmit Daniel Kachhap 		switch (data->id) {
157a0395eeeSAmit Daniel Kachhap 		case 0:
158a0395eeeSAmit Daniel Kachhap 			trim_info = readl(data->base +
159a0395eeeSAmit Daniel Kachhap 			EXYNOS5440_EFUSE_SWAP_OFFSET + reg->triminfo_data);
160a0395eeeSAmit Daniel Kachhap 			break;
161a0395eeeSAmit Daniel Kachhap 		case 1:
162b8d582b9SAmit Daniel Kachhap 			trim_info = readl(data->base + reg->triminfo_data);
163a0395eeeSAmit Daniel Kachhap 			break;
164a0395eeeSAmit Daniel Kachhap 		case 2:
165a0395eeeSAmit Daniel Kachhap 			trim_info = readl(data->base -
166a0395eeeSAmit Daniel Kachhap 			EXYNOS5440_EFUSE_SWAP_OFFSET + reg->triminfo_data);
167a0395eeeSAmit Daniel Kachhap 		}
168a0395eeeSAmit Daniel Kachhap 	} else {
16914a11dc7SNaveen Krishna Chatradhi 		/* On exynos5420 the triminfo register is in the shared space */
17014a11dc7SNaveen Krishna Chatradhi 		if (data->soc == SOC_ARCH_EXYNOS5420_TRIMINFO)
17114a11dc7SNaveen Krishna Chatradhi 			trim_info = readl(data->base_second +
17214a11dc7SNaveen Krishna Chatradhi 							reg->triminfo_data);
17314a11dc7SNaveen Krishna Chatradhi 		else
174a0395eeeSAmit Daniel Kachhap 			trim_info = readl(data->base + reg->triminfo_data);
175a0395eeeSAmit Daniel Kachhap 	}
176b8d582b9SAmit Daniel Kachhap 	data->temp_error1 = trim_info & EXYNOS_TMU_TEMP_MASK;
177*99d67fb9SBartlomiej Zolnierkiewicz 	data->temp_error2 = ((trim_info >> EXYNOS_TRIMINFO_85_SHIFT) &
178b8d582b9SAmit Daniel Kachhap 				EXYNOS_TMU_TEMP_MASK);
17959dfa54cSAmit Daniel Kachhap 
1805000806cSAmit Daniel Kachhap 	if (!data->temp_error1 ||
1815000806cSAmit Daniel Kachhap 		(pdata->min_efuse_value > data->temp_error1) ||
1825000806cSAmit Daniel Kachhap 		(data->temp_error1 > pdata->max_efuse_value))
1835000806cSAmit Daniel Kachhap 		data->temp_error1 = pdata->efuse_value & EXYNOS_TMU_TEMP_MASK;
1845000806cSAmit Daniel Kachhap 
1855000806cSAmit Daniel Kachhap 	if (!data->temp_error2)
1865000806cSAmit Daniel Kachhap 		data->temp_error2 =
187*99d67fb9SBartlomiej Zolnierkiewicz 			(pdata->efuse_value >> EXYNOS_TRIMINFO_85_SHIFT) &
1885000806cSAmit Daniel Kachhap 			EXYNOS_TMU_TEMP_MASK;
18959dfa54cSAmit Daniel Kachhap 
190c65d3473STushar Behera 	rising_threshold = readl(data->base + reg->threshold_th0);
191c65d3473STushar Behera 
19259dfa54cSAmit Daniel Kachhap 	if (data->soc == SOC_ARCH_EXYNOS4210) {
19359dfa54cSAmit Daniel Kachhap 		/* Write temperature code for threshold */
19459dfa54cSAmit Daniel Kachhap 		threshold_code = temp_to_code(data, pdata->threshold);
19559dfa54cSAmit Daniel Kachhap 		writeb(threshold_code,
196b8d582b9SAmit Daniel Kachhap 			data->base + reg->threshold_temp);
197ac951af5SBartlomiej Zolnierkiewicz 		for (i = 0; i < pdata->non_hw_trigger_levels; i++)
198b8d582b9SAmit Daniel Kachhap 			writeb(pdata->trigger_levels[i], data->base +
199b8d582b9SAmit Daniel Kachhap 			reg->threshold_th0 + i * sizeof(reg->threshold_th0));
20059dfa54cSAmit Daniel Kachhap 
20174429c2fSNaveen Krishna Chatradhi 		writel(reg->intclr_rise_mask, data->base + reg->tmu_intclear);
202a0395eeeSAmit Daniel Kachhap 	} else {
20359dfa54cSAmit Daniel Kachhap 		/* Write temperature code for rising and falling threshold */
204ac951af5SBartlomiej Zolnierkiewicz 		for (i = 0; i < pdata->non_hw_trigger_levels; i++) {
20559dfa54cSAmit Daniel Kachhap 			threshold_code = temp_to_code(data,
20659dfa54cSAmit Daniel Kachhap 						pdata->trigger_levels[i]);
207c65d3473STushar Behera 			rising_threshold &= ~(0xff << 8 * i);
20859dfa54cSAmit Daniel Kachhap 			rising_threshold |= threshold_code << 8 * i;
20959dfa54cSAmit Daniel Kachhap 			if (pdata->threshold_falling) {
21059dfa54cSAmit Daniel Kachhap 				threshold_code = temp_to_code(data,
21159dfa54cSAmit Daniel Kachhap 						pdata->trigger_levels[i] -
21259dfa54cSAmit Daniel Kachhap 						pdata->threshold_falling);
2138131a246SBartlomiej Zolnierkiewicz 				falling_threshold |= threshold_code << 8 * i;
21459dfa54cSAmit Daniel Kachhap 			}
21559dfa54cSAmit Daniel Kachhap 		}
21659dfa54cSAmit Daniel Kachhap 
21759dfa54cSAmit Daniel Kachhap 		writel(rising_threshold,
218b8d582b9SAmit Daniel Kachhap 				data->base + reg->threshold_th0);
21959dfa54cSAmit Daniel Kachhap 		writel(falling_threshold,
220b8d582b9SAmit Daniel Kachhap 				data->base + reg->threshold_th1);
22159dfa54cSAmit Daniel Kachhap 
22274429c2fSNaveen Krishna Chatradhi 		writel((reg->intclr_rise_mask << reg->intclr_rise_shift) |
22374429c2fSNaveen Krishna Chatradhi 			(reg->intclr_fall_mask << reg->intclr_fall_shift),
224b8d582b9SAmit Daniel Kachhap 				data->base + reg->tmu_intclear);
2257ca04e58SAmit Daniel Kachhap 
2267ca04e58SAmit Daniel Kachhap 		/* if last threshold limit is also present */
2277ca04e58SAmit Daniel Kachhap 		i = pdata->max_trigger_level - 1;
2287ca04e58SAmit Daniel Kachhap 		if (pdata->trigger_levels[i] &&
2297ca04e58SAmit Daniel Kachhap 				(pdata->trigger_type[i] == HW_TRIP)) {
2307ca04e58SAmit Daniel Kachhap 			threshold_code = temp_to_code(data,
2317ca04e58SAmit Daniel Kachhap 						pdata->trigger_levels[i]);
232a0395eeeSAmit Daniel Kachhap 			if (i == EXYNOS_MAX_TRIGGER_PER_REG - 1) {
233a0395eeeSAmit Daniel Kachhap 				/* 1-4 level to be assigned in th0 reg */
234c65d3473STushar Behera 				rising_threshold &= ~(0xff << 8 * i);
2357ca04e58SAmit Daniel Kachhap 				rising_threshold |= threshold_code << 8 * i;
2367ca04e58SAmit Daniel Kachhap 				writel(rising_threshold,
2377ca04e58SAmit Daniel Kachhap 					data->base + reg->threshold_th0);
238a0395eeeSAmit Daniel Kachhap 			} else if (i == EXYNOS_MAX_TRIGGER_PER_REG) {
239a0395eeeSAmit Daniel Kachhap 				/* 5th level to be assigned in th2 reg */
240a0395eeeSAmit Daniel Kachhap 				rising_threshold =
241a0395eeeSAmit Daniel Kachhap 				threshold_code << reg->threshold_th3_l0_shift;
242a0395eeeSAmit Daniel Kachhap 				writel(rising_threshold,
243a0395eeeSAmit Daniel Kachhap 					data->base + reg->threshold_th2);
244a0395eeeSAmit Daniel Kachhap 			}
2457ca04e58SAmit Daniel Kachhap 			con = readl(data->base + reg->tmu_ctrl);
2467ca04e58SAmit Daniel Kachhap 			con |= (1 << reg->therm_trip_en_shift);
2477ca04e58SAmit Daniel Kachhap 			writel(con, data->base + reg->tmu_ctrl);
2487ca04e58SAmit Daniel Kachhap 		}
24959dfa54cSAmit Daniel Kachhap 	}
250a0395eeeSAmit Daniel Kachhap 	/*Clear the PMIN in the common TMU register*/
251a0395eeeSAmit Daniel Kachhap 	if (reg->tmu_pmin && !data->id)
2529025d563SNaveen Krishna Chatradhi 		writel(0, data->base_second + reg->tmu_pmin);
25359dfa54cSAmit Daniel Kachhap out:
25459dfa54cSAmit Daniel Kachhap 	clk_disable(data->clk);
25559dfa54cSAmit Daniel Kachhap 	mutex_unlock(&data->lock);
25614a11dc7SNaveen Krishna Chatradhi 	if (!IS_ERR(data->clk_sec))
25714a11dc7SNaveen Krishna Chatradhi 		clk_disable(data->clk_sec);
25859dfa54cSAmit Daniel Kachhap 
25959dfa54cSAmit Daniel Kachhap 	return ret;
26059dfa54cSAmit Daniel Kachhap }
26159dfa54cSAmit Daniel Kachhap 
26259dfa54cSAmit Daniel Kachhap static void exynos_tmu_control(struct platform_device *pdev, bool on)
26359dfa54cSAmit Daniel Kachhap {
26459dfa54cSAmit Daniel Kachhap 	struct exynos_tmu_data *data = platform_get_drvdata(pdev);
26559dfa54cSAmit Daniel Kachhap 	struct exynos_tmu_platform_data *pdata = data->pdata;
266b8d582b9SAmit Daniel Kachhap 	const struct exynos_tmu_registers *reg = pdata->registers;
267d37761ecSBartlomiej Zolnierkiewicz 	unsigned int con, interrupt_en;
26859dfa54cSAmit Daniel Kachhap 
26959dfa54cSAmit Daniel Kachhap 	mutex_lock(&data->lock);
27059dfa54cSAmit Daniel Kachhap 	clk_enable(data->clk);
27159dfa54cSAmit Daniel Kachhap 
272b8d582b9SAmit Daniel Kachhap 	con = readl(data->base + reg->tmu_ctrl);
27359dfa54cSAmit Daniel Kachhap 
27486f5362eSLukasz Majewski 	if (pdata->test_mux)
27586f5362eSLukasz Majewski 		con |= (pdata->test_mux << reg->test_mux_addr_shift);
27686f5362eSLukasz Majewski 
277*99d67fb9SBartlomiej Zolnierkiewicz 	con &= ~(EXYNOS_TMU_REF_VOLTAGE_MASK << EXYNOS_TMU_REF_VOLTAGE_SHIFT);
278*99d67fb9SBartlomiej Zolnierkiewicz 	con |= pdata->reference_voltage << EXYNOS_TMU_REF_VOLTAGE_SHIFT;
279d0a0ce3eSAmit Daniel Kachhap 
280*99d67fb9SBartlomiej Zolnierkiewicz 	con &= ~(EXYNOS_TMU_BUF_SLOPE_SEL_MASK << EXYNOS_TMU_BUF_SLOPE_SEL_SHIFT);
281*99d67fb9SBartlomiej Zolnierkiewicz 	con |= (pdata->gain << EXYNOS_TMU_BUF_SLOPE_SEL_SHIFT);
282d0a0ce3eSAmit Daniel Kachhap 
283d0a0ce3eSAmit Daniel Kachhap 	if (pdata->noise_cancel_mode) {
284b8d582b9SAmit Daniel Kachhap 		con &= ~(reg->therm_trip_mode_mask <<
285b8d582b9SAmit Daniel Kachhap 					reg->therm_trip_mode_shift);
286b8d582b9SAmit Daniel Kachhap 		con |= (pdata->noise_cancel_mode << reg->therm_trip_mode_shift);
28759dfa54cSAmit Daniel Kachhap 	}
28859dfa54cSAmit Daniel Kachhap 
28959dfa54cSAmit Daniel Kachhap 	if (on) {
290*99d67fb9SBartlomiej Zolnierkiewicz 		con |= (1 << EXYNOS_TMU_CORE_EN_SHIFT);
291d0a0ce3eSAmit Daniel Kachhap 		interrupt_en =
292b8d582b9SAmit Daniel Kachhap 			pdata->trigger_enable[3] << reg->inten_rise3_shift |
293b8d582b9SAmit Daniel Kachhap 			pdata->trigger_enable[2] << reg->inten_rise2_shift |
294b8d582b9SAmit Daniel Kachhap 			pdata->trigger_enable[1] << reg->inten_rise1_shift |
295b8d582b9SAmit Daniel Kachhap 			pdata->trigger_enable[0] << reg->inten_rise0_shift;
296f4dae753SAmit Daniel Kachhap 		if (TMU_SUPPORTS(pdata, FALLING_TRIP))
297d0a0ce3eSAmit Daniel Kachhap 			interrupt_en |=
298b8d582b9SAmit Daniel Kachhap 				interrupt_en << reg->inten_fall0_shift;
29959dfa54cSAmit Daniel Kachhap 	} else {
300*99d67fb9SBartlomiej Zolnierkiewicz 		con &= ~(1 << EXYNOS_TMU_CORE_EN_SHIFT);
30159dfa54cSAmit Daniel Kachhap 		interrupt_en = 0; /* Disable all interrupts */
30259dfa54cSAmit Daniel Kachhap 	}
303b8d582b9SAmit Daniel Kachhap 	writel(interrupt_en, data->base + reg->tmu_inten);
304b8d582b9SAmit Daniel Kachhap 	writel(con, data->base + reg->tmu_ctrl);
30559dfa54cSAmit Daniel Kachhap 
30659dfa54cSAmit Daniel Kachhap 	clk_disable(data->clk);
30759dfa54cSAmit Daniel Kachhap 	mutex_unlock(&data->lock);
30859dfa54cSAmit Daniel Kachhap }
30959dfa54cSAmit Daniel Kachhap 
31059dfa54cSAmit Daniel Kachhap static int exynos_tmu_read(struct exynos_tmu_data *data)
31159dfa54cSAmit Daniel Kachhap {
312b8d582b9SAmit Daniel Kachhap 	struct exynos_tmu_platform_data *pdata = data->pdata;
313b8d582b9SAmit Daniel Kachhap 	const struct exynos_tmu_registers *reg = pdata->registers;
31459dfa54cSAmit Daniel Kachhap 	u8 temp_code;
31559dfa54cSAmit Daniel Kachhap 	int temp;
31659dfa54cSAmit Daniel Kachhap 
31759dfa54cSAmit Daniel Kachhap 	mutex_lock(&data->lock);
31859dfa54cSAmit Daniel Kachhap 	clk_enable(data->clk);
31959dfa54cSAmit Daniel Kachhap 
320b8d582b9SAmit Daniel Kachhap 	temp_code = readb(data->base + reg->tmu_cur_temp);
32159dfa54cSAmit Daniel Kachhap 
322ddb31d43SBartlomiej Zolnierkiewicz 	if (data->soc == SOC_ARCH_EXYNOS4210)
323ddb31d43SBartlomiej Zolnierkiewicz 		/* temp_code should range between 75 and 175 */
324ddb31d43SBartlomiej Zolnierkiewicz 		if (temp_code < 75 || temp_code > 175) {
325ddb31d43SBartlomiej Zolnierkiewicz 			temp = -ENODATA;
326ddb31d43SBartlomiej Zolnierkiewicz 			goto out;
327ddb31d43SBartlomiej Zolnierkiewicz 		}
328ddb31d43SBartlomiej Zolnierkiewicz 
329ddb31d43SBartlomiej Zolnierkiewicz 	temp = code_to_temp(data, temp_code);
330ddb31d43SBartlomiej Zolnierkiewicz out:
33159dfa54cSAmit Daniel Kachhap 	clk_disable(data->clk);
33259dfa54cSAmit Daniel Kachhap 	mutex_unlock(&data->lock);
33359dfa54cSAmit Daniel Kachhap 
33459dfa54cSAmit Daniel Kachhap 	return temp;
33559dfa54cSAmit Daniel Kachhap }
33659dfa54cSAmit Daniel Kachhap 
33759dfa54cSAmit Daniel Kachhap #ifdef CONFIG_THERMAL_EMULATION
33859dfa54cSAmit Daniel Kachhap static int exynos_tmu_set_emulation(void *drv_data, unsigned long temp)
33959dfa54cSAmit Daniel Kachhap {
34059dfa54cSAmit Daniel Kachhap 	struct exynos_tmu_data *data = drv_data;
341b8d582b9SAmit Daniel Kachhap 	struct exynos_tmu_platform_data *pdata = data->pdata;
342b8d582b9SAmit Daniel Kachhap 	const struct exynos_tmu_registers *reg = pdata->registers;
343b8d582b9SAmit Daniel Kachhap 	unsigned int val;
34459dfa54cSAmit Daniel Kachhap 	int ret = -EINVAL;
34559dfa54cSAmit Daniel Kachhap 
346f4dae753SAmit Daniel Kachhap 	if (!TMU_SUPPORTS(pdata, EMULATION))
34759dfa54cSAmit Daniel Kachhap 		goto out;
34859dfa54cSAmit Daniel Kachhap 
34959dfa54cSAmit Daniel Kachhap 	if (temp && temp < MCELSIUS)
35059dfa54cSAmit Daniel Kachhap 		goto out;
35159dfa54cSAmit Daniel Kachhap 
35259dfa54cSAmit Daniel Kachhap 	mutex_lock(&data->lock);
35359dfa54cSAmit Daniel Kachhap 	clk_enable(data->clk);
35459dfa54cSAmit Daniel Kachhap 
355b8d582b9SAmit Daniel Kachhap 	val = readl(data->base + reg->emul_con);
35659dfa54cSAmit Daniel Kachhap 
35759dfa54cSAmit Daniel Kachhap 	if (temp) {
35859dfa54cSAmit Daniel Kachhap 		temp /= MCELSIUS;
35959dfa54cSAmit Daniel Kachhap 
360f4dae753SAmit Daniel Kachhap 		if (TMU_SUPPORTS(pdata, EMUL_TIME)) {
361f4dae753SAmit Daniel Kachhap 			val &= ~(EXYNOS_EMUL_TIME_MASK << reg->emul_time_shift);
362f4dae753SAmit Daniel Kachhap 			val |= (EXYNOS_EMUL_TIME << reg->emul_time_shift);
363f4dae753SAmit Daniel Kachhap 		}
364f4dae753SAmit Daniel Kachhap 		val &= ~(EXYNOS_EMUL_DATA_MASK << reg->emul_temp_shift);
365f4dae753SAmit Daniel Kachhap 		val |= (temp_to_code(data, temp) << reg->emul_temp_shift) |
366f4dae753SAmit Daniel Kachhap 			EXYNOS_EMUL_ENABLE;
36759dfa54cSAmit Daniel Kachhap 	} else {
368b8d582b9SAmit Daniel Kachhap 		val &= ~EXYNOS_EMUL_ENABLE;
36959dfa54cSAmit Daniel Kachhap 	}
37059dfa54cSAmit Daniel Kachhap 
371b8d582b9SAmit Daniel Kachhap 	writel(val, data->base + reg->emul_con);
37259dfa54cSAmit Daniel Kachhap 
37359dfa54cSAmit Daniel Kachhap 	clk_disable(data->clk);
37459dfa54cSAmit Daniel Kachhap 	mutex_unlock(&data->lock);
37559dfa54cSAmit Daniel Kachhap 	return 0;
37659dfa54cSAmit Daniel Kachhap out:
37759dfa54cSAmit Daniel Kachhap 	return ret;
37859dfa54cSAmit Daniel Kachhap }
37959dfa54cSAmit Daniel Kachhap #else
38059dfa54cSAmit Daniel Kachhap static int exynos_tmu_set_emulation(void *drv_data,	unsigned long temp)
38159dfa54cSAmit Daniel Kachhap 	{ return -EINVAL; }
38259dfa54cSAmit Daniel Kachhap #endif/*CONFIG_THERMAL_EMULATION*/
38359dfa54cSAmit Daniel Kachhap 
38459dfa54cSAmit Daniel Kachhap static void exynos_tmu_work(struct work_struct *work)
38559dfa54cSAmit Daniel Kachhap {
38659dfa54cSAmit Daniel Kachhap 	struct exynos_tmu_data *data = container_of(work,
38759dfa54cSAmit Daniel Kachhap 			struct exynos_tmu_data, irq_work);
388b8d582b9SAmit Daniel Kachhap 	struct exynos_tmu_platform_data *pdata = data->pdata;
389b8d582b9SAmit Daniel Kachhap 	const struct exynos_tmu_registers *reg = pdata->registers;
390a0395eeeSAmit Daniel Kachhap 	unsigned int val_irq, val_type;
391a0395eeeSAmit Daniel Kachhap 
39214a11dc7SNaveen Krishna Chatradhi 	if (!IS_ERR(data->clk_sec))
39314a11dc7SNaveen Krishna Chatradhi 		clk_enable(data->clk_sec);
394a0395eeeSAmit Daniel Kachhap 	/* Find which sensor generated this interrupt */
395a0395eeeSAmit Daniel Kachhap 	if (reg->tmu_irqstatus) {
3969025d563SNaveen Krishna Chatradhi 		val_type = readl(data->base_second + reg->tmu_irqstatus);
397a0395eeeSAmit Daniel Kachhap 		if (!((val_type >> data->id) & 0x1))
398a0395eeeSAmit Daniel Kachhap 			goto out;
399a0395eeeSAmit Daniel Kachhap 	}
40014a11dc7SNaveen Krishna Chatradhi 	if (!IS_ERR(data->clk_sec))
40114a11dc7SNaveen Krishna Chatradhi 		clk_disable(data->clk_sec);
40259dfa54cSAmit Daniel Kachhap 
403cebe7373SAmit Daniel Kachhap 	exynos_report_trigger(data->reg_conf);
40459dfa54cSAmit Daniel Kachhap 	mutex_lock(&data->lock);
40559dfa54cSAmit Daniel Kachhap 	clk_enable(data->clk);
406b8d582b9SAmit Daniel Kachhap 
407a4463c4fSAmit Daniel Kachhap 	/* TODO: take action based on particular interrupt */
408a4463c4fSAmit Daniel Kachhap 	val_irq = readl(data->base + reg->tmu_intstat);
409a4463c4fSAmit Daniel Kachhap 	/* clear the interrupts */
410a4463c4fSAmit Daniel Kachhap 	writel(val_irq, data->base + reg->tmu_intclear);
411b8d582b9SAmit Daniel Kachhap 
41259dfa54cSAmit Daniel Kachhap 	clk_disable(data->clk);
41359dfa54cSAmit Daniel Kachhap 	mutex_unlock(&data->lock);
414a0395eeeSAmit Daniel Kachhap out:
41559dfa54cSAmit Daniel Kachhap 	enable_irq(data->irq);
41659dfa54cSAmit Daniel Kachhap }
41759dfa54cSAmit Daniel Kachhap 
41859dfa54cSAmit Daniel Kachhap static irqreturn_t exynos_tmu_irq(int irq, void *id)
41959dfa54cSAmit Daniel Kachhap {
42059dfa54cSAmit Daniel Kachhap 	struct exynos_tmu_data *data = id;
42159dfa54cSAmit Daniel Kachhap 
42259dfa54cSAmit Daniel Kachhap 	disable_irq_nosync(irq);
42359dfa54cSAmit Daniel Kachhap 	schedule_work(&data->irq_work);
42459dfa54cSAmit Daniel Kachhap 
42559dfa54cSAmit Daniel Kachhap 	return IRQ_HANDLED;
42659dfa54cSAmit Daniel Kachhap }
42759dfa54cSAmit Daniel Kachhap 
42859dfa54cSAmit Daniel Kachhap static const struct of_device_id exynos_tmu_match[] = {
42959dfa54cSAmit Daniel Kachhap 	{
4301fe56dc1SChanwoo Choi 		.compatible = "samsung,exynos3250-tmu",
4311fe56dc1SChanwoo Choi 		.data = (void *)EXYNOS3250_TMU_DRV_DATA,
4321fe56dc1SChanwoo Choi 	},
4331fe56dc1SChanwoo Choi 	{
43459dfa54cSAmit Daniel Kachhap 		.compatible = "samsung,exynos4210-tmu",
43559dfa54cSAmit Daniel Kachhap 		.data = (void *)EXYNOS4210_TMU_DRV_DATA,
43659dfa54cSAmit Daniel Kachhap 	},
43759dfa54cSAmit Daniel Kachhap 	{
43859dfa54cSAmit Daniel Kachhap 		.compatible = "samsung,exynos4412-tmu",
43914ddfaecSLukasz Majewski 		.data = (void *)EXYNOS4412_TMU_DRV_DATA,
44059dfa54cSAmit Daniel Kachhap 	},
44159dfa54cSAmit Daniel Kachhap 	{
44259dfa54cSAmit Daniel Kachhap 		.compatible = "samsung,exynos5250-tmu",
443e6b7991eSAmit Daniel Kachhap 		.data = (void *)EXYNOS5250_TMU_DRV_DATA,
44459dfa54cSAmit Daniel Kachhap 	},
44590542546SAmit Daniel Kachhap 	{
446923488a5SNaveen Krishna Chatradhi 		.compatible = "samsung,exynos5260-tmu",
447923488a5SNaveen Krishna Chatradhi 		.data = (void *)EXYNOS5260_TMU_DRV_DATA,
448923488a5SNaveen Krishna Chatradhi 	},
449923488a5SNaveen Krishna Chatradhi 	{
45014a11dc7SNaveen Krishna Chatradhi 		.compatible = "samsung,exynos5420-tmu",
45114a11dc7SNaveen Krishna Chatradhi 		.data = (void *)EXYNOS5420_TMU_DRV_DATA,
45214a11dc7SNaveen Krishna Chatradhi 	},
45314a11dc7SNaveen Krishna Chatradhi 	{
45414a11dc7SNaveen Krishna Chatradhi 		.compatible = "samsung,exynos5420-tmu-ext-triminfo",
45514a11dc7SNaveen Krishna Chatradhi 		.data = (void *)EXYNOS5420_TMU_DRV_DATA,
45614a11dc7SNaveen Krishna Chatradhi 	},
45714a11dc7SNaveen Krishna Chatradhi 	{
45890542546SAmit Daniel Kachhap 		.compatible = "samsung,exynos5440-tmu",
45990542546SAmit Daniel Kachhap 		.data = (void *)EXYNOS5440_TMU_DRV_DATA,
46090542546SAmit Daniel Kachhap 	},
46159dfa54cSAmit Daniel Kachhap 	{},
46259dfa54cSAmit Daniel Kachhap };
46359dfa54cSAmit Daniel Kachhap MODULE_DEVICE_TABLE(of, exynos_tmu_match);
46459dfa54cSAmit Daniel Kachhap 
46559dfa54cSAmit Daniel Kachhap static inline struct  exynos_tmu_platform_data *exynos_get_driver_data(
466cebe7373SAmit Daniel Kachhap 			struct platform_device *pdev, int id)
46759dfa54cSAmit Daniel Kachhap {
468cebe7373SAmit Daniel Kachhap 	struct  exynos_tmu_init_data *data_table;
469cebe7373SAmit Daniel Kachhap 	struct exynos_tmu_platform_data *tmu_data;
47059dfa54cSAmit Daniel Kachhap 	const struct of_device_id *match;
47173b5b1d7SSachin Kamat 
47259dfa54cSAmit Daniel Kachhap 	match = of_match_node(exynos_tmu_match, pdev->dev.of_node);
47359dfa54cSAmit Daniel Kachhap 	if (!match)
47459dfa54cSAmit Daniel Kachhap 		return NULL;
475cebe7373SAmit Daniel Kachhap 	data_table = (struct exynos_tmu_init_data *) match->data;
476cebe7373SAmit Daniel Kachhap 	if (!data_table || id >= data_table->tmu_count)
477cebe7373SAmit Daniel Kachhap 		return NULL;
478cebe7373SAmit Daniel Kachhap 	tmu_data = data_table->tmu_data;
479cebe7373SAmit Daniel Kachhap 	return (struct exynos_tmu_platform_data *) (tmu_data + id);
48059dfa54cSAmit Daniel Kachhap }
48159dfa54cSAmit Daniel Kachhap 
482cebe7373SAmit Daniel Kachhap static int exynos_map_dt_data(struct platform_device *pdev)
48359dfa54cSAmit Daniel Kachhap {
484cebe7373SAmit Daniel Kachhap 	struct exynos_tmu_data *data = platform_get_drvdata(pdev);
485cebe7373SAmit Daniel Kachhap 	struct exynos_tmu_platform_data *pdata;
486cebe7373SAmit Daniel Kachhap 	struct resource res;
487498d22f6SAmit Daniel Kachhap 	int ret;
48859dfa54cSAmit Daniel Kachhap 
48973b5b1d7SSachin Kamat 	if (!data || !pdev->dev.of_node)
490cebe7373SAmit Daniel Kachhap 		return -ENODEV;
49159dfa54cSAmit Daniel Kachhap 
492498d22f6SAmit Daniel Kachhap 	/*
493498d22f6SAmit Daniel Kachhap 	 * Try enabling the regulator if found
494498d22f6SAmit Daniel Kachhap 	 * TODO: Add regulator as an SOC feature, so that regulator enable
495498d22f6SAmit Daniel Kachhap 	 * is a compulsory call.
496498d22f6SAmit Daniel Kachhap 	 */
497498d22f6SAmit Daniel Kachhap 	data->regulator = devm_regulator_get(&pdev->dev, "vtmu");
498498d22f6SAmit Daniel Kachhap 	if (!IS_ERR(data->regulator)) {
499498d22f6SAmit Daniel Kachhap 		ret = regulator_enable(data->regulator);
500498d22f6SAmit Daniel Kachhap 		if (ret) {
501498d22f6SAmit Daniel Kachhap 			dev_err(&pdev->dev, "failed to enable vtmu\n");
502498d22f6SAmit Daniel Kachhap 			return ret;
503498d22f6SAmit Daniel Kachhap 		}
504498d22f6SAmit Daniel Kachhap 	} else {
505498d22f6SAmit Daniel Kachhap 		dev_info(&pdev->dev, "Regulator node (vtmu) not found\n");
506498d22f6SAmit Daniel Kachhap 	}
507498d22f6SAmit Daniel Kachhap 
508cebe7373SAmit Daniel Kachhap 	data->id = of_alias_get_id(pdev->dev.of_node, "tmuctrl");
509cebe7373SAmit Daniel Kachhap 	if (data->id < 0)
510cebe7373SAmit Daniel Kachhap 		data->id = 0;
511cebe7373SAmit Daniel Kachhap 
512cebe7373SAmit Daniel Kachhap 	data->irq = irq_of_parse_and_map(pdev->dev.of_node, 0);
513cebe7373SAmit Daniel Kachhap 	if (data->irq <= 0) {
514cebe7373SAmit Daniel Kachhap 		dev_err(&pdev->dev, "failed to get IRQ\n");
515cebe7373SAmit Daniel Kachhap 		return -ENODEV;
516cebe7373SAmit Daniel Kachhap 	}
517cebe7373SAmit Daniel Kachhap 
518cebe7373SAmit Daniel Kachhap 	if (of_address_to_resource(pdev->dev.of_node, 0, &res)) {
519cebe7373SAmit Daniel Kachhap 		dev_err(&pdev->dev, "failed to get Resource 0\n");
520cebe7373SAmit Daniel Kachhap 		return -ENODEV;
521cebe7373SAmit Daniel Kachhap 	}
522cebe7373SAmit Daniel Kachhap 
523cebe7373SAmit Daniel Kachhap 	data->base = devm_ioremap(&pdev->dev, res.start, resource_size(&res));
524cebe7373SAmit Daniel Kachhap 	if (!data->base) {
525cebe7373SAmit Daniel Kachhap 		dev_err(&pdev->dev, "Failed to ioremap memory\n");
526cebe7373SAmit Daniel Kachhap 		return -EADDRNOTAVAIL;
527cebe7373SAmit Daniel Kachhap 	}
528cebe7373SAmit Daniel Kachhap 
529cebe7373SAmit Daniel Kachhap 	pdata = exynos_get_driver_data(pdev, data->id);
53059dfa54cSAmit Daniel Kachhap 	if (!pdata) {
53159dfa54cSAmit Daniel Kachhap 		dev_err(&pdev->dev, "No platform init data supplied.\n");
53259dfa54cSAmit Daniel Kachhap 		return -ENODEV;
53359dfa54cSAmit Daniel Kachhap 	}
534cebe7373SAmit Daniel Kachhap 	data->pdata = pdata;
535d9b6ee14SAmit Daniel Kachhap 	/*
536d9b6ee14SAmit Daniel Kachhap 	 * Check if the TMU shares some registers and then try to map the
537d9b6ee14SAmit Daniel Kachhap 	 * memory of common registers.
538d9b6ee14SAmit Daniel Kachhap 	 */
5399025d563SNaveen Krishna Chatradhi 	if (!TMU_SUPPORTS(pdata, ADDRESS_MULTIPLE))
540d9b6ee14SAmit Daniel Kachhap 		return 0;
541d9b6ee14SAmit Daniel Kachhap 
542d9b6ee14SAmit Daniel Kachhap 	if (of_address_to_resource(pdev->dev.of_node, 1, &res)) {
543d9b6ee14SAmit Daniel Kachhap 		dev_err(&pdev->dev, "failed to get Resource 1\n");
544d9b6ee14SAmit Daniel Kachhap 		return -ENODEV;
545d9b6ee14SAmit Daniel Kachhap 	}
546d9b6ee14SAmit Daniel Kachhap 
5479025d563SNaveen Krishna Chatradhi 	data->base_second = devm_ioremap(&pdev->dev, res.start,
548d9b6ee14SAmit Daniel Kachhap 					resource_size(&res));
5499025d563SNaveen Krishna Chatradhi 	if (!data->base_second) {
550d9b6ee14SAmit Daniel Kachhap 		dev_err(&pdev->dev, "Failed to ioremap memory\n");
551d9b6ee14SAmit Daniel Kachhap 		return -ENOMEM;
552d9b6ee14SAmit Daniel Kachhap 	}
553cebe7373SAmit Daniel Kachhap 
554cebe7373SAmit Daniel Kachhap 	return 0;
555cebe7373SAmit Daniel Kachhap }
556cebe7373SAmit Daniel Kachhap 
557cebe7373SAmit Daniel Kachhap static int exynos_tmu_probe(struct platform_device *pdev)
558cebe7373SAmit Daniel Kachhap {
559cebe7373SAmit Daniel Kachhap 	struct exynos_tmu_data *data;
560cebe7373SAmit Daniel Kachhap 	struct exynos_tmu_platform_data *pdata;
561cebe7373SAmit Daniel Kachhap 	struct thermal_sensor_conf *sensor_conf;
562cebe7373SAmit Daniel Kachhap 	int ret, i;
563cebe7373SAmit Daniel Kachhap 
56459dfa54cSAmit Daniel Kachhap 	data = devm_kzalloc(&pdev->dev, sizeof(struct exynos_tmu_data),
56559dfa54cSAmit Daniel Kachhap 					GFP_KERNEL);
5662a9675b3SJingoo Han 	if (!data)
56759dfa54cSAmit Daniel Kachhap 		return -ENOMEM;
56859dfa54cSAmit Daniel Kachhap 
569cebe7373SAmit Daniel Kachhap 	platform_set_drvdata(pdev, data);
570cebe7373SAmit Daniel Kachhap 	mutex_init(&data->lock);
571cebe7373SAmit Daniel Kachhap 
572cebe7373SAmit Daniel Kachhap 	ret = exynos_map_dt_data(pdev);
573cebe7373SAmit Daniel Kachhap 	if (ret)
574cebe7373SAmit Daniel Kachhap 		return ret;
575cebe7373SAmit Daniel Kachhap 
576cebe7373SAmit Daniel Kachhap 	pdata = data->pdata;
57759dfa54cSAmit Daniel Kachhap 
57859dfa54cSAmit Daniel Kachhap 	INIT_WORK(&data->irq_work, exynos_tmu_work);
57959dfa54cSAmit Daniel Kachhap 
58059dfa54cSAmit Daniel Kachhap 	data->clk = devm_clk_get(&pdev->dev, "tmu_apbif");
58159dfa54cSAmit Daniel Kachhap 	if (IS_ERR(data->clk)) {
58259dfa54cSAmit Daniel Kachhap 		dev_err(&pdev->dev, "Failed to get clock\n");
58359dfa54cSAmit Daniel Kachhap 		return  PTR_ERR(data->clk);
58459dfa54cSAmit Daniel Kachhap 	}
58559dfa54cSAmit Daniel Kachhap 
58614a11dc7SNaveen Krishna Chatradhi 	data->clk_sec = devm_clk_get(&pdev->dev, "tmu_triminfo_apbif");
58714a11dc7SNaveen Krishna Chatradhi 	if (IS_ERR(data->clk_sec)) {
58814a11dc7SNaveen Krishna Chatradhi 		if (data->soc == SOC_ARCH_EXYNOS5420_TRIMINFO) {
58914a11dc7SNaveen Krishna Chatradhi 			dev_err(&pdev->dev, "Failed to get triminfo clock\n");
59014a11dc7SNaveen Krishna Chatradhi 			return PTR_ERR(data->clk_sec);
59114a11dc7SNaveen Krishna Chatradhi 		}
59214a11dc7SNaveen Krishna Chatradhi 	} else {
59314a11dc7SNaveen Krishna Chatradhi 		ret = clk_prepare(data->clk_sec);
59414a11dc7SNaveen Krishna Chatradhi 		if (ret) {
59514a11dc7SNaveen Krishna Chatradhi 			dev_err(&pdev->dev, "Failed to get clock\n");
59659dfa54cSAmit Daniel Kachhap 			return ret;
59714a11dc7SNaveen Krishna Chatradhi 		}
59814a11dc7SNaveen Krishna Chatradhi 	}
59914a11dc7SNaveen Krishna Chatradhi 
60014a11dc7SNaveen Krishna Chatradhi 	ret = clk_prepare(data->clk);
60114a11dc7SNaveen Krishna Chatradhi 	if (ret) {
60214a11dc7SNaveen Krishna Chatradhi 		dev_err(&pdev->dev, "Failed to get clock\n");
60314a11dc7SNaveen Krishna Chatradhi 		goto err_clk_sec;
60414a11dc7SNaveen Krishna Chatradhi 	}
60559dfa54cSAmit Daniel Kachhap 
6061fe56dc1SChanwoo Choi 	if (pdata->type == SOC_ARCH_EXYNOS3250 ||
6071fe56dc1SChanwoo Choi 	    pdata->type == SOC_ARCH_EXYNOS4210 ||
60814ddfaecSLukasz Majewski 	    pdata->type == SOC_ARCH_EXYNOS4412 ||
60914ddfaecSLukasz Majewski 	    pdata->type == SOC_ARCH_EXYNOS5250 ||
610923488a5SNaveen Krishna Chatradhi 	    pdata->type == SOC_ARCH_EXYNOS5260 ||
61114a11dc7SNaveen Krishna Chatradhi 	    pdata->type == SOC_ARCH_EXYNOS5420_TRIMINFO ||
612a0395eeeSAmit Daniel Kachhap 	    pdata->type == SOC_ARCH_EXYNOS5440)
61359dfa54cSAmit Daniel Kachhap 		data->soc = pdata->type;
61459dfa54cSAmit Daniel Kachhap 	else {
61559dfa54cSAmit Daniel Kachhap 		ret = -EINVAL;
61659dfa54cSAmit Daniel Kachhap 		dev_err(&pdev->dev, "Platform not supported\n");
61759dfa54cSAmit Daniel Kachhap 		goto err_clk;
61859dfa54cSAmit Daniel Kachhap 	}
61959dfa54cSAmit Daniel Kachhap 
62059dfa54cSAmit Daniel Kachhap 	ret = exynos_tmu_initialize(pdev);
62159dfa54cSAmit Daniel Kachhap 	if (ret) {
62259dfa54cSAmit Daniel Kachhap 		dev_err(&pdev->dev, "Failed to initialize TMU\n");
62359dfa54cSAmit Daniel Kachhap 		goto err_clk;
62459dfa54cSAmit Daniel Kachhap 	}
62559dfa54cSAmit Daniel Kachhap 
62659dfa54cSAmit Daniel Kachhap 	exynos_tmu_control(pdev, true);
62759dfa54cSAmit Daniel Kachhap 
628cebe7373SAmit Daniel Kachhap 	/* Allocate a structure to register with the exynos core thermal */
629cebe7373SAmit Daniel Kachhap 	sensor_conf = devm_kzalloc(&pdev->dev,
630cebe7373SAmit Daniel Kachhap 				sizeof(struct thermal_sensor_conf), GFP_KERNEL);
631cebe7373SAmit Daniel Kachhap 	if (!sensor_conf) {
632cebe7373SAmit Daniel Kachhap 		ret = -ENOMEM;
633cebe7373SAmit Daniel Kachhap 		goto err_clk;
634cebe7373SAmit Daniel Kachhap 	}
635cebe7373SAmit Daniel Kachhap 	sprintf(sensor_conf->name, "therm_zone%d", data->id);
636cebe7373SAmit Daniel Kachhap 	sensor_conf->read_temperature = (int (*)(void *))exynos_tmu_read;
637cebe7373SAmit Daniel Kachhap 	sensor_conf->write_emul_temp =
638cebe7373SAmit Daniel Kachhap 		(int (*)(void *, unsigned long))exynos_tmu_set_emulation;
639cebe7373SAmit Daniel Kachhap 	sensor_conf->driver_data = data;
640cebe7373SAmit Daniel Kachhap 	sensor_conf->trip_data.trip_count = pdata->trigger_enable[0] +
641bb34b4c8SAmit Daniel Kachhap 			pdata->trigger_enable[1] + pdata->trigger_enable[2]+
642bb34b4c8SAmit Daniel Kachhap 			pdata->trigger_enable[3];
64359dfa54cSAmit Daniel Kachhap 
644cebe7373SAmit Daniel Kachhap 	for (i = 0; i < sensor_conf->trip_data.trip_count; i++) {
645cebe7373SAmit Daniel Kachhap 		sensor_conf->trip_data.trip_val[i] =
64659dfa54cSAmit Daniel Kachhap 			pdata->threshold + pdata->trigger_levels[i];
647cebe7373SAmit Daniel Kachhap 		sensor_conf->trip_data.trip_type[i] =
6485c3cf552SAmit Daniel Kachhap 					pdata->trigger_type[i];
6495c3cf552SAmit Daniel Kachhap 	}
65059dfa54cSAmit Daniel Kachhap 
651cebe7373SAmit Daniel Kachhap 	sensor_conf->trip_data.trigger_falling = pdata->threshold_falling;
65259dfa54cSAmit Daniel Kachhap 
653cebe7373SAmit Daniel Kachhap 	sensor_conf->cooling_data.freq_clip_count = pdata->freq_tab_count;
65459dfa54cSAmit Daniel Kachhap 	for (i = 0; i < pdata->freq_tab_count; i++) {
655cebe7373SAmit Daniel Kachhap 		sensor_conf->cooling_data.freq_data[i].freq_clip_max =
65659dfa54cSAmit Daniel Kachhap 					pdata->freq_tab[i].freq_clip_max;
657cebe7373SAmit Daniel Kachhap 		sensor_conf->cooling_data.freq_data[i].temp_level =
65859dfa54cSAmit Daniel Kachhap 					pdata->freq_tab[i].temp_level;
65959dfa54cSAmit Daniel Kachhap 	}
660cebe7373SAmit Daniel Kachhap 	sensor_conf->dev = &pdev->dev;
661cebe7373SAmit Daniel Kachhap 	/* Register the sensor with thermal management interface */
662cebe7373SAmit Daniel Kachhap 	ret = exynos_register_thermal(sensor_conf);
66359dfa54cSAmit Daniel Kachhap 	if (ret) {
66459dfa54cSAmit Daniel Kachhap 		dev_err(&pdev->dev, "Failed to register thermal interface\n");
66559dfa54cSAmit Daniel Kachhap 		goto err_clk;
66659dfa54cSAmit Daniel Kachhap 	}
667cebe7373SAmit Daniel Kachhap 	data->reg_conf = sensor_conf;
668cebe7373SAmit Daniel Kachhap 
669cebe7373SAmit Daniel Kachhap 	ret = devm_request_irq(&pdev->dev, data->irq, exynos_tmu_irq,
670cebe7373SAmit Daniel Kachhap 		IRQF_TRIGGER_RISING | IRQF_SHARED, dev_name(&pdev->dev), data);
671cebe7373SAmit Daniel Kachhap 	if (ret) {
672cebe7373SAmit Daniel Kachhap 		dev_err(&pdev->dev, "Failed to request irq: %d\n", data->irq);
673cebe7373SAmit Daniel Kachhap 		goto err_clk;
674cebe7373SAmit Daniel Kachhap 	}
67559dfa54cSAmit Daniel Kachhap 
67659dfa54cSAmit Daniel Kachhap 	return 0;
67759dfa54cSAmit Daniel Kachhap err_clk:
67859dfa54cSAmit Daniel Kachhap 	clk_unprepare(data->clk);
67914a11dc7SNaveen Krishna Chatradhi err_clk_sec:
68014a11dc7SNaveen Krishna Chatradhi 	if (!IS_ERR(data->clk_sec))
68114a11dc7SNaveen Krishna Chatradhi 		clk_unprepare(data->clk_sec);
68259dfa54cSAmit Daniel Kachhap 	return ret;
68359dfa54cSAmit Daniel Kachhap }
68459dfa54cSAmit Daniel Kachhap 
68559dfa54cSAmit Daniel Kachhap static int exynos_tmu_remove(struct platform_device *pdev)
68659dfa54cSAmit Daniel Kachhap {
68759dfa54cSAmit Daniel Kachhap 	struct exynos_tmu_data *data = platform_get_drvdata(pdev);
68859dfa54cSAmit Daniel Kachhap 
689cebe7373SAmit Daniel Kachhap 	exynos_unregister_thermal(data->reg_conf);
69059dfa54cSAmit Daniel Kachhap 
6914215688eSBartlomiej Zolnierkiewicz 	exynos_tmu_control(pdev, false);
6924215688eSBartlomiej Zolnierkiewicz 
69359dfa54cSAmit Daniel Kachhap 	clk_unprepare(data->clk);
69414a11dc7SNaveen Krishna Chatradhi 	if (!IS_ERR(data->clk_sec))
69514a11dc7SNaveen Krishna Chatradhi 		clk_unprepare(data->clk_sec);
69659dfa54cSAmit Daniel Kachhap 
697498d22f6SAmit Daniel Kachhap 	if (!IS_ERR(data->regulator))
698498d22f6SAmit Daniel Kachhap 		regulator_disable(data->regulator);
699498d22f6SAmit Daniel Kachhap 
70059dfa54cSAmit Daniel Kachhap 	return 0;
70159dfa54cSAmit Daniel Kachhap }
70259dfa54cSAmit Daniel Kachhap 
70359dfa54cSAmit Daniel Kachhap #ifdef CONFIG_PM_SLEEP
70459dfa54cSAmit Daniel Kachhap static int exynos_tmu_suspend(struct device *dev)
70559dfa54cSAmit Daniel Kachhap {
70659dfa54cSAmit Daniel Kachhap 	exynos_tmu_control(to_platform_device(dev), false);
70759dfa54cSAmit Daniel Kachhap 
70859dfa54cSAmit Daniel Kachhap 	return 0;
70959dfa54cSAmit Daniel Kachhap }
71059dfa54cSAmit Daniel Kachhap 
71159dfa54cSAmit Daniel Kachhap static int exynos_tmu_resume(struct device *dev)
71259dfa54cSAmit Daniel Kachhap {
71359dfa54cSAmit Daniel Kachhap 	struct platform_device *pdev = to_platform_device(dev);
71459dfa54cSAmit Daniel Kachhap 
71559dfa54cSAmit Daniel Kachhap 	exynos_tmu_initialize(pdev);
71659dfa54cSAmit Daniel Kachhap 	exynos_tmu_control(pdev, true);
71759dfa54cSAmit Daniel Kachhap 
71859dfa54cSAmit Daniel Kachhap 	return 0;
71959dfa54cSAmit Daniel Kachhap }
72059dfa54cSAmit Daniel Kachhap 
72159dfa54cSAmit Daniel Kachhap static SIMPLE_DEV_PM_OPS(exynos_tmu_pm,
72259dfa54cSAmit Daniel Kachhap 			 exynos_tmu_suspend, exynos_tmu_resume);
72359dfa54cSAmit Daniel Kachhap #define EXYNOS_TMU_PM	(&exynos_tmu_pm)
72459dfa54cSAmit Daniel Kachhap #else
72559dfa54cSAmit Daniel Kachhap #define EXYNOS_TMU_PM	NULL
72659dfa54cSAmit Daniel Kachhap #endif
72759dfa54cSAmit Daniel Kachhap 
72859dfa54cSAmit Daniel Kachhap static struct platform_driver exynos_tmu_driver = {
72959dfa54cSAmit Daniel Kachhap 	.driver = {
73059dfa54cSAmit Daniel Kachhap 		.name   = "exynos-tmu",
73159dfa54cSAmit Daniel Kachhap 		.owner  = THIS_MODULE,
73259dfa54cSAmit Daniel Kachhap 		.pm     = EXYNOS_TMU_PM,
73373b5b1d7SSachin Kamat 		.of_match_table = exynos_tmu_match,
73459dfa54cSAmit Daniel Kachhap 	},
73559dfa54cSAmit Daniel Kachhap 	.probe = exynos_tmu_probe,
73659dfa54cSAmit Daniel Kachhap 	.remove	= exynos_tmu_remove,
73759dfa54cSAmit Daniel Kachhap };
73859dfa54cSAmit Daniel Kachhap 
73959dfa54cSAmit Daniel Kachhap module_platform_driver(exynos_tmu_driver);
74059dfa54cSAmit Daniel Kachhap 
74159dfa54cSAmit Daniel Kachhap MODULE_DESCRIPTION("EXYNOS TMU Driver");
74259dfa54cSAmit Daniel Kachhap MODULE_AUTHOR("Donggeun Kim <dg77.kim@samsung.com>");
74359dfa54cSAmit Daniel Kachhap MODULE_LICENSE("GPL");
74459dfa54cSAmit Daniel Kachhap MODULE_ALIAS("platform:exynos-tmu");
745