qcom_battmgr.c 39 KB

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