sbs-battery.c 33 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Gas Gauge driver for SBS Compliant Batteries
  4. *
  5. * Copyright (c) 2010, NVIDIA Corporation.
  6. */
  7. #include <linux/bits.h>
  8. #include <linux/delay.h>
  9. #include <linux/devm-helpers.h>
  10. #include <linux/err.h>
  11. #include <linux/gpio/consumer.h>
  12. #include <linux/i2c.h>
  13. #include <linux/init.h>
  14. #include <linux/interrupt.h>
  15. #include <linux/kernel.h>
  16. #include <linux/module.h>
  17. #include <linux/property.h>
  18. #include <linux/of_device.h>
  19. #include <linux/power/sbs-battery.h>
  20. #include <linux/power_supply.h>
  21. #include <linux/slab.h>
  22. #include <linux/stat.h>
  23. enum {
  24. REG_MANUFACTURER_DATA,
  25. REG_BATTERY_MODE,
  26. REG_TEMPERATURE,
  27. REG_VOLTAGE,
  28. REG_CURRENT_NOW,
  29. REG_CURRENT_AVG,
  30. REG_MAX_ERR,
  31. REG_CAPACITY,
  32. REG_TIME_TO_EMPTY_NOW,
  33. REG_TIME_TO_EMPTY_AVG,
  34. REG_TIME_TO_FULL_AVG,
  35. REG_STATUS,
  36. REG_CAPACITY_LEVEL,
  37. REG_CYCLE_COUNT,
  38. REG_SERIAL_NUMBER,
  39. REG_REMAINING_CAPACITY,
  40. REG_REMAINING_CAPACITY_CHARGE,
  41. REG_FULL_CHARGE_CAPACITY,
  42. REG_FULL_CHARGE_CAPACITY_CHARGE,
  43. REG_DESIGN_CAPACITY,
  44. REG_DESIGN_CAPACITY_CHARGE,
  45. REG_DESIGN_VOLTAGE_MIN,
  46. REG_DESIGN_VOLTAGE_MAX,
  47. REG_CHEMISTRY,
  48. REG_MANUFACTURER,
  49. REG_MODEL_NAME,
  50. REG_CHARGE_CURRENT,
  51. REG_CHARGE_VOLTAGE,
  52. };
  53. #define REG_ADDR_SPEC_INFO 0x1A
  54. #define SPEC_INFO_VERSION_MASK GENMASK(7, 4)
  55. #define SPEC_INFO_VERSION_SHIFT 4
  56. #define SBS_VERSION_1_0 1
  57. #define SBS_VERSION_1_1 2
  58. #define SBS_VERSION_1_1_WITH_PEC 3
  59. #define REG_ADDR_MANUFACTURE_DATE 0x1B
  60. /* Battery Mode defines */
  61. #define BATTERY_MODE_OFFSET 0x03
  62. #define BATTERY_MODE_CAPACITY_MASK BIT(15)
  63. enum sbs_capacity_mode {
  64. CAPACITY_MODE_AMPS = 0,
  65. CAPACITY_MODE_WATTS = BATTERY_MODE_CAPACITY_MASK
  66. };
  67. #define BATTERY_MODE_CHARGER_MASK (1<<14)
  68. /* manufacturer access defines */
  69. #define MANUFACTURER_ACCESS_STATUS 0x0006
  70. #define MANUFACTURER_ACCESS_SLEEP 0x0011
  71. /* battery status value bits */
  72. #define BATTERY_INITIALIZED 0x80
  73. #define BATTERY_DISCHARGING 0x40
  74. #define BATTERY_FULL_CHARGED 0x20
  75. #define BATTERY_FULL_DISCHARGED 0x10
  76. /* min_value and max_value are only valid for numerical data */
  77. #define SBS_DATA(_psp, _addr, _min_value, _max_value) { \
  78. .psp = _psp, \
  79. .addr = _addr, \
  80. .min_value = _min_value, \
  81. .max_value = _max_value, \
  82. }
  83. static const struct chip_data {
  84. enum power_supply_property psp;
  85. u8 addr;
  86. int min_value;
  87. int max_value;
  88. } sbs_data[] = {
  89. [REG_MANUFACTURER_DATA] =
  90. SBS_DATA(POWER_SUPPLY_PROP_PRESENT, 0x00, 0, 65535),
  91. [REG_BATTERY_MODE] =
  92. SBS_DATA(-1, 0x03, 0, 65535),
  93. [REG_TEMPERATURE] =
  94. SBS_DATA(POWER_SUPPLY_PROP_TEMP, 0x08, 0, 65535),
  95. [REG_VOLTAGE] =
  96. SBS_DATA(POWER_SUPPLY_PROP_VOLTAGE_NOW, 0x09, 0, 65535),
  97. [REG_CURRENT_NOW] =
  98. SBS_DATA(POWER_SUPPLY_PROP_CURRENT_NOW, 0x0A, -32768, 32767),
  99. [REG_CURRENT_AVG] =
  100. SBS_DATA(POWER_SUPPLY_PROP_CURRENT_AVG, 0x0B, -32768, 32767),
  101. [REG_MAX_ERR] =
  102. SBS_DATA(POWER_SUPPLY_PROP_CAPACITY_ERROR_MARGIN, 0x0c, 0, 100),
  103. [REG_CAPACITY] =
  104. SBS_DATA(POWER_SUPPLY_PROP_CAPACITY, 0x0D, 0, 100),
  105. [REG_REMAINING_CAPACITY] =
  106. SBS_DATA(POWER_SUPPLY_PROP_ENERGY_NOW, 0x0F, 0, 65535),
  107. [REG_REMAINING_CAPACITY_CHARGE] =
  108. SBS_DATA(POWER_SUPPLY_PROP_CHARGE_NOW, 0x0F, 0, 65535),
  109. [REG_FULL_CHARGE_CAPACITY] =
  110. SBS_DATA(POWER_SUPPLY_PROP_ENERGY_FULL, 0x10, 0, 65535),
  111. [REG_FULL_CHARGE_CAPACITY_CHARGE] =
  112. SBS_DATA(POWER_SUPPLY_PROP_CHARGE_FULL, 0x10, 0, 65535),
  113. [REG_TIME_TO_EMPTY_NOW] =
  114. SBS_DATA(POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW, 0x11, 0, 65535),
  115. [REG_TIME_TO_EMPTY_AVG] =
  116. SBS_DATA(POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG, 0x12, 0, 65535),
  117. [REG_TIME_TO_FULL_AVG] =
  118. SBS_DATA(POWER_SUPPLY_PROP_TIME_TO_FULL_AVG, 0x13, 0, 65535),
  119. [REG_CHARGE_CURRENT] =
  120. SBS_DATA(POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX, 0x14, 0, 65535),
  121. [REG_CHARGE_VOLTAGE] =
  122. SBS_DATA(POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX, 0x15, 0, 65535),
  123. [REG_STATUS] =
  124. SBS_DATA(POWER_SUPPLY_PROP_STATUS, 0x16, 0, 65535),
  125. [REG_CAPACITY_LEVEL] =
  126. SBS_DATA(POWER_SUPPLY_PROP_CAPACITY_LEVEL, 0x16, 0, 65535),
  127. [REG_CYCLE_COUNT] =
  128. SBS_DATA(POWER_SUPPLY_PROP_CYCLE_COUNT, 0x17, 0, 65535),
  129. [REG_DESIGN_CAPACITY] =
  130. SBS_DATA(POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN, 0x18, 0, 65535),
  131. [REG_DESIGN_CAPACITY_CHARGE] =
  132. SBS_DATA(POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN, 0x18, 0, 65535),
  133. [REG_DESIGN_VOLTAGE_MIN] =
  134. SBS_DATA(POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN, 0x19, 0, 65535),
  135. [REG_DESIGN_VOLTAGE_MAX] =
  136. SBS_DATA(POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN, 0x19, 0, 65535),
  137. [REG_SERIAL_NUMBER] =
  138. SBS_DATA(POWER_SUPPLY_PROP_SERIAL_NUMBER, 0x1C, 0, 65535),
  139. /* Properties of type `const char *' */
  140. [REG_MANUFACTURER] =
  141. SBS_DATA(POWER_SUPPLY_PROP_MANUFACTURER, 0x20, 0, 65535),
  142. [REG_MODEL_NAME] =
  143. SBS_DATA(POWER_SUPPLY_PROP_MODEL_NAME, 0x21, 0, 65535),
  144. [REG_CHEMISTRY] =
  145. SBS_DATA(POWER_SUPPLY_PROP_TECHNOLOGY, 0x22, 0, 65535)
  146. };
  147. static const enum power_supply_property sbs_properties[] = {
  148. POWER_SUPPLY_PROP_STATUS,
  149. POWER_SUPPLY_PROP_CAPACITY_LEVEL,
  150. POWER_SUPPLY_PROP_HEALTH,
  151. POWER_SUPPLY_PROP_PRESENT,
  152. POWER_SUPPLY_PROP_TECHNOLOGY,
  153. POWER_SUPPLY_PROP_CYCLE_COUNT,
  154. POWER_SUPPLY_PROP_VOLTAGE_NOW,
  155. POWER_SUPPLY_PROP_CURRENT_NOW,
  156. POWER_SUPPLY_PROP_CURRENT_AVG,
  157. POWER_SUPPLY_PROP_CAPACITY,
  158. POWER_SUPPLY_PROP_CAPACITY_ERROR_MARGIN,
  159. POWER_SUPPLY_PROP_TEMP,
  160. POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW,
  161. POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG,
  162. POWER_SUPPLY_PROP_TIME_TO_FULL_AVG,
  163. POWER_SUPPLY_PROP_SERIAL_NUMBER,
  164. POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
  165. POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
  166. POWER_SUPPLY_PROP_ENERGY_NOW,
  167. POWER_SUPPLY_PROP_ENERGY_FULL,
  168. POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN,
  169. POWER_SUPPLY_PROP_CHARGE_NOW,
  170. POWER_SUPPLY_PROP_CHARGE_FULL,
  171. POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
  172. POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX,
  173. POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX,
  174. POWER_SUPPLY_PROP_MANUFACTURE_YEAR,
  175. POWER_SUPPLY_PROP_MANUFACTURE_MONTH,
  176. POWER_SUPPLY_PROP_MANUFACTURE_DAY,
  177. /* Properties of type `const char *' */
  178. POWER_SUPPLY_PROP_MANUFACTURER,
  179. POWER_SUPPLY_PROP_MODEL_NAME
  180. };
  181. /* Supports special manufacturer commands from TI BQ20Z65 and BQ20Z75 IC. */
  182. #define SBS_FLAGS_TI_BQ20ZX5 BIT(0)
  183. static const enum power_supply_property string_properties[] = {
  184. POWER_SUPPLY_PROP_TECHNOLOGY,
  185. POWER_SUPPLY_PROP_MANUFACTURER,
  186. POWER_SUPPLY_PROP_MODEL_NAME,
  187. };
  188. #define NR_STRING_BUFFERS ARRAY_SIZE(string_properties)
  189. struct sbs_info {
  190. struct i2c_client *client;
  191. struct power_supply *power_supply;
  192. bool is_present;
  193. struct gpio_desc *gpio_detect;
  194. bool charger_broadcasts;
  195. int last_state;
  196. int poll_time;
  197. u32 i2c_retry_count;
  198. u32 poll_retry_count;
  199. struct delayed_work work;
  200. struct mutex mode_lock;
  201. u32 flags;
  202. int technology;
  203. char strings[NR_STRING_BUFFERS][I2C_SMBUS_BLOCK_MAX + 1];
  204. };
  205. static char *sbs_get_string_buf(struct sbs_info *chip,
  206. enum power_supply_property psp)
  207. {
  208. int i = 0;
  209. for (i = 0; i < NR_STRING_BUFFERS; i++)
  210. if (string_properties[i] == psp)
  211. return chip->strings[i];
  212. return ERR_PTR(-EINVAL);
  213. }
  214. static void sbs_invalidate_cached_props(struct sbs_info *chip)
  215. {
  216. int i = 0;
  217. chip->technology = -1;
  218. for (i = 0; i < NR_STRING_BUFFERS; i++)
  219. chip->strings[i][0] = 0;
  220. }
  221. static bool force_load;
  222. static int sbs_read_word_data(struct i2c_client *client, u8 address);
  223. static int sbs_write_word_data(struct i2c_client *client, u8 address, u16 value);
  224. static void sbs_disable_charger_broadcasts(struct sbs_info *chip)
  225. {
  226. int val = sbs_read_word_data(chip->client, BATTERY_MODE_OFFSET);
  227. if (val < 0)
  228. goto exit;
  229. val |= BATTERY_MODE_CHARGER_MASK;
  230. val = sbs_write_word_data(chip->client, BATTERY_MODE_OFFSET, val);
  231. exit:
  232. if (val < 0)
  233. dev_err(&chip->client->dev,
  234. "Failed to disable charger broadcasting: %d\n", val);
  235. else
  236. dev_dbg(&chip->client->dev, "%s\n", __func__);
  237. }
  238. static int sbs_update_presence(struct sbs_info *chip, bool is_present)
  239. {
  240. struct i2c_client *client = chip->client;
  241. int retries = chip->i2c_retry_count;
  242. s32 ret = 0;
  243. u8 version;
  244. if (chip->is_present == is_present)
  245. return 0;
  246. if (!is_present) {
  247. chip->is_present = false;
  248. /* Disable PEC when no device is present */
  249. client->flags &= ~I2C_CLIENT_PEC;
  250. sbs_invalidate_cached_props(chip);
  251. return 0;
  252. }
  253. /* Check if device supports packet error checking and use it */
  254. while (retries > 0) {
  255. ret = i2c_smbus_read_word_data(client, REG_ADDR_SPEC_INFO);
  256. if (ret >= 0)
  257. break;
  258. /*
  259. * Some batteries trigger the detection pin before the
  260. * I2C bus is properly connected. This works around the
  261. * issue.
  262. */
  263. msleep(100);
  264. retries--;
  265. }
  266. if (ret < 0) {
  267. dev_dbg(&client->dev, "failed to read spec info: %d\n", ret);
  268. /* fallback to old behaviour */
  269. client->flags &= ~I2C_CLIENT_PEC;
  270. chip->is_present = true;
  271. return ret;
  272. }
  273. version = (ret & SPEC_INFO_VERSION_MASK) >> SPEC_INFO_VERSION_SHIFT;
  274. if (version == SBS_VERSION_1_1_WITH_PEC)
  275. client->flags |= I2C_CLIENT_PEC;
  276. else
  277. client->flags &= ~I2C_CLIENT_PEC;
  278. if (of_device_is_compatible(client->dev.parent->of_node, "google,cros-ec-i2c-tunnel")
  279. && client->flags & I2C_CLIENT_PEC) {
  280. dev_info(&client->dev, "Disabling PEC because of broken Cros-EC implementation\n");
  281. client->flags &= ~I2C_CLIENT_PEC;
  282. }
  283. dev_dbg(&client->dev, "PEC: %s\n", (client->flags & I2C_CLIENT_PEC) ?
  284. "enabled" : "disabled");
  285. if (!chip->is_present && is_present && !chip->charger_broadcasts)
  286. sbs_disable_charger_broadcasts(chip);
  287. chip->is_present = true;
  288. return 0;
  289. }
  290. static int sbs_read_word_data(struct i2c_client *client, u8 address)
  291. {
  292. struct sbs_info *chip = i2c_get_clientdata(client);
  293. int retries = chip->i2c_retry_count;
  294. s32 ret = 0;
  295. while (retries > 0) {
  296. ret = i2c_smbus_read_word_data(client, address);
  297. if (ret >= 0)
  298. break;
  299. retries--;
  300. }
  301. if (ret < 0) {
  302. dev_dbg(&client->dev,
  303. "%s: i2c read at address 0x%x failed\n",
  304. __func__, address);
  305. return ret;
  306. }
  307. return ret;
  308. }
  309. static int sbs_read_string_data_fallback(struct i2c_client *client, u8 address, char *values)
  310. {
  311. struct sbs_info *chip = i2c_get_clientdata(client);
  312. s32 ret = 0, block_length = 0;
  313. int retries_length, retries_block;
  314. u8 block_buffer[I2C_SMBUS_BLOCK_MAX + 1];
  315. retries_length = chip->i2c_retry_count;
  316. retries_block = chip->i2c_retry_count;
  317. dev_warn_once(&client->dev, "I2C adapter does not support I2C_FUNC_SMBUS_READ_BLOCK_DATA.\n"
  318. "Fallback method does not support PEC.\n");
  319. /* Adapter needs to support these two functions */
  320. if (!i2c_check_functionality(client->adapter,
  321. I2C_FUNC_SMBUS_BYTE_DATA |
  322. I2C_FUNC_SMBUS_I2C_BLOCK)){
  323. return -ENODEV;
  324. }
  325. /* Get the length of block data */
  326. while (retries_length > 0) {
  327. ret = i2c_smbus_read_byte_data(client, address);
  328. if (ret >= 0)
  329. break;
  330. retries_length--;
  331. }
  332. if (ret < 0) {
  333. dev_dbg(&client->dev,
  334. "%s: i2c read at address 0x%x failed\n",
  335. __func__, address);
  336. return ret;
  337. }
  338. /* block_length does not include NULL terminator */
  339. block_length = ret;
  340. if (block_length > I2C_SMBUS_BLOCK_MAX) {
  341. dev_err(&client->dev,
  342. "%s: Returned block_length is longer than 0x%x\n",
  343. __func__, I2C_SMBUS_BLOCK_MAX);
  344. return -EINVAL;
  345. }
  346. /* Get the block data */
  347. while (retries_block > 0) {
  348. ret = i2c_smbus_read_i2c_block_data(
  349. client, address,
  350. block_length + 1, block_buffer);
  351. if (ret >= 0)
  352. break;
  353. retries_block--;
  354. }
  355. if (ret < 0) {
  356. dev_dbg(&client->dev,
  357. "%s: i2c read at address 0x%x failed\n",
  358. __func__, address);
  359. return ret;
  360. }
  361. /* block_buffer[0] == block_length */
  362. memcpy(values, block_buffer + 1, block_length);
  363. values[block_length] = '\0';
  364. return ret;
  365. }
  366. static int sbs_read_string_data(struct i2c_client *client, u8 address, char *values)
  367. {
  368. struct sbs_info *chip = i2c_get_clientdata(client);
  369. int retries = chip->i2c_retry_count;
  370. int ret = 0;
  371. if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_READ_BLOCK_DATA)) {
  372. bool pec = client->flags & I2C_CLIENT_PEC;
  373. client->flags &= ~I2C_CLIENT_PEC;
  374. ret = sbs_read_string_data_fallback(client, address, values);
  375. if (pec)
  376. client->flags |= I2C_CLIENT_PEC;
  377. return ret;
  378. }
  379. while (retries > 0) {
  380. ret = i2c_smbus_read_block_data(client, address, values);
  381. if (ret >= 0)
  382. break;
  383. retries--;
  384. }
  385. if (ret < 0) {
  386. dev_dbg(&client->dev, "failed to read block 0x%x: %d\n", address, ret);
  387. return ret;
  388. }
  389. /* add string termination */
  390. values[ret] = '\0';
  391. return ret;
  392. }
  393. static int sbs_write_word_data(struct i2c_client *client, u8 address,
  394. u16 value)
  395. {
  396. struct sbs_info *chip = i2c_get_clientdata(client);
  397. int retries = chip->i2c_retry_count;
  398. s32 ret = 0;
  399. while (retries > 0) {
  400. ret = i2c_smbus_write_word_data(client, address, value);
  401. if (ret >= 0)
  402. break;
  403. retries--;
  404. }
  405. if (ret < 0) {
  406. dev_dbg(&client->dev,
  407. "%s: i2c write to address 0x%x failed\n",
  408. __func__, address);
  409. return ret;
  410. }
  411. return 0;
  412. }
  413. static int sbs_status_correct(struct i2c_client *client, int *intval)
  414. {
  415. int ret;
  416. ret = sbs_read_word_data(client, sbs_data[REG_CURRENT_NOW].addr);
  417. if (ret < 0)
  418. return ret;
  419. ret = (s16)ret;
  420. /* Not drawing current -> not charging (i.e. idle) */
  421. if (*intval != POWER_SUPPLY_STATUS_FULL && ret == 0)
  422. *intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
  423. if (*intval == POWER_SUPPLY_STATUS_FULL) {
  424. /* Drawing or providing current when full */
  425. if (ret > 0)
  426. *intval = POWER_SUPPLY_STATUS_CHARGING;
  427. else if (ret < 0)
  428. *intval = POWER_SUPPLY_STATUS_DISCHARGING;
  429. }
  430. return 0;
  431. }
  432. static bool sbs_bat_needs_calibration(struct i2c_client *client)
  433. {
  434. int ret;
  435. ret = sbs_read_word_data(client, sbs_data[REG_BATTERY_MODE].addr);
  436. if (ret < 0)
  437. return false;
  438. return !!(ret & BIT(7));
  439. }
  440. static int sbs_get_ti_battery_presence_and_health(
  441. struct i2c_client *client, enum power_supply_property psp,
  442. union power_supply_propval *val)
  443. {
  444. s32 ret;
  445. /*
  446. * Write to ManufacturerAccess with ManufacturerAccess command
  447. * and then read the status.
  448. */
  449. ret = sbs_write_word_data(client, sbs_data[REG_MANUFACTURER_DATA].addr,
  450. MANUFACTURER_ACCESS_STATUS);
  451. if (ret < 0) {
  452. if (psp == POWER_SUPPLY_PROP_PRESENT)
  453. val->intval = 0; /* battery removed */
  454. return ret;
  455. }
  456. ret = sbs_read_word_data(client, sbs_data[REG_MANUFACTURER_DATA].addr);
  457. if (ret < 0) {
  458. if (psp == POWER_SUPPLY_PROP_PRESENT)
  459. val->intval = 0; /* battery removed */
  460. return ret;
  461. }
  462. if (ret < sbs_data[REG_MANUFACTURER_DATA].min_value ||
  463. ret > sbs_data[REG_MANUFACTURER_DATA].max_value) {
  464. val->intval = 0;
  465. return 0;
  466. }
  467. /* Mask the upper nibble of 2nd byte and
  468. * lower byte of response then
  469. * shift the result by 8 to get status*/
  470. ret &= 0x0F00;
  471. ret >>= 8;
  472. if (psp == POWER_SUPPLY_PROP_PRESENT) {
  473. if (ret == 0x0F)
  474. /* battery removed */
  475. val->intval = 0;
  476. else
  477. val->intval = 1;
  478. } else if (psp == POWER_SUPPLY_PROP_HEALTH) {
  479. if (ret == 0x09)
  480. val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
  481. else if (ret == 0x0B)
  482. val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
  483. else if (ret == 0x0C)
  484. val->intval = POWER_SUPPLY_HEALTH_DEAD;
  485. else if (sbs_bat_needs_calibration(client))
  486. val->intval = POWER_SUPPLY_HEALTH_CALIBRATION_REQUIRED;
  487. else
  488. val->intval = POWER_SUPPLY_HEALTH_GOOD;
  489. }
  490. return 0;
  491. }
  492. static int sbs_get_battery_presence_and_health(
  493. struct i2c_client *client, enum power_supply_property psp,
  494. union power_supply_propval *val)
  495. {
  496. struct sbs_info *chip = i2c_get_clientdata(client);
  497. int ret;
  498. if (chip->flags & SBS_FLAGS_TI_BQ20ZX5)
  499. return sbs_get_ti_battery_presence_and_health(client, psp, val);
  500. /* Dummy command; if it succeeds, battery is present. */
  501. ret = sbs_read_word_data(client, sbs_data[REG_STATUS].addr);
  502. if (ret < 0) { /* battery not present*/
  503. if (psp == POWER_SUPPLY_PROP_PRESENT) {
  504. val->intval = 0;
  505. return 0;
  506. }
  507. return ret;
  508. }
  509. if (psp == POWER_SUPPLY_PROP_PRESENT)
  510. val->intval = 1; /* battery present */
  511. else { /* POWER_SUPPLY_PROP_HEALTH */
  512. if (sbs_bat_needs_calibration(client)) {
  513. val->intval = POWER_SUPPLY_HEALTH_CALIBRATION_REQUIRED;
  514. } else {
  515. /* SBS spec doesn't have a general health command. */
  516. val->intval = POWER_SUPPLY_HEALTH_UNKNOWN;
  517. }
  518. }
  519. return 0;
  520. }
  521. static int sbs_get_battery_property(struct i2c_client *client,
  522. int reg_offset, enum power_supply_property psp,
  523. union power_supply_propval *val)
  524. {
  525. struct sbs_info *chip = i2c_get_clientdata(client);
  526. s32 ret;
  527. ret = sbs_read_word_data(client, sbs_data[reg_offset].addr);
  528. if (ret < 0)
  529. return ret;
  530. /* returned values are 16 bit */
  531. if (sbs_data[reg_offset].min_value < 0)
  532. ret = (s16)ret;
  533. if (ret >= sbs_data[reg_offset].min_value &&
  534. ret <= sbs_data[reg_offset].max_value) {
  535. val->intval = ret;
  536. if (psp == POWER_SUPPLY_PROP_CAPACITY_LEVEL) {
  537. if (!(ret & BATTERY_INITIALIZED))
  538. val->intval =
  539. POWER_SUPPLY_CAPACITY_LEVEL_UNKNOWN;
  540. else if (ret & BATTERY_FULL_CHARGED)
  541. val->intval =
  542. POWER_SUPPLY_CAPACITY_LEVEL_FULL;
  543. else if (ret & BATTERY_FULL_DISCHARGED)
  544. val->intval =
  545. POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL;
  546. else
  547. val->intval =
  548. POWER_SUPPLY_CAPACITY_LEVEL_NORMAL;
  549. return 0;
  550. } else if (psp != POWER_SUPPLY_PROP_STATUS) {
  551. return 0;
  552. }
  553. if (ret & BATTERY_FULL_CHARGED)
  554. val->intval = POWER_SUPPLY_STATUS_FULL;
  555. else if (ret & BATTERY_DISCHARGING)
  556. val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
  557. else
  558. val->intval = POWER_SUPPLY_STATUS_CHARGING;
  559. sbs_status_correct(client, &val->intval);
  560. if (chip->poll_time == 0)
  561. chip->last_state = val->intval;
  562. else if (chip->last_state != val->intval) {
  563. cancel_delayed_work_sync(&chip->work);
  564. power_supply_changed(chip->power_supply);
  565. chip->poll_time = 0;
  566. }
  567. } else {
  568. if (psp == POWER_SUPPLY_PROP_STATUS)
  569. val->intval = POWER_SUPPLY_STATUS_UNKNOWN;
  570. else if (psp == POWER_SUPPLY_PROP_CAPACITY)
  571. /* sbs spec says that this can be >100 %
  572. * even if max value is 100 %
  573. */
  574. val->intval = min(ret, 100);
  575. else
  576. val->intval = 0;
  577. }
  578. return 0;
  579. }
  580. static int sbs_get_property_index(struct i2c_client *client,
  581. enum power_supply_property psp)
  582. {
  583. int count;
  584. for (count = 0; count < ARRAY_SIZE(sbs_data); count++)
  585. if (psp == sbs_data[count].psp)
  586. return count;
  587. dev_warn(&client->dev,
  588. "%s: Invalid Property - %d\n", __func__, psp);
  589. return -EINVAL;
  590. }
  591. static const char *sbs_get_constant_string(struct sbs_info *chip,
  592. enum power_supply_property psp)
  593. {
  594. int ret;
  595. char *buf;
  596. u8 addr;
  597. buf = sbs_get_string_buf(chip, psp);
  598. if (IS_ERR(buf))
  599. return buf;
  600. if (!buf[0]) {
  601. ret = sbs_get_property_index(chip->client, psp);
  602. if (ret < 0)
  603. return ERR_PTR(ret);
  604. addr = sbs_data[ret].addr;
  605. ret = sbs_read_string_data(chip->client, addr, buf);
  606. if (ret < 0)
  607. return ERR_PTR(ret);
  608. }
  609. return buf;
  610. }
  611. static void sbs_unit_adjustment(struct i2c_client *client,
  612. enum power_supply_property psp, union power_supply_propval *val)
  613. {
  614. #define BASE_UNIT_CONVERSION 1000
  615. #define BATTERY_MODE_CAP_MULT_WATT (10 * BASE_UNIT_CONVERSION)
  616. #define TIME_UNIT_CONVERSION 60
  617. #define TEMP_KELVIN_TO_CELSIUS 2731
  618. switch (psp) {
  619. case POWER_SUPPLY_PROP_ENERGY_NOW:
  620. case POWER_SUPPLY_PROP_ENERGY_FULL:
  621. case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN:
  622. /* sbs provides energy in units of 10mWh.
  623. * Convert to µWh
  624. */
  625. val->intval *= BATTERY_MODE_CAP_MULT_WATT;
  626. break;
  627. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  628. case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
  629. case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
  630. case POWER_SUPPLY_PROP_CURRENT_NOW:
  631. case POWER_SUPPLY_PROP_CURRENT_AVG:
  632. case POWER_SUPPLY_PROP_CHARGE_NOW:
  633. case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX:
  634. case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX:
  635. case POWER_SUPPLY_PROP_CHARGE_FULL:
  636. case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
  637. val->intval *= BASE_UNIT_CONVERSION;
  638. break;
  639. case POWER_SUPPLY_PROP_TEMP:
  640. /* sbs provides battery temperature in 0.1K
  641. * so convert it to 0.1°C
  642. */
  643. val->intval -= TEMP_KELVIN_TO_CELSIUS;
  644. break;
  645. case POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW:
  646. case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG:
  647. case POWER_SUPPLY_PROP_TIME_TO_FULL_AVG:
  648. /* sbs provides time to empty and time to full in minutes.
  649. * Convert to seconds
  650. */
  651. val->intval *= TIME_UNIT_CONVERSION;
  652. break;
  653. default:
  654. dev_dbg(&client->dev,
  655. "%s: no need for unit conversion %d\n", __func__, psp);
  656. }
  657. }
  658. static enum sbs_capacity_mode sbs_set_capacity_mode(struct i2c_client *client,
  659. enum sbs_capacity_mode mode)
  660. {
  661. int ret, original_val;
  662. original_val = sbs_read_word_data(client, BATTERY_MODE_OFFSET);
  663. if (original_val < 0)
  664. return original_val;
  665. if ((original_val & BATTERY_MODE_CAPACITY_MASK) == mode)
  666. return mode;
  667. if (mode == CAPACITY_MODE_AMPS)
  668. ret = original_val & ~BATTERY_MODE_CAPACITY_MASK;
  669. else
  670. ret = original_val | BATTERY_MODE_CAPACITY_MASK;
  671. ret = sbs_write_word_data(client, BATTERY_MODE_OFFSET, ret);
  672. if (ret < 0)
  673. return ret;
  674. usleep_range(1000, 2000);
  675. return original_val & BATTERY_MODE_CAPACITY_MASK;
  676. }
  677. static int sbs_get_battery_capacity(struct i2c_client *client,
  678. int reg_offset, enum power_supply_property psp,
  679. union power_supply_propval *val)
  680. {
  681. s32 ret;
  682. enum sbs_capacity_mode mode = CAPACITY_MODE_WATTS;
  683. if (power_supply_is_amp_property(psp))
  684. mode = CAPACITY_MODE_AMPS;
  685. mode = sbs_set_capacity_mode(client, mode);
  686. if ((int)mode < 0)
  687. return mode;
  688. ret = sbs_read_word_data(client, sbs_data[reg_offset].addr);
  689. if (ret < 0)
  690. return ret;
  691. val->intval = ret;
  692. ret = sbs_set_capacity_mode(client, mode);
  693. if (ret < 0)
  694. return ret;
  695. return 0;
  696. }
  697. static char sbs_serial[5];
  698. static int sbs_get_battery_serial_number(struct i2c_client *client,
  699. union power_supply_propval *val)
  700. {
  701. int ret;
  702. ret = sbs_read_word_data(client, sbs_data[REG_SERIAL_NUMBER].addr);
  703. if (ret < 0)
  704. return ret;
  705. sprintf(sbs_serial, "%04x", ret);
  706. val->strval = sbs_serial;
  707. return 0;
  708. }
  709. static int sbs_get_chemistry(struct sbs_info *chip,
  710. union power_supply_propval *val)
  711. {
  712. const char *chemistry;
  713. if (chip->technology != -1) {
  714. val->intval = chip->technology;
  715. return 0;
  716. }
  717. chemistry = sbs_get_constant_string(chip, POWER_SUPPLY_PROP_TECHNOLOGY);
  718. if (IS_ERR(chemistry))
  719. return PTR_ERR(chemistry);
  720. if (!strncasecmp(chemistry, "LION", 4))
  721. chip->technology = POWER_SUPPLY_TECHNOLOGY_LION;
  722. else if (!strncasecmp(chemistry, "LiP", 3))
  723. chip->technology = POWER_SUPPLY_TECHNOLOGY_LIPO;
  724. else if (!strncasecmp(chemistry, "NiCd", 4))
  725. chip->technology = POWER_SUPPLY_TECHNOLOGY_NiCd;
  726. else if (!strncasecmp(chemistry, "NiMH", 4))
  727. chip->technology = POWER_SUPPLY_TECHNOLOGY_NiMH;
  728. else
  729. chip->technology = POWER_SUPPLY_TECHNOLOGY_UNKNOWN;
  730. if (chip->technology == POWER_SUPPLY_TECHNOLOGY_UNKNOWN)
  731. dev_warn(&chip->client->dev, "Unknown chemistry: %s\n", chemistry);
  732. val->intval = chip->technology;
  733. return 0;
  734. }
  735. static int sbs_get_battery_manufacture_date(struct i2c_client *client,
  736. enum power_supply_property psp,
  737. union power_supply_propval *val)
  738. {
  739. int ret;
  740. u16 day, month, year;
  741. ret = sbs_read_word_data(client, REG_ADDR_MANUFACTURE_DATE);
  742. if (ret < 0)
  743. return ret;
  744. day = ret & GENMASK(4, 0);
  745. month = (ret & GENMASK(8, 5)) >> 5;
  746. year = ((ret & GENMASK(15, 9)) >> 9) + 1980;
  747. switch (psp) {
  748. case POWER_SUPPLY_PROP_MANUFACTURE_YEAR:
  749. val->intval = year;
  750. break;
  751. case POWER_SUPPLY_PROP_MANUFACTURE_MONTH:
  752. val->intval = month;
  753. break;
  754. case POWER_SUPPLY_PROP_MANUFACTURE_DAY:
  755. val->intval = day;
  756. break;
  757. default:
  758. return -EINVAL;
  759. }
  760. return 0;
  761. }
  762. static int sbs_get_property(struct power_supply *psy,
  763. enum power_supply_property psp,
  764. union power_supply_propval *val)
  765. {
  766. int ret = 0;
  767. struct sbs_info *chip = power_supply_get_drvdata(psy);
  768. struct i2c_client *client = chip->client;
  769. const char *str;
  770. if (chip->gpio_detect) {
  771. ret = gpiod_get_value_cansleep(chip->gpio_detect);
  772. if (ret < 0)
  773. return ret;
  774. if (psp == POWER_SUPPLY_PROP_PRESENT) {
  775. val->intval = ret;
  776. sbs_update_presence(chip, ret);
  777. return 0;
  778. }
  779. if (ret == 0)
  780. return -ENODATA;
  781. }
  782. switch (psp) {
  783. case POWER_SUPPLY_PROP_PRESENT:
  784. case POWER_SUPPLY_PROP_HEALTH:
  785. ret = sbs_get_battery_presence_and_health(client, psp, val);
  786. /* this can only be true if no gpio is used */
  787. if (psp == POWER_SUPPLY_PROP_PRESENT)
  788. return 0;
  789. break;
  790. case POWER_SUPPLY_PROP_TECHNOLOGY:
  791. ret = sbs_get_chemistry(chip, val);
  792. if (ret < 0)
  793. break;
  794. goto done; /* don't trigger power_supply_changed()! */
  795. case POWER_SUPPLY_PROP_ENERGY_NOW:
  796. case POWER_SUPPLY_PROP_ENERGY_FULL:
  797. case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN:
  798. case POWER_SUPPLY_PROP_CHARGE_NOW:
  799. case POWER_SUPPLY_PROP_CHARGE_FULL:
  800. case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
  801. ret = sbs_get_property_index(client, psp);
  802. if (ret < 0)
  803. break;
  804. /* sbs_get_battery_capacity() will change the battery mode
  805. * temporarily to read the requested attribute. Ensure we stay
  806. * in the desired mode for the duration of the attribute read.
  807. */
  808. mutex_lock(&chip->mode_lock);
  809. ret = sbs_get_battery_capacity(client, ret, psp, val);
  810. mutex_unlock(&chip->mode_lock);
  811. break;
  812. case POWER_SUPPLY_PROP_SERIAL_NUMBER:
  813. ret = sbs_get_battery_serial_number(client, val);
  814. break;
  815. case POWER_SUPPLY_PROP_STATUS:
  816. case POWER_SUPPLY_PROP_CAPACITY_LEVEL:
  817. case POWER_SUPPLY_PROP_CYCLE_COUNT:
  818. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  819. case POWER_SUPPLY_PROP_CURRENT_NOW:
  820. case POWER_SUPPLY_PROP_CURRENT_AVG:
  821. case POWER_SUPPLY_PROP_TEMP:
  822. case POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW:
  823. case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG:
  824. case POWER_SUPPLY_PROP_TIME_TO_FULL_AVG:
  825. case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
  826. case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
  827. case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX:
  828. case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX:
  829. case POWER_SUPPLY_PROP_CAPACITY:
  830. case POWER_SUPPLY_PROP_CAPACITY_ERROR_MARGIN:
  831. ret = sbs_get_property_index(client, psp);
  832. if (ret < 0)
  833. break;
  834. ret = sbs_get_battery_property(client, ret, psp, val);
  835. break;
  836. case POWER_SUPPLY_PROP_MODEL_NAME:
  837. case POWER_SUPPLY_PROP_MANUFACTURER:
  838. str = sbs_get_constant_string(chip, psp);
  839. if (IS_ERR(str))
  840. ret = PTR_ERR(str);
  841. else
  842. val->strval = str;
  843. break;
  844. case POWER_SUPPLY_PROP_MANUFACTURE_YEAR:
  845. case POWER_SUPPLY_PROP_MANUFACTURE_MONTH:
  846. case POWER_SUPPLY_PROP_MANUFACTURE_DAY:
  847. ret = sbs_get_battery_manufacture_date(client, psp, val);
  848. break;
  849. default:
  850. dev_err(&client->dev,
  851. "%s: INVALID property\n", __func__);
  852. return -EINVAL;
  853. }
  854. if (!chip->gpio_detect && chip->is_present != (ret >= 0)) {
  855. bool old_present = chip->is_present;
  856. union power_supply_propval val;
  857. int err = sbs_get_battery_presence_and_health(
  858. client, POWER_SUPPLY_PROP_PRESENT, &val);
  859. sbs_update_presence(chip, !err && val.intval);
  860. if (old_present != chip->is_present)
  861. power_supply_changed(chip->power_supply);
  862. }
  863. done:
  864. if (!ret) {
  865. /* Convert units to match requirements for power supply class */
  866. sbs_unit_adjustment(client, psp, val);
  867. dev_dbg(&client->dev,
  868. "%s: property = %d, value = %x\n", __func__,
  869. psp, val->intval);
  870. } else if (!chip->is_present) {
  871. /* battery not present, so return NODATA for properties */
  872. ret = -ENODATA;
  873. }
  874. return ret;
  875. }
  876. static void sbs_supply_changed(struct sbs_info *chip)
  877. {
  878. struct power_supply *battery = chip->power_supply;
  879. int ret;
  880. ret = gpiod_get_value_cansleep(chip->gpio_detect);
  881. if (ret < 0)
  882. return;
  883. sbs_update_presence(chip, ret);
  884. power_supply_changed(battery);
  885. }
  886. static irqreturn_t sbs_irq(int irq, void *devid)
  887. {
  888. sbs_supply_changed(devid);
  889. return IRQ_HANDLED;
  890. }
  891. static void sbs_alert(struct i2c_client *client, enum i2c_alert_protocol prot,
  892. unsigned int data)
  893. {
  894. sbs_supply_changed(i2c_get_clientdata(client));
  895. }
  896. static void sbs_external_power_changed(struct power_supply *psy)
  897. {
  898. struct sbs_info *chip = power_supply_get_drvdata(psy);
  899. /* cancel outstanding work */
  900. cancel_delayed_work_sync(&chip->work);
  901. schedule_delayed_work(&chip->work, HZ);
  902. chip->poll_time = chip->poll_retry_count;
  903. }
  904. static void sbs_delayed_work(struct work_struct *work)
  905. {
  906. struct sbs_info *chip;
  907. s32 ret;
  908. chip = container_of(work, struct sbs_info, work.work);
  909. ret = sbs_read_word_data(chip->client, sbs_data[REG_STATUS].addr);
  910. /* if the read failed, give up on this work */
  911. if (ret < 0) {
  912. chip->poll_time = 0;
  913. return;
  914. }
  915. if (ret & BATTERY_FULL_CHARGED)
  916. ret = POWER_SUPPLY_STATUS_FULL;
  917. else if (ret & BATTERY_DISCHARGING)
  918. ret = POWER_SUPPLY_STATUS_DISCHARGING;
  919. else
  920. ret = POWER_SUPPLY_STATUS_CHARGING;
  921. sbs_status_correct(chip->client, &ret);
  922. if (chip->last_state != ret) {
  923. chip->poll_time = 0;
  924. power_supply_changed(chip->power_supply);
  925. return;
  926. }
  927. if (chip->poll_time > 0) {
  928. schedule_delayed_work(&chip->work, HZ);
  929. chip->poll_time--;
  930. return;
  931. }
  932. }
  933. static const struct power_supply_desc sbs_default_desc = {
  934. .type = POWER_SUPPLY_TYPE_BATTERY,
  935. .properties = sbs_properties,
  936. .num_properties = ARRAY_SIZE(sbs_properties),
  937. .get_property = sbs_get_property,
  938. .external_power_changed = sbs_external_power_changed,
  939. };
  940. static int sbs_probe(struct i2c_client *client)
  941. {
  942. struct sbs_info *chip;
  943. struct power_supply_desc *sbs_desc;
  944. struct sbs_platform_data *pdata = client->dev.platform_data;
  945. struct power_supply_config psy_cfg = {};
  946. int rc;
  947. int irq;
  948. sbs_desc = devm_kmemdup(&client->dev, &sbs_default_desc,
  949. sizeof(*sbs_desc), GFP_KERNEL);
  950. if (!sbs_desc)
  951. return -ENOMEM;
  952. sbs_desc->name = devm_kasprintf(&client->dev, GFP_KERNEL, "sbs-%s",
  953. dev_name(&client->dev));
  954. if (!sbs_desc->name)
  955. return -ENOMEM;
  956. chip = devm_kzalloc(&client->dev, sizeof(struct sbs_info), GFP_KERNEL);
  957. if (!chip)
  958. return -ENOMEM;
  959. chip->flags = (u32)(uintptr_t)device_get_match_data(&client->dev);
  960. chip->client = client;
  961. psy_cfg.of_node = client->dev.of_node;
  962. psy_cfg.drv_data = chip;
  963. chip->last_state = POWER_SUPPLY_STATUS_UNKNOWN;
  964. sbs_invalidate_cached_props(chip);
  965. mutex_init(&chip->mode_lock);
  966. /* use pdata if available, fall back to DT properties,
  967. * or hardcoded defaults if not
  968. */
  969. rc = device_property_read_u32(&client->dev, "sbs,i2c-retry-count",
  970. &chip->i2c_retry_count);
  971. if (rc)
  972. chip->i2c_retry_count = 0;
  973. rc = device_property_read_u32(&client->dev, "sbs,poll-retry-count",
  974. &chip->poll_retry_count);
  975. if (rc)
  976. chip->poll_retry_count = 0;
  977. if (pdata) {
  978. chip->poll_retry_count = pdata->poll_retry_count;
  979. chip->i2c_retry_count = pdata->i2c_retry_count;
  980. }
  981. chip->i2c_retry_count = chip->i2c_retry_count + 1;
  982. chip->charger_broadcasts = !device_property_read_bool(&client->dev,
  983. "sbs,disable-charger-broadcasts");
  984. chip->gpio_detect = devm_gpiod_get_optional(&client->dev,
  985. "sbs,battery-detect", GPIOD_IN);
  986. if (IS_ERR(chip->gpio_detect))
  987. return dev_err_probe(&client->dev, PTR_ERR(chip->gpio_detect),
  988. "Failed to get gpio\n");
  989. i2c_set_clientdata(client, chip);
  990. if (!chip->gpio_detect)
  991. goto skip_gpio;
  992. irq = gpiod_to_irq(chip->gpio_detect);
  993. if (irq <= 0) {
  994. dev_warn(&client->dev, "Failed to get gpio as irq: %d\n", irq);
  995. goto skip_gpio;
  996. }
  997. rc = devm_request_threaded_irq(&client->dev, irq, NULL, sbs_irq,
  998. IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
  999. dev_name(&client->dev), chip);
  1000. if (rc) {
  1001. dev_warn(&client->dev, "Failed to request irq: %d\n", rc);
  1002. goto skip_gpio;
  1003. }
  1004. skip_gpio:
  1005. /*
  1006. * Before we register, we might need to make sure we can actually talk
  1007. * to the battery.
  1008. */
  1009. if (!(force_load || chip->gpio_detect)) {
  1010. union power_supply_propval val;
  1011. rc = sbs_get_battery_presence_and_health(
  1012. client, POWER_SUPPLY_PROP_PRESENT, &val);
  1013. if (rc < 0 || !val.intval)
  1014. return dev_err_probe(&client->dev, -ENODEV,
  1015. "Failed to get present status\n");
  1016. }
  1017. rc = devm_delayed_work_autocancel(&client->dev, &chip->work,
  1018. sbs_delayed_work);
  1019. if (rc)
  1020. return rc;
  1021. chip->power_supply = devm_power_supply_register(&client->dev, sbs_desc,
  1022. &psy_cfg);
  1023. if (IS_ERR(chip->power_supply))
  1024. return dev_err_probe(&client->dev, PTR_ERR(chip->power_supply),
  1025. "Failed to register power supply\n");
  1026. dev_info(&client->dev,
  1027. "%s: battery gas gauge device registered\n", client->name);
  1028. return 0;
  1029. }
  1030. #if defined CONFIG_PM_SLEEP
  1031. static int sbs_suspend(struct device *dev)
  1032. {
  1033. struct i2c_client *client = to_i2c_client(dev);
  1034. struct sbs_info *chip = i2c_get_clientdata(client);
  1035. int ret;
  1036. if (chip->poll_time > 0)
  1037. cancel_delayed_work_sync(&chip->work);
  1038. if (chip->flags & SBS_FLAGS_TI_BQ20ZX5) {
  1039. /* Write to manufacturer access with sleep command. */
  1040. ret = sbs_write_word_data(client,
  1041. sbs_data[REG_MANUFACTURER_DATA].addr,
  1042. MANUFACTURER_ACCESS_SLEEP);
  1043. if (chip->is_present && ret < 0)
  1044. return ret;
  1045. }
  1046. return 0;
  1047. }
  1048. static SIMPLE_DEV_PM_OPS(sbs_pm_ops, sbs_suspend, NULL);
  1049. #define SBS_PM_OPS (&sbs_pm_ops)
  1050. #else
  1051. #define SBS_PM_OPS NULL
  1052. #endif
  1053. static const struct i2c_device_id sbs_id[] = {
  1054. { "bq20z65", 0 },
  1055. { "bq20z75", 0 },
  1056. { "sbs-battery", 1 },
  1057. {}
  1058. };
  1059. MODULE_DEVICE_TABLE(i2c, sbs_id);
  1060. static const struct of_device_id sbs_dt_ids[] = {
  1061. { .compatible = "sbs,sbs-battery" },
  1062. {
  1063. .compatible = "ti,bq20z65",
  1064. .data = (void *)SBS_FLAGS_TI_BQ20ZX5,
  1065. },
  1066. {
  1067. .compatible = "ti,bq20z75",
  1068. .data = (void *)SBS_FLAGS_TI_BQ20ZX5,
  1069. },
  1070. { }
  1071. };
  1072. MODULE_DEVICE_TABLE(of, sbs_dt_ids);
  1073. static struct i2c_driver sbs_battery_driver = {
  1074. .probe_new = sbs_probe,
  1075. .alert = sbs_alert,
  1076. .id_table = sbs_id,
  1077. .driver = {
  1078. .name = "sbs-battery",
  1079. .of_match_table = sbs_dt_ids,
  1080. .pm = SBS_PM_OPS,
  1081. },
  1082. };
  1083. module_i2c_driver(sbs_battery_driver);
  1084. MODULE_DESCRIPTION("SBS battery monitor driver");
  1085. MODULE_LICENSE("GPL");
  1086. module_param(force_load, bool, 0444);
  1087. MODULE_PARM_DESC(force_load,
  1088. "Attempt to load the driver even if no battery is connected");