rt5033_charger.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Battery charger driver for RT5033
  4. *
  5. * Copyright (C) 2014 Samsung Electronics, Co., Ltd.
  6. * Author: Beomho Seo <beomho.seo@samsung.com>
  7. */
  8. #include <linux/devm-helpers.h>
  9. #include <linux/extcon.h>
  10. #include <linux/mod_devicetable.h>
  11. #include <linux/module.h>
  12. #include <linux/mutex.h>
  13. #include <linux/of.h>
  14. #include <linux/platform_device.h>
  15. #include <linux/power_supply.h>
  16. #include <linux/regmap.h>
  17. #include <linux/mfd/rt5033-private.h>
  18. struct rt5033_charger_data {
  19. unsigned int pre_uamp;
  20. unsigned int pre_uvolt;
  21. unsigned int const_uvolt;
  22. unsigned int eoc_uamp;
  23. unsigned int fast_uamp;
  24. };
  25. struct rt5033_charger {
  26. struct device *dev;
  27. struct regmap *regmap;
  28. struct power_supply *psy;
  29. struct rt5033_charger_data chg;
  30. struct extcon_dev *edev;
  31. struct notifier_block extcon_nb;
  32. struct work_struct extcon_work;
  33. struct mutex lock;
  34. bool online;
  35. bool otg;
  36. bool mivr_enabled;
  37. u8 cv_regval;
  38. };
  39. static int rt5033_get_charger_state(struct rt5033_charger *charger)
  40. {
  41. struct regmap *regmap = charger->regmap;
  42. unsigned int reg_data;
  43. int state;
  44. if (!regmap)
  45. return POWER_SUPPLY_STATUS_UNKNOWN;
  46. regmap_read(regmap, RT5033_REG_CHG_STAT, &reg_data);
  47. switch (reg_data & RT5033_CHG_STAT_MASK) {
  48. case RT5033_CHG_STAT_DISCHARGING:
  49. state = POWER_SUPPLY_STATUS_DISCHARGING;
  50. break;
  51. case RT5033_CHG_STAT_CHARGING:
  52. state = POWER_SUPPLY_STATUS_CHARGING;
  53. break;
  54. case RT5033_CHG_STAT_FULL:
  55. state = POWER_SUPPLY_STATUS_FULL;
  56. break;
  57. case RT5033_CHG_STAT_NOT_CHARGING:
  58. state = POWER_SUPPLY_STATUS_NOT_CHARGING;
  59. break;
  60. default:
  61. state = POWER_SUPPLY_STATUS_UNKNOWN;
  62. }
  63. /* For OTG mode, RT5033 would still report "charging" */
  64. if (charger->otg)
  65. state = POWER_SUPPLY_STATUS_DISCHARGING;
  66. return state;
  67. }
  68. static int rt5033_get_charger_type(struct rt5033_charger *charger)
  69. {
  70. struct regmap *regmap = charger->regmap;
  71. unsigned int reg_data;
  72. int state;
  73. regmap_read(regmap, RT5033_REG_CHG_STAT, &reg_data);
  74. switch (reg_data & RT5033_CHG_STAT_TYPE_MASK) {
  75. case RT5033_CHG_STAT_TYPE_FAST:
  76. state = POWER_SUPPLY_CHARGE_TYPE_FAST;
  77. break;
  78. case RT5033_CHG_STAT_TYPE_PRE:
  79. state = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
  80. break;
  81. default:
  82. state = POWER_SUPPLY_CHARGE_TYPE_NONE;
  83. }
  84. return state;
  85. }
  86. static int rt5033_get_charger_current_limit(struct rt5033_charger *charger)
  87. {
  88. struct regmap *regmap = charger->regmap;
  89. unsigned int state, reg_data, data;
  90. regmap_read(regmap, RT5033_REG_CHG_CTRL5, &reg_data);
  91. state = (reg_data & RT5033_CHGCTRL5_ICHG_MASK)
  92. >> RT5033_CHGCTRL5_ICHG_SHIFT;
  93. data = RT5033_CHARGER_FAST_CURRENT_MIN +
  94. RT5033_CHARGER_FAST_CURRENT_STEP_NUM * state;
  95. return data;
  96. }
  97. static int rt5033_get_charger_const_voltage(struct rt5033_charger *charger)
  98. {
  99. struct regmap *regmap = charger->regmap;
  100. unsigned int state, reg_data, data;
  101. regmap_read(regmap, RT5033_REG_CHG_CTRL2, &reg_data);
  102. state = (reg_data & RT5033_CHGCTRL2_CV_MASK)
  103. >> RT5033_CHGCTRL2_CV_SHIFT;
  104. data = RT5033_CHARGER_CONST_VOLTAGE_LIMIT_MIN +
  105. RT5033_CHARGER_CONST_VOLTAGE_STEP_NUM * state;
  106. return data;
  107. }
  108. static inline int rt5033_init_const_charge(struct rt5033_charger *charger)
  109. {
  110. struct rt5033_charger_data *chg = &charger->chg;
  111. int ret;
  112. unsigned int val;
  113. u8 reg_data;
  114. /* Set constant voltage mode */
  115. if (chg->const_uvolt < RT5033_CHARGER_CONST_VOLTAGE_LIMIT_MIN ||
  116. chg->const_uvolt > RT5033_CHARGER_CONST_VOLTAGE_LIMIT_MAX) {
  117. dev_err(charger->dev,
  118. "Value 'constant-charge-voltage-max-microvolt' out of range\n");
  119. return -EINVAL;
  120. }
  121. if (chg->const_uvolt == RT5033_CHARGER_CONST_VOLTAGE_LIMIT_MIN)
  122. reg_data = 0x00;
  123. else if (chg->const_uvolt == RT5033_CHARGER_CONST_VOLTAGE_LIMIT_MAX)
  124. reg_data = RT5033_CV_MAX_VOLTAGE;
  125. else {
  126. val = chg->const_uvolt;
  127. val -= RT5033_CHARGER_CONST_VOLTAGE_LIMIT_MIN;
  128. val /= RT5033_CHARGER_CONST_VOLTAGE_STEP_NUM;
  129. reg_data = val;
  130. }
  131. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL2,
  132. RT5033_CHGCTRL2_CV_MASK,
  133. reg_data << RT5033_CHGCTRL2_CV_SHIFT);
  134. if (ret) {
  135. dev_err(charger->dev, "Failed regmap update\n");
  136. return -EINVAL;
  137. }
  138. /* Store that value for later usage */
  139. charger->cv_regval = reg_data;
  140. /* Set end of charge current */
  141. if (chg->eoc_uamp < RT5033_CHARGER_EOC_MIN ||
  142. chg->eoc_uamp > RT5033_CHARGER_EOC_MAX) {
  143. dev_err(charger->dev,
  144. "Value 'charge-term-current-microamp' out of range\n");
  145. return -EINVAL;
  146. }
  147. if (chg->eoc_uamp == RT5033_CHARGER_EOC_MIN)
  148. reg_data = 0x01;
  149. else if (chg->eoc_uamp == RT5033_CHARGER_EOC_MAX)
  150. reg_data = 0x07;
  151. else {
  152. val = chg->eoc_uamp;
  153. if (val < RT5033_CHARGER_EOC_REF) {
  154. val -= RT5033_CHARGER_EOC_MIN;
  155. val /= RT5033_CHARGER_EOC_STEP_NUM1;
  156. reg_data = 0x01 + val;
  157. } else if (val > RT5033_CHARGER_EOC_REF) {
  158. val -= RT5033_CHARGER_EOC_REF;
  159. val /= RT5033_CHARGER_EOC_STEP_NUM2;
  160. reg_data = 0x04 + val;
  161. } else {
  162. reg_data = 0x04;
  163. }
  164. }
  165. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL4,
  166. RT5033_CHGCTRL4_EOC_MASK, reg_data);
  167. if (ret) {
  168. dev_err(charger->dev, "Failed regmap update\n");
  169. return -EINVAL;
  170. }
  171. return 0;
  172. }
  173. static inline int rt5033_init_fast_charge(struct rt5033_charger *charger)
  174. {
  175. struct rt5033_charger_data *chg = &charger->chg;
  176. int ret;
  177. unsigned int val;
  178. u8 reg_data;
  179. /* Set limit input current */
  180. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL1,
  181. RT5033_CHGCTRL1_IAICR_MASK, RT5033_AICR_2000_MODE);
  182. if (ret) {
  183. dev_err(charger->dev, "Failed regmap update\n");
  184. return -EINVAL;
  185. }
  186. /* Set fast-charge mode charging current */
  187. if (chg->fast_uamp < RT5033_CHARGER_FAST_CURRENT_MIN ||
  188. chg->fast_uamp > RT5033_CHARGER_FAST_CURRENT_MAX) {
  189. dev_err(charger->dev,
  190. "Value 'constant-charge-current-max-microamp' out of range\n");
  191. return -EINVAL;
  192. }
  193. if (chg->fast_uamp == RT5033_CHARGER_FAST_CURRENT_MIN)
  194. reg_data = 0x00;
  195. else if (chg->fast_uamp == RT5033_CHARGER_FAST_CURRENT_MAX)
  196. reg_data = RT5033_CHG_MAX_CURRENT;
  197. else {
  198. val = chg->fast_uamp;
  199. val -= RT5033_CHARGER_FAST_CURRENT_MIN;
  200. val /= RT5033_CHARGER_FAST_CURRENT_STEP_NUM;
  201. reg_data = val;
  202. }
  203. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL5,
  204. RT5033_CHGCTRL5_ICHG_MASK,
  205. reg_data << RT5033_CHGCTRL5_ICHG_SHIFT);
  206. if (ret) {
  207. dev_err(charger->dev, "Failed regmap update\n");
  208. return -EINVAL;
  209. }
  210. return 0;
  211. }
  212. static inline int rt5033_init_pre_charge(struct rt5033_charger *charger)
  213. {
  214. struct rt5033_charger_data *chg = &charger->chg;
  215. int ret;
  216. unsigned int val;
  217. u8 reg_data;
  218. /* Set pre-charge threshold voltage */
  219. if (chg->pre_uvolt < RT5033_CHARGER_PRE_THRESHOLD_LIMIT_MIN ||
  220. chg->pre_uvolt > RT5033_CHARGER_PRE_THRESHOLD_LIMIT_MAX) {
  221. dev_err(charger->dev,
  222. "Value 'precharge-upper-limit-microvolt' out of range\n");
  223. return -EINVAL;
  224. }
  225. if (chg->pre_uvolt == RT5033_CHARGER_PRE_THRESHOLD_LIMIT_MIN)
  226. reg_data = 0x00;
  227. else if (chg->pre_uvolt == RT5033_CHARGER_PRE_THRESHOLD_LIMIT_MAX)
  228. reg_data = 0x0f;
  229. else {
  230. val = chg->pre_uvolt;
  231. val -= RT5033_CHARGER_PRE_THRESHOLD_LIMIT_MIN;
  232. val /= RT5033_CHARGER_PRE_THRESHOLD_STEP_NUM;
  233. reg_data = val;
  234. }
  235. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL5,
  236. RT5033_CHGCTRL5_VPREC_MASK, reg_data);
  237. if (ret) {
  238. dev_err(charger->dev, "Failed regmap update\n");
  239. return -EINVAL;
  240. }
  241. /* Set pre-charge mode charging current */
  242. if (chg->pre_uamp < RT5033_CHARGER_PRE_CURRENT_LIMIT_MIN ||
  243. chg->pre_uamp > RT5033_CHARGER_PRE_CURRENT_LIMIT_MAX) {
  244. dev_err(charger->dev,
  245. "Value 'precharge-current-microamp' out of range\n");
  246. return -EINVAL;
  247. }
  248. if (chg->pre_uamp == RT5033_CHARGER_PRE_CURRENT_LIMIT_MIN)
  249. reg_data = 0x00;
  250. else if (chg->pre_uamp == RT5033_CHARGER_PRE_CURRENT_LIMIT_MAX)
  251. reg_data = RT5033_CHG_MAX_PRE_CURRENT;
  252. else {
  253. val = chg->pre_uamp;
  254. val -= RT5033_CHARGER_PRE_CURRENT_LIMIT_MIN;
  255. val /= RT5033_CHARGER_PRE_CURRENT_STEP_NUM;
  256. reg_data = val;
  257. }
  258. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL4,
  259. RT5033_CHGCTRL4_IPREC_MASK,
  260. reg_data << RT5033_CHGCTRL4_IPREC_SHIFT);
  261. if (ret) {
  262. dev_err(charger->dev, "Failed regmap update\n");
  263. return -EINVAL;
  264. }
  265. return 0;
  266. }
  267. static int rt5033_charger_reg_init(struct rt5033_charger *charger)
  268. {
  269. int ret = 0;
  270. /* Enable charging termination */
  271. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL1,
  272. RT5033_CHGCTRL1_TE_EN_MASK, RT5033_TE_ENABLE);
  273. if (ret) {
  274. dev_err(charger->dev, "Failed to enable charging termination.\n");
  275. return -EINVAL;
  276. }
  277. /*
  278. * Disable minimum input voltage regulation (MIVR), this improves
  279. * the charging performance.
  280. */
  281. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL4,
  282. RT5033_CHGCTRL4_MIVR_MASK, RT5033_CHARGER_MIVR_DISABLE);
  283. if (ret) {
  284. dev_err(charger->dev, "Failed to disable MIVR.\n");
  285. return -EINVAL;
  286. }
  287. ret = rt5033_init_pre_charge(charger);
  288. if (ret)
  289. return ret;
  290. ret = rt5033_init_fast_charge(charger);
  291. if (ret)
  292. return ret;
  293. ret = rt5033_init_const_charge(charger);
  294. if (ret)
  295. return ret;
  296. return 0;
  297. }
  298. static int rt5033_charger_set_otg(struct rt5033_charger *charger)
  299. {
  300. int ret;
  301. mutex_lock(&charger->lock);
  302. /* Set OTG boost v_out to 5 volts */
  303. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL2,
  304. RT5033_CHGCTRL2_CV_MASK,
  305. 0x37 << RT5033_CHGCTRL2_CV_SHIFT);
  306. if (ret) {
  307. dev_err(charger->dev, "Failed set OTG boost v_out\n");
  308. ret = -EINVAL;
  309. goto out_unlock;
  310. }
  311. /* Set operation mode to OTG */
  312. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL1,
  313. RT5033_CHGCTRL1_MODE_MASK, RT5033_BOOST_MODE);
  314. if (ret) {
  315. dev_err(charger->dev, "Failed to update OTG mode.\n");
  316. ret = -EINVAL;
  317. goto out_unlock;
  318. }
  319. /* In case someone switched from charging to OTG directly */
  320. if (charger->online)
  321. charger->online = false;
  322. charger->otg = true;
  323. out_unlock:
  324. mutex_unlock(&charger->lock);
  325. return ret;
  326. }
  327. static int rt5033_charger_unset_otg(struct rt5033_charger *charger)
  328. {
  329. int ret;
  330. u8 data;
  331. /* Restore constant voltage for charging */
  332. data = charger->cv_regval;
  333. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL2,
  334. RT5033_CHGCTRL2_CV_MASK,
  335. data << RT5033_CHGCTRL2_CV_SHIFT);
  336. if (ret) {
  337. dev_err(charger->dev, "Failed to restore constant voltage\n");
  338. return -EINVAL;
  339. }
  340. /* Set operation mode to charging */
  341. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL1,
  342. RT5033_CHGCTRL1_MODE_MASK, RT5033_CHARGER_MODE);
  343. if (ret) {
  344. dev_err(charger->dev, "Failed to update charger mode.\n");
  345. return -EINVAL;
  346. }
  347. charger->otg = false;
  348. return 0;
  349. }
  350. static int rt5033_charger_set_charging(struct rt5033_charger *charger)
  351. {
  352. int ret;
  353. mutex_lock(&charger->lock);
  354. /* In case someone switched from OTG to charging directly */
  355. if (charger->otg) {
  356. ret = rt5033_charger_unset_otg(charger);
  357. if (ret) {
  358. mutex_unlock(&charger->lock);
  359. return -EINVAL;
  360. }
  361. }
  362. charger->online = true;
  363. mutex_unlock(&charger->lock);
  364. return 0;
  365. }
  366. static int rt5033_charger_set_mivr(struct rt5033_charger *charger)
  367. {
  368. int ret;
  369. mutex_lock(&charger->lock);
  370. /*
  371. * When connected via USB connector type SDP (Standard Downstream Port),
  372. * the minimum input voltage regulation (MIVR) should be enabled. It
  373. * prevents an input voltage drop due to insufficient current provided
  374. * by the adapter or USB input. As a downside, it may reduces the
  375. * charging current and thus slows the charging.
  376. */
  377. ret = regmap_update_bits(charger->regmap, RT5033_REG_CHG_CTRL4,
  378. RT5033_CHGCTRL4_MIVR_MASK, RT5033_CHARGER_MIVR_4600MV);
  379. if (ret) {
  380. dev_err(charger->dev, "Failed to set MIVR level.\n");
  381. mutex_unlock(&charger->lock);
  382. return -EINVAL;
  383. }
  384. charger->mivr_enabled = true;
  385. mutex_unlock(&charger->lock);
  386. /* Beyond this, do the same steps like setting charging */
  387. rt5033_charger_set_charging(charger);
  388. return 0;
  389. }
  390. static int rt5033_charger_set_disconnect(struct rt5033_charger *charger)
  391. {
  392. int ret = 0;
  393. mutex_lock(&charger->lock);
  394. /* Disable MIVR if enabled */
  395. if (charger->mivr_enabled) {
  396. ret = regmap_update_bits(charger->regmap,
  397. RT5033_REG_CHG_CTRL4,
  398. RT5033_CHGCTRL4_MIVR_MASK,
  399. RT5033_CHARGER_MIVR_DISABLE);
  400. if (ret) {
  401. dev_err(charger->dev, "Failed to disable MIVR.\n");
  402. ret = -EINVAL;
  403. goto out_unlock;
  404. }
  405. charger->mivr_enabled = false;
  406. }
  407. if (charger->otg) {
  408. ret = rt5033_charger_unset_otg(charger);
  409. if (ret) {
  410. ret = -EINVAL;
  411. goto out_unlock;
  412. }
  413. }
  414. if (charger->online)
  415. charger->online = false;
  416. out_unlock:
  417. mutex_unlock(&charger->lock);
  418. return ret;
  419. }
  420. static enum power_supply_property rt5033_charger_props[] = {
  421. POWER_SUPPLY_PROP_STATUS,
  422. POWER_SUPPLY_PROP_CHARGE_TYPE,
  423. POWER_SUPPLY_PROP_CURRENT_MAX,
  424. POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE,
  425. POWER_SUPPLY_PROP_MODEL_NAME,
  426. POWER_SUPPLY_PROP_MANUFACTURER,
  427. POWER_SUPPLY_PROP_ONLINE,
  428. };
  429. static int rt5033_charger_get_property(struct power_supply *psy,
  430. enum power_supply_property psp,
  431. union power_supply_propval *val)
  432. {
  433. struct rt5033_charger *charger = power_supply_get_drvdata(psy);
  434. switch (psp) {
  435. case POWER_SUPPLY_PROP_STATUS:
  436. val->intval = rt5033_get_charger_state(charger);
  437. break;
  438. case POWER_SUPPLY_PROP_CHARGE_TYPE:
  439. val->intval = rt5033_get_charger_type(charger);
  440. break;
  441. case POWER_SUPPLY_PROP_CURRENT_MAX:
  442. val->intval = rt5033_get_charger_current_limit(charger);
  443. break;
  444. case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
  445. val->intval = rt5033_get_charger_const_voltage(charger);
  446. break;
  447. case POWER_SUPPLY_PROP_MODEL_NAME:
  448. val->strval = RT5033_CHARGER_MODEL;
  449. break;
  450. case POWER_SUPPLY_PROP_MANUFACTURER:
  451. val->strval = RT5033_MANUFACTURER;
  452. break;
  453. case POWER_SUPPLY_PROP_ONLINE:
  454. val->intval = charger->online;
  455. break;
  456. default:
  457. return -EINVAL;
  458. }
  459. return 0;
  460. }
  461. static int rt5033_charger_dt_init(struct rt5033_charger *charger)
  462. {
  463. struct rt5033_charger_data *chg = &charger->chg;
  464. struct power_supply_battery_info *info;
  465. int ret;
  466. ret = power_supply_get_battery_info(charger->psy, &info);
  467. if (ret)
  468. return dev_err_probe(charger->dev, -EINVAL,
  469. "missing battery info\n");
  470. /* Assign data. Validity will be checked in the init functions. */
  471. chg->pre_uamp = info->precharge_current_ua;
  472. chg->fast_uamp = info->constant_charge_current_max_ua;
  473. chg->eoc_uamp = info->charge_term_current_ua;
  474. chg->pre_uvolt = info->precharge_voltage_max_uv;
  475. chg->const_uvolt = info->constant_charge_voltage_max_uv;
  476. return 0;
  477. }
  478. static void rt5033_charger_extcon_work(struct work_struct *work)
  479. {
  480. struct rt5033_charger *charger =
  481. container_of(work, struct rt5033_charger, extcon_work);
  482. struct extcon_dev *edev = charger->edev;
  483. int connector, state;
  484. int ret;
  485. for (connector = EXTCON_USB_HOST; connector <= EXTCON_CHG_USB_PD;
  486. connector++) {
  487. state = extcon_get_state(edev, connector);
  488. if (state == 1)
  489. break;
  490. }
  491. /*
  492. * Adding a delay between extcon notification and extcon action. This
  493. * makes extcon action execution more reliable. Without the delay the
  494. * execution sometimes fails, possibly because the chip is busy or not
  495. * ready.
  496. */
  497. msleep(100);
  498. switch (connector) {
  499. case EXTCON_CHG_USB_SDP:
  500. ret = rt5033_charger_set_mivr(charger);
  501. if (ret) {
  502. dev_err(charger->dev, "failed to set USB mode\n");
  503. break;
  504. }
  505. dev_info(charger->dev, "USB mode. connector type: %d\n",
  506. connector);
  507. break;
  508. case EXTCON_CHG_USB_DCP:
  509. case EXTCON_CHG_USB_CDP:
  510. case EXTCON_CHG_USB_ACA:
  511. case EXTCON_CHG_USB_FAST:
  512. case EXTCON_CHG_USB_SLOW:
  513. case EXTCON_CHG_WPT:
  514. case EXTCON_CHG_USB_PD:
  515. ret = rt5033_charger_set_charging(charger);
  516. if (ret) {
  517. dev_err(charger->dev, "failed to set charging\n");
  518. break;
  519. }
  520. dev_info(charger->dev, "charging. connector type: %d\n",
  521. connector);
  522. break;
  523. case EXTCON_USB_HOST:
  524. ret = rt5033_charger_set_otg(charger);
  525. if (ret) {
  526. dev_err(charger->dev, "failed to set OTG\n");
  527. break;
  528. }
  529. dev_info(charger->dev, "OTG enabled\n");
  530. break;
  531. default:
  532. ret = rt5033_charger_set_disconnect(charger);
  533. if (ret) {
  534. dev_err(charger->dev, "failed to set disconnect\n");
  535. break;
  536. }
  537. dev_info(charger->dev, "disconnected\n");
  538. break;
  539. }
  540. power_supply_changed(charger->psy);
  541. }
  542. static int rt5033_charger_extcon_notifier(struct notifier_block *nb,
  543. unsigned long event, void *param)
  544. {
  545. struct rt5033_charger *charger =
  546. container_of(nb, struct rt5033_charger, extcon_nb);
  547. schedule_work(&charger->extcon_work);
  548. return NOTIFY_OK;
  549. }
  550. static const struct power_supply_desc rt5033_charger_desc = {
  551. .name = "rt5033-charger",
  552. .type = POWER_SUPPLY_TYPE_USB,
  553. .properties = rt5033_charger_props,
  554. .num_properties = ARRAY_SIZE(rt5033_charger_props),
  555. .get_property = rt5033_charger_get_property,
  556. };
  557. static int rt5033_charger_probe(struct platform_device *pdev)
  558. {
  559. struct rt5033_charger *charger;
  560. struct power_supply_config psy_cfg = {};
  561. struct device_node *np_conn, *np_edev;
  562. int ret;
  563. charger = devm_kzalloc(&pdev->dev, sizeof(*charger), GFP_KERNEL);
  564. if (!charger)
  565. return -ENOMEM;
  566. platform_set_drvdata(pdev, charger);
  567. charger->dev = &pdev->dev;
  568. charger->regmap = dev_get_regmap(pdev->dev.parent, NULL);
  569. mutex_init(&charger->lock);
  570. psy_cfg.of_node = pdev->dev.of_node;
  571. psy_cfg.drv_data = charger;
  572. charger->psy = devm_power_supply_register(charger->dev,
  573. &rt5033_charger_desc,
  574. &psy_cfg);
  575. if (IS_ERR(charger->psy))
  576. return dev_err_probe(charger->dev, PTR_ERR(charger->psy),
  577. "Failed to register power supply\n");
  578. ret = rt5033_charger_dt_init(charger);
  579. if (ret)
  580. return ret;
  581. ret = rt5033_charger_reg_init(charger);
  582. if (ret)
  583. return ret;
  584. /*
  585. * Extcon support is not vital for the charger to work. If no extcon
  586. * is available, just emit a warning and leave the probe function.
  587. */
  588. np_conn = of_parse_phandle(pdev->dev.of_node, "richtek,usb-connector", 0);
  589. np_edev = of_get_parent(np_conn);
  590. charger->edev = extcon_find_edev_by_node(np_edev);
  591. if (IS_ERR(charger->edev)) {
  592. dev_warn(charger->dev, "no extcon device found in device-tree\n");
  593. goto out;
  594. }
  595. ret = devm_work_autocancel(charger->dev, &charger->extcon_work,
  596. rt5033_charger_extcon_work);
  597. if (ret) {
  598. dev_err(charger->dev, "failed to initialize extcon work\n");
  599. return ret;
  600. }
  601. charger->extcon_nb.notifier_call = rt5033_charger_extcon_notifier;
  602. ret = devm_extcon_register_notifier_all(charger->dev, charger->edev,
  603. &charger->extcon_nb);
  604. if (ret) {
  605. dev_err(charger->dev, "failed to register extcon notifier\n");
  606. return ret;
  607. }
  608. out:
  609. return 0;
  610. }
  611. static const struct platform_device_id rt5033_charger_id[] = {
  612. { "rt5033-charger", },
  613. { }
  614. };
  615. MODULE_DEVICE_TABLE(platform, rt5033_charger_id);
  616. static const struct of_device_id rt5033_charger_of_match[] = {
  617. { .compatible = "richtek,rt5033-charger", },
  618. { }
  619. };
  620. MODULE_DEVICE_TABLE(of, rt5033_charger_of_match);
  621. static struct platform_driver rt5033_charger_driver = {
  622. .driver = {
  623. .name = "rt5033-charger",
  624. .of_match_table = rt5033_charger_of_match,
  625. },
  626. .probe = rt5033_charger_probe,
  627. .id_table = rt5033_charger_id,
  628. };
  629. module_platform_driver(rt5033_charger_driver);
  630. MODULE_DESCRIPTION("Richtek RT5033 charger driver");
  631. MODULE_AUTHOR("Beomho Seo <beomho.seo@samsung.com>");
  632. MODULE_LICENSE("GPL v2");