1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (c) 2015, The Linux Foundation. All rights reserved. 4 */ 5 6 #include <linux/bitfield.h> 7 #include <linux/nvmem-consumer.h> 8 #include <linux/platform_device.h> 9 #include "tsens.h" 10 11 /* ----- SROT ------ */ 12 #define SROT_CTRL_OFF 0x0000 13 14 /* ----- TM ------ */ 15 #define TM_INT_EN_OFF 0x0000 16 #define TM_Sn_UPPER_LOWER_STATUS_CTRL_OFF 0x0004 17 #define TM_Sn_STATUS_OFF 0x0030 18 #define TM_TRDY_OFF 0x005c 19 20 /* extra data for 8974 */ 21 #define BKP_SEL 0x3 22 #define BKP_REDUN_SEL 0xe0000000 23 24 #define BIT_APPEND 0x3 25 26 static struct tsens_legacy_calibration_format tsens_8916_nvmem = { 27 .base_len = 7, 28 .base_shift = 3, 29 .sp_len = 5, 30 .mode = { 0, 29, 1 }, 31 .invalid = { 0, 31, 1 }, 32 .base = { { 0, 0 }, { 1, 25 } }, 33 .sp = { 34 { { 0, 7 }, { 0, 12 } }, 35 { { 0, 17 }, { 0, 22 } }, 36 { { 0, 27 }, { 1, 0 } }, 37 { { 1, 5 }, { 1, 10 } }, 38 { { 1, 15 }, { 1, 20 } }, 39 }, 40 }; 41 42 static struct tsens_legacy_calibration_format tsens_8974_nvmem = { 43 .base_len = 8, 44 .base_shift = 2, 45 .sp_len = 6, 46 .mode = { 1, 30 }, 47 .invalid = { 3, 30 }, 48 .base = { { 0, 0 }, { 2, 12 } }, 49 .sp = { 50 { { 0, 8 }, { 2, 20 } }, 51 { { 0, 14 }, { 2, 26 } }, 52 { { 0, 20 }, { 3, 0 } }, 53 { { 0, 26 }, { 3, 6 } }, 54 { { 1, 0 }, { 3, 12 } }, 55 { { 1, 6 }, { 3, 18 } }, 56 { { 1, 12 }, { 3, 24 } }, 57 { { 1, 18 }, { 4, 0 } }, 58 { { 1, 24 }, { 4, 6 } }, 59 { { 2, 0 }, { 4, 12 } }, 60 { { 2, 6 }, { 4, 18 } }, 61 }, 62 }; 63 64 static struct tsens_legacy_calibration_format tsens_8974_backup_nvmem = { 65 .base_len = 8, 66 .base_shift = 2, 67 .sp_len = 6, 68 .mode = { 4, 30, 1 }, 69 .invalid = { 5, 30, 1 }, 70 .base = { { 0, 0 }, { 2, 18 } }, 71 .sp = { 72 { { 0, 8 }, { 2, 26 } }, 73 { { 0, 14 }, { 3, 0 } }, 74 { { 0, 20 }, { 3, 6 } }, 75 { { 0, 26 }, { 3, 12 } }, 76 { { 1, 0 }, { 3, 18 } }, 77 { { 1, 6 }, { 3, 24, 1 } }, 78 { { 1, 12 }, { 4, 0, 1 } }, 79 { { 1, 18 }, { 4, 6, 1 } }, 80 { { 2, 0 }, { 4, 12, 1 } }, 81 { { 2, 6 }, { 4, 18, 1 } }, 82 { { 2, 12 }, { 4, 24, 1 } }, 83 }, 84 }; 85 86 static int calibrate_8916(struct tsens_priv *priv) 87 { 88 u32 p1[5], p2[5]; 89 u32 *qfprom_cdata, *qfprom_csel; 90 int mode, ret; 91 92 ret = tsens_calibrate_nvmem(priv, 3); 93 if (!ret) 94 return 0; 95 96 qfprom_cdata = (u32 *)qfprom_read(priv->dev, "calib"); 97 if (IS_ERR(qfprom_cdata)) 98 return PTR_ERR(qfprom_cdata); 99 100 qfprom_csel = (u32 *)qfprom_read(priv->dev, "calib_sel"); 101 if (IS_ERR(qfprom_csel)) { 102 kfree(qfprom_cdata); 103 return PTR_ERR(qfprom_csel); 104 } 105 106 mode = tsens_read_calibration_legacy(priv, &tsens_8916_nvmem, 107 p1, p2, 108 qfprom_cdata, qfprom_csel); 109 110 compute_intercept_slope(priv, p1, p2, mode); 111 kfree(qfprom_cdata); 112 kfree(qfprom_csel); 113 114 return 0; 115 } 116 117 static void fixup_8974_points(int mode, u32 *p1, u32 *p2) 118 { 119 int i; 120 121 if (mode == NO_PT_CALIB) { 122 p1[0] += 2; 123 p1[1] += 9; 124 p1[2] += 3; 125 p1[3] += 9; 126 p1[4] += 5; 127 p1[5] += 9; 128 p1[6] += 7; 129 p1[7] += 10; 130 p1[8] += 8; 131 p1[9] += 9; 132 p1[10] += 8; 133 } else { 134 for (i = 0; i < 11; i++) { 135 /* 136 * ONE_PT_CALIB requires using addition here instead of 137 * using OR operation. 138 */ 139 p1[i] += BIT_APPEND; 140 p2[i] += BIT_APPEND; 141 } 142 } 143 144 } 145 146 static int calibrate_8974_nvmem(struct tsens_priv *priv) 147 { 148 u32 p1[11], p2[11]; 149 u32 backup; 150 int ret, mode; 151 152 ret = nvmem_cell_read_variable_le_u32(priv->dev, "use_backup", &backup); 153 if (ret == -ENOENT) 154 dev_warn(priv->dev, "Please migrate to separate nvmem cells for calibration data\n"); 155 if (ret < 0) 156 return ret; 157 158 mode = tsens_read_calibration(priv, 2, p1, p2, backup == BKP_SEL); 159 if (mode < 0) 160 return mode; 161 162 fixup_8974_points(mode, p1, p2); 163 164 compute_intercept_slope(priv, p1, p2, mode); 165 166 return 0; 167 } 168 169 static int calibrate_8974(struct tsens_priv *priv) 170 { 171 u32 p1[11], p2[11]; 172 u32 *calib, *bkp; 173 u32 calib_redun_sel; 174 int mode, ret; 175 176 ret = calibrate_8974_nvmem(priv); 177 if (ret == 0) 178 return 0; 179 180 calib = (u32 *)qfprom_read(priv->dev, "calib"); 181 if (IS_ERR(calib)) 182 return PTR_ERR(calib); 183 184 bkp = (u32 *)qfprom_read(priv->dev, "calib_backup"); 185 if (IS_ERR(bkp)) { 186 kfree(calib); 187 return PTR_ERR(bkp); 188 } 189 190 calib_redun_sel = FIELD_GET(BKP_REDUN_SEL, bkp[1]); 191 192 if (calib_redun_sel == BKP_SEL) 193 mode = tsens_read_calibration_legacy(priv, &tsens_8974_backup_nvmem, 194 p1, p2, 195 bkp, calib); 196 else 197 mode = tsens_read_calibration_legacy(priv, &tsens_8974_nvmem, 198 p1, p2, 199 calib, NULL); 200 201 fixup_8974_points(mode, p1, p2); 202 203 compute_intercept_slope(priv, p1, p2, mode); 204 kfree(calib); 205 kfree(bkp); 206 207 return 0; 208 } 209 210 static int __init init_8226(struct tsens_priv *priv) 211 { 212 priv->sensor[0].slope = 2901; 213 priv->sensor[1].slope = 2846; 214 priv->sensor[2].slope = 3038; 215 priv->sensor[3].slope = 2955; 216 priv->sensor[4].slope = 2901; 217 priv->sensor[5].slope = 2846; 218 219 return init_common(priv); 220 } 221 222 static int __init init_8909(struct tsens_priv *priv) 223 { 224 int i; 225 226 for (i = 0; i < priv->num_sensors; ++i) 227 priv->sensor[i].slope = 3000; 228 229 priv->sensor[0].p1_calib_offset = 0; 230 priv->sensor[0].p2_calib_offset = 0; 231 priv->sensor[1].p1_calib_offset = -10; 232 priv->sensor[1].p2_calib_offset = -6; 233 priv->sensor[2].p1_calib_offset = 0; 234 priv->sensor[2].p2_calib_offset = 0; 235 priv->sensor[3].p1_calib_offset = -9; 236 priv->sensor[3].p2_calib_offset = -9; 237 priv->sensor[4].p1_calib_offset = -8; 238 priv->sensor[4].p2_calib_offset = -10; 239 240 return init_common(priv); 241 } 242 243 static int __init init_8939(struct tsens_priv *priv) { 244 priv->sensor[0].slope = 2911; 245 priv->sensor[1].slope = 2789; 246 priv->sensor[2].slope = 2906; 247 priv->sensor[3].slope = 2763; 248 priv->sensor[4].slope = 2922; 249 priv->sensor[5].slope = 2867; 250 priv->sensor[6].slope = 2833; 251 priv->sensor[7].slope = 2838; 252 priv->sensor[8].slope = 2840; 253 /* priv->sensor[9].slope = 2852; */ 254 255 return init_common(priv); 256 } 257 258 static int __init init_9607(struct tsens_priv *priv) 259 { 260 int i; 261 262 for (i = 0; i < priv->num_sensors; ++i) 263 priv->sensor[i].slope = 3000; 264 265 priv->sensor[0].p1_calib_offset = 1; 266 priv->sensor[0].p2_calib_offset = 1; 267 priv->sensor[1].p1_calib_offset = -4; 268 priv->sensor[1].p2_calib_offset = -2; 269 priv->sensor[2].p1_calib_offset = 4; 270 priv->sensor[2].p2_calib_offset = 8; 271 priv->sensor[3].p1_calib_offset = -3; 272 priv->sensor[3].p2_calib_offset = -5; 273 priv->sensor[4].p1_calib_offset = -4; 274 priv->sensor[4].p2_calib_offset = -4; 275 276 return init_common(priv); 277 } 278 279 /* v0.1: 8226, 8909, 8916, 8939, 8974, 9607 */ 280 281 static struct tsens_features tsens_v0_1_feat = { 282 .ver_major = VER_0_1, 283 .crit_int = 0, 284 .combo_int = 0, 285 .adc = 1, 286 .srot_split = 1, 287 .max_sensors = 11, 288 .trip_min_temp = -40000, 289 .trip_max_temp = 120000, 290 }; 291 292 static const struct reg_field tsens_v0_1_regfields[MAX_REGFIELDS] = { 293 /* ----- SROT ------ */ 294 /* No VERSION information */ 295 296 /* CTRL_OFFSET */ 297 [TSENS_EN] = REG_FIELD(SROT_CTRL_OFF, 0, 0), 298 [TSENS_SW_RST] = REG_FIELD(SROT_CTRL_OFF, 1, 1), 299 300 /* ----- TM ------ */ 301 /* INTERRUPT ENABLE */ 302 [INT_EN] = REG_FIELD(TM_INT_EN_OFF, 0, 0), 303 304 /* UPPER/LOWER TEMPERATURE THRESHOLDS */ 305 REG_FIELD_FOR_EACH_SENSOR11(LOW_THRESH, TM_Sn_UPPER_LOWER_STATUS_CTRL_OFF, 0, 9), 306 REG_FIELD_FOR_EACH_SENSOR11(UP_THRESH, TM_Sn_UPPER_LOWER_STATUS_CTRL_OFF, 10, 19), 307 308 /* UPPER/LOWER INTERRUPTS [CLEAR/STATUS] */ 309 REG_FIELD_FOR_EACH_SENSOR11(LOW_INT_CLEAR, TM_Sn_UPPER_LOWER_STATUS_CTRL_OFF, 20, 20), 310 REG_FIELD_FOR_EACH_SENSOR11(UP_INT_CLEAR, TM_Sn_UPPER_LOWER_STATUS_CTRL_OFF, 21, 21), 311 312 /* NO CRITICAL INTERRUPT SUPPORT on v0.1 */ 313 314 /* Sn_STATUS */ 315 REG_FIELD_FOR_EACH_SENSOR11(LAST_TEMP, TM_Sn_STATUS_OFF, 0, 9), 316 /* No VALID field on v0.1 */ 317 /* xxx_STATUS bits: 1 == threshold violated */ 318 REG_FIELD_FOR_EACH_SENSOR11(MIN_STATUS, TM_Sn_STATUS_OFF, 10, 10), 319 REG_FIELD_FOR_EACH_SENSOR11(LOWER_STATUS, TM_Sn_STATUS_OFF, 11, 11), 320 REG_FIELD_FOR_EACH_SENSOR11(UPPER_STATUS, TM_Sn_STATUS_OFF, 12, 12), 321 /* No CRITICAL field on v0.1 */ 322 REG_FIELD_FOR_EACH_SENSOR11(MAX_STATUS, TM_Sn_STATUS_OFF, 13, 13), 323 324 /* TRDY: 1=ready, 0=in progress */ 325 [TRDY] = REG_FIELD(TM_TRDY_OFF, 0, 0), 326 }; 327 328 static const struct tsens_ops ops_v0_1 = { 329 .init = init_common, 330 .calibrate = tsens_calibrate_common, 331 .get_temp = get_temp_common, 332 }; 333 334 static const struct tsens_ops ops_8226 = { 335 .init = init_8226, 336 .calibrate = tsens_calibrate_common, 337 .get_temp = get_temp_common, 338 }; 339 340 struct tsens_plat_data data_8226 = { 341 .num_sensors = 6, 342 .ops = &ops_8226, 343 .feat = &tsens_v0_1_feat, 344 .fields = tsens_v0_1_regfields, 345 }; 346 347 static const struct tsens_ops ops_8909 = { 348 .init = init_8909, 349 .calibrate = tsens_calibrate_common, 350 .get_temp = get_temp_common, 351 }; 352 353 struct tsens_plat_data data_8909 = { 354 .num_sensors = 5, 355 .ops = &ops_8909, 356 .feat = &tsens_v0_1_feat, 357 .fields = tsens_v0_1_regfields, 358 }; 359 360 static const struct tsens_ops ops_8916 = { 361 .init = init_common, 362 .calibrate = calibrate_8916, 363 .get_temp = get_temp_common, 364 }; 365 366 struct tsens_plat_data data_8916 = { 367 .num_sensors = 5, 368 .ops = &ops_8916, 369 .hw_ids = (unsigned int []){0, 1, 2, 4, 5 }, 370 371 .feat = &tsens_v0_1_feat, 372 .fields = tsens_v0_1_regfields, 373 }; 374 375 static const struct tsens_ops ops_8939 = { 376 .init = init_8939, 377 .calibrate = tsens_calibrate_common, 378 .get_temp = get_temp_common, 379 }; 380 381 struct tsens_plat_data data_8939 = { 382 .num_sensors = 9, 383 .ops = &ops_8939, 384 .hw_ids = (unsigned int []){ 0, 1, 2, 3, 5, 6, 7, 8, 9, /* 10 */ }, 385 386 .feat = &tsens_v0_1_feat, 387 .fields = tsens_v0_1_regfields, 388 }; 389 390 static const struct tsens_ops ops_8974 = { 391 .init = init_common, 392 .calibrate = calibrate_8974, 393 .get_temp = get_temp_common, 394 }; 395 396 struct tsens_plat_data data_8974 = { 397 .num_sensors = 11, 398 .ops = &ops_8974, 399 .feat = &tsens_v0_1_feat, 400 .fields = tsens_v0_1_regfields, 401 }; 402 403 static const struct tsens_ops ops_9607 = { 404 .init = init_9607, 405 .calibrate = tsens_calibrate_common, 406 .get_temp = get_temp_common, 407 }; 408 409 struct tsens_plat_data data_9607 = { 410 .num_sensors = 5, 411 .ops = &ops_9607, 412 .feat = &tsens_v0_1_feat, 413 .fields = tsens_v0_1_regfields, 414 }; 415