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 58ca3de46bSShawn Guo #define OCOTP_ANA1 0x04e0 59ca3de46bSShawn Guo 60ca3de46bSShawn Guo /* The driver supports 1 passive trip point and 1 critical trip point */ 61ca3de46bSShawn Guo enum imx_thermal_trip { 62ca3de46bSShawn Guo IMX_TRIP_PASSIVE, 63ca3de46bSShawn Guo IMX_TRIP_CRITICAL, 64ca3de46bSShawn Guo IMX_TRIP_NUM, 65ca3de46bSShawn Guo }; 66ca3de46bSShawn Guo 67ca3de46bSShawn Guo /* 68ca3de46bSShawn Guo * It defines the temperature in millicelsius for passive trip point 69ca3de46bSShawn Guo * that will trigger cooling action when crossed. 70ca3de46bSShawn Guo */ 71ca3de46bSShawn Guo #define IMX_TEMP_PASSIVE 85000 72ca3de46bSShawn Guo 73ca3de46bSShawn Guo #define IMX_POLLING_DELAY 2000 /* millisecond */ 74ca3de46bSShawn Guo #define IMX_PASSIVE_DELAY 1000 75ca3de46bSShawn Guo 76749e8be7SAnson Huang #define FACTOR0 10000000 77749e8be7SAnson Huang #define FACTOR1 15976 78749e8be7SAnson Huang #define FACTOR2 4297157 79749e8be7SAnson Huang 803c94f17eSAnson Huang #define TEMPMON_IMX6Q 1 813c94f17eSAnson Huang #define TEMPMON_IMX6SX 2 823c94f17eSAnson Huang 833c94f17eSAnson Huang struct thermal_soc_data { 843c94f17eSAnson Huang u32 version; 853c94f17eSAnson Huang }; 863c94f17eSAnson Huang 873c94f17eSAnson Huang static struct thermal_soc_data thermal_imx6q_data = { 883c94f17eSAnson Huang .version = TEMPMON_IMX6Q, 893c94f17eSAnson Huang }; 903c94f17eSAnson Huang 913c94f17eSAnson Huang static struct thermal_soc_data thermal_imx6sx_data = { 923c94f17eSAnson Huang .version = TEMPMON_IMX6SX, 933c94f17eSAnson Huang }; 943c94f17eSAnson Huang 95ca3de46bSShawn Guo struct imx_thermal_data { 96ca3de46bSShawn Guo struct thermal_zone_device *tz; 97ca3de46bSShawn Guo struct thermal_cooling_device *cdev; 98ca3de46bSShawn Guo enum thermal_device_mode mode; 99ca3de46bSShawn Guo struct regmap *tempmon; 100749e8be7SAnson Huang u32 c1, c2; /* See formula in imx_get_sensor_data() */ 101017e5142SPhilipp Zabel unsigned long temp_passive; 102017e5142SPhilipp Zabel unsigned long temp_critical; 10337713a1eSPhilipp Zabel unsigned long alarm_temp; 10437713a1eSPhilipp Zabel unsigned long last_temp; 10537713a1eSPhilipp Zabel bool irq_enabled; 10637713a1eSPhilipp Zabel int irq; 107329fe7b1SAnson Huang struct clk *thermal_clk; 1083c94f17eSAnson Huang const struct thermal_soc_data *socdata; 109ca3de46bSShawn Guo }; 110ca3de46bSShawn Guo 1113c94f17eSAnson Huang static void imx_set_panic_temp(struct imx_thermal_data *data, 1123c94f17eSAnson Huang signed long panic_temp) 1133c94f17eSAnson Huang { 1143c94f17eSAnson Huang struct regmap *map = data->tempmon; 1153c94f17eSAnson Huang int critical_value; 1163c94f17eSAnson Huang 1173c94f17eSAnson Huang critical_value = (data->c2 - panic_temp) / data->c1; 1183c94f17eSAnson Huang regmap_write(map, TEMPSENSE2 + REG_CLR, TEMPSENSE2_PANIC_VALUE_MASK); 1193c94f17eSAnson Huang regmap_write(map, TEMPSENSE2 + REG_SET, critical_value << 1203c94f17eSAnson Huang TEMPSENSE2_PANIC_VALUE_SHIFT); 1213c94f17eSAnson Huang } 1223c94f17eSAnson Huang 12337713a1eSPhilipp Zabel static void imx_set_alarm_temp(struct imx_thermal_data *data, 12437713a1eSPhilipp Zabel signed long alarm_temp) 12537713a1eSPhilipp Zabel { 12637713a1eSPhilipp Zabel struct regmap *map = data->tempmon; 12737713a1eSPhilipp Zabel int alarm_value; 12837713a1eSPhilipp Zabel 12937713a1eSPhilipp Zabel data->alarm_temp = alarm_temp; 130749e8be7SAnson Huang alarm_value = (data->c2 - alarm_temp) / data->c1; 13137713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_ALARM_VALUE_MASK); 13237713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, alarm_value << 13337713a1eSPhilipp Zabel TEMPSENSE0_ALARM_VALUE_SHIFT); 13437713a1eSPhilipp Zabel } 13537713a1eSPhilipp Zabel 136ca3de46bSShawn Guo static int imx_get_temp(struct thermal_zone_device *tz, unsigned long *temp) 137ca3de46bSShawn Guo { 138ca3de46bSShawn Guo struct imx_thermal_data *data = tz->devdata; 139ca3de46bSShawn Guo struct regmap *map = data->tempmon; 140ca3de46bSShawn Guo unsigned int n_meas; 14137713a1eSPhilipp Zabel bool wait; 142ca3de46bSShawn Guo u32 val; 143ca3de46bSShawn Guo 14437713a1eSPhilipp Zabel if (data->mode == THERMAL_DEVICE_ENABLED) { 14537713a1eSPhilipp Zabel /* Check if a measurement is currently in progress */ 14637713a1eSPhilipp Zabel regmap_read(map, TEMPSENSE0, &val); 14737713a1eSPhilipp Zabel wait = !(val & TEMPSENSE0_FINISHED); 14837713a1eSPhilipp Zabel } else { 149ca3de46bSShawn Guo /* 150ca3de46bSShawn Guo * Every time we measure the temperature, we will power on the 151ca3de46bSShawn Guo * temperature sensor, enable measurements, take a reading, 152ca3de46bSShawn Guo * disable measurements, power off the temperature sensor. 153ca3de46bSShawn Guo */ 154ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 155ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_MEASURE_TEMP); 156ca3de46bSShawn Guo 15737713a1eSPhilipp Zabel wait = true; 15837713a1eSPhilipp Zabel } 15937713a1eSPhilipp Zabel 160ca3de46bSShawn Guo /* 161ca3de46bSShawn Guo * According to the temp sensor designers, it may require up to ~17us 162ca3de46bSShawn Guo * to complete a measurement. 163ca3de46bSShawn Guo */ 16437713a1eSPhilipp Zabel if (wait) 165ca3de46bSShawn Guo usleep_range(20, 50); 166ca3de46bSShawn Guo 167ca3de46bSShawn Guo regmap_read(map, TEMPSENSE0, &val); 16837713a1eSPhilipp Zabel 16937713a1eSPhilipp Zabel if (data->mode != THERMAL_DEVICE_ENABLED) { 170ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_MEASURE_TEMP); 171ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 17237713a1eSPhilipp Zabel } 173ca3de46bSShawn Guo 174ca3de46bSShawn Guo if ((val & TEMPSENSE0_FINISHED) == 0) { 175ca3de46bSShawn Guo dev_dbg(&tz->device, "temp measurement never finished\n"); 176ca3de46bSShawn Guo return -EAGAIN; 177ca3de46bSShawn Guo } 178ca3de46bSShawn Guo 179ca3de46bSShawn Guo n_meas = (val & TEMPSENSE0_TEMP_CNT_MASK) >> TEMPSENSE0_TEMP_CNT_SHIFT; 180ca3de46bSShawn Guo 181ca3de46bSShawn Guo /* See imx_get_sensor_data() for formula derivation */ 182749e8be7SAnson Huang *temp = data->c2 - n_meas * data->c1; 183ca3de46bSShawn Guo 1843c94f17eSAnson Huang /* Update alarm value to next higher trip point for TEMPMON_IMX6Q */ 1853c94f17eSAnson Huang if (data->socdata->version == TEMPMON_IMX6Q) { 1863c94f17eSAnson Huang if (data->alarm_temp == data->temp_passive && 1873c94f17eSAnson Huang *temp >= data->temp_passive) 18837713a1eSPhilipp Zabel imx_set_alarm_temp(data, data->temp_critical); 1893c94f17eSAnson Huang if (data->alarm_temp == data->temp_critical && 1903c94f17eSAnson Huang *temp < data->temp_passive) { 19137713a1eSPhilipp Zabel imx_set_alarm_temp(data, data->temp_passive); 19237713a1eSPhilipp Zabel dev_dbg(&tz->device, "thermal alarm off: T < %lu\n", 19337713a1eSPhilipp Zabel data->alarm_temp / 1000); 19437713a1eSPhilipp Zabel } 1953c94f17eSAnson Huang } 19637713a1eSPhilipp Zabel 19737713a1eSPhilipp Zabel if (*temp != data->last_temp) { 198ca3de46bSShawn Guo dev_dbg(&tz->device, "millicelsius: %ld\n", *temp); 19937713a1eSPhilipp Zabel data->last_temp = *temp; 20037713a1eSPhilipp Zabel } 20137713a1eSPhilipp Zabel 20237713a1eSPhilipp Zabel /* Reenable alarm IRQ if temperature below alarm temperature */ 20337713a1eSPhilipp Zabel if (!data->irq_enabled && *temp < data->alarm_temp) { 20437713a1eSPhilipp Zabel data->irq_enabled = true; 20537713a1eSPhilipp Zabel enable_irq(data->irq); 206ca3de46bSShawn Guo } 207ca3de46bSShawn Guo 208ca3de46bSShawn Guo return 0; 209ca3de46bSShawn Guo } 210ca3de46bSShawn Guo 211ca3de46bSShawn Guo static int imx_get_mode(struct thermal_zone_device *tz, 212ca3de46bSShawn Guo enum thermal_device_mode *mode) 213ca3de46bSShawn Guo { 214ca3de46bSShawn Guo struct imx_thermal_data *data = tz->devdata; 215ca3de46bSShawn Guo 216ca3de46bSShawn Guo *mode = data->mode; 217ca3de46bSShawn Guo 218ca3de46bSShawn Guo return 0; 219ca3de46bSShawn Guo } 220ca3de46bSShawn Guo 221ca3de46bSShawn Guo static int imx_set_mode(struct thermal_zone_device *tz, 222ca3de46bSShawn Guo enum thermal_device_mode mode) 223ca3de46bSShawn Guo { 224ca3de46bSShawn Guo struct imx_thermal_data *data = tz->devdata; 22537713a1eSPhilipp Zabel struct regmap *map = data->tempmon; 226ca3de46bSShawn Guo 227ca3de46bSShawn Guo if (mode == THERMAL_DEVICE_ENABLED) { 228ca3de46bSShawn Guo tz->polling_delay = IMX_POLLING_DELAY; 229ca3de46bSShawn Guo tz->passive_delay = IMX_PASSIVE_DELAY; 23037713a1eSPhilipp Zabel 23137713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 23237713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_MEASURE_TEMP); 23337713a1eSPhilipp Zabel 23437713a1eSPhilipp Zabel if (!data->irq_enabled) { 23537713a1eSPhilipp Zabel data->irq_enabled = true; 23637713a1eSPhilipp Zabel enable_irq(data->irq); 23737713a1eSPhilipp Zabel } 238ca3de46bSShawn Guo } else { 23937713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_MEASURE_TEMP); 24037713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 24137713a1eSPhilipp Zabel 242ca3de46bSShawn Guo tz->polling_delay = 0; 243ca3de46bSShawn Guo tz->passive_delay = 0; 24437713a1eSPhilipp Zabel 24537713a1eSPhilipp Zabel if (data->irq_enabled) { 24637713a1eSPhilipp Zabel disable_irq(data->irq); 24737713a1eSPhilipp Zabel data->irq_enabled = false; 24837713a1eSPhilipp Zabel } 249ca3de46bSShawn Guo } 250ca3de46bSShawn Guo 251ca3de46bSShawn Guo data->mode = mode; 252ca3de46bSShawn Guo thermal_zone_device_update(tz); 253ca3de46bSShawn Guo 254ca3de46bSShawn Guo return 0; 255ca3de46bSShawn Guo } 256ca3de46bSShawn Guo 257ca3de46bSShawn Guo static int imx_get_trip_type(struct thermal_zone_device *tz, int trip, 258ca3de46bSShawn Guo enum thermal_trip_type *type) 259ca3de46bSShawn Guo { 260ca3de46bSShawn Guo *type = (trip == IMX_TRIP_PASSIVE) ? THERMAL_TRIP_PASSIVE : 261ca3de46bSShawn Guo THERMAL_TRIP_CRITICAL; 262ca3de46bSShawn Guo return 0; 263ca3de46bSShawn Guo } 264ca3de46bSShawn Guo 265ca3de46bSShawn Guo static int imx_get_crit_temp(struct thermal_zone_device *tz, 266ca3de46bSShawn Guo unsigned long *temp) 267ca3de46bSShawn Guo { 268017e5142SPhilipp Zabel struct imx_thermal_data *data = tz->devdata; 269017e5142SPhilipp Zabel 270017e5142SPhilipp Zabel *temp = data->temp_critical; 271ca3de46bSShawn Guo return 0; 272ca3de46bSShawn Guo } 273ca3de46bSShawn Guo 274ca3de46bSShawn Guo static int imx_get_trip_temp(struct thermal_zone_device *tz, int trip, 275ca3de46bSShawn Guo unsigned long *temp) 276ca3de46bSShawn Guo { 277017e5142SPhilipp Zabel struct imx_thermal_data *data = tz->devdata; 278017e5142SPhilipp Zabel 279017e5142SPhilipp Zabel *temp = (trip == IMX_TRIP_PASSIVE) ? data->temp_passive : 280017e5142SPhilipp Zabel data->temp_critical; 281017e5142SPhilipp Zabel return 0; 282017e5142SPhilipp Zabel } 283017e5142SPhilipp Zabel 284017e5142SPhilipp Zabel static int imx_set_trip_temp(struct thermal_zone_device *tz, int trip, 285017e5142SPhilipp Zabel unsigned long temp) 286017e5142SPhilipp Zabel { 287017e5142SPhilipp Zabel struct imx_thermal_data *data = tz->devdata; 288017e5142SPhilipp Zabel 289017e5142SPhilipp Zabel if (trip == IMX_TRIP_CRITICAL) 290017e5142SPhilipp Zabel return -EPERM; 291017e5142SPhilipp Zabel 292017e5142SPhilipp Zabel if (temp > IMX_TEMP_PASSIVE) 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, 309ca3de46bSShawn Guo THERMAL_NO_LIMIT); 310ca3de46bSShawn Guo if (ret) { 311ca3de46bSShawn Guo dev_err(&tz->device, 312ca3de46bSShawn Guo "binding zone %s with cdev %s failed:%d\n", 313ca3de46bSShawn Guo tz->type, cdev->type, ret); 314ca3de46bSShawn Guo return ret; 315ca3de46bSShawn Guo } 316ca3de46bSShawn Guo 317ca3de46bSShawn Guo return 0; 318ca3de46bSShawn Guo } 319ca3de46bSShawn Guo 320ca3de46bSShawn Guo static int imx_unbind(struct thermal_zone_device *tz, 321ca3de46bSShawn Guo struct thermal_cooling_device *cdev) 322ca3de46bSShawn Guo { 323ca3de46bSShawn Guo int ret; 324ca3de46bSShawn Guo 325ca3de46bSShawn Guo ret = thermal_zone_unbind_cooling_device(tz, IMX_TRIP_PASSIVE, cdev); 326ca3de46bSShawn Guo if (ret) { 327ca3de46bSShawn Guo dev_err(&tz->device, 328ca3de46bSShawn Guo "unbinding zone %s with cdev %s failed:%d\n", 329ca3de46bSShawn Guo tz->type, cdev->type, ret); 330ca3de46bSShawn Guo return ret; 331ca3de46bSShawn Guo } 332ca3de46bSShawn Guo 333ca3de46bSShawn Guo return 0; 334ca3de46bSShawn Guo } 335ca3de46bSShawn Guo 336cbb07bb3SEduardo Valentin static struct thermal_zone_device_ops imx_tz_ops = { 337ca3de46bSShawn Guo .bind = imx_bind, 338ca3de46bSShawn Guo .unbind = imx_unbind, 339ca3de46bSShawn Guo .get_temp = imx_get_temp, 340ca3de46bSShawn Guo .get_mode = imx_get_mode, 341ca3de46bSShawn Guo .set_mode = imx_set_mode, 342ca3de46bSShawn Guo .get_trip_type = imx_get_trip_type, 343ca3de46bSShawn Guo .get_trip_temp = imx_get_trip_temp, 344ca3de46bSShawn Guo .get_crit_temp = imx_get_crit_temp, 345017e5142SPhilipp Zabel .set_trip_temp = imx_set_trip_temp, 346ca3de46bSShawn Guo }; 347ca3de46bSShawn Guo 348ca3de46bSShawn Guo static int imx_get_sensor_data(struct platform_device *pdev) 349ca3de46bSShawn Guo { 350ca3de46bSShawn Guo struct imx_thermal_data *data = platform_get_drvdata(pdev); 351ca3de46bSShawn Guo struct regmap *map; 352d0f9d64aSAnson Huang int t1, n1; 353ca3de46bSShawn Guo int ret; 354ca3de46bSShawn Guo u32 val; 355749e8be7SAnson Huang u64 temp64; 356ca3de46bSShawn Guo 357ca3de46bSShawn Guo map = syscon_regmap_lookup_by_phandle(pdev->dev.of_node, 358ca3de46bSShawn Guo "fsl,tempmon-data"); 359ca3de46bSShawn Guo if (IS_ERR(map)) { 360ca3de46bSShawn Guo ret = PTR_ERR(map); 361ca3de46bSShawn Guo dev_err(&pdev->dev, "failed to get sensor regmap: %d\n", ret); 362ca3de46bSShawn Guo return ret; 363ca3de46bSShawn Guo } 364ca3de46bSShawn Guo 365ca3de46bSShawn Guo ret = regmap_read(map, OCOTP_ANA1, &val); 366ca3de46bSShawn Guo if (ret) { 367ca3de46bSShawn Guo dev_err(&pdev->dev, "failed to read sensor data: %d\n", ret); 368ca3de46bSShawn Guo return ret; 369ca3de46bSShawn Guo } 370ca3de46bSShawn Guo 371ca3de46bSShawn Guo if (val == 0 || val == ~0) { 372ca3de46bSShawn Guo dev_err(&pdev->dev, "invalid sensor calibration data\n"); 373ca3de46bSShawn Guo return -EINVAL; 374ca3de46bSShawn Guo } 375ca3de46bSShawn Guo 376ca3de46bSShawn Guo /* 377ca3de46bSShawn Guo * Sensor data layout: 378ca3de46bSShawn Guo * [31:20] - sensor value @ 25C 379749e8be7SAnson Huang * Use universal formula now and only need sensor value @ 25C 380749e8be7SAnson Huang * slope = 0.4297157 - (0.0015976 * 25C fuse) 381ca3de46bSShawn Guo */ 382ca3de46bSShawn Guo n1 = val >> 20; 383ca3de46bSShawn Guo t1 = 25; /* t1 always 25C */ 384ca3de46bSShawn Guo 385ca3de46bSShawn Guo /* 386749e8be7SAnson Huang * Derived from linear interpolation: 387749e8be7SAnson Huang * slope = 0.4297157 - (0.0015976 * 25C fuse) 388749e8be7SAnson Huang * slope = (FACTOR2 - FACTOR1 * n1) / FACTOR0 389749e8be7SAnson Huang * (Nmeas - n1) / (Tmeas - t1) = slope 390ca3de46bSShawn Guo * We want to reduce this down to the minimum computation necessary 391ca3de46bSShawn Guo * for each temperature read. Also, we want Tmeas in millicelsius 392ca3de46bSShawn Guo * and we don't want to lose precision from integer division. So... 393749e8be7SAnson Huang * Tmeas = (Nmeas - n1) / slope + t1 394749e8be7SAnson Huang * milli_Tmeas = 1000 * (Nmeas - n1) / slope + 1000 * t1 395749e8be7SAnson Huang * milli_Tmeas = -1000 * (n1 - Nmeas) / slope + 1000 * t1 396749e8be7SAnson Huang * Let constant c1 = (-1000 / slope) 397749e8be7SAnson Huang * milli_Tmeas = (n1 - Nmeas) * c1 + 1000 * t1 398749e8be7SAnson Huang * Let constant c2 = n1 *c1 + 1000 * t1 399749e8be7SAnson Huang * milli_Tmeas = c2 - Nmeas * c1 400ca3de46bSShawn Guo */ 401749e8be7SAnson Huang temp64 = FACTOR0; 402749e8be7SAnson Huang temp64 *= 1000; 403749e8be7SAnson Huang do_div(temp64, FACTOR1 * n1 - FACTOR2); 404749e8be7SAnson Huang data->c1 = temp64; 405749e8be7SAnson Huang data->c2 = n1 * data->c1 + 1000 * t1; 406ca3de46bSShawn Guo 407017e5142SPhilipp Zabel /* 408d0f9d64aSAnson Huang * Set the default passive cooling trip point, 409d0f9d64aSAnson Huang * can be changed from userspace. 410017e5142SPhilipp Zabel */ 411d0f9d64aSAnson Huang data->temp_passive = IMX_TEMP_PASSIVE; 412017e5142SPhilipp Zabel 413017e5142SPhilipp Zabel /* 414d0f9d64aSAnson Huang * The maximum die temperature set to 20 C higher than 415d0f9d64aSAnson Huang * IMX_TEMP_PASSIVE. 416017e5142SPhilipp Zabel */ 417d0f9d64aSAnson Huang data->temp_critical = 1000 * 20 + data->temp_passive; 418017e5142SPhilipp Zabel 419ca3de46bSShawn Guo return 0; 420ca3de46bSShawn Guo } 421ca3de46bSShawn Guo 42237713a1eSPhilipp Zabel static irqreturn_t imx_thermal_alarm_irq(int irq, void *dev) 42337713a1eSPhilipp Zabel { 42437713a1eSPhilipp Zabel struct imx_thermal_data *data = dev; 42537713a1eSPhilipp Zabel 42637713a1eSPhilipp Zabel disable_irq_nosync(irq); 42737713a1eSPhilipp Zabel data->irq_enabled = false; 42837713a1eSPhilipp Zabel 42937713a1eSPhilipp Zabel return IRQ_WAKE_THREAD; 43037713a1eSPhilipp Zabel } 43137713a1eSPhilipp Zabel 43237713a1eSPhilipp Zabel static irqreturn_t imx_thermal_alarm_irq_thread(int irq, void *dev) 43337713a1eSPhilipp Zabel { 43437713a1eSPhilipp Zabel struct imx_thermal_data *data = dev; 43537713a1eSPhilipp Zabel 43637713a1eSPhilipp Zabel dev_dbg(&data->tz->device, "THERMAL ALARM: T > %lu\n", 43737713a1eSPhilipp Zabel data->alarm_temp / 1000); 43837713a1eSPhilipp Zabel 43937713a1eSPhilipp Zabel thermal_zone_device_update(data->tz); 44037713a1eSPhilipp Zabel 44137713a1eSPhilipp Zabel return IRQ_HANDLED; 44237713a1eSPhilipp Zabel } 44337713a1eSPhilipp Zabel 4443c94f17eSAnson Huang static const struct of_device_id of_imx_thermal_match[] = { 4453c94f17eSAnson Huang { .compatible = "fsl,imx6q-tempmon", .data = &thermal_imx6q_data, }, 4463c94f17eSAnson Huang { .compatible = "fsl,imx6sx-tempmon", .data = &thermal_imx6sx_data, }, 4473c94f17eSAnson Huang { /* end */ } 4483c94f17eSAnson Huang }; 4493c94f17eSAnson Huang MODULE_DEVICE_TABLE(of, of_imx_thermal_match); 4503c94f17eSAnson Huang 451ca3de46bSShawn Guo static int imx_thermal_probe(struct platform_device *pdev) 452ca3de46bSShawn Guo { 4533c94f17eSAnson Huang const struct of_device_id *of_id = 4543c94f17eSAnson Huang of_match_device(of_imx_thermal_match, &pdev->dev); 455ca3de46bSShawn Guo struct imx_thermal_data *data; 456ca3de46bSShawn Guo struct regmap *map; 45737713a1eSPhilipp Zabel int measure_freq; 458ca3de46bSShawn Guo int ret; 459ca3de46bSShawn Guo 460ca3de46bSShawn Guo data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL); 461ca3de46bSShawn Guo if (!data) 462ca3de46bSShawn Guo return -ENOMEM; 463ca3de46bSShawn Guo 464ca3de46bSShawn Guo map = syscon_regmap_lookup_by_phandle(pdev->dev.of_node, "fsl,tempmon"); 465ca3de46bSShawn Guo if (IS_ERR(map)) { 466ca3de46bSShawn Guo ret = PTR_ERR(map); 467ca3de46bSShawn Guo dev_err(&pdev->dev, "failed to get tempmon regmap: %d\n", ret); 468ca3de46bSShawn Guo return ret; 469ca3de46bSShawn Guo } 470ca3de46bSShawn Guo data->tempmon = map; 471ca3de46bSShawn Guo 4723c94f17eSAnson Huang data->socdata = of_id->data; 4733c94f17eSAnson Huang 4743c94f17eSAnson Huang /* make sure the IRQ flag is clear before enabling irq on i.MX6SX */ 4753c94f17eSAnson Huang if (data->socdata->version == TEMPMON_IMX6SX) { 4763c94f17eSAnson Huang regmap_write(map, MISC1 + REG_CLR, MISC1_IRQ_TEMPHIGH | 4773c94f17eSAnson Huang MISC1_IRQ_TEMPLOW | MISC1_IRQ_TEMPPANIC); 4783c94f17eSAnson Huang /* 4793c94f17eSAnson Huang * reset value of LOW ALARM is incorrect, set it to lowest 4803c94f17eSAnson Huang * value to avoid false trigger of low alarm. 4813c94f17eSAnson Huang */ 4823c94f17eSAnson Huang regmap_write(map, TEMPSENSE2 + REG_SET, 4833c94f17eSAnson Huang TEMPSENSE2_LOW_VALUE_MASK); 4843c94f17eSAnson Huang } 4853c94f17eSAnson Huang 48637713a1eSPhilipp Zabel data->irq = platform_get_irq(pdev, 0); 48737713a1eSPhilipp Zabel if (data->irq < 0) 48837713a1eSPhilipp Zabel return data->irq; 48937713a1eSPhilipp Zabel 49037713a1eSPhilipp Zabel ret = devm_request_threaded_irq(&pdev->dev, data->irq, 49137713a1eSPhilipp Zabel imx_thermal_alarm_irq, imx_thermal_alarm_irq_thread, 49237713a1eSPhilipp Zabel 0, "imx_thermal", data); 49337713a1eSPhilipp Zabel if (ret < 0) { 49437713a1eSPhilipp Zabel dev_err(&pdev->dev, "failed to request alarm irq: %d\n", ret); 49537713a1eSPhilipp Zabel return ret; 49637713a1eSPhilipp Zabel } 49737713a1eSPhilipp Zabel 498ca3de46bSShawn Guo platform_set_drvdata(pdev, data); 499ca3de46bSShawn Guo 500ca3de46bSShawn Guo ret = imx_get_sensor_data(pdev); 501ca3de46bSShawn Guo if (ret) { 502ca3de46bSShawn Guo dev_err(&pdev->dev, "failed to get sensor data\n"); 503ca3de46bSShawn Guo return ret; 504ca3de46bSShawn Guo } 505ca3de46bSShawn Guo 506ca3de46bSShawn Guo /* Make sure sensor is in known good state for measurements */ 507ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 508ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_MEASURE_TEMP); 509ca3de46bSShawn Guo regmap_write(map, TEMPSENSE1 + REG_CLR, TEMPSENSE1_MEASURE_FREQ); 510ca3de46bSShawn Guo regmap_write(map, MISC0 + REG_SET, MISC0_REFTOP_SELBIASOFF); 511ca3de46bSShawn Guo regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 512ca3de46bSShawn Guo 513bec85d2eSViresh Kumar data->cdev = cpufreq_cooling_register(cpu_present_mask); 514ca3de46bSShawn Guo if (IS_ERR(data->cdev)) { 515ca3de46bSShawn Guo ret = PTR_ERR(data->cdev); 516ca3de46bSShawn Guo dev_err(&pdev->dev, 517ca3de46bSShawn Guo "failed to register cpufreq cooling device: %d\n", ret); 518ca3de46bSShawn Guo return ret; 519ca3de46bSShawn Guo } 520ca3de46bSShawn Guo 52190a21ff5SHeiner Kallweit data->thermal_clk = devm_clk_get(&pdev->dev, NULL); 52290a21ff5SHeiner Kallweit if (IS_ERR(data->thermal_clk)) { 52390a21ff5SHeiner Kallweit ret = PTR_ERR(data->thermal_clk); 52490a21ff5SHeiner Kallweit if (ret != -EPROBE_DEFER) 52590a21ff5SHeiner Kallweit dev_err(&pdev->dev, 52690a21ff5SHeiner Kallweit "failed to get thermal clk: %d\n", ret); 52790a21ff5SHeiner Kallweit cpufreq_cooling_unregister(data->cdev); 52890a21ff5SHeiner Kallweit return ret; 52990a21ff5SHeiner Kallweit } 53090a21ff5SHeiner Kallweit 53190a21ff5SHeiner Kallweit /* 53290a21ff5SHeiner Kallweit * Thermal sensor needs clk on to get correct value, normally 53390a21ff5SHeiner Kallweit * we should enable its clk before taking measurement and disable 53490a21ff5SHeiner Kallweit * clk after measurement is done, but if alarm function is enabled, 53590a21ff5SHeiner Kallweit * hardware will auto measure the temperature periodically, so we 53690a21ff5SHeiner Kallweit * need to keep the clk always on for alarm function. 53790a21ff5SHeiner Kallweit */ 53890a21ff5SHeiner Kallweit ret = clk_prepare_enable(data->thermal_clk); 53990a21ff5SHeiner Kallweit if (ret) { 54090a21ff5SHeiner Kallweit dev_err(&pdev->dev, "failed to enable thermal clk: %d\n", ret); 54190a21ff5SHeiner Kallweit cpufreq_cooling_unregister(data->cdev); 54290a21ff5SHeiner Kallweit return ret; 54390a21ff5SHeiner Kallweit } 54490a21ff5SHeiner Kallweit 545ca3de46bSShawn Guo data->tz = thermal_zone_device_register("imx_thermal_zone", 546017e5142SPhilipp Zabel IMX_TRIP_NUM, 547017e5142SPhilipp Zabel BIT(IMX_TRIP_PASSIVE), data, 548ca3de46bSShawn Guo &imx_tz_ops, NULL, 549ca3de46bSShawn Guo IMX_PASSIVE_DELAY, 550ca3de46bSShawn Guo IMX_POLLING_DELAY); 551ca3de46bSShawn Guo if (IS_ERR(data->tz)) { 552ca3de46bSShawn Guo ret = PTR_ERR(data->tz); 553ca3de46bSShawn Guo dev_err(&pdev->dev, 554ca3de46bSShawn Guo "failed to register thermal zone device %d\n", ret); 55590a21ff5SHeiner Kallweit clk_disable_unprepare(data->thermal_clk); 556ca3de46bSShawn Guo cpufreq_cooling_unregister(data->cdev); 557ca3de46bSShawn Guo return ret; 558ca3de46bSShawn Guo } 559ca3de46bSShawn Guo 56037713a1eSPhilipp Zabel /* Enable measurements at ~ 10 Hz */ 56137713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE1 + REG_CLR, TEMPSENSE1_MEASURE_FREQ); 56237713a1eSPhilipp Zabel measure_freq = DIV_ROUND_UP(32768, 10); /* 10 Hz */ 56337713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE1 + REG_SET, measure_freq); 56437713a1eSPhilipp Zabel imx_set_alarm_temp(data, data->temp_passive); 5653c94f17eSAnson Huang 5663c94f17eSAnson Huang if (data->socdata->version == TEMPMON_IMX6SX) 5673c94f17eSAnson Huang imx_set_panic_temp(data, data->temp_critical); 5683c94f17eSAnson Huang 56937713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 57037713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_MEASURE_TEMP); 57137713a1eSPhilipp Zabel 57237713a1eSPhilipp Zabel data->irq_enabled = true; 573ca3de46bSShawn Guo data->mode = THERMAL_DEVICE_ENABLED; 574ca3de46bSShawn Guo 575ca3de46bSShawn Guo return 0; 576ca3de46bSShawn Guo } 577ca3de46bSShawn Guo 578ca3de46bSShawn Guo static int imx_thermal_remove(struct platform_device *pdev) 579ca3de46bSShawn Guo { 580ca3de46bSShawn Guo struct imx_thermal_data *data = platform_get_drvdata(pdev); 58137713a1eSPhilipp Zabel struct regmap *map = data->tempmon; 58237713a1eSPhilipp Zabel 58337713a1eSPhilipp Zabel /* Disable measurements */ 58437713a1eSPhilipp Zabel regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 585329fe7b1SAnson Huang if (!IS_ERR(data->thermal_clk)) 586329fe7b1SAnson Huang clk_disable_unprepare(data->thermal_clk); 587ca3de46bSShawn Guo 588ca3de46bSShawn Guo thermal_zone_device_unregister(data->tz); 589ca3de46bSShawn Guo cpufreq_cooling_unregister(data->cdev); 590ca3de46bSShawn Guo 591ca3de46bSShawn Guo return 0; 592ca3de46bSShawn Guo } 593ca3de46bSShawn Guo 594ca3de46bSShawn Guo #ifdef CONFIG_PM_SLEEP 595ca3de46bSShawn Guo static int imx_thermal_suspend(struct device *dev) 596ca3de46bSShawn Guo { 597ca3de46bSShawn Guo struct imx_thermal_data *data = dev_get_drvdata(dev); 598ca3de46bSShawn Guo struct regmap *map = data->tempmon; 599ca3de46bSShawn Guo 600ca3de46bSShawn Guo /* 601b46cce59SAnson Huang * Need to disable thermal sensor, otherwise, when thermal core 602b46cce59SAnson Huang * try to get temperature before thermal sensor resume, a wrong 603b46cce59SAnson Huang * temperature will be read as the thermal sensor is powered 604b46cce59SAnson Huang * down. 605ca3de46bSShawn Guo */ 606b46cce59SAnson Huang regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_MEASURE_TEMP); 607b46cce59SAnson Huang regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_POWER_DOWN); 608b46cce59SAnson Huang data->mode = THERMAL_DEVICE_DISABLED; 609ca3de46bSShawn Guo 610ca3de46bSShawn Guo return 0; 611ca3de46bSShawn Guo } 612ca3de46bSShawn Guo 613ca3de46bSShawn Guo static int imx_thermal_resume(struct device *dev) 614ca3de46bSShawn Guo { 615b46cce59SAnson Huang struct imx_thermal_data *data = dev_get_drvdata(dev); 616b46cce59SAnson Huang struct regmap *map = data->tempmon; 617b46cce59SAnson Huang 618b46cce59SAnson Huang /* Enabled thermal sensor after resume */ 619b46cce59SAnson Huang regmap_write(map, TEMPSENSE0 + REG_CLR, TEMPSENSE0_POWER_DOWN); 620b46cce59SAnson Huang regmap_write(map, TEMPSENSE0 + REG_SET, TEMPSENSE0_MEASURE_TEMP); 621b46cce59SAnson Huang data->mode = THERMAL_DEVICE_ENABLED; 622b46cce59SAnson Huang 623ca3de46bSShawn Guo return 0; 624ca3de46bSShawn Guo } 625ca3de46bSShawn Guo #endif 626ca3de46bSShawn Guo 627ca3de46bSShawn Guo static SIMPLE_DEV_PM_OPS(imx_thermal_pm_ops, 628ca3de46bSShawn Guo imx_thermal_suspend, imx_thermal_resume); 629ca3de46bSShawn Guo 630ca3de46bSShawn Guo static struct platform_driver imx_thermal = { 631ca3de46bSShawn Guo .driver = { 632ca3de46bSShawn Guo .name = "imx_thermal", 633ca3de46bSShawn Guo .owner = THIS_MODULE, 634ca3de46bSShawn Guo .pm = &imx_thermal_pm_ops, 635ca3de46bSShawn Guo .of_match_table = of_imx_thermal_match, 636ca3de46bSShawn Guo }, 637ca3de46bSShawn Guo .probe = imx_thermal_probe, 638ca3de46bSShawn Guo .remove = imx_thermal_remove, 639ca3de46bSShawn Guo }; 640ca3de46bSShawn Guo module_platform_driver(imx_thermal); 641ca3de46bSShawn Guo 642ca3de46bSShawn Guo MODULE_AUTHOR("Freescale Semiconductor, Inc."); 643ca3de46bSShawn Guo MODULE_DESCRIPTION("Thermal driver for Freescale i.MX SoCs"); 644ca3de46bSShawn Guo MODULE_LICENSE("GPL v2"); 645ca3de46bSShawn Guo MODULE_ALIAS("platform:imx-thermal"); 646