twl6040.c 34 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305
  1. /*
  2. * ALSA SoC TWL6040 codec driver
  3. *
  4. * Author: Misael Lopez Cruz <x0052729@ti.com>
  5. *
  6. * This program is free software; you can redistribute it and/or
  7. * modify it under the terms of the GNU General Public License
  8. * version 2 as published by the Free Software Foundation.
  9. *
  10. * This program is distributed in the hope that it will be useful, but
  11. * WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  13. * General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License
  16. * along with this program; if not, write to the Free Software
  17. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  18. * 02110-1301 USA
  19. *
  20. */
  21. #include <linux/module.h>
  22. #include <linux/moduleparam.h>
  23. #include <linux/init.h>
  24. #include <linux/delay.h>
  25. #include <linux/pm.h>
  26. #include <linux/platform_device.h>
  27. #include <linux/slab.h>
  28. #include <linux/mfd/twl6040.h>
  29. #include <sound/core.h>
  30. #include <sound/pcm.h>
  31. #include <sound/pcm_params.h>
  32. #include <sound/soc.h>
  33. #include <sound/soc-dapm.h>
  34. #include <sound/initval.h>
  35. #include <sound/tlv.h>
  36. #include "twl6040.h"
  37. enum twl6040_dai_id {
  38. TWL6040_DAI_LEGACY = 0,
  39. TWL6040_DAI_UL,
  40. TWL6040_DAI_DL1,
  41. TWL6040_DAI_DL2,
  42. TWL6040_DAI_VIB,
  43. };
  44. #define TWL6040_RATES SNDRV_PCM_RATE_8000_96000
  45. #define TWL6040_FORMATS (SNDRV_PCM_FMTBIT_S32_LE)
  46. #define TWL6040_OUTHS_0dB 0x00
  47. #define TWL6040_OUTHS_M30dB 0x0F
  48. #define TWL6040_OUTHF_0dB 0x03
  49. #define TWL6040_OUTHF_M52dB 0x1D
  50. #define TWL6040_CACHEREGNUM (TWL6040_REG_STATUS + 1)
  51. struct twl6040_jack_data {
  52. struct snd_soc_jack *jack;
  53. struct delayed_work work;
  54. int report;
  55. };
  56. /* codec private data */
  57. struct twl6040_data {
  58. int plug_irq;
  59. int codec_powered;
  60. int pll;
  61. int pll_power_mode;
  62. int hs_power_mode;
  63. int hs_power_mode_locked;
  64. bool dl1_unmuted;
  65. bool dl2_unmuted;
  66. unsigned int clk_in;
  67. unsigned int sysclk;
  68. struct twl6040_jack_data hs_jack;
  69. struct snd_soc_codec *codec;
  70. struct mutex mutex;
  71. };
  72. /*
  73. * twl6040 register cache & default register settings
  74. */
  75. static const u8 twl6040_reg[TWL6040_CACHEREGNUM] = {
  76. 0x00, /* not used 0x00 */
  77. 0x4B, /* REG_ASICID 0x01 (ro) */
  78. 0x00, /* REG_ASICREV 0x02 (ro) */
  79. 0x00, /* REG_INTID 0x03 */
  80. 0x00, /* REG_INTMR 0x04 */
  81. 0x00, /* REG_NCPCTRL 0x05 */
  82. 0x00, /* REG_LDOCTL 0x06 */
  83. 0x60, /* REG_HPPLLCTL 0x07 */
  84. 0x00, /* REG_LPPLLCTL 0x08 */
  85. 0x4A, /* REG_LPPLLDIV 0x09 */
  86. 0x00, /* REG_AMICBCTL 0x0A */
  87. 0x00, /* REG_DMICBCTL 0x0B */
  88. 0x00, /* REG_MICLCTL 0x0C */
  89. 0x00, /* REG_MICRCTL 0x0D */
  90. 0x00, /* REG_MICGAIN 0x0E */
  91. 0x1B, /* REG_LINEGAIN 0x0F */
  92. 0x00, /* REG_HSLCTL 0x10 */
  93. 0x00, /* REG_HSRCTL 0x11 */
  94. 0x00, /* REG_HSGAIN 0x12 */
  95. 0x00, /* REG_EARCTL 0x13 */
  96. 0x00, /* REG_HFLCTL 0x14 */
  97. 0x00, /* REG_HFLGAIN 0x15 */
  98. 0x00, /* REG_HFRCTL 0x16 */
  99. 0x00, /* REG_HFRGAIN 0x17 */
  100. 0x00, /* REG_VIBCTLL 0x18 */
  101. 0x00, /* REG_VIBDATL 0x19 */
  102. 0x00, /* REG_VIBCTLR 0x1A */
  103. 0x00, /* REG_VIBDATR 0x1B */
  104. 0x00, /* REG_HKCTL1 0x1C */
  105. 0x00, /* REG_HKCTL2 0x1D */
  106. 0x00, /* REG_GPOCTL 0x1E */
  107. 0x00, /* REG_ALB 0x1F */
  108. 0x00, /* REG_DLB 0x20 */
  109. 0x00, /* not used 0x21 */
  110. 0x00, /* not used 0x22 */
  111. 0x00, /* not used 0x23 */
  112. 0x00, /* not used 0x24 */
  113. 0x00, /* not used 0x25 */
  114. 0x00, /* not used 0x26 */
  115. 0x00, /* not used 0x27 */
  116. 0x00, /* REG_TRIM1 0x28 */
  117. 0x00, /* REG_TRIM2 0x29 */
  118. 0x00, /* REG_TRIM3 0x2A */
  119. 0x00, /* REG_HSOTRIM 0x2B */
  120. 0x00, /* REG_HFOTRIM 0x2C */
  121. 0x09, /* REG_ACCCTL 0x2D */
  122. 0x00, /* REG_STATUS 0x2E (ro) */
  123. };
  124. /* List of registers to be restored after power up */
  125. static const int twl6040_restore_list[] = {
  126. TWL6040_REG_MICLCTL,
  127. TWL6040_REG_MICRCTL,
  128. TWL6040_REG_MICGAIN,
  129. TWL6040_REG_LINEGAIN,
  130. TWL6040_REG_HSLCTL,
  131. TWL6040_REG_HSRCTL,
  132. TWL6040_REG_HSGAIN,
  133. TWL6040_REG_EARCTL,
  134. TWL6040_REG_HFLCTL,
  135. TWL6040_REG_HFLGAIN,
  136. TWL6040_REG_HFRCTL,
  137. TWL6040_REG_HFRGAIN,
  138. };
  139. /* set of rates for each pll: low-power and high-performance */
  140. static unsigned int lp_rates[] = {
  141. 8000,
  142. 11250,
  143. 16000,
  144. 22500,
  145. 32000,
  146. 44100,
  147. 48000,
  148. 88200,
  149. 96000,
  150. };
  151. static unsigned int hp_rates[] = {
  152. 8000,
  153. 16000,
  154. 32000,
  155. 48000,
  156. 96000,
  157. };
  158. static struct snd_pcm_hw_constraint_list sysclk_constraints[] = {
  159. { .count = ARRAY_SIZE(lp_rates), .list = lp_rates, },
  160. { .count = ARRAY_SIZE(hp_rates), .list = hp_rates, },
  161. };
  162. /*
  163. * read twl6040 register cache
  164. */
  165. static inline unsigned int twl6040_read_reg_cache(struct snd_soc_codec *codec,
  166. unsigned int reg)
  167. {
  168. u8 *cache = codec->reg_cache;
  169. if (reg >= TWL6040_CACHEREGNUM)
  170. return -EIO;
  171. return cache[reg];
  172. }
  173. /*
  174. * write twl6040 register cache
  175. */
  176. static inline void twl6040_write_reg_cache(struct snd_soc_codec *codec,
  177. u8 reg, u8 value)
  178. {
  179. u8 *cache = codec->reg_cache;
  180. if (reg >= TWL6040_CACHEREGNUM)
  181. return;
  182. cache[reg] = value;
  183. }
  184. /*
  185. * read from twl6040 hardware register
  186. */
  187. static int twl6040_read_reg_volatile(struct snd_soc_codec *codec,
  188. unsigned int reg)
  189. {
  190. struct twl6040 *twl6040 = codec->control_data;
  191. u8 value;
  192. if (reg >= TWL6040_CACHEREGNUM)
  193. return -EIO;
  194. value = twl6040_reg_read(twl6040, reg);
  195. twl6040_write_reg_cache(codec, reg, value);
  196. return value;
  197. }
  198. static bool twl6040_is_path_unmuted(struct snd_soc_codec *codec,
  199. unsigned int reg)
  200. {
  201. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  202. switch (reg) {
  203. case TWL6040_REG_HSLCTL:
  204. case TWL6040_REG_HSRCTL:
  205. case TWL6040_REG_EARCTL:
  206. /* DL1 path */
  207. return priv->dl1_unmuted;
  208. case TWL6040_REG_HFLCTL:
  209. case TWL6040_REG_HFRCTL:
  210. return priv->dl2_unmuted;
  211. default:
  212. return 1;
  213. }
  214. }
  215. /*
  216. * write to the twl6040 register space
  217. */
  218. static int twl6040_write(struct snd_soc_codec *codec,
  219. unsigned int reg, unsigned int value)
  220. {
  221. struct twl6040 *twl6040 = codec->control_data;
  222. if (reg >= TWL6040_CACHEREGNUM)
  223. return -EIO;
  224. twl6040_write_reg_cache(codec, reg, value);
  225. if (twl6040_is_path_unmuted(codec, reg))
  226. return twl6040_reg_write(twl6040, reg, value);
  227. else
  228. return 0;
  229. }
  230. static void twl6040_init_chip(struct snd_soc_codec *codec)
  231. {
  232. struct twl6040 *twl6040 = codec->control_data;
  233. u8 val;
  234. /* Update reg_cache: ASICREV, and TRIM values */
  235. val = twl6040_get_revid(twl6040);
  236. twl6040_write_reg_cache(codec, TWL6040_REG_ASICREV, val);
  237. twl6040_read_reg_volatile(codec, TWL6040_REG_TRIM1);
  238. twl6040_read_reg_volatile(codec, TWL6040_REG_TRIM2);
  239. twl6040_read_reg_volatile(codec, TWL6040_REG_TRIM3);
  240. twl6040_read_reg_volatile(codec, TWL6040_REG_HSOTRIM);
  241. twl6040_read_reg_volatile(codec, TWL6040_REG_HFOTRIM);
  242. /* Change chip defaults */
  243. /* No imput selected for microphone amplifiers */
  244. twl6040_write_reg_cache(codec, TWL6040_REG_MICLCTL, 0x18);
  245. twl6040_write_reg_cache(codec, TWL6040_REG_MICRCTL, 0x18);
  246. /*
  247. * We need to lower the default gain values, so the ramp code
  248. * can work correctly for the first playback.
  249. * This reduces the pop noise heard at the first playback.
  250. */
  251. twl6040_write_reg_cache(codec, TWL6040_REG_HSGAIN, 0xff);
  252. twl6040_write_reg_cache(codec, TWL6040_REG_EARCTL, 0x1e);
  253. twl6040_write_reg_cache(codec, TWL6040_REG_HFLGAIN, 0x1d);
  254. twl6040_write_reg_cache(codec, TWL6040_REG_HFRGAIN, 0x1d);
  255. twl6040_write_reg_cache(codec, TWL6040_REG_LINEGAIN, 0);
  256. }
  257. static void twl6040_restore_regs(struct snd_soc_codec *codec)
  258. {
  259. u8 *cache = codec->reg_cache;
  260. int reg, i;
  261. for (i = 0; i < ARRAY_SIZE(twl6040_restore_list); i++) {
  262. reg = twl6040_restore_list[i];
  263. twl6040_write(codec, reg, cache[reg]);
  264. }
  265. }
  266. /* set headset dac and driver power mode */
  267. static int headset_power_mode(struct snd_soc_codec *codec, int high_perf)
  268. {
  269. int hslctl, hsrctl;
  270. int mask = TWL6040_HSDRVMODE | TWL6040_HSDACMODE;
  271. hslctl = twl6040_read_reg_cache(codec, TWL6040_REG_HSLCTL);
  272. hsrctl = twl6040_read_reg_cache(codec, TWL6040_REG_HSRCTL);
  273. if (high_perf) {
  274. hslctl &= ~mask;
  275. hsrctl &= ~mask;
  276. } else {
  277. hslctl |= mask;
  278. hsrctl |= mask;
  279. }
  280. twl6040_write(codec, TWL6040_REG_HSLCTL, hslctl);
  281. twl6040_write(codec, TWL6040_REG_HSRCTL, hsrctl);
  282. return 0;
  283. }
  284. static int twl6040_hs_dac_event(struct snd_soc_dapm_widget *w,
  285. struct snd_kcontrol *kcontrol, int event)
  286. {
  287. struct snd_soc_codec *codec = w->codec;
  288. u8 hslctl, hsrctl;
  289. /*
  290. * Workaround for Headset DC offset caused pop noise:
  291. * Both HS DAC need to be turned on (before the HS driver) and off at
  292. * the same time.
  293. */
  294. hslctl = twl6040_read_reg_cache(codec, TWL6040_REG_HSLCTL);
  295. hsrctl = twl6040_read_reg_cache(codec, TWL6040_REG_HSRCTL);
  296. if (SND_SOC_DAPM_EVENT_ON(event)) {
  297. hslctl |= TWL6040_HSDACENA;
  298. hsrctl |= TWL6040_HSDACENA;
  299. } else {
  300. hslctl &= ~TWL6040_HSDACENA;
  301. hsrctl &= ~TWL6040_HSDACENA;
  302. }
  303. twl6040_write(codec, TWL6040_REG_HSLCTL, hslctl);
  304. twl6040_write(codec, TWL6040_REG_HSRCTL, hsrctl);
  305. msleep(1);
  306. return 0;
  307. }
  308. static int twl6040_ep_drv_event(struct snd_soc_dapm_widget *w,
  309. struct snd_kcontrol *kcontrol, int event)
  310. {
  311. struct snd_soc_codec *codec = w->codec;
  312. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  313. int ret = 0;
  314. if (SND_SOC_DAPM_EVENT_ON(event)) {
  315. /* Earphone doesn't support low power mode */
  316. priv->hs_power_mode_locked = 1;
  317. ret = headset_power_mode(codec, 1);
  318. } else {
  319. priv->hs_power_mode_locked = 0;
  320. ret = headset_power_mode(codec, priv->hs_power_mode);
  321. }
  322. msleep(1);
  323. return ret;
  324. }
  325. static void twl6040_hs_jack_report(struct snd_soc_codec *codec,
  326. struct snd_soc_jack *jack, int report)
  327. {
  328. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  329. int status;
  330. mutex_lock(&priv->mutex);
  331. /* Sync status */
  332. status = twl6040_read_reg_volatile(codec, TWL6040_REG_STATUS);
  333. if (status & TWL6040_PLUGCOMP)
  334. snd_soc_jack_report(jack, report, report);
  335. else
  336. snd_soc_jack_report(jack, 0, report);
  337. mutex_unlock(&priv->mutex);
  338. }
  339. void twl6040_hs_jack_detect(struct snd_soc_codec *codec,
  340. struct snd_soc_jack *jack, int report)
  341. {
  342. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  343. struct twl6040_jack_data *hs_jack = &priv->hs_jack;
  344. hs_jack->jack = jack;
  345. hs_jack->report = report;
  346. twl6040_hs_jack_report(codec, hs_jack->jack, hs_jack->report);
  347. }
  348. EXPORT_SYMBOL_GPL(twl6040_hs_jack_detect);
  349. static void twl6040_accessory_work(struct work_struct *work)
  350. {
  351. struct twl6040_data *priv = container_of(work,
  352. struct twl6040_data, hs_jack.work.work);
  353. struct snd_soc_codec *codec = priv->codec;
  354. struct twl6040_jack_data *hs_jack = &priv->hs_jack;
  355. twl6040_hs_jack_report(codec, hs_jack->jack, hs_jack->report);
  356. }
  357. /* audio interrupt handler */
  358. static irqreturn_t twl6040_audio_handler(int irq, void *data)
  359. {
  360. struct snd_soc_codec *codec = data;
  361. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  362. queue_delayed_work(system_power_efficient_wq,
  363. &priv->hs_jack.work, msecs_to_jiffies(200));
  364. return IRQ_HANDLED;
  365. }
  366. static int twl6040_soc_dapm_put_vibra_enum(struct snd_kcontrol *kcontrol,
  367. struct snd_ctl_elem_value *ucontrol)
  368. {
  369. struct snd_soc_codec *codec = snd_soc_dapm_kcontrol_codec(kcontrol);
  370. struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
  371. unsigned int val;
  372. /* Do not allow changes while Input/FF efect is running */
  373. val = twl6040_read_reg_volatile(codec, e->reg);
  374. if (val & TWL6040_VIBENA && !(val & TWL6040_VIBSEL))
  375. return -EBUSY;
  376. return snd_soc_dapm_put_enum_double(kcontrol, ucontrol);
  377. }
  378. /*
  379. * MICATT volume control:
  380. * from -6 to 0 dB in 6 dB steps
  381. */
  382. static DECLARE_TLV_DB_SCALE(mic_preamp_tlv, -600, 600, 0);
  383. /*
  384. * MICGAIN volume control:
  385. * from 6 to 30 dB in 6 dB steps
  386. */
  387. static DECLARE_TLV_DB_SCALE(mic_amp_tlv, 600, 600, 0);
  388. /*
  389. * AFMGAIN volume control:
  390. * from -18 to 24 dB in 6 dB steps
  391. */
  392. static DECLARE_TLV_DB_SCALE(afm_amp_tlv, -1800, 600, 0);
  393. /*
  394. * HSGAIN volume control:
  395. * from -30 to 0 dB in 2 dB steps
  396. */
  397. static DECLARE_TLV_DB_SCALE(hs_tlv, -3000, 200, 0);
  398. /*
  399. * HFGAIN volume control:
  400. * from -52 to 6 dB in 2 dB steps
  401. */
  402. static DECLARE_TLV_DB_SCALE(hf_tlv, -5200, 200, 0);
  403. /*
  404. * EPGAIN volume control:
  405. * from -24 to 6 dB in 2 dB steps
  406. */
  407. static DECLARE_TLV_DB_SCALE(ep_tlv, -2400, 200, 0);
  408. /* Left analog microphone selection */
  409. static const char *twl6040_amicl_texts[] =
  410. {"Headset Mic", "Main Mic", "Aux/FM Left", "Off"};
  411. /* Right analog microphone selection */
  412. static const char *twl6040_amicr_texts[] =
  413. {"Headset Mic", "Sub Mic", "Aux/FM Right", "Off"};
  414. static const struct soc_enum twl6040_enum[] = {
  415. SOC_ENUM_SINGLE(TWL6040_REG_MICLCTL, 3, 4, twl6040_amicl_texts),
  416. SOC_ENUM_SINGLE(TWL6040_REG_MICRCTL, 3, 4, twl6040_amicr_texts),
  417. };
  418. static const char *twl6040_hs_texts[] = {
  419. "Off", "HS DAC", "Line-In amp"
  420. };
  421. static const struct soc_enum twl6040_hs_enum[] = {
  422. SOC_ENUM_SINGLE(TWL6040_REG_HSLCTL, 5, ARRAY_SIZE(twl6040_hs_texts),
  423. twl6040_hs_texts),
  424. SOC_ENUM_SINGLE(TWL6040_REG_HSRCTL, 5, ARRAY_SIZE(twl6040_hs_texts),
  425. twl6040_hs_texts),
  426. };
  427. static const char *twl6040_hf_texts[] = {
  428. "Off", "HF DAC", "Line-In amp"
  429. };
  430. static const struct soc_enum twl6040_hf_enum[] = {
  431. SOC_ENUM_SINGLE(TWL6040_REG_HFLCTL, 2, ARRAY_SIZE(twl6040_hf_texts),
  432. twl6040_hf_texts),
  433. SOC_ENUM_SINGLE(TWL6040_REG_HFRCTL, 2, ARRAY_SIZE(twl6040_hf_texts),
  434. twl6040_hf_texts),
  435. };
  436. static const char *twl6040_vibrapath_texts[] = {
  437. "Input FF", "Audio PDM"
  438. };
  439. static const struct soc_enum twl6040_vibra_enum[] = {
  440. SOC_ENUM_SINGLE(TWL6040_REG_VIBCTLL, 1,
  441. ARRAY_SIZE(twl6040_vibrapath_texts),
  442. twl6040_vibrapath_texts),
  443. SOC_ENUM_SINGLE(TWL6040_REG_VIBCTLR, 1,
  444. ARRAY_SIZE(twl6040_vibrapath_texts),
  445. twl6040_vibrapath_texts),
  446. };
  447. static const struct snd_kcontrol_new amicl_control =
  448. SOC_DAPM_ENUM("Route", twl6040_enum[0]);
  449. static const struct snd_kcontrol_new amicr_control =
  450. SOC_DAPM_ENUM("Route", twl6040_enum[1]);
  451. /* Headset DAC playback switches */
  452. static const struct snd_kcontrol_new hsl_mux_controls =
  453. SOC_DAPM_ENUM("Route", twl6040_hs_enum[0]);
  454. static const struct snd_kcontrol_new hsr_mux_controls =
  455. SOC_DAPM_ENUM("Route", twl6040_hs_enum[1]);
  456. /* Handsfree DAC playback switches */
  457. static const struct snd_kcontrol_new hfl_mux_controls =
  458. SOC_DAPM_ENUM("Route", twl6040_hf_enum[0]);
  459. static const struct snd_kcontrol_new hfr_mux_controls =
  460. SOC_DAPM_ENUM("Route", twl6040_hf_enum[1]);
  461. static const struct snd_kcontrol_new ep_path_enable_control =
  462. SOC_DAPM_SINGLE_VIRT("Switch", 1);
  463. static const struct snd_kcontrol_new auxl_switch_control =
  464. SOC_DAPM_SINGLE("Switch", TWL6040_REG_HFLCTL, 6, 1, 0);
  465. static const struct snd_kcontrol_new auxr_switch_control =
  466. SOC_DAPM_SINGLE("Switch", TWL6040_REG_HFRCTL, 6, 1, 0);
  467. /* Vibra playback switches */
  468. static const struct snd_kcontrol_new vibral_mux_controls =
  469. SOC_DAPM_ENUM_EXT("Route", twl6040_vibra_enum[0],
  470. snd_soc_dapm_get_enum_double,
  471. twl6040_soc_dapm_put_vibra_enum);
  472. static const struct snd_kcontrol_new vibrar_mux_controls =
  473. SOC_DAPM_ENUM_EXT("Route", twl6040_vibra_enum[1],
  474. snd_soc_dapm_get_enum_double,
  475. twl6040_soc_dapm_put_vibra_enum);
  476. /* Headset power mode */
  477. static const char *twl6040_power_mode_texts[] = {
  478. "Low-Power", "High-Performance",
  479. };
  480. static const struct soc_enum twl6040_power_mode_enum =
  481. SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(twl6040_power_mode_texts),
  482. twl6040_power_mode_texts);
  483. static int twl6040_headset_power_get_enum(struct snd_kcontrol *kcontrol,
  484. struct snd_ctl_elem_value *ucontrol)
  485. {
  486. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  487. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  488. ucontrol->value.enumerated.item[0] = priv->hs_power_mode;
  489. return 0;
  490. }
  491. static int twl6040_headset_power_put_enum(struct snd_kcontrol *kcontrol,
  492. struct snd_ctl_elem_value *ucontrol)
  493. {
  494. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  495. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  496. int high_perf = ucontrol->value.enumerated.item[0];
  497. int ret = 0;
  498. if (!priv->hs_power_mode_locked)
  499. ret = headset_power_mode(codec, high_perf);
  500. if (!ret)
  501. priv->hs_power_mode = high_perf;
  502. return ret;
  503. }
  504. static int twl6040_pll_get_enum(struct snd_kcontrol *kcontrol,
  505. struct snd_ctl_elem_value *ucontrol)
  506. {
  507. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  508. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  509. ucontrol->value.enumerated.item[0] = priv->pll_power_mode;
  510. return 0;
  511. }
  512. static int twl6040_pll_put_enum(struct snd_kcontrol *kcontrol,
  513. struct snd_ctl_elem_value *ucontrol)
  514. {
  515. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  516. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  517. priv->pll_power_mode = ucontrol->value.enumerated.item[0];
  518. return 0;
  519. }
  520. int twl6040_get_dl1_gain(struct snd_soc_codec *codec)
  521. {
  522. struct snd_soc_dapm_context *dapm = &codec->dapm;
  523. if (snd_soc_dapm_get_pin_status(dapm, "EP"))
  524. return -1; /* -1dB */
  525. if (snd_soc_dapm_get_pin_status(dapm, "HSOR") ||
  526. snd_soc_dapm_get_pin_status(dapm, "HSOL")) {
  527. u8 val = snd_soc_read(codec, TWL6040_REG_HSLCTL);
  528. if (val & TWL6040_HSDACMODE)
  529. /* HSDACL in LP mode */
  530. return -8; /* -8dB */
  531. else
  532. /* HSDACL in HP mode */
  533. return -1; /* -1dB */
  534. }
  535. return 0; /* 0dB */
  536. }
  537. EXPORT_SYMBOL_GPL(twl6040_get_dl1_gain);
  538. int twl6040_get_clk_id(struct snd_soc_codec *codec)
  539. {
  540. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  541. return priv->pll_power_mode;
  542. }
  543. EXPORT_SYMBOL_GPL(twl6040_get_clk_id);
  544. int twl6040_get_trim_value(struct snd_soc_codec *codec, enum twl6040_trim trim)
  545. {
  546. if (unlikely(trim >= TWL6040_TRIM_INVAL))
  547. return -EINVAL;
  548. return twl6040_read_reg_cache(codec, TWL6040_REG_TRIM1 + trim);
  549. }
  550. EXPORT_SYMBOL_GPL(twl6040_get_trim_value);
  551. int twl6040_get_hs_step_size(struct snd_soc_codec *codec)
  552. {
  553. struct twl6040 *twl6040 = codec->control_data;
  554. if (twl6040_get_revid(twl6040) < TWL6040_REV_ES1_3)
  555. /* For ES under ES_1.3 HS step is 2 mV */
  556. return 2;
  557. else
  558. /* For ES_1.3 HS step is 1 mV */
  559. return 1;
  560. }
  561. EXPORT_SYMBOL_GPL(twl6040_get_hs_step_size);
  562. static const struct snd_kcontrol_new twl6040_snd_controls[] = {
  563. /* Capture gains */
  564. SOC_DOUBLE_TLV("Capture Preamplifier Volume",
  565. TWL6040_REG_MICGAIN, 6, 7, 1, 1, mic_preamp_tlv),
  566. SOC_DOUBLE_TLV("Capture Volume",
  567. TWL6040_REG_MICGAIN, 0, 3, 4, 0, mic_amp_tlv),
  568. /* AFM gains */
  569. SOC_DOUBLE_TLV("Aux FM Volume",
  570. TWL6040_REG_LINEGAIN, 0, 3, 7, 0, afm_amp_tlv),
  571. /* Playback gains */
  572. SOC_DOUBLE_TLV("Headset Playback Volume",
  573. TWL6040_REG_HSGAIN, 0, 4, 0xF, 1, hs_tlv),
  574. SOC_DOUBLE_R_TLV("Handsfree Playback Volume",
  575. TWL6040_REG_HFLGAIN, TWL6040_REG_HFRGAIN, 0, 0x1D, 1, hf_tlv),
  576. SOC_SINGLE_TLV("Earphone Playback Volume",
  577. TWL6040_REG_EARCTL, 1, 0xF, 1, ep_tlv),
  578. SOC_ENUM_EXT("Headset Power Mode", twl6040_power_mode_enum,
  579. twl6040_headset_power_get_enum,
  580. twl6040_headset_power_put_enum),
  581. SOC_ENUM_EXT("PLL Selection", twl6040_power_mode_enum,
  582. twl6040_pll_get_enum, twl6040_pll_put_enum),
  583. };
  584. static const struct snd_soc_dapm_widget twl6040_dapm_widgets[] = {
  585. /* Inputs */
  586. SND_SOC_DAPM_INPUT("MAINMIC"),
  587. SND_SOC_DAPM_INPUT("HSMIC"),
  588. SND_SOC_DAPM_INPUT("SUBMIC"),
  589. SND_SOC_DAPM_INPUT("AFML"),
  590. SND_SOC_DAPM_INPUT("AFMR"),
  591. /* Outputs */
  592. SND_SOC_DAPM_OUTPUT("HSOL"),
  593. SND_SOC_DAPM_OUTPUT("HSOR"),
  594. SND_SOC_DAPM_OUTPUT("HFL"),
  595. SND_SOC_DAPM_OUTPUT("HFR"),
  596. SND_SOC_DAPM_OUTPUT("EP"),
  597. SND_SOC_DAPM_OUTPUT("AUXL"),
  598. SND_SOC_DAPM_OUTPUT("AUXR"),
  599. SND_SOC_DAPM_OUTPUT("VIBRAL"),
  600. SND_SOC_DAPM_OUTPUT("VIBRAR"),
  601. /* Analog input muxes for the capture amplifiers */
  602. SND_SOC_DAPM_MUX("Analog Left Capture Route",
  603. SND_SOC_NOPM, 0, 0, &amicl_control),
  604. SND_SOC_DAPM_MUX("Analog Right Capture Route",
  605. SND_SOC_NOPM, 0, 0, &amicr_control),
  606. /* Analog capture PGAs */
  607. SND_SOC_DAPM_PGA("MicAmpL",
  608. TWL6040_REG_MICLCTL, 0, 0, NULL, 0),
  609. SND_SOC_DAPM_PGA("MicAmpR",
  610. TWL6040_REG_MICRCTL, 0, 0, NULL, 0),
  611. /* Auxiliary FM PGAs */
  612. SND_SOC_DAPM_PGA("AFMAmpL",
  613. TWL6040_REG_MICLCTL, 1, 0, NULL, 0),
  614. SND_SOC_DAPM_PGA("AFMAmpR",
  615. TWL6040_REG_MICRCTL, 1, 0, NULL, 0),
  616. /* ADCs */
  617. SND_SOC_DAPM_ADC("ADC Left", NULL, TWL6040_REG_MICLCTL, 2, 0),
  618. SND_SOC_DAPM_ADC("ADC Right", NULL, TWL6040_REG_MICRCTL, 2, 0),
  619. /* Microphone bias */
  620. SND_SOC_DAPM_SUPPLY("Headset Mic Bias",
  621. TWL6040_REG_AMICBCTL, 0, 0, NULL, 0),
  622. SND_SOC_DAPM_SUPPLY("Main Mic Bias",
  623. TWL6040_REG_AMICBCTL, 4, 0, NULL, 0),
  624. SND_SOC_DAPM_SUPPLY("Digital Mic1 Bias",
  625. TWL6040_REG_DMICBCTL, 0, 0, NULL, 0),
  626. SND_SOC_DAPM_SUPPLY("Digital Mic2 Bias",
  627. TWL6040_REG_DMICBCTL, 4, 0, NULL, 0),
  628. /* DACs */
  629. SND_SOC_DAPM_DAC("HSDAC Left", NULL, SND_SOC_NOPM, 0, 0),
  630. SND_SOC_DAPM_DAC("HSDAC Right", NULL, SND_SOC_NOPM, 0, 0),
  631. SND_SOC_DAPM_DAC("HFDAC Left", NULL, TWL6040_REG_HFLCTL, 0, 0),
  632. SND_SOC_DAPM_DAC("HFDAC Right", NULL, TWL6040_REG_HFRCTL, 0, 0),
  633. /* Virtual DAC for vibra path (DL4 channel) */
  634. SND_SOC_DAPM_DAC("VIBRA DAC", NULL, SND_SOC_NOPM, 0, 0),
  635. SND_SOC_DAPM_MUX("Handsfree Left Playback",
  636. SND_SOC_NOPM, 0, 0, &hfl_mux_controls),
  637. SND_SOC_DAPM_MUX("Handsfree Right Playback",
  638. SND_SOC_NOPM, 0, 0, &hfr_mux_controls),
  639. /* Analog playback Muxes */
  640. SND_SOC_DAPM_MUX("Headset Left Playback",
  641. SND_SOC_NOPM, 0, 0, &hsl_mux_controls),
  642. SND_SOC_DAPM_MUX("Headset Right Playback",
  643. SND_SOC_NOPM, 0, 0, &hsr_mux_controls),
  644. SND_SOC_DAPM_MUX("Vibra Left Playback", SND_SOC_NOPM, 0, 0,
  645. &vibral_mux_controls),
  646. SND_SOC_DAPM_MUX("Vibra Right Playback", SND_SOC_NOPM, 0, 0,
  647. &vibrar_mux_controls),
  648. SND_SOC_DAPM_SWITCH("Earphone Playback", SND_SOC_NOPM, 0, 0,
  649. &ep_path_enable_control),
  650. SND_SOC_DAPM_SWITCH("AUXL Playback", SND_SOC_NOPM, 0, 0,
  651. &auxl_switch_control),
  652. SND_SOC_DAPM_SWITCH("AUXR Playback", SND_SOC_NOPM, 0, 0,
  653. &auxr_switch_control),
  654. /* Analog playback drivers */
  655. SND_SOC_DAPM_OUT_DRV("HF Left Driver",
  656. TWL6040_REG_HFLCTL, 4, 0, NULL, 0),
  657. SND_SOC_DAPM_OUT_DRV("HF Right Driver",
  658. TWL6040_REG_HFRCTL, 4, 0, NULL, 0),
  659. SND_SOC_DAPM_OUT_DRV("HS Left Driver",
  660. TWL6040_REG_HSLCTL, 2, 0, NULL, 0),
  661. SND_SOC_DAPM_OUT_DRV("HS Right Driver",
  662. TWL6040_REG_HSRCTL, 2, 0, NULL, 0),
  663. SND_SOC_DAPM_OUT_DRV_E("Earphone Driver",
  664. TWL6040_REG_EARCTL, 0, 0, NULL, 0,
  665. twl6040_ep_drv_event,
  666. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
  667. SND_SOC_DAPM_OUT_DRV("Vibra Left Driver",
  668. TWL6040_REG_VIBCTLL, 0, 0, NULL, 0),
  669. SND_SOC_DAPM_OUT_DRV("Vibra Right Driver",
  670. TWL6040_REG_VIBCTLR, 0, 0, NULL, 0),
  671. SND_SOC_DAPM_SUPPLY("Vibra Left Control", TWL6040_REG_VIBCTLL, 2, 0,
  672. NULL, 0),
  673. SND_SOC_DAPM_SUPPLY("Vibra Right Control", TWL6040_REG_VIBCTLR, 2, 0,
  674. NULL, 0),
  675. SND_SOC_DAPM_SUPPLY_S("HSDAC Power", 1, SND_SOC_NOPM, 0, 0,
  676. twl6040_hs_dac_event,
  677. SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
  678. /* Analog playback PGAs */
  679. SND_SOC_DAPM_PGA("HF Left PGA",
  680. TWL6040_REG_HFLCTL, 1, 0, NULL, 0),
  681. SND_SOC_DAPM_PGA("HF Right PGA",
  682. TWL6040_REG_HFRCTL, 1, 0, NULL, 0),
  683. };
  684. static const struct snd_soc_dapm_route intercon[] = {
  685. /* Stream -> DAC mapping */
  686. {"HSDAC Left", NULL, "Legacy Playback"},
  687. {"HSDAC Left", NULL, "Headset Playback"},
  688. {"HSDAC Right", NULL, "Legacy Playback"},
  689. {"HSDAC Right", NULL, "Headset Playback"},
  690. {"HFDAC Left", NULL, "Legacy Playback"},
  691. {"HFDAC Left", NULL, "Handsfree Playback"},
  692. {"HFDAC Right", NULL, "Legacy Playback"},
  693. {"HFDAC Right", NULL, "Handsfree Playback"},
  694. {"VIBRA DAC", NULL, "Legacy Playback"},
  695. {"VIBRA DAC", NULL, "Vibra Playback"},
  696. /* ADC -> Stream mapping */
  697. {"Legacy Capture" , NULL, "ADC Left"},
  698. {"Capture", NULL, "ADC Left"},
  699. {"Legacy Capture", NULL, "ADC Right"},
  700. {"Capture" , NULL, "ADC Right"},
  701. /* Capture path */
  702. {"Analog Left Capture Route", "Headset Mic", "HSMIC"},
  703. {"Analog Left Capture Route", "Main Mic", "MAINMIC"},
  704. {"Analog Left Capture Route", "Aux/FM Left", "AFML"},
  705. {"Analog Right Capture Route", "Headset Mic", "HSMIC"},
  706. {"Analog Right Capture Route", "Sub Mic", "SUBMIC"},
  707. {"Analog Right Capture Route", "Aux/FM Right", "AFMR"},
  708. {"MicAmpL", NULL, "Analog Left Capture Route"},
  709. {"MicAmpR", NULL, "Analog Right Capture Route"},
  710. {"ADC Left", NULL, "MicAmpL"},
  711. {"ADC Right", NULL, "MicAmpR"},
  712. /* AFM path */
  713. {"AFMAmpL", NULL, "AFML"},
  714. {"AFMAmpR", NULL, "AFMR"},
  715. {"HSDAC Left", NULL, "HSDAC Power"},
  716. {"HSDAC Right", NULL, "HSDAC Power"},
  717. {"Headset Left Playback", "HS DAC", "HSDAC Left"},
  718. {"Headset Left Playback", "Line-In amp", "AFMAmpL"},
  719. {"Headset Right Playback", "HS DAC", "HSDAC Right"},
  720. {"Headset Right Playback", "Line-In amp", "AFMAmpR"},
  721. {"HS Left Driver", NULL, "Headset Left Playback"},
  722. {"HS Right Driver", NULL, "Headset Right Playback"},
  723. {"HSOL", NULL, "HS Left Driver"},
  724. {"HSOR", NULL, "HS Right Driver"},
  725. /* Earphone playback path */
  726. {"Earphone Playback", "Switch", "HSDAC Left"},
  727. {"Earphone Driver", NULL, "Earphone Playback"},
  728. {"EP", NULL, "Earphone Driver"},
  729. {"Handsfree Left Playback", "HF DAC", "HFDAC Left"},
  730. {"Handsfree Left Playback", "Line-In amp", "AFMAmpL"},
  731. {"Handsfree Right Playback", "HF DAC", "HFDAC Right"},
  732. {"Handsfree Right Playback", "Line-In amp", "AFMAmpR"},
  733. {"HF Left PGA", NULL, "Handsfree Left Playback"},
  734. {"HF Right PGA", NULL, "Handsfree Right Playback"},
  735. {"HF Left Driver", NULL, "HF Left PGA"},
  736. {"HF Right Driver", NULL, "HF Right PGA"},
  737. {"HFL", NULL, "HF Left Driver"},
  738. {"HFR", NULL, "HF Right Driver"},
  739. {"AUXL Playback", "Switch", "HF Left PGA"},
  740. {"AUXR Playback", "Switch", "HF Right PGA"},
  741. {"AUXL", NULL, "AUXL Playback"},
  742. {"AUXR", NULL, "AUXR Playback"},
  743. /* Vibrator paths */
  744. {"Vibra Left Playback", "Audio PDM", "VIBRA DAC"},
  745. {"Vibra Right Playback", "Audio PDM", "VIBRA DAC"},
  746. {"Vibra Left Driver", NULL, "Vibra Left Playback"},
  747. {"Vibra Right Driver", NULL, "Vibra Right Playback"},
  748. {"Vibra Left Driver", NULL, "Vibra Left Control"},
  749. {"Vibra Right Driver", NULL, "Vibra Right Control"},
  750. {"VIBRAL", NULL, "Vibra Left Driver"},
  751. {"VIBRAR", NULL, "Vibra Right Driver"},
  752. };
  753. static int twl6040_set_bias_level(struct snd_soc_codec *codec,
  754. enum snd_soc_bias_level level)
  755. {
  756. struct twl6040 *twl6040 = codec->control_data;
  757. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  758. int ret;
  759. switch (level) {
  760. case SND_SOC_BIAS_ON:
  761. break;
  762. case SND_SOC_BIAS_PREPARE:
  763. break;
  764. case SND_SOC_BIAS_STANDBY:
  765. if (priv->codec_powered)
  766. break;
  767. ret = twl6040_power(twl6040, 1);
  768. if (ret)
  769. return ret;
  770. priv->codec_powered = 1;
  771. twl6040_restore_regs(codec);
  772. /* Set external boost GPO */
  773. twl6040_write(codec, TWL6040_REG_GPOCTL, 0x02);
  774. break;
  775. case SND_SOC_BIAS_OFF:
  776. if (!priv->codec_powered)
  777. break;
  778. twl6040_power(twl6040, 0);
  779. priv->codec_powered = 0;
  780. break;
  781. }
  782. codec->dapm.bias_level = level;
  783. return 0;
  784. }
  785. static int twl6040_startup(struct snd_pcm_substream *substream,
  786. struct snd_soc_dai *dai)
  787. {
  788. struct snd_soc_codec *codec = dai->codec;
  789. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  790. snd_pcm_hw_constraint_list(substream->runtime, 0,
  791. SNDRV_PCM_HW_PARAM_RATE,
  792. &sysclk_constraints[priv->pll_power_mode]);
  793. return 0;
  794. }
  795. static int twl6040_hw_params(struct snd_pcm_substream *substream,
  796. struct snd_pcm_hw_params *params,
  797. struct snd_soc_dai *dai)
  798. {
  799. struct snd_soc_codec *codec = dai->codec;
  800. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  801. int rate;
  802. rate = params_rate(params);
  803. switch (rate) {
  804. case 11250:
  805. case 22500:
  806. case 44100:
  807. case 88200:
  808. /* These rates are not supported when HPPLL is in use */
  809. if (unlikely(priv->pll == TWL6040_SYSCLK_SEL_HPPLL)) {
  810. dev_err(codec->dev, "HPPLL does not support rate %d\n",
  811. rate);
  812. return -EINVAL;
  813. }
  814. priv->sysclk = 17640000;
  815. break;
  816. case 8000:
  817. case 16000:
  818. case 32000:
  819. case 48000:
  820. case 96000:
  821. priv->sysclk = 19200000;
  822. break;
  823. default:
  824. dev_err(codec->dev, "unsupported rate %d\n", rate);
  825. return -EINVAL;
  826. }
  827. return 0;
  828. }
  829. static int twl6040_prepare(struct snd_pcm_substream *substream,
  830. struct snd_soc_dai *dai)
  831. {
  832. struct snd_soc_codec *codec = dai->codec;
  833. struct twl6040 *twl6040 = codec->control_data;
  834. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  835. int ret;
  836. if (!priv->sysclk) {
  837. dev_err(codec->dev,
  838. "no mclk configured, call set_sysclk() on init\n");
  839. return -EINVAL;
  840. }
  841. ret = twl6040_set_pll(twl6040, priv->pll, priv->clk_in, priv->sysclk);
  842. if (ret) {
  843. dev_err(codec->dev, "Can not set PLL (%d)\n", ret);
  844. return -EPERM;
  845. }
  846. return 0;
  847. }
  848. static int twl6040_set_dai_sysclk(struct snd_soc_dai *codec_dai,
  849. int clk_id, unsigned int freq, int dir)
  850. {
  851. struct snd_soc_codec *codec = codec_dai->codec;
  852. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  853. switch (clk_id) {
  854. case TWL6040_SYSCLK_SEL_LPPLL:
  855. case TWL6040_SYSCLK_SEL_HPPLL:
  856. priv->pll = clk_id;
  857. priv->clk_in = freq;
  858. break;
  859. default:
  860. dev_err(codec->dev, "unknown clk_id %d\n", clk_id);
  861. return -EINVAL;
  862. }
  863. return 0;
  864. }
  865. static void twl6040_mute_path(struct snd_soc_codec *codec, enum twl6040_dai_id id,
  866. int mute)
  867. {
  868. struct twl6040 *twl6040 = codec->control_data;
  869. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  870. int hslctl, hsrctl, earctl;
  871. int hflctl, hfrctl;
  872. switch (id) {
  873. case TWL6040_DAI_DL1:
  874. hslctl = twl6040_read_reg_cache(codec, TWL6040_REG_HSLCTL);
  875. hsrctl = twl6040_read_reg_cache(codec, TWL6040_REG_HSRCTL);
  876. earctl = twl6040_read_reg_cache(codec, TWL6040_REG_EARCTL);
  877. if (mute) {
  878. /* Power down drivers and DACs */
  879. earctl &= ~0x01;
  880. hslctl &= ~(TWL6040_HSDRVENA | TWL6040_HSDACENA);
  881. hsrctl &= ~(TWL6040_HSDRVENA | TWL6040_HSDACENA);
  882. }
  883. twl6040_reg_write(twl6040, TWL6040_REG_EARCTL, earctl);
  884. twl6040_reg_write(twl6040, TWL6040_REG_HSLCTL, hslctl);
  885. twl6040_reg_write(twl6040, TWL6040_REG_HSRCTL, hsrctl);
  886. priv->dl1_unmuted = !mute;
  887. break;
  888. case TWL6040_DAI_DL2:
  889. hflctl = twl6040_read_reg_cache(codec, TWL6040_REG_HFLCTL);
  890. hfrctl = twl6040_read_reg_cache(codec, TWL6040_REG_HFRCTL);
  891. if (mute) {
  892. /* Power down drivers and DACs */
  893. hflctl &= ~(TWL6040_HFDACENA | TWL6040_HFPGAENA |
  894. TWL6040_HFDRVENA);
  895. hfrctl &= ~(TWL6040_HFDACENA | TWL6040_HFPGAENA |
  896. TWL6040_HFDRVENA);
  897. }
  898. twl6040_reg_write(twl6040, TWL6040_REG_HFLCTL, hflctl);
  899. twl6040_reg_write(twl6040, TWL6040_REG_HFRCTL, hfrctl);
  900. priv->dl2_unmuted = !mute;
  901. break;
  902. default:
  903. break;
  904. }
  905. }
  906. static int twl6040_digital_mute(struct snd_soc_dai *dai, int mute)
  907. {
  908. switch (dai->id) {
  909. case TWL6040_DAI_LEGACY:
  910. twl6040_mute_path(dai->codec, TWL6040_DAI_DL1, mute);
  911. twl6040_mute_path(dai->codec, TWL6040_DAI_DL2, mute);
  912. break;
  913. case TWL6040_DAI_DL1:
  914. case TWL6040_DAI_DL2:
  915. twl6040_mute_path(dai->codec, dai->id, mute);
  916. break;
  917. default:
  918. break;
  919. }
  920. return 0;
  921. }
  922. static const struct snd_soc_dai_ops twl6040_dai_ops = {
  923. .startup = twl6040_startup,
  924. .hw_params = twl6040_hw_params,
  925. .prepare = twl6040_prepare,
  926. .set_sysclk = twl6040_set_dai_sysclk,
  927. .digital_mute = twl6040_digital_mute,
  928. };
  929. static struct snd_soc_dai_driver twl6040_dai[] = {
  930. {
  931. .name = "twl6040-legacy",
  932. .id = TWL6040_DAI_LEGACY,
  933. .playback = {
  934. .stream_name = "Legacy Playback",
  935. .channels_min = 1,
  936. .channels_max = 5,
  937. .rates = TWL6040_RATES,
  938. .formats = TWL6040_FORMATS,
  939. },
  940. .capture = {
  941. .stream_name = "Legacy Capture",
  942. .channels_min = 1,
  943. .channels_max = 2,
  944. .rates = TWL6040_RATES,
  945. .formats = TWL6040_FORMATS,
  946. },
  947. .ops = &twl6040_dai_ops,
  948. },
  949. {
  950. .name = "twl6040-ul",
  951. .id = TWL6040_DAI_UL,
  952. .capture = {
  953. .stream_name = "Capture",
  954. .channels_min = 1,
  955. .channels_max = 2,
  956. .rates = TWL6040_RATES,
  957. .formats = TWL6040_FORMATS,
  958. },
  959. .ops = &twl6040_dai_ops,
  960. },
  961. {
  962. .name = "twl6040-dl1",
  963. .id = TWL6040_DAI_DL1,
  964. .playback = {
  965. .stream_name = "Headset Playback",
  966. .channels_min = 1,
  967. .channels_max = 2,
  968. .rates = TWL6040_RATES,
  969. .formats = TWL6040_FORMATS,
  970. },
  971. .ops = &twl6040_dai_ops,
  972. },
  973. {
  974. .name = "twl6040-dl2",
  975. .id = TWL6040_DAI_DL2,
  976. .playback = {
  977. .stream_name = "Handsfree Playback",
  978. .channels_min = 1,
  979. .channels_max = 2,
  980. .rates = TWL6040_RATES,
  981. .formats = TWL6040_FORMATS,
  982. },
  983. .ops = &twl6040_dai_ops,
  984. },
  985. {
  986. .name = "twl6040-vib",
  987. .id = TWL6040_DAI_VIB,
  988. .playback = {
  989. .stream_name = "Vibra Playback",
  990. .channels_min = 1,
  991. .channels_max = 1,
  992. .rates = SNDRV_PCM_RATE_CONTINUOUS,
  993. .formats = TWL6040_FORMATS,
  994. },
  995. .ops = &twl6040_dai_ops,
  996. },
  997. };
  998. #ifdef CONFIG_PM
  999. static int twl6040_suspend(struct snd_soc_codec *codec)
  1000. {
  1001. twl6040_set_bias_level(codec, SND_SOC_BIAS_OFF);
  1002. return 0;
  1003. }
  1004. static int twl6040_resume(struct snd_soc_codec *codec)
  1005. {
  1006. twl6040_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  1007. return 0;
  1008. }
  1009. #else
  1010. #define twl6040_suspend NULL
  1011. #define twl6040_resume NULL
  1012. #endif
  1013. static int twl6040_probe(struct snd_soc_codec *codec)
  1014. {
  1015. struct twl6040_data *priv;
  1016. struct platform_device *pdev = container_of(codec->dev,
  1017. struct platform_device, dev);
  1018. int ret = 0;
  1019. priv = devm_kzalloc(codec->dev, sizeof(*priv), GFP_KERNEL);
  1020. if (priv == NULL)
  1021. return -ENOMEM;
  1022. snd_soc_codec_set_drvdata(codec, priv);
  1023. priv->codec = codec;
  1024. codec->control_data = dev_get_drvdata(codec->dev->parent);
  1025. priv->plug_irq = platform_get_irq(pdev, 0);
  1026. if (priv->plug_irq < 0) {
  1027. dev_err(codec->dev, "invalid irq\n");
  1028. return -EINVAL;
  1029. }
  1030. INIT_DELAYED_WORK(&priv->hs_jack.work, twl6040_accessory_work);
  1031. mutex_init(&priv->mutex);
  1032. ret = request_threaded_irq(priv->plug_irq, NULL,
  1033. twl6040_audio_handler, IRQF_NO_SUSPEND,
  1034. "twl6040_irq_plug", codec);
  1035. if (ret) {
  1036. dev_err(codec->dev, "PLUG IRQ request failed: %d\n", ret);
  1037. return ret;
  1038. }
  1039. twl6040_init_chip(codec);
  1040. /* power on device */
  1041. return twl6040_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  1042. }
  1043. static int twl6040_remove(struct snd_soc_codec *codec)
  1044. {
  1045. struct twl6040_data *priv = snd_soc_codec_get_drvdata(codec);
  1046. free_irq(priv->plug_irq, codec);
  1047. twl6040_set_bias_level(codec, SND_SOC_BIAS_OFF);
  1048. return 0;
  1049. }
  1050. static struct snd_soc_codec_driver soc_codec_dev_twl6040 = {
  1051. .probe = twl6040_probe,
  1052. .remove = twl6040_remove,
  1053. .suspend = twl6040_suspend,
  1054. .resume = twl6040_resume,
  1055. .read = twl6040_read_reg_cache,
  1056. .write = twl6040_write,
  1057. .set_bias_level = twl6040_set_bias_level,
  1058. .reg_cache_size = ARRAY_SIZE(twl6040_reg),
  1059. .reg_word_size = sizeof(u8),
  1060. .reg_cache_default = twl6040_reg,
  1061. .ignore_pmdown_time = true,
  1062. .controls = twl6040_snd_controls,
  1063. .num_controls = ARRAY_SIZE(twl6040_snd_controls),
  1064. .dapm_widgets = twl6040_dapm_widgets,
  1065. .num_dapm_widgets = ARRAY_SIZE(twl6040_dapm_widgets),
  1066. .dapm_routes = intercon,
  1067. .num_dapm_routes = ARRAY_SIZE(intercon),
  1068. };
  1069. static int twl6040_codec_probe(struct platform_device *pdev)
  1070. {
  1071. return snd_soc_register_codec(&pdev->dev, &soc_codec_dev_twl6040,
  1072. twl6040_dai, ARRAY_SIZE(twl6040_dai));
  1073. }
  1074. static int twl6040_codec_remove(struct platform_device *pdev)
  1075. {
  1076. snd_soc_unregister_codec(&pdev->dev);
  1077. return 0;
  1078. }
  1079. static struct platform_driver twl6040_codec_driver = {
  1080. .driver = {
  1081. .name = "twl6040-codec",
  1082. .owner = THIS_MODULE,
  1083. },
  1084. .probe = twl6040_codec_probe,
  1085. .remove = twl6040_codec_remove,
  1086. };
  1087. module_platform_driver(twl6040_codec_driver);
  1088. MODULE_DESCRIPTION("ASoC TWL6040 codec driver");
  1089. MODULE_AUTHOR("Misael Lopez Cruz");
  1090. MODULE_LICENSE("GPL");