bq20z75.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692
  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. struct bq20z75_info *bq20z75_device = i2c_get_clientdata(client);
  149. s32 ret = 0;
  150. int retries = 1;
  151. if (bq20z75_device->pdata)
  152. retries = max(bq20z75_device->pdata->i2c_retry_count + 1, 1);
  153. while (retries > 0) {
  154. ret = i2c_smbus_read_word_data(client, address);
  155. if (ret >= 0)
  156. break;
  157. retries--;
  158. }
  159. if (ret < 0) {
  160. dev_warn(&client->dev,
  161. "%s: i2c read at address 0x%x failed\n",
  162. __func__, address);
  163. return ret;
  164. }
  165. return le16_to_cpu(ret);
  166. }
  167. static int bq20z75_write_word_data(struct i2c_client *client, u8 address,
  168. u16 value)
  169. {
  170. struct bq20z75_info *bq20z75_device = i2c_get_clientdata(client);
  171. s32 ret = 0;
  172. int retries = 1;
  173. if (bq20z75_device->pdata)
  174. retries = max(bq20z75_device->pdata->i2c_retry_count + 1, 1);
  175. while (retries > 0) {
  176. ret = i2c_smbus_write_word_data(client, address,
  177. le16_to_cpu(value));
  178. if (ret >= 0)
  179. break;
  180. retries--;
  181. }
  182. if (ret < 0) {
  183. dev_warn(&client->dev,
  184. "%s: i2c write to address 0x%x failed\n",
  185. __func__, address);
  186. return ret;
  187. }
  188. return 0;
  189. }
  190. static int bq20z75_get_battery_presence_and_health(
  191. struct i2c_client *client, enum power_supply_property psp,
  192. union power_supply_propval *val)
  193. {
  194. s32 ret;
  195. struct bq20z75_info *bq20z75_device = i2c_get_clientdata(client);
  196. if (psp == POWER_SUPPLY_PROP_PRESENT &&
  197. bq20z75_device->gpio_detect) {
  198. ret = gpio_get_value(
  199. bq20z75_device->pdata->battery_detect);
  200. if (ret == bq20z75_device->pdata->battery_detect_present)
  201. val->intval = 1;
  202. else
  203. val->intval = 0;
  204. return ret;
  205. }
  206. /* Write to ManufacturerAccess with
  207. * ManufacturerAccess command and then
  208. * read the status */
  209. ret = bq20z75_write_word_data(client,
  210. bq20z75_data[REG_MANUFACTURER_DATA].addr,
  211. MANUFACTURER_ACCESS_STATUS);
  212. if (ret < 0)
  213. return ret;
  214. ret = bq20z75_read_word_data(client,
  215. bq20z75_data[REG_MANUFACTURER_DATA].addr);
  216. if (ret < 0) {
  217. if (psp == POWER_SUPPLY_PROP_PRESENT)
  218. val->intval = 0; /* battery removed */
  219. return ret;
  220. }
  221. if (ret < bq20z75_data[REG_MANUFACTURER_DATA].min_value ||
  222. ret > bq20z75_data[REG_MANUFACTURER_DATA].max_value) {
  223. val->intval = 0;
  224. return 0;
  225. }
  226. /* Mask the upper nibble of 2nd byte and
  227. * lower byte of response then
  228. * shift the result by 8 to get status*/
  229. ret &= 0x0F00;
  230. ret >>= 8;
  231. if (psp == POWER_SUPPLY_PROP_PRESENT) {
  232. if (ret == 0x0F)
  233. /* battery removed */
  234. val->intval = 0;
  235. else
  236. val->intval = 1;
  237. } else if (psp == POWER_SUPPLY_PROP_HEALTH) {
  238. if (ret == 0x09)
  239. val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
  240. else if (ret == 0x0B)
  241. val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
  242. else if (ret == 0x0C)
  243. val->intval = POWER_SUPPLY_HEALTH_DEAD;
  244. else
  245. val->intval = POWER_SUPPLY_HEALTH_GOOD;
  246. }
  247. return 0;
  248. }
  249. static int bq20z75_get_battery_property(struct i2c_client *client,
  250. int reg_offset, enum power_supply_property psp,
  251. union power_supply_propval *val)
  252. {
  253. s32 ret;
  254. ret = bq20z75_read_word_data(client,
  255. bq20z75_data[reg_offset].addr);
  256. if (ret < 0)
  257. return ret;
  258. /* returned values are 16 bit */
  259. if (bq20z75_data[reg_offset].min_value < 0)
  260. ret = (s16)ret;
  261. if (ret >= bq20z75_data[reg_offset].min_value &&
  262. ret <= bq20z75_data[reg_offset].max_value) {
  263. val->intval = ret;
  264. if (psp == POWER_SUPPLY_PROP_STATUS) {
  265. if (ret & BATTERY_FULL_CHARGED)
  266. val->intval = POWER_SUPPLY_STATUS_FULL;
  267. else if (ret & BATTERY_FULL_DISCHARGED)
  268. val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
  269. else if (ret & BATTERY_DISCHARGING)
  270. val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
  271. else
  272. val->intval = POWER_SUPPLY_STATUS_CHARGING;
  273. }
  274. } else {
  275. if (psp == POWER_SUPPLY_PROP_STATUS)
  276. val->intval = POWER_SUPPLY_STATUS_UNKNOWN;
  277. else
  278. val->intval = 0;
  279. }
  280. return 0;
  281. }
  282. static void bq20z75_unit_adjustment(struct i2c_client *client,
  283. enum power_supply_property psp, union power_supply_propval *val)
  284. {
  285. #define BASE_UNIT_CONVERSION 1000
  286. #define BATTERY_MODE_CAP_MULT_WATT (10 * BASE_UNIT_CONVERSION)
  287. #define TIME_UNIT_CONVERSION 600
  288. #define TEMP_KELVIN_TO_CELCIUS 2731
  289. switch (psp) {
  290. case POWER_SUPPLY_PROP_ENERGY_NOW:
  291. case POWER_SUPPLY_PROP_ENERGY_FULL:
  292. case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN:
  293. val->intval *= BATTERY_MODE_CAP_MULT_WATT;
  294. break;
  295. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  296. case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
  297. case POWER_SUPPLY_PROP_CURRENT_NOW:
  298. case POWER_SUPPLY_PROP_CHARGE_NOW:
  299. case POWER_SUPPLY_PROP_CHARGE_FULL:
  300. case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
  301. val->intval *= BASE_UNIT_CONVERSION;
  302. break;
  303. case POWER_SUPPLY_PROP_TEMP:
  304. /* bq20z75 provides battery tempreture in 0.1°K
  305. * so convert it to 0.1°C */
  306. val->intval -= TEMP_KELVIN_TO_CELCIUS;
  307. val->intval *= 10;
  308. break;
  309. case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG:
  310. case POWER_SUPPLY_PROP_TIME_TO_FULL_AVG:
  311. val->intval *= TIME_UNIT_CONVERSION;
  312. break;
  313. default:
  314. dev_dbg(&client->dev,
  315. "%s: no need for unit conversion %d\n", __func__, psp);
  316. }
  317. }
  318. static enum bq20z75_battery_mode
  319. bq20z75_set_battery_mode(struct i2c_client *client,
  320. enum bq20z75_battery_mode mode)
  321. {
  322. int ret, original_val;
  323. original_val = bq20z75_read_word_data(client, BATTERY_MODE_OFFSET);
  324. if (original_val < 0)
  325. return original_val;
  326. if ((original_val & BATTERY_MODE_MASK) == mode)
  327. return mode;
  328. if (mode == BATTERY_MODE_AMPS)
  329. ret = original_val & ~BATTERY_MODE_MASK;
  330. else
  331. ret = original_val | BATTERY_MODE_MASK;
  332. ret = bq20z75_write_word_data(client, BATTERY_MODE_OFFSET, ret);
  333. if (ret < 0)
  334. return ret;
  335. return original_val & BATTERY_MODE_MASK;
  336. }
  337. static int bq20z75_get_battery_capacity(struct i2c_client *client,
  338. int reg_offset, enum power_supply_property psp,
  339. union power_supply_propval *val)
  340. {
  341. s32 ret;
  342. enum bq20z75_battery_mode mode = BATTERY_MODE_WATTS;
  343. if (power_supply_is_amp_property(psp))
  344. mode = BATTERY_MODE_AMPS;
  345. mode = bq20z75_set_battery_mode(client, mode);
  346. if (mode < 0)
  347. return mode;
  348. ret = bq20z75_read_word_data(client, bq20z75_data[reg_offset].addr);
  349. if (ret < 0)
  350. return ret;
  351. if (psp == POWER_SUPPLY_PROP_CAPACITY) {
  352. /* bq20z75 spec says that this can be >100 %
  353. * even if max value is 100 % */
  354. val->intval = min(ret, 100);
  355. } else
  356. val->intval = ret;
  357. ret = bq20z75_set_battery_mode(client, mode);
  358. if (ret < 0)
  359. return ret;
  360. return 0;
  361. }
  362. static char bq20z75_serial[5];
  363. static int bq20z75_get_battery_serial_number(struct i2c_client *client,
  364. union power_supply_propval *val)
  365. {
  366. int ret;
  367. ret = bq20z75_read_word_data(client,
  368. bq20z75_data[REG_SERIAL_NUMBER].addr);
  369. if (ret < 0)
  370. return ret;
  371. ret = sprintf(bq20z75_serial, "%04x", ret);
  372. val->strval = bq20z75_serial;
  373. return 0;
  374. }
  375. static int bq20z75_get_property_index(struct i2c_client *client,
  376. enum power_supply_property psp)
  377. {
  378. int count;
  379. for (count = 0; count < ARRAY_SIZE(bq20z75_data); count++)
  380. if (psp == bq20z75_data[count].psp)
  381. return count;
  382. dev_warn(&client->dev,
  383. "%s: Invalid Property - %d\n", __func__, psp);
  384. return -EINVAL;
  385. }
  386. static int bq20z75_get_property(struct power_supply *psy,
  387. enum power_supply_property psp,
  388. union power_supply_propval *val)
  389. {
  390. int ret = 0;
  391. struct bq20z75_info *bq20z75_device = container_of(psy,
  392. struct bq20z75_info, power_supply);
  393. struct i2c_client *client = bq20z75_device->client;
  394. switch (psp) {
  395. case POWER_SUPPLY_PROP_PRESENT:
  396. case POWER_SUPPLY_PROP_HEALTH:
  397. ret = bq20z75_get_battery_presence_and_health(client, psp, val);
  398. break;
  399. case POWER_SUPPLY_PROP_TECHNOLOGY:
  400. val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
  401. break;
  402. case POWER_SUPPLY_PROP_ENERGY_NOW:
  403. case POWER_SUPPLY_PROP_ENERGY_FULL:
  404. case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN:
  405. case POWER_SUPPLY_PROP_CHARGE_NOW:
  406. case POWER_SUPPLY_PROP_CHARGE_FULL:
  407. case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
  408. case POWER_SUPPLY_PROP_CAPACITY:
  409. ret = bq20z75_get_property_index(client, psp);
  410. if (ret < 0)
  411. break;
  412. ret = bq20z75_get_battery_capacity(client, ret, psp, val);
  413. break;
  414. case POWER_SUPPLY_PROP_SERIAL_NUMBER:
  415. ret = bq20z75_get_battery_serial_number(client, val);
  416. break;
  417. case POWER_SUPPLY_PROP_STATUS:
  418. case POWER_SUPPLY_PROP_CYCLE_COUNT:
  419. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  420. case POWER_SUPPLY_PROP_CURRENT_NOW:
  421. case POWER_SUPPLY_PROP_TEMP:
  422. case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG:
  423. case POWER_SUPPLY_PROP_TIME_TO_FULL_AVG:
  424. case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
  425. ret = bq20z75_get_property_index(client, psp);
  426. if (ret < 0)
  427. break;
  428. ret = bq20z75_get_battery_property(client, ret, psp, val);
  429. break;
  430. default:
  431. dev_err(&client->dev,
  432. "%s: INVALID property\n", __func__);
  433. return -EINVAL;
  434. }
  435. if (!bq20z75_device->enable_detection)
  436. goto done;
  437. if (!bq20z75_device->gpio_detect &&
  438. bq20z75_device->is_present != (ret >= 0)) {
  439. bq20z75_device->is_present = (ret >= 0);
  440. power_supply_changed(&bq20z75_device->power_supply);
  441. }
  442. done:
  443. if (!ret) {
  444. /* Convert units to match requirements for power supply class */
  445. bq20z75_unit_adjustment(client, psp, val);
  446. }
  447. dev_dbg(&client->dev,
  448. "%s: property = %d, value = %d\n", __func__, psp, val->intval);
  449. return ret;
  450. }
  451. static irqreturn_t bq20z75_irq(int irq, void *devid)
  452. {
  453. struct power_supply *battery = devid;
  454. power_supply_changed(battery);
  455. return IRQ_HANDLED;
  456. }
  457. static int __devinit bq20z75_probe(struct i2c_client *client,
  458. const struct i2c_device_id *id)
  459. {
  460. struct bq20z75_info *bq20z75_device;
  461. struct bq20z75_platform_data *pdata = client->dev.platform_data;
  462. int rc;
  463. int irq;
  464. bq20z75_device = kzalloc(sizeof(struct bq20z75_info), GFP_KERNEL);
  465. if (!bq20z75_device)
  466. return -ENOMEM;
  467. bq20z75_device->client = client;
  468. bq20z75_device->enable_detection = false;
  469. bq20z75_device->gpio_detect = false;
  470. bq20z75_device->power_supply.name = "battery";
  471. bq20z75_device->power_supply.type = POWER_SUPPLY_TYPE_BATTERY;
  472. bq20z75_device->power_supply.properties = bq20z75_properties;
  473. bq20z75_device->power_supply.num_properties =
  474. ARRAY_SIZE(bq20z75_properties);
  475. bq20z75_device->power_supply.get_property = bq20z75_get_property;
  476. if (pdata) {
  477. bq20z75_device->gpio_detect =
  478. gpio_is_valid(pdata->battery_detect);
  479. bq20z75_device->pdata = pdata;
  480. }
  481. i2c_set_clientdata(client, bq20z75_device);
  482. if (!bq20z75_device->gpio_detect)
  483. goto skip_gpio;
  484. rc = gpio_request(pdata->battery_detect, dev_name(&client->dev));
  485. if (rc) {
  486. dev_warn(&client->dev, "Failed to request gpio: %d\n", rc);
  487. bq20z75_device->gpio_detect = false;
  488. goto skip_gpio;
  489. }
  490. rc = gpio_direction_input(pdata->battery_detect);
  491. if (rc) {
  492. dev_warn(&client->dev, "Failed to get gpio as input: %d\n", rc);
  493. gpio_free(pdata->battery_detect);
  494. bq20z75_device->gpio_detect = false;
  495. goto skip_gpio;
  496. }
  497. irq = gpio_to_irq(pdata->battery_detect);
  498. if (irq <= 0) {
  499. dev_warn(&client->dev, "Failed to get gpio as irq: %d\n", irq);
  500. gpio_free(pdata->battery_detect);
  501. bq20z75_device->gpio_detect = false;
  502. goto skip_gpio;
  503. }
  504. rc = request_irq(irq, bq20z75_irq,
  505. IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
  506. dev_name(&client->dev), &bq20z75_device->power_supply);
  507. if (rc) {
  508. dev_warn(&client->dev, "Failed to request irq: %d\n", rc);
  509. gpio_free(pdata->battery_detect);
  510. bq20z75_device->gpio_detect = false;
  511. goto skip_gpio;
  512. }
  513. bq20z75_device->irq = irq;
  514. skip_gpio:
  515. rc = power_supply_register(&client->dev, &bq20z75_device->power_supply);
  516. if (rc) {
  517. dev_err(&client->dev,
  518. "%s: Failed to register power supply\n", __func__);
  519. goto exit_psupply;
  520. }
  521. dev_info(&client->dev,
  522. "%s: battery gas gauge device registered\n", client->name);
  523. return 0;
  524. exit_psupply:
  525. if (bq20z75_device->irq)
  526. free_irq(bq20z75_device->irq, &bq20z75_device->power_supply);
  527. if (bq20z75_device->gpio_detect)
  528. gpio_free(pdata->battery_detect);
  529. kfree(bq20z75_device);
  530. return rc;
  531. }
  532. static int __devexit bq20z75_remove(struct i2c_client *client)
  533. {
  534. struct bq20z75_info *bq20z75_device = i2c_get_clientdata(client);
  535. if (bq20z75_device->irq)
  536. free_irq(bq20z75_device->irq, &bq20z75_device->power_supply);
  537. if (bq20z75_device->gpio_detect)
  538. gpio_free(bq20z75_device->pdata->battery_detect);
  539. power_supply_unregister(&bq20z75_device->power_supply);
  540. kfree(bq20z75_device);
  541. bq20z75_device = NULL;
  542. return 0;
  543. }
  544. #if defined CONFIG_PM
  545. static int bq20z75_suspend(struct i2c_client *client,
  546. pm_message_t state)
  547. {
  548. s32 ret;
  549. /* write to manufacturer access with sleep command */
  550. ret = bq20z75_write_word_data(client,
  551. bq20z75_data[REG_MANUFACTURER_DATA].addr,
  552. MANUFACTURER_ACCESS_SLEEP);
  553. if (ret < 0)
  554. return ret;
  555. return 0;
  556. }
  557. #else
  558. #define bq20z75_suspend NULL
  559. #endif
  560. /* any smbus transaction will wake up bq20z75 */
  561. #define bq20z75_resume NULL
  562. static const struct i2c_device_id bq20z75_id[] = {
  563. { "bq20z75", 0 },
  564. {}
  565. };
  566. static struct i2c_driver bq20z75_battery_driver = {
  567. .probe = bq20z75_probe,
  568. .remove = __devexit_p(bq20z75_remove),
  569. .suspend = bq20z75_suspend,
  570. .resume = bq20z75_resume,
  571. .id_table = bq20z75_id,
  572. .driver = {
  573. .name = "bq20z75-battery",
  574. },
  575. };
  576. static int __init bq20z75_battery_init(void)
  577. {
  578. return i2c_add_driver(&bq20z75_battery_driver);
  579. }
  580. module_init(bq20z75_battery_init);
  581. static void __exit bq20z75_battery_exit(void)
  582. {
  583. i2c_del_driver(&bq20z75_battery_driver);
  584. }
  585. module_exit(bq20z75_battery_exit);
  586. MODULE_DESCRIPTION("BQ20z75 battery monitor driver");
  587. MODULE_LICENSE("GPL");