1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Copyright (C) 2020 BAIKAL ELECTRONICS, JSC 4 * 5 * Authors: 6 * Maxim Kaurkin <maxim.kaurkin@baikalelectronics.ru> 7 * Serge Semin <Sergey.Semin@baikalelectronics.ru> 8 * 9 * Baikal-T1 Process, Voltage, Temperature sensor driver 10 */ 11 12 #include <linux/bitfield.h> 13 #include <linux/bitops.h> 14 #include <linux/clk.h> 15 #include <linux/completion.h> 16 #include <linux/device.h> 17 #include <linux/hwmon-sysfs.h> 18 #include <linux/hwmon.h> 19 #include <linux/interrupt.h> 20 #include <linux/io.h> 21 #include <linux/kernel.h> 22 #include <linux/ktime.h> 23 #include <linux/limits.h> 24 #include <linux/module.h> 25 #include <linux/mutex.h> 26 #include <linux/of.h> 27 #include <linux/platform_device.h> 28 #include <linux/seqlock.h> 29 #include <linux/sysfs.h> 30 #include <linux/types.h> 31 32 #include "bt1-pvt.h" 33 34 /* 35 * For the sake of the code simplification we created the sensors info table 36 * with the sensor names, activation modes, threshold registers base address 37 * and the thresholds bit fields. 38 */ 39 static const struct pvt_sensor_info pvt_info[] = { 40 PVT_SENSOR_INFO(0, "CPU Core Temperature", hwmon_temp, TEMP, TTHRES), 41 PVT_SENSOR_INFO(0, "CPU Core Voltage", hwmon_in, VOLT, VTHRES), 42 PVT_SENSOR_INFO(1, "CPU Core Low-Vt", hwmon_in, LVT, LTHRES), 43 PVT_SENSOR_INFO(2, "CPU Core High-Vt", hwmon_in, HVT, HTHRES), 44 PVT_SENSOR_INFO(3, "CPU Core Standard-Vt", hwmon_in, SVT, STHRES), 45 }; 46 47 /* 48 * The original translation formulae of the temperature (in degrees of Celsius) 49 * to PVT data and vice-versa are following: 50 * N = 1.8322e-8*(T^4) + 2.343e-5*(T^3) + 8.7018e-3*(T^2) + 3.9269*(T^1) + 51 * 1.7204e2, 52 * T = -1.6743e-11*(N^4) + 8.1542e-8*(N^3) + -1.8201e-4*(N^2) + 53 * 3.1020e-1*(N^1) - 4.838e1, 54 * where T = [-48.380, 147.438]C and N = [0, 1023]. 55 * They must be accordingly altered to be suitable for the integer arithmetics. 56 * The technique is called 'factor redistribution', which just makes sure the 57 * multiplications and divisions are made so to have a result of the operations 58 * within the integer numbers limit. In addition we need to translate the 59 * formulae to accept millidegrees of Celsius. Here what they look like after 60 * the alterations: 61 * N = (18322e-20*(T^4) + 2343e-13*(T^3) + 87018e-9*(T^2) + 39269e-3*T + 62 * 17204e2) / 1e4, 63 * T = -16743e-12*(D^4) + 81542e-9*(D^3) - 182010e-6*(D^2) + 310200e-3*D - 64 * 48380, 65 * where T = [-48380, 147438] mC and N = [0, 1023]. 66 */ 67 static const struct pvt_poly __maybe_unused poly_temp_to_N = { 68 .total_divider = 10000, 69 .terms = { 70 {4, 18322, 10000, 10000}, 71 {3, 2343, 10000, 10}, 72 {2, 87018, 10000, 10}, 73 {1, 39269, 1000, 1}, 74 {0, 1720400, 1, 1} 75 } 76 }; 77 78 static const struct pvt_poly poly_N_to_temp = { 79 .total_divider = 1, 80 .terms = { 81 {4, -16743, 1000, 1}, 82 {3, 81542, 1000, 1}, 83 {2, -182010, 1000, 1}, 84 {1, 310200, 1000, 1}, 85 {0, -48380, 1, 1} 86 } 87 }; 88 89 /* 90 * Similar alterations are performed for the voltage conversion equations. 91 * The original formulae are: 92 * N = 1.8658e3*V - 1.1572e3, 93 * V = (N + 1.1572e3) / 1.8658e3, 94 * where V = [0.620, 1.168] V and N = [0, 1023]. 95 * After the optimization they looks as follows: 96 * N = (18658e-3*V - 11572) / 10, 97 * V = N * 10^5 / 18658 + 11572 * 10^4 / 18658. 98 */ 99 static const struct pvt_poly __maybe_unused poly_volt_to_N = { 100 .total_divider = 10, 101 .terms = { 102 {1, 18658, 1000, 1}, 103 {0, -11572, 1, 1} 104 } 105 }; 106 107 static const struct pvt_poly poly_N_to_volt = { 108 .total_divider = 10, 109 .terms = { 110 {1, 100000, 18658, 1}, 111 {0, 115720000, 1, 18658} 112 } 113 }; 114 115 /* 116 * Here is the polynomial calculation function, which performs the 117 * redistributed terms calculations. It's pretty straightforward. We walk 118 * over each degree term up to the free one, and perform the redistributed 119 * multiplication of the term coefficient, its divider (as for the rationale 120 * fraction representation), data power and the rational fraction divider 121 * leftover. Then all of this is collected in a total sum variable, which 122 * value is normalized by the total divider before being returned. 123 */ 124 static long pvt_calc_poly(const struct pvt_poly *poly, long data) 125 { 126 const struct pvt_poly_term *term = poly->terms; 127 long tmp, ret = 0; 128 int deg; 129 130 do { 131 tmp = term->coef; 132 for (deg = 0; deg < term->deg; ++deg) 133 tmp = mult_frac(tmp, data, term->divider); 134 ret += tmp / term->divider_leftover; 135 } while ((term++)->deg); 136 137 return ret / poly->total_divider; 138 } 139 140 static inline u32 pvt_update(void __iomem *reg, u32 mask, u32 data) 141 { 142 u32 old; 143 144 old = readl_relaxed(reg); 145 writel((old & ~mask) | (data & mask), reg); 146 147 return old & mask; 148 } 149 150 /* 151 * Baikal-T1 PVT mode can be updated only when the controller is disabled. 152 * So first we disable it, then set the new mode together with the controller 153 * getting back enabled. The same concerns the temperature trim and 154 * measurements timeout. If it is necessary the interface mutex is supposed 155 * to be locked at the time the operations are performed. 156 */ 157 static inline void pvt_set_mode(struct pvt_hwmon *pvt, u32 mode) 158 { 159 u32 old; 160 161 mode = FIELD_PREP(PVT_CTRL_MODE_MASK, mode); 162 163 old = pvt_update(pvt->regs + PVT_CTRL, PVT_CTRL_EN, 0); 164 pvt_update(pvt->regs + PVT_CTRL, PVT_CTRL_MODE_MASK | PVT_CTRL_EN, 165 mode | old); 166 } 167 168 static inline u32 pvt_calc_trim(long temp) 169 { 170 temp = clamp_val(temp, 0, PVT_TRIM_TEMP); 171 172 return DIV_ROUND_UP(temp, PVT_TRIM_STEP); 173 } 174 175 static inline void pvt_set_trim(struct pvt_hwmon *pvt, u32 trim) 176 { 177 u32 old; 178 179 trim = FIELD_PREP(PVT_CTRL_TRIM_MASK, trim); 180 181 old = pvt_update(pvt->regs + PVT_CTRL, PVT_CTRL_EN, 0); 182 pvt_update(pvt->regs + PVT_CTRL, PVT_CTRL_TRIM_MASK | PVT_CTRL_EN, 183 trim | old); 184 } 185 186 static inline void pvt_set_tout(struct pvt_hwmon *pvt, u32 tout) 187 { 188 u32 old; 189 190 old = pvt_update(pvt->regs + PVT_CTRL, PVT_CTRL_EN, 0); 191 writel(tout, pvt->regs + PVT_TTIMEOUT); 192 pvt_update(pvt->regs + PVT_CTRL, PVT_CTRL_EN, old); 193 } 194 195 /* 196 * This driver can optionally provide the hwmon alarms for each sensor the PVT 197 * controller supports. The alarms functionality is made compile-time 198 * configurable due to the hardware interface implementation peculiarity 199 * described further in this comment. So in case if alarms are unnecessary in 200 * your system design it's recommended to have them disabled to prevent the PVT 201 * IRQs being periodically raised to get the data cache/alarms status up to 202 * date. 203 * 204 * Baikal-T1 PVT embedded controller is based on the Analog Bits PVT sensor, 205 * but is equipped with a dedicated control wrapper. It exposes the PVT 206 * sub-block registers space via the APB3 bus. In addition the wrapper provides 207 * a common interrupt vector of the sensors conversion completion events and 208 * threshold value alarms. Alas the wrapper interface hasn't been fully thought 209 * through. There is only one sensor can be activated at a time, for which the 210 * thresholds comparator is enabled right after the data conversion is 211 * completed. Due to this if alarms need to be implemented for all available 212 * sensors we can't just set the thresholds and enable the interrupts. We need 213 * to enable the sensors one after another and let the controller to detect 214 * the alarms by itself at each conversion. This also makes pointless to handle 215 * the alarms interrupts, since in occasion they happen synchronously with 216 * data conversion completion. The best driver design would be to have the 217 * completion interrupts enabled only and keep the converted value in the 218 * driver data cache. This solution is implemented if hwmon alarms are enabled 219 * in this driver. In case if the alarms are disabled, the conversion is 220 * performed on demand at the time a sensors input file is read. 221 */ 222 223 #if defined(CONFIG_SENSORS_BT1_PVT_ALARMS) 224 225 #define pvt_hard_isr NULL 226 227 static irqreturn_t pvt_soft_isr(int irq, void *data) 228 { 229 const struct pvt_sensor_info *info; 230 struct pvt_hwmon *pvt = data; 231 struct pvt_cache *cache; 232 u32 val, thres_sts, old; 233 234 /* 235 * DVALID bit will be cleared by reading the data. We need to save the 236 * status before the next conversion happens. Threshold events will be 237 * handled a bit later. 238 */ 239 thres_sts = readl(pvt->regs + PVT_RAW_INTR_STAT); 240 241 /* 242 * Then lets recharge the PVT interface with the next sampling mode. 243 * Lock the interface mutex to serialize trim, timeouts and alarm 244 * thresholds settings. 245 */ 246 cache = &pvt->cache[pvt->sensor]; 247 info = &pvt_info[pvt->sensor]; 248 pvt->sensor = (pvt->sensor == PVT_SENSOR_LAST) ? 249 PVT_SENSOR_FIRST : (pvt->sensor + 1); 250 251 /* 252 * For some reason we have to mask the interrupt before changing the 253 * mode, otherwise sometimes the temperature mode doesn't get 254 * activated even though the actual mode in the ctrl register 255 * corresponds to one. Then we read the data. By doing so we also 256 * recharge the data conversion. After this the mode corresponding 257 * to the next sensor in the row is set. Finally we enable the 258 * interrupts back. 259 */ 260 mutex_lock(&pvt->iface_mtx); 261 262 old = pvt_update(pvt->regs + PVT_INTR_MASK, PVT_INTR_DVALID, 263 PVT_INTR_DVALID); 264 265 val = readl(pvt->regs + PVT_DATA); 266 267 pvt_set_mode(pvt, pvt_info[pvt->sensor].mode); 268 269 pvt_update(pvt->regs + PVT_INTR_MASK, PVT_INTR_DVALID, old); 270 271 mutex_unlock(&pvt->iface_mtx); 272 273 /* 274 * We can now update the data cache with data just retrieved from the 275 * sensor. Lock write-seqlock to make sure the reader has a coherent 276 * data. 277 */ 278 write_seqlock(&cache->data_seqlock); 279 280 cache->data = FIELD_GET(PVT_DATA_DATA_MASK, val); 281 282 write_sequnlock(&cache->data_seqlock); 283 284 /* 285 * While PVT core is doing the next mode data conversion, we'll check 286 * whether the alarms were triggered for the current sensor. Note that 287 * according to the documentation only one threshold IRQ status can be 288 * set at a time, that's why if-else statement is utilized. 289 */ 290 if ((thres_sts & info->thres_sts_lo) ^ cache->thres_sts_lo) { 291 WRITE_ONCE(cache->thres_sts_lo, thres_sts & info->thres_sts_lo); 292 hwmon_notify_event(pvt->hwmon, info->type, info->attr_min_alarm, 293 info->channel); 294 } else if ((thres_sts & info->thres_sts_hi) ^ cache->thres_sts_hi) { 295 WRITE_ONCE(cache->thres_sts_hi, thres_sts & info->thres_sts_hi); 296 hwmon_notify_event(pvt->hwmon, info->type, info->attr_max_alarm, 297 info->channel); 298 } 299 300 return IRQ_HANDLED; 301 } 302 303 static inline umode_t pvt_limit_is_visible(enum pvt_sensor_type type) 304 { 305 return 0644; 306 } 307 308 static inline umode_t pvt_alarm_is_visible(enum pvt_sensor_type type) 309 { 310 return 0444; 311 } 312 313 static int pvt_read_data(struct pvt_hwmon *pvt, enum pvt_sensor_type type, 314 long *val) 315 { 316 struct pvt_cache *cache = &pvt->cache[type]; 317 unsigned int seq; 318 u32 data; 319 320 do { 321 seq = read_seqbegin(&cache->data_seqlock); 322 data = cache->data; 323 } while (read_seqretry(&cache->data_seqlock, seq)); 324 325 if (type == PVT_TEMP) 326 *val = pvt_calc_poly(&poly_N_to_temp, data); 327 else 328 *val = pvt_calc_poly(&poly_N_to_volt, data); 329 330 return 0; 331 } 332 333 static int pvt_read_limit(struct pvt_hwmon *pvt, enum pvt_sensor_type type, 334 bool is_low, long *val) 335 { 336 u32 data; 337 338 /* No need in serialization, since it is just read from MMIO. */ 339 data = readl(pvt->regs + pvt_info[type].thres_base); 340 341 if (is_low) 342 data = FIELD_GET(PVT_THRES_LO_MASK, data); 343 else 344 data = FIELD_GET(PVT_THRES_HI_MASK, data); 345 346 if (type == PVT_TEMP) 347 *val = pvt_calc_poly(&poly_N_to_temp, data); 348 else 349 *val = pvt_calc_poly(&poly_N_to_volt, data); 350 351 return 0; 352 } 353 354 static int pvt_write_limit(struct pvt_hwmon *pvt, enum pvt_sensor_type type, 355 bool is_low, long val) 356 { 357 u32 data, limit, mask; 358 int ret; 359 360 if (type == PVT_TEMP) { 361 val = clamp(val, PVT_TEMP_MIN, PVT_TEMP_MAX); 362 data = pvt_calc_poly(&poly_temp_to_N, val); 363 } else { 364 val = clamp(val, PVT_VOLT_MIN, PVT_VOLT_MAX); 365 data = pvt_calc_poly(&poly_volt_to_N, val); 366 } 367 368 /* Serialize limit update, since a part of the register is changed. */ 369 ret = mutex_lock_interruptible(&pvt->iface_mtx); 370 if (ret) 371 return ret; 372 373 /* Make sure the upper and lower ranges don't intersect. */ 374 limit = readl(pvt->regs + pvt_info[type].thres_base); 375 if (is_low) { 376 limit = FIELD_GET(PVT_THRES_HI_MASK, limit); 377 data = clamp_val(data, PVT_DATA_MIN, limit); 378 data = FIELD_PREP(PVT_THRES_LO_MASK, data); 379 mask = PVT_THRES_LO_MASK; 380 } else { 381 limit = FIELD_GET(PVT_THRES_LO_MASK, limit); 382 data = clamp_val(data, limit, PVT_DATA_MAX); 383 data = FIELD_PREP(PVT_THRES_HI_MASK, data); 384 mask = PVT_THRES_HI_MASK; 385 } 386 387 pvt_update(pvt->regs + pvt_info[type].thres_base, mask, data); 388 389 mutex_unlock(&pvt->iface_mtx); 390 391 return 0; 392 } 393 394 static int pvt_read_alarm(struct pvt_hwmon *pvt, enum pvt_sensor_type type, 395 bool is_low, long *val) 396 { 397 if (is_low) 398 *val = !!READ_ONCE(pvt->cache[type].thres_sts_lo); 399 else 400 *val = !!READ_ONCE(pvt->cache[type].thres_sts_hi); 401 402 return 0; 403 } 404 405 static const struct hwmon_channel_info *pvt_channel_info[] = { 406 HWMON_CHANNEL_INFO(chip, 407 HWMON_C_REGISTER_TZ | HWMON_C_UPDATE_INTERVAL), 408 HWMON_CHANNEL_INFO(temp, 409 HWMON_T_INPUT | HWMON_T_TYPE | HWMON_T_LABEL | 410 HWMON_T_MIN | HWMON_T_MIN_ALARM | 411 HWMON_T_MAX | HWMON_T_MAX_ALARM | 412 HWMON_T_OFFSET), 413 HWMON_CHANNEL_INFO(in, 414 HWMON_I_INPUT | HWMON_I_LABEL | 415 HWMON_I_MIN | HWMON_I_MIN_ALARM | 416 HWMON_I_MAX | HWMON_I_MAX_ALARM, 417 HWMON_I_INPUT | HWMON_I_LABEL | 418 HWMON_I_MIN | HWMON_I_MIN_ALARM | 419 HWMON_I_MAX | HWMON_I_MAX_ALARM, 420 HWMON_I_INPUT | HWMON_I_LABEL | 421 HWMON_I_MIN | HWMON_I_MIN_ALARM | 422 HWMON_I_MAX | HWMON_I_MAX_ALARM, 423 HWMON_I_INPUT | HWMON_I_LABEL | 424 HWMON_I_MIN | HWMON_I_MIN_ALARM | 425 HWMON_I_MAX | HWMON_I_MAX_ALARM), 426 NULL 427 }; 428 429 #else /* !CONFIG_SENSORS_BT1_PVT_ALARMS */ 430 431 static irqreturn_t pvt_hard_isr(int irq, void *data) 432 { 433 struct pvt_hwmon *pvt = data; 434 struct pvt_cache *cache; 435 u32 val; 436 437 /* 438 * Mask the DVALID interrupt so after exiting from the handler a 439 * repeated conversion wouldn't happen. 440 */ 441 pvt_update(pvt->regs + PVT_INTR_MASK, PVT_INTR_DVALID, 442 PVT_INTR_DVALID); 443 444 /* 445 * Nothing special for alarm-less driver. Just read the data, update 446 * the cache and notify a waiter of this event. 447 */ 448 val = readl(pvt->regs + PVT_DATA); 449 if (!(val & PVT_DATA_VALID)) { 450 dev_err(pvt->dev, "Got IRQ when data isn't valid\n"); 451 return IRQ_HANDLED; 452 } 453 454 cache = &pvt->cache[pvt->sensor]; 455 456 WRITE_ONCE(cache->data, FIELD_GET(PVT_DATA_DATA_MASK, val)); 457 458 complete(&cache->conversion); 459 460 return IRQ_HANDLED; 461 } 462 463 #define pvt_soft_isr NULL 464 465 static inline umode_t pvt_limit_is_visible(enum pvt_sensor_type type) 466 { 467 return 0; 468 } 469 470 static inline umode_t pvt_alarm_is_visible(enum pvt_sensor_type type) 471 { 472 return 0; 473 } 474 475 static int pvt_read_data(struct pvt_hwmon *pvt, enum pvt_sensor_type type, 476 long *val) 477 { 478 struct pvt_cache *cache = &pvt->cache[type]; 479 u32 data; 480 int ret; 481 482 /* 483 * Lock PVT conversion interface until data cache is updated. The 484 * data read procedure is following: set the requested PVT sensor 485 * mode, enable IRQ and conversion, wait until conversion is finished, 486 * then disable conversion and IRQ, and read the cached data. 487 */ 488 ret = mutex_lock_interruptible(&pvt->iface_mtx); 489 if (ret) 490 return ret; 491 492 pvt->sensor = type; 493 pvt_set_mode(pvt, pvt_info[type].mode); 494 495 /* 496 * Unmask the DVALID interrupt and enable the sensors conversions. 497 * Do the reverse procedure when conversion is done. 498 */ 499 pvt_update(pvt->regs + PVT_INTR_MASK, PVT_INTR_DVALID, 0); 500 pvt_update(pvt->regs + PVT_CTRL, PVT_CTRL_EN, PVT_CTRL_EN); 501 502 wait_for_completion(&cache->conversion); 503 504 pvt_update(pvt->regs + PVT_CTRL, PVT_CTRL_EN, 0); 505 pvt_update(pvt->regs + PVT_INTR_MASK, PVT_INTR_DVALID, 506 PVT_INTR_DVALID); 507 508 data = READ_ONCE(cache->data); 509 510 mutex_unlock(&pvt->iface_mtx); 511 512 if (type == PVT_TEMP) 513 *val = pvt_calc_poly(&poly_N_to_temp, data); 514 else 515 *val = pvt_calc_poly(&poly_N_to_volt, data); 516 517 return 0; 518 } 519 520 static int pvt_read_limit(struct pvt_hwmon *pvt, enum pvt_sensor_type type, 521 bool is_low, long *val) 522 { 523 return -EOPNOTSUPP; 524 } 525 526 static int pvt_write_limit(struct pvt_hwmon *pvt, enum pvt_sensor_type type, 527 bool is_low, long val) 528 { 529 return -EOPNOTSUPP; 530 } 531 532 static int pvt_read_alarm(struct pvt_hwmon *pvt, enum pvt_sensor_type type, 533 bool is_low, long *val) 534 { 535 return -EOPNOTSUPP; 536 } 537 538 static const struct hwmon_channel_info *pvt_channel_info[] = { 539 HWMON_CHANNEL_INFO(chip, 540 HWMON_C_REGISTER_TZ | HWMON_C_UPDATE_INTERVAL), 541 HWMON_CHANNEL_INFO(temp, 542 HWMON_T_INPUT | HWMON_T_TYPE | HWMON_T_LABEL | 543 HWMON_T_OFFSET), 544 HWMON_CHANNEL_INFO(in, 545 HWMON_I_INPUT | HWMON_I_LABEL, 546 HWMON_I_INPUT | HWMON_I_LABEL, 547 HWMON_I_INPUT | HWMON_I_LABEL, 548 HWMON_I_INPUT | HWMON_I_LABEL), 549 NULL 550 }; 551 552 #endif /* !CONFIG_SENSORS_BT1_PVT_ALARMS */ 553 554 static inline bool pvt_hwmon_channel_is_valid(enum hwmon_sensor_types type, 555 int ch) 556 { 557 switch (type) { 558 case hwmon_temp: 559 if (ch < 0 || ch >= PVT_TEMP_CHS) 560 return false; 561 break; 562 case hwmon_in: 563 if (ch < 0 || ch >= PVT_VOLT_CHS) 564 return false; 565 break; 566 default: 567 break; 568 } 569 570 /* The rest of the types are independent from the channel number. */ 571 return true; 572 } 573 574 static umode_t pvt_hwmon_is_visible(const void *data, 575 enum hwmon_sensor_types type, 576 u32 attr, int ch) 577 { 578 if (!pvt_hwmon_channel_is_valid(type, ch)) 579 return 0; 580 581 switch (type) { 582 case hwmon_chip: 583 switch (attr) { 584 case hwmon_chip_update_interval: 585 return 0644; 586 } 587 break; 588 case hwmon_temp: 589 switch (attr) { 590 case hwmon_temp_input: 591 case hwmon_temp_type: 592 case hwmon_temp_label: 593 return 0444; 594 case hwmon_temp_min: 595 case hwmon_temp_max: 596 return pvt_limit_is_visible(ch); 597 case hwmon_temp_min_alarm: 598 case hwmon_temp_max_alarm: 599 return pvt_alarm_is_visible(ch); 600 case hwmon_temp_offset: 601 return 0644; 602 } 603 break; 604 case hwmon_in: 605 switch (attr) { 606 case hwmon_in_input: 607 case hwmon_in_label: 608 return 0444; 609 case hwmon_in_min: 610 case hwmon_in_max: 611 return pvt_limit_is_visible(PVT_VOLT + ch); 612 case hwmon_in_min_alarm: 613 case hwmon_in_max_alarm: 614 return pvt_alarm_is_visible(PVT_VOLT + ch); 615 } 616 break; 617 default: 618 break; 619 } 620 621 return 0; 622 } 623 624 static int pvt_read_trim(struct pvt_hwmon *pvt, long *val) 625 { 626 u32 data; 627 628 data = readl(pvt->regs + PVT_CTRL); 629 *val = FIELD_GET(PVT_CTRL_TRIM_MASK, data) * PVT_TRIM_STEP; 630 631 return 0; 632 } 633 634 static int pvt_write_trim(struct pvt_hwmon *pvt, long val) 635 { 636 u32 trim; 637 int ret; 638 639 /* 640 * Serialize trim update, since a part of the register is changed and 641 * the controller is supposed to be disabled during this operation. 642 */ 643 ret = mutex_lock_interruptible(&pvt->iface_mtx); 644 if (ret) 645 return ret; 646 647 trim = pvt_calc_trim(val); 648 pvt_set_trim(pvt, trim); 649 650 mutex_unlock(&pvt->iface_mtx); 651 652 return 0; 653 } 654 655 static int pvt_read_timeout(struct pvt_hwmon *pvt, long *val) 656 { 657 unsigned long rate; 658 ktime_t kt; 659 u32 data; 660 661 rate = clk_get_rate(pvt->clks[PVT_CLOCK_REF].clk); 662 if (!rate) 663 return -ENODEV; 664 665 /* 666 * Don't bother with mutex here, since we just read data from MMIO. 667 * We also have to scale the ticks timeout up to compensate the 668 * ms-ns-data translations. 669 */ 670 data = readl(pvt->regs + PVT_TTIMEOUT) + 1; 671 672 /* 673 * Calculate ref-clock based delay (Ttotal) between two consecutive 674 * data samples of the same sensor. So we first must calculate the 675 * delay introduced by the internal ref-clock timer (Tref * Fclk). 676 * Then add the constant timeout cuased by each conversion latency 677 * (Tmin). The basic formulae for each conversion is following: 678 * Ttotal = Tref * Fclk + Tmin 679 * Note if alarms are enabled the sensors are polled one after 680 * another, so in order to have the delay being applicable for each 681 * sensor the requested value must be equally redistirbuted. 682 */ 683 #if defined(CONFIG_SENSORS_BT1_PVT_ALARMS) 684 kt = ktime_set(PVT_SENSORS_NUM * (u64)data, 0); 685 kt = ktime_divns(kt, rate); 686 kt = ktime_add_ns(kt, PVT_SENSORS_NUM * PVT_TOUT_MIN); 687 #else 688 kt = ktime_set(data, 0); 689 kt = ktime_divns(kt, rate); 690 kt = ktime_add_ns(kt, PVT_TOUT_MIN); 691 #endif 692 693 /* Return the result in msec as hwmon sysfs interface requires. */ 694 *val = ktime_to_ms(kt); 695 696 return 0; 697 } 698 699 static int pvt_write_timeout(struct pvt_hwmon *pvt, long val) 700 { 701 unsigned long rate; 702 ktime_t kt; 703 u32 data; 704 int ret; 705 706 rate = clk_get_rate(pvt->clks[PVT_CLOCK_REF].clk); 707 if (!rate) 708 return -ENODEV; 709 710 /* 711 * If alarms are enabled, the requested timeout must be divided 712 * between all available sensors to have the requested delay 713 * applicable to each individual sensor. 714 */ 715 kt = ms_to_ktime(val); 716 #if defined(CONFIG_SENSORS_BT1_PVT_ALARMS) 717 kt = ktime_divns(kt, PVT_SENSORS_NUM); 718 #endif 719 720 /* 721 * Subtract a constant lag, which always persists due to the limited 722 * PVT sampling rate. Make sure the timeout is not negative. 723 */ 724 kt = ktime_sub_ns(kt, PVT_TOUT_MIN); 725 if (ktime_to_ns(kt) < 0) 726 kt = ktime_set(0, 0); 727 728 /* 729 * Finally recalculate the timeout in terms of the reference clock 730 * period. 731 */ 732 data = ktime_divns(kt * rate, NSEC_PER_SEC); 733 734 /* 735 * Update the measurements delay, but lock the interface first, since 736 * we have to disable PVT in order to have the new delay actually 737 * updated. 738 */ 739 ret = mutex_lock_interruptible(&pvt->iface_mtx); 740 if (ret) 741 return ret; 742 743 pvt_set_tout(pvt, data); 744 745 mutex_unlock(&pvt->iface_mtx); 746 747 return 0; 748 } 749 750 static int pvt_hwmon_read(struct device *dev, enum hwmon_sensor_types type, 751 u32 attr, int ch, long *val) 752 { 753 struct pvt_hwmon *pvt = dev_get_drvdata(dev); 754 755 if (!pvt_hwmon_channel_is_valid(type, ch)) 756 return -EINVAL; 757 758 switch (type) { 759 case hwmon_chip: 760 switch (attr) { 761 case hwmon_chip_update_interval: 762 return pvt_read_timeout(pvt, val); 763 } 764 break; 765 case hwmon_temp: 766 switch (attr) { 767 case hwmon_temp_input: 768 return pvt_read_data(pvt, ch, val); 769 case hwmon_temp_type: 770 *val = 1; 771 return 0; 772 case hwmon_temp_min: 773 return pvt_read_limit(pvt, ch, true, val); 774 case hwmon_temp_max: 775 return pvt_read_limit(pvt, ch, false, val); 776 case hwmon_temp_min_alarm: 777 return pvt_read_alarm(pvt, ch, true, val); 778 case hwmon_temp_max_alarm: 779 return pvt_read_alarm(pvt, ch, false, val); 780 case hwmon_temp_offset: 781 return pvt_read_trim(pvt, val); 782 } 783 break; 784 case hwmon_in: 785 switch (attr) { 786 case hwmon_in_input: 787 return pvt_read_data(pvt, PVT_VOLT + ch, val); 788 case hwmon_in_min: 789 return pvt_read_limit(pvt, PVT_VOLT + ch, true, val); 790 case hwmon_in_max: 791 return pvt_read_limit(pvt, PVT_VOLT + ch, false, val); 792 case hwmon_in_min_alarm: 793 return pvt_read_alarm(pvt, PVT_VOLT + ch, true, val); 794 case hwmon_in_max_alarm: 795 return pvt_read_alarm(pvt, PVT_VOLT + ch, false, val); 796 } 797 break; 798 default: 799 break; 800 } 801 802 return -EOPNOTSUPP; 803 } 804 805 static int pvt_hwmon_read_string(struct device *dev, 806 enum hwmon_sensor_types type, 807 u32 attr, int ch, const char **str) 808 { 809 if (!pvt_hwmon_channel_is_valid(type, ch)) 810 return -EINVAL; 811 812 switch (type) { 813 case hwmon_temp: 814 switch (attr) { 815 case hwmon_temp_label: 816 *str = pvt_info[ch].label; 817 return 0; 818 } 819 break; 820 case hwmon_in: 821 switch (attr) { 822 case hwmon_in_label: 823 *str = pvt_info[PVT_VOLT + ch].label; 824 return 0; 825 } 826 break; 827 default: 828 break; 829 } 830 831 return -EOPNOTSUPP; 832 } 833 834 static int pvt_hwmon_write(struct device *dev, enum hwmon_sensor_types type, 835 u32 attr, int ch, long val) 836 { 837 struct pvt_hwmon *pvt = dev_get_drvdata(dev); 838 839 if (!pvt_hwmon_channel_is_valid(type, ch)) 840 return -EINVAL; 841 842 switch (type) { 843 case hwmon_chip: 844 switch (attr) { 845 case hwmon_chip_update_interval: 846 return pvt_write_timeout(pvt, val); 847 } 848 break; 849 case hwmon_temp: 850 switch (attr) { 851 case hwmon_temp_min: 852 return pvt_write_limit(pvt, ch, true, val); 853 case hwmon_temp_max: 854 return pvt_write_limit(pvt, ch, false, val); 855 case hwmon_temp_offset: 856 return pvt_write_trim(pvt, val); 857 } 858 break; 859 case hwmon_in: 860 switch (attr) { 861 case hwmon_in_min: 862 return pvt_write_limit(pvt, PVT_VOLT + ch, true, val); 863 case hwmon_in_max: 864 return pvt_write_limit(pvt, PVT_VOLT + ch, false, val); 865 } 866 break; 867 default: 868 break; 869 } 870 871 return -EOPNOTSUPP; 872 } 873 874 static const struct hwmon_ops pvt_hwmon_ops = { 875 .is_visible = pvt_hwmon_is_visible, 876 .read = pvt_hwmon_read, 877 .read_string = pvt_hwmon_read_string, 878 .write = pvt_hwmon_write 879 }; 880 881 static const struct hwmon_chip_info pvt_hwmon_info = { 882 .ops = &pvt_hwmon_ops, 883 .info = pvt_channel_info 884 }; 885 886 static void pvt_clear_data(void *data) 887 { 888 struct pvt_hwmon *pvt = data; 889 #if !defined(CONFIG_SENSORS_BT1_PVT_ALARMS) 890 int idx; 891 892 for (idx = 0; idx < PVT_SENSORS_NUM; ++idx) 893 complete_all(&pvt->cache[idx].conversion); 894 #endif 895 896 mutex_destroy(&pvt->iface_mtx); 897 } 898 899 static struct pvt_hwmon *pvt_create_data(struct platform_device *pdev) 900 { 901 struct device *dev = &pdev->dev; 902 struct pvt_hwmon *pvt; 903 int ret, idx; 904 905 pvt = devm_kzalloc(dev, sizeof(*pvt), GFP_KERNEL); 906 if (!pvt) 907 return ERR_PTR(-ENOMEM); 908 909 ret = devm_add_action(dev, pvt_clear_data, pvt); 910 if (ret) { 911 dev_err(dev, "Can't add PVT data clear action\n"); 912 return ERR_PTR(ret); 913 } 914 915 pvt->dev = dev; 916 pvt->sensor = PVT_SENSOR_FIRST; 917 mutex_init(&pvt->iface_mtx); 918 919 #if defined(CONFIG_SENSORS_BT1_PVT_ALARMS) 920 for (idx = 0; idx < PVT_SENSORS_NUM; ++idx) 921 seqlock_init(&pvt->cache[idx].data_seqlock); 922 #else 923 for (idx = 0; idx < PVT_SENSORS_NUM; ++idx) 924 init_completion(&pvt->cache[idx].conversion); 925 #endif 926 927 return pvt; 928 } 929 930 static int pvt_request_regs(struct pvt_hwmon *pvt) 931 { 932 struct platform_device *pdev = to_platform_device(pvt->dev); 933 struct resource *res; 934 935 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 936 if (!res) { 937 dev_err(pvt->dev, "Couldn't find PVT memresource\n"); 938 return -EINVAL; 939 } 940 941 pvt->regs = devm_ioremap_resource(pvt->dev, res); 942 if (IS_ERR(pvt->regs)) { 943 dev_err(pvt->dev, "Couldn't map PVT registers\n"); 944 return PTR_ERR(pvt->regs); 945 } 946 947 return 0; 948 } 949 950 static void pvt_disable_clks(void *data) 951 { 952 struct pvt_hwmon *pvt = data; 953 954 clk_bulk_disable_unprepare(PVT_CLOCK_NUM, pvt->clks); 955 } 956 957 static int pvt_request_clks(struct pvt_hwmon *pvt) 958 { 959 int ret; 960 961 pvt->clks[PVT_CLOCK_APB].id = "pclk"; 962 pvt->clks[PVT_CLOCK_REF].id = "ref"; 963 964 ret = devm_clk_bulk_get(pvt->dev, PVT_CLOCK_NUM, pvt->clks); 965 if (ret) { 966 dev_err(pvt->dev, "Couldn't get PVT clocks descriptors\n"); 967 return ret; 968 } 969 970 ret = clk_bulk_prepare_enable(PVT_CLOCK_NUM, pvt->clks); 971 if (ret) { 972 dev_err(pvt->dev, "Couldn't enable the PVT clocks\n"); 973 return ret; 974 } 975 976 ret = devm_add_action_or_reset(pvt->dev, pvt_disable_clks, pvt); 977 if (ret) { 978 dev_err(pvt->dev, "Can't add PVT clocks disable action\n"); 979 return ret; 980 } 981 982 return 0; 983 } 984 985 static void pvt_init_iface(struct pvt_hwmon *pvt) 986 { 987 u32 trim, temp; 988 989 /* 990 * Make sure all interrupts and controller are disabled so not to 991 * accidentally have ISR executed before the driver data is fully 992 * initialized. Clear the IRQ status as well. 993 */ 994 pvt_update(pvt->regs + PVT_INTR_MASK, PVT_INTR_ALL, PVT_INTR_ALL); 995 pvt_update(pvt->regs + PVT_CTRL, PVT_CTRL_EN, 0); 996 readl(pvt->regs + PVT_CLR_INTR); 997 readl(pvt->regs + PVT_DATA); 998 999 /* Setup default sensor mode, timeout and temperature trim. */ 1000 pvt_set_mode(pvt, pvt_info[pvt->sensor].mode); 1001 pvt_set_tout(pvt, PVT_TOUT_DEF); 1002 1003 trim = PVT_TRIM_DEF; 1004 if (!of_property_read_u32(pvt->dev->of_node, 1005 "baikal,pvt-temp-offset-millicelsius", &temp)) 1006 trim = pvt_calc_trim(temp); 1007 1008 pvt_set_trim(pvt, trim); 1009 } 1010 1011 static int pvt_request_irq(struct pvt_hwmon *pvt) 1012 { 1013 struct platform_device *pdev = to_platform_device(pvt->dev); 1014 int ret; 1015 1016 pvt->irq = platform_get_irq(pdev, 0); 1017 if (pvt->irq < 0) 1018 return pvt->irq; 1019 1020 ret = devm_request_threaded_irq(pvt->dev, pvt->irq, 1021 pvt_hard_isr, pvt_soft_isr, 1022 #if defined(CONFIG_SENSORS_BT1_PVT_ALARMS) 1023 IRQF_SHARED | IRQF_TRIGGER_HIGH | 1024 IRQF_ONESHOT, 1025 #else 1026 IRQF_SHARED | IRQF_TRIGGER_HIGH, 1027 #endif 1028 "pvt", pvt); 1029 if (ret) { 1030 dev_err(pvt->dev, "Couldn't request PVT IRQ\n"); 1031 return ret; 1032 } 1033 1034 return 0; 1035 } 1036 1037 static int pvt_create_hwmon(struct pvt_hwmon *pvt) 1038 { 1039 pvt->hwmon = devm_hwmon_device_register_with_info(pvt->dev, "pvt", pvt, 1040 &pvt_hwmon_info, NULL); 1041 if (IS_ERR(pvt->hwmon)) { 1042 dev_err(pvt->dev, "Couldn't create hwmon device\n"); 1043 return PTR_ERR(pvt->hwmon); 1044 } 1045 1046 return 0; 1047 } 1048 1049 #if defined(CONFIG_SENSORS_BT1_PVT_ALARMS) 1050 1051 static void pvt_disable_iface(void *data) 1052 { 1053 struct pvt_hwmon *pvt = data; 1054 1055 mutex_lock(&pvt->iface_mtx); 1056 pvt_update(pvt->regs + PVT_CTRL, PVT_CTRL_EN, 0); 1057 pvt_update(pvt->regs + PVT_INTR_MASK, PVT_INTR_DVALID, 1058 PVT_INTR_DVALID); 1059 mutex_unlock(&pvt->iface_mtx); 1060 } 1061 1062 static int pvt_enable_iface(struct pvt_hwmon *pvt) 1063 { 1064 int ret; 1065 1066 ret = devm_add_action(pvt->dev, pvt_disable_iface, pvt); 1067 if (ret) { 1068 dev_err(pvt->dev, "Can't add PVT disable interface action\n"); 1069 return ret; 1070 } 1071 1072 /* 1073 * Enable sensors data conversion and IRQ. We need to lock the 1074 * interface mutex since hwmon has just been created and the 1075 * corresponding sysfs files are accessible from user-space, 1076 * which theoretically may cause races. 1077 */ 1078 mutex_lock(&pvt->iface_mtx); 1079 pvt_update(pvt->regs + PVT_INTR_MASK, PVT_INTR_DVALID, 0); 1080 pvt_update(pvt->regs + PVT_CTRL, PVT_CTRL_EN, PVT_CTRL_EN); 1081 mutex_unlock(&pvt->iface_mtx); 1082 1083 return 0; 1084 } 1085 1086 #else /* !CONFIG_SENSORS_BT1_PVT_ALARMS */ 1087 1088 static int pvt_enable_iface(struct pvt_hwmon *pvt) 1089 { 1090 return 0; 1091 } 1092 1093 #endif /* !CONFIG_SENSORS_BT1_PVT_ALARMS */ 1094 1095 static int pvt_probe(struct platform_device *pdev) 1096 { 1097 struct pvt_hwmon *pvt; 1098 int ret; 1099 1100 pvt = pvt_create_data(pdev); 1101 if (IS_ERR(pvt)) 1102 return PTR_ERR(pvt); 1103 1104 ret = pvt_request_regs(pvt); 1105 if (ret) 1106 return ret; 1107 1108 ret = pvt_request_clks(pvt); 1109 if (ret) 1110 return ret; 1111 1112 pvt_init_iface(pvt); 1113 1114 ret = pvt_request_irq(pvt); 1115 if (ret) 1116 return ret; 1117 1118 ret = pvt_create_hwmon(pvt); 1119 if (ret) 1120 return ret; 1121 1122 ret = pvt_enable_iface(pvt); 1123 if (ret) 1124 return ret; 1125 1126 return 0; 1127 } 1128 1129 static const struct of_device_id pvt_of_match[] = { 1130 { .compatible = "baikal,bt1-pvt" }, 1131 { } 1132 }; 1133 MODULE_DEVICE_TABLE(of, pvt_of_match); 1134 1135 static struct platform_driver pvt_driver = { 1136 .probe = pvt_probe, 1137 .driver = { 1138 .name = "bt1-pvt", 1139 .of_match_table = pvt_of_match 1140 } 1141 }; 1142 module_platform_driver(pvt_driver); 1143 1144 MODULE_AUTHOR("Maxim Kaurkin <maxim.kaurkin@baikalelectronics.ru>"); 1145 MODULE_DESCRIPTION("Baikal-T1 PVT driver"); 1146 MODULE_LICENSE("GPL v2"); 1147