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