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> 114d753aa7SViresh Kumar #include <linux/cpufreq.h> 12ca3de46bSShawn Guo #include <linux/cpu_cooling.h> 13ca3de46bSShawn Guo #include <linux/delay.h> 14ca3de46bSShawn Guo #include <linux/device.h> 15ca3de46bSShawn Guo #include <linux/init.h> 1637713a1eSPhilipp Zabel #include <linux/interrupt.h> 17ca3de46bSShawn Guo #include <linux/io.h> 18ca3de46bSShawn Guo #include <linux/kernel.h> 19ca3de46bSShawn Guo #include <linux/mfd/syscon.h> 20ca3de46bSShawn Guo #include <linux/module.h> 21ca3de46bSShawn Guo #include <linux/of.h> 223c94f17eSAnson Huang #include <linux/of_device.h> 23ca3de46bSShawn Guo #include <linux/platform_device.h> 24ca3de46bSShawn Guo #include <linux/regmap.h> 25ca3de46bSShawn Guo #include <linux/slab.h> 26ca3de46bSShawn Guo #include <linux/thermal.h> 27ca3de46bSShawn Guo #include <linux/types.h> 28ca3de46bSShawn Guo 29ca3de46bSShawn Guo #define REG_SET 0x4 30ca3de46bSShawn Guo #define REG_CLR 0x8 31ca3de46bSShawn Guo #define REG_TOG 0xc 32ca3de46bSShawn Guo 33ca3de46bSShawn Guo #define MISC0 0x0150 34ca3de46bSShawn Guo #define MISC0_REFTOP_SELBIASOFF (1 << 3) 353c94f17eSAnson Huang #define MISC1 0x0160 363c94f17eSAnson Huang #define MISC1_IRQ_TEMPHIGH (1 << 29) 373c94f17eSAnson Huang /* Below LOW and PANIC bits are only for TEMPMON_IMX6SX */ 383c94f17eSAnson Huang #define MISC1_IRQ_TEMPLOW (1 << 28) 393c94f17eSAnson Huang #define MISC1_IRQ_TEMPPANIC (1 << 27) 40ca3de46bSShawn Guo 41ca3de46bSShawn Guo #define TEMPSENSE0 0x0180 4237713a1eSPhilipp Zabel #define TEMPSENSE0_ALARM_VALUE_SHIFT 20 4337713a1eSPhilipp Zabel #define TEMPSENSE0_ALARM_VALUE_MASK (0xfff << TEMPSENSE0_ALARM_VALUE_SHIFT) 44ca3de46bSShawn Guo #define TEMPSENSE0_TEMP_CNT_SHIFT 8 45ca3de46bSShawn Guo #define TEMPSENSE0_TEMP_CNT_MASK (0xfff << TEMPSENSE0_TEMP_CNT_SHIFT) 46ca3de46bSShawn Guo #define TEMPSENSE0_FINISHED (1 << 2) 47ca3de46bSShawn Guo #define TEMPSENSE0_MEASURE_TEMP (1 << 1) 48ca3de46bSShawn Guo #define TEMPSENSE0_POWER_DOWN (1 << 0) 49ca3de46bSShawn Guo 50ca3de46bSShawn Guo #define TEMPSENSE1 0x0190 51ca3de46bSShawn Guo #define TEMPSENSE1_MEASURE_FREQ 0xffff 523c94f17eSAnson Huang /* Below TEMPSENSE2 is only for TEMPMON_IMX6SX */ 533c94f17eSAnson Huang #define TEMPSENSE2 0x0290 543c94f17eSAnson Huang #define TEMPSENSE2_LOW_VALUE_SHIFT 0 553c94f17eSAnson Huang #define TEMPSENSE2_LOW_VALUE_MASK 0xfff 563c94f17eSAnson Huang #define TEMPSENSE2_PANIC_VALUE_SHIFT 16 573c94f17eSAnson Huang #define TEMPSENSE2_PANIC_VALUE_MASK 0xfff0000 58ca3de46bSShawn Guo 59a2291badSTim Harvey #define OCOTP_MEM0 0x0480 60ca3de46bSShawn Guo #define OCOTP_ANA1 0x04e0 61ca3de46bSShawn Guo 62ca3de46bSShawn Guo /* The driver supports 1 passive trip point and 1 critical trip point */ 63ca3de46bSShawn Guo enum imx_thermal_trip { 64ca3de46bSShawn Guo IMX_TRIP_PASSIVE, 65ca3de46bSShawn Guo IMX_TRIP_CRITICAL, 66ca3de46bSShawn Guo IMX_TRIP_NUM, 67ca3de46bSShawn Guo }; 68ca3de46bSShawn Guo 69ca3de46bSShawn Guo #define IMX_POLLING_DELAY 2000 /* millisecond */ 70ca3de46bSShawn Guo #define IMX_PASSIVE_DELAY 1000 71ca3de46bSShawn Guo 72749e8be7SAnson Huang #define FACTOR0 10000000 73749e8be7SAnson Huang #define FACTOR1 15976 74749e8be7SAnson Huang #define FACTOR2 4297157 75749e8be7SAnson Huang 763c94f17eSAnson Huang #define TEMPMON_IMX6Q 1 773c94f17eSAnson Huang #define TEMPMON_IMX6SX 2 783c94f17eSAnson Huang 793c94f17eSAnson Huang struct thermal_soc_data { 803c94f17eSAnson Huang u32 version; 813c94f17eSAnson Huang }; 823c94f17eSAnson Huang 833c94f17eSAnson Huang static struct thermal_soc_data thermal_imx6q_data = { 843c94f17eSAnson Huang .version = TEMPMON_IMX6Q, 853c94f17eSAnson Huang }; 863c94f17eSAnson Huang 873c94f17eSAnson Huang static struct thermal_soc_data thermal_imx6sx_data = { 883c94f17eSAnson Huang .version = TEMPMON_IMX6SX, 893c94f17eSAnson Huang }; 903c94f17eSAnson Huang 91ca3de46bSShawn Guo struct imx_thermal_data { 924d753aa7SViresh Kumar struct cpufreq_policy *policy; 93ca3de46bSShawn Guo struct thermal_zone_device *tz; 94ca3de46bSShawn Guo struct thermal_cooling_device *cdev; 95ca3de46bSShawn Guo enum thermal_device_mode mode; 96ca3de46bSShawn Guo struct regmap *tempmon; 97749e8be7SAnson Huang u32 c1, c2; /* See formula in imx_get_sensor_data() */ 9817e8351aSSascha Hauer int temp_passive; 9917e8351aSSascha Hauer int temp_critical; 100a2291badSTim Harvey int temp_max; 10117e8351aSSascha Hauer int alarm_temp; 10217e8351aSSascha Hauer int last_temp; 10337713a1eSPhilipp Zabel bool irq_enabled; 10437713a1eSPhilipp Zabel int irq; 105329fe7b1SAnson Huang struct clk *thermal_clk; 1063c94f17eSAnson Huang const struct thermal_soc_data *socdata; 107a2291badSTim Harvey const char *temp_grade; 108ca3de46bSShawn Guo }; 109ca3de46bSShawn Guo 1103c94f17eSAnson Huang static void imx_set_panic_temp(struct imx_thermal_data *data, 11117e8351aSSascha Hauer int panic_temp) 1123c94f17eSAnson Huang { 1133c94f17eSAnson Huang struct regmap *map = data->tempmon; 1143c94f17eSAnson Huang int critical_value; 1153c94f17eSAnson Huang 1163c94f17eSAnson Huang critical_value = (data->c2 - panic_temp) / data->c1; 1173c94f17eSAnson Huang regmap_write(map, TEMPSENSE2 + REG_CLR, TEMPSENSE2_PANIC_VALUE_MASK); 1183c94f17eSAnson Huang regmap_write(map, TEMPSENSE2 + REG_SET, critical_value << 1193c94f17eSAnson Huang TEMPSENSE2_PANIC_VALUE_SHIFT); 1203c94f17eSAnson Huang } 1213c94f17eSAnson Huang 12237713a1eSPhilipp Zabel static void imx_set_alarm_temp(struct imx_thermal_data *data, 12317e8351aSSascha Hauer int alarm_temp) 12437713a1eSPhilipp Zabel { 12537713a1eSPhilipp Zabel struct regmap *map = data->tempmon; 12637713a1eSPhilipp Zabel int alarm_value; 12737713a1eSPhilipp Zabel 12837713a1eSPhilipp Zabel data->alarm_temp = alarm_temp; 129749e8be7SAnson Huang alarm_value = (data->c2 - alarm_temp) / data->c1; 13037713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_ALARM_VALUE_MASK); 13137713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, alarm_value << 13237713a1eSPhilipp Zabel TEMPSENSE0_ALARM_VALUE_SHIFT); 13337713a1eSPhilipp Zabel } 13437713a1eSPhilipp Zabel 13517e8351aSSascha Hauer static int imx_get_temp(struct thermal_zone_device *tz, int *temp) 136ca3de46bSShawn Guo { 137ca3de46bSShawn Guo struct imx_thermal_data *data = tz->devdata; 138ca3de46bSShawn Guo struct regmap *map = data->tempmon; 139ca3de46bSShawn Guo unsigned int n_meas; 14037713a1eSPhilipp Zabel bool wait; 141ca3de46bSShawn Guo u32 val; 142ca3de46bSShawn Guo 14337713a1eSPhilipp Zabel if (data->mode == THERMAL_DEVICE_ENABLED) { 14437713a1eSPhilipp Zabel /* Check if a measurement is currently in progress */ 14537713a1eSPhilipp Zabel regmap_read(map, TEMPSENSE0, &val); 14637713a1eSPhilipp Zabel wait = !(val & TEMPSENSE0_FINISHED); 14737713a1eSPhilipp Zabel } else { 148ca3de46bSShawn Guo /* 149ca3de46bSShawn Guo * Every time we measure the temperature, we will power on the 150ca3de46bSShawn Guo * temperature sensor, enable measurements, take a reading, 151ca3de46bSShawn Guo * disable measurements, power off the temperature sensor. 152ca3de46bSShawn Guo */ 153ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 154ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_MEASURE_TEMP); 155ca3de46bSShawn Guo 15637713a1eSPhilipp Zabel wait = true; 15737713a1eSPhilipp Zabel } 15837713a1eSPhilipp Zabel 159ca3de46bSShawn Guo /* 160ca3de46bSShawn Guo * According to the temp sensor designers, it may require up to ~17us 161ca3de46bSShawn Guo * to complete a measurement. 162ca3de46bSShawn Guo */ 16337713a1eSPhilipp Zabel if (wait) 164ca3de46bSShawn Guo usleep_range(20, 50); 165ca3de46bSShawn Guo 166ca3de46bSShawn Guo regmap_read(map, TEMPSENSE0, &val); 16737713a1eSPhilipp Zabel 16837713a1eSPhilipp Zabel if (data->mode != THERMAL_DEVICE_ENABLED) { 169ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_MEASURE_TEMP); 170ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 17137713a1eSPhilipp Zabel } 172ca3de46bSShawn Guo 173ca3de46bSShawn Guo if ((val & TEMPSENSE0_FINISHED) == 0) { 174ca3de46bSShawn Guo dev_dbg(&tz->device, "temp measurement never finished\n"); 175ca3de46bSShawn Guo return -EAGAIN; 176ca3de46bSShawn Guo } 177ca3de46bSShawn Guo 178ca3de46bSShawn Guo n_meas = (val & TEMPSENSE0_TEMP_CNT_MASK) >> TEMPSENSE0_TEMP_CNT_SHIFT; 179ca3de46bSShawn Guo 180ca3de46bSShawn Guo /* See imx_get_sensor_data() for formula derivation */ 181749e8be7SAnson Huang *temp = data->c2 - n_meas * data->c1; 182ca3de46bSShawn Guo 1833c94f17eSAnson Huang /* Update alarm value to next higher trip point for TEMPMON_IMX6Q */ 1843c94f17eSAnson Huang if (data->socdata->version == TEMPMON_IMX6Q) { 1853c94f17eSAnson Huang if (data->alarm_temp == data->temp_passive && 1863c94f17eSAnson Huang *temp >= data->temp_passive) 18737713a1eSPhilipp Zabel imx_set_alarm_temp(data, data->temp_critical); 1883c94f17eSAnson Huang if (data->alarm_temp == data->temp_critical && 1893c94f17eSAnson Huang *temp < data->temp_passive) { 19037713a1eSPhilipp Zabel imx_set_alarm_temp(data, data->temp_passive); 19117e8351aSSascha Hauer dev_dbg(&tz->device, "thermal alarm off: T < %d\n", 19237713a1eSPhilipp Zabel data->alarm_temp / 1000); 19337713a1eSPhilipp Zabel } 1943c94f17eSAnson Huang } 19537713a1eSPhilipp Zabel 19637713a1eSPhilipp Zabel if (*temp != data->last_temp) { 19717e8351aSSascha Hauer dev_dbg(&tz->device, "millicelsius: %d\n", *temp); 19837713a1eSPhilipp Zabel data->last_temp = *temp; 19937713a1eSPhilipp Zabel } 20037713a1eSPhilipp Zabel 20137713a1eSPhilipp Zabel /* Reenable alarm IRQ if temperature below alarm temperature */ 20237713a1eSPhilipp Zabel if (!data->irq_enabled && *temp < data->alarm_temp) { 20337713a1eSPhilipp Zabel data->irq_enabled = true; 20437713a1eSPhilipp Zabel enable_irq(data->irq); 205ca3de46bSShawn Guo } 206ca3de46bSShawn Guo 207ca3de46bSShawn Guo return 0; 208ca3de46bSShawn Guo } 209ca3de46bSShawn Guo 210ca3de46bSShawn Guo static int imx_get_mode(struct thermal_zone_device *tz, 211ca3de46bSShawn Guo enum thermal_device_mode *mode) 212ca3de46bSShawn Guo { 213ca3de46bSShawn Guo struct imx_thermal_data *data = tz->devdata; 214ca3de46bSShawn Guo 215ca3de46bSShawn Guo *mode = data->mode; 216ca3de46bSShawn Guo 217ca3de46bSShawn Guo return 0; 218ca3de46bSShawn Guo } 219ca3de46bSShawn Guo 220ca3de46bSShawn Guo static int imx_set_mode(struct thermal_zone_device *tz, 221ca3de46bSShawn Guo enum thermal_device_mode mode) 222ca3de46bSShawn Guo { 223ca3de46bSShawn Guo struct imx_thermal_data *data = tz->devdata; 22437713a1eSPhilipp Zabel struct regmap *map = data->tempmon; 225ca3de46bSShawn Guo 226ca3de46bSShawn Guo if (mode == THERMAL_DEVICE_ENABLED) { 227ca3de46bSShawn Guo tz->polling_delay = IMX_POLLING_DELAY; 228ca3de46bSShawn Guo tz->passive_delay = IMX_PASSIVE_DELAY; 22937713a1eSPhilipp Zabel 23037713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 23137713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_MEASURE_TEMP); 23237713a1eSPhilipp Zabel 23337713a1eSPhilipp Zabel if (!data->irq_enabled) { 23437713a1eSPhilipp Zabel data->irq_enabled = true; 23537713a1eSPhilipp Zabel enable_irq(data->irq); 23637713a1eSPhilipp Zabel } 237ca3de46bSShawn Guo } else { 23837713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_MEASURE_TEMP); 23937713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 24037713a1eSPhilipp Zabel 241ca3de46bSShawn Guo tz->polling_delay = 0; 242ca3de46bSShawn Guo tz->passive_delay = 0; 24337713a1eSPhilipp Zabel 24437713a1eSPhilipp Zabel if (data->irq_enabled) { 24537713a1eSPhilipp Zabel disable_irq(data->irq); 24637713a1eSPhilipp Zabel data->irq_enabled = false; 24737713a1eSPhilipp Zabel } 248ca3de46bSShawn Guo } 249ca3de46bSShawn Guo 250ca3de46bSShawn Guo data->mode = mode; 2510e70f466SSrinivas Pandruvada thermal_zone_device_update(tz, THERMAL_EVENT_UNSPECIFIED); 252ca3de46bSShawn Guo 253ca3de46bSShawn Guo return 0; 254ca3de46bSShawn Guo } 255ca3de46bSShawn Guo 256ca3de46bSShawn Guo static int imx_get_trip_type(struct thermal_zone_device *tz, int trip, 257ca3de46bSShawn Guo enum thermal_trip_type *type) 258ca3de46bSShawn Guo { 259ca3de46bSShawn Guo *type = (trip == IMX_TRIP_PASSIVE) ? THERMAL_TRIP_PASSIVE : 260ca3de46bSShawn Guo THERMAL_TRIP_CRITICAL; 261ca3de46bSShawn Guo return 0; 262ca3de46bSShawn Guo } 263ca3de46bSShawn Guo 26417e8351aSSascha Hauer static int imx_get_crit_temp(struct thermal_zone_device *tz, int *temp) 265ca3de46bSShawn Guo { 266017e5142SPhilipp Zabel struct imx_thermal_data *data = tz->devdata; 267017e5142SPhilipp Zabel 268017e5142SPhilipp Zabel *temp = data->temp_critical; 269ca3de46bSShawn Guo return 0; 270ca3de46bSShawn Guo } 271ca3de46bSShawn Guo 272ca3de46bSShawn Guo static int imx_get_trip_temp(struct thermal_zone_device *tz, int trip, 27317e8351aSSascha Hauer int *temp) 274ca3de46bSShawn Guo { 275017e5142SPhilipp Zabel struct imx_thermal_data *data = tz->devdata; 276017e5142SPhilipp Zabel 277017e5142SPhilipp Zabel *temp = (trip == IMX_TRIP_PASSIVE) ? data->temp_passive : 278017e5142SPhilipp Zabel data->temp_critical; 279017e5142SPhilipp Zabel return 0; 280017e5142SPhilipp Zabel } 281017e5142SPhilipp Zabel 282017e5142SPhilipp Zabel static int imx_set_trip_temp(struct thermal_zone_device *tz, int trip, 28317e8351aSSascha Hauer int temp) 284017e5142SPhilipp Zabel { 285017e5142SPhilipp Zabel struct imx_thermal_data *data = tz->devdata; 286017e5142SPhilipp Zabel 287a2291badSTim Harvey /* do not allow changing critical threshold */ 288017e5142SPhilipp Zabel if (trip == IMX_TRIP_CRITICAL) 289017e5142SPhilipp Zabel return -EPERM; 290017e5142SPhilipp Zabel 291a2291badSTim Harvey /* do not allow passive to be set higher than critical */ 292a2291badSTim Harvey if (temp < 0 || temp > data->temp_critical) 293017e5142SPhilipp Zabel return -EINVAL; 294017e5142SPhilipp Zabel 295017e5142SPhilipp Zabel data->temp_passive = temp; 296017e5142SPhilipp Zabel 29737713a1eSPhilipp Zabel imx_set_alarm_temp(data, temp); 29837713a1eSPhilipp Zabel 299ca3de46bSShawn Guo return 0; 300ca3de46bSShawn Guo } 301ca3de46bSShawn Guo 302ca3de46bSShawn Guo static int imx_bind(struct thermal_zone_device *tz, 303ca3de46bSShawn Guo struct thermal_cooling_device *cdev) 304ca3de46bSShawn Guo { 305ca3de46bSShawn Guo int ret; 306ca3de46bSShawn Guo 307ca3de46bSShawn Guo ret = thermal_zone_bind_cooling_device(tz, IMX_TRIP_PASSIVE, cdev, 308ca3de46bSShawn Guo THERMAL_NO_LIMIT, 3096cd9e9f6SKapileshwar Singh THERMAL_NO_LIMIT, 3106cd9e9f6SKapileshwar Singh THERMAL_WEIGHT_DEFAULT); 311ca3de46bSShawn Guo if (ret) { 312ca3de46bSShawn Guo dev_err(&tz->device, 313ca3de46bSShawn Guo "binding zone %s with cdev %s failed:%d\n", 314ca3de46bSShawn Guo tz->type, cdev->type, ret); 315ca3de46bSShawn Guo return ret; 316ca3de46bSShawn Guo } 317ca3de46bSShawn Guo 318ca3de46bSShawn Guo return 0; 319ca3de46bSShawn Guo } 320ca3de46bSShawn Guo 321ca3de46bSShawn Guo static int imx_unbind(struct thermal_zone_device *tz, 322ca3de46bSShawn Guo struct thermal_cooling_device *cdev) 323ca3de46bSShawn Guo { 324ca3de46bSShawn Guo int ret; 325ca3de46bSShawn Guo 326ca3de46bSShawn Guo ret = thermal_zone_unbind_cooling_device(tz, IMX_TRIP_PASSIVE, cdev); 327ca3de46bSShawn Guo if (ret) { 328ca3de46bSShawn Guo dev_err(&tz->device, 329ca3de46bSShawn Guo "unbinding zone %s with cdev %s failed:%d\n", 330ca3de46bSShawn Guo tz->type, cdev->type, ret); 331ca3de46bSShawn Guo return ret; 332ca3de46bSShawn Guo } 333ca3de46bSShawn Guo 334ca3de46bSShawn Guo return 0; 335ca3de46bSShawn Guo } 336ca3de46bSShawn Guo 337cbb07bb3SEduardo Valentin static struct thermal_zone_device_ops imx_tz_ops = { 338ca3de46bSShawn Guo .bind = imx_bind, 339ca3de46bSShawn Guo .unbind = imx_unbind, 340ca3de46bSShawn Guo .get_temp = imx_get_temp, 341ca3de46bSShawn Guo .get_mode = imx_get_mode, 342ca3de46bSShawn Guo .set_mode = imx_set_mode, 343ca3de46bSShawn Guo .get_trip_type = imx_get_trip_type, 344ca3de46bSShawn Guo .get_trip_temp = imx_get_trip_temp, 345ca3de46bSShawn Guo .get_crit_temp = imx_get_crit_temp, 346017e5142SPhilipp Zabel .set_trip_temp = imx_set_trip_temp, 347ca3de46bSShawn Guo }; 348ca3de46bSShawn Guo 349ca3de46bSShawn Guo static int imx_get_sensor_data(struct platform_device *pdev) 350ca3de46bSShawn Guo { 351ca3de46bSShawn Guo struct imx_thermal_data *data = platform_get_drvdata(pdev); 352ca3de46bSShawn Guo struct regmap *map; 353d0f9d64aSAnson Huang int t1, n1; 354ca3de46bSShawn Guo int ret; 355ca3de46bSShawn Guo u32 val; 356749e8be7SAnson Huang u64 temp64; 357ca3de46bSShawn Guo 358ca3de46bSShawn Guo map = syscon_regmap_lookup_by_phandle(pdev->dev.of_node, 359ca3de46bSShawn Guo "fsl,tempmon-data"); 360ca3de46bSShawn Guo if (IS_ERR(map)) { 361ca3de46bSShawn Guo ret = PTR_ERR(map); 362ca3de46bSShawn Guo dev_err(&pdev->dev, "failed to get sensor regmap: %d\n", ret); 363ca3de46bSShawn Guo return ret; 364ca3de46bSShawn Guo } 365ca3de46bSShawn Guo 366ca3de46bSShawn Guo ret = regmap_read(map, OCOTP_ANA1, &val); 367ca3de46bSShawn Guo if (ret) { 368ca3de46bSShawn Guo dev_err(&pdev->dev, "failed to read sensor data: %d\n", ret); 369ca3de46bSShawn Guo return ret; 370ca3de46bSShawn Guo } 371ca3de46bSShawn Guo 372ca3de46bSShawn Guo if (val == 0 || val == ~0) { 373ca3de46bSShawn Guo dev_err(&pdev->dev, "invalid sensor calibration data\n"); 374ca3de46bSShawn Guo return -EINVAL; 375ca3de46bSShawn Guo } 376ca3de46bSShawn Guo 377ca3de46bSShawn Guo /* 378ca3de46bSShawn Guo * Sensor data layout: 379ca3de46bSShawn Guo * [31:20] - sensor value @ 25C 380749e8be7SAnson Huang * Use universal formula now and only need sensor value @ 25C 381749e8be7SAnson Huang * slope = 0.4297157 - (0.0015976 * 25C fuse) 382ca3de46bSShawn Guo */ 383ca3de46bSShawn Guo n1 = val >> 20; 384ca3de46bSShawn Guo t1 = 25; /* t1 always 25C */ 385ca3de46bSShawn Guo 386ca3de46bSShawn Guo /* 387749e8be7SAnson Huang * Derived from linear interpolation: 388749e8be7SAnson Huang * slope = 0.4297157 - (0.0015976 * 25C fuse) 389749e8be7SAnson Huang * slope = (FACTOR2 - FACTOR1 * n1) / FACTOR0 390749e8be7SAnson Huang * (Nmeas - n1) / (Tmeas - t1) = slope 391ca3de46bSShawn Guo * We want to reduce this down to the minimum computation necessary 392ca3de46bSShawn Guo * for each temperature read. Also, we want Tmeas in millicelsius 393ca3de46bSShawn Guo * and we don't want to lose precision from integer division. So... 394749e8be7SAnson Huang * Tmeas = (Nmeas - n1) / slope + t1 395749e8be7SAnson Huang * milli_Tmeas = 1000 * (Nmeas - n1) / slope + 1000 * t1 396749e8be7SAnson Huang * milli_Tmeas = -1000 * (n1 - Nmeas) / slope + 1000 * t1 397749e8be7SAnson Huang * Let constant c1 = (-1000 / slope) 398749e8be7SAnson Huang * milli_Tmeas = (n1 - Nmeas) * c1 + 1000 * t1 399749e8be7SAnson Huang * Let constant c2 = n1 *c1 + 1000 * t1 400749e8be7SAnson Huang * milli_Tmeas = c2 - Nmeas * c1 401ca3de46bSShawn Guo */ 402749e8be7SAnson Huang temp64 = FACTOR0; 403749e8be7SAnson Huang temp64 *= 1000; 404749e8be7SAnson Huang do_div(temp64, FACTOR1 * n1 - FACTOR2); 405749e8be7SAnson Huang data->c1 = temp64; 406749e8be7SAnson Huang data->c2 = n1 * data->c1 + 1000 * t1; 407ca3de46bSShawn Guo 408a2291badSTim Harvey /* use OTP for thermal grade */ 409a2291badSTim Harvey ret = regmap_read(map, OCOTP_MEM0, &val); 410a2291badSTim Harvey if (ret) { 411a2291badSTim Harvey dev_err(&pdev->dev, "failed to read temp grade: %d\n", ret); 412a2291badSTim Harvey return ret; 413a2291badSTim Harvey } 414a2291badSTim Harvey 415a2291badSTim Harvey /* The maximum die temp is specified by the Temperature Grade */ 416a2291badSTim Harvey switch ((val >> 6) & 0x3) { 417a2291badSTim Harvey case 0: /* Commercial (0 to 95C) */ 418a2291badSTim Harvey data->temp_grade = "Commercial"; 419a2291badSTim Harvey data->temp_max = 95000; 420a2291badSTim Harvey break; 421a2291badSTim Harvey case 1: /* Extended Commercial (-20 to 105C) */ 422a2291badSTim Harvey data->temp_grade = "Extended Commercial"; 423a2291badSTim Harvey data->temp_max = 105000; 424a2291badSTim Harvey break; 425a2291badSTim Harvey case 2: /* Industrial (-40 to 105C) */ 426a2291badSTim Harvey data->temp_grade = "Industrial"; 427a2291badSTim Harvey data->temp_max = 105000; 428a2291badSTim Harvey break; 429a2291badSTim Harvey case 3: /* Automotive (-40 to 125C) */ 430a2291badSTim Harvey data->temp_grade = "Automotive"; 431a2291badSTim Harvey data->temp_max = 125000; 432a2291badSTim Harvey break; 433a2291badSTim Harvey } 434017e5142SPhilipp Zabel 435017e5142SPhilipp Zabel /* 436a2291badSTim Harvey * Set the critical trip point at 5C under max 437a2291badSTim Harvey * Set the passive trip point at 10C under max (can change via sysfs) 438017e5142SPhilipp Zabel */ 439a2291badSTim Harvey data->temp_critical = data->temp_max - (1000 * 5); 440a2291badSTim Harvey data->temp_passive = data->temp_max - (1000 * 10); 441017e5142SPhilipp Zabel 442ca3de46bSShawn Guo return 0; 443ca3de46bSShawn Guo } 444ca3de46bSShawn Guo 44537713a1eSPhilipp Zabel static irqreturn_t imx_thermal_alarm_irq(int irq, void *dev) 44637713a1eSPhilipp Zabel { 44737713a1eSPhilipp Zabel struct imx_thermal_data *data = dev; 44837713a1eSPhilipp Zabel 44937713a1eSPhilipp Zabel disable_irq_nosync(irq); 45037713a1eSPhilipp Zabel data->irq_enabled = false; 45137713a1eSPhilipp Zabel 45237713a1eSPhilipp Zabel return IRQ_WAKE_THREAD; 45337713a1eSPhilipp Zabel } 45437713a1eSPhilipp Zabel 45537713a1eSPhilipp Zabel static irqreturn_t imx_thermal_alarm_irq_thread(int irq, void *dev) 45637713a1eSPhilipp Zabel { 45737713a1eSPhilipp Zabel struct imx_thermal_data *data = dev; 45837713a1eSPhilipp Zabel 45917e8351aSSascha Hauer dev_dbg(&data->tz->device, "THERMAL ALARM: T > %d\n", 46037713a1eSPhilipp Zabel data->alarm_temp / 1000); 46137713a1eSPhilipp Zabel 4620e70f466SSrinivas Pandruvada thermal_zone_device_update(data->tz, THERMAL_EVENT_UNSPECIFIED); 46337713a1eSPhilipp Zabel 46437713a1eSPhilipp Zabel return IRQ_HANDLED; 46537713a1eSPhilipp Zabel } 46637713a1eSPhilipp Zabel 4673c94f17eSAnson Huang static const struct of_device_id of_imx_thermal_match[] = { 4683c94f17eSAnson Huang { .compatible = "fsl,imx6q-tempmon", .data = &thermal_imx6q_data, }, 4693c94f17eSAnson Huang { .compatible = "fsl,imx6sx-tempmon", .data = &thermal_imx6sx_data, }, 4703c94f17eSAnson Huang { /* end */ } 4713c94f17eSAnson Huang }; 4723c94f17eSAnson Huang MODULE_DEVICE_TABLE(of, of_imx_thermal_match); 4733c94f17eSAnson Huang 474ca3de46bSShawn Guo static int imx_thermal_probe(struct platform_device *pdev) 475ca3de46bSShawn Guo { 476ca3de46bSShawn Guo struct imx_thermal_data *data; 477ca3de46bSShawn Guo struct regmap *map; 47837713a1eSPhilipp Zabel int measure_freq; 479ca3de46bSShawn Guo int ret; 480ca3de46bSShawn Guo 481ca3de46bSShawn Guo data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL); 482ca3de46bSShawn Guo if (!data) 483ca3de46bSShawn Guo return -ENOMEM; 484ca3de46bSShawn Guo 485ca3de46bSShawn Guo map = syscon_regmap_lookup_by_phandle(pdev->dev.of_node, "fsl,tempmon"); 486ca3de46bSShawn Guo if (IS_ERR(map)) { 487ca3de46bSShawn Guo ret = PTR_ERR(map); 488ca3de46bSShawn Guo dev_err(&pdev->dev, "failed to get tempmon regmap: %d\n", ret); 489ca3de46bSShawn Guo return ret; 490ca3de46bSShawn Guo } 491ca3de46bSShawn Guo data->tempmon = map; 492ca3de46bSShawn Guo 493829bc78aSCorentin LABBE data->socdata = of_device_get_match_data(&pdev->dev); 4948b051ec3SShailendra Verma if (!data->socdata) { 4958b051ec3SShailendra Verma dev_err(&pdev->dev, "no device match found\n"); 4968b051ec3SShailendra Verma return -ENODEV; 4978b051ec3SShailendra Verma } 4983c94f17eSAnson Huang 4993c94f17eSAnson Huang /* make sure the IRQ flag is clear before enabling irq on i.MX6SX */ 5003c94f17eSAnson Huang if (data->socdata->version == TEMPMON_IMX6SX) { 5013c94f17eSAnson Huang regmap_write(map, MISC1 + REG_CLR, MISC1_IRQ_TEMPHIGH | 5023c94f17eSAnson Huang MISC1_IRQ_TEMPLOW | MISC1_IRQ_TEMPPANIC); 5033c94f17eSAnson Huang /* 5043c94f17eSAnson Huang * reset value of LOW ALARM is incorrect, set it to lowest 5053c94f17eSAnson Huang * value to avoid false trigger of low alarm. 5063c94f17eSAnson Huang */ 5073c94f17eSAnson Huang regmap_write(map, TEMPSENSE2 + REG_SET, 5083c94f17eSAnson Huang TEMPSENSE2_LOW_VALUE_MASK); 5093c94f17eSAnson Huang } 5103c94f17eSAnson Huang 51137713a1eSPhilipp Zabel data->irq = platform_get_irq(pdev, 0); 51237713a1eSPhilipp Zabel if (data->irq < 0) 51337713a1eSPhilipp Zabel return data->irq; 51437713a1eSPhilipp Zabel 515ca3de46bSShawn Guo platform_set_drvdata(pdev, data); 516ca3de46bSShawn Guo 517ca3de46bSShawn Guo ret = imx_get_sensor_data(pdev); 518ca3de46bSShawn Guo if (ret) { 519ca3de46bSShawn Guo dev_err(&pdev->dev, "failed to get sensor data\n"); 520ca3de46bSShawn Guo return ret; 521ca3de46bSShawn Guo } 522ca3de46bSShawn Guo 523ca3de46bSShawn Guo /* Make sure sensor is in known good state for measurements */ 524ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 525ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_MEASURE_TEMP); 526ca3de46bSShawn Guo regmap_write(map, TEMPSENSE1 + REG_CLR, TEMPSENSE1_MEASURE_FREQ); 527ca3de46bSShawn Guo regmap_write(map, MISC0 + REG_SET, MISC0_REFTOP_SELBIASOFF); 528ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 529ca3de46bSShawn Guo 5304d753aa7SViresh Kumar data->policy = cpufreq_cpu_get(0); 5314d753aa7SViresh Kumar if (!data->policy) { 5324d753aa7SViresh Kumar pr_debug("%s: CPUFreq policy not found\n", __func__); 5334d753aa7SViresh Kumar return -EPROBE_DEFER; 5344d753aa7SViresh Kumar } 5354d753aa7SViresh Kumar 5364d753aa7SViresh Kumar data->cdev = cpufreq_cooling_register(data->policy); 537ca3de46bSShawn Guo if (IS_ERR(data->cdev)) { 538ca3de46bSShawn Guo ret = PTR_ERR(data->cdev); 539ca3de46bSShawn Guo dev_err(&pdev->dev, 5404d753aa7SViresh Kumar "failed to register cpufreq cooling device: %d\n", ret); 5414d753aa7SViresh Kumar cpufreq_cpu_put(data->policy); 542ca3de46bSShawn Guo return ret; 543ca3de46bSShawn Guo } 544ca3de46bSShawn Guo 54590a21ff5SHeiner Kallweit data->thermal_clk = devm_clk_get(&pdev->dev, NULL); 54690a21ff5SHeiner Kallweit if (IS_ERR(data->thermal_clk)) { 54790a21ff5SHeiner Kallweit ret = PTR_ERR(data->thermal_clk); 54890a21ff5SHeiner Kallweit if (ret != -EPROBE_DEFER) 54990a21ff5SHeiner Kallweit dev_err(&pdev->dev, 55090a21ff5SHeiner Kallweit "failed to get thermal clk: %d\n", ret); 55190a21ff5SHeiner Kallweit cpufreq_cooling_unregister(data->cdev); 5524d753aa7SViresh Kumar cpufreq_cpu_put(data->policy); 55390a21ff5SHeiner Kallweit return ret; 55490a21ff5SHeiner Kallweit } 55590a21ff5SHeiner Kallweit 55690a21ff5SHeiner Kallweit /* 55790a21ff5SHeiner Kallweit * Thermal sensor needs clk on to get correct value, normally 55890a21ff5SHeiner Kallweit * we should enable its clk before taking measurement and disable 55990a21ff5SHeiner Kallweit * clk after measurement is done, but if alarm function is enabled, 56090a21ff5SHeiner Kallweit * hardware will auto measure the temperature periodically, so we 56190a21ff5SHeiner Kallweit * need to keep the clk always on for alarm function. 56290a21ff5SHeiner Kallweit */ 56390a21ff5SHeiner Kallweit ret = clk_prepare_enable(data->thermal_clk); 56490a21ff5SHeiner Kallweit if (ret) { 56590a21ff5SHeiner Kallweit dev_err(&pdev->dev, "failed to enable thermal clk: %d\n", ret); 56690a21ff5SHeiner Kallweit cpufreq_cooling_unregister(data->cdev); 5674d753aa7SViresh Kumar cpufreq_cpu_put(data->policy); 56890a21ff5SHeiner Kallweit return ret; 56990a21ff5SHeiner Kallweit } 57090a21ff5SHeiner Kallweit 571ca3de46bSShawn Guo data->tz = thermal_zone_device_register("imx_thermal_zone", 572017e5142SPhilipp Zabel IMX_TRIP_NUM, 573017e5142SPhilipp Zabel BIT(IMX_TRIP_PASSIVE), data, 574ca3de46bSShawn Guo &imx_tz_ops, NULL, 575ca3de46bSShawn Guo IMX_PASSIVE_DELAY, 576ca3de46bSShawn Guo IMX_POLLING_DELAY); 577ca3de46bSShawn Guo if (IS_ERR(data->tz)) { 578ca3de46bSShawn Guo ret = PTR_ERR(data->tz); 579ca3de46bSShawn Guo dev_err(&pdev->dev, 580ca3de46bSShawn Guo "failed to register thermal zone device %d\n", ret); 58190a21ff5SHeiner Kallweit clk_disable_unprepare(data->thermal_clk); 582ca3de46bSShawn Guo cpufreq_cooling_unregister(data->cdev); 5834d753aa7SViresh Kumar cpufreq_cpu_put(data->policy); 584ca3de46bSShawn Guo return ret; 585ca3de46bSShawn Guo } 586ca3de46bSShawn Guo 587a2291badSTim Harvey dev_info(&pdev->dev, "%s CPU temperature grade - max:%dC" 588a2291badSTim Harvey " critical:%dC passive:%dC\n", data->temp_grade, 589a2291badSTim Harvey data->temp_max / 1000, data->temp_critical / 1000, 590a2291badSTim Harvey data->temp_passive / 1000); 591a2291badSTim Harvey 59237713a1eSPhilipp Zabel /* Enable measurements at ~ 10 Hz */ 59337713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE1 + REG_CLR, TEMPSENSE1_MEASURE_FREQ); 59437713a1eSPhilipp Zabel measure_freq = DIV_ROUND_UP(32768, 10); /* 10 Hz */ 59537713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE1 + REG_SET, measure_freq); 59637713a1eSPhilipp Zabel imx_set_alarm_temp(data, data->temp_passive); 5973c94f17eSAnson Huang 5983c94f17eSAnson Huang if (data->socdata->version == TEMPMON_IMX6SX) 5993c94f17eSAnson Huang imx_set_panic_temp(data, data->temp_critical); 6003c94f17eSAnson Huang 60137713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 60237713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_MEASURE_TEMP); 60337713a1eSPhilipp Zabel 60484866ee5SBai Ping ret = devm_request_threaded_irq(&pdev->dev, data->irq, 60584866ee5SBai Ping imx_thermal_alarm_irq, imx_thermal_alarm_irq_thread, 60684866ee5SBai Ping 0, "imx_thermal", data); 60784866ee5SBai Ping if (ret < 0) { 60884866ee5SBai Ping dev_err(&pdev->dev, "failed to request alarm irq: %d\n", ret); 60984866ee5SBai Ping clk_disable_unprepare(data->thermal_clk); 61084866ee5SBai Ping thermal_zone_device_unregister(data->tz); 61184866ee5SBai Ping cpufreq_cooling_unregister(data->cdev); 6124d753aa7SViresh Kumar cpufreq_cpu_put(data->policy); 61384866ee5SBai Ping return ret; 61484866ee5SBai Ping } 61584866ee5SBai Ping 61637713a1eSPhilipp Zabel data->irq_enabled = true; 617ca3de46bSShawn Guo data->mode = THERMAL_DEVICE_ENABLED; 618ca3de46bSShawn Guo 619ca3de46bSShawn Guo return 0; 620ca3de46bSShawn Guo } 621ca3de46bSShawn Guo 622ca3de46bSShawn Guo static int imx_thermal_remove(struct platform_device *pdev) 623ca3de46bSShawn Guo { 624ca3de46bSShawn Guo struct imx_thermal_data *data = platform_get_drvdata(pdev); 62537713a1eSPhilipp Zabel struct regmap *map = data->tempmon; 62637713a1eSPhilipp Zabel 62737713a1eSPhilipp Zabel /* Disable measurements */ 62837713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 629329fe7b1SAnson Huang if (!IS_ERR(data->thermal_clk)) 630329fe7b1SAnson Huang clk_disable_unprepare(data->thermal_clk); 631ca3de46bSShawn Guo 632ca3de46bSShawn Guo thermal_zone_device_unregister(data->tz); 633ca3de46bSShawn Guo cpufreq_cooling_unregister(data->cdev); 6344d753aa7SViresh Kumar cpufreq_cpu_put(data->policy); 635ca3de46bSShawn Guo 636ca3de46bSShawn Guo return 0; 637ca3de46bSShawn Guo } 638ca3de46bSShawn Guo 639ca3de46bSShawn Guo #ifdef CONFIG_PM_SLEEP 640ca3de46bSShawn Guo static int imx_thermal_suspend(struct device *dev) 641ca3de46bSShawn Guo { 642ca3de46bSShawn Guo struct imx_thermal_data *data = dev_get_drvdata(dev); 643ca3de46bSShawn Guo struct regmap *map = data->tempmon; 644ca3de46bSShawn Guo 645ca3de46bSShawn Guo /* 646b46cce59SAnson Huang * Need to disable thermal sensor, otherwise, when thermal core 647b46cce59SAnson Huang * try to get temperature before thermal sensor resume, a wrong 648b46cce59SAnson Huang * temperature will be read as the thermal sensor is powered 649b46cce59SAnson Huang * down. 650ca3de46bSShawn Guo */ 651b46cce59SAnson Huang regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_MEASURE_TEMP); 652b46cce59SAnson Huang regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 653b46cce59SAnson Huang data->mode = THERMAL_DEVICE_DISABLED; 654d26eef8bSAnson Huang clk_disable_unprepare(data->thermal_clk); 655ca3de46bSShawn Guo 656ca3de46bSShawn Guo return 0; 657ca3de46bSShawn Guo } 658ca3de46bSShawn Guo 659ca3de46bSShawn Guo static int imx_thermal_resume(struct device *dev) 660ca3de46bSShawn Guo { 661b46cce59SAnson Huang struct imx_thermal_data *data = dev_get_drvdata(dev); 662b46cce59SAnson Huang struct regmap *map = data->tempmon; 663e3bdc8d7SArvind Yadav int ret; 664b46cce59SAnson Huang 665e3bdc8d7SArvind Yadav ret = clk_prepare_enable(data->thermal_clk); 666e3bdc8d7SArvind Yadav if (ret) 667e3bdc8d7SArvind Yadav return ret; 668b46cce59SAnson Huang /* Enabled thermal sensor after resume */ 669b46cce59SAnson Huang regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 670b46cce59SAnson Huang regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_MEASURE_TEMP); 671b46cce59SAnson Huang data->mode = THERMAL_DEVICE_ENABLED; 672b46cce59SAnson Huang 673ca3de46bSShawn Guo return 0; 674ca3de46bSShawn Guo } 675ca3de46bSShawn Guo #endif 676ca3de46bSShawn Guo 677ca3de46bSShawn Guo static SIMPLE_DEV_PM_OPS(imx_thermal_pm_ops, 678ca3de46bSShawn Guo imx_thermal_suspend, imx_thermal_resume); 679ca3de46bSShawn Guo 680ca3de46bSShawn Guo static struct platform_driver imx_thermal = { 681ca3de46bSShawn Guo .driver = { 682ca3de46bSShawn Guo .name = "imx_thermal", 683ca3de46bSShawn Guo .pm = &imx_thermal_pm_ops, 684ca3de46bSShawn Guo .of_match_table = of_imx_thermal_match, 685ca3de46bSShawn Guo }, 686ca3de46bSShawn Guo .probe = imx_thermal_probe, 687ca3de46bSShawn Guo .remove = imx_thermal_remove, 688ca3de46bSShawn Guo }; 689ca3de46bSShawn Guo module_platform_driver(imx_thermal); 690ca3de46bSShawn Guo 691ca3de46bSShawn Guo MODULE_AUTHOR("Freescale Semiconductor, Inc."); 692ca3de46bSShawn Guo MODULE_DESCRIPTION("Thermal driver for Freescale i.MX SoCs"); 693ca3de46bSShawn Guo MODULE_LICENSE("GPL v2"); 694ca3de46bSShawn Guo MODULE_ALIAS("platform:imx-thermal"); 695