1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Copyright (c) 2019-2020, The Linux Foundation. All rights reserved. 4 * Copyright (c) 2022, Linaro Ltd 5 */ 6 #include <linux/auxiliary_bus.h> 7 #include <linux/module.h> 8 #include <linux/mutex.h> 9 #include <linux/of_device.h> 10 #include <linux/power_supply.h> 11 #include <linux/property.h> 12 #include <linux/soc/qcom/pdr.h> 13 #include <linux/soc/qcom/pmic_glink.h> 14 #include <linux/math.h> 15 #include <linux/units.h> 16 17 #define BATTMGR_CHEMISTRY_LEN 4 18 #define BATTMGR_STRING_LEN 128 19 20 enum qcom_battmgr_variant { 21 QCOM_BATTMGR_SM8350, 22 QCOM_BATTMGR_SC8280XP, 23 }; 24 25 #define BATTMGR_BAT_STATUS 0x1 26 27 #define BATTMGR_REQUEST_NOTIFICATION 0x4 28 29 #define BATTMGR_NOTIFICATION 0x7 30 #define NOTIF_BAT_PROPERTY 0x30 31 #define NOTIF_USB_PROPERTY 0x32 32 #define NOTIF_WLS_PROPERTY 0x34 33 #define NOTIF_BAT_INFO 0x81 34 #define NOTIF_BAT_STATUS 0x80 35 36 #define BATTMGR_BAT_INFO 0x9 37 38 #define BATTMGR_BAT_DISCHARGE_TIME 0xc 39 40 #define BATTMGR_BAT_CHARGE_TIME 0xd 41 42 #define BATTMGR_BAT_PROPERTY_GET 0x30 43 #define BATTMGR_BAT_PROPERTY_SET 0x31 44 #define BATT_STATUS 0 45 #define BATT_HEALTH 1 46 #define BATT_PRESENT 2 47 #define BATT_CHG_TYPE 3 48 #define BATT_CAPACITY 4 49 #define BATT_SOH 5 50 #define BATT_VOLT_OCV 6 51 #define BATT_VOLT_NOW 7 52 #define BATT_VOLT_MAX 8 53 #define BATT_CURR_NOW 9 54 #define BATT_CHG_CTRL_LIM 10 55 #define BATT_CHG_CTRL_LIM_MAX 11 56 #define BATT_TEMP 12 57 #define BATT_TECHNOLOGY 13 58 #define BATT_CHG_COUNTER 14 59 #define BATT_CYCLE_COUNT 15 60 #define BATT_CHG_FULL_DESIGN 16 61 #define BATT_CHG_FULL 17 62 #define BATT_MODEL_NAME 18 63 #define BATT_TTF_AVG 19 64 #define BATT_TTE_AVG 20 65 #define BATT_RESISTANCE 21 66 #define BATT_POWER_NOW 22 67 #define BATT_POWER_AVG 23 68 69 #define BATTMGR_USB_PROPERTY_GET 0x32 70 #define BATTMGR_USB_PROPERTY_SET 0x33 71 #define USB_ONLINE 0 72 #define USB_VOLT_NOW 1 73 #define USB_VOLT_MAX 2 74 #define USB_CURR_NOW 3 75 #define USB_CURR_MAX 4 76 #define USB_INPUT_CURR_LIMIT 5 77 #define USB_TYPE 6 78 #define USB_ADAP_TYPE 7 79 #define USB_MOISTURE_DET_EN 8 80 #define USB_MOISTURE_DET_STS 9 81 82 #define BATTMGR_WLS_PROPERTY_GET 0x34 83 #define BATTMGR_WLS_PROPERTY_SET 0x35 84 #define WLS_ONLINE 0 85 #define WLS_VOLT_NOW 1 86 #define WLS_VOLT_MAX 2 87 #define WLS_CURR_NOW 3 88 #define WLS_CURR_MAX 4 89 #define WLS_TYPE 5 90 #define WLS_BOOST_EN 6 91 92 struct qcom_battmgr_enable_request { 93 struct pmic_glink_hdr hdr; 94 __le32 battery_id; 95 __le32 power_state; 96 __le32 low_capacity; 97 __le32 high_capacity; 98 }; 99 100 struct qcom_battmgr_property_request { 101 struct pmic_glink_hdr hdr; 102 __le32 battery; 103 __le32 property; 104 __le32 value; 105 }; 106 107 struct qcom_battmgr_update_request { 108 struct pmic_glink_hdr hdr; 109 __le32 battery_id; 110 }; 111 112 struct qcom_battmgr_charge_time_request { 113 struct pmic_glink_hdr hdr; 114 __le32 battery_id; 115 __le32 percent; 116 __le32 reserved; 117 }; 118 119 struct qcom_battmgr_discharge_time_request { 120 struct pmic_glink_hdr hdr; 121 __le32 battery_id; 122 __le32 rate; /* 0 for current rate */ 123 __le32 reserved; 124 }; 125 126 struct qcom_battmgr_message { 127 struct pmic_glink_hdr hdr; 128 union { 129 struct { 130 __le32 property; 131 __le32 value; 132 __le32 result; 133 } intval; 134 struct { 135 __le32 property; 136 char model[BATTMGR_STRING_LEN]; 137 } strval; 138 struct { 139 /* 140 * 0: mWh 141 * 1: mAh 142 */ 143 __le32 power_unit; 144 __le32 design_capacity; 145 __le32 last_full_capacity; 146 /* 147 * 0 nonrechargable 148 * 1 rechargable 149 */ 150 __le32 battery_tech; 151 __le32 design_voltage; /* mV */ 152 __le32 capacity_low; 153 __le32 capacity_warning; 154 __le32 cycle_count; 155 /* thousandth of percent */ 156 __le32 accuracy; 157 __le32 max_sample_time_ms; 158 __le32 min_sample_time_ms; 159 __le32 max_average_interval_ms; 160 __le32 min_average_interval_ms; 161 /* granularity between low and warning */ 162 __le32 capacity_granularity1; 163 /* granularity between warning and full */ 164 __le32 capacity_granularity2; 165 /* 166 * 0: no 167 * 1: cold 168 * 2: hot 169 */ 170 __le32 swappable; 171 __le32 capabilities; 172 char model_number[BATTMGR_STRING_LEN]; 173 char serial_number[BATTMGR_STRING_LEN]; 174 char battery_type[BATTMGR_STRING_LEN]; 175 char oem_info[BATTMGR_STRING_LEN]; 176 char battery_chemistry[BATTMGR_CHEMISTRY_LEN]; 177 char uid[BATTMGR_STRING_LEN]; 178 __le32 critical_bias; 179 u8 day; 180 u8 month; 181 __le16 year; 182 __le32 battery_id; 183 } info; 184 struct { 185 /* 186 * BIT(0) discharging 187 * BIT(1) charging 188 * BIT(2) critical low 189 */ 190 __le32 battery_state; 191 /* mWh or mAh, based on info->power_unit */ 192 __le32 capacity; 193 __le32 rate; 194 /* mv */ 195 __le32 battery_voltage; 196 /* 197 * BIT(0) power online 198 * BIT(1) discharging 199 * BIT(2) charging 200 * BIT(3) battery critical 201 */ 202 __le32 power_state; 203 /* 204 * 1: AC 205 * 2: USB 206 * 3: Wireless 207 */ 208 __le32 charging_source; 209 __le32 temperature; 210 } status; 211 __le32 time; 212 __le32 notification; 213 }; 214 }; 215 216 #define BATTMGR_CHARGING_SOURCE_AC 1 217 #define BATTMGR_CHARGING_SOURCE_USB 2 218 #define BATTMGR_CHARGING_SOURCE_WIRELESS 3 219 220 enum qcom_battmgr_unit { 221 QCOM_BATTMGR_UNIT_mWh = 0, 222 QCOM_BATTMGR_UNIT_mAh = 1 223 }; 224 225 struct qcom_battmgr_info { 226 bool valid; 227 228 bool present; 229 unsigned int charge_type; 230 unsigned int design_capacity; 231 unsigned int last_full_capacity; 232 unsigned int voltage_max_design; 233 unsigned int voltage_max; 234 unsigned int capacity_low; 235 unsigned int capacity_warning; 236 unsigned int cycle_count; 237 unsigned int charge_count; 238 char model_number[BATTMGR_STRING_LEN]; 239 char serial_number[BATTMGR_STRING_LEN]; 240 char oem_info[BATTMGR_STRING_LEN]; 241 unsigned char technology; 242 unsigned char day; 243 unsigned char month; 244 unsigned short year; 245 }; 246 247 struct qcom_battmgr_status { 248 unsigned int status; 249 unsigned int health; 250 unsigned int capacity; 251 unsigned int percent; 252 int current_now; 253 int power_now; 254 unsigned int voltage_now; 255 unsigned int voltage_ocv; 256 unsigned int temperature; 257 258 unsigned int discharge_time; 259 unsigned int charge_time; 260 }; 261 262 struct qcom_battmgr_ac { 263 bool online; 264 }; 265 266 struct qcom_battmgr_usb { 267 bool online; 268 unsigned int voltage_now; 269 unsigned int voltage_max; 270 unsigned int current_now; 271 unsigned int current_max; 272 unsigned int current_limit; 273 unsigned int usb_type; 274 }; 275 276 struct qcom_battmgr_wireless { 277 bool online; 278 unsigned int voltage_now; 279 unsigned int voltage_max; 280 unsigned int current_now; 281 unsigned int current_max; 282 }; 283 284 struct qcom_battmgr { 285 struct device *dev; 286 struct pmic_glink_client *client; 287 288 enum qcom_battmgr_variant variant; 289 290 struct power_supply *ac_psy; 291 struct power_supply *bat_psy; 292 struct power_supply *usb_psy; 293 struct power_supply *wls_psy; 294 295 enum qcom_battmgr_unit unit; 296 297 int error; 298 struct completion ack; 299 300 bool service_up; 301 302 struct qcom_battmgr_info info; 303 struct qcom_battmgr_status status; 304 struct qcom_battmgr_ac ac; 305 struct qcom_battmgr_usb usb; 306 struct qcom_battmgr_wireless wireless; 307 308 struct work_struct enable_work; 309 310 /* 311 * @lock is used to prevent concurrent power supply requests to the 312 * firmware, as it then stops responding. 313 */ 314 struct mutex lock; 315 }; 316 317 static int qcom_battmgr_request(struct qcom_battmgr *battmgr, void *data, size_t len) 318 { 319 unsigned long left; 320 int ret; 321 322 reinit_completion(&battmgr->ack); 323 324 battmgr->error = 0; 325 326 ret = pmic_glink_send(battmgr->client, data, len); 327 if (ret < 0) 328 return ret; 329 330 left = wait_for_completion_timeout(&battmgr->ack, HZ); 331 if (!left) 332 return -ETIMEDOUT; 333 334 return battmgr->error; 335 } 336 337 static int qcom_battmgr_request_property(struct qcom_battmgr *battmgr, int opcode, 338 int property, u32 value) 339 { 340 struct qcom_battmgr_property_request request = { 341 .hdr.owner = cpu_to_le32(PMIC_GLINK_OWNER_BATTMGR), 342 .hdr.type = cpu_to_le32(PMIC_GLINK_REQ_RESP), 343 .hdr.opcode = cpu_to_le32(opcode), 344 .battery = cpu_to_le32(0), 345 .property = cpu_to_le32(property), 346 .value = cpu_to_le32(value), 347 }; 348 349 return qcom_battmgr_request(battmgr, &request, sizeof(request)); 350 } 351 352 static int qcom_battmgr_update_status(struct qcom_battmgr *battmgr) 353 { 354 struct qcom_battmgr_update_request request = { 355 .hdr.owner = cpu_to_le32(PMIC_GLINK_OWNER_BATTMGR), 356 .hdr.type = cpu_to_le32(PMIC_GLINK_REQ_RESP), 357 .hdr.opcode = cpu_to_le32(BATTMGR_BAT_STATUS), 358 .battery_id = cpu_to_le32(0), 359 }; 360 361 return qcom_battmgr_request(battmgr, &request, sizeof(request)); 362 } 363 364 static int qcom_battmgr_update_info(struct qcom_battmgr *battmgr) 365 { 366 struct qcom_battmgr_update_request request = { 367 .hdr.owner = cpu_to_le32(PMIC_GLINK_OWNER_BATTMGR), 368 .hdr.type = cpu_to_le32(PMIC_GLINK_REQ_RESP), 369 .hdr.opcode = cpu_to_le32(BATTMGR_BAT_INFO), 370 .battery_id = cpu_to_le32(0), 371 }; 372 373 return qcom_battmgr_request(battmgr, &request, sizeof(request)); 374 } 375 376 static int qcom_battmgr_update_charge_time(struct qcom_battmgr *battmgr) 377 { 378 struct qcom_battmgr_charge_time_request request = { 379 .hdr.owner = cpu_to_le32(PMIC_GLINK_OWNER_BATTMGR), 380 .hdr.type = cpu_to_le32(PMIC_GLINK_REQ_RESP), 381 .hdr.opcode = cpu_to_le32(BATTMGR_BAT_CHARGE_TIME), 382 .battery_id = cpu_to_le32(0), 383 .percent = cpu_to_le32(100), 384 }; 385 386 return qcom_battmgr_request(battmgr, &request, sizeof(request)); 387 } 388 389 static int qcom_battmgr_update_discharge_time(struct qcom_battmgr *battmgr) 390 { 391 struct qcom_battmgr_discharge_time_request request = { 392 .hdr.owner = cpu_to_le32(PMIC_GLINK_OWNER_BATTMGR), 393 .hdr.type = cpu_to_le32(PMIC_GLINK_REQ_RESP), 394 .hdr.opcode = cpu_to_le32(BATTMGR_BAT_DISCHARGE_TIME), 395 .battery_id = cpu_to_le32(0), 396 .rate = cpu_to_le32(0), 397 }; 398 399 return qcom_battmgr_request(battmgr, &request, sizeof(request)); 400 } 401 402 static const u8 sm8350_bat_prop_map[] = { 403 [POWER_SUPPLY_PROP_STATUS] = BATT_STATUS, 404 [POWER_SUPPLY_PROP_HEALTH] = BATT_HEALTH, 405 [POWER_SUPPLY_PROP_PRESENT] = BATT_PRESENT, 406 [POWER_SUPPLY_PROP_CHARGE_TYPE] = BATT_CHG_TYPE, 407 [POWER_SUPPLY_PROP_CAPACITY] = BATT_CAPACITY, 408 [POWER_SUPPLY_PROP_VOLTAGE_OCV] = BATT_VOLT_OCV, 409 [POWER_SUPPLY_PROP_VOLTAGE_NOW] = BATT_VOLT_NOW, 410 [POWER_SUPPLY_PROP_VOLTAGE_MAX] = BATT_VOLT_MAX, 411 [POWER_SUPPLY_PROP_CURRENT_NOW] = BATT_CURR_NOW, 412 [POWER_SUPPLY_PROP_TEMP] = BATT_TEMP, 413 [POWER_SUPPLY_PROP_TECHNOLOGY] = BATT_TECHNOLOGY, 414 [POWER_SUPPLY_PROP_CHARGE_COUNTER] = BATT_CHG_COUNTER, 415 [POWER_SUPPLY_PROP_CYCLE_COUNT] = BATT_CYCLE_COUNT, 416 [POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN] = BATT_CHG_FULL_DESIGN, 417 [POWER_SUPPLY_PROP_CHARGE_FULL] = BATT_CHG_FULL, 418 [POWER_SUPPLY_PROP_MODEL_NAME] = BATT_MODEL_NAME, 419 [POWER_SUPPLY_PROP_TIME_TO_FULL_AVG] = BATT_TTF_AVG, 420 [POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG] = BATT_TTE_AVG, 421 [POWER_SUPPLY_PROP_POWER_NOW] = BATT_POWER_NOW, 422 }; 423 424 static int qcom_battmgr_bat_sm8350_update(struct qcom_battmgr *battmgr, 425 enum power_supply_property psp) 426 { 427 unsigned int prop; 428 int ret; 429 430 if (psp >= ARRAY_SIZE(sm8350_bat_prop_map)) 431 return -EINVAL; 432 433 prop = sm8350_bat_prop_map[psp]; 434 435 mutex_lock(&battmgr->lock); 436 ret = qcom_battmgr_request_property(battmgr, BATTMGR_BAT_PROPERTY_GET, prop, 0); 437 mutex_unlock(&battmgr->lock); 438 439 return ret; 440 } 441 442 static int qcom_battmgr_bat_sc8280xp_update(struct qcom_battmgr *battmgr, 443 enum power_supply_property psp) 444 { 445 int ret; 446 447 mutex_lock(&battmgr->lock); 448 449 if (!battmgr->info.valid) { 450 ret = qcom_battmgr_update_info(battmgr); 451 if (ret < 0) 452 goto out_unlock; 453 battmgr->info.valid = true; 454 } 455 456 ret = qcom_battmgr_update_status(battmgr); 457 if (ret < 0) 458 goto out_unlock; 459 460 if (psp == POWER_SUPPLY_PROP_TIME_TO_FULL_AVG) { 461 ret = qcom_battmgr_update_charge_time(battmgr); 462 if (ret < 0) { 463 ret = -ENODATA; 464 goto out_unlock; 465 } 466 } 467 468 if (psp == POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG) { 469 ret = qcom_battmgr_update_discharge_time(battmgr); 470 if (ret < 0) { 471 ret = -ENODATA; 472 goto out_unlock; 473 } 474 } 475 476 out_unlock: 477 mutex_unlock(&battmgr->lock); 478 return ret; 479 } 480 481 static int qcom_battmgr_bat_get_property(struct power_supply *psy, 482 enum power_supply_property psp, 483 union power_supply_propval *val) 484 { 485 struct qcom_battmgr *battmgr = power_supply_get_drvdata(psy); 486 enum qcom_battmgr_unit unit = battmgr->unit; 487 int ret; 488 489 if (!battmgr->service_up) 490 return -EAGAIN; 491 492 if (battmgr->variant == QCOM_BATTMGR_SC8280XP) 493 ret = qcom_battmgr_bat_sc8280xp_update(battmgr, psp); 494 else 495 ret = qcom_battmgr_bat_sm8350_update(battmgr, psp); 496 if (ret < 0) 497 return ret; 498 499 switch (psp) { 500 case POWER_SUPPLY_PROP_STATUS: 501 val->intval = battmgr->status.status; 502 break; 503 case POWER_SUPPLY_PROP_CHARGE_TYPE: 504 val->intval = battmgr->info.charge_type; 505 break; 506 case POWER_SUPPLY_PROP_HEALTH: 507 val->intval = battmgr->status.health; 508 break; 509 case POWER_SUPPLY_PROP_PRESENT: 510 val->intval = battmgr->info.present; 511 break; 512 case POWER_SUPPLY_PROP_TECHNOLOGY: 513 val->intval = battmgr->info.technology; 514 break; 515 case POWER_SUPPLY_PROP_CYCLE_COUNT: 516 val->intval = battmgr->info.cycle_count; 517 break; 518 case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN: 519 val->intval = battmgr->info.voltage_max_design; 520 break; 521 case POWER_SUPPLY_PROP_VOLTAGE_MAX: 522 val->intval = battmgr->info.voltage_max; 523 break; 524 case POWER_SUPPLY_PROP_VOLTAGE_NOW: 525 val->intval = battmgr->status.voltage_now; 526 break; 527 case POWER_SUPPLY_PROP_VOLTAGE_OCV: 528 val->intval = battmgr->status.voltage_ocv; 529 break; 530 case POWER_SUPPLY_PROP_CURRENT_NOW: 531 val->intval = battmgr->status.current_now; 532 break; 533 case POWER_SUPPLY_PROP_POWER_NOW: 534 val->intval = battmgr->status.power_now; 535 break; 536 case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN: 537 if (unit != QCOM_BATTMGR_UNIT_mAh) 538 return -ENODATA; 539 val->intval = battmgr->info.design_capacity; 540 break; 541 case POWER_SUPPLY_PROP_CHARGE_FULL: 542 if (unit != QCOM_BATTMGR_UNIT_mAh) 543 return -ENODATA; 544 val->intval = battmgr->info.last_full_capacity; 545 break; 546 case POWER_SUPPLY_PROP_CHARGE_EMPTY: 547 if (unit != QCOM_BATTMGR_UNIT_mAh) 548 return -ENODATA; 549 val->intval = battmgr->info.capacity_low; 550 break; 551 case POWER_SUPPLY_PROP_CHARGE_NOW: 552 if (unit != QCOM_BATTMGR_UNIT_mAh) 553 return -ENODATA; 554 val->intval = battmgr->status.capacity; 555 break; 556 case POWER_SUPPLY_PROP_CHARGE_COUNTER: 557 val->intval = battmgr->info.charge_count; 558 break; 559 case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN: 560 if (unit != QCOM_BATTMGR_UNIT_mWh) 561 return -ENODATA; 562 val->intval = battmgr->info.design_capacity; 563 break; 564 case POWER_SUPPLY_PROP_ENERGY_FULL: 565 if (unit != QCOM_BATTMGR_UNIT_mWh) 566 return -ENODATA; 567 val->intval = battmgr->info.last_full_capacity; 568 break; 569 case POWER_SUPPLY_PROP_ENERGY_EMPTY: 570 if (unit != QCOM_BATTMGR_UNIT_mWh) 571 return -ENODATA; 572 val->intval = battmgr->info.capacity_low; 573 break; 574 case POWER_SUPPLY_PROP_ENERGY_NOW: 575 if (unit != QCOM_BATTMGR_UNIT_mWh) 576 return -ENODATA; 577 val->intval = battmgr->status.capacity; 578 break; 579 case POWER_SUPPLY_PROP_CAPACITY: 580 val->intval = battmgr->status.percent; 581 break; 582 case POWER_SUPPLY_PROP_TEMP: 583 val->intval = battmgr->status.temperature; 584 break; 585 case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG: 586 val->intval = battmgr->status.discharge_time; 587 break; 588 case POWER_SUPPLY_PROP_TIME_TO_FULL_AVG: 589 val->intval = battmgr->status.charge_time; 590 break; 591 case POWER_SUPPLY_PROP_MANUFACTURE_YEAR: 592 val->intval = battmgr->info.year; 593 break; 594 case POWER_SUPPLY_PROP_MANUFACTURE_MONTH: 595 val->intval = battmgr->info.month; 596 break; 597 case POWER_SUPPLY_PROP_MANUFACTURE_DAY: 598 val->intval = battmgr->info.day; 599 break; 600 case POWER_SUPPLY_PROP_MODEL_NAME: 601 val->strval = battmgr->info.model_number; 602 break; 603 case POWER_SUPPLY_PROP_MANUFACTURER: 604 val->strval = battmgr->info.oem_info; 605 break; 606 case POWER_SUPPLY_PROP_SERIAL_NUMBER: 607 val->strval = battmgr->info.serial_number; 608 break; 609 default: 610 return -EINVAL; 611 } 612 613 return 0; 614 } 615 616 static const enum power_supply_property sc8280xp_bat_props[] = { 617 POWER_SUPPLY_PROP_STATUS, 618 POWER_SUPPLY_PROP_PRESENT, 619 POWER_SUPPLY_PROP_TECHNOLOGY, 620 POWER_SUPPLY_PROP_CYCLE_COUNT, 621 POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN, 622 POWER_SUPPLY_PROP_VOLTAGE_NOW, 623 POWER_SUPPLY_PROP_POWER_NOW, 624 POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN, 625 POWER_SUPPLY_PROP_CHARGE_FULL, 626 POWER_SUPPLY_PROP_CHARGE_EMPTY, 627 POWER_SUPPLY_PROP_CHARGE_NOW, 628 POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN, 629 POWER_SUPPLY_PROP_ENERGY_FULL, 630 POWER_SUPPLY_PROP_ENERGY_EMPTY, 631 POWER_SUPPLY_PROP_ENERGY_NOW, 632 POWER_SUPPLY_PROP_TEMP, 633 POWER_SUPPLY_PROP_MANUFACTURE_YEAR, 634 POWER_SUPPLY_PROP_MANUFACTURE_MONTH, 635 POWER_SUPPLY_PROP_MANUFACTURE_DAY, 636 POWER_SUPPLY_PROP_MODEL_NAME, 637 POWER_SUPPLY_PROP_MANUFACTURER, 638 POWER_SUPPLY_PROP_SERIAL_NUMBER, 639 }; 640 641 static const struct power_supply_desc sc8280xp_bat_psy_desc = { 642 .name = "qcom-battmgr-bat", 643 .type = POWER_SUPPLY_TYPE_BATTERY, 644 .properties = sc8280xp_bat_props, 645 .num_properties = ARRAY_SIZE(sc8280xp_bat_props), 646 .get_property = qcom_battmgr_bat_get_property, 647 }; 648 649 static const enum power_supply_property sm8350_bat_props[] = { 650 POWER_SUPPLY_PROP_STATUS, 651 POWER_SUPPLY_PROP_HEALTH, 652 POWER_SUPPLY_PROP_PRESENT, 653 POWER_SUPPLY_PROP_CHARGE_TYPE, 654 POWER_SUPPLY_PROP_CAPACITY, 655 POWER_SUPPLY_PROP_VOLTAGE_OCV, 656 POWER_SUPPLY_PROP_VOLTAGE_NOW, 657 POWER_SUPPLY_PROP_VOLTAGE_MAX, 658 POWER_SUPPLY_PROP_CURRENT_NOW, 659 POWER_SUPPLY_PROP_TEMP, 660 POWER_SUPPLY_PROP_TECHNOLOGY, 661 POWER_SUPPLY_PROP_CHARGE_COUNTER, 662 POWER_SUPPLY_PROP_CYCLE_COUNT, 663 POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN, 664 POWER_SUPPLY_PROP_CHARGE_FULL, 665 POWER_SUPPLY_PROP_MODEL_NAME, 666 POWER_SUPPLY_PROP_TIME_TO_FULL_AVG, 667 POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG, 668 POWER_SUPPLY_PROP_POWER_NOW, 669 }; 670 671 static const struct power_supply_desc sm8350_bat_psy_desc = { 672 .name = "qcom-battmgr-bat", 673 .type = POWER_SUPPLY_TYPE_BATTERY, 674 .properties = sm8350_bat_props, 675 .num_properties = ARRAY_SIZE(sm8350_bat_props), 676 .get_property = qcom_battmgr_bat_get_property, 677 }; 678 679 static int qcom_battmgr_ac_get_property(struct power_supply *psy, 680 enum power_supply_property psp, 681 union power_supply_propval *val) 682 { 683 struct qcom_battmgr *battmgr = power_supply_get_drvdata(psy); 684 int ret; 685 686 if (!battmgr->service_up) 687 return -EAGAIN; 688 689 ret = qcom_battmgr_bat_sc8280xp_update(battmgr, psp); 690 if (ret) 691 return ret; 692 693 switch (psp) { 694 case POWER_SUPPLY_PROP_ONLINE: 695 val->intval = battmgr->ac.online; 696 break; 697 default: 698 return -EINVAL; 699 } 700 701 return 0; 702 } 703 704 static const enum power_supply_property sc8280xp_ac_props[] = { 705 POWER_SUPPLY_PROP_ONLINE, 706 }; 707 708 static const struct power_supply_desc sc8280xp_ac_psy_desc = { 709 .name = "qcom-battmgr-ac", 710 .type = POWER_SUPPLY_TYPE_MAINS, 711 .properties = sc8280xp_ac_props, 712 .num_properties = ARRAY_SIZE(sc8280xp_ac_props), 713 .get_property = qcom_battmgr_ac_get_property, 714 }; 715 716 static const u8 sm8350_usb_prop_map[] = { 717 [POWER_SUPPLY_PROP_ONLINE] = USB_ONLINE, 718 [POWER_SUPPLY_PROP_VOLTAGE_NOW] = USB_VOLT_NOW, 719 [POWER_SUPPLY_PROP_VOLTAGE_MAX] = USB_VOLT_MAX, 720 [POWER_SUPPLY_PROP_CURRENT_NOW] = USB_CURR_NOW, 721 [POWER_SUPPLY_PROP_CURRENT_MAX] = USB_CURR_MAX, 722 [POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT] = USB_INPUT_CURR_LIMIT, 723 [POWER_SUPPLY_PROP_USB_TYPE] = USB_TYPE, 724 }; 725 726 static int qcom_battmgr_usb_sm8350_update(struct qcom_battmgr *battmgr, 727 enum power_supply_property psp) 728 { 729 unsigned int prop; 730 int ret; 731 732 if (psp >= ARRAY_SIZE(sm8350_usb_prop_map)) 733 return -EINVAL; 734 735 prop = sm8350_usb_prop_map[psp]; 736 737 mutex_lock(&battmgr->lock); 738 ret = qcom_battmgr_request_property(battmgr, BATTMGR_USB_PROPERTY_GET, prop, 0); 739 mutex_unlock(&battmgr->lock); 740 741 return ret; 742 } 743 744 static int qcom_battmgr_usb_get_property(struct power_supply *psy, 745 enum power_supply_property psp, 746 union power_supply_propval *val) 747 { 748 struct qcom_battmgr *battmgr = power_supply_get_drvdata(psy); 749 int ret; 750 751 if (!battmgr->service_up) 752 return -EAGAIN; 753 754 if (battmgr->variant == QCOM_BATTMGR_SC8280XP) 755 ret = qcom_battmgr_bat_sc8280xp_update(battmgr, psp); 756 else 757 ret = qcom_battmgr_usb_sm8350_update(battmgr, psp); 758 if (ret) 759 return ret; 760 761 switch (psp) { 762 case POWER_SUPPLY_PROP_ONLINE: 763 val->intval = battmgr->usb.online; 764 break; 765 case POWER_SUPPLY_PROP_VOLTAGE_NOW: 766 val->intval = battmgr->usb.voltage_now; 767 break; 768 case POWER_SUPPLY_PROP_VOLTAGE_MAX: 769 val->intval = battmgr->usb.voltage_max; 770 break; 771 case POWER_SUPPLY_PROP_CURRENT_NOW: 772 val->intval = battmgr->usb.current_now; 773 break; 774 case POWER_SUPPLY_PROP_CURRENT_MAX: 775 val->intval = battmgr->usb.current_max; 776 break; 777 case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT: 778 val->intval = battmgr->usb.current_limit; 779 break; 780 case POWER_SUPPLY_PROP_USB_TYPE: 781 val->intval = battmgr->usb.usb_type; 782 break; 783 default: 784 return -EINVAL; 785 } 786 787 return 0; 788 } 789 790 static const enum power_supply_property sc8280xp_usb_props[] = { 791 POWER_SUPPLY_PROP_ONLINE, 792 }; 793 794 static const struct power_supply_desc sc8280xp_usb_psy_desc = { 795 .name = "qcom-battmgr-usb", 796 .type = POWER_SUPPLY_TYPE_USB, 797 .properties = sc8280xp_usb_props, 798 .num_properties = ARRAY_SIZE(sc8280xp_usb_props), 799 .get_property = qcom_battmgr_usb_get_property, 800 .usb_types = BIT(POWER_SUPPLY_USB_TYPE_UNKNOWN) | 801 BIT(POWER_SUPPLY_USB_TYPE_SDP) | 802 BIT(POWER_SUPPLY_USB_TYPE_DCP) | 803 BIT(POWER_SUPPLY_USB_TYPE_CDP) | 804 BIT(POWER_SUPPLY_USB_TYPE_ACA) | 805 BIT(POWER_SUPPLY_USB_TYPE_C) | 806 BIT(POWER_SUPPLY_USB_TYPE_PD) | 807 BIT(POWER_SUPPLY_USB_TYPE_PD_DRP) | 808 BIT(POWER_SUPPLY_USB_TYPE_PD_PPS) | 809 BIT(POWER_SUPPLY_USB_TYPE_APPLE_BRICK_ID), 810 }; 811 812 static const enum power_supply_property sm8350_usb_props[] = { 813 POWER_SUPPLY_PROP_ONLINE, 814 POWER_SUPPLY_PROP_VOLTAGE_NOW, 815 POWER_SUPPLY_PROP_VOLTAGE_MAX, 816 POWER_SUPPLY_PROP_CURRENT_NOW, 817 POWER_SUPPLY_PROP_CURRENT_MAX, 818 POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT, 819 POWER_SUPPLY_PROP_USB_TYPE, 820 }; 821 822 static const struct power_supply_desc sm8350_usb_psy_desc = { 823 .name = "qcom-battmgr-usb", 824 .type = POWER_SUPPLY_TYPE_USB, 825 .properties = sm8350_usb_props, 826 .num_properties = ARRAY_SIZE(sm8350_usb_props), 827 .get_property = qcom_battmgr_usb_get_property, 828 .usb_types = BIT(POWER_SUPPLY_USB_TYPE_UNKNOWN) | 829 BIT(POWER_SUPPLY_USB_TYPE_SDP) | 830 BIT(POWER_SUPPLY_USB_TYPE_DCP) | 831 BIT(POWER_SUPPLY_USB_TYPE_CDP) | 832 BIT(POWER_SUPPLY_USB_TYPE_ACA) | 833 BIT(POWER_SUPPLY_USB_TYPE_C) | 834 BIT(POWER_SUPPLY_USB_TYPE_PD) | 835 BIT(POWER_SUPPLY_USB_TYPE_PD_DRP) | 836 BIT(POWER_SUPPLY_USB_TYPE_PD_PPS) | 837 BIT(POWER_SUPPLY_USB_TYPE_APPLE_BRICK_ID), 838 }; 839 840 static const u8 sm8350_wls_prop_map[] = { 841 [POWER_SUPPLY_PROP_ONLINE] = WLS_ONLINE, 842 [POWER_SUPPLY_PROP_VOLTAGE_NOW] = WLS_VOLT_NOW, 843 [POWER_SUPPLY_PROP_VOLTAGE_MAX] = WLS_VOLT_MAX, 844 [POWER_SUPPLY_PROP_CURRENT_NOW] = WLS_CURR_NOW, 845 [POWER_SUPPLY_PROP_CURRENT_MAX] = WLS_CURR_MAX, 846 }; 847 848 static int qcom_battmgr_wls_sm8350_update(struct qcom_battmgr *battmgr, 849 enum power_supply_property psp) 850 { 851 unsigned int prop; 852 int ret; 853 854 if (psp >= ARRAY_SIZE(sm8350_wls_prop_map)) 855 return -EINVAL; 856 857 prop = sm8350_wls_prop_map[psp]; 858 859 mutex_lock(&battmgr->lock); 860 ret = qcom_battmgr_request_property(battmgr, BATTMGR_WLS_PROPERTY_GET, prop, 0); 861 mutex_unlock(&battmgr->lock); 862 863 return ret; 864 } 865 866 static int qcom_battmgr_wls_get_property(struct power_supply *psy, 867 enum power_supply_property psp, 868 union power_supply_propval *val) 869 { 870 struct qcom_battmgr *battmgr = power_supply_get_drvdata(psy); 871 int ret; 872 873 if (!battmgr->service_up) 874 return -EAGAIN; 875 876 if (battmgr->variant == QCOM_BATTMGR_SC8280XP) 877 ret = qcom_battmgr_bat_sc8280xp_update(battmgr, psp); 878 else 879 ret = qcom_battmgr_wls_sm8350_update(battmgr, psp); 880 if (ret < 0) 881 return ret; 882 883 switch (psp) { 884 case POWER_SUPPLY_PROP_ONLINE: 885 val->intval = battmgr->wireless.online; 886 break; 887 case POWER_SUPPLY_PROP_VOLTAGE_NOW: 888 val->intval = battmgr->wireless.voltage_now; 889 break; 890 case POWER_SUPPLY_PROP_VOLTAGE_MAX: 891 val->intval = battmgr->wireless.voltage_max; 892 break; 893 case POWER_SUPPLY_PROP_CURRENT_NOW: 894 val->intval = battmgr->wireless.current_now; 895 break; 896 case POWER_SUPPLY_PROP_CURRENT_MAX: 897 val->intval = battmgr->wireless.current_max; 898 break; 899 default: 900 return -EINVAL; 901 } 902 903 return 0; 904 } 905 906 static const enum power_supply_property sc8280xp_wls_props[] = { 907 POWER_SUPPLY_PROP_ONLINE, 908 }; 909 910 static const struct power_supply_desc sc8280xp_wls_psy_desc = { 911 .name = "qcom-battmgr-wls", 912 .type = POWER_SUPPLY_TYPE_WIRELESS, 913 .properties = sc8280xp_wls_props, 914 .num_properties = ARRAY_SIZE(sc8280xp_wls_props), 915 .get_property = qcom_battmgr_wls_get_property, 916 }; 917 918 static const enum power_supply_property sm8350_wls_props[] = { 919 POWER_SUPPLY_PROP_ONLINE, 920 POWER_SUPPLY_PROP_VOLTAGE_NOW, 921 POWER_SUPPLY_PROP_VOLTAGE_MAX, 922 POWER_SUPPLY_PROP_CURRENT_NOW, 923 POWER_SUPPLY_PROP_CURRENT_MAX, 924 }; 925 926 static const struct power_supply_desc sm8350_wls_psy_desc = { 927 .name = "qcom-battmgr-wls", 928 .type = POWER_SUPPLY_TYPE_WIRELESS, 929 .properties = sm8350_wls_props, 930 .num_properties = ARRAY_SIZE(sm8350_wls_props), 931 .get_property = qcom_battmgr_wls_get_property, 932 }; 933 934 static void qcom_battmgr_notification(struct qcom_battmgr *battmgr, 935 const struct qcom_battmgr_message *msg, 936 int len) 937 { 938 size_t payload_len = len - sizeof(struct pmic_glink_hdr); 939 unsigned int notification; 940 941 if (payload_len != sizeof(msg->notification)) { 942 dev_warn(battmgr->dev, "ignoring notification with invalid length\n"); 943 return; 944 } 945 946 notification = le32_to_cpu(msg->notification); 947 switch (notification) { 948 case NOTIF_BAT_INFO: 949 battmgr->info.valid = false; 950 fallthrough; 951 case NOTIF_BAT_STATUS: 952 case NOTIF_BAT_PROPERTY: 953 power_supply_changed(battmgr->bat_psy); 954 break; 955 case NOTIF_USB_PROPERTY: 956 power_supply_changed(battmgr->usb_psy); 957 break; 958 case NOTIF_WLS_PROPERTY: 959 power_supply_changed(battmgr->wls_psy); 960 break; 961 default: 962 dev_err(battmgr->dev, "unknown notification: %#x\n", notification); 963 break; 964 } 965 } 966 967 static void qcom_battmgr_sc8280xp_strcpy(char *dest, const char *src) 968 { 969 size_t len = src[0]; 970 971 /* Some firmware versions return Pascal-style strings */ 972 if (len < BATTMGR_STRING_LEN && len == strnlen(src + 1, BATTMGR_STRING_LEN - 1)) { 973 memcpy(dest, src + 1, len); 974 dest[len] = '\0'; 975 } else { 976 memcpy(dest, src, BATTMGR_STRING_LEN); 977 } 978 } 979 980 static unsigned int qcom_battmgr_sc8280xp_parse_technology(const char *chemistry) 981 { 982 if (!strncmp(chemistry, "LIO", BATTMGR_CHEMISTRY_LEN)) 983 return POWER_SUPPLY_TECHNOLOGY_LION; 984 985 pr_err("Unknown battery technology '%s'\n", chemistry); 986 return POWER_SUPPLY_TECHNOLOGY_UNKNOWN; 987 } 988 989 static unsigned int qcom_battmgr_sc8280xp_convert_temp(unsigned int temperature) 990 { 991 return DIV_ROUND_CLOSEST(temperature, 10); 992 } 993 994 static void qcom_battmgr_sc8280xp_callback(struct qcom_battmgr *battmgr, 995 const struct qcom_battmgr_message *resp, 996 size_t len) 997 { 998 unsigned int opcode = le32_to_cpu(resp->hdr.opcode); 999 unsigned int source; 1000 unsigned int state; 1001 size_t payload_len = len - sizeof(struct pmic_glink_hdr); 1002 1003 if (payload_len < sizeof(__le32)) { 1004 dev_warn(battmgr->dev, "invalid payload length for %#x: %zd\n", 1005 opcode, len); 1006 return; 1007 } 1008 1009 switch (opcode) { 1010 case BATTMGR_REQUEST_NOTIFICATION: 1011 battmgr->error = 0; 1012 break; 1013 case BATTMGR_BAT_INFO: 1014 /* some firmware versions report an extra __le32 at the end of the payload */ 1015 if (payload_len != sizeof(resp->info) && 1016 payload_len != (sizeof(resp->info) + sizeof(__le32))) { 1017 dev_warn(battmgr->dev, 1018 "invalid payload length for battery information request: %zd\n", 1019 payload_len); 1020 battmgr->error = -ENODATA; 1021 return; 1022 } 1023 1024 battmgr->unit = le32_to_cpu(resp->info.power_unit); 1025 1026 battmgr->info.present = true; 1027 battmgr->info.design_capacity = le32_to_cpu(resp->info.design_capacity) * 1000; 1028 battmgr->info.last_full_capacity = le32_to_cpu(resp->info.last_full_capacity) * 1000; 1029 battmgr->info.voltage_max_design = le32_to_cpu(resp->info.design_voltage) * 1000; 1030 battmgr->info.capacity_low = le32_to_cpu(resp->info.capacity_low) * 1000; 1031 battmgr->info.cycle_count = le32_to_cpu(resp->info.cycle_count); 1032 qcom_battmgr_sc8280xp_strcpy(battmgr->info.model_number, resp->info.model_number); 1033 qcom_battmgr_sc8280xp_strcpy(battmgr->info.serial_number, resp->info.serial_number); 1034 battmgr->info.technology = qcom_battmgr_sc8280xp_parse_technology(resp->info.battery_chemistry); 1035 qcom_battmgr_sc8280xp_strcpy(battmgr->info.oem_info, resp->info.oem_info); 1036 battmgr->info.day = resp->info.day; 1037 battmgr->info.month = resp->info.month; 1038 battmgr->info.year = le16_to_cpu(resp->info.year); 1039 break; 1040 case BATTMGR_BAT_STATUS: 1041 if (payload_len != sizeof(resp->status)) { 1042 dev_warn(battmgr->dev, 1043 "invalid payload length for battery status request: %zd\n", 1044 payload_len); 1045 battmgr->error = -ENODATA; 1046 return; 1047 } 1048 1049 state = le32_to_cpu(resp->status.battery_state); 1050 if (state & BIT(0)) 1051 battmgr->status.status = POWER_SUPPLY_STATUS_DISCHARGING; 1052 else if (state & BIT(1)) 1053 battmgr->status.status = POWER_SUPPLY_STATUS_CHARGING; 1054 else 1055 battmgr->status.status = POWER_SUPPLY_STATUS_NOT_CHARGING; 1056 1057 battmgr->status.capacity = le32_to_cpu(resp->status.capacity) * 1000; 1058 battmgr->status.power_now = le32_to_cpu(resp->status.rate) * 1000; 1059 battmgr->status.voltage_now = le32_to_cpu(resp->status.battery_voltage) * 1000; 1060 battmgr->status.temperature = qcom_battmgr_sc8280xp_convert_temp(le32_to_cpu(resp->status.temperature)); 1061 1062 source = le32_to_cpu(resp->status.charging_source); 1063 battmgr->ac.online = source == BATTMGR_CHARGING_SOURCE_AC; 1064 battmgr->usb.online = source == BATTMGR_CHARGING_SOURCE_USB; 1065 battmgr->wireless.online = source == BATTMGR_CHARGING_SOURCE_WIRELESS; 1066 break; 1067 case BATTMGR_BAT_DISCHARGE_TIME: 1068 battmgr->status.discharge_time = le32_to_cpu(resp->time); 1069 break; 1070 case BATTMGR_BAT_CHARGE_TIME: 1071 battmgr->status.charge_time = le32_to_cpu(resp->time); 1072 break; 1073 default: 1074 dev_warn(battmgr->dev, "unknown message %#x\n", opcode); 1075 break; 1076 } 1077 1078 complete(&battmgr->ack); 1079 } 1080 1081 static void qcom_battmgr_sm8350_callback(struct qcom_battmgr *battmgr, 1082 const struct qcom_battmgr_message *resp, 1083 size_t len) 1084 { 1085 unsigned int property; 1086 unsigned int opcode = le32_to_cpu(resp->hdr.opcode); 1087 size_t payload_len = len - sizeof(struct pmic_glink_hdr); 1088 unsigned int val; 1089 1090 if (payload_len < sizeof(__le32)) { 1091 dev_warn(battmgr->dev, "invalid payload length for %#x: %zd\n", 1092 opcode, len); 1093 return; 1094 } 1095 1096 switch (opcode) { 1097 case BATTMGR_BAT_PROPERTY_GET: 1098 property = le32_to_cpu(resp->intval.property); 1099 if (property == BATT_MODEL_NAME) { 1100 if (payload_len != sizeof(resp->strval)) { 1101 dev_warn(battmgr->dev, 1102 "invalid payload length for BATT_MODEL_NAME request: %zd\n", 1103 payload_len); 1104 battmgr->error = -ENODATA; 1105 return; 1106 } 1107 } else { 1108 if (payload_len != sizeof(resp->intval)) { 1109 dev_warn(battmgr->dev, 1110 "invalid payload length for %#x request: %zd\n", 1111 property, payload_len); 1112 battmgr->error = -ENODATA; 1113 return; 1114 } 1115 1116 battmgr->error = le32_to_cpu(resp->intval.result); 1117 if (battmgr->error) 1118 goto out_complete; 1119 } 1120 1121 switch (property) { 1122 case BATT_STATUS: 1123 battmgr->status.status = le32_to_cpu(resp->intval.value); 1124 break; 1125 case BATT_HEALTH: 1126 battmgr->status.health = le32_to_cpu(resp->intval.value); 1127 break; 1128 case BATT_PRESENT: 1129 battmgr->info.present = le32_to_cpu(resp->intval.value); 1130 break; 1131 case BATT_CHG_TYPE: 1132 battmgr->info.charge_type = le32_to_cpu(resp->intval.value); 1133 break; 1134 case BATT_CAPACITY: 1135 battmgr->status.percent = le32_to_cpu(resp->intval.value) / 100; 1136 break; 1137 case BATT_VOLT_OCV: 1138 battmgr->status.voltage_ocv = le32_to_cpu(resp->intval.value); 1139 break; 1140 case BATT_VOLT_NOW: 1141 battmgr->status.voltage_now = le32_to_cpu(resp->intval.value); 1142 break; 1143 case BATT_VOLT_MAX: 1144 battmgr->info.voltage_max = le32_to_cpu(resp->intval.value); 1145 break; 1146 case BATT_CURR_NOW: 1147 battmgr->status.current_now = le32_to_cpu(resp->intval.value); 1148 break; 1149 case BATT_TEMP: 1150 val = le32_to_cpu(resp->intval.value); 1151 battmgr->status.temperature = DIV_ROUND_CLOSEST(val, 10); 1152 break; 1153 case BATT_TECHNOLOGY: 1154 battmgr->info.technology = le32_to_cpu(resp->intval.value); 1155 break; 1156 case BATT_CHG_COUNTER: 1157 battmgr->info.charge_count = le32_to_cpu(resp->intval.value); 1158 break; 1159 case BATT_CYCLE_COUNT: 1160 battmgr->info.cycle_count = le32_to_cpu(resp->intval.value); 1161 break; 1162 case BATT_CHG_FULL_DESIGN: 1163 battmgr->info.design_capacity = le32_to_cpu(resp->intval.value); 1164 break; 1165 case BATT_CHG_FULL: 1166 battmgr->info.last_full_capacity = le32_to_cpu(resp->intval.value); 1167 break; 1168 case BATT_MODEL_NAME: 1169 strscpy(battmgr->info.model_number, resp->strval.model, BATTMGR_STRING_LEN); 1170 break; 1171 case BATT_TTF_AVG: 1172 battmgr->status.charge_time = le32_to_cpu(resp->intval.value); 1173 break; 1174 case BATT_TTE_AVG: 1175 battmgr->status.discharge_time = le32_to_cpu(resp->intval.value); 1176 break; 1177 case BATT_POWER_NOW: 1178 battmgr->status.power_now = le32_to_cpu(resp->intval.value); 1179 break; 1180 default: 1181 dev_warn(battmgr->dev, "unknown property %#x\n", property); 1182 break; 1183 } 1184 break; 1185 case BATTMGR_USB_PROPERTY_GET: 1186 property = le32_to_cpu(resp->intval.property); 1187 if (payload_len != sizeof(resp->intval)) { 1188 dev_warn(battmgr->dev, 1189 "invalid payload length for %#x request: %zd\n", 1190 property, payload_len); 1191 battmgr->error = -ENODATA; 1192 return; 1193 } 1194 1195 battmgr->error = le32_to_cpu(resp->intval.result); 1196 if (battmgr->error) 1197 goto out_complete; 1198 1199 switch (property) { 1200 case USB_ONLINE: 1201 battmgr->usb.online = le32_to_cpu(resp->intval.value); 1202 break; 1203 case USB_VOLT_NOW: 1204 battmgr->usb.voltage_now = le32_to_cpu(resp->intval.value); 1205 break; 1206 case USB_VOLT_MAX: 1207 battmgr->usb.voltage_max = le32_to_cpu(resp->intval.value); 1208 break; 1209 case USB_CURR_NOW: 1210 battmgr->usb.current_now = le32_to_cpu(resp->intval.value); 1211 break; 1212 case USB_CURR_MAX: 1213 battmgr->usb.current_max = le32_to_cpu(resp->intval.value); 1214 break; 1215 case USB_INPUT_CURR_LIMIT: 1216 battmgr->usb.current_limit = le32_to_cpu(resp->intval.value); 1217 break; 1218 case USB_TYPE: 1219 battmgr->usb.usb_type = le32_to_cpu(resp->intval.value); 1220 break; 1221 default: 1222 dev_warn(battmgr->dev, "unknown property %#x\n", property); 1223 break; 1224 } 1225 break; 1226 case BATTMGR_WLS_PROPERTY_GET: 1227 property = le32_to_cpu(resp->intval.property); 1228 if (payload_len != sizeof(resp->intval)) { 1229 dev_warn(battmgr->dev, 1230 "invalid payload length for %#x request: %zd\n", 1231 property, payload_len); 1232 battmgr->error = -ENODATA; 1233 return; 1234 } 1235 1236 battmgr->error = le32_to_cpu(resp->intval.result); 1237 if (battmgr->error) 1238 goto out_complete; 1239 1240 switch (property) { 1241 case WLS_ONLINE: 1242 battmgr->wireless.online = le32_to_cpu(resp->intval.value); 1243 break; 1244 case WLS_VOLT_NOW: 1245 battmgr->wireless.voltage_now = le32_to_cpu(resp->intval.value); 1246 break; 1247 case WLS_VOLT_MAX: 1248 battmgr->wireless.voltage_max = le32_to_cpu(resp->intval.value); 1249 break; 1250 case WLS_CURR_NOW: 1251 battmgr->wireless.current_now = le32_to_cpu(resp->intval.value); 1252 break; 1253 case WLS_CURR_MAX: 1254 battmgr->wireless.current_max = le32_to_cpu(resp->intval.value); 1255 break; 1256 default: 1257 dev_warn(battmgr->dev, "unknown property %#x\n", property); 1258 break; 1259 } 1260 break; 1261 case BATTMGR_REQUEST_NOTIFICATION: 1262 battmgr->error = 0; 1263 break; 1264 default: 1265 dev_warn(battmgr->dev, "unknown message %#x\n", opcode); 1266 break; 1267 } 1268 1269 out_complete: 1270 complete(&battmgr->ack); 1271 } 1272 1273 static void qcom_battmgr_callback(const void *data, size_t len, void *priv) 1274 { 1275 const struct pmic_glink_hdr *hdr = data; 1276 struct qcom_battmgr *battmgr = priv; 1277 unsigned int opcode = le32_to_cpu(hdr->opcode); 1278 1279 if (opcode == BATTMGR_NOTIFICATION) 1280 qcom_battmgr_notification(battmgr, data, len); 1281 else if (battmgr->variant == QCOM_BATTMGR_SC8280XP) 1282 qcom_battmgr_sc8280xp_callback(battmgr, data, len); 1283 else 1284 qcom_battmgr_sm8350_callback(battmgr, data, len); 1285 } 1286 1287 static void qcom_battmgr_enable_worker(struct work_struct *work) 1288 { 1289 struct qcom_battmgr *battmgr = container_of(work, struct qcom_battmgr, enable_work); 1290 struct qcom_battmgr_enable_request req = { 1291 .hdr.owner = cpu_to_le32(PMIC_GLINK_OWNER_BATTMGR), 1292 .hdr.type = cpu_to_le32(PMIC_GLINK_NOTIFY), 1293 .hdr.opcode = cpu_to_le32(BATTMGR_REQUEST_NOTIFICATION), 1294 }; 1295 int ret; 1296 1297 ret = qcom_battmgr_request(battmgr, &req, sizeof(req)); 1298 if (ret) 1299 dev_err(battmgr->dev, "failed to request power notifications\n"); 1300 } 1301 1302 static void qcom_battmgr_pdr_notify(void *priv, int state) 1303 { 1304 struct qcom_battmgr *battmgr = priv; 1305 1306 if (state == SERVREG_SERVICE_STATE_UP) { 1307 battmgr->service_up = true; 1308 schedule_work(&battmgr->enable_work); 1309 } else { 1310 battmgr->service_up = false; 1311 } 1312 } 1313 1314 static const struct of_device_id qcom_battmgr_of_variants[] = { 1315 { .compatible = "qcom,sc8180x-pmic-glink", .data = (void *)QCOM_BATTMGR_SC8280XP }, 1316 { .compatible = "qcom,sc8280xp-pmic-glink", .data = (void *)QCOM_BATTMGR_SC8280XP }, 1317 { .compatible = "qcom,x1e80100-pmic-glink", .data = (void *)QCOM_BATTMGR_SC8280XP }, 1318 /* Unmatched devices falls back to QCOM_BATTMGR_SM8350 */ 1319 {} 1320 }; 1321 1322 static char *qcom_battmgr_battery[] = { "battery" }; 1323 1324 static int qcom_battmgr_probe(struct auxiliary_device *adev, 1325 const struct auxiliary_device_id *id) 1326 { 1327 struct power_supply_config psy_cfg_supply = {}; 1328 struct power_supply_config psy_cfg = {}; 1329 const struct of_device_id *match; 1330 struct qcom_battmgr *battmgr; 1331 struct device *dev = &adev->dev; 1332 1333 battmgr = devm_kzalloc(dev, sizeof(*battmgr), GFP_KERNEL); 1334 if (!battmgr) 1335 return -ENOMEM; 1336 1337 battmgr->dev = dev; 1338 1339 psy_cfg.drv_data = battmgr; 1340 psy_cfg.fwnode = dev_fwnode(&adev->dev); 1341 1342 psy_cfg_supply.drv_data = battmgr; 1343 psy_cfg_supply.fwnode = dev_fwnode(&adev->dev); 1344 psy_cfg_supply.supplied_to = qcom_battmgr_battery; 1345 psy_cfg_supply.num_supplicants = 1; 1346 1347 INIT_WORK(&battmgr->enable_work, qcom_battmgr_enable_worker); 1348 mutex_init(&battmgr->lock); 1349 init_completion(&battmgr->ack); 1350 1351 match = of_match_device(qcom_battmgr_of_variants, dev->parent); 1352 if (match) 1353 battmgr->variant = (unsigned long)match->data; 1354 else 1355 battmgr->variant = QCOM_BATTMGR_SM8350; 1356 1357 if (battmgr->variant == QCOM_BATTMGR_SC8280XP) { 1358 battmgr->bat_psy = devm_power_supply_register(dev, &sc8280xp_bat_psy_desc, &psy_cfg); 1359 if (IS_ERR(battmgr->bat_psy)) 1360 return dev_err_probe(dev, PTR_ERR(battmgr->bat_psy), 1361 "failed to register battery power supply\n"); 1362 1363 battmgr->ac_psy = devm_power_supply_register(dev, &sc8280xp_ac_psy_desc, &psy_cfg_supply); 1364 if (IS_ERR(battmgr->ac_psy)) 1365 return dev_err_probe(dev, PTR_ERR(battmgr->ac_psy), 1366 "failed to register AC power supply\n"); 1367 1368 battmgr->usb_psy = devm_power_supply_register(dev, &sc8280xp_usb_psy_desc, &psy_cfg_supply); 1369 if (IS_ERR(battmgr->usb_psy)) 1370 return dev_err_probe(dev, PTR_ERR(battmgr->usb_psy), 1371 "failed to register USB power supply\n"); 1372 1373 battmgr->wls_psy = devm_power_supply_register(dev, &sc8280xp_wls_psy_desc, &psy_cfg_supply); 1374 if (IS_ERR(battmgr->wls_psy)) 1375 return dev_err_probe(dev, PTR_ERR(battmgr->wls_psy), 1376 "failed to register wireless charing power supply\n"); 1377 } else { 1378 battmgr->bat_psy = devm_power_supply_register(dev, &sm8350_bat_psy_desc, &psy_cfg); 1379 if (IS_ERR(battmgr->bat_psy)) 1380 return dev_err_probe(dev, PTR_ERR(battmgr->bat_psy), 1381 "failed to register battery power supply\n"); 1382 1383 battmgr->usb_psy = devm_power_supply_register(dev, &sm8350_usb_psy_desc, &psy_cfg_supply); 1384 if (IS_ERR(battmgr->usb_psy)) 1385 return dev_err_probe(dev, PTR_ERR(battmgr->usb_psy), 1386 "failed to register USB power supply\n"); 1387 1388 battmgr->wls_psy = devm_power_supply_register(dev, &sm8350_wls_psy_desc, &psy_cfg_supply); 1389 if (IS_ERR(battmgr->wls_psy)) 1390 return dev_err_probe(dev, PTR_ERR(battmgr->wls_psy), 1391 "failed to register wireless charing power supply\n"); 1392 } 1393 1394 battmgr->client = devm_pmic_glink_client_alloc(dev, PMIC_GLINK_OWNER_BATTMGR, 1395 qcom_battmgr_callback, 1396 qcom_battmgr_pdr_notify, 1397 battmgr); 1398 if (IS_ERR(battmgr->client)) 1399 return PTR_ERR(battmgr->client); 1400 1401 pmic_glink_client_register(battmgr->client); 1402 1403 return 0; 1404 } 1405 1406 static const struct auxiliary_device_id qcom_battmgr_id_table[] = { 1407 { .name = "pmic_glink.power-supply", }, 1408 {}, 1409 }; 1410 MODULE_DEVICE_TABLE(auxiliary, qcom_battmgr_id_table); 1411 1412 static struct auxiliary_driver qcom_battmgr_driver = { 1413 .name = "pmic_glink_power_supply", 1414 .probe = qcom_battmgr_probe, 1415 .id_table = qcom_battmgr_id_table, 1416 }; 1417 1418 module_auxiliary_driver(qcom_battmgr_driver); 1419 1420 MODULE_DESCRIPTION("Qualcomm PMIC GLINK battery manager driver"); 1421 MODULE_LICENSE("GPL"); 1422