12d71d8deSAmit Kucheria // SPDX-License-Identifier: GPL-2.0 29066073cSRajendra Nayak /* 39066073cSRajendra Nayak * Copyright (c) 2015, The Linux Foundation. All rights reserved. 4a7ff8297SAmit Kucheria * Copyright (c) 2019, 2020, Linaro Ltd. 59066073cSRajendra Nayak */ 69066073cSRajendra Nayak 77c938f48SAmit Kucheria #include <linux/debugfs.h> 89066073cSRajendra Nayak #include <linux/err.h> 9a7ff8297SAmit Kucheria #include <linux/io.h> 109066073cSRajendra Nayak #include <linux/module.h> 11a7ff8297SAmit Kucheria #include <linux/nvmem-consumer.h> 129066073cSRajendra Nayak #include <linux/of.h> 13a7ff8297SAmit Kucheria #include <linux/of_address.h> 14634e11d5SAmit Kucheria #include <linux/of_platform.h> 1553e2a20eSAnsuel Smith #include <linux/mfd/syscon.h> 169066073cSRajendra Nayak #include <linux/platform_device.h> 179066073cSRajendra Nayak #include <linux/pm.h> 18a7ff8297SAmit Kucheria #include <linux/regmap.h> 199066073cSRajendra Nayak #include <linux/slab.h> 209066073cSRajendra Nayak #include <linux/thermal.h> 218556e19dSDmitry Baryshkov #include "../thermal_hwmon.h" 229066073cSRajendra Nayak #include "tsens.h" 239066073cSRajendra Nayak 24a7ff8297SAmit Kucheria /** 25a7ff8297SAmit Kucheria * struct tsens_irq_data - IRQ status and temperature violations 26a7ff8297SAmit Kucheria * @up_viol: upper threshold violated 27a7ff8297SAmit Kucheria * @up_thresh: upper threshold temperature value 28a7ff8297SAmit Kucheria * @up_irq_mask: mask register for upper threshold irqs 29a7ff8297SAmit Kucheria * @up_irq_clear: clear register for uppper threshold irqs 30a7ff8297SAmit Kucheria * @low_viol: lower threshold violated 31a7ff8297SAmit Kucheria * @low_thresh: lower threshold temperature value 32a7ff8297SAmit Kucheria * @low_irq_mask: mask register for lower threshold irqs 33a7ff8297SAmit Kucheria * @low_irq_clear: clear register for lower threshold irqs 34a7ff8297SAmit Kucheria * @crit_viol: critical threshold violated 35a7ff8297SAmit Kucheria * @crit_thresh: critical threshold temperature value 36a7ff8297SAmit Kucheria * @crit_irq_mask: mask register for critical threshold irqs 37a7ff8297SAmit Kucheria * @crit_irq_clear: clear register for critical threshold irqs 38a7ff8297SAmit Kucheria * 39a7ff8297SAmit Kucheria * Structure containing data about temperature threshold settings and 40a7ff8297SAmit Kucheria * irq status if they were violated. 41a7ff8297SAmit Kucheria */ 42a7ff8297SAmit Kucheria struct tsens_irq_data { 43a7ff8297SAmit Kucheria u32 up_viol; 44a7ff8297SAmit Kucheria int up_thresh; 45a7ff8297SAmit Kucheria u32 up_irq_mask; 46a7ff8297SAmit Kucheria u32 up_irq_clear; 47a7ff8297SAmit Kucheria u32 low_viol; 48a7ff8297SAmit Kucheria int low_thresh; 49a7ff8297SAmit Kucheria u32 low_irq_mask; 50a7ff8297SAmit Kucheria u32 low_irq_clear; 51a7ff8297SAmit Kucheria u32 crit_viol; 52a7ff8297SAmit Kucheria u32 crit_thresh; 53a7ff8297SAmit Kucheria u32 crit_irq_mask; 54a7ff8297SAmit Kucheria u32 crit_irq_clear; 55a7ff8297SAmit Kucheria }; 56a7ff8297SAmit Kucheria 57a7ff8297SAmit Kucheria char *qfprom_read(struct device *dev, const char *cname) 58a7ff8297SAmit Kucheria { 59a7ff8297SAmit Kucheria struct nvmem_cell *cell; 60a7ff8297SAmit Kucheria ssize_t data; 61a7ff8297SAmit Kucheria char *ret; 62a7ff8297SAmit Kucheria 63a7ff8297SAmit Kucheria cell = nvmem_cell_get(dev, cname); 64a7ff8297SAmit Kucheria if (IS_ERR(cell)) 65a7ff8297SAmit Kucheria return ERR_CAST(cell); 66a7ff8297SAmit Kucheria 67a7ff8297SAmit Kucheria ret = nvmem_cell_read(cell, &data); 68a7ff8297SAmit Kucheria nvmem_cell_put(cell); 69a7ff8297SAmit Kucheria 70a7ff8297SAmit Kucheria return ret; 71a7ff8297SAmit Kucheria } 72a7ff8297SAmit Kucheria 73a7ff8297SAmit Kucheria /* 74a7ff8297SAmit Kucheria * Use this function on devices where slope and offset calculations 75a7ff8297SAmit Kucheria * depend on calibration data read from qfprom. On others the slope 76a7ff8297SAmit Kucheria * and offset values are derived from tz->tzp->slope and tz->tzp->offset 77a7ff8297SAmit Kucheria * resp. 78a7ff8297SAmit Kucheria */ 79a7ff8297SAmit Kucheria void compute_intercept_slope(struct tsens_priv *priv, u32 *p1, 80a7ff8297SAmit Kucheria u32 *p2, u32 mode) 81a7ff8297SAmit Kucheria { 82a7ff8297SAmit Kucheria int i; 83a7ff8297SAmit Kucheria int num, den; 84a7ff8297SAmit Kucheria 85a7ff8297SAmit Kucheria for (i = 0; i < priv->num_sensors; i++) { 86a7ff8297SAmit Kucheria dev_dbg(priv->dev, 87a7ff8297SAmit Kucheria "%s: sensor%d - data_point1:%#x data_point2:%#x\n", 88a7ff8297SAmit Kucheria __func__, i, p1[i], p2[i]); 89a7ff8297SAmit Kucheria 909d51769bSAnsuel Smith if (!priv->sensor[i].slope) 91a7ff8297SAmit Kucheria priv->sensor[i].slope = SLOPE_DEFAULT; 92a7ff8297SAmit Kucheria if (mode == TWO_PT_CALIB) { 93a7ff8297SAmit Kucheria /* 94a7ff8297SAmit Kucheria * slope (m) = adc_code2 - adc_code1 (y2 - y1)/ 95a7ff8297SAmit Kucheria * temp_120_degc - temp_30_degc (x2 - x1) 96a7ff8297SAmit Kucheria */ 97a7ff8297SAmit Kucheria num = p2[i] - p1[i]; 98a7ff8297SAmit Kucheria num *= SLOPE_FACTOR; 99a7ff8297SAmit Kucheria den = CAL_DEGC_PT2 - CAL_DEGC_PT1; 100a7ff8297SAmit Kucheria priv->sensor[i].slope = num / den; 101a7ff8297SAmit Kucheria } 102a7ff8297SAmit Kucheria 103a7ff8297SAmit Kucheria priv->sensor[i].offset = (p1[i] * SLOPE_FACTOR) - 104a7ff8297SAmit Kucheria (CAL_DEGC_PT1 * 105a7ff8297SAmit Kucheria priv->sensor[i].slope); 106a7ff8297SAmit Kucheria dev_dbg(priv->dev, "%s: offset:%d\n", __func__, 107a7ff8297SAmit Kucheria priv->sensor[i].offset); 108a7ff8297SAmit Kucheria } 109a7ff8297SAmit Kucheria } 110a7ff8297SAmit Kucheria 111a7ff8297SAmit Kucheria static inline u32 degc_to_code(int degc, const struct tsens_sensor *s) 112a7ff8297SAmit Kucheria { 113a7ff8297SAmit Kucheria u64 code = div_u64(((u64)degc * s->slope + s->offset), SLOPE_FACTOR); 114a7ff8297SAmit Kucheria 115a7ff8297SAmit Kucheria pr_debug("%s: raw_code: 0x%llx, degc:%d\n", __func__, code, degc); 116a7ff8297SAmit Kucheria return clamp_val(code, THRESHOLD_MIN_ADC_CODE, THRESHOLD_MAX_ADC_CODE); 117a7ff8297SAmit Kucheria } 118a7ff8297SAmit Kucheria 119a7ff8297SAmit Kucheria static inline int code_to_degc(u32 adc_code, const struct tsens_sensor *s) 120a7ff8297SAmit Kucheria { 121a7ff8297SAmit Kucheria int degc, num, den; 122a7ff8297SAmit Kucheria 123a7ff8297SAmit Kucheria num = (adc_code * SLOPE_FACTOR) - s->offset; 124a7ff8297SAmit Kucheria den = s->slope; 125a7ff8297SAmit Kucheria 126a7ff8297SAmit Kucheria if (num > 0) 127a7ff8297SAmit Kucheria degc = num + (den / 2); 128a7ff8297SAmit Kucheria else if (num < 0) 129a7ff8297SAmit Kucheria degc = num - (den / 2); 130a7ff8297SAmit Kucheria else 131a7ff8297SAmit Kucheria degc = num; 132a7ff8297SAmit Kucheria 133a7ff8297SAmit Kucheria degc /= den; 134a7ff8297SAmit Kucheria 135a7ff8297SAmit Kucheria return degc; 136a7ff8297SAmit Kucheria } 137a7ff8297SAmit Kucheria 138a7ff8297SAmit Kucheria /** 139a7ff8297SAmit Kucheria * tsens_hw_to_mC - Return sign-extended temperature in mCelsius. 140a7ff8297SAmit Kucheria * @s: Pointer to sensor struct 141a7ff8297SAmit Kucheria * @field: Index into regmap_field array pointing to temperature data 142a7ff8297SAmit Kucheria * 143a7ff8297SAmit Kucheria * This function handles temperature returned in ADC code or deciCelsius 144a7ff8297SAmit Kucheria * depending on IP version. 145a7ff8297SAmit Kucheria * 146a7ff8297SAmit Kucheria * Return: Temperature in milliCelsius on success, a negative errno will 147a7ff8297SAmit Kucheria * be returned in error cases 148a7ff8297SAmit Kucheria */ 149a7ff8297SAmit Kucheria static int tsens_hw_to_mC(const struct tsens_sensor *s, int field) 150a7ff8297SAmit Kucheria { 151a7ff8297SAmit Kucheria struct tsens_priv *priv = s->priv; 152a7ff8297SAmit Kucheria u32 resolution; 153a7ff8297SAmit Kucheria u32 temp = 0; 154a7ff8297SAmit Kucheria int ret; 155a7ff8297SAmit Kucheria 156a7ff8297SAmit Kucheria resolution = priv->fields[LAST_TEMP_0].msb - 157a7ff8297SAmit Kucheria priv->fields[LAST_TEMP_0].lsb; 158a7ff8297SAmit Kucheria 159a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[field], &temp); 160a7ff8297SAmit Kucheria if (ret) 161a7ff8297SAmit Kucheria return ret; 162a7ff8297SAmit Kucheria 163a7ff8297SAmit Kucheria /* Convert temperature from ADC code to milliCelsius */ 164a7ff8297SAmit Kucheria if (priv->feat->adc) 165a7ff8297SAmit Kucheria return code_to_degc(temp, s) * 1000; 166a7ff8297SAmit Kucheria 167a7ff8297SAmit Kucheria /* deciCelsius -> milliCelsius along with sign extension */ 168a7ff8297SAmit Kucheria return sign_extend32(temp, resolution) * 100; 169a7ff8297SAmit Kucheria } 170a7ff8297SAmit Kucheria 171a7ff8297SAmit Kucheria /** 172a7ff8297SAmit Kucheria * tsens_mC_to_hw - Convert temperature to hardware register value 173a7ff8297SAmit Kucheria * @s: Pointer to sensor struct 174a7ff8297SAmit Kucheria * @temp: temperature in milliCelsius to be programmed to hardware 175a7ff8297SAmit Kucheria * 176a7ff8297SAmit Kucheria * This function outputs the value to be written to hardware in ADC code 177a7ff8297SAmit Kucheria * or deciCelsius depending on IP version. 178a7ff8297SAmit Kucheria * 179a7ff8297SAmit Kucheria * Return: ADC code or temperature in deciCelsius. 180a7ff8297SAmit Kucheria */ 181a7ff8297SAmit Kucheria static int tsens_mC_to_hw(const struct tsens_sensor *s, int temp) 182a7ff8297SAmit Kucheria { 183a7ff8297SAmit Kucheria struct tsens_priv *priv = s->priv; 184a7ff8297SAmit Kucheria 185a7ff8297SAmit Kucheria /* milliC to adc code */ 186a7ff8297SAmit Kucheria if (priv->feat->adc) 187a7ff8297SAmit Kucheria return degc_to_code(temp / 1000, s); 188a7ff8297SAmit Kucheria 189a7ff8297SAmit Kucheria /* milliC to deciC */ 190a7ff8297SAmit Kucheria return temp / 100; 191a7ff8297SAmit Kucheria } 192a7ff8297SAmit Kucheria 193a7ff8297SAmit Kucheria static inline enum tsens_ver tsens_version(struct tsens_priv *priv) 194a7ff8297SAmit Kucheria { 195a7ff8297SAmit Kucheria return priv->feat->ver_major; 196a7ff8297SAmit Kucheria } 197a7ff8297SAmit Kucheria 198a7ff8297SAmit Kucheria static void tsens_set_interrupt_v1(struct tsens_priv *priv, u32 hw_id, 199a7ff8297SAmit Kucheria enum tsens_irq_type irq_type, bool enable) 200a7ff8297SAmit Kucheria { 201a7ff8297SAmit Kucheria u32 index = 0; 202a7ff8297SAmit Kucheria 203a7ff8297SAmit Kucheria switch (irq_type) { 204a7ff8297SAmit Kucheria case UPPER: 205a7ff8297SAmit Kucheria index = UP_INT_CLEAR_0 + hw_id; 206a7ff8297SAmit Kucheria break; 207a7ff8297SAmit Kucheria case LOWER: 208a7ff8297SAmit Kucheria index = LOW_INT_CLEAR_0 + hw_id; 209a7ff8297SAmit Kucheria break; 210a7ff8297SAmit Kucheria case CRITICAL: 211a7ff8297SAmit Kucheria /* No critical interrupts before v2 */ 212a7ff8297SAmit Kucheria return; 213a7ff8297SAmit Kucheria } 214a7ff8297SAmit Kucheria regmap_field_write(priv->rf[index], enable ? 0 : 1); 215a7ff8297SAmit Kucheria } 216a7ff8297SAmit Kucheria 217a7ff8297SAmit Kucheria static void tsens_set_interrupt_v2(struct tsens_priv *priv, u32 hw_id, 218a7ff8297SAmit Kucheria enum tsens_irq_type irq_type, bool enable) 219a7ff8297SAmit Kucheria { 220a7ff8297SAmit Kucheria u32 index_mask = 0, index_clear = 0; 221a7ff8297SAmit Kucheria 222a7ff8297SAmit Kucheria /* 223a7ff8297SAmit Kucheria * To enable the interrupt flag for a sensor: 224a7ff8297SAmit Kucheria * - clear the mask bit 225a7ff8297SAmit Kucheria * To disable the interrupt flag for a sensor: 226a7ff8297SAmit Kucheria * - Mask further interrupts for this sensor 227a7ff8297SAmit Kucheria * - Write 1 followed by 0 to clear the interrupt 228a7ff8297SAmit Kucheria */ 229a7ff8297SAmit Kucheria switch (irq_type) { 230a7ff8297SAmit Kucheria case UPPER: 231a7ff8297SAmit Kucheria index_mask = UP_INT_MASK_0 + hw_id; 232a7ff8297SAmit Kucheria index_clear = UP_INT_CLEAR_0 + hw_id; 233a7ff8297SAmit Kucheria break; 234a7ff8297SAmit Kucheria case LOWER: 235a7ff8297SAmit Kucheria index_mask = LOW_INT_MASK_0 + hw_id; 236a7ff8297SAmit Kucheria index_clear = LOW_INT_CLEAR_0 + hw_id; 237a7ff8297SAmit Kucheria break; 238a7ff8297SAmit Kucheria case CRITICAL: 239a7ff8297SAmit Kucheria index_mask = CRIT_INT_MASK_0 + hw_id; 240a7ff8297SAmit Kucheria index_clear = CRIT_INT_CLEAR_0 + hw_id; 241a7ff8297SAmit Kucheria break; 242a7ff8297SAmit Kucheria } 243a7ff8297SAmit Kucheria 244a7ff8297SAmit Kucheria if (enable) { 245a7ff8297SAmit Kucheria regmap_field_write(priv->rf[index_mask], 0); 246a7ff8297SAmit Kucheria } else { 247a7ff8297SAmit Kucheria regmap_field_write(priv->rf[index_mask], 1); 248a7ff8297SAmit Kucheria regmap_field_write(priv->rf[index_clear], 1); 249a7ff8297SAmit Kucheria regmap_field_write(priv->rf[index_clear], 0); 250a7ff8297SAmit Kucheria } 251a7ff8297SAmit Kucheria } 252a7ff8297SAmit Kucheria 253a7ff8297SAmit Kucheria /** 254a7ff8297SAmit Kucheria * tsens_set_interrupt - Set state of an interrupt 255a7ff8297SAmit Kucheria * @priv: Pointer to tsens controller private data 256a7ff8297SAmit Kucheria * @hw_id: Hardware ID aka. sensor number 257a7ff8297SAmit Kucheria * @irq_type: irq_type from enum tsens_irq_type 258a7ff8297SAmit Kucheria * @enable: false = disable, true = enable 259a7ff8297SAmit Kucheria * 260a7ff8297SAmit Kucheria * Call IP-specific function to set state of an interrupt 261a7ff8297SAmit Kucheria * 262a7ff8297SAmit Kucheria * Return: void 263a7ff8297SAmit Kucheria */ 264a7ff8297SAmit Kucheria static void tsens_set_interrupt(struct tsens_priv *priv, u32 hw_id, 265a7ff8297SAmit Kucheria enum tsens_irq_type irq_type, bool enable) 266a7ff8297SAmit Kucheria { 267a7ff8297SAmit Kucheria dev_dbg(priv->dev, "[%u] %s: %s -> %s\n", hw_id, __func__, 268a7ff8297SAmit Kucheria irq_type ? ((irq_type == 1) ? "UP" : "CRITICAL") : "LOW", 269a7ff8297SAmit Kucheria enable ? "en" : "dis"); 270a7ff8297SAmit Kucheria if (tsens_version(priv) > VER_1_X) 271a7ff8297SAmit Kucheria tsens_set_interrupt_v2(priv, hw_id, irq_type, enable); 272a7ff8297SAmit Kucheria else 273a7ff8297SAmit Kucheria tsens_set_interrupt_v1(priv, hw_id, irq_type, enable); 274a7ff8297SAmit Kucheria } 275a7ff8297SAmit Kucheria 276a7ff8297SAmit Kucheria /** 277a7ff8297SAmit Kucheria * tsens_threshold_violated - Check if a sensor temperature violated a preset threshold 278a7ff8297SAmit Kucheria * @priv: Pointer to tsens controller private data 279a7ff8297SAmit Kucheria * @hw_id: Hardware ID aka. sensor number 280a7ff8297SAmit Kucheria * @d: Pointer to irq state data 281a7ff8297SAmit Kucheria * 282a7ff8297SAmit Kucheria * Return: 0 if threshold was not violated, 1 if it was violated and negative 283a7ff8297SAmit Kucheria * errno in case of errors 284a7ff8297SAmit Kucheria */ 285a7ff8297SAmit Kucheria static int tsens_threshold_violated(struct tsens_priv *priv, u32 hw_id, 286a7ff8297SAmit Kucheria struct tsens_irq_data *d) 287a7ff8297SAmit Kucheria { 288a7ff8297SAmit Kucheria int ret; 289a7ff8297SAmit Kucheria 290a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[UPPER_STATUS_0 + hw_id], &d->up_viol); 291a7ff8297SAmit Kucheria if (ret) 292a7ff8297SAmit Kucheria return ret; 293a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[LOWER_STATUS_0 + hw_id], &d->low_viol); 294a7ff8297SAmit Kucheria if (ret) 295a7ff8297SAmit Kucheria return ret; 296a7ff8297SAmit Kucheria 297a7ff8297SAmit Kucheria if (priv->feat->crit_int) { 298a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[CRITICAL_STATUS_0 + hw_id], 299a7ff8297SAmit Kucheria &d->crit_viol); 300a7ff8297SAmit Kucheria if (ret) 301a7ff8297SAmit Kucheria return ret; 302a7ff8297SAmit Kucheria } 303a7ff8297SAmit Kucheria 304a7ff8297SAmit Kucheria if (d->up_viol || d->low_viol || d->crit_viol) 305a7ff8297SAmit Kucheria return 1; 306a7ff8297SAmit Kucheria 307a7ff8297SAmit Kucheria return 0; 308a7ff8297SAmit Kucheria } 309a7ff8297SAmit Kucheria 310a7ff8297SAmit Kucheria static int tsens_read_irq_state(struct tsens_priv *priv, u32 hw_id, 311a7ff8297SAmit Kucheria const struct tsens_sensor *s, 312a7ff8297SAmit Kucheria struct tsens_irq_data *d) 313a7ff8297SAmit Kucheria { 314a7ff8297SAmit Kucheria int ret; 315a7ff8297SAmit Kucheria 316a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[UP_INT_CLEAR_0 + hw_id], &d->up_irq_clear); 317a7ff8297SAmit Kucheria if (ret) 318a7ff8297SAmit Kucheria return ret; 319a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[LOW_INT_CLEAR_0 + hw_id], &d->low_irq_clear); 320a7ff8297SAmit Kucheria if (ret) 321a7ff8297SAmit Kucheria return ret; 322a7ff8297SAmit Kucheria if (tsens_version(priv) > VER_1_X) { 323a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[UP_INT_MASK_0 + hw_id], &d->up_irq_mask); 324a7ff8297SAmit Kucheria if (ret) 325a7ff8297SAmit Kucheria return ret; 326a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[LOW_INT_MASK_0 + hw_id], &d->low_irq_mask); 327a7ff8297SAmit Kucheria if (ret) 328a7ff8297SAmit Kucheria return ret; 329a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[CRIT_INT_CLEAR_0 + hw_id], 330a7ff8297SAmit Kucheria &d->crit_irq_clear); 331a7ff8297SAmit Kucheria if (ret) 332a7ff8297SAmit Kucheria return ret; 333a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[CRIT_INT_MASK_0 + hw_id], 334a7ff8297SAmit Kucheria &d->crit_irq_mask); 335a7ff8297SAmit Kucheria if (ret) 336a7ff8297SAmit Kucheria return ret; 337a7ff8297SAmit Kucheria 338a7ff8297SAmit Kucheria d->crit_thresh = tsens_hw_to_mC(s, CRIT_THRESH_0 + hw_id); 339a7ff8297SAmit Kucheria } else { 340a7ff8297SAmit Kucheria /* No mask register on older TSENS */ 341a7ff8297SAmit Kucheria d->up_irq_mask = 0; 342a7ff8297SAmit Kucheria d->low_irq_mask = 0; 343a7ff8297SAmit Kucheria d->crit_irq_clear = 0; 344a7ff8297SAmit Kucheria d->crit_irq_mask = 0; 345a7ff8297SAmit Kucheria d->crit_thresh = 0; 346a7ff8297SAmit Kucheria } 347a7ff8297SAmit Kucheria 348a7ff8297SAmit Kucheria d->up_thresh = tsens_hw_to_mC(s, UP_THRESH_0 + hw_id); 349a7ff8297SAmit Kucheria d->low_thresh = tsens_hw_to_mC(s, LOW_THRESH_0 + hw_id); 350a7ff8297SAmit Kucheria 351a7ff8297SAmit Kucheria dev_dbg(priv->dev, "[%u] %s%s: status(%u|%u|%u) | clr(%u|%u|%u) | mask(%u|%u|%u)\n", 352a7ff8297SAmit Kucheria hw_id, __func__, 353a7ff8297SAmit Kucheria (d->up_viol || d->low_viol || d->crit_viol) ? "(V)" : "", 354a7ff8297SAmit Kucheria d->low_viol, d->up_viol, d->crit_viol, 355a7ff8297SAmit Kucheria d->low_irq_clear, d->up_irq_clear, d->crit_irq_clear, 356a7ff8297SAmit Kucheria d->low_irq_mask, d->up_irq_mask, d->crit_irq_mask); 357a7ff8297SAmit Kucheria dev_dbg(priv->dev, "[%u] %s%s: thresh: (%d:%d:%d)\n", hw_id, __func__, 358a7ff8297SAmit Kucheria (d->up_viol || d->low_viol || d->crit_viol) ? "(V)" : "", 359a7ff8297SAmit Kucheria d->low_thresh, d->up_thresh, d->crit_thresh); 360a7ff8297SAmit Kucheria 361a7ff8297SAmit Kucheria return 0; 362a7ff8297SAmit Kucheria } 363a7ff8297SAmit Kucheria 364a7ff8297SAmit Kucheria static inline u32 masked_irq(u32 hw_id, u32 mask, enum tsens_ver ver) 365a7ff8297SAmit Kucheria { 366a7ff8297SAmit Kucheria if (ver > VER_1_X) 367a7ff8297SAmit Kucheria return mask & (1 << hw_id); 368a7ff8297SAmit Kucheria 369a7ff8297SAmit Kucheria /* v1, v0.1 don't have a irq mask register */ 370a7ff8297SAmit Kucheria return 0; 371a7ff8297SAmit Kucheria } 372a7ff8297SAmit Kucheria 373a7ff8297SAmit Kucheria /** 374a7ff8297SAmit Kucheria * tsens_critical_irq_thread() - Threaded handler for critical interrupts 375a7ff8297SAmit Kucheria * @irq: irq number 376a7ff8297SAmit Kucheria * @data: tsens controller private data 377a7ff8297SAmit Kucheria * 378a7ff8297SAmit Kucheria * Check FSM watchdog bark status and clear if needed. 379a7ff8297SAmit Kucheria * Check all sensors to find ones that violated their critical threshold limits. 380a7ff8297SAmit Kucheria * Clear and then re-enable the interrupt. 381a7ff8297SAmit Kucheria * 382a7ff8297SAmit Kucheria * The level-triggered interrupt might deassert if the temperature returned to 383a7ff8297SAmit Kucheria * within the threshold limits by the time the handler got scheduled. We 384a7ff8297SAmit Kucheria * consider the irq to have been handled in that case. 385a7ff8297SAmit Kucheria * 386a7ff8297SAmit Kucheria * Return: IRQ_HANDLED 387a7ff8297SAmit Kucheria */ 3883ecc8292SAmit Kucheria static irqreturn_t tsens_critical_irq_thread(int irq, void *data) 389a7ff8297SAmit Kucheria { 390a7ff8297SAmit Kucheria struct tsens_priv *priv = data; 391a7ff8297SAmit Kucheria struct tsens_irq_data d; 392a7ff8297SAmit Kucheria int temp, ret, i; 393a7ff8297SAmit Kucheria u32 wdog_status, wdog_count; 394a7ff8297SAmit Kucheria 395a7ff8297SAmit Kucheria if (priv->feat->has_watchdog) { 396a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[WDOG_BARK_STATUS], 397a7ff8297SAmit Kucheria &wdog_status); 398a7ff8297SAmit Kucheria if (ret) 399a7ff8297SAmit Kucheria return ret; 400a7ff8297SAmit Kucheria 401a7ff8297SAmit Kucheria if (wdog_status) { 402a7ff8297SAmit Kucheria /* Clear WDOG interrupt */ 403a7ff8297SAmit Kucheria regmap_field_write(priv->rf[WDOG_BARK_CLEAR], 1); 404a7ff8297SAmit Kucheria regmap_field_write(priv->rf[WDOG_BARK_CLEAR], 0); 405a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[WDOG_BARK_COUNT], 406a7ff8297SAmit Kucheria &wdog_count); 407a7ff8297SAmit Kucheria if (ret) 408a7ff8297SAmit Kucheria return ret; 409a7ff8297SAmit Kucheria if (wdog_count) 410a7ff8297SAmit Kucheria dev_dbg(priv->dev, "%s: watchdog count: %d\n", 411a7ff8297SAmit Kucheria __func__, wdog_count); 412a7ff8297SAmit Kucheria 413a7ff8297SAmit Kucheria /* Fall through to handle critical interrupts if any */ 414a7ff8297SAmit Kucheria } 415a7ff8297SAmit Kucheria } 416a7ff8297SAmit Kucheria 417a7ff8297SAmit Kucheria for (i = 0; i < priv->num_sensors; i++) { 418a7ff8297SAmit Kucheria const struct tsens_sensor *s = &priv->sensor[i]; 419a7ff8297SAmit Kucheria u32 hw_id = s->hw_id; 420a7ff8297SAmit Kucheria 421cf969218SAnsuel Smith if (!s->tzd) 422a7ff8297SAmit Kucheria continue; 423a7ff8297SAmit Kucheria if (!tsens_threshold_violated(priv, hw_id, &d)) 424a7ff8297SAmit Kucheria continue; 425a7ff8297SAmit Kucheria ret = get_temp_tsens_valid(s, &temp); 426a7ff8297SAmit Kucheria if (ret) { 427a7ff8297SAmit Kucheria dev_err(priv->dev, "[%u] %s: error reading sensor\n", 428a7ff8297SAmit Kucheria hw_id, __func__); 429a7ff8297SAmit Kucheria continue; 430a7ff8297SAmit Kucheria } 431a7ff8297SAmit Kucheria 432a7ff8297SAmit Kucheria tsens_read_irq_state(priv, hw_id, s, &d); 433a7ff8297SAmit Kucheria if (d.crit_viol && 434a7ff8297SAmit Kucheria !masked_irq(hw_id, d.crit_irq_mask, tsens_version(priv))) { 435a7ff8297SAmit Kucheria /* Mask critical interrupts, unused on Linux */ 436a7ff8297SAmit Kucheria tsens_set_interrupt(priv, hw_id, CRITICAL, false); 437a7ff8297SAmit Kucheria } 438a7ff8297SAmit Kucheria } 439a7ff8297SAmit Kucheria 440a7ff8297SAmit Kucheria return IRQ_HANDLED; 441a7ff8297SAmit Kucheria } 442a7ff8297SAmit Kucheria 443a7ff8297SAmit Kucheria /** 444a7ff8297SAmit Kucheria * tsens_irq_thread - Threaded interrupt handler for uplow interrupts 445a7ff8297SAmit Kucheria * @irq: irq number 446a7ff8297SAmit Kucheria * @data: tsens controller private data 447a7ff8297SAmit Kucheria * 448a7ff8297SAmit Kucheria * Check all sensors to find ones that violated their threshold limits. If the 449a7ff8297SAmit Kucheria * temperature is still outside the limits, call thermal_zone_device_update() to 450a7ff8297SAmit Kucheria * update the thresholds, else re-enable the interrupts. 451a7ff8297SAmit Kucheria * 452a7ff8297SAmit Kucheria * The level-triggered interrupt might deassert if the temperature returned to 453a7ff8297SAmit Kucheria * within the threshold limits by the time the handler got scheduled. We 454a7ff8297SAmit Kucheria * consider the irq to have been handled in that case. 455a7ff8297SAmit Kucheria * 456a7ff8297SAmit Kucheria * Return: IRQ_HANDLED 457a7ff8297SAmit Kucheria */ 4583ecc8292SAmit Kucheria static irqreturn_t tsens_irq_thread(int irq, void *data) 459a7ff8297SAmit Kucheria { 460a7ff8297SAmit Kucheria struct tsens_priv *priv = data; 461a7ff8297SAmit Kucheria struct tsens_irq_data d; 462a7ff8297SAmit Kucheria bool enable = true, disable = false; 463a7ff8297SAmit Kucheria unsigned long flags; 464a7ff8297SAmit Kucheria int temp, ret, i; 465a7ff8297SAmit Kucheria 466a7ff8297SAmit Kucheria for (i = 0; i < priv->num_sensors; i++) { 467a7ff8297SAmit Kucheria bool trigger = false; 468a7ff8297SAmit Kucheria const struct tsens_sensor *s = &priv->sensor[i]; 469a7ff8297SAmit Kucheria u32 hw_id = s->hw_id; 470a7ff8297SAmit Kucheria 471cf969218SAnsuel Smith if (!s->tzd) 472a7ff8297SAmit Kucheria continue; 473a7ff8297SAmit Kucheria if (!tsens_threshold_violated(priv, hw_id, &d)) 474a7ff8297SAmit Kucheria continue; 475a7ff8297SAmit Kucheria ret = get_temp_tsens_valid(s, &temp); 476a7ff8297SAmit Kucheria if (ret) { 477a7ff8297SAmit Kucheria dev_err(priv->dev, "[%u] %s: error reading sensor\n", 478a7ff8297SAmit Kucheria hw_id, __func__); 479a7ff8297SAmit Kucheria continue; 480a7ff8297SAmit Kucheria } 481a7ff8297SAmit Kucheria 482a7ff8297SAmit Kucheria spin_lock_irqsave(&priv->ul_lock, flags); 483a7ff8297SAmit Kucheria 484a7ff8297SAmit Kucheria tsens_read_irq_state(priv, hw_id, s, &d); 485a7ff8297SAmit Kucheria 486a7ff8297SAmit Kucheria if (d.up_viol && 487a7ff8297SAmit Kucheria !masked_irq(hw_id, d.up_irq_mask, tsens_version(priv))) { 488a7ff8297SAmit Kucheria tsens_set_interrupt(priv, hw_id, UPPER, disable); 489a7ff8297SAmit Kucheria if (d.up_thresh > temp) { 490a7ff8297SAmit Kucheria dev_dbg(priv->dev, "[%u] %s: re-arm upper\n", 491a7ff8297SAmit Kucheria hw_id, __func__); 492a7ff8297SAmit Kucheria tsens_set_interrupt(priv, hw_id, UPPER, enable); 493a7ff8297SAmit Kucheria } else { 494a7ff8297SAmit Kucheria trigger = true; 495a7ff8297SAmit Kucheria /* Keep irq masked */ 496a7ff8297SAmit Kucheria } 497a7ff8297SAmit Kucheria } else if (d.low_viol && 498a7ff8297SAmit Kucheria !masked_irq(hw_id, d.low_irq_mask, tsens_version(priv))) { 499a7ff8297SAmit Kucheria tsens_set_interrupt(priv, hw_id, LOWER, disable); 500a7ff8297SAmit Kucheria if (d.low_thresh < temp) { 501a7ff8297SAmit Kucheria dev_dbg(priv->dev, "[%u] %s: re-arm low\n", 502a7ff8297SAmit Kucheria hw_id, __func__); 503a7ff8297SAmit Kucheria tsens_set_interrupt(priv, hw_id, LOWER, enable); 504a7ff8297SAmit Kucheria } else { 505a7ff8297SAmit Kucheria trigger = true; 506a7ff8297SAmit Kucheria /* Keep irq masked */ 507a7ff8297SAmit Kucheria } 508a7ff8297SAmit Kucheria } 509a7ff8297SAmit Kucheria 510a7ff8297SAmit Kucheria spin_unlock_irqrestore(&priv->ul_lock, flags); 511a7ff8297SAmit Kucheria 512a7ff8297SAmit Kucheria if (trigger) { 513a7ff8297SAmit Kucheria dev_dbg(priv->dev, "[%u] %s: TZ update trigger (%d mC)\n", 514a7ff8297SAmit Kucheria hw_id, __func__, temp); 515a7ff8297SAmit Kucheria thermal_zone_device_update(s->tzd, 516a7ff8297SAmit Kucheria THERMAL_EVENT_UNSPECIFIED); 517a7ff8297SAmit Kucheria } else { 518a7ff8297SAmit Kucheria dev_dbg(priv->dev, "[%u] %s: no violation: %d\n", 519a7ff8297SAmit Kucheria hw_id, __func__, temp); 520a7ff8297SAmit Kucheria } 52153e2a20eSAnsuel Smith 52253e2a20eSAnsuel Smith if (tsens_version(priv) < VER_0_1) { 52353e2a20eSAnsuel Smith /* Constraint: There is only 1 interrupt control register for all 52453e2a20eSAnsuel Smith * 11 temperature sensor. So monitoring more than 1 sensor based 52553e2a20eSAnsuel Smith * on interrupts will yield inconsistent result. To overcome this 52653e2a20eSAnsuel Smith * issue we will monitor only sensor 0 which is the master sensor. 52753e2a20eSAnsuel Smith */ 52853e2a20eSAnsuel Smith break; 52953e2a20eSAnsuel Smith } 530a7ff8297SAmit Kucheria } 531a7ff8297SAmit Kucheria 532a7ff8297SAmit Kucheria return IRQ_HANDLED; 533a7ff8297SAmit Kucheria } 534a7ff8297SAmit Kucheria 5354360af35SRobert Marko /** 5364360af35SRobert Marko * tsens_combined_irq_thread() - Threaded interrupt handler for combined interrupts 5374360af35SRobert Marko * @irq: irq number 5384360af35SRobert Marko * @data: tsens controller private data 5394360af35SRobert Marko * 5404360af35SRobert Marko * Handle the combined interrupt as if it were 2 separate interrupts, so call the 5414360af35SRobert Marko * critical handler first and then the up/low one. 5424360af35SRobert Marko * 5434360af35SRobert Marko * Return: IRQ_HANDLED 5444360af35SRobert Marko */ 5454360af35SRobert Marko static irqreturn_t tsens_combined_irq_thread(int irq, void *data) 5464360af35SRobert Marko { 5474360af35SRobert Marko irqreturn_t ret; 5484360af35SRobert Marko 5494360af35SRobert Marko ret = tsens_critical_irq_thread(irq, data); 5504360af35SRobert Marko if (ret != IRQ_HANDLED) 5514360af35SRobert Marko return ret; 5524360af35SRobert Marko 5534360af35SRobert Marko return tsens_irq_thread(irq, data); 5544360af35SRobert Marko } 5554360af35SRobert Marko 556ca1b9a9eSDaniel Lezcano static int tsens_set_trips(struct thermal_zone_device *tz, int low, int high) 557a7ff8297SAmit Kucheria { 558ca1b9a9eSDaniel Lezcano struct tsens_sensor *s = tz->devdata; 559a7ff8297SAmit Kucheria struct tsens_priv *priv = s->priv; 560a7ff8297SAmit Kucheria struct device *dev = priv->dev; 561a7ff8297SAmit Kucheria struct tsens_irq_data d; 562a7ff8297SAmit Kucheria unsigned long flags; 563a7ff8297SAmit Kucheria int high_val, low_val, cl_high, cl_low; 564a7ff8297SAmit Kucheria u32 hw_id = s->hw_id; 565a7ff8297SAmit Kucheria 56653e2a20eSAnsuel Smith if (tsens_version(priv) < VER_0_1) { 56753e2a20eSAnsuel Smith /* Pre v0.1 IP had a single register for each type of interrupt 56853e2a20eSAnsuel Smith * and thresholds 56953e2a20eSAnsuel Smith */ 57053e2a20eSAnsuel Smith hw_id = 0; 57153e2a20eSAnsuel Smith } 57253e2a20eSAnsuel Smith 573a7ff8297SAmit Kucheria dev_dbg(dev, "[%u] %s: proposed thresholds: (%d:%d)\n", 574a7ff8297SAmit Kucheria hw_id, __func__, low, high); 575a7ff8297SAmit Kucheria 576f63bacedSRobert Marko cl_high = clamp_val(high, priv->feat->trip_min_temp, priv->feat->trip_max_temp); 577f63bacedSRobert Marko cl_low = clamp_val(low, priv->feat->trip_min_temp, priv->feat->trip_max_temp); 578a7ff8297SAmit Kucheria 579a7ff8297SAmit Kucheria high_val = tsens_mC_to_hw(s, cl_high); 580a7ff8297SAmit Kucheria low_val = tsens_mC_to_hw(s, cl_low); 581a7ff8297SAmit Kucheria 582a7ff8297SAmit Kucheria spin_lock_irqsave(&priv->ul_lock, flags); 583a7ff8297SAmit Kucheria 584a7ff8297SAmit Kucheria tsens_read_irq_state(priv, hw_id, s, &d); 585a7ff8297SAmit Kucheria 586a7ff8297SAmit Kucheria /* Write the new thresholds and clear the status */ 587a7ff8297SAmit Kucheria regmap_field_write(priv->rf[LOW_THRESH_0 + hw_id], low_val); 588a7ff8297SAmit Kucheria regmap_field_write(priv->rf[UP_THRESH_0 + hw_id], high_val); 589a7ff8297SAmit Kucheria tsens_set_interrupt(priv, hw_id, LOWER, true); 590a7ff8297SAmit Kucheria tsens_set_interrupt(priv, hw_id, UPPER, true); 591a7ff8297SAmit Kucheria 592a7ff8297SAmit Kucheria spin_unlock_irqrestore(&priv->ul_lock, flags); 593a7ff8297SAmit Kucheria 594a7ff8297SAmit Kucheria dev_dbg(dev, "[%u] %s: (%d:%d)->(%d:%d)\n", 595a7ff8297SAmit Kucheria hw_id, __func__, d.low_thresh, d.up_thresh, cl_low, cl_high); 596a7ff8297SAmit Kucheria 597a7ff8297SAmit Kucheria return 0; 598a7ff8297SAmit Kucheria } 599a7ff8297SAmit Kucheria 6003ecc8292SAmit Kucheria static int tsens_enable_irq(struct tsens_priv *priv) 601a7ff8297SAmit Kucheria { 602a7ff8297SAmit Kucheria int ret; 603a7ff8297SAmit Kucheria int val = tsens_version(priv) > VER_1_X ? 7 : 1; 604a7ff8297SAmit Kucheria 605a7ff8297SAmit Kucheria ret = regmap_field_write(priv->rf[INT_EN], val); 606a7ff8297SAmit Kucheria if (ret < 0) 607a7ff8297SAmit Kucheria dev_err(priv->dev, "%s: failed to enable interrupts\n", 608a7ff8297SAmit Kucheria __func__); 609a7ff8297SAmit Kucheria 610a7ff8297SAmit Kucheria return ret; 611a7ff8297SAmit Kucheria } 612a7ff8297SAmit Kucheria 6133ecc8292SAmit Kucheria static void tsens_disable_irq(struct tsens_priv *priv) 614a7ff8297SAmit Kucheria { 615a7ff8297SAmit Kucheria regmap_field_write(priv->rf[INT_EN], 0); 616a7ff8297SAmit Kucheria } 617a7ff8297SAmit Kucheria 618a7ff8297SAmit Kucheria int get_temp_tsens_valid(const struct tsens_sensor *s, int *temp) 619a7ff8297SAmit Kucheria { 620a7ff8297SAmit Kucheria struct tsens_priv *priv = s->priv; 621a7ff8297SAmit Kucheria int hw_id = s->hw_id; 622a7ff8297SAmit Kucheria u32 temp_idx = LAST_TEMP_0 + hw_id; 623a7ff8297SAmit Kucheria u32 valid_idx = VALID_0 + hw_id; 624a7ff8297SAmit Kucheria u32 valid; 625a7ff8297SAmit Kucheria int ret; 626a7ff8297SAmit Kucheria 62753e2a20eSAnsuel Smith /* VER_0 doesn't have VALID bit */ 628d012f918SAnsuel Smith if (tsens_version(priv) == VER_0) 629d012f918SAnsuel Smith goto get_temp; 630d012f918SAnsuel Smith 631a7ff8297SAmit Kucheria /* Valid bit is 0 for 6 AHB clock cycles. 632a7ff8297SAmit Kucheria * At 19.2MHz, 1 AHB clock is ~60ns. 633a7ff8297SAmit Kucheria * We should enter this loop very, very rarely. 634d012f918SAnsuel Smith * Wait 1 us since it's the min of poll_timeout macro. 635d012f918SAnsuel Smith * Old value was 400 ns. 636a7ff8297SAmit Kucheria */ 637d012f918SAnsuel Smith ret = regmap_field_read_poll_timeout(priv->rf[valid_idx], valid, 638d012f918SAnsuel Smith valid, 1, 20 * USEC_PER_MSEC); 639a7ff8297SAmit Kucheria if (ret) 640a7ff8297SAmit Kucheria return ret; 641a7ff8297SAmit Kucheria 642d012f918SAnsuel Smith get_temp: 643a7ff8297SAmit Kucheria /* Valid bit is set, OK to read the temperature */ 644a7ff8297SAmit Kucheria *temp = tsens_hw_to_mC(s, temp_idx); 645a7ff8297SAmit Kucheria 646a7ff8297SAmit Kucheria return 0; 647a7ff8297SAmit Kucheria } 648a7ff8297SAmit Kucheria 649a7ff8297SAmit Kucheria int get_temp_common(const struct tsens_sensor *s, int *temp) 650a7ff8297SAmit Kucheria { 651a7ff8297SAmit Kucheria struct tsens_priv *priv = s->priv; 652a7ff8297SAmit Kucheria int hw_id = s->hw_id; 65353e2a20eSAnsuel Smith int last_temp = 0, ret, trdy; 65453e2a20eSAnsuel Smith unsigned long timeout; 65553e2a20eSAnsuel Smith 65653e2a20eSAnsuel Smith timeout = jiffies + usecs_to_jiffies(TIMEOUT_US); 65753e2a20eSAnsuel Smith do { 65853e2a20eSAnsuel Smith if (tsens_version(priv) == VER_0) { 65953e2a20eSAnsuel Smith ret = regmap_field_read(priv->rf[TRDY], &trdy); 66053e2a20eSAnsuel Smith if (ret) 66153e2a20eSAnsuel Smith return ret; 66253e2a20eSAnsuel Smith if (!trdy) 66353e2a20eSAnsuel Smith continue; 66453e2a20eSAnsuel Smith } 665a7ff8297SAmit Kucheria 666a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[LAST_TEMP_0 + hw_id], &last_temp); 667a7ff8297SAmit Kucheria if (ret) 668a7ff8297SAmit Kucheria return ret; 669a7ff8297SAmit Kucheria 670a7ff8297SAmit Kucheria *temp = code_to_degc(last_temp, s) * 1000; 671a7ff8297SAmit Kucheria 672a7ff8297SAmit Kucheria return 0; 67353e2a20eSAnsuel Smith } while (time_before(jiffies, timeout)); 67453e2a20eSAnsuel Smith 67553e2a20eSAnsuel Smith return -ETIMEDOUT; 676a7ff8297SAmit Kucheria } 677a7ff8297SAmit Kucheria 678a7ff8297SAmit Kucheria #ifdef CONFIG_DEBUG_FS 679a7ff8297SAmit Kucheria static int dbg_sensors_show(struct seq_file *s, void *data) 680a7ff8297SAmit Kucheria { 681a7ff8297SAmit Kucheria struct platform_device *pdev = s->private; 682a7ff8297SAmit Kucheria struct tsens_priv *priv = platform_get_drvdata(pdev); 683a7ff8297SAmit Kucheria int i; 684a7ff8297SAmit Kucheria 685a7ff8297SAmit Kucheria seq_printf(s, "max: %2d\nnum: %2d\n\n", 686a7ff8297SAmit Kucheria priv->feat->max_sensors, priv->num_sensors); 687a7ff8297SAmit Kucheria 688a7ff8297SAmit Kucheria seq_puts(s, " id slope offset\n--------------------------\n"); 689a7ff8297SAmit Kucheria for (i = 0; i < priv->num_sensors; i++) { 690a7ff8297SAmit Kucheria seq_printf(s, "%8d %8d %8d\n", priv->sensor[i].hw_id, 691a7ff8297SAmit Kucheria priv->sensor[i].slope, priv->sensor[i].offset); 692a7ff8297SAmit Kucheria } 693a7ff8297SAmit Kucheria 694a7ff8297SAmit Kucheria return 0; 695a7ff8297SAmit Kucheria } 696a7ff8297SAmit Kucheria 697a7ff8297SAmit Kucheria static int dbg_version_show(struct seq_file *s, void *data) 698a7ff8297SAmit Kucheria { 699a7ff8297SAmit Kucheria struct platform_device *pdev = s->private; 700a7ff8297SAmit Kucheria struct tsens_priv *priv = platform_get_drvdata(pdev); 701a7ff8297SAmit Kucheria u32 maj_ver, min_ver, step_ver; 702a7ff8297SAmit Kucheria int ret; 703a7ff8297SAmit Kucheria 704a7ff8297SAmit Kucheria if (tsens_version(priv) > VER_0_1) { 705a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[VER_MAJOR], &maj_ver); 706a7ff8297SAmit Kucheria if (ret) 707a7ff8297SAmit Kucheria return ret; 708a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[VER_MINOR], &min_ver); 709a7ff8297SAmit Kucheria if (ret) 710a7ff8297SAmit Kucheria return ret; 711a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[VER_STEP], &step_ver); 712a7ff8297SAmit Kucheria if (ret) 713a7ff8297SAmit Kucheria return ret; 714a7ff8297SAmit Kucheria seq_printf(s, "%d.%d.%d\n", maj_ver, min_ver, step_ver); 715a7ff8297SAmit Kucheria } else { 716*c7e077e9SChristian Marangi seq_printf(s, "0.%d.0\n", priv->feat->ver_major); 717a7ff8297SAmit Kucheria } 718a7ff8297SAmit Kucheria 719a7ff8297SAmit Kucheria return 0; 720a7ff8297SAmit Kucheria } 721a7ff8297SAmit Kucheria 722a7ff8297SAmit Kucheria DEFINE_SHOW_ATTRIBUTE(dbg_version); 723a7ff8297SAmit Kucheria DEFINE_SHOW_ATTRIBUTE(dbg_sensors); 724a7ff8297SAmit Kucheria 725a7ff8297SAmit Kucheria static void tsens_debug_init(struct platform_device *pdev) 726a7ff8297SAmit Kucheria { 727a7ff8297SAmit Kucheria struct tsens_priv *priv = platform_get_drvdata(pdev); 728a7ff8297SAmit Kucheria struct dentry *root, *file; 729a7ff8297SAmit Kucheria 730a7ff8297SAmit Kucheria root = debugfs_lookup("tsens", NULL); 731a7ff8297SAmit Kucheria if (!root) 732a7ff8297SAmit Kucheria priv->debug_root = debugfs_create_dir("tsens", NULL); 733a7ff8297SAmit Kucheria else 734a7ff8297SAmit Kucheria priv->debug_root = root; 735a7ff8297SAmit Kucheria 736a7ff8297SAmit Kucheria file = debugfs_lookup("version", priv->debug_root); 737a7ff8297SAmit Kucheria if (!file) 738a7ff8297SAmit Kucheria debugfs_create_file("version", 0444, priv->debug_root, 739a7ff8297SAmit Kucheria pdev, &dbg_version_fops); 740a7ff8297SAmit Kucheria 741a7ff8297SAmit Kucheria /* A directory for each instance of the TSENS IP */ 742a7ff8297SAmit Kucheria priv->debug = debugfs_create_dir(dev_name(&pdev->dev), priv->debug_root); 743a7ff8297SAmit Kucheria debugfs_create_file("sensors", 0444, priv->debug, pdev, &dbg_sensors_fops); 744a7ff8297SAmit Kucheria } 745a7ff8297SAmit Kucheria #else 746a7ff8297SAmit Kucheria static inline void tsens_debug_init(struct platform_device *pdev) {} 747a7ff8297SAmit Kucheria #endif 748a7ff8297SAmit Kucheria 749a7ff8297SAmit Kucheria static const struct regmap_config tsens_config = { 750a7ff8297SAmit Kucheria .name = "tm", 751a7ff8297SAmit Kucheria .reg_bits = 32, 752a7ff8297SAmit Kucheria .val_bits = 32, 753a7ff8297SAmit Kucheria .reg_stride = 4, 754a7ff8297SAmit Kucheria }; 755a7ff8297SAmit Kucheria 756a7ff8297SAmit Kucheria static const struct regmap_config tsens_srot_config = { 757a7ff8297SAmit Kucheria .name = "srot", 758a7ff8297SAmit Kucheria .reg_bits = 32, 759a7ff8297SAmit Kucheria .val_bits = 32, 760a7ff8297SAmit Kucheria .reg_stride = 4, 761a7ff8297SAmit Kucheria }; 762a7ff8297SAmit Kucheria 763a7ff8297SAmit Kucheria int __init init_common(struct tsens_priv *priv) 764a7ff8297SAmit Kucheria { 765a7ff8297SAmit Kucheria void __iomem *tm_base, *srot_base; 766a7ff8297SAmit Kucheria struct device *dev = priv->dev; 767a7ff8297SAmit Kucheria u32 ver_minor; 768a7ff8297SAmit Kucheria struct resource *res; 769a7ff8297SAmit Kucheria u32 enabled; 770a7ff8297SAmit Kucheria int ret, i, j; 771a7ff8297SAmit Kucheria struct platform_device *op = of_find_device_by_node(priv->dev->of_node); 772a7ff8297SAmit Kucheria 773a7ff8297SAmit Kucheria if (!op) 774a7ff8297SAmit Kucheria return -EINVAL; 775a7ff8297SAmit Kucheria 776a7ff8297SAmit Kucheria if (op->num_resources > 1) { 777a7ff8297SAmit Kucheria /* DT with separate SROT and TM address space */ 778a7ff8297SAmit Kucheria priv->tm_offset = 0; 779a7ff8297SAmit Kucheria res = platform_get_resource(op, IORESOURCE_MEM, 1); 780a7ff8297SAmit Kucheria srot_base = devm_ioremap_resource(dev, res); 781a7ff8297SAmit Kucheria if (IS_ERR(srot_base)) { 782a7ff8297SAmit Kucheria ret = PTR_ERR(srot_base); 783a7ff8297SAmit Kucheria goto err_put_device; 784a7ff8297SAmit Kucheria } 785a7ff8297SAmit Kucheria 786a7ff8297SAmit Kucheria priv->srot_map = devm_regmap_init_mmio(dev, srot_base, 787a7ff8297SAmit Kucheria &tsens_srot_config); 788a7ff8297SAmit Kucheria if (IS_ERR(priv->srot_map)) { 789a7ff8297SAmit Kucheria ret = PTR_ERR(priv->srot_map); 790a7ff8297SAmit Kucheria goto err_put_device; 791a7ff8297SAmit Kucheria } 792a7ff8297SAmit Kucheria } else { 793a7ff8297SAmit Kucheria /* old DTs where SROT and TM were in a contiguous 2K block */ 794a7ff8297SAmit Kucheria priv->tm_offset = 0x1000; 795a7ff8297SAmit Kucheria } 796a7ff8297SAmit Kucheria 79753e2a20eSAnsuel Smith if (tsens_version(priv) >= VER_0_1) { 798a7ff8297SAmit Kucheria res = platform_get_resource(op, IORESOURCE_MEM, 0); 799a7ff8297SAmit Kucheria tm_base = devm_ioremap_resource(dev, res); 800a7ff8297SAmit Kucheria if (IS_ERR(tm_base)) { 801a7ff8297SAmit Kucheria ret = PTR_ERR(tm_base); 802a7ff8297SAmit Kucheria goto err_put_device; 803a7ff8297SAmit Kucheria } 804a7ff8297SAmit Kucheria 805a7ff8297SAmit Kucheria priv->tm_map = devm_regmap_init_mmio(dev, tm_base, &tsens_config); 80653e2a20eSAnsuel Smith } else { /* VER_0 share the same gcc regs using a syscon */ 80753e2a20eSAnsuel Smith struct device *parent = priv->dev->parent; 80853e2a20eSAnsuel Smith 80953e2a20eSAnsuel Smith if (parent) 81053e2a20eSAnsuel Smith priv->tm_map = syscon_node_to_regmap(parent->of_node); 81153e2a20eSAnsuel Smith } 81253e2a20eSAnsuel Smith 81353e2a20eSAnsuel Smith if (IS_ERR_OR_NULL(priv->tm_map)) { 81453e2a20eSAnsuel Smith if (!priv->tm_map) 81553e2a20eSAnsuel Smith ret = -ENODEV; 81653e2a20eSAnsuel Smith else 817a7ff8297SAmit Kucheria ret = PTR_ERR(priv->tm_map); 818a7ff8297SAmit Kucheria goto err_put_device; 819a7ff8297SAmit Kucheria } 820a7ff8297SAmit Kucheria 82153e2a20eSAnsuel Smith /* VER_0 have only tm_map */ 82253e2a20eSAnsuel Smith if (!priv->srot_map) 82353e2a20eSAnsuel Smith priv->srot_map = priv->tm_map; 82453e2a20eSAnsuel Smith 825a7ff8297SAmit Kucheria if (tsens_version(priv) > VER_0_1) { 826a7ff8297SAmit Kucheria for (i = VER_MAJOR; i <= VER_STEP; i++) { 827a7ff8297SAmit Kucheria priv->rf[i] = devm_regmap_field_alloc(dev, priv->srot_map, 828a7ff8297SAmit Kucheria priv->fields[i]); 829f4136863SGuangqing Zhu if (IS_ERR(priv->rf[i])) { 830f4136863SGuangqing Zhu ret = PTR_ERR(priv->rf[i]); 831f4136863SGuangqing Zhu goto err_put_device; 832f4136863SGuangqing Zhu } 833a7ff8297SAmit Kucheria } 834a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[VER_MINOR], &ver_minor); 835a7ff8297SAmit Kucheria if (ret) 836a7ff8297SAmit Kucheria goto err_put_device; 837a7ff8297SAmit Kucheria } 838a7ff8297SAmit Kucheria 839a7ff8297SAmit Kucheria priv->rf[TSENS_EN] = devm_regmap_field_alloc(dev, priv->srot_map, 840a7ff8297SAmit Kucheria priv->fields[TSENS_EN]); 841a7ff8297SAmit Kucheria if (IS_ERR(priv->rf[TSENS_EN])) { 842a7ff8297SAmit Kucheria ret = PTR_ERR(priv->rf[TSENS_EN]); 843a7ff8297SAmit Kucheria goto err_put_device; 844a7ff8297SAmit Kucheria } 84553e2a20eSAnsuel Smith /* in VER_0 TSENS need to be explicitly enabled */ 84653e2a20eSAnsuel Smith if (tsens_version(priv) == VER_0) 84753e2a20eSAnsuel Smith regmap_field_write(priv->rf[TSENS_EN], 1); 84853e2a20eSAnsuel Smith 849a7ff8297SAmit Kucheria ret = regmap_field_read(priv->rf[TSENS_EN], &enabled); 850a7ff8297SAmit Kucheria if (ret) 851a7ff8297SAmit Kucheria goto err_put_device; 852a7ff8297SAmit Kucheria if (!enabled) { 853a7ff8297SAmit Kucheria dev_err(dev, "%s: device not enabled\n", __func__); 854a7ff8297SAmit Kucheria ret = -ENODEV; 855a7ff8297SAmit Kucheria goto err_put_device; 856a7ff8297SAmit Kucheria } 857a7ff8297SAmit Kucheria 858a7ff8297SAmit Kucheria priv->rf[SENSOR_EN] = devm_regmap_field_alloc(dev, priv->srot_map, 859a7ff8297SAmit Kucheria priv->fields[SENSOR_EN]); 860a7ff8297SAmit Kucheria if (IS_ERR(priv->rf[SENSOR_EN])) { 861a7ff8297SAmit Kucheria ret = PTR_ERR(priv->rf[SENSOR_EN]); 862a7ff8297SAmit Kucheria goto err_put_device; 863a7ff8297SAmit Kucheria } 864a7ff8297SAmit Kucheria priv->rf[INT_EN] = devm_regmap_field_alloc(dev, priv->tm_map, 865a7ff8297SAmit Kucheria priv->fields[INT_EN]); 866a7ff8297SAmit Kucheria if (IS_ERR(priv->rf[INT_EN])) { 867a7ff8297SAmit Kucheria ret = PTR_ERR(priv->rf[INT_EN]); 868a7ff8297SAmit Kucheria goto err_put_device; 869a7ff8297SAmit Kucheria } 870a7ff8297SAmit Kucheria 87153e2a20eSAnsuel Smith priv->rf[TSENS_SW_RST] = 87253e2a20eSAnsuel Smith devm_regmap_field_alloc(dev, priv->srot_map, priv->fields[TSENS_SW_RST]); 87353e2a20eSAnsuel Smith if (IS_ERR(priv->rf[TSENS_SW_RST])) { 87453e2a20eSAnsuel Smith ret = PTR_ERR(priv->rf[TSENS_SW_RST]); 87553e2a20eSAnsuel Smith goto err_put_device; 87653e2a20eSAnsuel Smith } 87753e2a20eSAnsuel Smith 87853e2a20eSAnsuel Smith priv->rf[TRDY] = devm_regmap_field_alloc(dev, priv->tm_map, priv->fields[TRDY]); 87953e2a20eSAnsuel Smith if (IS_ERR(priv->rf[TRDY])) { 88053e2a20eSAnsuel Smith ret = PTR_ERR(priv->rf[TRDY]); 88153e2a20eSAnsuel Smith goto err_put_device; 88253e2a20eSAnsuel Smith } 88353e2a20eSAnsuel Smith 884a7ff8297SAmit Kucheria /* This loop might need changes if enum regfield_ids is reordered */ 885a7ff8297SAmit Kucheria for (j = LAST_TEMP_0; j <= UP_THRESH_15; j += 16) { 886a7ff8297SAmit Kucheria for (i = 0; i < priv->feat->max_sensors; i++) { 887a7ff8297SAmit Kucheria int idx = j + i; 888a7ff8297SAmit Kucheria 889a7ff8297SAmit Kucheria priv->rf[idx] = devm_regmap_field_alloc(dev, 890a7ff8297SAmit Kucheria priv->tm_map, 891a7ff8297SAmit Kucheria priv->fields[idx]); 892a7ff8297SAmit Kucheria if (IS_ERR(priv->rf[idx])) { 893a7ff8297SAmit Kucheria ret = PTR_ERR(priv->rf[idx]); 894a7ff8297SAmit Kucheria goto err_put_device; 895a7ff8297SAmit Kucheria } 896a7ff8297SAmit Kucheria } 897a7ff8297SAmit Kucheria } 898a7ff8297SAmit Kucheria 89953e2a20eSAnsuel Smith if (priv->feat->crit_int || tsens_version(priv) < VER_0_1) { 900a7ff8297SAmit Kucheria /* Loop might need changes if enum regfield_ids is reordered */ 901a7ff8297SAmit Kucheria for (j = CRITICAL_STATUS_0; j <= CRIT_THRESH_15; j += 16) { 902a7ff8297SAmit Kucheria for (i = 0; i < priv->feat->max_sensors; i++) { 903a7ff8297SAmit Kucheria int idx = j + i; 904a7ff8297SAmit Kucheria 905a7ff8297SAmit Kucheria priv->rf[idx] = 906a7ff8297SAmit Kucheria devm_regmap_field_alloc(dev, 907a7ff8297SAmit Kucheria priv->tm_map, 908a7ff8297SAmit Kucheria priv->fields[idx]); 909a7ff8297SAmit Kucheria if (IS_ERR(priv->rf[idx])) { 910a7ff8297SAmit Kucheria ret = PTR_ERR(priv->rf[idx]); 911a7ff8297SAmit Kucheria goto err_put_device; 912a7ff8297SAmit Kucheria } 913a7ff8297SAmit Kucheria } 914a7ff8297SAmit Kucheria } 915a7ff8297SAmit Kucheria } 916a7ff8297SAmit Kucheria 917a7ff8297SAmit Kucheria if (tsens_version(priv) > VER_1_X && ver_minor > 2) { 918a7ff8297SAmit Kucheria /* Watchdog is present only on v2.3+ */ 919a7ff8297SAmit Kucheria priv->feat->has_watchdog = 1; 920a7ff8297SAmit Kucheria for (i = WDOG_BARK_STATUS; i <= CC_MON_MASK; i++) { 921a7ff8297SAmit Kucheria priv->rf[i] = devm_regmap_field_alloc(dev, priv->tm_map, 922a7ff8297SAmit Kucheria priv->fields[i]); 923a7ff8297SAmit Kucheria if (IS_ERR(priv->rf[i])) { 924a7ff8297SAmit Kucheria ret = PTR_ERR(priv->rf[i]); 925a7ff8297SAmit Kucheria goto err_put_device; 926a7ff8297SAmit Kucheria } 927a7ff8297SAmit Kucheria } 928a7ff8297SAmit Kucheria /* 929a7ff8297SAmit Kucheria * Watchdog is already enabled, unmask the bark. 930a7ff8297SAmit Kucheria * Disable cycle completion monitoring 931a7ff8297SAmit Kucheria */ 932a7ff8297SAmit Kucheria regmap_field_write(priv->rf[WDOG_BARK_MASK], 0); 933a7ff8297SAmit Kucheria regmap_field_write(priv->rf[CC_MON_MASK], 1); 934a7ff8297SAmit Kucheria } 935a7ff8297SAmit Kucheria 936a7ff8297SAmit Kucheria spin_lock_init(&priv->ul_lock); 93753e2a20eSAnsuel Smith 93853e2a20eSAnsuel Smith /* VER_0 interrupt doesn't need to be enabled */ 93953e2a20eSAnsuel Smith if (tsens_version(priv) >= VER_0_1) 940a7ff8297SAmit Kucheria tsens_enable_irq(priv); 94153e2a20eSAnsuel Smith 942a7ff8297SAmit Kucheria err_put_device: 943a7ff8297SAmit Kucheria put_device(&op->dev); 944a7ff8297SAmit Kucheria return ret; 945a7ff8297SAmit Kucheria } 946a7ff8297SAmit Kucheria 947ca1b9a9eSDaniel Lezcano static int tsens_get_temp(struct thermal_zone_device *tz, int *temp) 9489066073cSRajendra Nayak { 949ca1b9a9eSDaniel Lezcano struct tsens_sensor *s = tz->devdata; 95069b628acSAmit Kucheria struct tsens_priv *priv = s->priv; 9519066073cSRajendra Nayak 9528b71bce4SAmit Kucheria return priv->ops->get_temp(s, temp); 9539066073cSRajendra Nayak } 9549066073cSRajendra Nayak 9555b97469aSArnd Bergmann static int __maybe_unused tsens_suspend(struct device *dev) 9569066073cSRajendra Nayak { 95769b628acSAmit Kucheria struct tsens_priv *priv = dev_get_drvdata(dev); 9589066073cSRajendra Nayak 95969b628acSAmit Kucheria if (priv->ops && priv->ops->suspend) 96069b628acSAmit Kucheria return priv->ops->suspend(priv); 9619066073cSRajendra Nayak 9629066073cSRajendra Nayak return 0; 9639066073cSRajendra Nayak } 9649066073cSRajendra Nayak 9655b97469aSArnd Bergmann static int __maybe_unused tsens_resume(struct device *dev) 9669066073cSRajendra Nayak { 96769b628acSAmit Kucheria struct tsens_priv *priv = dev_get_drvdata(dev); 9689066073cSRajendra Nayak 96969b628acSAmit Kucheria if (priv->ops && priv->ops->resume) 97069b628acSAmit Kucheria return priv->ops->resume(priv); 9719066073cSRajendra Nayak 9729066073cSRajendra Nayak return 0; 9739066073cSRajendra Nayak } 9749066073cSRajendra Nayak 9759066073cSRajendra Nayak static SIMPLE_DEV_PM_OPS(tsens_pm_ops, tsens_suspend, tsens_resume); 9769066073cSRajendra Nayak 9779066073cSRajendra Nayak static const struct of_device_id tsens_table[] = { 9789066073cSRajendra Nayak { 9796b3aeafbSAnsuel Smith .compatible = "qcom,ipq8064-tsens", 9806b3aeafbSAnsuel Smith .data = &data_8960, 9816b3aeafbSAnsuel Smith }, { 9826840455dSRobert Marko .compatible = "qcom,ipq8074-tsens", 9836840455dSRobert Marko .data = &data_ipq8074, 9846840455dSRobert Marko }, { 985a2149ab8SKonrad Dybcio .compatible = "qcom,mdm9607-tsens", 986a2149ab8SKonrad Dybcio .data = &data_9607, 987a2149ab8SKonrad Dybcio }, { 9889066073cSRajendra Nayak .compatible = "qcom,msm8916-tsens", 989840a5bd3SRajendra Nayak .data = &data_8916, 9909066073cSRajendra Nayak }, { 991332bc8ebSShawn Guo .compatible = "qcom,msm8939-tsens", 992332bc8ebSShawn Guo .data = &data_8939, 993332bc8ebSShawn Guo }, { 9942caf7396SDmitry Baryshkov .compatible = "qcom,msm8960-tsens", 9952caf7396SDmitry Baryshkov .data = &data_8960, 9962caf7396SDmitry Baryshkov }, { 9979066073cSRajendra Nayak .compatible = "qcom,msm8974-tsens", 9985e6703bdSRajendra Nayak .data = &data_8974, 999d059c739SRajendra Nayak }, { 10000e580290SAngeloGioacchino Del Regno .compatible = "qcom,msm8976-tsens", 10010e580290SAngeloGioacchino Del Regno .data = &data_8976, 10020e580290SAngeloGioacchino Del Regno }, { 1003d059c739SRajendra Nayak .compatible = "qcom,msm8996-tsens", 1004d059c739SRajendra Nayak .data = &data_8996, 1005191dc74bSAmit Kucheria }, { 1006e8c24c6fSAmit Kucheria .compatible = "qcom,tsens-v1", 1007e8c24c6fSAmit Kucheria .data = &data_tsens_v1, 1008e8c24c6fSAmit Kucheria }, { 1009191dc74bSAmit Kucheria .compatible = "qcom,tsens-v2", 1010191dc74bSAmit Kucheria .data = &data_tsens_v2, 10119066073cSRajendra Nayak }, 10129066073cSRajendra Nayak {} 10139066073cSRajendra Nayak }; 10149066073cSRajendra Nayak MODULE_DEVICE_TABLE(of, tsens_table); 10159066073cSRajendra Nayak 1016ca1b9a9eSDaniel Lezcano static const struct thermal_zone_device_ops tsens_of_ops = { 10179066073cSRajendra Nayak .get_temp = tsens_get_temp, 1018634e11d5SAmit Kucheria .set_trips = tsens_set_trips, 10199066073cSRajendra Nayak }; 10209066073cSRajendra Nayak 102179125e03SAmit Kucheria static int tsens_register_irq(struct tsens_priv *priv, char *irqname, 102279125e03SAmit Kucheria irq_handler_t thread_fn) 102379125e03SAmit Kucheria { 102479125e03SAmit Kucheria struct platform_device *pdev; 102579125e03SAmit Kucheria int ret, irq; 102679125e03SAmit Kucheria 102779125e03SAmit Kucheria pdev = of_find_device_by_node(priv->dev->of_node); 102879125e03SAmit Kucheria if (!pdev) 102979125e03SAmit Kucheria return -ENODEV; 103079125e03SAmit Kucheria 103179125e03SAmit Kucheria irq = platform_get_irq_byname(pdev, irqname); 103279125e03SAmit Kucheria if (irq < 0) { 103379125e03SAmit Kucheria ret = irq; 103479125e03SAmit Kucheria /* For old DTs with no IRQ defined */ 103579125e03SAmit Kucheria if (irq == -ENXIO) 103679125e03SAmit Kucheria ret = 0; 103779125e03SAmit Kucheria } else { 103853e2a20eSAnsuel Smith /* VER_0 interrupt is TRIGGER_RISING, VER_0_1 and up is ONESHOT */ 103953e2a20eSAnsuel Smith if (tsens_version(priv) == VER_0) 104079125e03SAmit Kucheria ret = devm_request_threaded_irq(&pdev->dev, irq, 104153e2a20eSAnsuel Smith thread_fn, NULL, 104253e2a20eSAnsuel Smith IRQF_TRIGGER_RISING, 104353e2a20eSAnsuel Smith dev_name(&pdev->dev), 104453e2a20eSAnsuel Smith priv); 104553e2a20eSAnsuel Smith else 104653e2a20eSAnsuel Smith ret = devm_request_threaded_irq(&pdev->dev, irq, NULL, 104753e2a20eSAnsuel Smith thread_fn, IRQF_ONESHOT, 104853e2a20eSAnsuel Smith dev_name(&pdev->dev), 104953e2a20eSAnsuel Smith priv); 105053e2a20eSAnsuel Smith 105179125e03SAmit Kucheria if (ret) 105279125e03SAmit Kucheria dev_err(&pdev->dev, "%s: failed to get irq\n", 105379125e03SAmit Kucheria __func__); 105479125e03SAmit Kucheria else 105579125e03SAmit Kucheria enable_irq_wake(irq); 105679125e03SAmit Kucheria } 105779125e03SAmit Kucheria 105879125e03SAmit Kucheria put_device(&pdev->dev); 105979125e03SAmit Kucheria return ret; 106079125e03SAmit Kucheria } 106179125e03SAmit Kucheria 106269b628acSAmit Kucheria static int tsens_register(struct tsens_priv *priv) 10639066073cSRajendra Nayak { 106479125e03SAmit Kucheria int i, ret; 10659066073cSRajendra Nayak struct thermal_zone_device *tzd; 10669066073cSRajendra Nayak 106769b628acSAmit Kucheria for (i = 0; i < priv->num_sensors; i++) { 106869b628acSAmit Kucheria priv->sensor[i].priv = priv; 1069ca1b9a9eSDaniel Lezcano tzd = devm_thermal_of_zone_register(priv->dev, priv->sensor[i].hw_id, 107069b628acSAmit Kucheria &priv->sensor[i], 10719066073cSRajendra Nayak &tsens_of_ops); 10729066073cSRajendra Nayak if (IS_ERR(tzd)) 10739066073cSRajendra Nayak continue; 107469b628acSAmit Kucheria priv->sensor[i].tzd = tzd; 107569b628acSAmit Kucheria if (priv->ops->enable) 107669b628acSAmit Kucheria priv->ops->enable(priv, i); 10778556e19dSDmitry Baryshkov 10788556e19dSDmitry Baryshkov if (devm_thermal_add_hwmon_sysfs(tzd)) 10798556e19dSDmitry Baryshkov dev_warn(priv->dev, 10808556e19dSDmitry Baryshkov "Failed to add hwmon sysfs attributes\n"); 10819066073cSRajendra Nayak } 1082634e11d5SAmit Kucheria 108353e2a20eSAnsuel Smith /* VER_0 require to set MIN and MAX THRESH 108453e2a20eSAnsuel Smith * These 2 regs are set using the: 108553e2a20eSAnsuel Smith * - CRIT_THRESH_0 for MAX THRESH hardcoded to 120°C 108653e2a20eSAnsuel Smith * - CRIT_THRESH_1 for MIN THRESH hardcoded to 0°C 108753e2a20eSAnsuel Smith */ 108853e2a20eSAnsuel Smith if (tsens_version(priv) < VER_0_1) { 108953e2a20eSAnsuel Smith regmap_field_write(priv->rf[CRIT_THRESH_0], 109053e2a20eSAnsuel Smith tsens_mC_to_hw(priv->sensor, 120000)); 109153e2a20eSAnsuel Smith 109253e2a20eSAnsuel Smith regmap_field_write(priv->rf[CRIT_THRESH_1], 109353e2a20eSAnsuel Smith tsens_mC_to_hw(priv->sensor, 0)); 109453e2a20eSAnsuel Smith } 109553e2a20eSAnsuel Smith 10964360af35SRobert Marko if (priv->feat->combo_int) { 10974360af35SRobert Marko ret = tsens_register_irq(priv, "combined", 10984360af35SRobert Marko tsens_combined_irq_thread); 10994360af35SRobert Marko } else { 110079125e03SAmit Kucheria ret = tsens_register_irq(priv, "uplow", tsens_irq_thread); 110179125e03SAmit Kucheria if (ret < 0) 110279125e03SAmit Kucheria return ret; 1103634e11d5SAmit Kucheria 110479125e03SAmit Kucheria if (priv->feat->crit_int) 110579125e03SAmit Kucheria ret = tsens_register_irq(priv, "critical", 110679125e03SAmit Kucheria tsens_critical_irq_thread); 11074360af35SRobert Marko } 1108634e11d5SAmit Kucheria 1109634e11d5SAmit Kucheria return ret; 11109066073cSRajendra Nayak } 11119066073cSRajendra Nayak 11129066073cSRajendra Nayak static int tsens_probe(struct platform_device *pdev) 11139066073cSRajendra Nayak { 11149066073cSRajendra Nayak int ret, i; 11159066073cSRajendra Nayak struct device *dev; 11169066073cSRajendra Nayak struct device_node *np; 111769b628acSAmit Kucheria struct tsens_priv *priv; 11183c040ce0SAmit Kucheria const struct tsens_plat_data *data; 11199066073cSRajendra Nayak const struct of_device_id *id; 11206d7c70d1SBjorn Andersson u32 num_sensors; 11219066073cSRajendra Nayak 11229066073cSRajendra Nayak if (pdev->dev.of_node) 11239066073cSRajendra Nayak dev = &pdev->dev; 11249066073cSRajendra Nayak else 11259066073cSRajendra Nayak dev = pdev->dev.parent; 11269066073cSRajendra Nayak 11279066073cSRajendra Nayak np = dev->of_node; 11289066073cSRajendra Nayak 11299066073cSRajendra Nayak id = of_match_node(tsens_table, np); 113020d4fd84SRajendra Nayak if (id) 11319066073cSRajendra Nayak data = id->data; 113220d4fd84SRajendra Nayak else 113320d4fd84SRajendra Nayak data = &data_8960; 11349066073cSRajendra Nayak 11356d7c70d1SBjorn Andersson num_sensors = data->num_sensors; 11366d7c70d1SBjorn Andersson 11376d7c70d1SBjorn Andersson if (np) 11386d7c70d1SBjorn Andersson of_property_read_u32(np, "#qcom,sensors", &num_sensors); 11396d7c70d1SBjorn Andersson 11406d7c70d1SBjorn Andersson if (num_sensors <= 0) { 11413795ad5eSAmit Kucheria dev_err(dev, "%s: invalid number of sensors\n", __func__); 11429066073cSRajendra Nayak return -EINVAL; 11439066073cSRajendra Nayak } 11449066073cSRajendra Nayak 114569b628acSAmit Kucheria priv = devm_kzalloc(dev, 114669b628acSAmit Kucheria struct_size(priv, sensor, num_sensors), 11470ed2dd03SKees Cook GFP_KERNEL); 114869b628acSAmit Kucheria if (!priv) 11499066073cSRajendra Nayak return -ENOMEM; 11509066073cSRajendra Nayak 115169b628acSAmit Kucheria priv->dev = dev; 115269b628acSAmit Kucheria priv->num_sensors = num_sensors; 115369b628acSAmit Kucheria priv->ops = data->ops; 115469b628acSAmit Kucheria for (i = 0; i < priv->num_sensors; i++) { 11559066073cSRajendra Nayak if (data->hw_ids) 115669b628acSAmit Kucheria priv->sensor[i].hw_id = data->hw_ids[i]; 11579066073cSRajendra Nayak else 115869b628acSAmit Kucheria priv->sensor[i].hw_id = i; 11599066073cSRajendra Nayak } 1160c1997054SAmit Kucheria priv->feat = data->feat; 1161c1997054SAmit Kucheria priv->fields = data->fields; 11629066073cSRajendra Nayak 11630e9c0bc7SAmit Kucheria platform_set_drvdata(pdev, priv); 11640e9c0bc7SAmit Kucheria 116569b628acSAmit Kucheria if (!priv->ops || !priv->ops->init || !priv->ops->get_temp) 11669066073cSRajendra Nayak return -EINVAL; 11679066073cSRajendra Nayak 116869b628acSAmit Kucheria ret = priv->ops->init(priv); 11699066073cSRajendra Nayak if (ret < 0) { 11703795ad5eSAmit Kucheria dev_err(dev, "%s: init failed\n", __func__); 11719066073cSRajendra Nayak return ret; 11729066073cSRajendra Nayak } 11739066073cSRajendra Nayak 117469b628acSAmit Kucheria if (priv->ops->calibrate) { 117569b628acSAmit Kucheria ret = priv->ops->calibrate(priv); 11769066073cSRajendra Nayak if (ret < 0) { 1177fc7d18cfSAmit Kucheria if (ret != -EPROBE_DEFER) 11783795ad5eSAmit Kucheria dev_err(dev, "%s: calibration failed\n", __func__); 11799066073cSRajendra Nayak return ret; 11809066073cSRajendra Nayak } 11819066073cSRajendra Nayak } 11829066073cSRajendra Nayak 1183de48d876SChristian Marangi ret = tsens_register(priv); 1184de48d876SChristian Marangi if (!ret) 1185de48d876SChristian Marangi tsens_debug_init(pdev); 1186de48d876SChristian Marangi 1187de48d876SChristian Marangi return ret; 11889066073cSRajendra Nayak } 11899066073cSRajendra Nayak 11909066073cSRajendra Nayak static int tsens_remove(struct platform_device *pdev) 11919066073cSRajendra Nayak { 119269b628acSAmit Kucheria struct tsens_priv *priv = platform_get_drvdata(pdev); 11939066073cSRajendra Nayak 11947c938f48SAmit Kucheria debugfs_remove_recursive(priv->debug_root); 1195634e11d5SAmit Kucheria tsens_disable_irq(priv); 119669b628acSAmit Kucheria if (priv->ops->disable) 119769b628acSAmit Kucheria priv->ops->disable(priv); 11989066073cSRajendra Nayak 11999066073cSRajendra Nayak return 0; 12009066073cSRajendra Nayak } 12019066073cSRajendra Nayak 12029066073cSRajendra Nayak static struct platform_driver tsens_driver = { 12039066073cSRajendra Nayak .probe = tsens_probe, 12049066073cSRajendra Nayak .remove = tsens_remove, 12059066073cSRajendra Nayak .driver = { 12069066073cSRajendra Nayak .name = "qcom-tsens", 12079066073cSRajendra Nayak .pm = &tsens_pm_ops, 12089066073cSRajendra Nayak .of_match_table = tsens_table, 12099066073cSRajendra Nayak }, 12109066073cSRajendra Nayak }; 12119066073cSRajendra Nayak module_platform_driver(tsens_driver); 12129066073cSRajendra Nayak 12139066073cSRajendra Nayak MODULE_LICENSE("GPL v2"); 12149066073cSRajendra Nayak MODULE_DESCRIPTION("QCOM Temperature Sensor driver"); 12159066073cSRajendra Nayak MODULE_ALIAS("platform:qcom-tsens"); 1216