1ca3de46bSShawn Guo /* 2ca3de46bSShawn Guo * Copyright 2013 Freescale Semiconductor, Inc. 3ca3de46bSShawn Guo * 4ca3de46bSShawn Guo * This program is free software; you can redistribute it and/or modify 5ca3de46bSShawn Guo * it under the terms of the GNU General Public License version 2 as 6ca3de46bSShawn Guo * published by the Free Software Foundation. 7ca3de46bSShawn Guo * 8ca3de46bSShawn Guo */ 9ca3de46bSShawn Guo 10329fe7b1SAnson Huang #include <linux/clk.h> 11ca3de46bSShawn Guo #include <linux/cpu_cooling.h> 12ca3de46bSShawn Guo #include <linux/delay.h> 13ca3de46bSShawn Guo #include <linux/device.h> 14ca3de46bSShawn Guo #include <linux/init.h> 1537713a1eSPhilipp Zabel #include <linux/interrupt.h> 16ca3de46bSShawn Guo #include <linux/io.h> 17ca3de46bSShawn Guo #include <linux/kernel.h> 18ca3de46bSShawn Guo #include <linux/mfd/syscon.h> 19ca3de46bSShawn Guo #include <linux/module.h> 20ca3de46bSShawn Guo #include <linux/of.h> 213c94f17eSAnson Huang #include <linux/of_device.h> 22ca3de46bSShawn Guo #include <linux/platform_device.h> 23ca3de46bSShawn Guo #include <linux/regmap.h> 24ca3de46bSShawn Guo #include <linux/slab.h> 25ca3de46bSShawn Guo #include <linux/thermal.h> 26ca3de46bSShawn Guo #include <linux/types.h> 27ca3de46bSShawn Guo 28ca3de46bSShawn Guo #define REG_SET 0x4 29ca3de46bSShawn Guo #define REG_CLR 0x8 30ca3de46bSShawn Guo #define REG_TOG 0xc 31ca3de46bSShawn Guo 32ca3de46bSShawn Guo #define MISC0 0x0150 33ca3de46bSShawn Guo #define MISC0_REFTOP_SELBIASOFF (1 << 3) 343c94f17eSAnson Huang #define MISC1 0x0160 353c94f17eSAnson Huang #define MISC1_IRQ_TEMPHIGH (1 << 29) 363c94f17eSAnson Huang /* Below LOW and PANIC bits are only for TEMPMON_IMX6SX */ 373c94f17eSAnson Huang #define MISC1_IRQ_TEMPLOW (1 << 28) 383c94f17eSAnson Huang #define MISC1_IRQ_TEMPPANIC (1 << 27) 39ca3de46bSShawn Guo 40ca3de46bSShawn Guo #define TEMPSENSE0 0x0180 4137713a1eSPhilipp Zabel #define TEMPSENSE0_ALARM_VALUE_SHIFT 20 4237713a1eSPhilipp Zabel #define TEMPSENSE0_ALARM_VALUE_MASK (0xfff << TEMPSENSE0_ALARM_VALUE_SHIFT) 43ca3de46bSShawn Guo #define TEMPSENSE0_TEMP_CNT_SHIFT 8 44ca3de46bSShawn Guo #define TEMPSENSE0_TEMP_CNT_MASK (0xfff << TEMPSENSE0_TEMP_CNT_SHIFT) 45ca3de46bSShawn Guo #define TEMPSENSE0_FINISHED (1 << 2) 46ca3de46bSShawn Guo #define TEMPSENSE0_MEASURE_TEMP (1 << 1) 47ca3de46bSShawn Guo #define TEMPSENSE0_POWER_DOWN (1 << 0) 48ca3de46bSShawn Guo 49ca3de46bSShawn Guo #define TEMPSENSE1 0x0190 50ca3de46bSShawn Guo #define TEMPSENSE1_MEASURE_FREQ 0xffff 513c94f17eSAnson Huang /* Below TEMPSENSE2 is only for TEMPMON_IMX6SX */ 523c94f17eSAnson Huang #define TEMPSENSE2 0x0290 533c94f17eSAnson Huang #define TEMPSENSE2_LOW_VALUE_SHIFT 0 543c94f17eSAnson Huang #define TEMPSENSE2_LOW_VALUE_MASK 0xfff 553c94f17eSAnson Huang #define TEMPSENSE2_PANIC_VALUE_SHIFT 16 563c94f17eSAnson Huang #define TEMPSENSE2_PANIC_VALUE_MASK 0xfff0000 57ca3de46bSShawn Guo 58a2291badSTim Harvey #define OCOTP_MEM0 0x0480 59ca3de46bSShawn Guo #define OCOTP_ANA1 0x04e0 60ca3de46bSShawn Guo 61ca3de46bSShawn Guo /* The driver supports 1 passive trip point and 1 critical trip point */ 62ca3de46bSShawn Guo enum imx_thermal_trip { 63ca3de46bSShawn Guo IMX_TRIP_PASSIVE, 64ca3de46bSShawn Guo IMX_TRIP_CRITICAL, 65ca3de46bSShawn Guo IMX_TRIP_NUM, 66ca3de46bSShawn Guo }; 67ca3de46bSShawn Guo 68ca3de46bSShawn Guo #define IMX_POLLING_DELAY 2000 /* millisecond */ 69ca3de46bSShawn Guo #define IMX_PASSIVE_DELAY 1000 70ca3de46bSShawn Guo 71749e8be7SAnson Huang #define FACTOR0 10000000 72749e8be7SAnson Huang #define FACTOR1 15976 73749e8be7SAnson Huang #define FACTOR2 4297157 74749e8be7SAnson Huang 753c94f17eSAnson Huang #define TEMPMON_IMX6Q 1 763c94f17eSAnson Huang #define TEMPMON_IMX6SX 2 773c94f17eSAnson Huang 783c94f17eSAnson Huang struct thermal_soc_data { 793c94f17eSAnson Huang u32 version; 803c94f17eSAnson Huang }; 813c94f17eSAnson Huang 823c94f17eSAnson Huang static struct thermal_soc_data thermal_imx6q_data = { 833c94f17eSAnson Huang .version = TEMPMON_IMX6Q, 843c94f17eSAnson Huang }; 853c94f17eSAnson Huang 863c94f17eSAnson Huang static struct thermal_soc_data thermal_imx6sx_data = { 873c94f17eSAnson Huang .version = TEMPMON_IMX6SX, 883c94f17eSAnson Huang }; 893c94f17eSAnson Huang 90ca3de46bSShawn Guo struct imx_thermal_data { 91ca3de46bSShawn Guo struct thermal_zone_device *tz; 92ca3de46bSShawn Guo struct thermal_cooling_device *cdev; 93ca3de46bSShawn Guo enum thermal_device_mode mode; 94ca3de46bSShawn Guo struct regmap *tempmon; 95749e8be7SAnson Huang u32 c1, c2; /* See formula in imx_get_sensor_data() */ 9617e8351aSSascha Hauer int temp_passive; 9717e8351aSSascha Hauer int temp_critical; 98a2291badSTim Harvey int temp_max; 9917e8351aSSascha Hauer int alarm_temp; 10017e8351aSSascha Hauer int last_temp; 10137713a1eSPhilipp Zabel bool irq_enabled; 10237713a1eSPhilipp Zabel int irq; 103329fe7b1SAnson Huang struct clk *thermal_clk; 1043c94f17eSAnson Huang const struct thermal_soc_data *socdata; 105a2291badSTim Harvey const char *temp_grade; 106ca3de46bSShawn Guo }; 107ca3de46bSShawn Guo 1083c94f17eSAnson Huang static void imx_set_panic_temp(struct imx_thermal_data *data, 10917e8351aSSascha Hauer int panic_temp) 1103c94f17eSAnson Huang { 1113c94f17eSAnson Huang struct regmap *map = data->tempmon; 1123c94f17eSAnson Huang int critical_value; 1133c94f17eSAnson Huang 1143c94f17eSAnson Huang critical_value = (data->c2 - panic_temp) / data->c1; 1153c94f17eSAnson Huang regmap_write(map, TEMPSENSE2 + REG_CLR, TEMPSENSE2_PANIC_VALUE_MASK); 1163c94f17eSAnson Huang regmap_write(map, TEMPSENSE2 + REG_SET, critical_value << 1173c94f17eSAnson Huang TEMPSENSE2_PANIC_VALUE_SHIFT); 1183c94f17eSAnson Huang } 1193c94f17eSAnson Huang 12037713a1eSPhilipp Zabel static void imx_set_alarm_temp(struct imx_thermal_data *data, 12117e8351aSSascha Hauer int alarm_temp) 12237713a1eSPhilipp Zabel { 12337713a1eSPhilipp Zabel struct regmap *map = data->tempmon; 12437713a1eSPhilipp Zabel int alarm_value; 12537713a1eSPhilipp Zabel 12637713a1eSPhilipp Zabel data->alarm_temp = alarm_temp; 127749e8be7SAnson Huang alarm_value = (data->c2 - alarm_temp) / data->c1; 12837713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_ALARM_VALUE_MASK); 12937713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, alarm_value << 13037713a1eSPhilipp Zabel TEMPSENSE0_ALARM_VALUE_SHIFT); 13137713a1eSPhilipp Zabel } 13237713a1eSPhilipp Zabel 13317e8351aSSascha Hauer static int imx_get_temp(struct thermal_zone_device *tz, int *temp) 134ca3de46bSShawn Guo { 135ca3de46bSShawn Guo struct imx_thermal_data *data = tz->devdata; 136ca3de46bSShawn Guo struct regmap *map = data->tempmon; 137ca3de46bSShawn Guo unsigned int n_meas; 13837713a1eSPhilipp Zabel bool wait; 139ca3de46bSShawn Guo u32 val; 140ca3de46bSShawn Guo 14137713a1eSPhilipp Zabel if (data->mode == THERMAL_DEVICE_ENABLED) { 14237713a1eSPhilipp Zabel /* Check if a measurement is currently in progress */ 14337713a1eSPhilipp Zabel regmap_read(map, TEMPSENSE0, &val); 14437713a1eSPhilipp Zabel wait = !(val & TEMPSENSE0_FINISHED); 14537713a1eSPhilipp Zabel } else { 146ca3de46bSShawn Guo /* 147ca3de46bSShawn Guo * Every time we measure the temperature, we will power on the 148ca3de46bSShawn Guo * temperature sensor, enable measurements, take a reading, 149ca3de46bSShawn Guo * disable measurements, power off the temperature sensor. 150ca3de46bSShawn Guo */ 151ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 152ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_MEASURE_TEMP); 153ca3de46bSShawn Guo 15437713a1eSPhilipp Zabel wait = true; 15537713a1eSPhilipp Zabel } 15637713a1eSPhilipp Zabel 157ca3de46bSShawn Guo /* 158ca3de46bSShawn Guo * According to the temp sensor designers, it may require up to ~17us 159ca3de46bSShawn Guo * to complete a measurement. 160ca3de46bSShawn Guo */ 16137713a1eSPhilipp Zabel if (wait) 162ca3de46bSShawn Guo usleep_range(20, 50); 163ca3de46bSShawn Guo 164ca3de46bSShawn Guo regmap_read(map, TEMPSENSE0, &val); 16537713a1eSPhilipp Zabel 16637713a1eSPhilipp Zabel if (data->mode != THERMAL_DEVICE_ENABLED) { 167ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_MEASURE_TEMP); 168ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 16937713a1eSPhilipp Zabel } 170ca3de46bSShawn Guo 171ca3de46bSShawn Guo if ((val & TEMPSENSE0_FINISHED) == 0) { 172ca3de46bSShawn Guo dev_dbg(&tz->device, "temp measurement never finished\n"); 173ca3de46bSShawn Guo return -EAGAIN; 174ca3de46bSShawn Guo } 175ca3de46bSShawn Guo 176ca3de46bSShawn Guo n_meas = (val & TEMPSENSE0_TEMP_CNT_MASK) >> TEMPSENSE0_TEMP_CNT_SHIFT; 177ca3de46bSShawn Guo 178ca3de46bSShawn Guo /* See imx_get_sensor_data() for formula derivation */ 179749e8be7SAnson Huang *temp = data->c2 - n_meas * data->c1; 180ca3de46bSShawn Guo 1813c94f17eSAnson Huang /* Update alarm value to next higher trip point for TEMPMON_IMX6Q */ 1823c94f17eSAnson Huang if (data->socdata->version == TEMPMON_IMX6Q) { 1833c94f17eSAnson Huang if (data->alarm_temp == data->temp_passive && 1843c94f17eSAnson Huang *temp >= data->temp_passive) 18537713a1eSPhilipp Zabel imx_set_alarm_temp(data, data->temp_critical); 1863c94f17eSAnson Huang if (data->alarm_temp == data->temp_critical && 1873c94f17eSAnson Huang *temp < data->temp_passive) { 18837713a1eSPhilipp Zabel imx_set_alarm_temp(data, data->temp_passive); 18917e8351aSSascha Hauer dev_dbg(&tz->device, "thermal alarm off: T < %d\n", 19037713a1eSPhilipp Zabel data->alarm_temp / 1000); 19137713a1eSPhilipp Zabel } 1923c94f17eSAnson Huang } 19337713a1eSPhilipp Zabel 19437713a1eSPhilipp Zabel if (*temp != data->last_temp) { 19517e8351aSSascha Hauer dev_dbg(&tz->device, "millicelsius: %d\n", *temp); 19637713a1eSPhilipp Zabel data->last_temp = *temp; 19737713a1eSPhilipp Zabel } 19837713a1eSPhilipp Zabel 19937713a1eSPhilipp Zabel /* Reenable alarm IRQ if temperature below alarm temperature */ 20037713a1eSPhilipp Zabel if (!data->irq_enabled && *temp < data->alarm_temp) { 20137713a1eSPhilipp Zabel data->irq_enabled = true; 20237713a1eSPhilipp Zabel enable_irq(data->irq); 203ca3de46bSShawn Guo } 204ca3de46bSShawn Guo 205ca3de46bSShawn Guo return 0; 206ca3de46bSShawn Guo } 207ca3de46bSShawn Guo 208ca3de46bSShawn Guo static int imx_get_mode(struct thermal_zone_device *tz, 209ca3de46bSShawn Guo enum thermal_device_mode *mode) 210ca3de46bSShawn Guo { 211ca3de46bSShawn Guo struct imx_thermal_data *data = tz->devdata; 212ca3de46bSShawn Guo 213ca3de46bSShawn Guo *mode = data->mode; 214ca3de46bSShawn Guo 215ca3de46bSShawn Guo return 0; 216ca3de46bSShawn Guo } 217ca3de46bSShawn Guo 218ca3de46bSShawn Guo static int imx_set_mode(struct thermal_zone_device *tz, 219ca3de46bSShawn Guo enum thermal_device_mode mode) 220ca3de46bSShawn Guo { 221ca3de46bSShawn Guo struct imx_thermal_data *data = tz->devdata; 22237713a1eSPhilipp Zabel struct regmap *map = data->tempmon; 223ca3de46bSShawn Guo 224ca3de46bSShawn Guo if (mode == THERMAL_DEVICE_ENABLED) { 225ca3de46bSShawn Guo tz->polling_delay = IMX_POLLING_DELAY; 226ca3de46bSShawn Guo tz->passive_delay = IMX_PASSIVE_DELAY; 22737713a1eSPhilipp Zabel 22837713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 22937713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_MEASURE_TEMP); 23037713a1eSPhilipp Zabel 23137713a1eSPhilipp Zabel if (!data->irq_enabled) { 23237713a1eSPhilipp Zabel data->irq_enabled = true; 23337713a1eSPhilipp Zabel enable_irq(data->irq); 23437713a1eSPhilipp Zabel } 235ca3de46bSShawn Guo } else { 23637713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_MEASURE_TEMP); 23737713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 23837713a1eSPhilipp Zabel 239ca3de46bSShawn Guo tz->polling_delay = 0; 240ca3de46bSShawn Guo tz->passive_delay = 0; 24137713a1eSPhilipp Zabel 24237713a1eSPhilipp Zabel if (data->irq_enabled) { 24337713a1eSPhilipp Zabel disable_irq(data->irq); 24437713a1eSPhilipp Zabel data->irq_enabled = false; 24537713a1eSPhilipp Zabel } 246ca3de46bSShawn Guo } 247ca3de46bSShawn Guo 248ca3de46bSShawn Guo data->mode = mode; 2490e70f466SSrinivas Pandruvada thermal_zone_device_update(tz, THERMAL_EVENT_UNSPECIFIED); 250ca3de46bSShawn Guo 251ca3de46bSShawn Guo return 0; 252ca3de46bSShawn Guo } 253ca3de46bSShawn Guo 254ca3de46bSShawn Guo static int imx_get_trip_type(struct thermal_zone_device *tz, int trip, 255ca3de46bSShawn Guo enum thermal_trip_type *type) 256ca3de46bSShawn Guo { 257ca3de46bSShawn Guo *type = (trip == IMX_TRIP_PASSIVE) ? THERMAL_TRIP_PASSIVE : 258ca3de46bSShawn Guo THERMAL_TRIP_CRITICAL; 259ca3de46bSShawn Guo return 0; 260ca3de46bSShawn Guo } 261ca3de46bSShawn Guo 26217e8351aSSascha Hauer static int imx_get_crit_temp(struct thermal_zone_device *tz, int *temp) 263ca3de46bSShawn Guo { 264017e5142SPhilipp Zabel struct imx_thermal_data *data = tz->devdata; 265017e5142SPhilipp Zabel 266017e5142SPhilipp Zabel *temp = data->temp_critical; 267ca3de46bSShawn Guo return 0; 268ca3de46bSShawn Guo } 269ca3de46bSShawn Guo 270ca3de46bSShawn Guo static int imx_get_trip_temp(struct thermal_zone_device *tz, int trip, 27117e8351aSSascha Hauer int *temp) 272ca3de46bSShawn Guo { 273017e5142SPhilipp Zabel struct imx_thermal_data *data = tz->devdata; 274017e5142SPhilipp Zabel 275017e5142SPhilipp Zabel *temp = (trip == IMX_TRIP_PASSIVE) ? data->temp_passive : 276017e5142SPhilipp Zabel data->temp_critical; 277017e5142SPhilipp Zabel return 0; 278017e5142SPhilipp Zabel } 279017e5142SPhilipp Zabel 280017e5142SPhilipp Zabel static int imx_set_trip_temp(struct thermal_zone_device *tz, int trip, 28117e8351aSSascha Hauer int temp) 282017e5142SPhilipp Zabel { 283017e5142SPhilipp Zabel struct imx_thermal_data *data = tz->devdata; 284017e5142SPhilipp Zabel 285a2291badSTim Harvey /* do not allow changing critical threshold */ 286017e5142SPhilipp Zabel if (trip == IMX_TRIP_CRITICAL) 287017e5142SPhilipp Zabel return -EPERM; 288017e5142SPhilipp Zabel 289a2291badSTim Harvey /* do not allow passive to be set higher than critical */ 290a2291badSTim Harvey if (temp < 0 || temp > data->temp_critical) 291017e5142SPhilipp Zabel return -EINVAL; 292017e5142SPhilipp Zabel 293017e5142SPhilipp Zabel data->temp_passive = temp; 294017e5142SPhilipp Zabel 29537713a1eSPhilipp Zabel imx_set_alarm_temp(data, temp); 29637713a1eSPhilipp Zabel 297ca3de46bSShawn Guo return 0; 298ca3de46bSShawn Guo } 299ca3de46bSShawn Guo 300ca3de46bSShawn Guo static int imx_bind(struct thermal_zone_device *tz, 301ca3de46bSShawn Guo struct thermal_cooling_device *cdev) 302ca3de46bSShawn Guo { 303ca3de46bSShawn Guo int ret; 304ca3de46bSShawn Guo 305ca3de46bSShawn Guo ret = thermal_zone_bind_cooling_device(tz, IMX_TRIP_PASSIVE, cdev, 306ca3de46bSShawn Guo THERMAL_NO_LIMIT, 3076cd9e9f6SKapileshwar Singh THERMAL_NO_LIMIT, 3086cd9e9f6SKapileshwar Singh THERMAL_WEIGHT_DEFAULT); 309ca3de46bSShawn Guo if (ret) { 310ca3de46bSShawn Guo dev_err(&tz->device, 311ca3de46bSShawn Guo "binding zone %s with cdev %s failed:%d\n", 312ca3de46bSShawn Guo tz->type, cdev->type, ret); 313ca3de46bSShawn Guo return ret; 314ca3de46bSShawn Guo } 315ca3de46bSShawn Guo 316ca3de46bSShawn Guo return 0; 317ca3de46bSShawn Guo } 318ca3de46bSShawn Guo 319ca3de46bSShawn Guo static int imx_unbind(struct thermal_zone_device *tz, 320ca3de46bSShawn Guo struct thermal_cooling_device *cdev) 321ca3de46bSShawn Guo { 322ca3de46bSShawn Guo int ret; 323ca3de46bSShawn Guo 324ca3de46bSShawn Guo ret = thermal_zone_unbind_cooling_device(tz, IMX_TRIP_PASSIVE, cdev); 325ca3de46bSShawn Guo if (ret) { 326ca3de46bSShawn Guo dev_err(&tz->device, 327ca3de46bSShawn Guo "unbinding zone %s with cdev %s failed:%d\n", 328ca3de46bSShawn Guo tz->type, cdev->type, ret); 329ca3de46bSShawn Guo return ret; 330ca3de46bSShawn Guo } 331ca3de46bSShawn Guo 332ca3de46bSShawn Guo return 0; 333ca3de46bSShawn Guo } 334ca3de46bSShawn Guo 335cbb07bb3SEduardo Valentin static struct thermal_zone_device_ops imx_tz_ops = { 336ca3de46bSShawn Guo .bind = imx_bind, 337ca3de46bSShawn Guo .unbind = imx_unbind, 338ca3de46bSShawn Guo .get_temp = imx_get_temp, 339ca3de46bSShawn Guo .get_mode = imx_get_mode, 340ca3de46bSShawn Guo .set_mode = imx_set_mode, 341ca3de46bSShawn Guo .get_trip_type = imx_get_trip_type, 342ca3de46bSShawn Guo .get_trip_temp = imx_get_trip_temp, 343ca3de46bSShawn Guo .get_crit_temp = imx_get_crit_temp, 344017e5142SPhilipp Zabel .set_trip_temp = imx_set_trip_temp, 345ca3de46bSShawn Guo }; 346ca3de46bSShawn Guo 347ca3de46bSShawn Guo static int imx_get_sensor_data(struct platform_device *pdev) 348ca3de46bSShawn Guo { 349ca3de46bSShawn Guo struct imx_thermal_data *data = platform_get_drvdata(pdev); 350ca3de46bSShawn Guo struct regmap *map; 351d0f9d64aSAnson Huang int t1, n1; 352ca3de46bSShawn Guo int ret; 353ca3de46bSShawn Guo u32 val; 354749e8be7SAnson Huang u64 temp64; 355ca3de46bSShawn Guo 356ca3de46bSShawn Guo map = syscon_regmap_lookup_by_phandle(pdev->dev.of_node, 357ca3de46bSShawn Guo "fsl,tempmon-data"); 358ca3de46bSShawn Guo if (IS_ERR(map)) { 359ca3de46bSShawn Guo ret = PTR_ERR(map); 360ca3de46bSShawn Guo dev_err(&pdev->dev, "failed to get sensor regmap: %d\n", ret); 361ca3de46bSShawn Guo return ret; 362ca3de46bSShawn Guo } 363ca3de46bSShawn Guo 364ca3de46bSShawn Guo ret = regmap_read(map, OCOTP_ANA1, &val); 365ca3de46bSShawn Guo if (ret) { 366ca3de46bSShawn Guo dev_err(&pdev->dev, "failed to read sensor data: %d\n", ret); 367ca3de46bSShawn Guo return ret; 368ca3de46bSShawn Guo } 369ca3de46bSShawn Guo 370ca3de46bSShawn Guo if (val == 0 || val == ~0) { 371ca3de46bSShawn Guo dev_err(&pdev->dev, "invalid sensor calibration data\n"); 372ca3de46bSShawn Guo return -EINVAL; 373ca3de46bSShawn Guo } 374ca3de46bSShawn Guo 375ca3de46bSShawn Guo /* 376ca3de46bSShawn Guo * Sensor data layout: 377ca3de46bSShawn Guo * [31:20] - sensor value @ 25C 378749e8be7SAnson Huang * Use universal formula now and only need sensor value @ 25C 379749e8be7SAnson Huang * slope = 0.4297157 - (0.0015976 * 25C fuse) 380ca3de46bSShawn Guo */ 381ca3de46bSShawn Guo n1 = val >> 20; 382ca3de46bSShawn Guo t1 = 25; /* t1 always 25C */ 383ca3de46bSShawn Guo 384ca3de46bSShawn Guo /* 385749e8be7SAnson Huang * Derived from linear interpolation: 386749e8be7SAnson Huang * slope = 0.4297157 - (0.0015976 * 25C fuse) 387749e8be7SAnson Huang * slope = (FACTOR2 - FACTOR1 * n1) / FACTOR0 388749e8be7SAnson Huang * (Nmeas - n1) / (Tmeas - t1) = slope 389ca3de46bSShawn Guo * We want to reduce this down to the minimum computation necessary 390ca3de46bSShawn Guo * for each temperature read. Also, we want Tmeas in millicelsius 391ca3de46bSShawn Guo * and we don't want to lose precision from integer division. So... 392749e8be7SAnson Huang * Tmeas = (Nmeas - n1) / slope + t1 393749e8be7SAnson Huang * milli_Tmeas = 1000 * (Nmeas - n1) / slope + 1000 * t1 394749e8be7SAnson Huang * milli_Tmeas = -1000 * (n1 - Nmeas) / slope + 1000 * t1 395749e8be7SAnson Huang * Let constant c1 = (-1000 / slope) 396749e8be7SAnson Huang * milli_Tmeas = (n1 - Nmeas) * c1 + 1000 * t1 397749e8be7SAnson Huang * Let constant c2 = n1 *c1 + 1000 * t1 398749e8be7SAnson Huang * milli_Tmeas = c2 - Nmeas * c1 399ca3de46bSShawn Guo */ 400749e8be7SAnson Huang temp64 = FACTOR0; 401749e8be7SAnson Huang temp64 *= 1000; 402749e8be7SAnson Huang do_div(temp64, FACTOR1 * n1 - FACTOR2); 403749e8be7SAnson Huang data->c1 = temp64; 404749e8be7SAnson Huang data->c2 = n1 * data->c1 + 1000 * t1; 405ca3de46bSShawn Guo 406a2291badSTim Harvey /* use OTP for thermal grade */ 407a2291badSTim Harvey ret = regmap_read(map, OCOTP_MEM0, &val); 408a2291badSTim Harvey if (ret) { 409a2291badSTim Harvey dev_err(&pdev->dev, "failed to read temp grade: %d\n", ret); 410a2291badSTim Harvey return ret; 411a2291badSTim Harvey } 412a2291badSTim Harvey 413a2291badSTim Harvey /* The maximum die temp is specified by the Temperature Grade */ 414a2291badSTim Harvey switch ((val >> 6) & 0x3) { 415a2291badSTim Harvey case 0: /* Commercial (0 to 95C) */ 416a2291badSTim Harvey data->temp_grade = "Commercial"; 417a2291badSTim Harvey data->temp_max = 95000; 418a2291badSTim Harvey break; 419a2291badSTim Harvey case 1: /* Extended Commercial (-20 to 105C) */ 420a2291badSTim Harvey data->temp_grade = "Extended Commercial"; 421a2291badSTim Harvey data->temp_max = 105000; 422a2291badSTim Harvey break; 423a2291badSTim Harvey case 2: /* Industrial (-40 to 105C) */ 424a2291badSTim Harvey data->temp_grade = "Industrial"; 425a2291badSTim Harvey data->temp_max = 105000; 426a2291badSTim Harvey break; 427a2291badSTim Harvey case 3: /* Automotive (-40 to 125C) */ 428a2291badSTim Harvey data->temp_grade = "Automotive"; 429a2291badSTim Harvey data->temp_max = 125000; 430a2291badSTim Harvey break; 431a2291badSTim Harvey } 432017e5142SPhilipp Zabel 433017e5142SPhilipp Zabel /* 434a2291badSTim Harvey * Set the critical trip point at 5C under max 435a2291badSTim Harvey * Set the passive trip point at 10C under max (can change via sysfs) 436017e5142SPhilipp Zabel */ 437a2291badSTim Harvey data->temp_critical = data->temp_max - (1000 * 5); 438a2291badSTim Harvey data->temp_passive = data->temp_max - (1000 * 10); 439017e5142SPhilipp Zabel 440ca3de46bSShawn Guo return 0; 441ca3de46bSShawn Guo } 442ca3de46bSShawn Guo 44337713a1eSPhilipp Zabel static irqreturn_t imx_thermal_alarm_irq(int irq, void *dev) 44437713a1eSPhilipp Zabel { 44537713a1eSPhilipp Zabel struct imx_thermal_data *data = dev; 44637713a1eSPhilipp Zabel 44737713a1eSPhilipp Zabel disable_irq_nosync(irq); 44837713a1eSPhilipp Zabel data->irq_enabled = false; 44937713a1eSPhilipp Zabel 45037713a1eSPhilipp Zabel return IRQ_WAKE_THREAD; 45137713a1eSPhilipp Zabel } 45237713a1eSPhilipp Zabel 45337713a1eSPhilipp Zabel static irqreturn_t imx_thermal_alarm_irq_thread(int irq, void *dev) 45437713a1eSPhilipp Zabel { 45537713a1eSPhilipp Zabel struct imx_thermal_data *data = dev; 45637713a1eSPhilipp Zabel 45717e8351aSSascha Hauer dev_dbg(&data->tz->device, "THERMAL ALARM: T > %d\n", 45837713a1eSPhilipp Zabel data->alarm_temp / 1000); 45937713a1eSPhilipp Zabel 4600e70f466SSrinivas Pandruvada thermal_zone_device_update(data->tz, THERMAL_EVENT_UNSPECIFIED); 46137713a1eSPhilipp Zabel 46237713a1eSPhilipp Zabel return IRQ_HANDLED; 46337713a1eSPhilipp Zabel } 46437713a1eSPhilipp Zabel 4653c94f17eSAnson Huang static const struct of_device_id of_imx_thermal_match[] = { 4663c94f17eSAnson Huang { .compatible = "fsl,imx6q-tempmon", .data = &thermal_imx6q_data, }, 4673c94f17eSAnson Huang { .compatible = "fsl,imx6sx-tempmon", .data = &thermal_imx6sx_data, }, 4683c94f17eSAnson Huang { /* end */ } 4693c94f17eSAnson Huang }; 4703c94f17eSAnson Huang MODULE_DEVICE_TABLE(of, of_imx_thermal_match); 4713c94f17eSAnson Huang 472ca3de46bSShawn Guo static int imx_thermal_probe(struct platform_device *pdev) 473ca3de46bSShawn Guo { 474ca3de46bSShawn Guo struct imx_thermal_data *data; 475ca3de46bSShawn Guo struct regmap *map; 47637713a1eSPhilipp Zabel int measure_freq; 477ca3de46bSShawn Guo int ret; 478ca3de46bSShawn Guo 479ca3de46bSShawn Guo data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL); 480ca3de46bSShawn Guo if (!data) 481ca3de46bSShawn Guo return -ENOMEM; 482ca3de46bSShawn Guo 483ca3de46bSShawn Guo map = syscon_regmap_lookup_by_phandle(pdev->dev.of_node, "fsl,tempmon"); 484ca3de46bSShawn Guo if (IS_ERR(map)) { 485ca3de46bSShawn Guo ret = PTR_ERR(map); 486ca3de46bSShawn Guo dev_err(&pdev->dev, "failed to get tempmon regmap: %d\n", ret); 487ca3de46bSShawn Guo return ret; 488ca3de46bSShawn Guo } 489ca3de46bSShawn Guo data->tempmon = map; 490ca3de46bSShawn Guo 491829bc78aSCorentin LABBE data->socdata = of_device_get_match_data(&pdev->dev); 4923c94f17eSAnson Huang 4933c94f17eSAnson Huang /* make sure the IRQ flag is clear before enabling irq on i.MX6SX */ 4943c94f17eSAnson Huang if (data->socdata->version == TEMPMON_IMX6SX) { 4953c94f17eSAnson Huang regmap_write(map, MISC1 + REG_CLR, MISC1_IRQ_TEMPHIGH | 4963c94f17eSAnson Huang MISC1_IRQ_TEMPLOW | MISC1_IRQ_TEMPPANIC); 4973c94f17eSAnson Huang /* 4983c94f17eSAnson Huang * reset value of LOW ALARM is incorrect, set it to lowest 4993c94f17eSAnson Huang * value to avoid false trigger of low alarm. 5003c94f17eSAnson Huang */ 5013c94f17eSAnson Huang regmap_write(map, TEMPSENSE2 + REG_SET, 5023c94f17eSAnson Huang TEMPSENSE2_LOW_VALUE_MASK); 5033c94f17eSAnson Huang } 5043c94f17eSAnson Huang 50537713a1eSPhilipp Zabel data->irq = platform_get_irq(pdev, 0); 50637713a1eSPhilipp Zabel if (data->irq < 0) 50737713a1eSPhilipp Zabel return data->irq; 50837713a1eSPhilipp Zabel 509ca3de46bSShawn Guo platform_set_drvdata(pdev, data); 510ca3de46bSShawn Guo 511ca3de46bSShawn Guo ret = imx_get_sensor_data(pdev); 512ca3de46bSShawn Guo if (ret) { 513ca3de46bSShawn Guo dev_err(&pdev->dev, "failed to get sensor data\n"); 514ca3de46bSShawn Guo return ret; 515ca3de46bSShawn Guo } 516ca3de46bSShawn Guo 517ca3de46bSShawn Guo /* Make sure sensor is in known good state for measurements */ 518ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 519ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_MEASURE_TEMP); 520ca3de46bSShawn Guo regmap_write(map, TEMPSENSE1 + REG_CLR, TEMPSENSE1_MEASURE_FREQ); 521ca3de46bSShawn Guo regmap_write(map, MISC0 + REG_SET, MISC0_REFTOP_SELBIASOFF); 522ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 523ca3de46bSShawn Guo 524bec85d2eSViresh Kumar data->cdev = cpufreq_cooling_register(cpu_present_mask); 525ca3de46bSShawn Guo if (IS_ERR(data->cdev)) { 526ca3de46bSShawn Guo ret = PTR_ERR(data->cdev); 527412aff94SFabio Estevam if (ret != -EPROBE_DEFER) 528ca3de46bSShawn Guo dev_err(&pdev->dev, 529412aff94SFabio Estevam "failed to register cpufreq cooling device: %d\n", 530412aff94SFabio Estevam ret); 531ca3de46bSShawn Guo return ret; 532ca3de46bSShawn Guo } 533ca3de46bSShawn Guo 53490a21ff5SHeiner Kallweit data->thermal_clk = devm_clk_get(&pdev->dev, NULL); 53590a21ff5SHeiner Kallweit if (IS_ERR(data->thermal_clk)) { 53690a21ff5SHeiner Kallweit ret = PTR_ERR(data->thermal_clk); 53790a21ff5SHeiner Kallweit if (ret != -EPROBE_DEFER) 53890a21ff5SHeiner Kallweit dev_err(&pdev->dev, 53990a21ff5SHeiner Kallweit "failed to get thermal clk: %d\n", ret); 54090a21ff5SHeiner Kallweit cpufreq_cooling_unregister(data->cdev); 54190a21ff5SHeiner Kallweit return ret; 54290a21ff5SHeiner Kallweit } 54390a21ff5SHeiner Kallweit 54490a21ff5SHeiner Kallweit /* 54590a21ff5SHeiner Kallweit * Thermal sensor needs clk on to get correct value, normally 54690a21ff5SHeiner Kallweit * we should enable its clk before taking measurement and disable 54790a21ff5SHeiner Kallweit * clk after measurement is done, but if alarm function is enabled, 54890a21ff5SHeiner Kallweit * hardware will auto measure the temperature periodically, so we 54990a21ff5SHeiner Kallweit * need to keep the clk always on for alarm function. 55090a21ff5SHeiner Kallweit */ 55190a21ff5SHeiner Kallweit ret = clk_prepare_enable(data->thermal_clk); 55290a21ff5SHeiner Kallweit if (ret) { 55390a21ff5SHeiner Kallweit dev_err(&pdev->dev, "failed to enable thermal clk: %d\n", ret); 55490a21ff5SHeiner Kallweit cpufreq_cooling_unregister(data->cdev); 55590a21ff5SHeiner Kallweit return ret; 55690a21ff5SHeiner Kallweit } 55790a21ff5SHeiner Kallweit 558ca3de46bSShawn Guo data->tz = thermal_zone_device_register("imx_thermal_zone", 559017e5142SPhilipp Zabel IMX_TRIP_NUM, 560017e5142SPhilipp Zabel BIT(IMX_TRIP_PASSIVE), data, 561ca3de46bSShawn Guo &imx_tz_ops, NULL, 562ca3de46bSShawn Guo IMX_PASSIVE_DELAY, 563ca3de46bSShawn Guo IMX_POLLING_DELAY); 564ca3de46bSShawn Guo if (IS_ERR(data->tz)) { 565ca3de46bSShawn Guo ret = PTR_ERR(data->tz); 566ca3de46bSShawn Guo dev_err(&pdev->dev, 567ca3de46bSShawn Guo "failed to register thermal zone device %d\n", ret); 56890a21ff5SHeiner Kallweit clk_disable_unprepare(data->thermal_clk); 569ca3de46bSShawn Guo cpufreq_cooling_unregister(data->cdev); 570ca3de46bSShawn Guo return ret; 571ca3de46bSShawn Guo } 572ca3de46bSShawn Guo 573a2291badSTim Harvey dev_info(&pdev->dev, "%s CPU temperature grade - max:%dC" 574a2291badSTim Harvey " critical:%dC passive:%dC\n", data->temp_grade, 575a2291badSTim Harvey data->temp_max / 1000, data->temp_critical / 1000, 576a2291badSTim Harvey data->temp_passive / 1000); 577a2291badSTim Harvey 57837713a1eSPhilipp Zabel /* Enable measurements at ~ 10 Hz */ 57937713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE1 + REG_CLR, TEMPSENSE1_MEASURE_FREQ); 58037713a1eSPhilipp Zabel measure_freq = DIV_ROUND_UP(32768, 10); /* 10 Hz */ 58137713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE1 + REG_SET, measure_freq); 58237713a1eSPhilipp Zabel imx_set_alarm_temp(data, data->temp_passive); 5833c94f17eSAnson Huang 5843c94f17eSAnson Huang if (data->socdata->version == TEMPMON_IMX6SX) 5853c94f17eSAnson Huang imx_set_panic_temp(data, data->temp_critical); 5863c94f17eSAnson Huang 58737713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 58837713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_MEASURE_TEMP); 58937713a1eSPhilipp Zabel 59084866ee5SBai Ping ret = devm_request_threaded_irq(&pdev->dev, data->irq, 59184866ee5SBai Ping imx_thermal_alarm_irq, imx_thermal_alarm_irq_thread, 59284866ee5SBai Ping 0, "imx_thermal", data); 59384866ee5SBai Ping if (ret < 0) { 59484866ee5SBai Ping dev_err(&pdev->dev, "failed to request alarm irq: %d\n", ret); 59584866ee5SBai Ping clk_disable_unprepare(data->thermal_clk); 59684866ee5SBai Ping thermal_zone_device_unregister(data->tz); 59784866ee5SBai Ping cpufreq_cooling_unregister(data->cdev); 59884866ee5SBai Ping return ret; 59984866ee5SBai Ping } 60084866ee5SBai Ping 60137713a1eSPhilipp Zabel data->irq_enabled = true; 602ca3de46bSShawn Guo data->mode = THERMAL_DEVICE_ENABLED; 603ca3de46bSShawn Guo 604ca3de46bSShawn Guo return 0; 605ca3de46bSShawn Guo } 606ca3de46bSShawn Guo 607ca3de46bSShawn Guo static int imx_thermal_remove(struct platform_device *pdev) 608ca3de46bSShawn Guo { 609ca3de46bSShawn Guo struct imx_thermal_data *data = platform_get_drvdata(pdev); 61037713a1eSPhilipp Zabel struct regmap *map = data->tempmon; 61137713a1eSPhilipp Zabel 61237713a1eSPhilipp Zabel /* Disable measurements */ 61337713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 614329fe7b1SAnson Huang if (!IS_ERR(data->thermal_clk)) 615329fe7b1SAnson Huang clk_disable_unprepare(data->thermal_clk); 616ca3de46bSShawn Guo 617ca3de46bSShawn Guo thermal_zone_device_unregister(data->tz); 618ca3de46bSShawn Guo cpufreq_cooling_unregister(data->cdev); 619ca3de46bSShawn Guo 620ca3de46bSShawn Guo return 0; 621ca3de46bSShawn Guo } 622ca3de46bSShawn Guo 623ca3de46bSShawn Guo #ifdef CONFIG_PM_SLEEP 624ca3de46bSShawn Guo static int imx_thermal_suspend(struct device *dev) 625ca3de46bSShawn Guo { 626ca3de46bSShawn Guo struct imx_thermal_data *data = dev_get_drvdata(dev); 627ca3de46bSShawn Guo struct regmap *map = data->tempmon; 628ca3de46bSShawn Guo 629ca3de46bSShawn Guo /* 630b46cce59SAnson Huang * Need to disable thermal sensor, otherwise, when thermal core 631b46cce59SAnson Huang * try to get temperature before thermal sensor resume, a wrong 632b46cce59SAnson Huang * temperature will be read as the thermal sensor is powered 633b46cce59SAnson Huang * down. 634ca3de46bSShawn Guo */ 635b46cce59SAnson Huang regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_MEASURE_TEMP); 636b46cce59SAnson Huang regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 637b46cce59SAnson Huang data->mode = THERMAL_DEVICE_DISABLED; 638d26eef8bSAnson Huang clk_disable_unprepare(data->thermal_clk); 639ca3de46bSShawn Guo 640ca3de46bSShawn Guo return 0; 641ca3de46bSShawn Guo } 642ca3de46bSShawn Guo 643ca3de46bSShawn Guo static int imx_thermal_resume(struct device *dev) 644ca3de46bSShawn Guo { 645b46cce59SAnson Huang struct imx_thermal_data *data = dev_get_drvdata(dev); 646b46cce59SAnson Huang struct regmap *map = data->tempmon; 647b46cce59SAnson Huang 648d26eef8bSAnson Huang clk_prepare_enable(data->thermal_clk); 649b46cce59SAnson Huang /* Enabled thermal sensor after resume */ 650b46cce59SAnson Huang regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 651b46cce59SAnson Huang regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_MEASURE_TEMP); 652b46cce59SAnson Huang data->mode = THERMAL_DEVICE_ENABLED; 653b46cce59SAnson Huang 654ca3de46bSShawn Guo return 0; 655ca3de46bSShawn Guo } 656ca3de46bSShawn Guo #endif 657ca3de46bSShawn Guo 658ca3de46bSShawn Guo static SIMPLE_DEV_PM_OPS(imx_thermal_pm_ops, 659ca3de46bSShawn Guo imx_thermal_suspend, imx_thermal_resume); 660ca3de46bSShawn Guo 661ca3de46bSShawn Guo static struct platform_driver imx_thermal = { 662ca3de46bSShawn Guo .driver = { 663ca3de46bSShawn Guo .name = "imx_thermal", 664ca3de46bSShawn Guo .pm = &imx_thermal_pm_ops, 665ca3de46bSShawn Guo .of_match_table = of_imx_thermal_match, 666ca3de46bSShawn Guo }, 667ca3de46bSShawn Guo .probe = imx_thermal_probe, 668ca3de46bSShawn Guo .remove = imx_thermal_remove, 669ca3de46bSShawn Guo }; 670ca3de46bSShawn Guo module_platform_driver(imx_thermal); 671ca3de46bSShawn Guo 672ca3de46bSShawn Guo MODULE_AUTHOR("Freescale Semiconductor, Inc."); 673ca3de46bSShawn Guo MODULE_DESCRIPTION("Thermal driver for Freescale i.MX SoCs"); 674ca3de46bSShawn Guo MODULE_LICENSE("GPL v2"); 675ca3de46bSShawn Guo MODULE_ALIAS("platform:imx-thermal"); 676