twl6040.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748
  1. /*
  2. * MFD driver for TWL6040 audio device
  3. *
  4. * Authors: Misael Lopez Cruz <misael.lopez@ti.com>
  5. * Jorge Eduardo Candelaria <jorge.candelaria@ti.com>
  6. * Peter Ujfalusi <peter.ujfalusi@ti.com>
  7. *
  8. * Copyright: (C) 2011 Texas Instruments, Inc.
  9. *
  10. * This program is free software; you can redistribute it and/or modify
  11. * it under the terms of the GNU General Public License version 2 as
  12. * published by the Free Software Foundation.
  13. *
  14. * This program is distributed in the hope that it will be useful, but
  15. * WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  17. * General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License
  20. * along with this program; if not, write to the Free Software
  21. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  22. * 02110-1301 USA
  23. *
  24. */
  25. #include <linux/module.h>
  26. #include <linux/types.h>
  27. #include <linux/slab.h>
  28. #include <linux/kernel.h>
  29. #include <linux/err.h>
  30. #include <linux/platform_device.h>
  31. #include <linux/of.h>
  32. #include <linux/of_irq.h>
  33. #include <linux/of_gpio.h>
  34. #include <linux/of_platform.h>
  35. #include <linux/gpio.h>
  36. #include <linux/delay.h>
  37. #include <linux/i2c.h>
  38. #include <linux/regmap.h>
  39. #include <linux/mfd/core.h>
  40. #include <linux/mfd/twl6040.h>
  41. #include <linux/regulator/consumer.h>
  42. #define VIBRACTRL_MEMBER(reg) ((reg == TWL6040_REG_VIBCTLL) ? 0 : 1)
  43. #define TWL6040_NUM_SUPPLIES (2)
  44. static bool twl6040_has_vibra(struct twl6040_platform_data *pdata,
  45. struct device_node *node)
  46. {
  47. if (pdata && pdata->vibra)
  48. return true;
  49. #ifdef CONFIG_OF
  50. if (of_find_node_by_name(node, "vibra"))
  51. return true;
  52. #endif
  53. return false;
  54. }
  55. int twl6040_reg_read(struct twl6040 *twl6040, unsigned int reg)
  56. {
  57. int ret;
  58. unsigned int val;
  59. /* Vibra control registers from cache */
  60. if (unlikely(reg == TWL6040_REG_VIBCTLL ||
  61. reg == TWL6040_REG_VIBCTLR)) {
  62. val = twl6040->vibra_ctrl_cache[VIBRACTRL_MEMBER(reg)];
  63. } else {
  64. ret = regmap_read(twl6040->regmap, reg, &val);
  65. if (ret < 0)
  66. return ret;
  67. }
  68. return val;
  69. }
  70. EXPORT_SYMBOL(twl6040_reg_read);
  71. int twl6040_reg_write(struct twl6040 *twl6040, unsigned int reg, u8 val)
  72. {
  73. int ret;
  74. ret = regmap_write(twl6040->regmap, reg, val);
  75. /* Cache the vibra control registers */
  76. if (reg == TWL6040_REG_VIBCTLL || reg == TWL6040_REG_VIBCTLR)
  77. twl6040->vibra_ctrl_cache[VIBRACTRL_MEMBER(reg)] = val;
  78. return ret;
  79. }
  80. EXPORT_SYMBOL(twl6040_reg_write);
  81. int twl6040_set_bits(struct twl6040 *twl6040, unsigned int reg, u8 mask)
  82. {
  83. return regmap_update_bits(twl6040->regmap, reg, mask, mask);
  84. }
  85. EXPORT_SYMBOL(twl6040_set_bits);
  86. int twl6040_clear_bits(struct twl6040 *twl6040, unsigned int reg, u8 mask)
  87. {
  88. return regmap_update_bits(twl6040->regmap, reg, mask, 0);
  89. }
  90. EXPORT_SYMBOL(twl6040_clear_bits);
  91. /* twl6040 codec manual power-up sequence */
  92. static int twl6040_power_up_manual(struct twl6040 *twl6040)
  93. {
  94. u8 ldoctl, ncpctl, lppllctl;
  95. int ret;
  96. /* enable high-side LDO, reference system and internal oscillator */
  97. ldoctl = TWL6040_HSLDOENA | TWL6040_REFENA | TWL6040_OSCENA;
  98. ret = twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl);
  99. if (ret)
  100. return ret;
  101. usleep_range(10000, 10500);
  102. /* enable negative charge pump */
  103. ncpctl = TWL6040_NCPENA;
  104. ret = twl6040_reg_write(twl6040, TWL6040_REG_NCPCTL, ncpctl);
  105. if (ret)
  106. goto ncp_err;
  107. usleep_range(1000, 1500);
  108. /* enable low-side LDO */
  109. ldoctl |= TWL6040_LSLDOENA;
  110. ret = twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl);
  111. if (ret)
  112. goto lsldo_err;
  113. usleep_range(1000, 1500);
  114. /* enable low-power PLL */
  115. lppllctl = TWL6040_LPLLENA;
  116. ret = twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL, lppllctl);
  117. if (ret)
  118. goto lppll_err;
  119. usleep_range(5000, 5500);
  120. /* disable internal oscillator */
  121. ldoctl &= ~TWL6040_OSCENA;
  122. ret = twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl);
  123. if (ret)
  124. goto osc_err;
  125. return 0;
  126. osc_err:
  127. lppllctl &= ~TWL6040_LPLLENA;
  128. twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL, lppllctl);
  129. lppll_err:
  130. ldoctl &= ~TWL6040_LSLDOENA;
  131. twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl);
  132. lsldo_err:
  133. ncpctl &= ~TWL6040_NCPENA;
  134. twl6040_reg_write(twl6040, TWL6040_REG_NCPCTL, ncpctl);
  135. ncp_err:
  136. ldoctl &= ~(TWL6040_HSLDOENA | TWL6040_REFENA | TWL6040_OSCENA);
  137. twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl);
  138. dev_err(twl6040->dev, "manual power-up failed\n");
  139. return ret;
  140. }
  141. /* twl6040 manual power-down sequence */
  142. static void twl6040_power_down_manual(struct twl6040 *twl6040)
  143. {
  144. u8 ncpctl, ldoctl, lppllctl;
  145. ncpctl = twl6040_reg_read(twl6040, TWL6040_REG_NCPCTL);
  146. ldoctl = twl6040_reg_read(twl6040, TWL6040_REG_LDOCTL);
  147. lppllctl = twl6040_reg_read(twl6040, TWL6040_REG_LPPLLCTL);
  148. /* enable internal oscillator */
  149. ldoctl |= TWL6040_OSCENA;
  150. twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl);
  151. usleep_range(1000, 1500);
  152. /* disable low-power PLL */
  153. lppllctl &= ~TWL6040_LPLLENA;
  154. twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL, lppllctl);
  155. /* disable low-side LDO */
  156. ldoctl &= ~TWL6040_LSLDOENA;
  157. twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl);
  158. /* disable negative charge pump */
  159. ncpctl &= ~TWL6040_NCPENA;
  160. twl6040_reg_write(twl6040, TWL6040_REG_NCPCTL, ncpctl);
  161. /* disable high-side LDO, reference system and internal oscillator */
  162. ldoctl &= ~(TWL6040_HSLDOENA | TWL6040_REFENA | TWL6040_OSCENA);
  163. twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl);
  164. }
  165. static irqreturn_t twl6040_readyint_handler(int irq, void *data)
  166. {
  167. struct twl6040 *twl6040 = data;
  168. complete(&twl6040->ready);
  169. return IRQ_HANDLED;
  170. }
  171. static irqreturn_t twl6040_thint_handler(int irq, void *data)
  172. {
  173. struct twl6040 *twl6040 = data;
  174. u8 status;
  175. status = twl6040_reg_read(twl6040, TWL6040_REG_STATUS);
  176. if (status & TWL6040_TSHUTDET) {
  177. dev_warn(twl6040->dev, "Thermal shutdown, powering-off");
  178. twl6040_power(twl6040, 0);
  179. } else {
  180. dev_warn(twl6040->dev, "Leaving thermal shutdown, powering-on");
  181. twl6040_power(twl6040, 1);
  182. }
  183. return IRQ_HANDLED;
  184. }
  185. static int twl6040_power_up_automatic(struct twl6040 *twl6040)
  186. {
  187. int time_left;
  188. gpio_set_value(twl6040->audpwron, 1);
  189. time_left = wait_for_completion_timeout(&twl6040->ready,
  190. msecs_to_jiffies(144));
  191. if (!time_left) {
  192. u8 intid;
  193. dev_warn(twl6040->dev, "timeout waiting for READYINT\n");
  194. intid = twl6040_reg_read(twl6040, TWL6040_REG_INTID);
  195. if (!(intid & TWL6040_READYINT)) {
  196. dev_err(twl6040->dev, "automatic power-up failed\n");
  197. gpio_set_value(twl6040->audpwron, 0);
  198. return -ETIMEDOUT;
  199. }
  200. }
  201. return 0;
  202. }
  203. int twl6040_power(struct twl6040 *twl6040, int on)
  204. {
  205. int ret = 0;
  206. mutex_lock(&twl6040->mutex);
  207. if (on) {
  208. /* already powered-up */
  209. if (twl6040->power_count++)
  210. goto out;
  211. if (gpio_is_valid(twl6040->audpwron)) {
  212. /* use automatic power-up sequence */
  213. ret = twl6040_power_up_automatic(twl6040);
  214. if (ret) {
  215. twl6040->power_count = 0;
  216. goto out;
  217. }
  218. } else {
  219. /* use manual power-up sequence */
  220. ret = twl6040_power_up_manual(twl6040);
  221. if (ret) {
  222. twl6040->power_count = 0;
  223. goto out;
  224. }
  225. }
  226. /* Default PLL configuration after power up */
  227. twl6040->pll = TWL6040_SYSCLK_SEL_LPPLL;
  228. twl6040->sysclk = 19200000;
  229. twl6040->mclk = 32768;
  230. } else {
  231. /* already powered-down */
  232. if (!twl6040->power_count) {
  233. dev_err(twl6040->dev,
  234. "device is already powered-off\n");
  235. ret = -EPERM;
  236. goto out;
  237. }
  238. if (--twl6040->power_count)
  239. goto out;
  240. if (gpio_is_valid(twl6040->audpwron)) {
  241. /* use AUDPWRON line */
  242. gpio_set_value(twl6040->audpwron, 0);
  243. /* power-down sequence latency */
  244. usleep_range(500, 700);
  245. } else {
  246. /* use manual power-down sequence */
  247. twl6040_power_down_manual(twl6040);
  248. }
  249. twl6040->sysclk = 0;
  250. twl6040->mclk = 0;
  251. }
  252. out:
  253. mutex_unlock(&twl6040->mutex);
  254. return ret;
  255. }
  256. EXPORT_SYMBOL(twl6040_power);
  257. int twl6040_set_pll(struct twl6040 *twl6040, int pll_id,
  258. unsigned int freq_in, unsigned int freq_out)
  259. {
  260. u8 hppllctl, lppllctl;
  261. int ret = 0;
  262. mutex_lock(&twl6040->mutex);
  263. hppllctl = twl6040_reg_read(twl6040, TWL6040_REG_HPPLLCTL);
  264. lppllctl = twl6040_reg_read(twl6040, TWL6040_REG_LPPLLCTL);
  265. /* Force full reconfiguration when switching between PLL */
  266. if (pll_id != twl6040->pll) {
  267. twl6040->sysclk = 0;
  268. twl6040->mclk = 0;
  269. }
  270. switch (pll_id) {
  271. case TWL6040_SYSCLK_SEL_LPPLL:
  272. /* low-power PLL divider */
  273. /* Change the sysclk configuration only if it has been canged */
  274. if (twl6040->sysclk != freq_out) {
  275. switch (freq_out) {
  276. case 17640000:
  277. lppllctl |= TWL6040_LPLLFIN;
  278. break;
  279. case 19200000:
  280. lppllctl &= ~TWL6040_LPLLFIN;
  281. break;
  282. default:
  283. dev_err(twl6040->dev,
  284. "freq_out %d not supported\n",
  285. freq_out);
  286. ret = -EINVAL;
  287. goto pll_out;
  288. }
  289. twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL,
  290. lppllctl);
  291. }
  292. /* The PLL in use has not been change, we can exit */
  293. if (twl6040->pll == pll_id)
  294. break;
  295. switch (freq_in) {
  296. case 32768:
  297. lppllctl |= TWL6040_LPLLENA;
  298. twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL,
  299. lppllctl);
  300. mdelay(5);
  301. lppllctl &= ~TWL6040_HPLLSEL;
  302. twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL,
  303. lppllctl);
  304. hppllctl &= ~TWL6040_HPLLENA;
  305. twl6040_reg_write(twl6040, TWL6040_REG_HPPLLCTL,
  306. hppllctl);
  307. break;
  308. default:
  309. dev_err(twl6040->dev,
  310. "freq_in %d not supported\n", freq_in);
  311. ret = -EINVAL;
  312. goto pll_out;
  313. }
  314. break;
  315. case TWL6040_SYSCLK_SEL_HPPLL:
  316. /* high-performance PLL can provide only 19.2 MHz */
  317. if (freq_out != 19200000) {
  318. dev_err(twl6040->dev,
  319. "freq_out %d not supported\n", freq_out);
  320. ret = -EINVAL;
  321. goto pll_out;
  322. }
  323. if (twl6040->mclk != freq_in) {
  324. hppllctl &= ~TWL6040_MCLK_MSK;
  325. switch (freq_in) {
  326. case 12000000:
  327. /* PLL enabled, active mode */
  328. hppllctl |= TWL6040_MCLK_12000KHZ |
  329. TWL6040_HPLLENA;
  330. break;
  331. case 19200000:
  332. /*
  333. * PLL disabled
  334. * (enable PLL if MCLK jitter quality
  335. * doesn't meet specification)
  336. */
  337. hppllctl |= TWL6040_MCLK_19200KHZ;
  338. break;
  339. case 26000000:
  340. /* PLL enabled, active mode */
  341. hppllctl |= TWL6040_MCLK_26000KHZ |
  342. TWL6040_HPLLENA;
  343. break;
  344. case 38400000:
  345. /* PLL enabled, active mode */
  346. hppllctl |= TWL6040_MCLK_38400KHZ |
  347. TWL6040_HPLLENA;
  348. break;
  349. default:
  350. dev_err(twl6040->dev,
  351. "freq_in %d not supported\n", freq_in);
  352. ret = -EINVAL;
  353. goto pll_out;
  354. }
  355. /*
  356. * enable clock slicer to ensure input waveform is
  357. * square
  358. */
  359. hppllctl |= TWL6040_HPLLSQRENA;
  360. twl6040_reg_write(twl6040, TWL6040_REG_HPPLLCTL,
  361. hppllctl);
  362. usleep_range(500, 700);
  363. lppllctl |= TWL6040_HPLLSEL;
  364. twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL,
  365. lppllctl);
  366. lppllctl &= ~TWL6040_LPLLENA;
  367. twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL,
  368. lppllctl);
  369. }
  370. break;
  371. default:
  372. dev_err(twl6040->dev, "unknown pll id %d\n", pll_id);
  373. ret = -EINVAL;
  374. goto pll_out;
  375. }
  376. twl6040->sysclk = freq_out;
  377. twl6040->mclk = freq_in;
  378. twl6040->pll = pll_id;
  379. pll_out:
  380. mutex_unlock(&twl6040->mutex);
  381. return ret;
  382. }
  383. EXPORT_SYMBOL(twl6040_set_pll);
  384. int twl6040_get_pll(struct twl6040 *twl6040)
  385. {
  386. if (twl6040->power_count)
  387. return twl6040->pll;
  388. else
  389. return -ENODEV;
  390. }
  391. EXPORT_SYMBOL(twl6040_get_pll);
  392. unsigned int twl6040_get_sysclk(struct twl6040 *twl6040)
  393. {
  394. return twl6040->sysclk;
  395. }
  396. EXPORT_SYMBOL(twl6040_get_sysclk);
  397. /* Get the combined status of the vibra control register */
  398. int twl6040_get_vibralr_status(struct twl6040 *twl6040)
  399. {
  400. u8 status;
  401. status = twl6040->vibra_ctrl_cache[0] | twl6040->vibra_ctrl_cache[1];
  402. status &= (TWL6040_VIBENA | TWL6040_VIBSEL);
  403. return status;
  404. }
  405. EXPORT_SYMBOL(twl6040_get_vibralr_status);
  406. static struct resource twl6040_vibra_rsrc[] = {
  407. {
  408. .flags = IORESOURCE_IRQ,
  409. },
  410. };
  411. static struct resource twl6040_codec_rsrc[] = {
  412. {
  413. .flags = IORESOURCE_IRQ,
  414. },
  415. };
  416. static bool twl6040_readable_reg(struct device *dev, unsigned int reg)
  417. {
  418. /* Register 0 is not readable */
  419. if (!reg)
  420. return false;
  421. return true;
  422. }
  423. static struct regmap_config twl6040_regmap_config = {
  424. .reg_bits = 8,
  425. .val_bits = 8,
  426. .max_register = TWL6040_REG_STATUS, /* 0x2e */
  427. .readable_reg = twl6040_readable_reg,
  428. };
  429. static const struct regmap_irq twl6040_irqs[] = {
  430. { .reg_offset = 0, .mask = TWL6040_THINT, },
  431. { .reg_offset = 0, .mask = TWL6040_PLUGINT | TWL6040_UNPLUGINT, },
  432. { .reg_offset = 0, .mask = TWL6040_HOOKINT, },
  433. { .reg_offset = 0, .mask = TWL6040_HFINT, },
  434. { .reg_offset = 0, .mask = TWL6040_VIBINT, },
  435. { .reg_offset = 0, .mask = TWL6040_READYINT, },
  436. };
  437. static struct regmap_irq_chip twl6040_irq_chip = {
  438. .name = "twl6040",
  439. .irqs = twl6040_irqs,
  440. .num_irqs = ARRAY_SIZE(twl6040_irqs),
  441. .num_regs = 1,
  442. .status_base = TWL6040_REG_INTID,
  443. .mask_base = TWL6040_REG_INTMR,
  444. };
  445. static int twl6040_probe(struct i2c_client *client,
  446. const struct i2c_device_id *id)
  447. {
  448. struct twl6040_platform_data *pdata = client->dev.platform_data;
  449. struct device_node *node = client->dev.of_node;
  450. struct twl6040 *twl6040;
  451. struct mfd_cell *cell = NULL;
  452. int irq, ret, children = 0;
  453. if (!pdata && !node) {
  454. dev_err(&client->dev, "Platform data is missing\n");
  455. return -EINVAL;
  456. }
  457. /* In order to operate correctly we need valid interrupt config */
  458. if (!client->irq) {
  459. dev_err(&client->dev, "Invalid IRQ configuration\n");
  460. return -EINVAL;
  461. }
  462. twl6040 = devm_kzalloc(&client->dev, sizeof(struct twl6040),
  463. GFP_KERNEL);
  464. if (!twl6040) {
  465. ret = -ENOMEM;
  466. goto err;
  467. }
  468. twl6040->regmap = devm_regmap_init_i2c(client, &twl6040_regmap_config);
  469. if (IS_ERR(twl6040->regmap)) {
  470. ret = PTR_ERR(twl6040->regmap);
  471. goto err;
  472. }
  473. i2c_set_clientdata(client, twl6040);
  474. twl6040->supplies[0].supply = "vio";
  475. twl6040->supplies[1].supply = "v2v1";
  476. ret = regulator_bulk_get(&client->dev, TWL6040_NUM_SUPPLIES,
  477. twl6040->supplies);
  478. if (ret != 0) {
  479. dev_err(&client->dev, "Failed to get supplies: %d\n", ret);
  480. goto regulator_get_err;
  481. }
  482. ret = regulator_bulk_enable(TWL6040_NUM_SUPPLIES, twl6040->supplies);
  483. if (ret != 0) {
  484. dev_err(&client->dev, "Failed to enable supplies: %d\n", ret);
  485. goto power_err;
  486. }
  487. twl6040->dev = &client->dev;
  488. twl6040->irq = client->irq;
  489. mutex_init(&twl6040->mutex);
  490. init_completion(&twl6040->ready);
  491. twl6040->rev = twl6040_reg_read(twl6040, TWL6040_REG_ASICREV);
  492. /* ERRATA: Automatic power-up is not possible in ES1.0 */
  493. if (twl6040_get_revid(twl6040) > TWL6040_REV_ES1_0) {
  494. if (pdata)
  495. twl6040->audpwron = pdata->audpwron_gpio;
  496. else
  497. twl6040->audpwron = of_get_named_gpio(node,
  498. "ti,audpwron-gpio", 0);
  499. } else
  500. twl6040->audpwron = -EINVAL;
  501. if (gpio_is_valid(twl6040->audpwron)) {
  502. ret = gpio_request_one(twl6040->audpwron, GPIOF_OUT_INIT_LOW,
  503. "audpwron");
  504. if (ret)
  505. goto gpio_err;
  506. }
  507. ret = regmap_add_irq_chip(twl6040->regmap, twl6040->irq,
  508. IRQF_ONESHOT, 0, &twl6040_irq_chip,
  509. &twl6040->irq_data);
  510. if (ret < 0)
  511. goto irq_init_err;
  512. twl6040->irq_ready = regmap_irq_get_virq(twl6040->irq_data,
  513. TWL6040_IRQ_READY);
  514. twl6040->irq_th = regmap_irq_get_virq(twl6040->irq_data,
  515. TWL6040_IRQ_TH);
  516. ret = request_threaded_irq(twl6040->irq_ready, NULL,
  517. twl6040_readyint_handler, IRQF_ONESHOT,
  518. "twl6040_irq_ready", twl6040);
  519. if (ret) {
  520. dev_err(twl6040->dev, "READY IRQ request failed: %d\n", ret);
  521. goto readyirq_err;
  522. }
  523. ret = request_threaded_irq(twl6040->irq_th, NULL,
  524. twl6040_thint_handler, IRQF_ONESHOT,
  525. "twl6040_irq_th", twl6040);
  526. if (ret) {
  527. dev_err(twl6040->dev, "Thermal IRQ request failed: %d\n", ret);
  528. goto thirq_err;
  529. }
  530. /* dual-access registers controlled by I2C only */
  531. twl6040_set_bits(twl6040, TWL6040_REG_ACCCTL, TWL6040_I2CSEL);
  532. /*
  533. * The main functionality of twl6040 to provide audio on OMAP4+ systems.
  534. * We can add the ASoC codec child whenever this driver has been loaded.
  535. * The ASoC codec can work without pdata, pass the platform_data only if
  536. * it has been provided.
  537. */
  538. irq = regmap_irq_get_virq(twl6040->irq_data, TWL6040_IRQ_PLUG);
  539. cell = &twl6040->cells[children];
  540. cell->name = "twl6040-codec";
  541. twl6040_codec_rsrc[0].start = irq;
  542. twl6040_codec_rsrc[0].end = irq;
  543. cell->resources = twl6040_codec_rsrc;
  544. cell->num_resources = ARRAY_SIZE(twl6040_codec_rsrc);
  545. if (pdata && pdata->codec) {
  546. cell->platform_data = pdata->codec;
  547. cell->pdata_size = sizeof(*pdata->codec);
  548. }
  549. children++;
  550. if (twl6040_has_vibra(pdata, node)) {
  551. irq = regmap_irq_get_virq(twl6040->irq_data, TWL6040_IRQ_VIB);
  552. cell = &twl6040->cells[children];
  553. cell->name = "twl6040-vibra";
  554. twl6040_vibra_rsrc[0].start = irq;
  555. twl6040_vibra_rsrc[0].end = irq;
  556. cell->resources = twl6040_vibra_rsrc;
  557. cell->num_resources = ARRAY_SIZE(twl6040_vibra_rsrc);
  558. if (pdata && pdata->vibra) {
  559. cell->platform_data = pdata->vibra;
  560. cell->pdata_size = sizeof(*pdata->vibra);
  561. }
  562. children++;
  563. }
  564. /*
  565. * Enable the GPO driver in the following cases:
  566. * DT booted kernel or legacy boot with valid gpo platform_data
  567. */
  568. if (!pdata || (pdata && pdata->gpo)) {
  569. cell = &twl6040->cells[children];
  570. cell->name = "twl6040-gpo";
  571. if (pdata) {
  572. cell->platform_data = pdata->gpo;
  573. cell->pdata_size = sizeof(*pdata->gpo);
  574. }
  575. children++;
  576. }
  577. ret = mfd_add_devices(&client->dev, -1, twl6040->cells, children,
  578. NULL, 0, NULL);
  579. if (ret)
  580. goto mfd_err;
  581. return 0;
  582. mfd_err:
  583. free_irq(twl6040->irq_th, twl6040);
  584. thirq_err:
  585. free_irq(twl6040->irq_ready, twl6040);
  586. readyirq_err:
  587. regmap_del_irq_chip(twl6040->irq, twl6040->irq_data);
  588. irq_init_err:
  589. if (gpio_is_valid(twl6040->audpwron))
  590. gpio_free(twl6040->audpwron);
  591. gpio_err:
  592. regulator_bulk_disable(TWL6040_NUM_SUPPLIES, twl6040->supplies);
  593. power_err:
  594. regulator_bulk_free(TWL6040_NUM_SUPPLIES, twl6040->supplies);
  595. regulator_get_err:
  596. i2c_set_clientdata(client, NULL);
  597. err:
  598. return ret;
  599. }
  600. static int twl6040_remove(struct i2c_client *client)
  601. {
  602. struct twl6040 *twl6040 = i2c_get_clientdata(client);
  603. if (twl6040->power_count)
  604. twl6040_power(twl6040, 0);
  605. if (gpio_is_valid(twl6040->audpwron))
  606. gpio_free(twl6040->audpwron);
  607. free_irq(twl6040->irq_ready, twl6040);
  608. free_irq(twl6040->irq_th, twl6040);
  609. regmap_del_irq_chip(twl6040->irq, twl6040->irq_data);
  610. mfd_remove_devices(&client->dev);
  611. i2c_set_clientdata(client, NULL);
  612. regulator_bulk_disable(TWL6040_NUM_SUPPLIES, twl6040->supplies);
  613. regulator_bulk_free(TWL6040_NUM_SUPPLIES, twl6040->supplies);
  614. return 0;
  615. }
  616. static const struct i2c_device_id twl6040_i2c_id[] = {
  617. { "twl6040", 0, },
  618. { "twl6041", 0, },
  619. { },
  620. };
  621. MODULE_DEVICE_TABLE(i2c, twl6040_i2c_id);
  622. static struct i2c_driver twl6040_driver = {
  623. .driver = {
  624. .name = "twl6040",
  625. .owner = THIS_MODULE,
  626. },
  627. .probe = twl6040_probe,
  628. .remove = twl6040_remove,
  629. .id_table = twl6040_i2c_id,
  630. };
  631. module_i2c_driver(twl6040_driver);
  632. MODULE_DESCRIPTION("TWL6040 MFD");
  633. MODULE_AUTHOR("Misael Lopez Cruz <misael.lopez@ti.com>");
  634. MODULE_AUTHOR("Jorge Eduardo Candelaria <jorge.candelaria@ti.com>");
  635. MODULE_LICENSE("GPL");
  636. MODULE_ALIAS("platform:twl6040");