bq20z75.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667
  1. /*
  2. * Gas Gauge driver for TI's BQ20Z75
  3. *
  4. * Copyright (c) 2010, NVIDIA Corporation.
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation; either version 2 of the License, or
  9. * (at your option) any later version.
  10. *
  11. * This program is distributed in the hope that it will be useful, but WITHOUT
  12. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  14. * more details.
  15. *
  16. * You should have received a copy of the GNU General Public License along
  17. * with this program; if not, write to the Free Software Foundation, Inc.,
  18. * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
  19. */
  20. #include <linux/init.h>
  21. #include <linux/module.h>
  22. #include <linux/kernel.h>
  23. #include <linux/err.h>
  24. #include <linux/power_supply.h>
  25. #include <linux/i2c.h>
  26. #include <linux/slab.h>
  27. #include <linux/interrupt.h>
  28. #include <linux/gpio.h>
  29. #include <linux/power/bq20z75.h>
  30. enum {
  31. REG_MANUFACTURER_DATA,
  32. REG_TEMPERATURE,
  33. REG_VOLTAGE,
  34. REG_CURRENT,
  35. REG_CAPACITY,
  36. REG_TIME_TO_EMPTY,
  37. REG_TIME_TO_FULL,
  38. REG_STATUS,
  39. REG_CYCLE_COUNT,
  40. REG_SERIAL_NUMBER,
  41. REG_REMAINING_CAPACITY,
  42. REG_REMAINING_CAPACITY_CHARGE,
  43. REG_FULL_CHARGE_CAPACITY,
  44. REG_FULL_CHARGE_CAPACITY_CHARGE,
  45. REG_DESIGN_CAPACITY,
  46. REG_DESIGN_CAPACITY_CHARGE,
  47. REG_DESIGN_VOLTAGE,
  48. };
  49. /* Battery Mode defines */
  50. #define BATTERY_MODE_OFFSET 0x03
  51. #define BATTERY_MODE_MASK 0x8000
  52. enum bq20z75_battery_mode {
  53. BATTERY_MODE_AMPS,
  54. BATTERY_MODE_WATTS
  55. };
  56. /* manufacturer access defines */
  57. #define MANUFACTURER_ACCESS_STATUS 0x0006
  58. #define MANUFACTURER_ACCESS_SLEEP 0x0011
  59. /* battery status value bits */
  60. #define BATTERY_DISCHARGING 0x40
  61. #define BATTERY_FULL_CHARGED 0x20
  62. #define BATTERY_FULL_DISCHARGED 0x10
  63. #define BQ20Z75_DATA(_psp, _addr, _min_value, _max_value) { \
  64. .psp = _psp, \
  65. .addr = _addr, \
  66. .min_value = _min_value, \
  67. .max_value = _max_value, \
  68. }
  69. static const struct bq20z75_device_data {
  70. enum power_supply_property psp;
  71. u8 addr;
  72. int min_value;
  73. int max_value;
  74. } bq20z75_data[] = {
  75. [REG_MANUFACTURER_DATA] =
  76. BQ20Z75_DATA(POWER_SUPPLY_PROP_PRESENT, 0x00, 0, 65535),
  77. [REG_TEMPERATURE] =
  78. BQ20Z75_DATA(POWER_SUPPLY_PROP_TEMP, 0x08, 0, 65535),
  79. [REG_VOLTAGE] =
  80. BQ20Z75_DATA(POWER_SUPPLY_PROP_VOLTAGE_NOW, 0x09, 0, 20000),
  81. [REG_CURRENT] =
  82. BQ20Z75_DATA(POWER_SUPPLY_PROP_CURRENT_NOW, 0x0A, -32768,
  83. 32767),
  84. [REG_CAPACITY] =
  85. BQ20Z75_DATA(POWER_SUPPLY_PROP_CAPACITY, 0x0E, 0, 100),
  86. [REG_REMAINING_CAPACITY] =
  87. BQ20Z75_DATA(POWER_SUPPLY_PROP_ENERGY_NOW, 0x0F, 0, 65535),
  88. [REG_REMAINING_CAPACITY_CHARGE] =
  89. BQ20Z75_DATA(POWER_SUPPLY_PROP_CHARGE_NOW, 0x0F, 0, 65535),
  90. [REG_FULL_CHARGE_CAPACITY] =
  91. BQ20Z75_DATA(POWER_SUPPLY_PROP_ENERGY_FULL, 0x10, 0, 65535),
  92. [REG_FULL_CHARGE_CAPACITY_CHARGE] =
  93. BQ20Z75_DATA(POWER_SUPPLY_PROP_CHARGE_FULL, 0x10, 0, 65535),
  94. [REG_TIME_TO_EMPTY] =
  95. BQ20Z75_DATA(POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG, 0x12, 0,
  96. 65535),
  97. [REG_TIME_TO_FULL] =
  98. BQ20Z75_DATA(POWER_SUPPLY_PROP_TIME_TO_FULL_AVG, 0x13, 0,
  99. 65535),
  100. [REG_STATUS] =
  101. BQ20Z75_DATA(POWER_SUPPLY_PROP_STATUS, 0x16, 0, 65535),
  102. [REG_CYCLE_COUNT] =
  103. BQ20Z75_DATA(POWER_SUPPLY_PROP_CYCLE_COUNT, 0x17, 0, 65535),
  104. [REG_DESIGN_CAPACITY] =
  105. BQ20Z75_DATA(POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN, 0x18, 0,
  106. 65535),
  107. [REG_DESIGN_CAPACITY_CHARGE] =
  108. BQ20Z75_DATA(POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN, 0x18, 0,
  109. 65535),
  110. [REG_DESIGN_VOLTAGE] =
  111. BQ20Z75_DATA(POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN, 0x19, 0,
  112. 65535),
  113. [REG_SERIAL_NUMBER] =
  114. BQ20Z75_DATA(POWER_SUPPLY_PROP_SERIAL_NUMBER, 0x1C, 0, 65535),
  115. };
  116. static enum power_supply_property bq20z75_properties[] = {
  117. POWER_SUPPLY_PROP_STATUS,
  118. POWER_SUPPLY_PROP_HEALTH,
  119. POWER_SUPPLY_PROP_PRESENT,
  120. POWER_SUPPLY_PROP_TECHNOLOGY,
  121. POWER_SUPPLY_PROP_CYCLE_COUNT,
  122. POWER_SUPPLY_PROP_VOLTAGE_NOW,
  123. POWER_SUPPLY_PROP_CURRENT_NOW,
  124. POWER_SUPPLY_PROP_CAPACITY,
  125. POWER_SUPPLY_PROP_TEMP,
  126. POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG,
  127. POWER_SUPPLY_PROP_TIME_TO_FULL_AVG,
  128. POWER_SUPPLY_PROP_SERIAL_NUMBER,
  129. POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
  130. POWER_SUPPLY_PROP_ENERGY_NOW,
  131. POWER_SUPPLY_PROP_ENERGY_FULL,
  132. POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN,
  133. POWER_SUPPLY_PROP_CHARGE_NOW,
  134. POWER_SUPPLY_PROP_CHARGE_FULL,
  135. POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
  136. };
  137. struct bq20z75_info {
  138. struct i2c_client *client;
  139. struct power_supply power_supply;
  140. struct bq20z75_platform_data *pdata;
  141. bool is_present;
  142. bool gpio_detect;
  143. bool enable_detection;
  144. int irq;
  145. };
  146. static int bq20z75_read_word_data(struct i2c_client *client, u8 address)
  147. {
  148. s32 ret;
  149. ret = i2c_smbus_read_word_data(client, address);
  150. if (ret < 0) {
  151. dev_err(&client->dev,
  152. "%s: i2c read at address 0x%x failed\n",
  153. __func__, address);
  154. return ret;
  155. }
  156. return le16_to_cpu(ret);
  157. }
  158. static int bq20z75_write_word_data(struct i2c_client *client, u8 address,
  159. u16 value)
  160. {
  161. s32 ret;
  162. ret = i2c_smbus_write_word_data(client, address, le16_to_cpu(value));
  163. if (ret < 0) {
  164. dev_err(&client->dev,
  165. "%s: i2c write to address 0x%x failed\n",
  166. __func__, address);
  167. return ret;
  168. }
  169. return 0;
  170. }
  171. static int bq20z75_get_battery_presence_and_health(
  172. struct i2c_client *client, enum power_supply_property psp,
  173. union power_supply_propval *val)
  174. {
  175. s32 ret;
  176. struct bq20z75_info *bq20z75_device = i2c_get_clientdata(client);
  177. if (psp == POWER_SUPPLY_PROP_PRESENT &&
  178. bq20z75_device->gpio_detect) {
  179. ret = gpio_get_value(
  180. bq20z75_device->pdata->battery_detect);
  181. if (ret == bq20z75_device->pdata->battery_detect_present)
  182. val->intval = 1;
  183. else
  184. val->intval = 0;
  185. return ret;
  186. }
  187. /* Write to ManufacturerAccess with
  188. * ManufacturerAccess command and then
  189. * read the status */
  190. ret = bq20z75_write_word_data(client,
  191. bq20z75_data[REG_MANUFACTURER_DATA].addr,
  192. MANUFACTURER_ACCESS_STATUS);
  193. if (ret < 0)
  194. return ret;
  195. ret = bq20z75_read_word_data(client,
  196. bq20z75_data[REG_MANUFACTURER_DATA].addr);
  197. if (ret < 0) {
  198. if (psp == POWER_SUPPLY_PROP_PRESENT)
  199. val->intval = 0; /* battery removed */
  200. return ret;
  201. }
  202. if (ret < bq20z75_data[REG_MANUFACTURER_DATA].min_value ||
  203. ret > bq20z75_data[REG_MANUFACTURER_DATA].max_value) {
  204. val->intval = 0;
  205. return 0;
  206. }
  207. /* Mask the upper nibble of 2nd byte and
  208. * lower byte of response then
  209. * shift the result by 8 to get status*/
  210. ret &= 0x0F00;
  211. ret >>= 8;
  212. if (psp == POWER_SUPPLY_PROP_PRESENT) {
  213. if (ret == 0x0F)
  214. /* battery removed */
  215. val->intval = 0;
  216. else
  217. val->intval = 1;
  218. } else if (psp == POWER_SUPPLY_PROP_HEALTH) {
  219. if (ret == 0x09)
  220. val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
  221. else if (ret == 0x0B)
  222. val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
  223. else if (ret == 0x0C)
  224. val->intval = POWER_SUPPLY_HEALTH_DEAD;
  225. else
  226. val->intval = POWER_SUPPLY_HEALTH_GOOD;
  227. }
  228. return 0;
  229. }
  230. static int bq20z75_get_battery_property(struct i2c_client *client,
  231. int reg_offset, enum power_supply_property psp,
  232. union power_supply_propval *val)
  233. {
  234. s32 ret;
  235. ret = bq20z75_read_word_data(client,
  236. bq20z75_data[reg_offset].addr);
  237. if (ret < 0)
  238. return ret;
  239. /* returned values are 16 bit */
  240. if (bq20z75_data[reg_offset].min_value < 0)
  241. ret = (s16)ret;
  242. if (ret >= bq20z75_data[reg_offset].min_value &&
  243. ret <= bq20z75_data[reg_offset].max_value) {
  244. val->intval = ret;
  245. if (psp == POWER_SUPPLY_PROP_STATUS) {
  246. if (ret & BATTERY_FULL_CHARGED)
  247. val->intval = POWER_SUPPLY_STATUS_FULL;
  248. else if (ret & BATTERY_FULL_DISCHARGED)
  249. val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
  250. else if (ret & BATTERY_DISCHARGING)
  251. val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
  252. else
  253. val->intval = POWER_SUPPLY_STATUS_CHARGING;
  254. }
  255. } else {
  256. if (psp == POWER_SUPPLY_PROP_STATUS)
  257. val->intval = POWER_SUPPLY_STATUS_UNKNOWN;
  258. else
  259. val->intval = 0;
  260. }
  261. return 0;
  262. }
  263. static void bq20z75_unit_adjustment(struct i2c_client *client,
  264. enum power_supply_property psp, union power_supply_propval *val)
  265. {
  266. #define BASE_UNIT_CONVERSION 1000
  267. #define BATTERY_MODE_CAP_MULT_WATT (10 * BASE_UNIT_CONVERSION)
  268. #define TIME_UNIT_CONVERSION 600
  269. #define TEMP_KELVIN_TO_CELCIUS 2731
  270. switch (psp) {
  271. case POWER_SUPPLY_PROP_ENERGY_NOW:
  272. case POWER_SUPPLY_PROP_ENERGY_FULL:
  273. case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN:
  274. val->intval *= BATTERY_MODE_CAP_MULT_WATT;
  275. break;
  276. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  277. case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
  278. case POWER_SUPPLY_PROP_CURRENT_NOW:
  279. case POWER_SUPPLY_PROP_CHARGE_NOW:
  280. case POWER_SUPPLY_PROP_CHARGE_FULL:
  281. case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
  282. val->intval *= BASE_UNIT_CONVERSION;
  283. break;
  284. case POWER_SUPPLY_PROP_TEMP:
  285. /* bq20z75 provides battery tempreture in 0.1°K
  286. * so convert it to 0.1°C */
  287. val->intval -= TEMP_KELVIN_TO_CELCIUS;
  288. val->intval *= 10;
  289. break;
  290. case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG:
  291. case POWER_SUPPLY_PROP_TIME_TO_FULL_AVG:
  292. val->intval *= TIME_UNIT_CONVERSION;
  293. break;
  294. default:
  295. dev_dbg(&client->dev,
  296. "%s: no need for unit conversion %d\n", __func__, psp);
  297. }
  298. }
  299. static enum bq20z75_battery_mode
  300. bq20z75_set_battery_mode(struct i2c_client *client,
  301. enum bq20z75_battery_mode mode)
  302. {
  303. int ret, original_val;
  304. original_val = bq20z75_read_word_data(client, BATTERY_MODE_OFFSET);
  305. if (original_val < 0)
  306. return original_val;
  307. if ((original_val & BATTERY_MODE_MASK) == mode)
  308. return mode;
  309. if (mode == BATTERY_MODE_AMPS)
  310. ret = original_val & ~BATTERY_MODE_MASK;
  311. else
  312. ret = original_val | BATTERY_MODE_MASK;
  313. ret = bq20z75_write_word_data(client, BATTERY_MODE_OFFSET, ret);
  314. if (ret < 0)
  315. return ret;
  316. return original_val & BATTERY_MODE_MASK;
  317. }
  318. static int bq20z75_get_battery_capacity(struct i2c_client *client,
  319. int reg_offset, enum power_supply_property psp,
  320. union power_supply_propval *val)
  321. {
  322. s32 ret;
  323. enum bq20z75_battery_mode mode = BATTERY_MODE_WATTS;
  324. if (power_supply_is_amp_property(psp))
  325. mode = BATTERY_MODE_AMPS;
  326. mode = bq20z75_set_battery_mode(client, mode);
  327. if (mode < 0)
  328. return mode;
  329. ret = bq20z75_read_word_data(client, bq20z75_data[reg_offset].addr);
  330. if (ret < 0)
  331. return ret;
  332. if (psp == POWER_SUPPLY_PROP_CAPACITY) {
  333. /* bq20z75 spec says that this can be >100 %
  334. * even if max value is 100 % */
  335. val->intval = min(ret, 100);
  336. } else
  337. val->intval = ret;
  338. ret = bq20z75_set_battery_mode(client, mode);
  339. if (ret < 0)
  340. return ret;
  341. return 0;
  342. }
  343. static char bq20z75_serial[5];
  344. static int bq20z75_get_battery_serial_number(struct i2c_client *client,
  345. union power_supply_propval *val)
  346. {
  347. int ret;
  348. ret = bq20z75_read_word_data(client,
  349. bq20z75_data[REG_SERIAL_NUMBER].addr);
  350. if (ret < 0)
  351. return ret;
  352. ret = sprintf(bq20z75_serial, "%04x", ret);
  353. val->strval = bq20z75_serial;
  354. return 0;
  355. }
  356. static int bq20z75_get_property_index(struct i2c_client *client,
  357. enum power_supply_property psp)
  358. {
  359. int count;
  360. for (count = 0; count < ARRAY_SIZE(bq20z75_data); count++)
  361. if (psp == bq20z75_data[count].psp)
  362. return count;
  363. dev_warn(&client->dev,
  364. "%s: Invalid Property - %d\n", __func__, psp);
  365. return -EINVAL;
  366. }
  367. static int bq20z75_get_property(struct power_supply *psy,
  368. enum power_supply_property psp,
  369. union power_supply_propval *val)
  370. {
  371. int ret = 0;
  372. struct bq20z75_info *bq20z75_device = container_of(psy,
  373. struct bq20z75_info, power_supply);
  374. struct i2c_client *client = bq20z75_device->client;
  375. switch (psp) {
  376. case POWER_SUPPLY_PROP_PRESENT:
  377. case POWER_SUPPLY_PROP_HEALTH:
  378. ret = bq20z75_get_battery_presence_and_health(client, psp, val);
  379. break;
  380. case POWER_SUPPLY_PROP_TECHNOLOGY:
  381. val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
  382. break;
  383. case POWER_SUPPLY_PROP_ENERGY_NOW:
  384. case POWER_SUPPLY_PROP_ENERGY_FULL:
  385. case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN:
  386. case POWER_SUPPLY_PROP_CHARGE_NOW:
  387. case POWER_SUPPLY_PROP_CHARGE_FULL:
  388. case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
  389. case POWER_SUPPLY_PROP_CAPACITY:
  390. ret = bq20z75_get_property_index(client, psp);
  391. if (ret < 0)
  392. break;
  393. ret = bq20z75_get_battery_capacity(client, ret, psp, val);
  394. break;
  395. case POWER_SUPPLY_PROP_SERIAL_NUMBER:
  396. ret = bq20z75_get_battery_serial_number(client, val);
  397. break;
  398. case POWER_SUPPLY_PROP_STATUS:
  399. case POWER_SUPPLY_PROP_CYCLE_COUNT:
  400. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  401. case POWER_SUPPLY_PROP_CURRENT_NOW:
  402. case POWER_SUPPLY_PROP_TEMP:
  403. case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG:
  404. case POWER_SUPPLY_PROP_TIME_TO_FULL_AVG:
  405. case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
  406. ret = bq20z75_get_property_index(client, psp);
  407. if (ret < 0)
  408. break;
  409. ret = bq20z75_get_battery_property(client, ret, psp, val);
  410. break;
  411. default:
  412. dev_err(&client->dev,
  413. "%s: INVALID property\n", __func__);
  414. return -EINVAL;
  415. }
  416. if (!bq20z75_device->enable_detection)
  417. goto done;
  418. if (!bq20z75_device->gpio_detect &&
  419. bq20z75_device->is_present != (ret >= 0)) {
  420. bq20z75_device->is_present = (ret >= 0);
  421. power_supply_changed(&bq20z75_device->power_supply);
  422. }
  423. done:
  424. if (!ret) {
  425. /* Convert units to match requirements for power supply class */
  426. bq20z75_unit_adjustment(client, psp, val);
  427. }
  428. dev_dbg(&client->dev,
  429. "%s: property = %d, value = %d\n", __func__, psp, val->intval);
  430. return ret;
  431. }
  432. static irqreturn_t bq20z75_irq(int irq, void *devid)
  433. {
  434. struct power_supply *battery = devid;
  435. power_supply_changed(battery);
  436. return IRQ_HANDLED;
  437. }
  438. static int __devinit bq20z75_probe(struct i2c_client *client,
  439. const struct i2c_device_id *id)
  440. {
  441. struct bq20z75_info *bq20z75_device;
  442. struct bq20z75_platform_data *pdata = client->dev.platform_data;
  443. int rc;
  444. int irq;
  445. bq20z75_device = kzalloc(sizeof(struct bq20z75_info), GFP_KERNEL);
  446. if (!bq20z75_device)
  447. return -ENOMEM;
  448. bq20z75_device->client = client;
  449. bq20z75_device->enable_detection = false;
  450. bq20z75_device->gpio_detect = false;
  451. bq20z75_device->power_supply.name = "battery";
  452. bq20z75_device->power_supply.type = POWER_SUPPLY_TYPE_BATTERY;
  453. bq20z75_device->power_supply.properties = bq20z75_properties;
  454. bq20z75_device->power_supply.num_properties =
  455. ARRAY_SIZE(bq20z75_properties);
  456. bq20z75_device->power_supply.get_property = bq20z75_get_property;
  457. if (pdata) {
  458. bq20z75_device->gpio_detect =
  459. gpio_is_valid(pdata->battery_detect);
  460. bq20z75_device->pdata = pdata;
  461. }
  462. i2c_set_clientdata(client, bq20z75_device);
  463. if (!bq20z75_device->gpio_detect)
  464. goto skip_gpio;
  465. rc = gpio_request(pdata->battery_detect, dev_name(&client->dev));
  466. if (rc) {
  467. dev_warn(&client->dev, "Failed to request gpio: %d\n", rc);
  468. bq20z75_device->gpio_detect = false;
  469. goto skip_gpio;
  470. }
  471. rc = gpio_direction_input(pdata->battery_detect);
  472. if (rc) {
  473. dev_warn(&client->dev, "Failed to get gpio as input: %d\n", rc);
  474. gpio_free(pdata->battery_detect);
  475. bq20z75_device->gpio_detect = false;
  476. goto skip_gpio;
  477. }
  478. irq = gpio_to_irq(pdata->battery_detect);
  479. if (irq <= 0) {
  480. dev_warn(&client->dev, "Failed to get gpio as irq: %d\n", irq);
  481. gpio_free(pdata->battery_detect);
  482. bq20z75_device->gpio_detect = false;
  483. goto skip_gpio;
  484. }
  485. rc = request_irq(irq, bq20z75_irq,
  486. IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
  487. dev_name(&client->dev), &bq20z75_device->power_supply);
  488. if (rc) {
  489. dev_warn(&client->dev, "Failed to request irq: %d\n", rc);
  490. gpio_free(pdata->battery_detect);
  491. bq20z75_device->gpio_detect = false;
  492. goto skip_gpio;
  493. }
  494. bq20z75_device->irq = irq;
  495. skip_gpio:
  496. rc = power_supply_register(&client->dev, &bq20z75_device->power_supply);
  497. if (rc) {
  498. dev_err(&client->dev,
  499. "%s: Failed to register power supply\n", __func__);
  500. goto exit_psupply;
  501. }
  502. dev_info(&client->dev,
  503. "%s: battery gas gauge device registered\n", client->name);
  504. return 0;
  505. exit_psupply:
  506. if (bq20z75_device->irq)
  507. free_irq(bq20z75_device->irq, &bq20z75_device->power_supply);
  508. if (bq20z75_device->gpio_detect)
  509. gpio_free(pdata->battery_detect);
  510. kfree(bq20z75_device);
  511. return rc;
  512. }
  513. static int __devexit bq20z75_remove(struct i2c_client *client)
  514. {
  515. struct bq20z75_info *bq20z75_device = i2c_get_clientdata(client);
  516. if (bq20z75_device->irq)
  517. free_irq(bq20z75_device->irq, &bq20z75_device->power_supply);
  518. if (bq20z75_device->gpio_detect)
  519. gpio_free(bq20z75_device->pdata->battery_detect);
  520. power_supply_unregister(&bq20z75_device->power_supply);
  521. kfree(bq20z75_device);
  522. bq20z75_device = NULL;
  523. return 0;
  524. }
  525. #if defined CONFIG_PM
  526. static int bq20z75_suspend(struct i2c_client *client,
  527. pm_message_t state)
  528. {
  529. s32 ret;
  530. /* write to manufacturer access with sleep command */
  531. ret = bq20z75_write_word_data(client,
  532. bq20z75_data[REG_MANUFACTURER_DATA].addr,
  533. MANUFACTURER_ACCESS_SLEEP);
  534. if (ret < 0)
  535. return ret;
  536. return 0;
  537. }
  538. #else
  539. #define bq20z75_suspend NULL
  540. #endif
  541. /* any smbus transaction will wake up bq20z75 */
  542. #define bq20z75_resume NULL
  543. static const struct i2c_device_id bq20z75_id[] = {
  544. { "bq20z75", 0 },
  545. {}
  546. };
  547. static struct i2c_driver bq20z75_battery_driver = {
  548. .probe = bq20z75_probe,
  549. .remove = __devexit_p(bq20z75_remove),
  550. .suspend = bq20z75_suspend,
  551. .resume = bq20z75_resume,
  552. .id_table = bq20z75_id,
  553. .driver = {
  554. .name = "bq20z75-battery",
  555. },
  556. };
  557. static int __init bq20z75_battery_init(void)
  558. {
  559. return i2c_add_driver(&bq20z75_battery_driver);
  560. }
  561. module_init(bq20z75_battery_init);
  562. static void __exit bq20z75_battery_exit(void)
  563. {
  564. i2c_del_driver(&bq20z75_battery_driver);
  565. }
  566. module_exit(bq20z75_battery_exit);
  567. MODULE_DESCRIPTION("BQ20z75 battery monitor driver");
  568. MODULE_LICENSE("GPL");