tosa_battery.c 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Battery and Power Management code for the Sharp SL-6000x
  4. *
  5. * Copyright (c) 2005 Dirk Opfer
  6. * Copyright (c) 2008 Dmitry Baryshkov
  7. */
  8. #include <linux/kernel.h>
  9. #include <linux/module.h>
  10. #include <linux/power_supply.h>
  11. #include <linux/wm97xx.h>
  12. #include <linux/delay.h>
  13. #include <linux/spinlock.h>
  14. #include <linux/interrupt.h>
  15. #include <linux/gpio.h>
  16. #include <asm/mach-types.h>
  17. #include <mach/tosa.h>
  18. static DEFINE_MUTEX(bat_lock); /* protects gpio pins */
  19. static struct work_struct bat_work;
  20. struct tosa_bat {
  21. int status;
  22. struct power_supply *psy;
  23. int full_chrg;
  24. struct mutex work_lock; /* protects data */
  25. bool (*is_present)(struct tosa_bat *bat);
  26. int gpio_full;
  27. int gpio_charge_off;
  28. int technology;
  29. int gpio_bat;
  30. int adc_bat;
  31. int adc_bat_divider;
  32. int bat_max;
  33. int bat_min;
  34. int gpio_temp;
  35. int adc_temp;
  36. int adc_temp_divider;
  37. };
  38. static struct tosa_bat tosa_bat_main;
  39. static struct tosa_bat tosa_bat_jacket;
  40. static unsigned long tosa_read_bat(struct tosa_bat *bat)
  41. {
  42. unsigned long value = 0;
  43. if (bat->gpio_bat < 0 || bat->adc_bat < 0)
  44. return 0;
  45. mutex_lock(&bat_lock);
  46. gpio_set_value(bat->gpio_bat, 1);
  47. msleep(5);
  48. value = wm97xx_read_aux_adc(dev_get_drvdata(bat->psy->dev.parent),
  49. bat->adc_bat);
  50. gpio_set_value(bat->gpio_bat, 0);
  51. mutex_unlock(&bat_lock);
  52. value = value * 1000000 / bat->adc_bat_divider;
  53. return value;
  54. }
  55. static unsigned long tosa_read_temp(struct tosa_bat *bat)
  56. {
  57. unsigned long value = 0;
  58. if (bat->gpio_temp < 0 || bat->adc_temp < 0)
  59. return 0;
  60. mutex_lock(&bat_lock);
  61. gpio_set_value(bat->gpio_temp, 1);
  62. msleep(5);
  63. value = wm97xx_read_aux_adc(dev_get_drvdata(bat->psy->dev.parent),
  64. bat->adc_temp);
  65. gpio_set_value(bat->gpio_temp, 0);
  66. mutex_unlock(&bat_lock);
  67. value = value * 10000 / bat->adc_temp_divider;
  68. return value;
  69. }
  70. static int tosa_bat_get_property(struct power_supply *psy,
  71. enum power_supply_property psp,
  72. union power_supply_propval *val)
  73. {
  74. int ret = 0;
  75. struct tosa_bat *bat = power_supply_get_drvdata(psy);
  76. if (bat->is_present && !bat->is_present(bat)
  77. && psp != POWER_SUPPLY_PROP_PRESENT) {
  78. return -ENODEV;
  79. }
  80. switch (psp) {
  81. case POWER_SUPPLY_PROP_STATUS:
  82. val->intval = bat->status;
  83. break;
  84. case POWER_SUPPLY_PROP_TECHNOLOGY:
  85. val->intval = bat->technology;
  86. break;
  87. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  88. val->intval = tosa_read_bat(bat);
  89. break;
  90. case POWER_SUPPLY_PROP_VOLTAGE_MAX:
  91. if (bat->full_chrg == -1)
  92. val->intval = bat->bat_max;
  93. else
  94. val->intval = bat->full_chrg;
  95. break;
  96. case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
  97. val->intval = bat->bat_max;
  98. break;
  99. case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
  100. val->intval = bat->bat_min;
  101. break;
  102. case POWER_SUPPLY_PROP_TEMP:
  103. val->intval = tosa_read_temp(bat);
  104. break;
  105. case POWER_SUPPLY_PROP_PRESENT:
  106. val->intval = bat->is_present ? bat->is_present(bat) : 1;
  107. break;
  108. default:
  109. ret = -EINVAL;
  110. break;
  111. }
  112. return ret;
  113. }
  114. static bool tosa_jacket_bat_is_present(struct tosa_bat *bat)
  115. {
  116. return gpio_get_value(TOSA_GPIO_JACKET_DETECT) == 0;
  117. }
  118. static void tosa_bat_external_power_changed(struct power_supply *psy)
  119. {
  120. schedule_work(&bat_work);
  121. }
  122. static irqreturn_t tosa_bat_gpio_isr(int irq, void *data)
  123. {
  124. pr_info("tosa_bat_gpio irq\n");
  125. schedule_work(&bat_work);
  126. return IRQ_HANDLED;
  127. }
  128. static void tosa_bat_update(struct tosa_bat *bat)
  129. {
  130. int old;
  131. struct power_supply *psy = bat->psy;
  132. mutex_lock(&bat->work_lock);
  133. old = bat->status;
  134. if (bat->is_present && !bat->is_present(bat)) {
  135. printk(KERN_NOTICE "%s not present\n", psy->desc->name);
  136. bat->status = POWER_SUPPLY_STATUS_UNKNOWN;
  137. bat->full_chrg = -1;
  138. } else if (power_supply_am_i_supplied(psy)) {
  139. if (bat->status == POWER_SUPPLY_STATUS_DISCHARGING) {
  140. gpio_set_value(bat->gpio_charge_off, 0);
  141. mdelay(15);
  142. }
  143. if (gpio_get_value(bat->gpio_full)) {
  144. if (old == POWER_SUPPLY_STATUS_CHARGING ||
  145. bat->full_chrg == -1)
  146. bat->full_chrg = tosa_read_bat(bat);
  147. gpio_set_value(bat->gpio_charge_off, 1);
  148. bat->status = POWER_SUPPLY_STATUS_FULL;
  149. } else {
  150. gpio_set_value(bat->gpio_charge_off, 0);
  151. bat->status = POWER_SUPPLY_STATUS_CHARGING;
  152. }
  153. } else {
  154. gpio_set_value(bat->gpio_charge_off, 1);
  155. bat->status = POWER_SUPPLY_STATUS_DISCHARGING;
  156. }
  157. if (old != bat->status)
  158. power_supply_changed(psy);
  159. mutex_unlock(&bat->work_lock);
  160. }
  161. static void tosa_bat_work(struct work_struct *work)
  162. {
  163. tosa_bat_update(&tosa_bat_main);
  164. tosa_bat_update(&tosa_bat_jacket);
  165. }
  166. static enum power_supply_property tosa_bat_main_props[] = {
  167. POWER_SUPPLY_PROP_STATUS,
  168. POWER_SUPPLY_PROP_TECHNOLOGY,
  169. POWER_SUPPLY_PROP_VOLTAGE_NOW,
  170. POWER_SUPPLY_PROP_VOLTAGE_MAX,
  171. POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
  172. POWER_SUPPLY_PROP_TEMP,
  173. POWER_SUPPLY_PROP_PRESENT,
  174. };
  175. static enum power_supply_property tosa_bat_bu_props[] = {
  176. POWER_SUPPLY_PROP_STATUS,
  177. POWER_SUPPLY_PROP_TECHNOLOGY,
  178. POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
  179. POWER_SUPPLY_PROP_VOLTAGE_NOW,
  180. POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
  181. POWER_SUPPLY_PROP_PRESENT,
  182. };
  183. static const struct power_supply_desc tosa_bat_main_desc = {
  184. .name = "main-battery",
  185. .type = POWER_SUPPLY_TYPE_BATTERY,
  186. .properties = tosa_bat_main_props,
  187. .num_properties = ARRAY_SIZE(tosa_bat_main_props),
  188. .get_property = tosa_bat_get_property,
  189. .external_power_changed = tosa_bat_external_power_changed,
  190. .use_for_apm = 1,
  191. };
  192. static const struct power_supply_desc tosa_bat_jacket_desc = {
  193. .name = "jacket-battery",
  194. .type = POWER_SUPPLY_TYPE_BATTERY,
  195. .properties = tosa_bat_main_props,
  196. .num_properties = ARRAY_SIZE(tosa_bat_main_props),
  197. .get_property = tosa_bat_get_property,
  198. .external_power_changed = tosa_bat_external_power_changed,
  199. };
  200. static const struct power_supply_desc tosa_bat_bu_desc = {
  201. .name = "backup-battery",
  202. .type = POWER_SUPPLY_TYPE_BATTERY,
  203. .properties = tosa_bat_bu_props,
  204. .num_properties = ARRAY_SIZE(tosa_bat_bu_props),
  205. .get_property = tosa_bat_get_property,
  206. .external_power_changed = tosa_bat_external_power_changed,
  207. };
  208. static struct tosa_bat tosa_bat_main = {
  209. .status = POWER_SUPPLY_STATUS_DISCHARGING,
  210. .full_chrg = -1,
  211. .psy = NULL,
  212. .gpio_full = TOSA_GPIO_BAT0_CRG,
  213. .gpio_charge_off = TOSA_GPIO_CHARGE_OFF,
  214. .technology = POWER_SUPPLY_TECHNOLOGY_LIPO,
  215. .gpio_bat = TOSA_GPIO_BAT0_V_ON,
  216. .adc_bat = WM97XX_AUX_ID3,
  217. .adc_bat_divider = 414,
  218. .bat_max = 4310000,
  219. .bat_min = 1551 * 1000000 / 414,
  220. .gpio_temp = TOSA_GPIO_BAT1_TH_ON,
  221. .adc_temp = WM97XX_AUX_ID2,
  222. .adc_temp_divider = 10000,
  223. };
  224. static struct tosa_bat tosa_bat_jacket = {
  225. .status = POWER_SUPPLY_STATUS_DISCHARGING,
  226. .full_chrg = -1,
  227. .psy = NULL,
  228. .is_present = tosa_jacket_bat_is_present,
  229. .gpio_full = TOSA_GPIO_BAT1_CRG,
  230. .gpio_charge_off = TOSA_GPIO_CHARGE_OFF_JC,
  231. .technology = POWER_SUPPLY_TECHNOLOGY_LIPO,
  232. .gpio_bat = TOSA_GPIO_BAT1_V_ON,
  233. .adc_bat = WM97XX_AUX_ID3,
  234. .adc_bat_divider = 414,
  235. .bat_max = 4310000,
  236. .bat_min = 1551 * 1000000 / 414,
  237. .gpio_temp = TOSA_GPIO_BAT0_TH_ON,
  238. .adc_temp = WM97XX_AUX_ID2,
  239. .adc_temp_divider = 10000,
  240. };
  241. static struct tosa_bat tosa_bat_bu = {
  242. .status = POWER_SUPPLY_STATUS_UNKNOWN,
  243. .full_chrg = -1,
  244. .psy = NULL,
  245. .gpio_full = -1,
  246. .gpio_charge_off = -1,
  247. .technology = POWER_SUPPLY_TECHNOLOGY_LiMn,
  248. .gpio_bat = TOSA_GPIO_BU_CHRG_ON,
  249. .adc_bat = WM97XX_AUX_ID4,
  250. .adc_bat_divider = 1266,
  251. .gpio_temp = -1,
  252. .adc_temp = -1,
  253. .adc_temp_divider = -1,
  254. };
  255. static struct gpio tosa_bat_gpios[] = {
  256. { TOSA_GPIO_CHARGE_OFF, GPIOF_OUT_INIT_HIGH, "main charge off" },
  257. { TOSA_GPIO_CHARGE_OFF_JC, GPIOF_OUT_INIT_HIGH, "jacket charge off" },
  258. { TOSA_GPIO_BAT_SW_ON, GPIOF_OUT_INIT_LOW, "battery switch" },
  259. { TOSA_GPIO_BAT0_V_ON, GPIOF_OUT_INIT_LOW, "main battery" },
  260. { TOSA_GPIO_BAT1_V_ON, GPIOF_OUT_INIT_LOW, "jacket battery" },
  261. { TOSA_GPIO_BAT1_TH_ON, GPIOF_OUT_INIT_LOW, "main battery temp" },
  262. { TOSA_GPIO_BAT0_TH_ON, GPIOF_OUT_INIT_LOW, "jacket battery temp" },
  263. { TOSA_GPIO_BU_CHRG_ON, GPIOF_OUT_INIT_LOW, "backup battery" },
  264. { TOSA_GPIO_BAT0_CRG, GPIOF_IN, "main battery full" },
  265. { TOSA_GPIO_BAT1_CRG, GPIOF_IN, "jacket battery full" },
  266. { TOSA_GPIO_BAT0_LOW, GPIOF_IN, "main battery low" },
  267. { TOSA_GPIO_BAT1_LOW, GPIOF_IN, "jacket battery low" },
  268. { TOSA_GPIO_JACKET_DETECT, GPIOF_IN, "jacket detect" },
  269. };
  270. #ifdef CONFIG_PM
  271. static int tosa_bat_suspend(struct platform_device *dev, pm_message_t state)
  272. {
  273. /* flush all pending status updates */
  274. flush_work(&bat_work);
  275. return 0;
  276. }
  277. static int tosa_bat_resume(struct platform_device *dev)
  278. {
  279. /* things may have changed while we were away */
  280. schedule_work(&bat_work);
  281. return 0;
  282. }
  283. #else
  284. #define tosa_bat_suspend NULL
  285. #define tosa_bat_resume NULL
  286. #endif
  287. static int tosa_bat_probe(struct platform_device *dev)
  288. {
  289. int ret;
  290. struct power_supply_config main_psy_cfg = {},
  291. jacket_psy_cfg = {},
  292. bu_psy_cfg = {};
  293. if (!machine_is_tosa())
  294. return -ENODEV;
  295. ret = gpio_request_array(tosa_bat_gpios, ARRAY_SIZE(tosa_bat_gpios));
  296. if (ret)
  297. return ret;
  298. mutex_init(&tosa_bat_main.work_lock);
  299. mutex_init(&tosa_bat_jacket.work_lock);
  300. INIT_WORK(&bat_work, tosa_bat_work);
  301. main_psy_cfg.drv_data = &tosa_bat_main;
  302. tosa_bat_main.psy = power_supply_register(&dev->dev,
  303. &tosa_bat_main_desc,
  304. &main_psy_cfg);
  305. if (IS_ERR(tosa_bat_main.psy)) {
  306. ret = PTR_ERR(tosa_bat_main.psy);
  307. goto err_psy_reg_main;
  308. }
  309. jacket_psy_cfg.drv_data = &tosa_bat_jacket;
  310. tosa_bat_jacket.psy = power_supply_register(&dev->dev,
  311. &tosa_bat_jacket_desc,
  312. &jacket_psy_cfg);
  313. if (IS_ERR(tosa_bat_jacket.psy)) {
  314. ret = PTR_ERR(tosa_bat_jacket.psy);
  315. goto err_psy_reg_jacket;
  316. }
  317. bu_psy_cfg.drv_data = &tosa_bat_bu;
  318. tosa_bat_bu.psy = power_supply_register(&dev->dev, &tosa_bat_bu_desc,
  319. &bu_psy_cfg);
  320. if (IS_ERR(tosa_bat_bu.psy)) {
  321. ret = PTR_ERR(tosa_bat_bu.psy);
  322. goto err_psy_reg_bu;
  323. }
  324. ret = request_irq(gpio_to_irq(TOSA_GPIO_BAT0_CRG),
  325. tosa_bat_gpio_isr,
  326. IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
  327. "main full", &tosa_bat_main);
  328. if (ret)
  329. goto err_req_main;
  330. ret = request_irq(gpio_to_irq(TOSA_GPIO_BAT1_CRG),
  331. tosa_bat_gpio_isr,
  332. IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
  333. "jacket full", &tosa_bat_jacket);
  334. if (ret)
  335. goto err_req_jacket;
  336. ret = request_irq(gpio_to_irq(TOSA_GPIO_JACKET_DETECT),
  337. tosa_bat_gpio_isr,
  338. IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
  339. "jacket detect", &tosa_bat_jacket);
  340. if (!ret) {
  341. schedule_work(&bat_work);
  342. return 0;
  343. }
  344. free_irq(gpio_to_irq(TOSA_GPIO_BAT1_CRG), &tosa_bat_jacket);
  345. err_req_jacket:
  346. free_irq(gpio_to_irq(TOSA_GPIO_BAT0_CRG), &tosa_bat_main);
  347. err_req_main:
  348. power_supply_unregister(tosa_bat_bu.psy);
  349. err_psy_reg_bu:
  350. power_supply_unregister(tosa_bat_jacket.psy);
  351. err_psy_reg_jacket:
  352. power_supply_unregister(tosa_bat_main.psy);
  353. err_psy_reg_main:
  354. /* see comment in tosa_bat_remove */
  355. cancel_work_sync(&bat_work);
  356. gpio_free_array(tosa_bat_gpios, ARRAY_SIZE(tosa_bat_gpios));
  357. return ret;
  358. }
  359. static int tosa_bat_remove(struct platform_device *dev)
  360. {
  361. free_irq(gpio_to_irq(TOSA_GPIO_JACKET_DETECT), &tosa_bat_jacket);
  362. free_irq(gpio_to_irq(TOSA_GPIO_BAT1_CRG), &tosa_bat_jacket);
  363. free_irq(gpio_to_irq(TOSA_GPIO_BAT0_CRG), &tosa_bat_main);
  364. power_supply_unregister(tosa_bat_bu.psy);
  365. power_supply_unregister(tosa_bat_jacket.psy);
  366. power_supply_unregister(tosa_bat_main.psy);
  367. /*
  368. * Now cancel the bat_work. We won't get any more schedules,
  369. * since all sources (isr and external_power_changed) are
  370. * unregistered now.
  371. */
  372. cancel_work_sync(&bat_work);
  373. gpio_free_array(tosa_bat_gpios, ARRAY_SIZE(tosa_bat_gpios));
  374. return 0;
  375. }
  376. static struct platform_driver tosa_bat_driver = {
  377. .driver.name = "wm97xx-battery",
  378. .driver.owner = THIS_MODULE,
  379. .probe = tosa_bat_probe,
  380. .remove = tosa_bat_remove,
  381. .suspend = tosa_bat_suspend,
  382. .resume = tosa_bat_resume,
  383. };
  384. module_platform_driver(tosa_bat_driver);
  385. MODULE_LICENSE("GPL");
  386. MODULE_AUTHOR("Dmitry Baryshkov");
  387. MODULE_DESCRIPTION("Tosa battery driver");
  388. MODULE_ALIAS("platform:wm97xx-battery");