bq2415x_charger.c 42 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665
  1. /*
  2. * bq2415x charger driver
  3. *
  4. * Copyright (C) 2011-2012 Pali Rohár <pali.rohar@gmail.com>
  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,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for 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. /*
  21. * Datasheets:
  22. * http://www.ti.com/product/bq24150
  23. * http://www.ti.com/product/bq24150a
  24. * http://www.ti.com/product/bq24152
  25. * http://www.ti.com/product/bq24153
  26. * http://www.ti.com/product/bq24153a
  27. * http://www.ti.com/product/bq24155
  28. */
  29. #include <linux/kernel.h>
  30. #include <linux/module.h>
  31. #include <linux/param.h>
  32. #include <linux/err.h>
  33. #include <linux/workqueue.h>
  34. #include <linux/sysfs.h>
  35. #include <linux/platform_device.h>
  36. #include <linux/power_supply.h>
  37. #include <linux/idr.h>
  38. #include <linux/i2c.h>
  39. #include <linux/slab.h>
  40. #include <linux/power/bq2415x_charger.h>
  41. /* timeout for resetting chip timer */
  42. #define BQ2415X_TIMER_TIMEOUT 10
  43. #define BQ2415X_REG_STATUS 0x00
  44. #define BQ2415X_REG_CONTROL 0x01
  45. #define BQ2415X_REG_VOLTAGE 0x02
  46. #define BQ2415X_REG_VENDER 0x03
  47. #define BQ2415X_REG_CURRENT 0x04
  48. /* reset state for all registers */
  49. #define BQ2415X_RESET_STATUS BIT(6)
  50. #define BQ2415X_RESET_CONTROL (BIT(4)|BIT(5))
  51. #define BQ2415X_RESET_VOLTAGE (BIT(1)|BIT(3))
  52. #define BQ2415X_RESET_CURRENT (BIT(0)|BIT(3)|BIT(7))
  53. /* status register */
  54. #define BQ2415X_BIT_TMR_RST 7
  55. #define BQ2415X_BIT_OTG 7
  56. #define BQ2415X_BIT_EN_STAT 6
  57. #define BQ2415X_MASK_STAT (BIT(4)|BIT(5))
  58. #define BQ2415X_SHIFT_STAT 4
  59. #define BQ2415X_BIT_BOOST 3
  60. #define BQ2415X_MASK_FAULT (BIT(0)|BIT(1)|BIT(2))
  61. #define BQ2415X_SHIFT_FAULT 0
  62. /* control register */
  63. #define BQ2415X_MASK_LIMIT (BIT(6)|BIT(7))
  64. #define BQ2415X_SHIFT_LIMIT 6
  65. #define BQ2415X_MASK_VLOWV (BIT(4)|BIT(5))
  66. #define BQ2415X_SHIFT_VLOWV 4
  67. #define BQ2415X_BIT_TE 3
  68. #define BQ2415X_BIT_CE 2
  69. #define BQ2415X_BIT_HZ_MODE 1
  70. #define BQ2415X_BIT_OPA_MODE 0
  71. /* voltage register */
  72. #define BQ2415X_MASK_VO (BIT(2)|BIT(3)|BIT(4)|BIT(5)|BIT(6)|BIT(7))
  73. #define BQ2415X_SHIFT_VO 2
  74. #define BQ2415X_BIT_OTG_PL 1
  75. #define BQ2415X_BIT_OTG_EN 0
  76. /* vender register */
  77. #define BQ2415X_MASK_VENDER (BIT(5)|BIT(6)|BIT(7))
  78. #define BQ2415X_SHIFT_VENDER 5
  79. #define BQ2415X_MASK_PN (BIT(3)|BIT(4))
  80. #define BQ2415X_SHIFT_PN 3
  81. #define BQ2415X_MASK_REVISION (BIT(0)|BIT(1)|BIT(2))
  82. #define BQ2415X_SHIFT_REVISION 0
  83. /* current register */
  84. #define BQ2415X_MASK_RESET BIT(7)
  85. #define BQ2415X_MASK_VI_CHRG (BIT(4)|BIT(5)|BIT(6))
  86. #define BQ2415X_SHIFT_VI_CHRG 4
  87. /* N/A BIT(3) */
  88. #define BQ2415X_MASK_VI_TERM (BIT(0)|BIT(1)|BIT(2))
  89. #define BQ2415X_SHIFT_VI_TERM 0
  90. enum bq2415x_command {
  91. BQ2415X_TIMER_RESET,
  92. BQ2415X_OTG_STATUS,
  93. BQ2415X_STAT_PIN_STATUS,
  94. BQ2415X_STAT_PIN_ENABLE,
  95. BQ2415X_STAT_PIN_DISABLE,
  96. BQ2415X_CHARGE_STATUS,
  97. BQ2415X_BOOST_STATUS,
  98. BQ2415X_FAULT_STATUS,
  99. BQ2415X_CHARGE_TERMINATION_STATUS,
  100. BQ2415X_CHARGE_TERMINATION_ENABLE,
  101. BQ2415X_CHARGE_TERMINATION_DISABLE,
  102. BQ2415X_CHARGER_STATUS,
  103. BQ2415X_CHARGER_ENABLE,
  104. BQ2415X_CHARGER_DISABLE,
  105. BQ2415X_HIGH_IMPEDANCE_STATUS,
  106. BQ2415X_HIGH_IMPEDANCE_ENABLE,
  107. BQ2415X_HIGH_IMPEDANCE_DISABLE,
  108. BQ2415X_BOOST_MODE_STATUS,
  109. BQ2415X_BOOST_MODE_ENABLE,
  110. BQ2415X_BOOST_MODE_DISABLE,
  111. BQ2415X_OTG_LEVEL,
  112. BQ2415X_OTG_ACTIVATE_HIGH,
  113. BQ2415X_OTG_ACTIVATE_LOW,
  114. BQ2415X_OTG_PIN_STATUS,
  115. BQ2415X_OTG_PIN_ENABLE,
  116. BQ2415X_OTG_PIN_DISABLE,
  117. BQ2415X_VENDER_CODE,
  118. BQ2415X_PART_NUMBER,
  119. BQ2415X_REVISION,
  120. };
  121. enum bq2415x_chip {
  122. BQUNKNOWN,
  123. BQ24150,
  124. BQ24150A,
  125. BQ24151,
  126. BQ24151A,
  127. BQ24152,
  128. BQ24153,
  129. BQ24153A,
  130. BQ24155,
  131. BQ24156,
  132. BQ24156A,
  133. BQ24158,
  134. };
  135. static char *bq2415x_chip_name[] = {
  136. "unknown",
  137. "bq24150",
  138. "bq24150a",
  139. "bq24151",
  140. "bq24151a",
  141. "bq24152",
  142. "bq24153",
  143. "bq24153a",
  144. "bq24155",
  145. "bq24156",
  146. "bq24156a",
  147. "bq24158",
  148. };
  149. struct bq2415x_device {
  150. struct device *dev;
  151. struct bq2415x_platform_data init_data;
  152. struct power_supply charger;
  153. struct delayed_work work;
  154. enum bq2415x_mode reported_mode;/* mode reported by hook function */
  155. enum bq2415x_mode mode; /* current configured mode */
  156. enum bq2415x_chip chip;
  157. const char *timer_error;
  158. char *model;
  159. char *name;
  160. int autotimer; /* 1 - if driver automatically reset timer, 0 - not */
  161. int automode; /* 1 - enabled, 0 - disabled; -1 - not supported */
  162. int id;
  163. };
  164. /* each registered chip must have unique id */
  165. static DEFINE_IDR(bq2415x_id);
  166. static DEFINE_MUTEX(bq2415x_id_mutex);
  167. static DEFINE_MUTEX(bq2415x_timer_mutex);
  168. static DEFINE_MUTEX(bq2415x_i2c_mutex);
  169. /**** i2c read functions ****/
  170. /* read value from register */
  171. static int bq2415x_i2c_read(struct bq2415x_device *bq, u8 reg)
  172. {
  173. struct i2c_client *client = to_i2c_client(bq->dev);
  174. struct i2c_msg msg[2];
  175. u8 val;
  176. int ret;
  177. if (!client->adapter)
  178. return -ENODEV;
  179. msg[0].addr = client->addr;
  180. msg[0].flags = 0;
  181. msg[0].buf = &reg;
  182. msg[0].len = sizeof(reg);
  183. msg[1].addr = client->addr;
  184. msg[1].flags = I2C_M_RD;
  185. msg[1].buf = &val;
  186. msg[1].len = sizeof(val);
  187. mutex_lock(&bq2415x_i2c_mutex);
  188. ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
  189. mutex_unlock(&bq2415x_i2c_mutex);
  190. if (ret < 0)
  191. return ret;
  192. return val;
  193. }
  194. /* read value from register, apply mask and right shift it */
  195. static int bq2415x_i2c_read_mask(struct bq2415x_device *bq, u8 reg,
  196. u8 mask, u8 shift)
  197. {
  198. int ret;
  199. if (shift > 8)
  200. return -EINVAL;
  201. ret = bq2415x_i2c_read(bq, reg);
  202. if (ret < 0)
  203. return ret;
  204. return (ret & mask) >> shift;
  205. }
  206. /* read value from register and return one specified bit */
  207. static int bq2415x_i2c_read_bit(struct bq2415x_device *bq, u8 reg, u8 bit)
  208. {
  209. if (bit > 8)
  210. return -EINVAL;
  211. return bq2415x_i2c_read_mask(bq, reg, BIT(bit), bit);
  212. }
  213. /**** i2c write functions ****/
  214. /* write value to register */
  215. static int bq2415x_i2c_write(struct bq2415x_device *bq, u8 reg, u8 val)
  216. {
  217. struct i2c_client *client = to_i2c_client(bq->dev);
  218. struct i2c_msg msg[1];
  219. u8 data[2];
  220. int ret;
  221. data[0] = reg;
  222. data[1] = val;
  223. msg[0].addr = client->addr;
  224. msg[0].flags = 0;
  225. msg[0].buf = data;
  226. msg[0].len = ARRAY_SIZE(data);
  227. mutex_lock(&bq2415x_i2c_mutex);
  228. ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
  229. mutex_unlock(&bq2415x_i2c_mutex);
  230. /* i2c_transfer returns number of messages transferred */
  231. if (ret < 0)
  232. return ret;
  233. else if (ret != 1)
  234. return -EIO;
  235. return 0;
  236. }
  237. /* read value from register, change it with mask left shifted and write back */
  238. static int bq2415x_i2c_write_mask(struct bq2415x_device *bq, u8 reg, u8 val,
  239. u8 mask, u8 shift)
  240. {
  241. int ret;
  242. if (shift > 8)
  243. return -EINVAL;
  244. ret = bq2415x_i2c_read(bq, reg);
  245. if (ret < 0)
  246. return ret;
  247. ret &= ~mask;
  248. ret |= val << shift;
  249. return bq2415x_i2c_write(bq, reg, ret);
  250. }
  251. /* change only one bit in register */
  252. static int bq2415x_i2c_write_bit(struct bq2415x_device *bq, u8 reg,
  253. bool val, u8 bit)
  254. {
  255. if (bit > 8)
  256. return -EINVAL;
  257. return bq2415x_i2c_write_mask(bq, reg, val, BIT(bit), bit);
  258. }
  259. /**** global functions ****/
  260. /* exec command function */
  261. static int bq2415x_exec_command(struct bq2415x_device *bq,
  262. enum bq2415x_command command)
  263. {
  264. int ret;
  265. switch (command) {
  266. case BQ2415X_TIMER_RESET:
  267. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS,
  268. 1, BQ2415X_BIT_TMR_RST);
  269. case BQ2415X_OTG_STATUS:
  270. return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
  271. BQ2415X_BIT_OTG);
  272. case BQ2415X_STAT_PIN_STATUS:
  273. return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
  274. BQ2415X_BIT_EN_STAT);
  275. case BQ2415X_STAT_PIN_ENABLE:
  276. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, 1,
  277. BQ2415X_BIT_EN_STAT);
  278. case BQ2415X_STAT_PIN_DISABLE:
  279. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, 0,
  280. BQ2415X_BIT_EN_STAT);
  281. case BQ2415X_CHARGE_STATUS:
  282. return bq2415x_i2c_read_mask(bq, BQ2415X_REG_STATUS,
  283. BQ2415X_MASK_STAT, BQ2415X_SHIFT_STAT);
  284. case BQ2415X_BOOST_STATUS:
  285. return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
  286. BQ2415X_BIT_BOOST);
  287. case BQ2415X_FAULT_STATUS:
  288. return bq2415x_i2c_read_mask(bq, BQ2415X_REG_STATUS,
  289. BQ2415X_MASK_FAULT, BQ2415X_SHIFT_FAULT);
  290. case BQ2415X_CHARGE_TERMINATION_STATUS:
  291. return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
  292. BQ2415X_BIT_TE);
  293. case BQ2415X_CHARGE_TERMINATION_ENABLE:
  294. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
  295. 1, BQ2415X_BIT_TE);
  296. case BQ2415X_CHARGE_TERMINATION_DISABLE:
  297. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
  298. 0, BQ2415X_BIT_TE);
  299. case BQ2415X_CHARGER_STATUS:
  300. ret = bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
  301. BQ2415X_BIT_CE);
  302. if (ret < 0)
  303. return ret;
  304. else
  305. return ret > 0 ? 0 : 1;
  306. case BQ2415X_CHARGER_ENABLE:
  307. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
  308. 0, BQ2415X_BIT_CE);
  309. case BQ2415X_CHARGER_DISABLE:
  310. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
  311. 1, BQ2415X_BIT_CE);
  312. case BQ2415X_HIGH_IMPEDANCE_STATUS:
  313. return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
  314. BQ2415X_BIT_HZ_MODE);
  315. case BQ2415X_HIGH_IMPEDANCE_ENABLE:
  316. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
  317. 1, BQ2415X_BIT_HZ_MODE);
  318. case BQ2415X_HIGH_IMPEDANCE_DISABLE:
  319. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
  320. 0, BQ2415X_BIT_HZ_MODE);
  321. case BQ2415X_BOOST_MODE_STATUS:
  322. return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
  323. BQ2415X_BIT_OPA_MODE);
  324. case BQ2415X_BOOST_MODE_ENABLE:
  325. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
  326. 1, BQ2415X_BIT_OPA_MODE);
  327. case BQ2415X_BOOST_MODE_DISABLE:
  328. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
  329. 0, BQ2415X_BIT_OPA_MODE);
  330. case BQ2415X_OTG_LEVEL:
  331. return bq2415x_i2c_read_bit(bq, BQ2415X_REG_VOLTAGE,
  332. BQ2415X_BIT_OTG_PL);
  333. case BQ2415X_OTG_ACTIVATE_HIGH:
  334. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
  335. 1, BQ2415X_BIT_OTG_PL);
  336. case BQ2415X_OTG_ACTIVATE_LOW:
  337. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
  338. 0, BQ2415X_BIT_OTG_PL);
  339. case BQ2415X_OTG_PIN_STATUS:
  340. return bq2415x_i2c_read_bit(bq, BQ2415X_REG_VOLTAGE,
  341. BQ2415X_BIT_OTG_EN);
  342. case BQ2415X_OTG_PIN_ENABLE:
  343. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
  344. 1, BQ2415X_BIT_OTG_EN);
  345. case BQ2415X_OTG_PIN_DISABLE:
  346. return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
  347. 0, BQ2415X_BIT_OTG_EN);
  348. case BQ2415X_VENDER_CODE:
  349. return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
  350. BQ2415X_MASK_VENDER, BQ2415X_SHIFT_VENDER);
  351. case BQ2415X_PART_NUMBER:
  352. return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
  353. BQ2415X_MASK_PN, BQ2415X_SHIFT_PN);
  354. case BQ2415X_REVISION:
  355. return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
  356. BQ2415X_MASK_REVISION, BQ2415X_SHIFT_REVISION);
  357. }
  358. return -EINVAL;
  359. }
  360. /* detect chip type */
  361. static enum bq2415x_chip bq2415x_detect_chip(struct bq2415x_device *bq)
  362. {
  363. struct i2c_client *client = to_i2c_client(bq->dev);
  364. int ret = bq2415x_exec_command(bq, BQ2415X_PART_NUMBER);
  365. if (ret < 0)
  366. return ret;
  367. switch (client->addr) {
  368. case 0x6b:
  369. switch (ret) {
  370. case 0:
  371. if (bq->chip == BQ24151A)
  372. return bq->chip;
  373. else
  374. return BQ24151;
  375. case 1:
  376. if (bq->chip == BQ24150A ||
  377. bq->chip == BQ24152 ||
  378. bq->chip == BQ24155)
  379. return bq->chip;
  380. else
  381. return BQ24150;
  382. case 2:
  383. if (bq->chip == BQ24153A)
  384. return bq->chip;
  385. else
  386. return BQ24153;
  387. default:
  388. return BQUNKNOWN;
  389. }
  390. break;
  391. case 0x6a:
  392. switch (ret) {
  393. case 0:
  394. if (bq->chip == BQ24156A)
  395. return bq->chip;
  396. else
  397. return BQ24156;
  398. case 2:
  399. return BQ24158;
  400. default:
  401. return BQUNKNOWN;
  402. }
  403. break;
  404. }
  405. return BQUNKNOWN;
  406. }
  407. /* detect chip revision */
  408. static int bq2415x_detect_revision(struct bq2415x_device *bq)
  409. {
  410. int ret = bq2415x_exec_command(bq, BQ2415X_REVISION);
  411. int chip = bq2415x_detect_chip(bq);
  412. if (ret < 0 || chip < 0)
  413. return -1;
  414. switch (chip) {
  415. case BQ24150:
  416. case BQ24150A:
  417. case BQ24151:
  418. case BQ24151A:
  419. case BQ24152:
  420. if (ret >= 0 && ret <= 3)
  421. return ret;
  422. else
  423. return -1;
  424. case BQ24153:
  425. case BQ24153A:
  426. case BQ24156:
  427. case BQ24156A:
  428. case BQ24158:
  429. if (ret == 3)
  430. return 0;
  431. else if (ret == 1)
  432. return 1;
  433. else
  434. return -1;
  435. case BQ24155:
  436. if (ret == 3)
  437. return 3;
  438. else
  439. return -1;
  440. case BQUNKNOWN:
  441. return -1;
  442. }
  443. return -1;
  444. }
  445. /* return chip vender code */
  446. static int bq2415x_get_vender_code(struct bq2415x_device *bq)
  447. {
  448. int ret;
  449. ret = bq2415x_exec_command(bq, BQ2415X_VENDER_CODE);
  450. if (ret < 0)
  451. return 0;
  452. /* convert to binary */
  453. return (ret & 0x1) +
  454. ((ret >> 1) & 0x1) * 10 +
  455. ((ret >> 2) & 0x1) * 100;
  456. }
  457. /* reset all chip registers to default state */
  458. static void bq2415x_reset_chip(struct bq2415x_device *bq)
  459. {
  460. bq2415x_i2c_write(bq, BQ2415X_REG_CURRENT, BQ2415X_RESET_CURRENT);
  461. bq2415x_i2c_write(bq, BQ2415X_REG_VOLTAGE, BQ2415X_RESET_VOLTAGE);
  462. bq2415x_i2c_write(bq, BQ2415X_REG_CONTROL, BQ2415X_RESET_CONTROL);
  463. bq2415x_i2c_write(bq, BQ2415X_REG_STATUS, BQ2415X_RESET_STATUS);
  464. bq->timer_error = NULL;
  465. }
  466. /**** properties functions ****/
  467. /* set current limit in mA */
  468. static int bq2415x_set_current_limit(struct bq2415x_device *bq, int mA)
  469. {
  470. int val;
  471. if (mA <= 100)
  472. val = 0;
  473. else if (mA <= 500)
  474. val = 1;
  475. else if (mA <= 800)
  476. val = 2;
  477. else
  478. val = 3;
  479. return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val,
  480. BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT);
  481. }
  482. /* get current limit in mA */
  483. static int bq2415x_get_current_limit(struct bq2415x_device *bq)
  484. {
  485. int ret;
  486. ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL,
  487. BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT);
  488. if (ret < 0)
  489. return ret;
  490. else if (ret == 0)
  491. return 100;
  492. else if (ret == 1)
  493. return 500;
  494. else if (ret == 2)
  495. return 800;
  496. else if (ret == 3)
  497. return 1800;
  498. return -EINVAL;
  499. }
  500. /* set weak battery voltage in mV */
  501. static int bq2415x_set_weak_battery_voltage(struct bq2415x_device *bq, int mV)
  502. {
  503. int val;
  504. /* round to 100mV */
  505. if (mV <= 3400 + 50)
  506. val = 0;
  507. else if (mV <= 3500 + 50)
  508. val = 1;
  509. else if (mV <= 3600 + 50)
  510. val = 2;
  511. else
  512. val = 3;
  513. return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val,
  514. BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV);
  515. }
  516. /* get weak battery voltage in mV */
  517. static int bq2415x_get_weak_battery_voltage(struct bq2415x_device *bq)
  518. {
  519. int ret;
  520. ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL,
  521. BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV);
  522. if (ret < 0)
  523. return ret;
  524. return 100 * (34 + ret);
  525. }
  526. /* set battery regulation voltage in mV */
  527. static int bq2415x_set_battery_regulation_voltage(struct bq2415x_device *bq,
  528. int mV)
  529. {
  530. int val = (mV/10 - 350) / 2;
  531. /*
  532. * According to datasheet, maximum battery regulation voltage is
  533. * 4440mV which is b101111 = 47.
  534. */
  535. if (val < 0)
  536. val = 0;
  537. else if (val > 47)
  538. return -EINVAL;
  539. return bq2415x_i2c_write_mask(bq, BQ2415X_REG_VOLTAGE, val,
  540. BQ2415X_MASK_VO, BQ2415X_SHIFT_VO);
  541. }
  542. /* get battery regulation voltage in mV */
  543. static int bq2415x_get_battery_regulation_voltage(struct bq2415x_device *bq)
  544. {
  545. int ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_VOLTAGE,
  546. BQ2415X_MASK_VO, BQ2415X_SHIFT_VO);
  547. if (ret < 0)
  548. return ret;
  549. return 10 * (350 + 2*ret);
  550. }
  551. /* set charge current in mA (platform data must provide resistor sense) */
  552. static int bq2415x_set_charge_current(struct bq2415x_device *bq, int mA)
  553. {
  554. int val;
  555. if (bq->init_data.resistor_sense <= 0)
  556. return -ENOSYS;
  557. val = (mA * bq->init_data.resistor_sense - 37400) / 6800;
  558. if (val < 0)
  559. val = 0;
  560. else if (val > 7)
  561. val = 7;
  562. return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val,
  563. BQ2415X_MASK_VI_CHRG | BQ2415X_MASK_RESET,
  564. BQ2415X_SHIFT_VI_CHRG);
  565. }
  566. /* get charge current in mA (platform data must provide resistor sense) */
  567. static int bq2415x_get_charge_current(struct bq2415x_device *bq)
  568. {
  569. int ret;
  570. if (bq->init_data.resistor_sense <= 0)
  571. return -ENOSYS;
  572. ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT,
  573. BQ2415X_MASK_VI_CHRG, BQ2415X_SHIFT_VI_CHRG);
  574. if (ret < 0)
  575. return ret;
  576. return (37400 + 6800*ret) / bq->init_data.resistor_sense;
  577. }
  578. /* set termination current in mA (platform data must provide resistor sense) */
  579. static int bq2415x_set_termination_current(struct bq2415x_device *bq, int mA)
  580. {
  581. int val;
  582. if (bq->init_data.resistor_sense <= 0)
  583. return -ENOSYS;
  584. val = (mA * bq->init_data.resistor_sense - 3400) / 3400;
  585. if (val < 0)
  586. val = 0;
  587. else if (val > 7)
  588. val = 7;
  589. return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val,
  590. BQ2415X_MASK_VI_TERM | BQ2415X_MASK_RESET,
  591. BQ2415X_SHIFT_VI_TERM);
  592. }
  593. /* get termination current in mA (platform data must provide resistor sense) */
  594. static int bq2415x_get_termination_current(struct bq2415x_device *bq)
  595. {
  596. int ret;
  597. if (bq->init_data.resistor_sense <= 0)
  598. return -ENOSYS;
  599. ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT,
  600. BQ2415X_MASK_VI_TERM, BQ2415X_SHIFT_VI_TERM);
  601. if (ret < 0)
  602. return ret;
  603. return (3400 + 3400*ret) / bq->init_data.resistor_sense;
  604. }
  605. /* set default value of property */
  606. #define bq2415x_set_default_value(bq, prop) \
  607. do { \
  608. int ret = 0; \
  609. if (bq->init_data.prop != -1) \
  610. ret = bq2415x_set_##prop(bq, bq->init_data.prop); \
  611. if (ret < 0) \
  612. return ret; \
  613. } while (0)
  614. /* set default values of all properties */
  615. static int bq2415x_set_defaults(struct bq2415x_device *bq)
  616. {
  617. bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE);
  618. bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE);
  619. bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_DISABLE);
  620. bq2415x_set_default_value(bq, current_limit);
  621. bq2415x_set_default_value(bq, weak_battery_voltage);
  622. bq2415x_set_default_value(bq, battery_regulation_voltage);
  623. if (bq->init_data.resistor_sense > 0) {
  624. bq2415x_set_default_value(bq, charge_current);
  625. bq2415x_set_default_value(bq, termination_current);
  626. bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_ENABLE);
  627. }
  628. bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE);
  629. return 0;
  630. }
  631. /**** charger mode functions ****/
  632. /* set charger mode */
  633. static int bq2415x_set_mode(struct bq2415x_device *bq, enum bq2415x_mode mode)
  634. {
  635. int ret = 0;
  636. int charger = 0;
  637. int boost = 0;
  638. if (mode == BQ2415X_MODE_BOOST)
  639. boost = 1;
  640. else if (mode != BQ2415X_MODE_OFF)
  641. charger = 1;
  642. if (!charger)
  643. ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE);
  644. if (!boost)
  645. ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE);
  646. if (ret < 0)
  647. return ret;
  648. switch (mode) {
  649. case BQ2415X_MODE_OFF:
  650. dev_dbg(bq->dev, "changing mode to: Offline\n");
  651. ret = bq2415x_set_current_limit(bq, 100);
  652. break;
  653. case BQ2415X_MODE_NONE:
  654. dev_dbg(bq->dev, "changing mode to: N/A\n");
  655. ret = bq2415x_set_current_limit(bq, 100);
  656. break;
  657. case BQ2415X_MODE_HOST_CHARGER:
  658. dev_dbg(bq->dev, "changing mode to: Host/HUB charger\n");
  659. ret = bq2415x_set_current_limit(bq, 500);
  660. break;
  661. case BQ2415X_MODE_DEDICATED_CHARGER:
  662. dev_dbg(bq->dev, "changing mode to: Dedicated charger\n");
  663. ret = bq2415x_set_current_limit(bq, 1800);
  664. break;
  665. case BQ2415X_MODE_BOOST: /* Boost mode */
  666. dev_dbg(bq->dev, "changing mode to: Boost\n");
  667. ret = bq2415x_set_current_limit(bq, 100);
  668. break;
  669. }
  670. if (ret < 0)
  671. return ret;
  672. if (charger)
  673. ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE);
  674. else if (boost)
  675. ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_ENABLE);
  676. if (ret < 0)
  677. return ret;
  678. bq2415x_set_default_value(bq, weak_battery_voltage);
  679. bq2415x_set_default_value(bq, battery_regulation_voltage);
  680. bq->mode = mode;
  681. sysfs_notify(&bq->charger.dev->kobj, NULL, "mode");
  682. return 0;
  683. }
  684. /* hook function called by other driver which set reported mode */
  685. static void bq2415x_hook_function(enum bq2415x_mode mode, void *data)
  686. {
  687. struct bq2415x_device *bq = data;
  688. if (!bq)
  689. return;
  690. dev_dbg(bq->dev, "hook function was called\n");
  691. bq->reported_mode = mode;
  692. /* if automode is not enabled do not tell about reported_mode */
  693. if (bq->automode < 1)
  694. return;
  695. sysfs_notify(&bq->charger.dev->kobj, NULL, "reported_mode");
  696. bq2415x_set_mode(bq, bq->reported_mode);
  697. }
  698. /**** timer functions ****/
  699. /* enable/disable auto resetting chip timer */
  700. static void bq2415x_set_autotimer(struct bq2415x_device *bq, int state)
  701. {
  702. mutex_lock(&bq2415x_timer_mutex);
  703. if (bq->autotimer == state) {
  704. mutex_unlock(&bq2415x_timer_mutex);
  705. return;
  706. }
  707. bq->autotimer = state;
  708. if (state) {
  709. schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ);
  710. bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
  711. bq->timer_error = NULL;
  712. } else {
  713. cancel_delayed_work_sync(&bq->work);
  714. }
  715. mutex_unlock(&bq2415x_timer_mutex);
  716. }
  717. /* called by bq2415x_timer_work on timer error */
  718. static void bq2415x_timer_error(struct bq2415x_device *bq, const char *msg)
  719. {
  720. bq->timer_error = msg;
  721. sysfs_notify(&bq->charger.dev->kobj, NULL, "timer");
  722. dev_err(bq->dev, "%s\n", msg);
  723. if (bq->automode > 0)
  724. bq->automode = 0;
  725. bq2415x_set_mode(bq, BQ2415X_MODE_OFF);
  726. bq2415x_set_autotimer(bq, 0);
  727. }
  728. /* delayed work function for auto resetting chip timer */
  729. static void bq2415x_timer_work(struct work_struct *work)
  730. {
  731. struct bq2415x_device *bq = container_of(work, struct bq2415x_device,
  732. work.work);
  733. int ret;
  734. int error;
  735. int boost;
  736. if (!bq->autotimer)
  737. return;
  738. ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
  739. if (ret < 0) {
  740. bq2415x_timer_error(bq, "Resetting timer failed");
  741. return;
  742. }
  743. boost = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_STATUS);
  744. if (boost < 0) {
  745. bq2415x_timer_error(bq, "Unknown error");
  746. return;
  747. }
  748. error = bq2415x_exec_command(bq, BQ2415X_FAULT_STATUS);
  749. if (error < 0) {
  750. bq2415x_timer_error(bq, "Unknown error");
  751. return;
  752. }
  753. if (boost) {
  754. switch (error) {
  755. /* Non fatal errors, chip is OK */
  756. case 0: /* No error */
  757. break;
  758. case 6: /* Timer expired */
  759. dev_err(bq->dev, "Timer expired\n");
  760. break;
  761. case 3: /* Battery voltage too low */
  762. dev_err(bq->dev, "Battery voltage to low\n");
  763. break;
  764. /* Fatal errors, disable and reset chip */
  765. case 1: /* Overvoltage protection (chip fried) */
  766. bq2415x_timer_error(bq,
  767. "Overvoltage protection (chip fried)");
  768. return;
  769. case 2: /* Overload */
  770. bq2415x_timer_error(bq, "Overload");
  771. return;
  772. case 4: /* Battery overvoltage protection */
  773. bq2415x_timer_error(bq,
  774. "Battery overvoltage protection");
  775. return;
  776. case 5: /* Thermal shutdown (too hot) */
  777. bq2415x_timer_error(bq,
  778. "Thermal shutdown (too hot)");
  779. return;
  780. case 7: /* N/A */
  781. bq2415x_timer_error(bq, "Unknown error");
  782. return;
  783. }
  784. } else {
  785. switch (error) {
  786. /* Non fatal errors, chip is OK */
  787. case 0: /* No error */
  788. break;
  789. case 2: /* Sleep mode */
  790. dev_err(bq->dev, "Sleep mode\n");
  791. break;
  792. case 3: /* Poor input source */
  793. dev_err(bq->dev, "Poor input source\n");
  794. break;
  795. case 6: /* Timer expired */
  796. dev_err(bq->dev, "Timer expired\n");
  797. break;
  798. case 7: /* No battery */
  799. dev_err(bq->dev, "No battery\n");
  800. break;
  801. /* Fatal errors, disable and reset chip */
  802. case 1: /* Overvoltage protection (chip fried) */
  803. bq2415x_timer_error(bq,
  804. "Overvoltage protection (chip fried)");
  805. return;
  806. case 4: /* Battery overvoltage protection */
  807. bq2415x_timer_error(bq,
  808. "Battery overvoltage protection");
  809. return;
  810. case 5: /* Thermal shutdown (too hot) */
  811. bq2415x_timer_error(bq,
  812. "Thermal shutdown (too hot)");
  813. return;
  814. }
  815. }
  816. schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ);
  817. }
  818. /**** power supply interface code ****/
  819. static enum power_supply_property bq2415x_power_supply_props[] = {
  820. /* TODO: maybe add more power supply properties */
  821. POWER_SUPPLY_PROP_STATUS,
  822. POWER_SUPPLY_PROP_MODEL_NAME,
  823. };
  824. static int bq2415x_power_supply_get_property(struct power_supply *psy,
  825. enum power_supply_property psp,
  826. union power_supply_propval *val)
  827. {
  828. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  829. charger);
  830. int ret;
  831. switch (psp) {
  832. case POWER_SUPPLY_PROP_STATUS:
  833. ret = bq2415x_exec_command(bq, BQ2415X_CHARGE_STATUS);
  834. if (ret < 0)
  835. return ret;
  836. else if (ret == 0) /* Ready */
  837. val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
  838. else if (ret == 1) /* Charge in progress */
  839. val->intval = POWER_SUPPLY_STATUS_CHARGING;
  840. else if (ret == 2) /* Charge done */
  841. val->intval = POWER_SUPPLY_STATUS_FULL;
  842. else
  843. val->intval = POWER_SUPPLY_STATUS_UNKNOWN;
  844. break;
  845. case POWER_SUPPLY_PROP_MODEL_NAME:
  846. val->strval = bq->model;
  847. break;
  848. default:
  849. return -EINVAL;
  850. }
  851. return 0;
  852. }
  853. static int bq2415x_power_supply_init(struct bq2415x_device *bq)
  854. {
  855. int ret;
  856. int chip;
  857. char revstr[8];
  858. bq->charger.name = bq->name;
  859. bq->charger.type = POWER_SUPPLY_TYPE_USB;
  860. bq->charger.properties = bq2415x_power_supply_props;
  861. bq->charger.num_properties = ARRAY_SIZE(bq2415x_power_supply_props);
  862. bq->charger.get_property = bq2415x_power_supply_get_property;
  863. ret = bq2415x_detect_chip(bq);
  864. if (ret < 0)
  865. chip = BQUNKNOWN;
  866. else
  867. chip = ret;
  868. ret = bq2415x_detect_revision(bq);
  869. if (ret < 0)
  870. strcpy(revstr, "unknown");
  871. else
  872. sprintf(revstr, "1.%d", ret);
  873. bq->model = kasprintf(GFP_KERNEL,
  874. "chip %s, revision %s, vender code %.3d",
  875. bq2415x_chip_name[chip], revstr,
  876. bq2415x_get_vender_code(bq));
  877. if (!bq->model) {
  878. dev_err(bq->dev, "failed to allocate model name\n");
  879. return -ENOMEM;
  880. }
  881. ret = power_supply_register(bq->dev, &bq->charger);
  882. if (ret) {
  883. kfree(bq->model);
  884. return ret;
  885. }
  886. return 0;
  887. }
  888. static void bq2415x_power_supply_exit(struct bq2415x_device *bq)
  889. {
  890. bq->autotimer = 0;
  891. if (bq->automode > 0)
  892. bq->automode = 0;
  893. cancel_delayed_work_sync(&bq->work);
  894. power_supply_unregister(&bq->charger);
  895. kfree(bq->model);
  896. }
  897. /**** additional sysfs entries for power supply interface ****/
  898. /* show *_status entries */
  899. static ssize_t bq2415x_sysfs_show_status(struct device *dev,
  900. struct device_attribute *attr,
  901. char *buf)
  902. {
  903. struct power_supply *psy = dev_get_drvdata(dev);
  904. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  905. charger);
  906. enum bq2415x_command command;
  907. int ret;
  908. if (strcmp(attr->attr.name, "otg_status") == 0)
  909. command = BQ2415X_OTG_STATUS;
  910. else if (strcmp(attr->attr.name, "charge_status") == 0)
  911. command = BQ2415X_CHARGE_STATUS;
  912. else if (strcmp(attr->attr.name, "boost_status") == 0)
  913. command = BQ2415X_BOOST_STATUS;
  914. else if (strcmp(attr->attr.name, "fault_status") == 0)
  915. command = BQ2415X_FAULT_STATUS;
  916. else
  917. return -EINVAL;
  918. ret = bq2415x_exec_command(bq, command);
  919. if (ret < 0)
  920. return ret;
  921. return sprintf(buf, "%d\n", ret);
  922. }
  923. /*
  924. * set timer entry:
  925. * auto - enable auto mode
  926. * off - disable auto mode
  927. * (other values) - reset chip timer
  928. */
  929. static ssize_t bq2415x_sysfs_set_timer(struct device *dev,
  930. struct device_attribute *attr,
  931. const char *buf,
  932. size_t count)
  933. {
  934. struct power_supply *psy = dev_get_drvdata(dev);
  935. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  936. charger);
  937. int ret = 0;
  938. if (strncmp(buf, "auto", 4) == 0)
  939. bq2415x_set_autotimer(bq, 1);
  940. else if (strncmp(buf, "off", 3) == 0)
  941. bq2415x_set_autotimer(bq, 0);
  942. else
  943. ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
  944. if (ret < 0)
  945. return ret;
  946. return count;
  947. }
  948. /* show timer entry (auto or off) */
  949. static ssize_t bq2415x_sysfs_show_timer(struct device *dev,
  950. struct device_attribute *attr,
  951. char *buf)
  952. {
  953. struct power_supply *psy = dev_get_drvdata(dev);
  954. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  955. charger);
  956. if (bq->timer_error)
  957. return sprintf(buf, "%s\n", bq->timer_error);
  958. if (bq->autotimer)
  959. return sprintf(buf, "auto\n");
  960. return sprintf(buf, "off\n");
  961. }
  962. /*
  963. * set mode entry:
  964. * auto - if automode is supported, enable it and set mode to reported
  965. * none - disable charger and boost mode
  966. * host - charging mode for host/hub chargers (current limit 500mA)
  967. * dedicated - charging mode for dedicated chargers (unlimited current limit)
  968. * boost - disable charger and enable boost mode
  969. */
  970. static ssize_t bq2415x_sysfs_set_mode(struct device *dev,
  971. struct device_attribute *attr,
  972. const char *buf,
  973. size_t count)
  974. {
  975. struct power_supply *psy = dev_get_drvdata(dev);
  976. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  977. charger);
  978. enum bq2415x_mode mode;
  979. int ret = 0;
  980. if (strncmp(buf, "auto", 4) == 0) {
  981. if (bq->automode < 0)
  982. return -ENOSYS;
  983. bq->automode = 1;
  984. mode = bq->reported_mode;
  985. } else if (strncmp(buf, "off", 3) == 0) {
  986. if (bq->automode > 0)
  987. bq->automode = 0;
  988. mode = BQ2415X_MODE_OFF;
  989. } else if (strncmp(buf, "none", 4) == 0) {
  990. if (bq->automode > 0)
  991. bq->automode = 0;
  992. mode = BQ2415X_MODE_NONE;
  993. } else if (strncmp(buf, "host", 4) == 0) {
  994. if (bq->automode > 0)
  995. bq->automode = 0;
  996. mode = BQ2415X_MODE_HOST_CHARGER;
  997. } else if (strncmp(buf, "dedicated", 9) == 0) {
  998. if (bq->automode > 0)
  999. bq->automode = 0;
  1000. mode = BQ2415X_MODE_DEDICATED_CHARGER;
  1001. } else if (strncmp(buf, "boost", 5) == 0) {
  1002. if (bq->automode > 0)
  1003. bq->automode = 0;
  1004. mode = BQ2415X_MODE_BOOST;
  1005. } else if (strncmp(buf, "reset", 5) == 0) {
  1006. bq2415x_reset_chip(bq);
  1007. bq2415x_set_defaults(bq);
  1008. if (bq->automode <= 0)
  1009. return count;
  1010. bq->automode = 1;
  1011. mode = bq->reported_mode;
  1012. } else {
  1013. return -EINVAL;
  1014. }
  1015. ret = bq2415x_set_mode(bq, mode);
  1016. if (ret < 0)
  1017. return ret;
  1018. return count;
  1019. }
  1020. /* show mode entry (auto, none, host, dedicated or boost) */
  1021. static ssize_t bq2415x_sysfs_show_mode(struct device *dev,
  1022. struct device_attribute *attr,
  1023. char *buf)
  1024. {
  1025. struct power_supply *psy = dev_get_drvdata(dev);
  1026. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  1027. charger);
  1028. ssize_t ret = 0;
  1029. if (bq->automode > 0)
  1030. ret += sprintf(buf+ret, "auto (");
  1031. switch (bq->mode) {
  1032. case BQ2415X_MODE_OFF:
  1033. ret += sprintf(buf+ret, "off");
  1034. break;
  1035. case BQ2415X_MODE_NONE:
  1036. ret += sprintf(buf+ret, "none");
  1037. break;
  1038. case BQ2415X_MODE_HOST_CHARGER:
  1039. ret += sprintf(buf+ret, "host");
  1040. break;
  1041. case BQ2415X_MODE_DEDICATED_CHARGER:
  1042. ret += sprintf(buf+ret, "dedicated");
  1043. break;
  1044. case BQ2415X_MODE_BOOST:
  1045. ret += sprintf(buf+ret, "boost");
  1046. break;
  1047. }
  1048. if (bq->automode > 0)
  1049. ret += sprintf(buf+ret, ")");
  1050. ret += sprintf(buf+ret, "\n");
  1051. return ret;
  1052. }
  1053. /* show reported_mode entry (none, host, dedicated or boost) */
  1054. static ssize_t bq2415x_sysfs_show_reported_mode(struct device *dev,
  1055. struct device_attribute *attr,
  1056. char *buf)
  1057. {
  1058. struct power_supply *psy = dev_get_drvdata(dev);
  1059. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  1060. charger);
  1061. if (bq->automode < 0)
  1062. return -EINVAL;
  1063. switch (bq->reported_mode) {
  1064. case BQ2415X_MODE_OFF:
  1065. return sprintf(buf, "off\n");
  1066. case BQ2415X_MODE_NONE:
  1067. return sprintf(buf, "none\n");
  1068. case BQ2415X_MODE_HOST_CHARGER:
  1069. return sprintf(buf, "host\n");
  1070. case BQ2415X_MODE_DEDICATED_CHARGER:
  1071. return sprintf(buf, "dedicated\n");
  1072. case BQ2415X_MODE_BOOST:
  1073. return sprintf(buf, "boost\n");
  1074. }
  1075. return -EINVAL;
  1076. }
  1077. /* directly set raw value to chip register, format: 'register value' */
  1078. static ssize_t bq2415x_sysfs_set_registers(struct device *dev,
  1079. struct device_attribute *attr,
  1080. const char *buf,
  1081. size_t count)
  1082. {
  1083. struct power_supply *psy = dev_get_drvdata(dev);
  1084. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  1085. charger);
  1086. ssize_t ret = 0;
  1087. unsigned int reg;
  1088. unsigned int val;
  1089. if (sscanf(buf, "%x %x", &reg, &val) != 2)
  1090. return -EINVAL;
  1091. if (reg > 4 || val > 255)
  1092. return -EINVAL;
  1093. ret = bq2415x_i2c_write(bq, reg, val);
  1094. if (ret < 0)
  1095. return ret;
  1096. return count;
  1097. }
  1098. /* print value of chip register, format: 'register=value' */
  1099. static ssize_t bq2415x_sysfs_print_reg(struct bq2415x_device *bq,
  1100. u8 reg,
  1101. char *buf)
  1102. {
  1103. int ret = bq2415x_i2c_read(bq, reg);
  1104. if (ret < 0)
  1105. return sprintf(buf, "%#.2x=error %d\n", reg, ret);
  1106. return sprintf(buf, "%#.2x=%#.2x\n", reg, ret);
  1107. }
  1108. /* show all raw values of chip register, format per line: 'register=value' */
  1109. static ssize_t bq2415x_sysfs_show_registers(struct device *dev,
  1110. struct device_attribute *attr,
  1111. char *buf)
  1112. {
  1113. struct power_supply *psy = dev_get_drvdata(dev);
  1114. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  1115. charger);
  1116. ssize_t ret = 0;
  1117. ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_STATUS, buf+ret);
  1118. ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CONTROL, buf+ret);
  1119. ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VOLTAGE, buf+ret);
  1120. ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VENDER, buf+ret);
  1121. ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CURRENT, buf+ret);
  1122. return ret;
  1123. }
  1124. /* set current and voltage limit entries (in mA or mV) */
  1125. static ssize_t bq2415x_sysfs_set_limit(struct device *dev,
  1126. struct device_attribute *attr,
  1127. const char *buf,
  1128. size_t count)
  1129. {
  1130. struct power_supply *psy = dev_get_drvdata(dev);
  1131. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  1132. charger);
  1133. long val;
  1134. int ret;
  1135. if (kstrtol(buf, 10, &val) < 0)
  1136. return -EINVAL;
  1137. if (strcmp(attr->attr.name, "current_limit") == 0)
  1138. ret = bq2415x_set_current_limit(bq, val);
  1139. else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0)
  1140. ret = bq2415x_set_weak_battery_voltage(bq, val);
  1141. else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0)
  1142. ret = bq2415x_set_battery_regulation_voltage(bq, val);
  1143. else if (strcmp(attr->attr.name, "charge_current") == 0)
  1144. ret = bq2415x_set_charge_current(bq, val);
  1145. else if (strcmp(attr->attr.name, "termination_current") == 0)
  1146. ret = bq2415x_set_termination_current(bq, val);
  1147. else
  1148. return -EINVAL;
  1149. if (ret < 0)
  1150. return ret;
  1151. return count;
  1152. }
  1153. /* show current and voltage limit entries (in mA or mV) */
  1154. static ssize_t bq2415x_sysfs_show_limit(struct device *dev,
  1155. struct device_attribute *attr,
  1156. char *buf)
  1157. {
  1158. struct power_supply *psy = dev_get_drvdata(dev);
  1159. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  1160. charger);
  1161. int ret;
  1162. if (strcmp(attr->attr.name, "current_limit") == 0)
  1163. ret = bq2415x_get_current_limit(bq);
  1164. else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0)
  1165. ret = bq2415x_get_weak_battery_voltage(bq);
  1166. else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0)
  1167. ret = bq2415x_get_battery_regulation_voltage(bq);
  1168. else if (strcmp(attr->attr.name, "charge_current") == 0)
  1169. ret = bq2415x_get_charge_current(bq);
  1170. else if (strcmp(attr->attr.name, "termination_current") == 0)
  1171. ret = bq2415x_get_termination_current(bq);
  1172. else
  1173. return -EINVAL;
  1174. if (ret < 0)
  1175. return ret;
  1176. return sprintf(buf, "%d\n", ret);
  1177. }
  1178. /* set *_enable entries */
  1179. static ssize_t bq2415x_sysfs_set_enable(struct device *dev,
  1180. struct device_attribute *attr,
  1181. const char *buf,
  1182. size_t count)
  1183. {
  1184. struct power_supply *psy = dev_get_drvdata(dev);
  1185. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  1186. charger);
  1187. enum bq2415x_command command;
  1188. long val;
  1189. int ret;
  1190. if (kstrtol(buf, 10, &val) < 0)
  1191. return -EINVAL;
  1192. if (strcmp(attr->attr.name, "charge_termination_enable") == 0)
  1193. command = val ? BQ2415X_CHARGE_TERMINATION_ENABLE :
  1194. BQ2415X_CHARGE_TERMINATION_DISABLE;
  1195. else if (strcmp(attr->attr.name, "high_impedance_enable") == 0)
  1196. command = val ? BQ2415X_HIGH_IMPEDANCE_ENABLE :
  1197. BQ2415X_HIGH_IMPEDANCE_DISABLE;
  1198. else if (strcmp(attr->attr.name, "otg_pin_enable") == 0)
  1199. command = val ? BQ2415X_OTG_PIN_ENABLE :
  1200. BQ2415X_OTG_PIN_DISABLE;
  1201. else if (strcmp(attr->attr.name, "stat_pin_enable") == 0)
  1202. command = val ? BQ2415X_STAT_PIN_ENABLE :
  1203. BQ2415X_STAT_PIN_DISABLE;
  1204. else
  1205. return -EINVAL;
  1206. ret = bq2415x_exec_command(bq, command);
  1207. if (ret < 0)
  1208. return ret;
  1209. return count;
  1210. }
  1211. /* show *_enable entries */
  1212. static ssize_t bq2415x_sysfs_show_enable(struct device *dev,
  1213. struct device_attribute *attr,
  1214. char *buf)
  1215. {
  1216. struct power_supply *psy = dev_get_drvdata(dev);
  1217. struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
  1218. charger);
  1219. enum bq2415x_command command;
  1220. int ret;
  1221. if (strcmp(attr->attr.name, "charge_termination_enable") == 0)
  1222. command = BQ2415X_CHARGE_TERMINATION_STATUS;
  1223. else if (strcmp(attr->attr.name, "high_impedance_enable") == 0)
  1224. command = BQ2415X_HIGH_IMPEDANCE_STATUS;
  1225. else if (strcmp(attr->attr.name, "otg_pin_enable") == 0)
  1226. command = BQ2415X_OTG_PIN_STATUS;
  1227. else if (strcmp(attr->attr.name, "stat_pin_enable") == 0)
  1228. command = BQ2415X_STAT_PIN_STATUS;
  1229. else
  1230. return -EINVAL;
  1231. ret = bq2415x_exec_command(bq, command);
  1232. if (ret < 0)
  1233. return ret;
  1234. return sprintf(buf, "%d\n", ret);
  1235. }
  1236. static DEVICE_ATTR(current_limit, S_IWUSR | S_IRUGO,
  1237. bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
  1238. static DEVICE_ATTR(weak_battery_voltage, S_IWUSR | S_IRUGO,
  1239. bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
  1240. static DEVICE_ATTR(battery_regulation_voltage, S_IWUSR | S_IRUGO,
  1241. bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
  1242. static DEVICE_ATTR(charge_current, S_IWUSR | S_IRUGO,
  1243. bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
  1244. static DEVICE_ATTR(termination_current, S_IWUSR | S_IRUGO,
  1245. bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
  1246. static DEVICE_ATTR(charge_termination_enable, S_IWUSR | S_IRUGO,
  1247. bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
  1248. static DEVICE_ATTR(high_impedance_enable, S_IWUSR | S_IRUGO,
  1249. bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
  1250. static DEVICE_ATTR(otg_pin_enable, S_IWUSR | S_IRUGO,
  1251. bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
  1252. static DEVICE_ATTR(stat_pin_enable, S_IWUSR | S_IRUGO,
  1253. bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
  1254. static DEVICE_ATTR(reported_mode, S_IRUGO,
  1255. bq2415x_sysfs_show_reported_mode, NULL);
  1256. static DEVICE_ATTR(mode, S_IWUSR | S_IRUGO,
  1257. bq2415x_sysfs_show_mode, bq2415x_sysfs_set_mode);
  1258. static DEVICE_ATTR(timer, S_IWUSR | S_IRUGO,
  1259. bq2415x_sysfs_show_timer, bq2415x_sysfs_set_timer);
  1260. static DEVICE_ATTR(registers, S_IWUSR | S_IRUGO,
  1261. bq2415x_sysfs_show_registers, bq2415x_sysfs_set_registers);
  1262. static DEVICE_ATTR(otg_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
  1263. static DEVICE_ATTR(charge_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
  1264. static DEVICE_ATTR(boost_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
  1265. static DEVICE_ATTR(fault_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
  1266. static struct attribute *bq2415x_sysfs_attributes[] = {
  1267. /*
  1268. * TODO: some (appropriate) of these attrs should be switched to
  1269. * use power supply class props.
  1270. */
  1271. &dev_attr_current_limit.attr,
  1272. &dev_attr_weak_battery_voltage.attr,
  1273. &dev_attr_battery_regulation_voltage.attr,
  1274. &dev_attr_charge_current.attr,
  1275. &dev_attr_termination_current.attr,
  1276. &dev_attr_charge_termination_enable.attr,
  1277. &dev_attr_high_impedance_enable.attr,
  1278. &dev_attr_otg_pin_enable.attr,
  1279. &dev_attr_stat_pin_enable.attr,
  1280. &dev_attr_reported_mode.attr,
  1281. &dev_attr_mode.attr,
  1282. &dev_attr_timer.attr,
  1283. &dev_attr_registers.attr,
  1284. &dev_attr_otg_status.attr,
  1285. &dev_attr_charge_status.attr,
  1286. &dev_attr_boost_status.attr,
  1287. &dev_attr_fault_status.attr,
  1288. NULL,
  1289. };
  1290. static const struct attribute_group bq2415x_sysfs_attr_group = {
  1291. .attrs = bq2415x_sysfs_attributes,
  1292. };
  1293. static int bq2415x_sysfs_init(struct bq2415x_device *bq)
  1294. {
  1295. return sysfs_create_group(&bq->charger.dev->kobj,
  1296. &bq2415x_sysfs_attr_group);
  1297. }
  1298. static void bq2415x_sysfs_exit(struct bq2415x_device *bq)
  1299. {
  1300. sysfs_remove_group(&bq->charger.dev->kobj, &bq2415x_sysfs_attr_group);
  1301. }
  1302. /* main bq2415x probe function */
  1303. static int bq2415x_probe(struct i2c_client *client,
  1304. const struct i2c_device_id *id)
  1305. {
  1306. int ret;
  1307. int num;
  1308. char *name;
  1309. struct bq2415x_device *bq;
  1310. if (!client->dev.platform_data) {
  1311. dev_err(&client->dev, "platform data not set\n");
  1312. return -ENODEV;
  1313. }
  1314. /* Get new ID for the new device */
  1315. mutex_lock(&bq2415x_id_mutex);
  1316. num = idr_alloc(&bq2415x_id, client, 0, 0, GFP_KERNEL);
  1317. mutex_unlock(&bq2415x_id_mutex);
  1318. if (num < 0)
  1319. return num;
  1320. name = kasprintf(GFP_KERNEL, "%s-%d", id->name, num);
  1321. if (!name) {
  1322. dev_err(&client->dev, "failed to allocate device name\n");
  1323. ret = -ENOMEM;
  1324. goto error_1;
  1325. }
  1326. bq = devm_kzalloc(&client->dev, sizeof(*bq), GFP_KERNEL);
  1327. if (!bq) {
  1328. dev_err(&client->dev, "failed to allocate device data\n");
  1329. ret = -ENOMEM;
  1330. goto error_2;
  1331. }
  1332. i2c_set_clientdata(client, bq);
  1333. bq->id = num;
  1334. bq->dev = &client->dev;
  1335. bq->chip = id->driver_data;
  1336. bq->name = name;
  1337. bq->mode = BQ2415X_MODE_OFF;
  1338. bq->reported_mode = BQ2415X_MODE_OFF;
  1339. bq->autotimer = 0;
  1340. bq->automode = 0;
  1341. memcpy(&bq->init_data, client->dev.platform_data,
  1342. sizeof(bq->init_data));
  1343. bq2415x_reset_chip(bq);
  1344. ret = bq2415x_power_supply_init(bq);
  1345. if (ret) {
  1346. dev_err(bq->dev, "failed to register power supply: %d\n", ret);
  1347. goto error_2;
  1348. }
  1349. ret = bq2415x_sysfs_init(bq);
  1350. if (ret) {
  1351. dev_err(bq->dev, "failed to create sysfs entries: %d\n", ret);
  1352. goto error_3;
  1353. }
  1354. ret = bq2415x_set_defaults(bq);
  1355. if (ret) {
  1356. dev_err(bq->dev, "failed to set default values: %d\n", ret);
  1357. goto error_4;
  1358. }
  1359. if (bq->init_data.set_mode_hook) {
  1360. if (bq->init_data.set_mode_hook(
  1361. bq2415x_hook_function, bq)) {
  1362. bq->automode = 1;
  1363. bq2415x_set_mode(bq, bq->reported_mode);
  1364. dev_info(bq->dev, "automode enabled\n");
  1365. } else {
  1366. bq->automode = -1;
  1367. dev_info(bq->dev, "automode failed\n");
  1368. }
  1369. } else {
  1370. bq->automode = -1;
  1371. dev_info(bq->dev, "automode not supported\n");
  1372. }
  1373. INIT_DELAYED_WORK(&bq->work, bq2415x_timer_work);
  1374. bq2415x_set_autotimer(bq, 1);
  1375. dev_info(bq->dev, "driver registered\n");
  1376. return 0;
  1377. error_4:
  1378. bq2415x_sysfs_exit(bq);
  1379. error_3:
  1380. bq2415x_power_supply_exit(bq);
  1381. error_2:
  1382. kfree(name);
  1383. error_1:
  1384. mutex_lock(&bq2415x_id_mutex);
  1385. idr_remove(&bq2415x_id, num);
  1386. mutex_unlock(&bq2415x_id_mutex);
  1387. return ret;
  1388. }
  1389. /* main bq2415x remove function */
  1390. static int bq2415x_remove(struct i2c_client *client)
  1391. {
  1392. struct bq2415x_device *bq = i2c_get_clientdata(client);
  1393. if (bq->init_data.set_mode_hook)
  1394. bq->init_data.set_mode_hook(NULL, NULL);
  1395. bq2415x_sysfs_exit(bq);
  1396. bq2415x_power_supply_exit(bq);
  1397. bq2415x_reset_chip(bq);
  1398. mutex_lock(&bq2415x_id_mutex);
  1399. idr_remove(&bq2415x_id, bq->id);
  1400. mutex_unlock(&bq2415x_id_mutex);
  1401. dev_info(bq->dev, "driver unregistered\n");
  1402. kfree(bq->name);
  1403. return 0;
  1404. }
  1405. static const struct i2c_device_id bq2415x_i2c_id_table[] = {
  1406. { "bq2415x", BQUNKNOWN },
  1407. { "bq24150", BQ24150 },
  1408. { "bq24150a", BQ24150A },
  1409. { "bq24151", BQ24151 },
  1410. { "bq24151a", BQ24151A },
  1411. { "bq24152", BQ24152 },
  1412. { "bq24153", BQ24153 },
  1413. { "bq24153a", BQ24153A },
  1414. { "bq24155", BQ24155 },
  1415. { "bq24156", BQ24156 },
  1416. { "bq24156a", BQ24156A },
  1417. { "bq24158", BQ24158 },
  1418. {},
  1419. };
  1420. MODULE_DEVICE_TABLE(i2c, bq2415x_i2c_id_table);
  1421. static struct i2c_driver bq2415x_driver = {
  1422. .driver = {
  1423. .name = "bq2415x-charger",
  1424. },
  1425. .probe = bq2415x_probe,
  1426. .remove = bq2415x_remove,
  1427. .id_table = bq2415x_i2c_id_table,
  1428. };
  1429. module_i2c_driver(bq2415x_driver);
  1430. MODULE_AUTHOR("Pali Rohár <pali.rohar@gmail.com>");
  1431. MODULE_DESCRIPTION("bq2415x charger driver");
  1432. MODULE_LICENSE("GPL");