88pm860x-codec.c 44 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488
  1. /*
  2. * 88pm860x-codec.c -- 88PM860x ALSA SoC Audio Driver
  3. *
  4. * Copyright 2010 Marvell International Ltd.
  5. * Author: Haojian Zhuang <haojian.zhuang@marvell.com>
  6. *
  7. * This program is free software; you can redistribute it and/or modify
  8. * it under the terms of the GNU General Public License version 2 as
  9. * published by the Free Software Foundation.
  10. */
  11. #include <linux/kernel.h>
  12. #include <linux/module.h>
  13. #include <linux/i2c.h>
  14. #include <linux/platform_device.h>
  15. #include <linux/mfd/88pm860x.h>
  16. #include <linux/slab.h>
  17. #include <linux/delay.h>
  18. #include <sound/core.h>
  19. #include <sound/pcm.h>
  20. #include <sound/pcm_params.h>
  21. #include <sound/soc.h>
  22. #include <sound/tlv.h>
  23. #include <sound/initval.h>
  24. #include <sound/jack.h>
  25. #include <trace/events/asoc.h>
  26. #include "88pm860x-codec.h"
  27. #define MAX_NAME_LEN 20
  28. #define REG_CACHE_SIZE 0x40
  29. #define REG_CACHE_BASE 0xb0
  30. /* Status Register 1 (0x01) */
  31. #define REG_STATUS_1 0x01
  32. #define MIC_STATUS (1 << 7)
  33. #define HOOK_STATUS (1 << 6)
  34. #define HEADSET_STATUS (1 << 5)
  35. /* Mic Detection Register (0x37) */
  36. #define REG_MIC_DET 0x37
  37. #define CONTINUOUS_POLLING (3 << 1)
  38. #define EN_MIC_DET (1 << 0)
  39. #define MICDET_MASK 0x07
  40. /* Headset Detection Register (0x38) */
  41. #define REG_HS_DET 0x38
  42. #define EN_HS_DET (1 << 0)
  43. /* Misc2 Register (0x42) */
  44. #define REG_MISC2 0x42
  45. #define AUDIO_PLL (1 << 5)
  46. #define AUDIO_SECTION_RESET (1 << 4)
  47. #define AUDIO_SECTION_ON (1 << 3)
  48. /* PCM Interface Register 2 (0xb1) */
  49. #define PCM_INF2_BCLK (1 << 6) /* Bit clock polarity */
  50. #define PCM_INF2_FS (1 << 5) /* Frame Sync polarity */
  51. #define PCM_INF2_MASTER (1 << 4) /* Master / Slave */
  52. #define PCM_INF2_18WL (1 << 3) /* 18 / 16 bits */
  53. #define PCM_GENERAL_I2S 0
  54. #define PCM_EXACT_I2S 1
  55. #define PCM_LEFT_I2S 2
  56. #define PCM_RIGHT_I2S 3
  57. #define PCM_SHORT_FS 4
  58. #define PCM_LONG_FS 5
  59. #define PCM_MODE_MASK 7
  60. /* I2S Interface Register 4 (0xbe) */
  61. #define I2S_EQU_BYP (1 << 6)
  62. /* DAC Offset Register (0xcb) */
  63. #define DAC_MUTE (1 << 7)
  64. #define MUTE_LEFT (1 << 6)
  65. #define MUTE_RIGHT (1 << 2)
  66. /* ADC Analog Register 1 (0xd0) */
  67. #define REG_ADC_ANA_1 0xd0
  68. #define MIC1BIAS_MASK 0x60
  69. /* Earpiece/Speaker Control Register 2 (0xda) */
  70. #define REG_EAR2 0xda
  71. #define RSYNC_CHANGE (1 << 2)
  72. /* Audio Supplies Register 2 (0xdc) */
  73. #define REG_SUPPLIES2 0xdc
  74. #define LDO15_READY (1 << 4)
  75. #define LDO15_EN (1 << 3)
  76. #define CPUMP_READY (1 << 2)
  77. #define CPUMP_EN (1 << 1)
  78. #define AUDIO_EN (1 << 0)
  79. #define SUPPLY_MASK (LDO15_EN | CPUMP_EN | AUDIO_EN)
  80. /* Audio Enable Register 1 (0xdd) */
  81. #define ADC_MOD_RIGHT (1 << 1)
  82. #define ADC_MOD_LEFT (1 << 0)
  83. /* Audio Enable Register 2 (0xde) */
  84. #define ADC_LEFT (1 << 5)
  85. #define ADC_RIGHT (1 << 4)
  86. /* DAC Enable Register 2 (0xe1) */
  87. #define DAC_LEFT (1 << 5)
  88. #define DAC_RIGHT (1 << 4)
  89. #define MODULATOR (1 << 3)
  90. /* Shorts Register (0xeb) */
  91. #define REG_SHORTS 0xeb
  92. #define CLR_SHORT_LO2 (1 << 7)
  93. #define SHORT_LO2 (1 << 6)
  94. #define CLR_SHORT_LO1 (1 << 5)
  95. #define SHORT_LO1 (1 << 4)
  96. #define CLR_SHORT_HS2 (1 << 3)
  97. #define SHORT_HS2 (1 << 2)
  98. #define CLR_SHORT_HS1 (1 << 1)
  99. #define SHORT_HS1 (1 << 0)
  100. /*
  101. * This widget should be just after DAC & PGA in DAPM power-on sequence and
  102. * before DAC & PGA in DAPM power-off sequence.
  103. */
  104. #define PM860X_DAPM_OUTPUT(wname, wevent) \
  105. { .id = snd_soc_dapm_pga, .name = wname, .reg = SND_SOC_NOPM, \
  106. .shift = 0, .invert = 0, .kcontrol_news = NULL, \
  107. .num_kcontrols = 0, .event = wevent, \
  108. .event_flags = SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD, }
  109. struct pm860x_det {
  110. struct snd_soc_jack *hp_jack;
  111. struct snd_soc_jack *mic_jack;
  112. int hp_det;
  113. int mic_det;
  114. int hook_det;
  115. int hs_shrt;
  116. int lo_shrt;
  117. };
  118. struct pm860x_priv {
  119. unsigned int sysclk;
  120. unsigned int pcmclk;
  121. unsigned int dir;
  122. unsigned int filter;
  123. struct snd_soc_codec *codec;
  124. struct i2c_client *i2c;
  125. struct pm860x_chip *chip;
  126. struct pm860x_det det;
  127. int irq[4];
  128. unsigned char name[4][MAX_NAME_LEN];
  129. };
  130. /* -9450dB to 0dB in 150dB steps ( mute instead of -9450dB) */
  131. static const DECLARE_TLV_DB_SCALE(dpga_tlv, -9450, 150, 1);
  132. /* -9dB to 0db in 3dB steps */
  133. static const DECLARE_TLV_DB_SCALE(adc_tlv, -900, 300, 0);
  134. /* {-23, -17, -13.5, -11, -9, -6, -3, 0}dB */
  135. static const unsigned int mic_tlv[] = {
  136. TLV_DB_RANGE_HEAD(5),
  137. 0, 0, TLV_DB_SCALE_ITEM(-2300, 0, 0),
  138. 1, 1, TLV_DB_SCALE_ITEM(-1700, 0, 0),
  139. 2, 2, TLV_DB_SCALE_ITEM(-1350, 0, 0),
  140. 3, 3, TLV_DB_SCALE_ITEM(-1100, 0, 0),
  141. 4, 7, TLV_DB_SCALE_ITEM(-900, 300, 0),
  142. };
  143. /* {0, 0, 0, -6, 0, 6, 12, 18}dB */
  144. static const unsigned int aux_tlv[] = {
  145. TLV_DB_RANGE_HEAD(2),
  146. 0, 2, TLV_DB_SCALE_ITEM(0, 0, 0),
  147. 3, 7, TLV_DB_SCALE_ITEM(-600, 600, 0),
  148. };
  149. /* {-16, -13, -10, -7, -5.2, -3,3, -2.2, 0}dB, mute instead of -16dB */
  150. static const unsigned int out_tlv[] = {
  151. TLV_DB_RANGE_HEAD(4),
  152. 0, 3, TLV_DB_SCALE_ITEM(-1600, 300, 1),
  153. 4, 4, TLV_DB_SCALE_ITEM(-520, 0, 0),
  154. 5, 5, TLV_DB_SCALE_ITEM(-330, 0, 0),
  155. 6, 7, TLV_DB_SCALE_ITEM(-220, 220, 0),
  156. };
  157. static const unsigned int st_tlv[] = {
  158. TLV_DB_RANGE_HEAD(8),
  159. 0, 1, TLV_DB_SCALE_ITEM(-12041, 602, 0),
  160. 2, 3, TLV_DB_SCALE_ITEM(-11087, 250, 0),
  161. 4, 5, TLV_DB_SCALE_ITEM(-10643, 158, 0),
  162. 6, 7, TLV_DB_SCALE_ITEM(-10351, 116, 0),
  163. 8, 9, TLV_DB_SCALE_ITEM(-10133, 92, 0),
  164. 10, 13, TLV_DB_SCALE_ITEM(-9958, 70, 0),
  165. 14, 17, TLV_DB_SCALE_ITEM(-9689, 53, 0),
  166. 18, 271, TLV_DB_SCALE_ITEM(-9484, 37, 0),
  167. };
  168. /* Sidetone Gain = M * 2^(-5-N) */
  169. struct st_gain {
  170. unsigned int db;
  171. unsigned int m;
  172. unsigned int n;
  173. };
  174. static struct st_gain st_table[] = {
  175. {-12041, 1, 15}, {-11439, 1, 14}, {-11087, 3, 15}, {-10837, 1, 13},
  176. {-10643, 5, 15}, {-10485, 3, 14}, {-10351, 7, 15}, {-10235, 1, 12},
  177. {-10133, 9, 15}, {-10041, 5, 14}, { -9958, 11, 15}, { -9883, 3, 13},
  178. { -9813, 13, 15}, { -9749, 7, 14}, { -9689, 15, 15}, { -9633, 1, 11},
  179. { -9580, 17, 15}, { -9531, 9, 14}, { -9484, 19, 15}, { -9439, 5, 13},
  180. { -9397, 21, 15}, { -9356, 11, 14}, { -9318, 23, 15}, { -9281, 3, 12},
  181. { -9245, 25, 15}, { -9211, 13, 14}, { -9178, 27, 15}, { -9147, 7, 13},
  182. { -9116, 29, 15}, { -9087, 15, 14}, { -9058, 31, 15}, { -9031, 1, 10},
  183. { -8978, 17, 14}, { -8929, 9, 13}, { -8882, 19, 14}, { -8837, 5, 12},
  184. { -8795, 21, 14}, { -8754, 11, 13}, { -8716, 23, 14}, { -8679, 3, 11},
  185. { -8643, 25, 14}, { -8609, 13, 13}, { -8576, 27, 14}, { -8545, 7, 12},
  186. { -8514, 29, 14}, { -8485, 15, 13}, { -8456, 31, 14}, { -8429, 1, 9},
  187. { -8376, 17, 13}, { -8327, 9, 12}, { -8280, 19, 13}, { -8235, 5, 11},
  188. { -8193, 21, 13}, { -8152, 11, 12}, { -8114, 23, 13}, { -8077, 3, 10},
  189. { -8041, 25, 13}, { -8007, 13, 12}, { -7974, 27, 13}, { -7943, 7, 11},
  190. { -7912, 29, 13}, { -7883, 15, 12}, { -7854, 31, 13}, { -7827, 1, 8},
  191. { -7774, 17, 12}, { -7724, 9, 11}, { -7678, 19, 12}, { -7633, 5, 10},
  192. { -7591, 21, 12}, { -7550, 11, 11}, { -7512, 23, 12}, { -7475, 3, 9},
  193. { -7439, 25, 12}, { -7405, 13, 11}, { -7372, 27, 12}, { -7341, 7, 10},
  194. { -7310, 29, 12}, { -7281, 15, 11}, { -7252, 31, 12}, { -7225, 1, 7},
  195. { -7172, 17, 11}, { -7122, 9, 10}, { -7075, 19, 11}, { -7031, 5, 9},
  196. { -6989, 21, 11}, { -6948, 11, 10}, { -6910, 23, 11}, { -6873, 3, 8},
  197. { -6837, 25, 11}, { -6803, 13, 10}, { -6770, 27, 11}, { -6739, 7, 9},
  198. { -6708, 29, 11}, { -6679, 15, 10}, { -6650, 31, 11}, { -6623, 1, 6},
  199. { -6570, 17, 10}, { -6520, 9, 9}, { -6473, 19, 10}, { -6429, 5, 8},
  200. { -6386, 21, 10}, { -6346, 11, 9}, { -6307, 23, 10}, { -6270, 3, 7},
  201. { -6235, 25, 10}, { -6201, 13, 9}, { -6168, 27, 10}, { -6137, 7, 8},
  202. { -6106, 29, 10}, { -6077, 15, 9}, { -6048, 31, 10}, { -6021, 1, 5},
  203. { -5968, 17, 9}, { -5918, 9, 8}, { -5871, 19, 9}, { -5827, 5, 7},
  204. { -5784, 21, 9}, { -5744, 11, 8}, { -5705, 23, 9}, { -5668, 3, 6},
  205. { -5633, 25, 9}, { -5599, 13, 8}, { -5566, 27, 9}, { -5535, 7, 7},
  206. { -5504, 29, 9}, { -5475, 15, 8}, { -5446, 31, 9}, { -5419, 1, 4},
  207. { -5366, 17, 8}, { -5316, 9, 7}, { -5269, 19, 8}, { -5225, 5, 6},
  208. { -5182, 21, 8}, { -5142, 11, 7}, { -5103, 23, 8}, { -5066, 3, 5},
  209. { -5031, 25, 8}, { -4997, 13, 7}, { -4964, 27, 8}, { -4932, 7, 6},
  210. { -4902, 29, 8}, { -4873, 15, 7}, { -4844, 31, 8}, { -4816, 1, 3},
  211. { -4764, 17, 7}, { -4714, 9, 6}, { -4667, 19, 7}, { -4623, 5, 5},
  212. { -4580, 21, 7}, { -4540, 11, 6}, { -4501, 23, 7}, { -4464, 3, 4},
  213. { -4429, 25, 7}, { -4395, 13, 6}, { -4362, 27, 7}, { -4330, 7, 5},
  214. { -4300, 29, 7}, { -4270, 15, 6}, { -4242, 31, 7}, { -4214, 1, 2},
  215. { -4162, 17, 6}, { -4112, 9, 5}, { -4065, 19, 6}, { -4021, 5, 4},
  216. { -3978, 21, 6}, { -3938, 11, 5}, { -3899, 23, 6}, { -3862, 3, 3},
  217. { -3827, 25, 6}, { -3793, 13, 5}, { -3760, 27, 6}, { -3728, 7, 4},
  218. { -3698, 29, 6}, { -3668, 15, 5}, { -3640, 31, 6}, { -3612, 1, 1},
  219. { -3560, 17, 5}, { -3510, 9, 4}, { -3463, 19, 5}, { -3419, 5, 3},
  220. { -3376, 21, 5}, { -3336, 11, 4}, { -3297, 23, 5}, { -3260, 3, 2},
  221. { -3225, 25, 5}, { -3191, 13, 4}, { -3158, 27, 5}, { -3126, 7, 3},
  222. { -3096, 29, 5}, { -3066, 15, 4}, { -3038, 31, 5}, { -3010, 1, 0},
  223. { -2958, 17, 4}, { -2908, 9, 3}, { -2861, 19, 4}, { -2816, 5, 2},
  224. { -2774, 21, 4}, { -2734, 11, 3}, { -2695, 23, 4}, { -2658, 3, 1},
  225. { -2623, 25, 4}, { -2589, 13, 3}, { -2556, 27, 4}, { -2524, 7, 2},
  226. { -2494, 29, 4}, { -2464, 15, 3}, { -2436, 31, 4}, { -2408, 2, 0},
  227. { -2356, 17, 3}, { -2306, 9, 2}, { -2259, 19, 3}, { -2214, 5, 1},
  228. { -2172, 21, 3}, { -2132, 11, 2}, { -2093, 23, 3}, { -2056, 3, 0},
  229. { -2021, 25, 3}, { -1987, 13, 2}, { -1954, 27, 3}, { -1922, 7, 1},
  230. { -1892, 29, 3}, { -1862, 15, 2}, { -1834, 31, 3}, { -1806, 4, 0},
  231. { -1754, 17, 2}, { -1704, 9, 1}, { -1657, 19, 2}, { -1612, 5, 0},
  232. { -1570, 21, 2}, { -1530, 11, 1}, { -1491, 23, 2}, { -1454, 6, 0},
  233. { -1419, 25, 2}, { -1384, 13, 1}, { -1352, 27, 2}, { -1320, 7, 0},
  234. { -1290, 29, 2}, { -1260, 15, 1}, { -1232, 31, 2}, { -1204, 8, 0},
  235. { -1151, 17, 1}, { -1102, 9, 0}, { -1055, 19, 1}, { -1010, 10, 0},
  236. { -968, 21, 1}, { -928, 11, 0}, { -889, 23, 1}, { -852, 12, 0},
  237. { -816, 25, 1}, { -782, 13, 0}, { -750, 27, 1}, { -718, 14, 0},
  238. { -688, 29, 1}, { -658, 15, 0}, { -630, 31, 1}, { -602, 16, 0},
  239. { -549, 17, 0}, { -500, 18, 0}, { -453, 19, 0}, { -408, 20, 0},
  240. { -366, 21, 0}, { -325, 22, 0}, { -287, 23, 0}, { -250, 24, 0},
  241. { -214, 25, 0}, { -180, 26, 0}, { -148, 27, 0}, { -116, 28, 0},
  242. { -86, 29, 0}, { -56, 30, 0}, { -28, 31, 0}, { 0, 0, 0},
  243. };
  244. static int pm860x_volatile(unsigned int reg)
  245. {
  246. BUG_ON(reg >= REG_CACHE_SIZE);
  247. switch (reg) {
  248. case PM860X_AUDIO_SUPPLIES_2:
  249. return 1;
  250. }
  251. return 0;
  252. }
  253. static unsigned int pm860x_read_reg_cache(struct snd_soc_codec *codec,
  254. unsigned int reg)
  255. {
  256. unsigned char *cache = codec->reg_cache;
  257. BUG_ON(reg >= REG_CACHE_SIZE);
  258. if (pm860x_volatile(reg))
  259. return cache[reg];
  260. reg += REG_CACHE_BASE;
  261. return pm860x_reg_read(codec->control_data, reg);
  262. }
  263. static int pm860x_write_reg_cache(struct snd_soc_codec *codec,
  264. unsigned int reg, unsigned int value)
  265. {
  266. unsigned char *cache = codec->reg_cache;
  267. BUG_ON(reg >= REG_CACHE_SIZE);
  268. if (!pm860x_volatile(reg))
  269. cache[reg] = (unsigned char)value;
  270. reg += REG_CACHE_BASE;
  271. return pm860x_reg_write(codec->control_data, reg, value);
  272. }
  273. static int snd_soc_get_volsw_2r_st(struct snd_kcontrol *kcontrol,
  274. struct snd_ctl_elem_value *ucontrol)
  275. {
  276. struct soc_mixer_control *mc =
  277. (struct soc_mixer_control *)kcontrol->private_value;
  278. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  279. unsigned int reg = mc->reg;
  280. unsigned int reg2 = mc->rreg;
  281. int val[2], val2[2], i;
  282. val[0] = snd_soc_read(codec, reg) & 0x3f;
  283. val[1] = (snd_soc_read(codec, PM860X_SIDETONE_SHIFT) >> 4) & 0xf;
  284. val2[0] = snd_soc_read(codec, reg2) & 0x3f;
  285. val2[1] = (snd_soc_read(codec, PM860X_SIDETONE_SHIFT)) & 0xf;
  286. for (i = 0; i < ARRAY_SIZE(st_table); i++) {
  287. if ((st_table[i].m == val[0]) && (st_table[i].n == val[1]))
  288. ucontrol->value.integer.value[0] = i;
  289. if ((st_table[i].m == val2[0]) && (st_table[i].n == val2[1]))
  290. ucontrol->value.integer.value[1] = i;
  291. }
  292. return 0;
  293. }
  294. static int snd_soc_put_volsw_2r_st(struct snd_kcontrol *kcontrol,
  295. struct snd_ctl_elem_value *ucontrol)
  296. {
  297. struct soc_mixer_control *mc =
  298. (struct soc_mixer_control *)kcontrol->private_value;
  299. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  300. unsigned int reg = mc->reg;
  301. unsigned int reg2 = mc->rreg;
  302. int err;
  303. unsigned int val, val2;
  304. val = ucontrol->value.integer.value[0];
  305. val2 = ucontrol->value.integer.value[1];
  306. err = snd_soc_update_bits(codec, reg, 0x3f, st_table[val].m);
  307. if (err < 0)
  308. return err;
  309. err = snd_soc_update_bits(codec, PM860X_SIDETONE_SHIFT, 0xf0,
  310. st_table[val].n << 4);
  311. if (err < 0)
  312. return err;
  313. err = snd_soc_update_bits(codec, reg2, 0x3f, st_table[val2].m);
  314. if (err < 0)
  315. return err;
  316. err = snd_soc_update_bits(codec, PM860X_SIDETONE_SHIFT, 0x0f,
  317. st_table[val2].n);
  318. return err;
  319. }
  320. static int snd_soc_get_volsw_2r_out(struct snd_kcontrol *kcontrol,
  321. struct snd_ctl_elem_value *ucontrol)
  322. {
  323. struct soc_mixer_control *mc =
  324. (struct soc_mixer_control *)kcontrol->private_value;
  325. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  326. unsigned int reg = mc->reg;
  327. unsigned int reg2 = mc->rreg;
  328. unsigned int shift = mc->shift;
  329. int max = mc->max, val, val2;
  330. unsigned int mask = (1 << fls(max)) - 1;
  331. val = snd_soc_read(codec, reg) >> shift;
  332. val2 = snd_soc_read(codec, reg2) >> shift;
  333. ucontrol->value.integer.value[0] = (max - val) & mask;
  334. ucontrol->value.integer.value[1] = (max - val2) & mask;
  335. return 0;
  336. }
  337. static int snd_soc_put_volsw_2r_out(struct snd_kcontrol *kcontrol,
  338. struct snd_ctl_elem_value *ucontrol)
  339. {
  340. struct soc_mixer_control *mc =
  341. (struct soc_mixer_control *)kcontrol->private_value;
  342. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  343. unsigned int reg = mc->reg;
  344. unsigned int reg2 = mc->rreg;
  345. unsigned int shift = mc->shift;
  346. int max = mc->max;
  347. unsigned int mask = (1 << fls(max)) - 1;
  348. int err;
  349. unsigned int val, val2, val_mask;
  350. val_mask = mask << shift;
  351. val = ((max - ucontrol->value.integer.value[0]) & mask);
  352. val2 = ((max - ucontrol->value.integer.value[1]) & mask);
  353. val = val << shift;
  354. val2 = val2 << shift;
  355. err = snd_soc_update_bits(codec, reg, val_mask, val);
  356. if (err < 0)
  357. return err;
  358. err = snd_soc_update_bits(codec, reg2, val_mask, val2);
  359. return err;
  360. }
  361. /* DAPM Widget Events */
  362. /*
  363. * A lot registers are belong to RSYNC domain. It requires enabling RSYNC bit
  364. * after updating these registers. Otherwise, these updated registers won't
  365. * be effective.
  366. */
  367. static int pm860x_rsync_event(struct snd_soc_dapm_widget *w,
  368. struct snd_kcontrol *kcontrol, int event)
  369. {
  370. struct snd_soc_codec *codec = w->codec;
  371. /*
  372. * In order to avoid current on the load, mute power-on and power-off
  373. * should be transients.
  374. * Unmute by DAC_MUTE. It should be unmuted when DAPM sequence is
  375. * finished.
  376. */
  377. snd_soc_update_bits(codec, PM860X_DAC_OFFSET, DAC_MUTE, 0);
  378. snd_soc_update_bits(codec, PM860X_EAR_CTRL_2,
  379. RSYNC_CHANGE, RSYNC_CHANGE);
  380. return 0;
  381. }
  382. static int pm860x_dac_event(struct snd_soc_dapm_widget *w,
  383. struct snd_kcontrol *kcontrol, int event)
  384. {
  385. struct snd_soc_codec *codec = w->codec;
  386. unsigned int dac = 0;
  387. int data;
  388. if (!strcmp(w->name, "Left DAC"))
  389. dac = DAC_LEFT;
  390. if (!strcmp(w->name, "Right DAC"))
  391. dac = DAC_RIGHT;
  392. switch (event) {
  393. case SND_SOC_DAPM_PRE_PMU:
  394. if (dac) {
  395. /* Auto mute in power-on sequence. */
  396. dac |= MODULATOR;
  397. snd_soc_update_bits(codec, PM860X_DAC_OFFSET,
  398. DAC_MUTE, DAC_MUTE);
  399. snd_soc_update_bits(codec, PM860X_EAR_CTRL_2,
  400. RSYNC_CHANGE, RSYNC_CHANGE);
  401. /* update dac */
  402. snd_soc_update_bits(codec, PM860X_DAC_EN_2,
  403. dac, dac);
  404. }
  405. break;
  406. case SND_SOC_DAPM_PRE_PMD:
  407. if (dac) {
  408. /* Auto mute in power-off sequence. */
  409. snd_soc_update_bits(codec, PM860X_DAC_OFFSET,
  410. DAC_MUTE, DAC_MUTE);
  411. snd_soc_update_bits(codec, PM860X_EAR_CTRL_2,
  412. RSYNC_CHANGE, RSYNC_CHANGE);
  413. /* update dac */
  414. data = snd_soc_read(codec, PM860X_DAC_EN_2);
  415. data &= ~dac;
  416. if (!(data & (DAC_LEFT | DAC_RIGHT)))
  417. data &= ~MODULATOR;
  418. snd_soc_write(codec, PM860X_DAC_EN_2, data);
  419. }
  420. break;
  421. }
  422. return 0;
  423. }
  424. static const char *pm860x_opamp_texts[] = {"-50%", "-25%", "0%", "75%"};
  425. static const char *pm860x_pa_texts[] = {"-33%", "0%", "33%", "66%"};
  426. static const struct soc_enum pm860x_hs1_opamp_enum =
  427. SOC_ENUM_SINGLE(PM860X_HS1_CTRL, 5, 4, pm860x_opamp_texts);
  428. static const struct soc_enum pm860x_hs2_opamp_enum =
  429. SOC_ENUM_SINGLE(PM860X_HS2_CTRL, 5, 4, pm860x_opamp_texts);
  430. static const struct soc_enum pm860x_hs1_pa_enum =
  431. SOC_ENUM_SINGLE(PM860X_HS1_CTRL, 3, 4, pm860x_pa_texts);
  432. static const struct soc_enum pm860x_hs2_pa_enum =
  433. SOC_ENUM_SINGLE(PM860X_HS2_CTRL, 3, 4, pm860x_pa_texts);
  434. static const struct soc_enum pm860x_lo1_opamp_enum =
  435. SOC_ENUM_SINGLE(PM860X_LO1_CTRL, 5, 4, pm860x_opamp_texts);
  436. static const struct soc_enum pm860x_lo2_opamp_enum =
  437. SOC_ENUM_SINGLE(PM860X_LO2_CTRL, 5, 4, pm860x_opamp_texts);
  438. static const struct soc_enum pm860x_lo1_pa_enum =
  439. SOC_ENUM_SINGLE(PM860X_LO1_CTRL, 3, 4, pm860x_pa_texts);
  440. static const struct soc_enum pm860x_lo2_pa_enum =
  441. SOC_ENUM_SINGLE(PM860X_LO2_CTRL, 3, 4, pm860x_pa_texts);
  442. static const struct soc_enum pm860x_spk_pa_enum =
  443. SOC_ENUM_SINGLE(PM860X_EAR_CTRL_1, 5, 4, pm860x_pa_texts);
  444. static const struct soc_enum pm860x_ear_pa_enum =
  445. SOC_ENUM_SINGLE(PM860X_EAR_CTRL_2, 0, 4, pm860x_pa_texts);
  446. static const struct soc_enum pm860x_spk_ear_opamp_enum =
  447. SOC_ENUM_SINGLE(PM860X_EAR_CTRL_1, 3, 4, pm860x_opamp_texts);
  448. static const struct snd_kcontrol_new pm860x_snd_controls[] = {
  449. SOC_DOUBLE_R_TLV("ADC Capture Volume", PM860X_ADC_ANA_2,
  450. PM860X_ADC_ANA_3, 6, 3, 0, adc_tlv),
  451. SOC_DOUBLE_TLV("AUX Capture Volume", PM860X_ADC_ANA_3, 0, 3, 7, 0,
  452. aux_tlv),
  453. SOC_SINGLE_TLV("MIC1 Capture Volume", PM860X_ADC_ANA_2, 0, 7, 0,
  454. mic_tlv),
  455. SOC_SINGLE_TLV("MIC3 Capture Volume", PM860X_ADC_ANA_2, 3, 7, 0,
  456. mic_tlv),
  457. SOC_DOUBLE_R_EXT_TLV("Sidetone Volume", PM860X_SIDETONE_L_GAIN,
  458. PM860X_SIDETONE_R_GAIN, 0, ARRAY_SIZE(st_table)-1,
  459. 0, snd_soc_get_volsw_2r_st,
  460. snd_soc_put_volsw_2r_st, st_tlv),
  461. SOC_SINGLE_TLV("Speaker Playback Volume", PM860X_EAR_CTRL_1,
  462. 0, 7, 0, out_tlv),
  463. SOC_DOUBLE_R_TLV("Line Playback Volume", PM860X_LO1_CTRL,
  464. PM860X_LO2_CTRL, 0, 7, 0, out_tlv),
  465. SOC_DOUBLE_R_TLV("Headset Playback Volume", PM860X_HS1_CTRL,
  466. PM860X_HS2_CTRL, 0, 7, 0, out_tlv),
  467. SOC_DOUBLE_R_EXT_TLV("Hifi Left Playback Volume",
  468. PM860X_HIFIL_GAIN_LEFT,
  469. PM860X_HIFIL_GAIN_RIGHT, 0, 63, 0,
  470. snd_soc_get_volsw_2r_out,
  471. snd_soc_put_volsw_2r_out, dpga_tlv),
  472. SOC_DOUBLE_R_EXT_TLV("Hifi Right Playback Volume",
  473. PM860X_HIFIR_GAIN_LEFT,
  474. PM860X_HIFIR_GAIN_RIGHT, 0, 63, 0,
  475. snd_soc_get_volsw_2r_out,
  476. snd_soc_put_volsw_2r_out, dpga_tlv),
  477. SOC_DOUBLE_R_EXT_TLV("Lofi Playback Volume", PM860X_LOFI_GAIN_LEFT,
  478. PM860X_LOFI_GAIN_RIGHT, 0, 63, 0,
  479. snd_soc_get_volsw_2r_out,
  480. snd_soc_put_volsw_2r_out, dpga_tlv),
  481. SOC_ENUM("Headset1 Operational Amplifier Current",
  482. pm860x_hs1_opamp_enum),
  483. SOC_ENUM("Headset2 Operational Amplifier Current",
  484. pm860x_hs2_opamp_enum),
  485. SOC_ENUM("Headset1 Amplifier Current", pm860x_hs1_pa_enum),
  486. SOC_ENUM("Headset2 Amplifier Current", pm860x_hs2_pa_enum),
  487. SOC_ENUM("Lineout1 Operational Amplifier Current",
  488. pm860x_lo1_opamp_enum),
  489. SOC_ENUM("Lineout2 Operational Amplifier Current",
  490. pm860x_lo2_opamp_enum),
  491. SOC_ENUM("Lineout1 Amplifier Current", pm860x_lo1_pa_enum),
  492. SOC_ENUM("Lineout2 Amplifier Current", pm860x_lo2_pa_enum),
  493. SOC_ENUM("Speaker Operational Amplifier Current",
  494. pm860x_spk_ear_opamp_enum),
  495. SOC_ENUM("Speaker Amplifier Current", pm860x_spk_pa_enum),
  496. SOC_ENUM("Earpiece Amplifier Current", pm860x_ear_pa_enum),
  497. };
  498. /*
  499. * DAPM Controls
  500. */
  501. /* PCM Switch / PCM Interface */
  502. static const struct snd_kcontrol_new pcm_switch_controls =
  503. SOC_DAPM_SINGLE("Switch", PM860X_ADC_EN_2, 0, 1, 0);
  504. /* AUX1 Switch */
  505. static const struct snd_kcontrol_new aux1_switch_controls =
  506. SOC_DAPM_SINGLE("Switch", PM860X_ANA_TO_ANA, 4, 1, 0);
  507. /* AUX2 Switch */
  508. static const struct snd_kcontrol_new aux2_switch_controls =
  509. SOC_DAPM_SINGLE("Switch", PM860X_ANA_TO_ANA, 5, 1, 0);
  510. /* Left Ex. PA Switch */
  511. static const struct snd_kcontrol_new lepa_switch_controls =
  512. SOC_DAPM_SINGLE("Switch", PM860X_DAC_EN_2, 2, 1, 0);
  513. /* Right Ex. PA Switch */
  514. static const struct snd_kcontrol_new repa_switch_controls =
  515. SOC_DAPM_SINGLE("Switch", PM860X_DAC_EN_2, 1, 1, 0);
  516. /* PCM Mux / Mux7 */
  517. static const char *aif1_text[] = {
  518. "PCM L", "PCM R",
  519. };
  520. static const struct soc_enum aif1_enum =
  521. SOC_ENUM_SINGLE(PM860X_PCM_IFACE_3, 6, 2, aif1_text);
  522. static const struct snd_kcontrol_new aif1_mux =
  523. SOC_DAPM_ENUM("PCM Mux", aif1_enum);
  524. /* I2S Mux / Mux9 */
  525. static const char *i2s_din_text[] = {
  526. "DIN", "DIN1",
  527. };
  528. static const struct soc_enum i2s_din_enum =
  529. SOC_ENUM_SINGLE(PM860X_I2S_IFACE_3, 1, 2, i2s_din_text);
  530. static const struct snd_kcontrol_new i2s_din_mux =
  531. SOC_DAPM_ENUM("I2S DIN Mux", i2s_din_enum);
  532. /* I2S Mic Mux / Mux8 */
  533. static const char *i2s_mic_text[] = {
  534. "Ex PA", "ADC",
  535. };
  536. static const struct soc_enum i2s_mic_enum =
  537. SOC_ENUM_SINGLE(PM860X_I2S_IFACE_3, 4, 2, i2s_mic_text);
  538. static const struct snd_kcontrol_new i2s_mic_mux =
  539. SOC_DAPM_ENUM("I2S Mic Mux", i2s_mic_enum);
  540. /* ADCL Mux / Mux2 */
  541. static const char *adcl_text[] = {
  542. "ADCR", "ADCL",
  543. };
  544. static const struct soc_enum adcl_enum =
  545. SOC_ENUM_SINGLE(PM860X_PCM_IFACE_3, 4, 2, adcl_text);
  546. static const struct snd_kcontrol_new adcl_mux =
  547. SOC_DAPM_ENUM("ADC Left Mux", adcl_enum);
  548. /* ADCR Mux / Mux3 */
  549. static const char *adcr_text[] = {
  550. "ADCL", "ADCR",
  551. };
  552. static const struct soc_enum adcr_enum =
  553. SOC_ENUM_SINGLE(PM860X_PCM_IFACE_3, 2, 2, adcr_text);
  554. static const struct snd_kcontrol_new adcr_mux =
  555. SOC_DAPM_ENUM("ADC Right Mux", adcr_enum);
  556. /* ADCR EC Mux / Mux6 */
  557. static const char *adcr_ec_text[] = {
  558. "ADCR", "EC",
  559. };
  560. static const struct soc_enum adcr_ec_enum =
  561. SOC_ENUM_SINGLE(PM860X_ADC_EN_2, 3, 2, adcr_ec_text);
  562. static const struct snd_kcontrol_new adcr_ec_mux =
  563. SOC_DAPM_ENUM("ADCR EC Mux", adcr_ec_enum);
  564. /* EC Mux / Mux4 */
  565. static const char *ec_text[] = {
  566. "Left", "Right", "Left + Right",
  567. };
  568. static const struct soc_enum ec_enum =
  569. SOC_ENUM_SINGLE(PM860X_EC_PATH, 1, 3, ec_text);
  570. static const struct snd_kcontrol_new ec_mux =
  571. SOC_DAPM_ENUM("EC Mux", ec_enum);
  572. static const char *dac_text[] = {
  573. "No input", "Right", "Left", "No input",
  574. };
  575. /* DAC Headset 1 Mux / Mux10 */
  576. static const struct soc_enum dac_hs1_enum =
  577. SOC_ENUM_SINGLE(PM860X_ANA_INPUT_SEL_1, 0, 4, dac_text);
  578. static const struct snd_kcontrol_new dac_hs1_mux =
  579. SOC_DAPM_ENUM("DAC HS1 Mux", dac_hs1_enum);
  580. /* DAC Headset 2 Mux / Mux11 */
  581. static const struct soc_enum dac_hs2_enum =
  582. SOC_ENUM_SINGLE(PM860X_ANA_INPUT_SEL_1, 2, 4, dac_text);
  583. static const struct snd_kcontrol_new dac_hs2_mux =
  584. SOC_DAPM_ENUM("DAC HS2 Mux", dac_hs2_enum);
  585. /* DAC Lineout 1 Mux / Mux12 */
  586. static const struct soc_enum dac_lo1_enum =
  587. SOC_ENUM_SINGLE(PM860X_ANA_INPUT_SEL_1, 4, 4, dac_text);
  588. static const struct snd_kcontrol_new dac_lo1_mux =
  589. SOC_DAPM_ENUM("DAC LO1 Mux", dac_lo1_enum);
  590. /* DAC Lineout 2 Mux / Mux13 */
  591. static const struct soc_enum dac_lo2_enum =
  592. SOC_ENUM_SINGLE(PM860X_ANA_INPUT_SEL_1, 6, 4, dac_text);
  593. static const struct snd_kcontrol_new dac_lo2_mux =
  594. SOC_DAPM_ENUM("DAC LO2 Mux", dac_lo2_enum);
  595. /* DAC Spearker Earphone Mux / Mux14 */
  596. static const struct soc_enum dac_spk_ear_enum =
  597. SOC_ENUM_SINGLE(PM860X_ANA_INPUT_SEL_2, 0, 4, dac_text);
  598. static const struct snd_kcontrol_new dac_spk_ear_mux =
  599. SOC_DAPM_ENUM("DAC SP Mux", dac_spk_ear_enum);
  600. /* Headset 1 Mux / Mux15 */
  601. static const char *in_text[] = {
  602. "Digital", "Analog",
  603. };
  604. static const struct soc_enum hs1_enum =
  605. SOC_ENUM_SINGLE(PM860X_ANA_TO_ANA, 0, 2, in_text);
  606. static const struct snd_kcontrol_new hs1_mux =
  607. SOC_DAPM_ENUM("Headset1 Mux", hs1_enum);
  608. /* Headset 2 Mux / Mux16 */
  609. static const struct soc_enum hs2_enum =
  610. SOC_ENUM_SINGLE(PM860X_ANA_TO_ANA, 1, 2, in_text);
  611. static const struct snd_kcontrol_new hs2_mux =
  612. SOC_DAPM_ENUM("Headset2 Mux", hs2_enum);
  613. /* Lineout 1 Mux / Mux17 */
  614. static const struct soc_enum lo1_enum =
  615. SOC_ENUM_SINGLE(PM860X_ANA_TO_ANA, 2, 2, in_text);
  616. static const struct snd_kcontrol_new lo1_mux =
  617. SOC_DAPM_ENUM("Lineout1 Mux", lo1_enum);
  618. /* Lineout 2 Mux / Mux18 */
  619. static const struct soc_enum lo2_enum =
  620. SOC_ENUM_SINGLE(PM860X_ANA_TO_ANA, 3, 2, in_text);
  621. static const struct snd_kcontrol_new lo2_mux =
  622. SOC_DAPM_ENUM("Lineout2 Mux", lo2_enum);
  623. /* Speaker Earpiece Demux */
  624. static const char *spk_text[] = {
  625. "Earpiece", "Speaker",
  626. };
  627. static const struct soc_enum spk_enum =
  628. SOC_ENUM_SINGLE(PM860X_ANA_TO_ANA, 6, 2, spk_text);
  629. static const struct snd_kcontrol_new spk_demux =
  630. SOC_DAPM_ENUM("Speaker Earpiece Demux", spk_enum);
  631. /* MIC Mux / Mux1 */
  632. static const char *mic_text[] = {
  633. "Mic 1", "Mic 2",
  634. };
  635. static const struct soc_enum mic_enum =
  636. SOC_ENUM_SINGLE(PM860X_ADC_ANA_4, 4, 2, mic_text);
  637. static const struct snd_kcontrol_new mic_mux =
  638. SOC_DAPM_ENUM("MIC Mux", mic_enum);
  639. static const struct snd_soc_dapm_widget pm860x_dapm_widgets[] = {
  640. SND_SOC_DAPM_AIF_IN("PCM SDI", "PCM Playback", 0,
  641. PM860X_ADC_EN_2, 0, 0),
  642. SND_SOC_DAPM_AIF_OUT("PCM SDO", "PCM Capture", 0,
  643. PM860X_PCM_IFACE_3, 1, 1),
  644. SND_SOC_DAPM_AIF_IN("I2S DIN", "I2S Playback", 0,
  645. SND_SOC_NOPM, 0, 0),
  646. SND_SOC_DAPM_AIF_IN("I2S DIN1", "I2S Playback", 0,
  647. SND_SOC_NOPM, 0, 0),
  648. SND_SOC_DAPM_AIF_OUT("I2S DOUT", "I2S Capture", 0,
  649. PM860X_I2S_IFACE_3, 5, 1),
  650. SND_SOC_DAPM_SUPPLY("I2S CLK", PM860X_DAC_EN_2, 0, 0, NULL, 0),
  651. SND_SOC_DAPM_MUX("I2S Mic Mux", SND_SOC_NOPM, 0, 0, &i2s_mic_mux),
  652. SND_SOC_DAPM_MUX("ADC Left Mux", SND_SOC_NOPM, 0, 0, &adcl_mux),
  653. SND_SOC_DAPM_MUX("ADC Right Mux", SND_SOC_NOPM, 0, 0, &adcr_mux),
  654. SND_SOC_DAPM_MUX("EC Mux", SND_SOC_NOPM, 0, 0, &ec_mux),
  655. SND_SOC_DAPM_MUX("ADCR EC Mux", SND_SOC_NOPM, 0, 0, &adcr_ec_mux),
  656. SND_SOC_DAPM_SWITCH("Left EPA", SND_SOC_NOPM, 0, 0,
  657. &lepa_switch_controls),
  658. SND_SOC_DAPM_SWITCH("Right EPA", SND_SOC_NOPM, 0, 0,
  659. &repa_switch_controls),
  660. SND_SOC_DAPM_REG(snd_soc_dapm_supply, "Left ADC MOD", PM860X_ADC_EN_1,
  661. 0, 1, 1, 0),
  662. SND_SOC_DAPM_REG(snd_soc_dapm_supply, "Right ADC MOD", PM860X_ADC_EN_1,
  663. 1, 1, 1, 0),
  664. SND_SOC_DAPM_ADC("Left ADC", NULL, PM860X_ADC_EN_2, 5, 0),
  665. SND_SOC_DAPM_ADC("Right ADC", NULL, PM860X_ADC_EN_2, 4, 0),
  666. SND_SOC_DAPM_SWITCH("AUX1 Switch", SND_SOC_NOPM, 0, 0,
  667. &aux1_switch_controls),
  668. SND_SOC_DAPM_SWITCH("AUX2 Switch", SND_SOC_NOPM, 0, 0,
  669. &aux2_switch_controls),
  670. SND_SOC_DAPM_MUX("MIC Mux", SND_SOC_NOPM, 0, 0, &mic_mux),
  671. SND_SOC_DAPM_MICBIAS("Mic1 Bias", PM860X_ADC_ANA_1, 2, 0),
  672. SND_SOC_DAPM_MICBIAS("Mic3 Bias", PM860X_ADC_ANA_1, 7, 0),
  673. SND_SOC_DAPM_PGA("MIC1 Volume", PM860X_ADC_EN_1, 2, 0, NULL, 0),
  674. SND_SOC_DAPM_PGA("MIC3 Volume", PM860X_ADC_EN_1, 3, 0, NULL, 0),
  675. SND_SOC_DAPM_PGA("AUX1 Volume", PM860X_ADC_EN_1, 4, 0, NULL, 0),
  676. SND_SOC_DAPM_PGA("AUX2 Volume", PM860X_ADC_EN_1, 5, 0, NULL, 0),
  677. SND_SOC_DAPM_PGA("Sidetone PGA", PM860X_ADC_EN_2, 1, 0, NULL, 0),
  678. SND_SOC_DAPM_PGA("Lofi PGA", PM860X_ADC_EN_2, 2, 0, NULL, 0),
  679. SND_SOC_DAPM_INPUT("AUX1"),
  680. SND_SOC_DAPM_INPUT("AUX2"),
  681. SND_SOC_DAPM_INPUT("MIC1P"),
  682. SND_SOC_DAPM_INPUT("MIC1N"),
  683. SND_SOC_DAPM_INPUT("MIC2P"),
  684. SND_SOC_DAPM_INPUT("MIC2N"),
  685. SND_SOC_DAPM_INPUT("MIC3P"),
  686. SND_SOC_DAPM_INPUT("MIC3N"),
  687. SND_SOC_DAPM_DAC_E("Left DAC", NULL, SND_SOC_NOPM, 0, 0,
  688. pm860x_dac_event,
  689. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD),
  690. SND_SOC_DAPM_DAC_E("Right DAC", NULL, SND_SOC_NOPM, 0, 0,
  691. pm860x_dac_event,
  692. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD),
  693. SND_SOC_DAPM_MUX("I2S DIN Mux", SND_SOC_NOPM, 0, 0, &i2s_din_mux),
  694. SND_SOC_DAPM_MUX("DAC HS1 Mux", SND_SOC_NOPM, 0, 0, &dac_hs1_mux),
  695. SND_SOC_DAPM_MUX("DAC HS2 Mux", SND_SOC_NOPM, 0, 0, &dac_hs2_mux),
  696. SND_SOC_DAPM_MUX("DAC LO1 Mux", SND_SOC_NOPM, 0, 0, &dac_lo1_mux),
  697. SND_SOC_DAPM_MUX("DAC LO2 Mux", SND_SOC_NOPM, 0, 0, &dac_lo2_mux),
  698. SND_SOC_DAPM_MUX("DAC SP Mux", SND_SOC_NOPM, 0, 0, &dac_spk_ear_mux),
  699. SND_SOC_DAPM_MUX("Headset1 Mux", SND_SOC_NOPM, 0, 0, &hs1_mux),
  700. SND_SOC_DAPM_MUX("Headset2 Mux", SND_SOC_NOPM, 0, 0, &hs2_mux),
  701. SND_SOC_DAPM_MUX("Lineout1 Mux", SND_SOC_NOPM, 0, 0, &lo1_mux),
  702. SND_SOC_DAPM_MUX("Lineout2 Mux", SND_SOC_NOPM, 0, 0, &lo2_mux),
  703. SND_SOC_DAPM_MUX("Speaker Earpiece Demux", SND_SOC_NOPM, 0, 0,
  704. &spk_demux),
  705. SND_SOC_DAPM_PGA("Headset1 PGA", PM860X_DAC_EN_1, 0, 0, NULL, 0),
  706. SND_SOC_DAPM_PGA("Headset2 PGA", PM860X_DAC_EN_1, 1, 0, NULL, 0),
  707. SND_SOC_DAPM_OUTPUT("HS1"),
  708. SND_SOC_DAPM_OUTPUT("HS2"),
  709. SND_SOC_DAPM_PGA("Lineout1 PGA", PM860X_DAC_EN_1, 2, 0, NULL, 0),
  710. SND_SOC_DAPM_PGA("Lineout2 PGA", PM860X_DAC_EN_1, 3, 0, NULL, 0),
  711. SND_SOC_DAPM_OUTPUT("LINEOUT1"),
  712. SND_SOC_DAPM_OUTPUT("LINEOUT2"),
  713. SND_SOC_DAPM_PGA("Earpiece PGA", PM860X_DAC_EN_1, 4, 0, NULL, 0),
  714. SND_SOC_DAPM_OUTPUT("EARP"),
  715. SND_SOC_DAPM_OUTPUT("EARN"),
  716. SND_SOC_DAPM_PGA("Speaker PGA", PM860X_DAC_EN_1, 5, 0, NULL, 0),
  717. SND_SOC_DAPM_OUTPUT("LSP"),
  718. SND_SOC_DAPM_OUTPUT("LSN"),
  719. SND_SOC_DAPM_REG(snd_soc_dapm_supply, "VCODEC", PM860X_AUDIO_SUPPLIES_2,
  720. 0, SUPPLY_MASK, SUPPLY_MASK, 0),
  721. PM860X_DAPM_OUTPUT("RSYNC", pm860x_rsync_event),
  722. };
  723. static const struct snd_soc_dapm_route pm860x_dapm_routes[] = {
  724. /* supply */
  725. {"Left DAC", NULL, "VCODEC"},
  726. {"Right DAC", NULL, "VCODEC"},
  727. {"Left ADC", NULL, "VCODEC"},
  728. {"Right ADC", NULL, "VCODEC"},
  729. {"Left ADC", NULL, "Left ADC MOD"},
  730. {"Right ADC", NULL, "Right ADC MOD"},
  731. /* I2S Clock */
  732. {"I2S DIN", NULL, "I2S CLK"},
  733. {"I2S DIN1", NULL, "I2S CLK"},
  734. {"I2S DOUT", NULL, "I2S CLK"},
  735. /* PCM/AIF1 Inputs */
  736. {"PCM SDO", NULL, "ADC Left Mux"},
  737. {"PCM SDO", NULL, "ADCR EC Mux"},
  738. /* PCM/AFI2 Outputs */
  739. {"Lofi PGA", NULL, "PCM SDI"},
  740. {"Lofi PGA", NULL, "Sidetone PGA"},
  741. {"Left DAC", NULL, "Lofi PGA"},
  742. {"Right DAC", NULL, "Lofi PGA"},
  743. /* I2S/AIF2 Inputs */
  744. {"MIC Mux", "Mic 1", "MIC1P"},
  745. {"MIC Mux", "Mic 1", "MIC1N"},
  746. {"MIC Mux", "Mic 2", "MIC2P"},
  747. {"MIC Mux", "Mic 2", "MIC2N"},
  748. {"MIC1 Volume", NULL, "MIC Mux"},
  749. {"MIC3 Volume", NULL, "MIC3P"},
  750. {"MIC3 Volume", NULL, "MIC3N"},
  751. {"Left ADC", NULL, "MIC1 Volume"},
  752. {"Right ADC", NULL, "MIC3 Volume"},
  753. {"ADC Left Mux", "ADCR", "Right ADC"},
  754. {"ADC Left Mux", "ADCL", "Left ADC"},
  755. {"ADC Right Mux", "ADCL", "Left ADC"},
  756. {"ADC Right Mux", "ADCR", "Right ADC"},
  757. {"Left EPA", "Switch", "Left DAC"},
  758. {"Right EPA", "Switch", "Right DAC"},
  759. {"EC Mux", "Left", "Left DAC"},
  760. {"EC Mux", "Right", "Right DAC"},
  761. {"EC Mux", "Left + Right", "Left DAC"},
  762. {"EC Mux", "Left + Right", "Right DAC"},
  763. {"ADCR EC Mux", "ADCR", "ADC Right Mux"},
  764. {"ADCR EC Mux", "EC", "EC Mux"},
  765. {"I2S Mic Mux", "Ex PA", "Left EPA"},
  766. {"I2S Mic Mux", "Ex PA", "Right EPA"},
  767. {"I2S Mic Mux", "ADC", "ADC Left Mux"},
  768. {"I2S Mic Mux", "ADC", "ADCR EC Mux"},
  769. {"I2S DOUT", NULL, "I2S Mic Mux"},
  770. /* I2S/AIF2 Outputs */
  771. {"I2S DIN Mux", "DIN", "I2S DIN"},
  772. {"I2S DIN Mux", "DIN1", "I2S DIN1"},
  773. {"Left DAC", NULL, "I2S DIN Mux"},
  774. {"Right DAC", NULL, "I2S DIN Mux"},
  775. {"DAC HS1 Mux", "Left", "Left DAC"},
  776. {"DAC HS1 Mux", "Right", "Right DAC"},
  777. {"DAC HS2 Mux", "Left", "Left DAC"},
  778. {"DAC HS2 Mux", "Right", "Right DAC"},
  779. {"DAC LO1 Mux", "Left", "Left DAC"},
  780. {"DAC LO1 Mux", "Right", "Right DAC"},
  781. {"DAC LO2 Mux", "Left", "Left DAC"},
  782. {"DAC LO2 Mux", "Right", "Right DAC"},
  783. {"Headset1 Mux", "Digital", "DAC HS1 Mux"},
  784. {"Headset2 Mux", "Digital", "DAC HS2 Mux"},
  785. {"Lineout1 Mux", "Digital", "DAC LO1 Mux"},
  786. {"Lineout2 Mux", "Digital", "DAC LO2 Mux"},
  787. {"Headset1 PGA", NULL, "Headset1 Mux"},
  788. {"Headset2 PGA", NULL, "Headset2 Mux"},
  789. {"Lineout1 PGA", NULL, "Lineout1 Mux"},
  790. {"Lineout2 PGA", NULL, "Lineout2 Mux"},
  791. {"DAC SP Mux", "Left", "Left DAC"},
  792. {"DAC SP Mux", "Right", "Right DAC"},
  793. {"Speaker Earpiece Demux", "Speaker", "DAC SP Mux"},
  794. {"Speaker PGA", NULL, "Speaker Earpiece Demux"},
  795. {"Earpiece PGA", NULL, "Speaker Earpiece Demux"},
  796. {"RSYNC", NULL, "Headset1 PGA"},
  797. {"RSYNC", NULL, "Headset2 PGA"},
  798. {"RSYNC", NULL, "Lineout1 PGA"},
  799. {"RSYNC", NULL, "Lineout2 PGA"},
  800. {"RSYNC", NULL, "Speaker PGA"},
  801. {"RSYNC", NULL, "Speaker PGA"},
  802. {"RSYNC", NULL, "Earpiece PGA"},
  803. {"RSYNC", NULL, "Earpiece PGA"},
  804. {"HS1", NULL, "RSYNC"},
  805. {"HS2", NULL, "RSYNC"},
  806. {"LINEOUT1", NULL, "RSYNC"},
  807. {"LINEOUT2", NULL, "RSYNC"},
  808. {"LSP", NULL, "RSYNC"},
  809. {"LSN", NULL, "RSYNC"},
  810. {"EARP", NULL, "RSYNC"},
  811. {"EARN", NULL, "RSYNC"},
  812. };
  813. /*
  814. * Use MUTE_LEFT & MUTE_RIGHT to implement digital mute.
  815. * These bits can also be used to mute.
  816. */
  817. static int pm860x_digital_mute(struct snd_soc_dai *codec_dai, int mute)
  818. {
  819. struct snd_soc_codec *codec = codec_dai->codec;
  820. int data = 0, mask = MUTE_LEFT | MUTE_RIGHT;
  821. if (mute)
  822. data = mask;
  823. snd_soc_update_bits(codec, PM860X_DAC_OFFSET, mask, data);
  824. snd_soc_update_bits(codec, PM860X_EAR_CTRL_2,
  825. RSYNC_CHANGE, RSYNC_CHANGE);
  826. return 0;
  827. }
  828. static int pm860x_pcm_hw_params(struct snd_pcm_substream *substream,
  829. struct snd_pcm_hw_params *params,
  830. struct snd_soc_dai *dai)
  831. {
  832. struct snd_soc_codec *codec = dai->codec;
  833. unsigned char inf = 0, mask = 0;
  834. /* bit size */
  835. switch (params_format(params)) {
  836. case SNDRV_PCM_FORMAT_S16_LE:
  837. inf &= ~PCM_INF2_18WL;
  838. break;
  839. case SNDRV_PCM_FORMAT_S18_3LE:
  840. inf |= PCM_INF2_18WL;
  841. break;
  842. default:
  843. return -EINVAL;
  844. }
  845. mask |= PCM_INF2_18WL;
  846. snd_soc_update_bits(codec, PM860X_PCM_IFACE_2, mask, inf);
  847. /* sample rate */
  848. switch (params_rate(params)) {
  849. case 8000:
  850. inf = 0;
  851. break;
  852. case 16000:
  853. inf = 3;
  854. break;
  855. case 32000:
  856. inf = 6;
  857. break;
  858. case 48000:
  859. inf = 8;
  860. break;
  861. default:
  862. return -EINVAL;
  863. }
  864. snd_soc_update_bits(codec, PM860X_PCM_RATE, 0x0f, inf);
  865. return 0;
  866. }
  867. static int pm860x_pcm_set_dai_fmt(struct snd_soc_dai *codec_dai,
  868. unsigned int fmt)
  869. {
  870. struct snd_soc_codec *codec = codec_dai->codec;
  871. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  872. unsigned char inf = 0, mask = 0;
  873. int ret = -EINVAL;
  874. mask |= PCM_INF2_BCLK | PCM_INF2_FS | PCM_INF2_MASTER;
  875. /* set master/slave audio interface */
  876. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  877. case SND_SOC_DAIFMT_CBM_CFM:
  878. case SND_SOC_DAIFMT_CBM_CFS:
  879. if (pm860x->dir == PM860X_CLK_DIR_OUT) {
  880. inf |= PCM_INF2_MASTER;
  881. ret = 0;
  882. }
  883. break;
  884. case SND_SOC_DAIFMT_CBS_CFS:
  885. if (pm860x->dir == PM860X_CLK_DIR_IN) {
  886. inf &= ~PCM_INF2_MASTER;
  887. ret = 0;
  888. }
  889. break;
  890. }
  891. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  892. case SND_SOC_DAIFMT_I2S:
  893. inf |= PCM_EXACT_I2S;
  894. ret = 0;
  895. break;
  896. }
  897. mask |= PCM_MODE_MASK;
  898. if (ret)
  899. return ret;
  900. snd_soc_update_bits(codec, PM860X_PCM_IFACE_2, mask, inf);
  901. return 0;
  902. }
  903. static int pm860x_set_dai_sysclk(struct snd_soc_dai *codec_dai,
  904. int clk_id, unsigned int freq, int dir)
  905. {
  906. struct snd_soc_codec *codec = codec_dai->codec;
  907. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  908. if (dir == PM860X_CLK_DIR_OUT)
  909. pm860x->dir = PM860X_CLK_DIR_OUT;
  910. else {
  911. pm860x->dir = PM860X_CLK_DIR_IN;
  912. return -EINVAL;
  913. }
  914. return 0;
  915. }
  916. static int pm860x_i2s_hw_params(struct snd_pcm_substream *substream,
  917. struct snd_pcm_hw_params *params,
  918. struct snd_soc_dai *dai)
  919. {
  920. struct snd_soc_codec *codec = dai->codec;
  921. unsigned char inf;
  922. /* bit size */
  923. switch (params_format(params)) {
  924. case SNDRV_PCM_FORMAT_S16_LE:
  925. inf = 0;
  926. break;
  927. case SNDRV_PCM_FORMAT_S18_3LE:
  928. inf = PCM_INF2_18WL;
  929. break;
  930. default:
  931. return -EINVAL;
  932. }
  933. snd_soc_update_bits(codec, PM860X_I2S_IFACE_2, PCM_INF2_18WL, inf);
  934. /* sample rate */
  935. switch (params_rate(params)) {
  936. case 8000:
  937. inf = 0;
  938. break;
  939. case 11025:
  940. inf = 1;
  941. break;
  942. case 16000:
  943. inf = 3;
  944. break;
  945. case 22050:
  946. inf = 4;
  947. break;
  948. case 32000:
  949. inf = 6;
  950. break;
  951. case 44100:
  952. inf = 7;
  953. break;
  954. case 48000:
  955. inf = 8;
  956. break;
  957. default:
  958. return -EINVAL;
  959. }
  960. snd_soc_update_bits(codec, PM860X_I2S_IFACE_4, 0xf, inf);
  961. return 0;
  962. }
  963. static int pm860x_i2s_set_dai_fmt(struct snd_soc_dai *codec_dai,
  964. unsigned int fmt)
  965. {
  966. struct snd_soc_codec *codec = codec_dai->codec;
  967. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  968. unsigned char inf = 0, mask = 0;
  969. mask |= PCM_INF2_BCLK | PCM_INF2_FS | PCM_INF2_MASTER;
  970. /* set master/slave audio interface */
  971. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  972. case SND_SOC_DAIFMT_CBM_CFM:
  973. if (pm860x->dir == PM860X_CLK_DIR_OUT)
  974. inf |= PCM_INF2_MASTER;
  975. else
  976. return -EINVAL;
  977. break;
  978. case SND_SOC_DAIFMT_CBS_CFS:
  979. if (pm860x->dir == PM860X_CLK_DIR_IN)
  980. inf &= ~PCM_INF2_MASTER;
  981. else
  982. return -EINVAL;
  983. break;
  984. default:
  985. return -EINVAL;
  986. }
  987. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  988. case SND_SOC_DAIFMT_I2S:
  989. inf |= PCM_EXACT_I2S;
  990. break;
  991. default:
  992. return -EINVAL;
  993. }
  994. mask |= PCM_MODE_MASK;
  995. snd_soc_update_bits(codec, PM860X_I2S_IFACE_2, mask, inf);
  996. return 0;
  997. }
  998. static int pm860x_set_bias_level(struct snd_soc_codec *codec,
  999. enum snd_soc_bias_level level)
  1000. {
  1001. int data;
  1002. switch (level) {
  1003. case SND_SOC_BIAS_ON:
  1004. break;
  1005. case SND_SOC_BIAS_PREPARE:
  1006. break;
  1007. case SND_SOC_BIAS_STANDBY:
  1008. if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
  1009. /* Enable Audio PLL & Audio section */
  1010. data = AUDIO_PLL | AUDIO_SECTION_ON;
  1011. pm860x_reg_write(codec->control_data, REG_MISC2, data);
  1012. udelay(300);
  1013. data = AUDIO_PLL | AUDIO_SECTION_RESET
  1014. | AUDIO_SECTION_ON;
  1015. pm860x_reg_write(codec->control_data, REG_MISC2, data);
  1016. }
  1017. break;
  1018. case SND_SOC_BIAS_OFF:
  1019. data = AUDIO_PLL | AUDIO_SECTION_RESET | AUDIO_SECTION_ON;
  1020. pm860x_set_bits(codec->control_data, REG_MISC2, data, 0);
  1021. break;
  1022. }
  1023. codec->dapm.bias_level = level;
  1024. return 0;
  1025. }
  1026. static const struct snd_soc_dai_ops pm860x_pcm_dai_ops = {
  1027. .digital_mute = pm860x_digital_mute,
  1028. .hw_params = pm860x_pcm_hw_params,
  1029. .set_fmt = pm860x_pcm_set_dai_fmt,
  1030. .set_sysclk = pm860x_set_dai_sysclk,
  1031. };
  1032. static const struct snd_soc_dai_ops pm860x_i2s_dai_ops = {
  1033. .digital_mute = pm860x_digital_mute,
  1034. .hw_params = pm860x_i2s_hw_params,
  1035. .set_fmt = pm860x_i2s_set_dai_fmt,
  1036. .set_sysclk = pm860x_set_dai_sysclk,
  1037. };
  1038. #define PM860X_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 | \
  1039. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000)
  1040. static struct snd_soc_dai_driver pm860x_dai[] = {
  1041. {
  1042. /* DAI PCM */
  1043. .name = "88pm860x-pcm",
  1044. .id = 1,
  1045. .playback = {
  1046. .stream_name = "PCM Playback",
  1047. .channels_min = 2,
  1048. .channels_max = 2,
  1049. .rates = PM860X_RATES,
  1050. .formats = SNDRV_PCM_FORMAT_S16_LE | \
  1051. SNDRV_PCM_FORMAT_S18_3LE,
  1052. },
  1053. .capture = {
  1054. .stream_name = "PCM Capture",
  1055. .channels_min = 2,
  1056. .channels_max = 2,
  1057. .rates = PM860X_RATES,
  1058. .formats = SNDRV_PCM_FORMAT_S16_LE | \
  1059. SNDRV_PCM_FORMAT_S18_3LE,
  1060. },
  1061. .ops = &pm860x_pcm_dai_ops,
  1062. }, {
  1063. /* DAI I2S */
  1064. .name = "88pm860x-i2s",
  1065. .id = 2,
  1066. .playback = {
  1067. .stream_name = "I2S Playback",
  1068. .channels_min = 2,
  1069. .channels_max = 2,
  1070. .rates = SNDRV_PCM_RATE_8000_48000,
  1071. .formats = SNDRV_PCM_FORMAT_S16_LE | \
  1072. SNDRV_PCM_FORMAT_S18_3LE,
  1073. },
  1074. .capture = {
  1075. .stream_name = "I2S Capture",
  1076. .channels_min = 2,
  1077. .channels_max = 2,
  1078. .rates = SNDRV_PCM_RATE_8000_48000,
  1079. .formats = SNDRV_PCM_FORMAT_S16_LE | \
  1080. SNDRV_PCM_FORMAT_S18_3LE,
  1081. },
  1082. .ops = &pm860x_i2s_dai_ops,
  1083. },
  1084. };
  1085. static irqreturn_t pm860x_codec_handler(int irq, void *data)
  1086. {
  1087. struct pm860x_priv *pm860x = data;
  1088. int status, shrt, report = 0, mic_report = 0;
  1089. int mask;
  1090. status = pm860x_reg_read(pm860x->i2c, REG_STATUS_1);
  1091. shrt = pm860x_reg_read(pm860x->i2c, REG_SHORTS);
  1092. mask = pm860x->det.hs_shrt | pm860x->det.hook_det | pm860x->det.lo_shrt
  1093. | pm860x->det.hp_det;
  1094. #ifndef CONFIG_SND_SOC_88PM860X_MODULE
  1095. if (status & (HEADSET_STATUS | MIC_STATUS | SHORT_HS1 | SHORT_HS2 |
  1096. SHORT_LO1 | SHORT_LO2))
  1097. trace_snd_soc_jack_irq(dev_name(pm860x->codec->dev));
  1098. #endif
  1099. if ((pm860x->det.hp_det & SND_JACK_HEADPHONE)
  1100. && (status & HEADSET_STATUS))
  1101. report |= SND_JACK_HEADPHONE;
  1102. if ((pm860x->det.mic_det & SND_JACK_MICROPHONE)
  1103. && (status & MIC_STATUS))
  1104. mic_report |= SND_JACK_MICROPHONE;
  1105. if (pm860x->det.hs_shrt && (shrt & (SHORT_HS1 | SHORT_HS2)))
  1106. report |= pm860x->det.hs_shrt;
  1107. if (pm860x->det.hook_det && (status & HOOK_STATUS))
  1108. report |= pm860x->det.hook_det;
  1109. if (pm860x->det.lo_shrt && (shrt & (SHORT_LO1 | SHORT_LO2)))
  1110. report |= pm860x->det.lo_shrt;
  1111. if (report)
  1112. snd_soc_jack_report(pm860x->det.hp_jack, report, mask);
  1113. if (mic_report)
  1114. snd_soc_jack_report(pm860x->det.mic_jack, SND_JACK_MICROPHONE,
  1115. SND_JACK_MICROPHONE);
  1116. dev_dbg(pm860x->codec->dev, "headphone report:0x%x, mask:%x\n",
  1117. report, mask);
  1118. dev_dbg(pm860x->codec->dev, "microphone report:0x%x\n", mic_report);
  1119. return IRQ_HANDLED;
  1120. }
  1121. int pm860x_hs_jack_detect(struct snd_soc_codec *codec,
  1122. struct snd_soc_jack *jack,
  1123. int det, int hook, int hs_shrt, int lo_shrt)
  1124. {
  1125. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  1126. int data;
  1127. pm860x->det.hp_jack = jack;
  1128. pm860x->det.hp_det = det;
  1129. pm860x->det.hook_det = hook;
  1130. pm860x->det.hs_shrt = hs_shrt;
  1131. pm860x->det.lo_shrt = lo_shrt;
  1132. if (det & SND_JACK_HEADPHONE)
  1133. pm860x_set_bits(codec->control_data, REG_HS_DET,
  1134. EN_HS_DET, EN_HS_DET);
  1135. /* headset short detect */
  1136. if (hs_shrt) {
  1137. data = CLR_SHORT_HS2 | CLR_SHORT_HS1;
  1138. pm860x_set_bits(codec->control_data, REG_SHORTS, data, data);
  1139. }
  1140. /* Lineout short detect */
  1141. if (lo_shrt) {
  1142. data = CLR_SHORT_LO2 | CLR_SHORT_LO1;
  1143. pm860x_set_bits(codec->control_data, REG_SHORTS, data, data);
  1144. }
  1145. /* sync status */
  1146. pm860x_codec_handler(0, pm860x);
  1147. return 0;
  1148. }
  1149. EXPORT_SYMBOL_GPL(pm860x_hs_jack_detect);
  1150. int pm860x_mic_jack_detect(struct snd_soc_codec *codec,
  1151. struct snd_soc_jack *jack, int det)
  1152. {
  1153. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  1154. pm860x->det.mic_jack = jack;
  1155. pm860x->det.mic_det = det;
  1156. if (det & SND_JACK_MICROPHONE)
  1157. pm860x_set_bits(codec->control_data, REG_MIC_DET,
  1158. MICDET_MASK, MICDET_MASK);
  1159. /* sync status */
  1160. pm860x_codec_handler(0, pm860x);
  1161. return 0;
  1162. }
  1163. EXPORT_SYMBOL_GPL(pm860x_mic_jack_detect);
  1164. static int pm860x_probe(struct snd_soc_codec *codec)
  1165. {
  1166. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  1167. int i, ret;
  1168. pm860x->codec = codec;
  1169. codec->control_data = pm860x->i2c;
  1170. for (i = 0; i < 4; i++) {
  1171. ret = request_threaded_irq(pm860x->irq[i], NULL,
  1172. pm860x_codec_handler, IRQF_ONESHOT,
  1173. pm860x->name[i], pm860x);
  1174. if (ret < 0) {
  1175. dev_err(codec->dev, "Failed to request IRQ!\n");
  1176. goto out;
  1177. }
  1178. }
  1179. pm860x_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  1180. ret = pm860x_bulk_read(codec->control_data, REG_CACHE_BASE,
  1181. REG_CACHE_SIZE, codec->reg_cache);
  1182. if (ret < 0) {
  1183. dev_err(codec->dev, "Failed to fill register cache: %d\n",
  1184. ret);
  1185. goto out;
  1186. }
  1187. return 0;
  1188. out:
  1189. while (--i >= 0)
  1190. free_irq(pm860x->irq[i], pm860x);
  1191. return ret;
  1192. }
  1193. static int pm860x_remove(struct snd_soc_codec *codec)
  1194. {
  1195. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  1196. int i;
  1197. for (i = 3; i >= 0; i--)
  1198. free_irq(pm860x->irq[i], pm860x);
  1199. pm860x_set_bias_level(codec, SND_SOC_BIAS_OFF);
  1200. return 0;
  1201. }
  1202. static struct snd_soc_codec_driver soc_codec_dev_pm860x = {
  1203. .probe = pm860x_probe,
  1204. .remove = pm860x_remove,
  1205. .read = pm860x_read_reg_cache,
  1206. .write = pm860x_write_reg_cache,
  1207. .reg_cache_size = REG_CACHE_SIZE,
  1208. .reg_word_size = sizeof(u8),
  1209. .set_bias_level = pm860x_set_bias_level,
  1210. .controls = pm860x_snd_controls,
  1211. .num_controls = ARRAY_SIZE(pm860x_snd_controls),
  1212. .dapm_widgets = pm860x_dapm_widgets,
  1213. .num_dapm_widgets = ARRAY_SIZE(pm860x_dapm_widgets),
  1214. .dapm_routes = pm860x_dapm_routes,
  1215. .num_dapm_routes = ARRAY_SIZE(pm860x_dapm_routes),
  1216. };
  1217. static int pm860x_codec_probe(struct platform_device *pdev)
  1218. {
  1219. struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent);
  1220. struct pm860x_priv *pm860x;
  1221. struct resource *res;
  1222. int i, ret;
  1223. pm860x = devm_kzalloc(&pdev->dev, sizeof(struct pm860x_priv),
  1224. GFP_KERNEL);
  1225. if (pm860x == NULL)
  1226. return -ENOMEM;
  1227. pm860x->chip = chip;
  1228. pm860x->i2c = (chip->id == CHIP_PM8607) ? chip->client
  1229. : chip->companion;
  1230. platform_set_drvdata(pdev, pm860x);
  1231. for (i = 0; i < 4; i++) {
  1232. res = platform_get_resource(pdev, IORESOURCE_IRQ, i);
  1233. if (!res) {
  1234. dev_err(&pdev->dev, "Failed to get IRQ resources\n");
  1235. goto out;
  1236. }
  1237. pm860x->irq[i] = res->start + chip->irq_base;
  1238. strncpy(pm860x->name[i], res->name, MAX_NAME_LEN);
  1239. }
  1240. ret = snd_soc_register_codec(&pdev->dev, &soc_codec_dev_pm860x,
  1241. pm860x_dai, ARRAY_SIZE(pm860x_dai));
  1242. if (ret) {
  1243. dev_err(&pdev->dev, "Failed to register codec\n");
  1244. goto out;
  1245. }
  1246. return ret;
  1247. out:
  1248. platform_set_drvdata(pdev, NULL);
  1249. return -EINVAL;
  1250. }
  1251. static int pm860x_codec_remove(struct platform_device *pdev)
  1252. {
  1253. snd_soc_unregister_codec(&pdev->dev);
  1254. platform_set_drvdata(pdev, NULL);
  1255. return 0;
  1256. }
  1257. static struct platform_driver pm860x_codec_driver = {
  1258. .driver = {
  1259. .name = "88pm860x-codec",
  1260. .owner = THIS_MODULE,
  1261. },
  1262. .probe = pm860x_codec_probe,
  1263. .remove = pm860x_codec_remove,
  1264. };
  1265. module_platform_driver(pm860x_codec_driver);
  1266. MODULE_DESCRIPTION("ASoC 88PM860x driver");
  1267. MODULE_AUTHOR("Haojian Zhuang <haojian.zhuang@marvell.com>");
  1268. MODULE_LICENSE("GPL");
  1269. MODULE_ALIAS("platform:88pm860x-codec");