palmas.c 15 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625
  1. /*
  2. * TI Palmas MFD Driver
  3. *
  4. * Copyright 2011-2012 Texas Instruments Inc.
  5. *
  6. * Author: Graeme Gregory <gg@slimlogic.co.uk>
  7. *
  8. * This program is free software; you can redistribute it and/or modify it
  9. * under the terms of the GNU General Public License as published by the
  10. * Free Software Foundation; either version 2 of the License, or (at your
  11. * option) any later version.
  12. *
  13. */
  14. #include <linux/module.h>
  15. #include <linux/moduleparam.h>
  16. #include <linux/init.h>
  17. #include <linux/slab.h>
  18. #include <linux/i2c.h>
  19. #include <linux/interrupt.h>
  20. #include <linux/irq.h>
  21. #include <linux/regmap.h>
  22. #include <linux/err.h>
  23. #include <linux/mfd/core.h>
  24. #include <linux/mfd/palmas.h>
  25. #include <linux/of_device.h>
  26. #define PALMAS_EXT_REQ (PALMAS_EXT_CONTROL_ENABLE1 | \
  27. PALMAS_EXT_CONTROL_ENABLE2 | \
  28. PALMAS_EXT_CONTROL_NSLEEP)
  29. struct palmas_sleep_requestor_info {
  30. int id;
  31. int reg_offset;
  32. int bit_pos;
  33. };
  34. #define EXTERNAL_REQUESTOR(_id, _offset, _pos) \
  35. [PALMAS_EXTERNAL_REQSTR_ID_##_id] = { \
  36. .id = PALMAS_EXTERNAL_REQSTR_ID_##_id, \
  37. .reg_offset = _offset, \
  38. .bit_pos = _pos, \
  39. }
  40. static struct palmas_sleep_requestor_info sleep_req_info[] = {
  41. EXTERNAL_REQUESTOR(REGEN1, 0, 0),
  42. EXTERNAL_REQUESTOR(REGEN2, 0, 1),
  43. EXTERNAL_REQUESTOR(SYSEN1, 0, 2),
  44. EXTERNAL_REQUESTOR(SYSEN2, 0, 3),
  45. EXTERNAL_REQUESTOR(CLK32KG, 0, 4),
  46. EXTERNAL_REQUESTOR(CLK32KGAUDIO, 0, 5),
  47. EXTERNAL_REQUESTOR(REGEN3, 0, 6),
  48. EXTERNAL_REQUESTOR(SMPS12, 1, 0),
  49. EXTERNAL_REQUESTOR(SMPS3, 1, 1),
  50. EXTERNAL_REQUESTOR(SMPS45, 1, 2),
  51. EXTERNAL_REQUESTOR(SMPS6, 1, 3),
  52. EXTERNAL_REQUESTOR(SMPS7, 1, 4),
  53. EXTERNAL_REQUESTOR(SMPS8, 1, 5),
  54. EXTERNAL_REQUESTOR(SMPS9, 1, 6),
  55. EXTERNAL_REQUESTOR(SMPS10, 1, 7),
  56. EXTERNAL_REQUESTOR(LDO1, 2, 0),
  57. EXTERNAL_REQUESTOR(LDO2, 2, 1),
  58. EXTERNAL_REQUESTOR(LDO3, 2, 2),
  59. EXTERNAL_REQUESTOR(LDO4, 2, 3),
  60. EXTERNAL_REQUESTOR(LDO5, 2, 4),
  61. EXTERNAL_REQUESTOR(LDO6, 2, 5),
  62. EXTERNAL_REQUESTOR(LDO7, 2, 6),
  63. EXTERNAL_REQUESTOR(LDO8, 2, 7),
  64. EXTERNAL_REQUESTOR(LDO9, 3, 0),
  65. EXTERNAL_REQUESTOR(LDOLN, 3, 1),
  66. EXTERNAL_REQUESTOR(LDOUSB, 3, 2),
  67. };
  68. static const struct regmap_config palmas_regmap_config[PALMAS_NUM_CLIENTS] = {
  69. {
  70. .reg_bits = 8,
  71. .val_bits = 8,
  72. .max_register = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE,
  73. PALMAS_PRIMARY_SECONDARY_PAD3),
  74. },
  75. {
  76. .reg_bits = 8,
  77. .val_bits = 8,
  78. .max_register = PALMAS_BASE_TO_REG(PALMAS_GPADC_BASE,
  79. PALMAS_GPADC_SMPS_VSEL_MONITORING),
  80. },
  81. {
  82. .reg_bits = 8,
  83. .val_bits = 8,
  84. .max_register = PALMAS_BASE_TO_REG(PALMAS_TRIM_GPADC_BASE,
  85. PALMAS_GPADC_TRIM16),
  86. },
  87. };
  88. static const struct regmap_irq palmas_irqs[] = {
  89. /* INT1 IRQs */
  90. [PALMAS_CHARG_DET_N_VBUS_OVV_IRQ] = {
  91. .mask = PALMAS_INT1_STATUS_CHARG_DET_N_VBUS_OVV,
  92. },
  93. [PALMAS_PWRON_IRQ] = {
  94. .mask = PALMAS_INT1_STATUS_PWRON,
  95. },
  96. [PALMAS_LONG_PRESS_KEY_IRQ] = {
  97. .mask = PALMAS_INT1_STATUS_LONG_PRESS_KEY,
  98. },
  99. [PALMAS_RPWRON_IRQ] = {
  100. .mask = PALMAS_INT1_STATUS_RPWRON,
  101. },
  102. [PALMAS_PWRDOWN_IRQ] = {
  103. .mask = PALMAS_INT1_STATUS_PWRDOWN,
  104. },
  105. [PALMAS_HOTDIE_IRQ] = {
  106. .mask = PALMAS_INT1_STATUS_HOTDIE,
  107. },
  108. [PALMAS_VSYS_MON_IRQ] = {
  109. .mask = PALMAS_INT1_STATUS_VSYS_MON,
  110. },
  111. [PALMAS_VBAT_MON_IRQ] = {
  112. .mask = PALMAS_INT1_STATUS_VBAT_MON,
  113. },
  114. /* INT2 IRQs*/
  115. [PALMAS_RTC_ALARM_IRQ] = {
  116. .mask = PALMAS_INT2_STATUS_RTC_ALARM,
  117. .reg_offset = 1,
  118. },
  119. [PALMAS_RTC_TIMER_IRQ] = {
  120. .mask = PALMAS_INT2_STATUS_RTC_TIMER,
  121. .reg_offset = 1,
  122. },
  123. [PALMAS_WDT_IRQ] = {
  124. .mask = PALMAS_INT2_STATUS_WDT,
  125. .reg_offset = 1,
  126. },
  127. [PALMAS_BATREMOVAL_IRQ] = {
  128. .mask = PALMAS_INT2_STATUS_BATREMOVAL,
  129. .reg_offset = 1,
  130. },
  131. [PALMAS_RESET_IN_IRQ] = {
  132. .mask = PALMAS_INT2_STATUS_RESET_IN,
  133. .reg_offset = 1,
  134. },
  135. [PALMAS_FBI_BB_IRQ] = {
  136. .mask = PALMAS_INT2_STATUS_FBI_BB,
  137. .reg_offset = 1,
  138. },
  139. [PALMAS_SHORT_IRQ] = {
  140. .mask = PALMAS_INT2_STATUS_SHORT,
  141. .reg_offset = 1,
  142. },
  143. [PALMAS_VAC_ACOK_IRQ] = {
  144. .mask = PALMAS_INT2_STATUS_VAC_ACOK,
  145. .reg_offset = 1,
  146. },
  147. /* INT3 IRQs */
  148. [PALMAS_GPADC_AUTO_0_IRQ] = {
  149. .mask = PALMAS_INT3_STATUS_GPADC_AUTO_0,
  150. .reg_offset = 2,
  151. },
  152. [PALMAS_GPADC_AUTO_1_IRQ] = {
  153. .mask = PALMAS_INT3_STATUS_GPADC_AUTO_1,
  154. .reg_offset = 2,
  155. },
  156. [PALMAS_GPADC_EOC_SW_IRQ] = {
  157. .mask = PALMAS_INT3_STATUS_GPADC_EOC_SW,
  158. .reg_offset = 2,
  159. },
  160. [PALMAS_GPADC_EOC_RT_IRQ] = {
  161. .mask = PALMAS_INT3_STATUS_GPADC_EOC_RT,
  162. .reg_offset = 2,
  163. },
  164. [PALMAS_ID_OTG_IRQ] = {
  165. .mask = PALMAS_INT3_STATUS_ID_OTG,
  166. .reg_offset = 2,
  167. },
  168. [PALMAS_ID_IRQ] = {
  169. .mask = PALMAS_INT3_STATUS_ID,
  170. .reg_offset = 2,
  171. },
  172. [PALMAS_VBUS_OTG_IRQ] = {
  173. .mask = PALMAS_INT3_STATUS_VBUS_OTG,
  174. .reg_offset = 2,
  175. },
  176. [PALMAS_VBUS_IRQ] = {
  177. .mask = PALMAS_INT3_STATUS_VBUS,
  178. .reg_offset = 2,
  179. },
  180. /* INT4 IRQs */
  181. [PALMAS_GPIO_0_IRQ] = {
  182. .mask = PALMAS_INT4_STATUS_GPIO_0,
  183. .reg_offset = 3,
  184. },
  185. [PALMAS_GPIO_1_IRQ] = {
  186. .mask = PALMAS_INT4_STATUS_GPIO_1,
  187. .reg_offset = 3,
  188. },
  189. [PALMAS_GPIO_2_IRQ] = {
  190. .mask = PALMAS_INT4_STATUS_GPIO_2,
  191. .reg_offset = 3,
  192. },
  193. [PALMAS_GPIO_3_IRQ] = {
  194. .mask = PALMAS_INT4_STATUS_GPIO_3,
  195. .reg_offset = 3,
  196. },
  197. [PALMAS_GPIO_4_IRQ] = {
  198. .mask = PALMAS_INT4_STATUS_GPIO_4,
  199. .reg_offset = 3,
  200. },
  201. [PALMAS_GPIO_5_IRQ] = {
  202. .mask = PALMAS_INT4_STATUS_GPIO_5,
  203. .reg_offset = 3,
  204. },
  205. [PALMAS_GPIO_6_IRQ] = {
  206. .mask = PALMAS_INT4_STATUS_GPIO_6,
  207. .reg_offset = 3,
  208. },
  209. [PALMAS_GPIO_7_IRQ] = {
  210. .mask = PALMAS_INT4_STATUS_GPIO_7,
  211. .reg_offset = 3,
  212. },
  213. };
  214. static struct regmap_irq_chip palmas_irq_chip = {
  215. .name = "palmas",
  216. .irqs = palmas_irqs,
  217. .num_irqs = ARRAY_SIZE(palmas_irqs),
  218. .num_regs = 4,
  219. .irq_reg_stride = 5,
  220. .status_base = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE,
  221. PALMAS_INT1_STATUS),
  222. .mask_base = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE,
  223. PALMAS_INT1_MASK),
  224. };
  225. int palmas_ext_control_req_config(struct palmas *palmas,
  226. enum palmas_external_requestor_id id, int ext_ctrl, bool enable)
  227. {
  228. int preq_mask_bit = 0;
  229. int reg_add = 0;
  230. int bit_pos;
  231. int ret;
  232. if (!(ext_ctrl & PALMAS_EXT_REQ))
  233. return 0;
  234. if (id >= PALMAS_EXTERNAL_REQSTR_ID_MAX)
  235. return 0;
  236. if (ext_ctrl & PALMAS_EXT_CONTROL_NSLEEP) {
  237. reg_add = PALMAS_NSLEEP_RES_ASSIGN;
  238. preq_mask_bit = 0;
  239. } else if (ext_ctrl & PALMAS_EXT_CONTROL_ENABLE1) {
  240. reg_add = PALMAS_ENABLE1_RES_ASSIGN;
  241. preq_mask_bit = 1;
  242. } else if (ext_ctrl & PALMAS_EXT_CONTROL_ENABLE2) {
  243. reg_add = PALMAS_ENABLE2_RES_ASSIGN;
  244. preq_mask_bit = 2;
  245. }
  246. bit_pos = sleep_req_info[id].bit_pos;
  247. reg_add += sleep_req_info[id].reg_offset;
  248. if (enable)
  249. ret = palmas_update_bits(palmas, PALMAS_RESOURCE_BASE,
  250. reg_add, BIT(bit_pos), BIT(bit_pos));
  251. else
  252. ret = palmas_update_bits(palmas, PALMAS_RESOURCE_BASE,
  253. reg_add, BIT(bit_pos), 0);
  254. if (ret < 0) {
  255. dev_err(palmas->dev, "Resource reg 0x%02x update failed %d\n",
  256. reg_add, ret);
  257. return ret;
  258. }
  259. /* Unmask the PREQ */
  260. ret = palmas_update_bits(palmas, PALMAS_PMU_CONTROL_BASE,
  261. PALMAS_POWER_CTRL, BIT(preq_mask_bit), 0);
  262. if (ret < 0) {
  263. dev_err(palmas->dev, "POWER_CTRL register update failed %d\n",
  264. ret);
  265. return ret;
  266. }
  267. return ret;
  268. }
  269. EXPORT_SYMBOL_GPL(palmas_ext_control_req_config);
  270. static int palmas_set_pdata_irq_flag(struct i2c_client *i2c,
  271. struct palmas_platform_data *pdata)
  272. {
  273. struct irq_data *irq_data = irq_get_irq_data(i2c->irq);
  274. if (!irq_data) {
  275. dev_err(&i2c->dev, "Invalid IRQ: %d\n", i2c->irq);
  276. return -EINVAL;
  277. }
  278. pdata->irq_flags = irqd_get_trigger_type(irq_data);
  279. dev_info(&i2c->dev, "Irq flag is 0x%08x\n", pdata->irq_flags);
  280. return 0;
  281. }
  282. static void palmas_dt_to_pdata(struct i2c_client *i2c,
  283. struct palmas_platform_data *pdata)
  284. {
  285. struct device_node *node = i2c->dev.of_node;
  286. int ret;
  287. u32 prop;
  288. ret = of_property_read_u32(node, "ti,mux-pad1", &prop);
  289. if (!ret) {
  290. pdata->mux_from_pdata = 1;
  291. pdata->pad1 = prop;
  292. }
  293. ret = of_property_read_u32(node, "ti,mux-pad2", &prop);
  294. if (!ret) {
  295. pdata->mux_from_pdata = 1;
  296. pdata->pad2 = prop;
  297. }
  298. /* The default for this register is all masked */
  299. ret = of_property_read_u32(node, "ti,power-ctrl", &prop);
  300. if (!ret)
  301. pdata->power_ctrl = prop;
  302. else
  303. pdata->power_ctrl = PALMAS_POWER_CTRL_NSLEEP_MASK |
  304. PALMAS_POWER_CTRL_ENABLE1_MASK |
  305. PALMAS_POWER_CTRL_ENABLE2_MASK;
  306. if (i2c->irq)
  307. palmas_set_pdata_irq_flag(i2c, pdata);
  308. pdata->pm_off = of_property_read_bool(node,
  309. "ti,system-power-controller");
  310. }
  311. static struct palmas *palmas_dev;
  312. static void palmas_power_off(void)
  313. {
  314. unsigned int addr;
  315. int ret, slave;
  316. if (!palmas_dev)
  317. return;
  318. slave = PALMAS_BASE_TO_SLAVE(PALMAS_PMU_CONTROL_BASE);
  319. addr = PALMAS_BASE_TO_REG(PALMAS_PMU_CONTROL_BASE, PALMAS_DEV_CTRL);
  320. ret = regmap_update_bits(
  321. palmas_dev->regmap[slave],
  322. addr,
  323. PALMAS_DEV_CTRL_DEV_ON,
  324. 0);
  325. if (ret)
  326. pr_err("%s: Unable to write to DEV_CTRL_DEV_ON: %d\n",
  327. __func__, ret);
  328. }
  329. static unsigned int palmas_features = PALMAS_PMIC_FEATURE_SMPS10_BOOST;
  330. static unsigned int tps659038_features;
  331. static const struct of_device_id of_palmas_match_tbl[] = {
  332. {
  333. .compatible = "ti,palmas",
  334. .data = &palmas_features,
  335. },
  336. {
  337. .compatible = "ti,tps659038",
  338. .data = &tps659038_features,
  339. },
  340. { },
  341. };
  342. MODULE_DEVICE_TABLE(of, of_palmas_match_tbl);
  343. static int palmas_i2c_probe(struct i2c_client *i2c,
  344. const struct i2c_device_id *id)
  345. {
  346. struct palmas *palmas;
  347. struct palmas_platform_data *pdata;
  348. struct device_node *node = i2c->dev.of_node;
  349. int ret = 0, i;
  350. unsigned int reg, addr, *features;
  351. int slave;
  352. const struct of_device_id *match;
  353. pdata = dev_get_platdata(&i2c->dev);
  354. if (node && !pdata) {
  355. pdata = devm_kzalloc(&i2c->dev, sizeof(*pdata), GFP_KERNEL);
  356. if (!pdata)
  357. return -ENOMEM;
  358. palmas_dt_to_pdata(i2c, pdata);
  359. }
  360. if (!pdata)
  361. return -EINVAL;
  362. palmas = devm_kzalloc(&i2c->dev, sizeof(struct palmas), GFP_KERNEL);
  363. if (palmas == NULL)
  364. return -ENOMEM;
  365. i2c_set_clientdata(i2c, palmas);
  366. palmas->dev = &i2c->dev;
  367. palmas->irq = i2c->irq;
  368. match = of_match_device(of_palmas_match_tbl, &i2c->dev);
  369. if (!match)
  370. return -ENODATA;
  371. features = (unsigned int *)match->data;
  372. palmas->features = *features;
  373. for (i = 0; i < PALMAS_NUM_CLIENTS; i++) {
  374. if (i == 0)
  375. palmas->i2c_clients[i] = i2c;
  376. else {
  377. palmas->i2c_clients[i] =
  378. i2c_new_dummy(i2c->adapter,
  379. i2c->addr + i);
  380. if (!palmas->i2c_clients[i]) {
  381. dev_err(palmas->dev,
  382. "can't attach client %d\n", i);
  383. ret = -ENOMEM;
  384. goto err_i2c;
  385. }
  386. palmas->i2c_clients[i]->dev.of_node = of_node_get(node);
  387. }
  388. palmas->regmap[i] = devm_regmap_init_i2c(palmas->i2c_clients[i],
  389. &palmas_regmap_config[i]);
  390. if (IS_ERR(palmas->regmap[i])) {
  391. ret = PTR_ERR(palmas->regmap[i]);
  392. dev_err(palmas->dev,
  393. "Failed to allocate regmap %d, err: %d\n",
  394. i, ret);
  395. goto err_i2c;
  396. }
  397. }
  398. if (!palmas->irq) {
  399. dev_warn(palmas->dev, "IRQ missing: skipping irq request\n");
  400. goto no_irq;
  401. }
  402. /* Change interrupt line output polarity */
  403. if (pdata->irq_flags & IRQ_TYPE_LEVEL_HIGH)
  404. reg = PALMAS_POLARITY_CTRL_INT_POLARITY;
  405. else
  406. reg = 0;
  407. ret = palmas_update_bits(palmas, PALMAS_PU_PD_OD_BASE,
  408. PALMAS_POLARITY_CTRL, PALMAS_POLARITY_CTRL_INT_POLARITY,
  409. reg);
  410. if (ret < 0) {
  411. dev_err(palmas->dev, "POLARITY_CTRL updat failed: %d\n", ret);
  412. goto err_i2c;
  413. }
  414. /* Change IRQ into clear on read mode for efficiency */
  415. slave = PALMAS_BASE_TO_SLAVE(PALMAS_INTERRUPT_BASE);
  416. addr = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE, PALMAS_INT_CTRL);
  417. reg = PALMAS_INT_CTRL_INT_CLEAR;
  418. regmap_write(palmas->regmap[slave], addr, reg);
  419. ret = regmap_add_irq_chip(palmas->regmap[slave], palmas->irq,
  420. IRQF_ONESHOT | pdata->irq_flags, 0, &palmas_irq_chip,
  421. &palmas->irq_data);
  422. if (ret < 0)
  423. goto err_i2c;
  424. no_irq:
  425. slave = PALMAS_BASE_TO_SLAVE(PALMAS_PU_PD_OD_BASE);
  426. addr = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE,
  427. PALMAS_PRIMARY_SECONDARY_PAD1);
  428. if (pdata->mux_from_pdata) {
  429. reg = pdata->pad1;
  430. ret = regmap_write(palmas->regmap[slave], addr, reg);
  431. if (ret)
  432. goto err_irq;
  433. } else {
  434. ret = regmap_read(palmas->regmap[slave], addr, &reg);
  435. if (ret)
  436. goto err_irq;
  437. }
  438. if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_0))
  439. palmas->gpio_muxed |= PALMAS_GPIO_0_MUXED;
  440. if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK))
  441. palmas->gpio_muxed |= PALMAS_GPIO_1_MUXED;
  442. else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK) ==
  443. (2 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_SHIFT))
  444. palmas->led_muxed |= PALMAS_LED1_MUXED;
  445. else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK) ==
  446. (3 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_SHIFT))
  447. palmas->pwm_muxed |= PALMAS_PWM1_MUXED;
  448. if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK))
  449. palmas->gpio_muxed |= PALMAS_GPIO_2_MUXED;
  450. else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK) ==
  451. (2 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_SHIFT))
  452. palmas->led_muxed |= PALMAS_LED2_MUXED;
  453. else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK) ==
  454. (3 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_SHIFT))
  455. palmas->pwm_muxed |= PALMAS_PWM2_MUXED;
  456. if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_3))
  457. palmas->gpio_muxed |= PALMAS_GPIO_3_MUXED;
  458. addr = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE,
  459. PALMAS_PRIMARY_SECONDARY_PAD2);
  460. if (pdata->mux_from_pdata) {
  461. reg = pdata->pad2;
  462. ret = regmap_write(palmas->regmap[slave], addr, reg);
  463. if (ret)
  464. goto err_irq;
  465. } else {
  466. ret = regmap_read(palmas->regmap[slave], addr, &reg);
  467. if (ret)
  468. goto err_irq;
  469. }
  470. if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_4))
  471. palmas->gpio_muxed |= PALMAS_GPIO_4_MUXED;
  472. if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_5_MASK))
  473. palmas->gpio_muxed |= PALMAS_GPIO_5_MUXED;
  474. if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_6))
  475. palmas->gpio_muxed |= PALMAS_GPIO_6_MUXED;
  476. if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_7_MASK))
  477. palmas->gpio_muxed |= PALMAS_GPIO_7_MUXED;
  478. dev_info(palmas->dev, "Muxing GPIO %x, PWM %x, LED %x\n",
  479. palmas->gpio_muxed, palmas->pwm_muxed,
  480. palmas->led_muxed);
  481. reg = pdata->power_ctrl;
  482. slave = PALMAS_BASE_TO_SLAVE(PALMAS_PMU_CONTROL_BASE);
  483. addr = PALMAS_BASE_TO_REG(PALMAS_PMU_CONTROL_BASE, PALMAS_POWER_CTRL);
  484. ret = regmap_write(palmas->regmap[slave], addr, reg);
  485. if (ret)
  486. goto err_irq;
  487. /*
  488. * If we are probing with DT do this the DT way and return here
  489. * otherwise continue and add devices using mfd helpers.
  490. */
  491. if (node) {
  492. ret = of_platform_populate(node, NULL, NULL, &i2c->dev);
  493. if (ret < 0) {
  494. goto err_irq;
  495. } else if (pdata->pm_off && !pm_power_off) {
  496. palmas_dev = palmas;
  497. pm_power_off = palmas_power_off;
  498. }
  499. }
  500. return ret;
  501. err_irq:
  502. regmap_del_irq_chip(palmas->irq, palmas->irq_data);
  503. err_i2c:
  504. for (i = 1; i < PALMAS_NUM_CLIENTS; i++) {
  505. if (palmas->i2c_clients[i])
  506. i2c_unregister_device(palmas->i2c_clients[i]);
  507. }
  508. return ret;
  509. }
  510. static int palmas_i2c_remove(struct i2c_client *i2c)
  511. {
  512. struct palmas *palmas = i2c_get_clientdata(i2c);
  513. int i;
  514. regmap_del_irq_chip(palmas->irq, palmas->irq_data);
  515. for (i = 1; i < PALMAS_NUM_CLIENTS; i++) {
  516. if (palmas->i2c_clients[i])
  517. i2c_unregister_device(palmas->i2c_clients[i]);
  518. }
  519. if (palmas == palmas_dev) {
  520. pm_power_off = NULL;
  521. palmas_dev = NULL;
  522. }
  523. return 0;
  524. }
  525. static const struct i2c_device_id palmas_i2c_id[] = {
  526. { "palmas", },
  527. { "twl6035", },
  528. { "twl6037", },
  529. { "tps65913", },
  530. { /* end */ }
  531. };
  532. MODULE_DEVICE_TABLE(i2c, palmas_i2c_id);
  533. static struct i2c_driver palmas_i2c_driver = {
  534. .driver = {
  535. .name = "palmas",
  536. .of_match_table = of_palmas_match_tbl,
  537. .owner = THIS_MODULE,
  538. },
  539. .probe = palmas_i2c_probe,
  540. .remove = palmas_i2c_remove,
  541. .id_table = palmas_i2c_id,
  542. };
  543. static int __init palmas_i2c_init(void)
  544. {
  545. return i2c_add_driver(&palmas_i2c_driver);
  546. }
  547. /* init early so consumer devices can complete system boot */
  548. subsys_initcall(palmas_i2c_init);
  549. static void __exit palmas_i2c_exit(void)
  550. {
  551. i2c_del_driver(&palmas_i2c_driver);
  552. }
  553. module_exit(palmas_i2c_exit);
  554. MODULE_AUTHOR("Graeme Gregory <gg@slimlogic.co.uk>");
  555. MODULE_DESCRIPTION("Palmas chip family multi-function driver");
  556. MODULE_LICENSE("GPL");