88pm860x-codec.c 43 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435
  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 <linux/regmap.h>
  19. #include <sound/core.h>
  20. #include <sound/pcm.h>
  21. #include <sound/pcm_params.h>
  22. #include <sound/soc.h>
  23. #include <sound/tlv.h>
  24. #include <sound/initval.h>
  25. #include <sound/jack.h>
  26. #include <trace/events/asoc.h>
  27. #include "88pm860x-codec.h"
  28. #define MAX_NAME_LEN 20
  29. #define REG_CACHE_SIZE 0x40
  30. #define REG_CACHE_BASE 0xb0
  31. /* Status Register 1 (0x01) */
  32. #define REG_STATUS_1 0x01
  33. #define MIC_STATUS (1 << 7)
  34. #define HOOK_STATUS (1 << 6)
  35. #define HEADSET_STATUS (1 << 5)
  36. /* Mic Detection Register (0x37) */
  37. #define REG_MIC_DET 0x37
  38. #define CONTINUOUS_POLLING (3 << 1)
  39. #define EN_MIC_DET (1 << 0)
  40. #define MICDET_MASK 0x07
  41. /* Headset Detection Register (0x38) */
  42. #define REG_HS_DET 0x38
  43. #define EN_HS_DET (1 << 0)
  44. /* Misc2 Register (0x42) */
  45. #define REG_MISC2 0x42
  46. #define AUDIO_PLL (1 << 5)
  47. #define AUDIO_SECTION_RESET (1 << 4)
  48. #define AUDIO_SECTION_ON (1 << 3)
  49. /* PCM Interface Register 2 (0xb1) */
  50. #define PCM_INF2_BCLK (1 << 6) /* Bit clock polarity */
  51. #define PCM_INF2_FS (1 << 5) /* Frame Sync polarity */
  52. #define PCM_INF2_MASTER (1 << 4) /* Master / Slave */
  53. #define PCM_INF2_18WL (1 << 3) /* 18 / 16 bits */
  54. #define PCM_GENERAL_I2S 0
  55. #define PCM_EXACT_I2S 1
  56. #define PCM_LEFT_I2S 2
  57. #define PCM_RIGHT_I2S 3
  58. #define PCM_SHORT_FS 4
  59. #define PCM_LONG_FS 5
  60. #define PCM_MODE_MASK 7
  61. /* I2S Interface Register 4 (0xbe) */
  62. #define I2S_EQU_BYP (1 << 6)
  63. /* DAC Offset Register (0xcb) */
  64. #define DAC_MUTE (1 << 7)
  65. #define MUTE_LEFT (1 << 6)
  66. #define MUTE_RIGHT (1 << 2)
  67. /* ADC Analog Register 1 (0xd0) */
  68. #define REG_ADC_ANA_1 0xd0
  69. #define MIC1BIAS_MASK 0x60
  70. /* Earpiece/Speaker Control Register 2 (0xda) */
  71. #define REG_EAR2 0xda
  72. #define RSYNC_CHANGE (1 << 2)
  73. /* Audio Supplies Register 2 (0xdc) */
  74. #define REG_SUPPLIES2 0xdc
  75. #define LDO15_READY (1 << 4)
  76. #define LDO15_EN (1 << 3)
  77. #define CPUMP_READY (1 << 2)
  78. #define CPUMP_EN (1 << 1)
  79. #define AUDIO_EN (1 << 0)
  80. #define SUPPLY_MASK (LDO15_EN | CPUMP_EN | AUDIO_EN)
  81. /* Audio Enable Register 1 (0xdd) */
  82. #define ADC_MOD_RIGHT (1 << 1)
  83. #define ADC_MOD_LEFT (1 << 0)
  84. /* Audio Enable Register 2 (0xde) */
  85. #define ADC_LEFT (1 << 5)
  86. #define ADC_RIGHT (1 << 4)
  87. /* DAC Enable Register 2 (0xe1) */
  88. #define DAC_LEFT (1 << 5)
  89. #define DAC_RIGHT (1 << 4)
  90. #define MODULATOR (1 << 3)
  91. /* Shorts Register (0xeb) */
  92. #define REG_SHORTS 0xeb
  93. #define CLR_SHORT_LO2 (1 << 7)
  94. #define SHORT_LO2 (1 << 6)
  95. #define CLR_SHORT_LO1 (1 << 5)
  96. #define SHORT_LO1 (1 << 4)
  97. #define CLR_SHORT_HS2 (1 << 3)
  98. #define SHORT_HS2 (1 << 2)
  99. #define CLR_SHORT_HS1 (1 << 1)
  100. #define SHORT_HS1 (1 << 0)
  101. /*
  102. * This widget should be just after DAC & PGA in DAPM power-on sequence and
  103. * before DAC & PGA in DAPM power-off sequence.
  104. */
  105. #define PM860X_DAPM_OUTPUT(wname, wevent) \
  106. SND_SOC_DAPM_PGA_E(wname, SND_SOC_NOPM, 0, 0, NULL, 0, wevent, \
  107. SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD)
  108. struct pm860x_det {
  109. struct snd_soc_jack *hp_jack;
  110. struct snd_soc_jack *mic_jack;
  111. int hp_det;
  112. int mic_det;
  113. int hook_det;
  114. int hs_shrt;
  115. int lo_shrt;
  116. };
  117. struct pm860x_priv {
  118. unsigned int sysclk;
  119. unsigned int pcmclk;
  120. unsigned int dir;
  121. unsigned int filter;
  122. struct snd_soc_codec *codec;
  123. struct i2c_client *i2c;
  124. struct regmap *regmap;
  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 snd_soc_get_volsw_2r_st(struct snd_kcontrol *kcontrol,
  245. struct snd_ctl_elem_value *ucontrol)
  246. {
  247. struct soc_mixer_control *mc =
  248. (struct soc_mixer_control *)kcontrol->private_value;
  249. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  250. unsigned int reg = mc->reg;
  251. unsigned int reg2 = mc->rreg;
  252. int val[2], val2[2], i;
  253. val[0] = snd_soc_read(codec, reg) & 0x3f;
  254. val[1] = (snd_soc_read(codec, PM860X_SIDETONE_SHIFT) >> 4) & 0xf;
  255. val2[0] = snd_soc_read(codec, reg2) & 0x3f;
  256. val2[1] = (snd_soc_read(codec, PM860X_SIDETONE_SHIFT)) & 0xf;
  257. for (i = 0; i < ARRAY_SIZE(st_table); i++) {
  258. if ((st_table[i].m == val[0]) && (st_table[i].n == val[1]))
  259. ucontrol->value.integer.value[0] = i;
  260. if ((st_table[i].m == val2[0]) && (st_table[i].n == val2[1]))
  261. ucontrol->value.integer.value[1] = i;
  262. }
  263. return 0;
  264. }
  265. static int snd_soc_put_volsw_2r_st(struct snd_kcontrol *kcontrol,
  266. struct snd_ctl_elem_value *ucontrol)
  267. {
  268. struct soc_mixer_control *mc =
  269. (struct soc_mixer_control *)kcontrol->private_value;
  270. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  271. unsigned int reg = mc->reg;
  272. unsigned int reg2 = mc->rreg;
  273. int err;
  274. unsigned int val, val2;
  275. val = ucontrol->value.integer.value[0];
  276. val2 = ucontrol->value.integer.value[1];
  277. if (val >= ARRAY_SIZE(st_table) || val2 >= ARRAY_SIZE(st_table))
  278. return -EINVAL;
  279. err = snd_soc_update_bits(codec, reg, 0x3f, st_table[val].m);
  280. if (err < 0)
  281. return err;
  282. err = snd_soc_update_bits(codec, PM860X_SIDETONE_SHIFT, 0xf0,
  283. st_table[val].n << 4);
  284. if (err < 0)
  285. return err;
  286. err = snd_soc_update_bits(codec, reg2, 0x3f, st_table[val2].m);
  287. if (err < 0)
  288. return err;
  289. err = snd_soc_update_bits(codec, PM860X_SIDETONE_SHIFT, 0x0f,
  290. st_table[val2].n);
  291. return err;
  292. }
  293. static int snd_soc_get_volsw_2r_out(struct snd_kcontrol *kcontrol,
  294. struct snd_ctl_elem_value *ucontrol)
  295. {
  296. struct soc_mixer_control *mc =
  297. (struct soc_mixer_control *)kcontrol->private_value;
  298. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  299. unsigned int reg = mc->reg;
  300. unsigned int reg2 = mc->rreg;
  301. unsigned int shift = mc->shift;
  302. int max = mc->max, val, val2;
  303. unsigned int mask = (1 << fls(max)) - 1;
  304. val = snd_soc_read(codec, reg) >> shift;
  305. val2 = snd_soc_read(codec, reg2) >> shift;
  306. ucontrol->value.integer.value[0] = (max - val) & mask;
  307. ucontrol->value.integer.value[1] = (max - val2) & mask;
  308. return 0;
  309. }
  310. static int snd_soc_put_volsw_2r_out(struct snd_kcontrol *kcontrol,
  311. struct snd_ctl_elem_value *ucontrol)
  312. {
  313. struct soc_mixer_control *mc =
  314. (struct soc_mixer_control *)kcontrol->private_value;
  315. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  316. unsigned int reg = mc->reg;
  317. unsigned int reg2 = mc->rreg;
  318. unsigned int shift = mc->shift;
  319. int max = mc->max;
  320. unsigned int mask = (1 << fls(max)) - 1;
  321. int err;
  322. unsigned int val, val2, val_mask;
  323. val_mask = mask << shift;
  324. val = ((max - ucontrol->value.integer.value[0]) & mask);
  325. val2 = ((max - ucontrol->value.integer.value[1]) & mask);
  326. val = val << shift;
  327. val2 = val2 << shift;
  328. err = snd_soc_update_bits(codec, reg, val_mask, val);
  329. if (err < 0)
  330. return err;
  331. err = snd_soc_update_bits(codec, reg2, val_mask, val2);
  332. return err;
  333. }
  334. /* DAPM Widget Events */
  335. /*
  336. * A lot registers are belong to RSYNC domain. It requires enabling RSYNC bit
  337. * after updating these registers. Otherwise, these updated registers won't
  338. * be effective.
  339. */
  340. static int pm860x_rsync_event(struct snd_soc_dapm_widget *w,
  341. struct snd_kcontrol *kcontrol, int event)
  342. {
  343. struct snd_soc_codec *codec = w->codec;
  344. /*
  345. * In order to avoid current on the load, mute power-on and power-off
  346. * should be transients.
  347. * Unmute by DAC_MUTE. It should be unmuted when DAPM sequence is
  348. * finished.
  349. */
  350. snd_soc_update_bits(codec, PM860X_DAC_OFFSET, DAC_MUTE, 0);
  351. snd_soc_update_bits(codec, PM860X_EAR_CTRL_2,
  352. RSYNC_CHANGE, RSYNC_CHANGE);
  353. return 0;
  354. }
  355. static int pm860x_dac_event(struct snd_soc_dapm_widget *w,
  356. struct snd_kcontrol *kcontrol, int event)
  357. {
  358. struct snd_soc_codec *codec = w->codec;
  359. unsigned int dac = 0;
  360. int data;
  361. if (!strcmp(w->name, "Left DAC"))
  362. dac = DAC_LEFT;
  363. if (!strcmp(w->name, "Right DAC"))
  364. dac = DAC_RIGHT;
  365. switch (event) {
  366. case SND_SOC_DAPM_PRE_PMU:
  367. if (dac) {
  368. /* Auto mute in power-on sequence. */
  369. dac |= MODULATOR;
  370. snd_soc_update_bits(codec, PM860X_DAC_OFFSET,
  371. DAC_MUTE, DAC_MUTE);
  372. snd_soc_update_bits(codec, PM860X_EAR_CTRL_2,
  373. RSYNC_CHANGE, RSYNC_CHANGE);
  374. /* update dac */
  375. snd_soc_update_bits(codec, PM860X_DAC_EN_2,
  376. dac, dac);
  377. }
  378. break;
  379. case SND_SOC_DAPM_PRE_PMD:
  380. if (dac) {
  381. /* Auto mute in power-off sequence. */
  382. snd_soc_update_bits(codec, PM860X_DAC_OFFSET,
  383. DAC_MUTE, DAC_MUTE);
  384. snd_soc_update_bits(codec, PM860X_EAR_CTRL_2,
  385. RSYNC_CHANGE, RSYNC_CHANGE);
  386. /* update dac */
  387. data = snd_soc_read(codec, PM860X_DAC_EN_2);
  388. data &= ~dac;
  389. if (!(data & (DAC_LEFT | DAC_RIGHT)))
  390. data &= ~MODULATOR;
  391. snd_soc_write(codec, PM860X_DAC_EN_2, data);
  392. }
  393. break;
  394. }
  395. return 0;
  396. }
  397. static const char *pm860x_opamp_texts[] = {"-50%", "-25%", "0%", "75%"};
  398. static const char *pm860x_pa_texts[] = {"-33%", "0%", "33%", "66%"};
  399. static const struct soc_enum pm860x_hs1_opamp_enum =
  400. SOC_ENUM_SINGLE(PM860X_HS1_CTRL, 5, 4, pm860x_opamp_texts);
  401. static const struct soc_enum pm860x_hs2_opamp_enum =
  402. SOC_ENUM_SINGLE(PM860X_HS2_CTRL, 5, 4, pm860x_opamp_texts);
  403. static const struct soc_enum pm860x_hs1_pa_enum =
  404. SOC_ENUM_SINGLE(PM860X_HS1_CTRL, 3, 4, pm860x_pa_texts);
  405. static const struct soc_enum pm860x_hs2_pa_enum =
  406. SOC_ENUM_SINGLE(PM860X_HS2_CTRL, 3, 4, pm860x_pa_texts);
  407. static const struct soc_enum pm860x_lo1_opamp_enum =
  408. SOC_ENUM_SINGLE(PM860X_LO1_CTRL, 5, 4, pm860x_opamp_texts);
  409. static const struct soc_enum pm860x_lo2_opamp_enum =
  410. SOC_ENUM_SINGLE(PM860X_LO2_CTRL, 5, 4, pm860x_opamp_texts);
  411. static const struct soc_enum pm860x_lo1_pa_enum =
  412. SOC_ENUM_SINGLE(PM860X_LO1_CTRL, 3, 4, pm860x_pa_texts);
  413. static const struct soc_enum pm860x_lo2_pa_enum =
  414. SOC_ENUM_SINGLE(PM860X_LO2_CTRL, 3, 4, pm860x_pa_texts);
  415. static const struct soc_enum pm860x_spk_pa_enum =
  416. SOC_ENUM_SINGLE(PM860X_EAR_CTRL_1, 5, 4, pm860x_pa_texts);
  417. static const struct soc_enum pm860x_ear_pa_enum =
  418. SOC_ENUM_SINGLE(PM860X_EAR_CTRL_2, 0, 4, pm860x_pa_texts);
  419. static const struct soc_enum pm860x_spk_ear_opamp_enum =
  420. SOC_ENUM_SINGLE(PM860X_EAR_CTRL_1, 3, 4, pm860x_opamp_texts);
  421. static const struct snd_kcontrol_new pm860x_snd_controls[] = {
  422. SOC_DOUBLE_R_TLV("ADC Capture Volume", PM860X_ADC_ANA_2,
  423. PM860X_ADC_ANA_3, 6, 3, 0, adc_tlv),
  424. SOC_DOUBLE_TLV("AUX Capture Volume", PM860X_ADC_ANA_3, 0, 3, 7, 0,
  425. aux_tlv),
  426. SOC_SINGLE_TLV("MIC1 Capture Volume", PM860X_ADC_ANA_2, 0, 7, 0,
  427. mic_tlv),
  428. SOC_SINGLE_TLV("MIC3 Capture Volume", PM860X_ADC_ANA_2, 3, 7, 0,
  429. mic_tlv),
  430. SOC_DOUBLE_R_EXT_TLV("Sidetone Volume", PM860X_SIDETONE_L_GAIN,
  431. PM860X_SIDETONE_R_GAIN, 0, ARRAY_SIZE(st_table)-1,
  432. 0, snd_soc_get_volsw_2r_st,
  433. snd_soc_put_volsw_2r_st, st_tlv),
  434. SOC_SINGLE_TLV("Speaker Playback Volume", PM860X_EAR_CTRL_1,
  435. 0, 7, 0, out_tlv),
  436. SOC_DOUBLE_R_TLV("Line Playback Volume", PM860X_LO1_CTRL,
  437. PM860X_LO2_CTRL, 0, 7, 0, out_tlv),
  438. SOC_DOUBLE_R_TLV("Headset Playback Volume", PM860X_HS1_CTRL,
  439. PM860X_HS2_CTRL, 0, 7, 0, out_tlv),
  440. SOC_DOUBLE_R_EXT_TLV("Hifi Left Playback Volume",
  441. PM860X_HIFIL_GAIN_LEFT,
  442. PM860X_HIFIL_GAIN_RIGHT, 0, 63, 0,
  443. snd_soc_get_volsw_2r_out,
  444. snd_soc_put_volsw_2r_out, dpga_tlv),
  445. SOC_DOUBLE_R_EXT_TLV("Hifi Right Playback Volume",
  446. PM860X_HIFIR_GAIN_LEFT,
  447. PM860X_HIFIR_GAIN_RIGHT, 0, 63, 0,
  448. snd_soc_get_volsw_2r_out,
  449. snd_soc_put_volsw_2r_out, dpga_tlv),
  450. SOC_DOUBLE_R_EXT_TLV("Lofi Playback Volume", PM860X_LOFI_GAIN_LEFT,
  451. PM860X_LOFI_GAIN_RIGHT, 0, 63, 0,
  452. snd_soc_get_volsw_2r_out,
  453. snd_soc_put_volsw_2r_out, dpga_tlv),
  454. SOC_ENUM("Headset1 Operational Amplifier Current",
  455. pm860x_hs1_opamp_enum),
  456. SOC_ENUM("Headset2 Operational Amplifier Current",
  457. pm860x_hs2_opamp_enum),
  458. SOC_ENUM("Headset1 Amplifier Current", pm860x_hs1_pa_enum),
  459. SOC_ENUM("Headset2 Amplifier Current", pm860x_hs2_pa_enum),
  460. SOC_ENUM("Lineout1 Operational Amplifier Current",
  461. pm860x_lo1_opamp_enum),
  462. SOC_ENUM("Lineout2 Operational Amplifier Current",
  463. pm860x_lo2_opamp_enum),
  464. SOC_ENUM("Lineout1 Amplifier Current", pm860x_lo1_pa_enum),
  465. SOC_ENUM("Lineout2 Amplifier Current", pm860x_lo2_pa_enum),
  466. SOC_ENUM("Speaker Operational Amplifier Current",
  467. pm860x_spk_ear_opamp_enum),
  468. SOC_ENUM("Speaker Amplifier Current", pm860x_spk_pa_enum),
  469. SOC_ENUM("Earpiece Amplifier Current", pm860x_ear_pa_enum),
  470. };
  471. /*
  472. * DAPM Controls
  473. */
  474. /* PCM Switch / PCM Interface */
  475. static const struct snd_kcontrol_new pcm_switch_controls =
  476. SOC_DAPM_SINGLE("Switch", PM860X_ADC_EN_2, 0, 1, 0);
  477. /* AUX1 Switch */
  478. static const struct snd_kcontrol_new aux1_switch_controls =
  479. SOC_DAPM_SINGLE("Switch", PM860X_ANA_TO_ANA, 4, 1, 0);
  480. /* AUX2 Switch */
  481. static const struct snd_kcontrol_new aux2_switch_controls =
  482. SOC_DAPM_SINGLE("Switch", PM860X_ANA_TO_ANA, 5, 1, 0);
  483. /* Left Ex. PA Switch */
  484. static const struct snd_kcontrol_new lepa_switch_controls =
  485. SOC_DAPM_SINGLE("Switch", PM860X_DAC_EN_2, 2, 1, 0);
  486. /* Right Ex. PA Switch */
  487. static const struct snd_kcontrol_new repa_switch_controls =
  488. SOC_DAPM_SINGLE("Switch", PM860X_DAC_EN_2, 1, 1, 0);
  489. /* PCM Mux / Mux7 */
  490. static const char *aif1_text[] = {
  491. "PCM L", "PCM R",
  492. };
  493. static const struct soc_enum aif1_enum =
  494. SOC_ENUM_SINGLE(PM860X_PCM_IFACE_3, 6, 2, aif1_text);
  495. static const struct snd_kcontrol_new aif1_mux =
  496. SOC_DAPM_ENUM("PCM Mux", aif1_enum);
  497. /* I2S Mux / Mux9 */
  498. static const char *i2s_din_text[] = {
  499. "DIN", "DIN1",
  500. };
  501. static const struct soc_enum i2s_din_enum =
  502. SOC_ENUM_SINGLE(PM860X_I2S_IFACE_3, 1, 2, i2s_din_text);
  503. static const struct snd_kcontrol_new i2s_din_mux =
  504. SOC_DAPM_ENUM("I2S DIN Mux", i2s_din_enum);
  505. /* I2S Mic Mux / Mux8 */
  506. static const char *i2s_mic_text[] = {
  507. "Ex PA", "ADC",
  508. };
  509. static const struct soc_enum i2s_mic_enum =
  510. SOC_ENUM_SINGLE(PM860X_I2S_IFACE_3, 4, 2, i2s_mic_text);
  511. static const struct snd_kcontrol_new i2s_mic_mux =
  512. SOC_DAPM_ENUM("I2S Mic Mux", i2s_mic_enum);
  513. /* ADCL Mux / Mux2 */
  514. static const char *adcl_text[] = {
  515. "ADCR", "ADCL",
  516. };
  517. static const struct soc_enum adcl_enum =
  518. SOC_ENUM_SINGLE(PM860X_PCM_IFACE_3, 4, 2, adcl_text);
  519. static const struct snd_kcontrol_new adcl_mux =
  520. SOC_DAPM_ENUM("ADC Left Mux", adcl_enum);
  521. /* ADCR Mux / Mux3 */
  522. static const char *adcr_text[] = {
  523. "ADCL", "ADCR",
  524. };
  525. static const struct soc_enum adcr_enum =
  526. SOC_ENUM_SINGLE(PM860X_PCM_IFACE_3, 2, 2, adcr_text);
  527. static const struct snd_kcontrol_new adcr_mux =
  528. SOC_DAPM_ENUM("ADC Right Mux", adcr_enum);
  529. /* ADCR EC Mux / Mux6 */
  530. static const char *adcr_ec_text[] = {
  531. "ADCR", "EC",
  532. };
  533. static const struct soc_enum adcr_ec_enum =
  534. SOC_ENUM_SINGLE(PM860X_ADC_EN_2, 3, 2, adcr_ec_text);
  535. static const struct snd_kcontrol_new adcr_ec_mux =
  536. SOC_DAPM_ENUM("ADCR EC Mux", adcr_ec_enum);
  537. /* EC Mux / Mux4 */
  538. static const char *ec_text[] = {
  539. "Left", "Right", "Left + Right",
  540. };
  541. static const struct soc_enum ec_enum =
  542. SOC_ENUM_SINGLE(PM860X_EC_PATH, 1, 3, ec_text);
  543. static const struct snd_kcontrol_new ec_mux =
  544. SOC_DAPM_ENUM("EC Mux", ec_enum);
  545. static const char *dac_text[] = {
  546. "No input", "Right", "Left", "No input",
  547. };
  548. /* DAC Headset 1 Mux / Mux10 */
  549. static const struct soc_enum dac_hs1_enum =
  550. SOC_ENUM_SINGLE(PM860X_ANA_INPUT_SEL_1, 0, 4, dac_text);
  551. static const struct snd_kcontrol_new dac_hs1_mux =
  552. SOC_DAPM_ENUM("DAC HS1 Mux", dac_hs1_enum);
  553. /* DAC Headset 2 Mux / Mux11 */
  554. static const struct soc_enum dac_hs2_enum =
  555. SOC_ENUM_SINGLE(PM860X_ANA_INPUT_SEL_1, 2, 4, dac_text);
  556. static const struct snd_kcontrol_new dac_hs2_mux =
  557. SOC_DAPM_ENUM("DAC HS2 Mux", dac_hs2_enum);
  558. /* DAC Lineout 1 Mux / Mux12 */
  559. static const struct soc_enum dac_lo1_enum =
  560. SOC_ENUM_SINGLE(PM860X_ANA_INPUT_SEL_1, 4, 4, dac_text);
  561. static const struct snd_kcontrol_new dac_lo1_mux =
  562. SOC_DAPM_ENUM("DAC LO1 Mux", dac_lo1_enum);
  563. /* DAC Lineout 2 Mux / Mux13 */
  564. static const struct soc_enum dac_lo2_enum =
  565. SOC_ENUM_SINGLE(PM860X_ANA_INPUT_SEL_1, 6, 4, dac_text);
  566. static const struct snd_kcontrol_new dac_lo2_mux =
  567. SOC_DAPM_ENUM("DAC LO2 Mux", dac_lo2_enum);
  568. /* DAC Spearker Earphone Mux / Mux14 */
  569. static const struct soc_enum dac_spk_ear_enum =
  570. SOC_ENUM_SINGLE(PM860X_ANA_INPUT_SEL_2, 0, 4, dac_text);
  571. static const struct snd_kcontrol_new dac_spk_ear_mux =
  572. SOC_DAPM_ENUM("DAC SP Mux", dac_spk_ear_enum);
  573. /* Headset 1 Mux / Mux15 */
  574. static const char *in_text[] = {
  575. "Digital", "Analog",
  576. };
  577. static const struct soc_enum hs1_enum =
  578. SOC_ENUM_SINGLE(PM860X_ANA_TO_ANA, 0, 2, in_text);
  579. static const struct snd_kcontrol_new hs1_mux =
  580. SOC_DAPM_ENUM("Headset1 Mux", hs1_enum);
  581. /* Headset 2 Mux / Mux16 */
  582. static const struct soc_enum hs2_enum =
  583. SOC_ENUM_SINGLE(PM860X_ANA_TO_ANA, 1, 2, in_text);
  584. static const struct snd_kcontrol_new hs2_mux =
  585. SOC_DAPM_ENUM("Headset2 Mux", hs2_enum);
  586. /* Lineout 1 Mux / Mux17 */
  587. static const struct soc_enum lo1_enum =
  588. SOC_ENUM_SINGLE(PM860X_ANA_TO_ANA, 2, 2, in_text);
  589. static const struct snd_kcontrol_new lo1_mux =
  590. SOC_DAPM_ENUM("Lineout1 Mux", lo1_enum);
  591. /* Lineout 2 Mux / Mux18 */
  592. static const struct soc_enum lo2_enum =
  593. SOC_ENUM_SINGLE(PM860X_ANA_TO_ANA, 3, 2, in_text);
  594. static const struct snd_kcontrol_new lo2_mux =
  595. SOC_DAPM_ENUM("Lineout2 Mux", lo2_enum);
  596. /* Speaker Earpiece Demux */
  597. static const char *spk_text[] = {
  598. "Earpiece", "Speaker",
  599. };
  600. static const struct soc_enum spk_enum =
  601. SOC_ENUM_SINGLE(PM860X_ANA_TO_ANA, 6, 2, spk_text);
  602. static const struct snd_kcontrol_new spk_demux =
  603. SOC_DAPM_ENUM("Speaker Earpiece Demux", spk_enum);
  604. /* MIC Mux / Mux1 */
  605. static const char *mic_text[] = {
  606. "Mic 1", "Mic 2",
  607. };
  608. static const struct soc_enum mic_enum =
  609. SOC_ENUM_SINGLE(PM860X_ADC_ANA_4, 4, 2, mic_text);
  610. static const struct snd_kcontrol_new mic_mux =
  611. SOC_DAPM_ENUM("MIC Mux", mic_enum);
  612. static const struct snd_soc_dapm_widget pm860x_dapm_widgets[] = {
  613. SND_SOC_DAPM_AIF_IN("PCM SDI", "PCM Playback", 0,
  614. PM860X_ADC_EN_2, 0, 0),
  615. SND_SOC_DAPM_AIF_OUT("PCM SDO", "PCM Capture", 0,
  616. PM860X_PCM_IFACE_3, 1, 1),
  617. SND_SOC_DAPM_AIF_IN("I2S DIN", "I2S Playback", 0,
  618. SND_SOC_NOPM, 0, 0),
  619. SND_SOC_DAPM_AIF_IN("I2S DIN1", "I2S Playback", 0,
  620. SND_SOC_NOPM, 0, 0),
  621. SND_SOC_DAPM_AIF_OUT("I2S DOUT", "I2S Capture", 0,
  622. PM860X_I2S_IFACE_3, 5, 1),
  623. SND_SOC_DAPM_SUPPLY("I2S CLK", PM860X_DAC_EN_2, 0, 0, NULL, 0),
  624. SND_SOC_DAPM_MUX("I2S Mic Mux", SND_SOC_NOPM, 0, 0, &i2s_mic_mux),
  625. SND_SOC_DAPM_MUX("ADC Left Mux", SND_SOC_NOPM, 0, 0, &adcl_mux),
  626. SND_SOC_DAPM_MUX("ADC Right Mux", SND_SOC_NOPM, 0, 0, &adcr_mux),
  627. SND_SOC_DAPM_MUX("EC Mux", SND_SOC_NOPM, 0, 0, &ec_mux),
  628. SND_SOC_DAPM_MUX("ADCR EC Mux", SND_SOC_NOPM, 0, 0, &adcr_ec_mux),
  629. SND_SOC_DAPM_SWITCH("Left EPA", SND_SOC_NOPM, 0, 0,
  630. &lepa_switch_controls),
  631. SND_SOC_DAPM_SWITCH("Right EPA", SND_SOC_NOPM, 0, 0,
  632. &repa_switch_controls),
  633. SND_SOC_DAPM_REG(snd_soc_dapm_supply, "Left ADC MOD", PM860X_ADC_EN_1,
  634. 0, 1, 1, 0),
  635. SND_SOC_DAPM_REG(snd_soc_dapm_supply, "Right ADC MOD", PM860X_ADC_EN_1,
  636. 1, 1, 1, 0),
  637. SND_SOC_DAPM_ADC("Left ADC", NULL, PM860X_ADC_EN_2, 5, 0),
  638. SND_SOC_DAPM_ADC("Right ADC", NULL, PM860X_ADC_EN_2, 4, 0),
  639. SND_SOC_DAPM_SWITCH("AUX1 Switch", SND_SOC_NOPM, 0, 0,
  640. &aux1_switch_controls),
  641. SND_SOC_DAPM_SWITCH("AUX2 Switch", SND_SOC_NOPM, 0, 0,
  642. &aux2_switch_controls),
  643. SND_SOC_DAPM_MUX("MIC Mux", SND_SOC_NOPM, 0, 0, &mic_mux),
  644. SND_SOC_DAPM_MICBIAS("Mic1 Bias", PM860X_ADC_ANA_1, 2, 0),
  645. SND_SOC_DAPM_MICBIAS("Mic3 Bias", PM860X_ADC_ANA_1, 7, 0),
  646. SND_SOC_DAPM_PGA("MIC1 Volume", PM860X_ADC_EN_1, 2, 0, NULL, 0),
  647. SND_SOC_DAPM_PGA("MIC3 Volume", PM860X_ADC_EN_1, 3, 0, NULL, 0),
  648. SND_SOC_DAPM_PGA("AUX1 Volume", PM860X_ADC_EN_1, 4, 0, NULL, 0),
  649. SND_SOC_DAPM_PGA("AUX2 Volume", PM860X_ADC_EN_1, 5, 0, NULL, 0),
  650. SND_SOC_DAPM_PGA("Sidetone PGA", PM860X_ADC_EN_2, 1, 0, NULL, 0),
  651. SND_SOC_DAPM_PGA("Lofi PGA", PM860X_ADC_EN_2, 2, 0, NULL, 0),
  652. SND_SOC_DAPM_INPUT("AUX1"),
  653. SND_SOC_DAPM_INPUT("AUX2"),
  654. SND_SOC_DAPM_INPUT("MIC1P"),
  655. SND_SOC_DAPM_INPUT("MIC1N"),
  656. SND_SOC_DAPM_INPUT("MIC2P"),
  657. SND_SOC_DAPM_INPUT("MIC2N"),
  658. SND_SOC_DAPM_INPUT("MIC3P"),
  659. SND_SOC_DAPM_INPUT("MIC3N"),
  660. SND_SOC_DAPM_DAC_E("Left DAC", NULL, SND_SOC_NOPM, 0, 0,
  661. pm860x_dac_event,
  662. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD),
  663. SND_SOC_DAPM_DAC_E("Right DAC", NULL, SND_SOC_NOPM, 0, 0,
  664. pm860x_dac_event,
  665. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD),
  666. SND_SOC_DAPM_MUX("I2S DIN Mux", SND_SOC_NOPM, 0, 0, &i2s_din_mux),
  667. SND_SOC_DAPM_MUX("DAC HS1 Mux", SND_SOC_NOPM, 0, 0, &dac_hs1_mux),
  668. SND_SOC_DAPM_MUX("DAC HS2 Mux", SND_SOC_NOPM, 0, 0, &dac_hs2_mux),
  669. SND_SOC_DAPM_MUX("DAC LO1 Mux", SND_SOC_NOPM, 0, 0, &dac_lo1_mux),
  670. SND_SOC_DAPM_MUX("DAC LO2 Mux", SND_SOC_NOPM, 0, 0, &dac_lo2_mux),
  671. SND_SOC_DAPM_MUX("DAC SP Mux", SND_SOC_NOPM, 0, 0, &dac_spk_ear_mux),
  672. SND_SOC_DAPM_MUX("Headset1 Mux", SND_SOC_NOPM, 0, 0, &hs1_mux),
  673. SND_SOC_DAPM_MUX("Headset2 Mux", SND_SOC_NOPM, 0, 0, &hs2_mux),
  674. SND_SOC_DAPM_MUX("Lineout1 Mux", SND_SOC_NOPM, 0, 0, &lo1_mux),
  675. SND_SOC_DAPM_MUX("Lineout2 Mux", SND_SOC_NOPM, 0, 0, &lo2_mux),
  676. SND_SOC_DAPM_MUX("Speaker Earpiece Demux", SND_SOC_NOPM, 0, 0,
  677. &spk_demux),
  678. SND_SOC_DAPM_PGA("Headset1 PGA", PM860X_DAC_EN_1, 0, 0, NULL, 0),
  679. SND_SOC_DAPM_PGA("Headset2 PGA", PM860X_DAC_EN_1, 1, 0, NULL, 0),
  680. SND_SOC_DAPM_OUTPUT("HS1"),
  681. SND_SOC_DAPM_OUTPUT("HS2"),
  682. SND_SOC_DAPM_PGA("Lineout1 PGA", PM860X_DAC_EN_1, 2, 0, NULL, 0),
  683. SND_SOC_DAPM_PGA("Lineout2 PGA", PM860X_DAC_EN_1, 3, 0, NULL, 0),
  684. SND_SOC_DAPM_OUTPUT("LINEOUT1"),
  685. SND_SOC_DAPM_OUTPUT("LINEOUT2"),
  686. SND_SOC_DAPM_PGA("Earpiece PGA", PM860X_DAC_EN_1, 4, 0, NULL, 0),
  687. SND_SOC_DAPM_OUTPUT("EARP"),
  688. SND_SOC_DAPM_OUTPUT("EARN"),
  689. SND_SOC_DAPM_PGA("Speaker PGA", PM860X_DAC_EN_1, 5, 0, NULL, 0),
  690. SND_SOC_DAPM_OUTPUT("LSP"),
  691. SND_SOC_DAPM_OUTPUT("LSN"),
  692. SND_SOC_DAPM_REG(snd_soc_dapm_supply, "VCODEC", PM860X_AUDIO_SUPPLIES_2,
  693. 0, SUPPLY_MASK, SUPPLY_MASK, 0),
  694. PM860X_DAPM_OUTPUT("RSYNC", pm860x_rsync_event),
  695. };
  696. static const struct snd_soc_dapm_route pm860x_dapm_routes[] = {
  697. /* supply */
  698. {"Left DAC", NULL, "VCODEC"},
  699. {"Right DAC", NULL, "VCODEC"},
  700. {"Left ADC", NULL, "VCODEC"},
  701. {"Right ADC", NULL, "VCODEC"},
  702. {"Left ADC", NULL, "Left ADC MOD"},
  703. {"Right ADC", NULL, "Right ADC MOD"},
  704. /* I2S Clock */
  705. {"I2S DIN", NULL, "I2S CLK"},
  706. {"I2S DIN1", NULL, "I2S CLK"},
  707. {"I2S DOUT", NULL, "I2S CLK"},
  708. /* PCM/AIF1 Inputs */
  709. {"PCM SDO", NULL, "ADC Left Mux"},
  710. {"PCM SDO", NULL, "ADCR EC Mux"},
  711. /* PCM/AFI2 Outputs */
  712. {"Lofi PGA", NULL, "PCM SDI"},
  713. {"Lofi PGA", NULL, "Sidetone PGA"},
  714. {"Left DAC", NULL, "Lofi PGA"},
  715. {"Right DAC", NULL, "Lofi PGA"},
  716. /* I2S/AIF2 Inputs */
  717. {"MIC Mux", "Mic 1", "MIC1P"},
  718. {"MIC Mux", "Mic 1", "MIC1N"},
  719. {"MIC Mux", "Mic 2", "MIC2P"},
  720. {"MIC Mux", "Mic 2", "MIC2N"},
  721. {"MIC1 Volume", NULL, "MIC Mux"},
  722. {"MIC3 Volume", NULL, "MIC3P"},
  723. {"MIC3 Volume", NULL, "MIC3N"},
  724. {"Left ADC", NULL, "MIC1 Volume"},
  725. {"Right ADC", NULL, "MIC3 Volume"},
  726. {"ADC Left Mux", "ADCR", "Right ADC"},
  727. {"ADC Left Mux", "ADCL", "Left ADC"},
  728. {"ADC Right Mux", "ADCL", "Left ADC"},
  729. {"ADC Right Mux", "ADCR", "Right ADC"},
  730. {"Left EPA", "Switch", "Left DAC"},
  731. {"Right EPA", "Switch", "Right DAC"},
  732. {"EC Mux", "Left", "Left DAC"},
  733. {"EC Mux", "Right", "Right DAC"},
  734. {"EC Mux", "Left + Right", "Left DAC"},
  735. {"EC Mux", "Left + Right", "Right DAC"},
  736. {"ADCR EC Mux", "ADCR", "ADC Right Mux"},
  737. {"ADCR EC Mux", "EC", "EC Mux"},
  738. {"I2S Mic Mux", "Ex PA", "Left EPA"},
  739. {"I2S Mic Mux", "Ex PA", "Right EPA"},
  740. {"I2S Mic Mux", "ADC", "ADC Left Mux"},
  741. {"I2S Mic Mux", "ADC", "ADCR EC Mux"},
  742. {"I2S DOUT", NULL, "I2S Mic Mux"},
  743. /* I2S/AIF2 Outputs */
  744. {"I2S DIN Mux", "DIN", "I2S DIN"},
  745. {"I2S DIN Mux", "DIN1", "I2S DIN1"},
  746. {"Left DAC", NULL, "I2S DIN Mux"},
  747. {"Right DAC", NULL, "I2S DIN Mux"},
  748. {"DAC HS1 Mux", "Left", "Left DAC"},
  749. {"DAC HS1 Mux", "Right", "Right DAC"},
  750. {"DAC HS2 Mux", "Left", "Left DAC"},
  751. {"DAC HS2 Mux", "Right", "Right DAC"},
  752. {"DAC LO1 Mux", "Left", "Left DAC"},
  753. {"DAC LO1 Mux", "Right", "Right DAC"},
  754. {"DAC LO2 Mux", "Left", "Left DAC"},
  755. {"DAC LO2 Mux", "Right", "Right DAC"},
  756. {"Headset1 Mux", "Digital", "DAC HS1 Mux"},
  757. {"Headset2 Mux", "Digital", "DAC HS2 Mux"},
  758. {"Lineout1 Mux", "Digital", "DAC LO1 Mux"},
  759. {"Lineout2 Mux", "Digital", "DAC LO2 Mux"},
  760. {"Headset1 PGA", NULL, "Headset1 Mux"},
  761. {"Headset2 PGA", NULL, "Headset2 Mux"},
  762. {"Lineout1 PGA", NULL, "Lineout1 Mux"},
  763. {"Lineout2 PGA", NULL, "Lineout2 Mux"},
  764. {"DAC SP Mux", "Left", "Left DAC"},
  765. {"DAC SP Mux", "Right", "Right DAC"},
  766. {"Speaker Earpiece Demux", "Speaker", "DAC SP Mux"},
  767. {"Speaker PGA", NULL, "Speaker Earpiece Demux"},
  768. {"Earpiece PGA", NULL, "Speaker Earpiece Demux"},
  769. {"RSYNC", NULL, "Headset1 PGA"},
  770. {"RSYNC", NULL, "Headset2 PGA"},
  771. {"RSYNC", NULL, "Lineout1 PGA"},
  772. {"RSYNC", NULL, "Lineout2 PGA"},
  773. {"RSYNC", NULL, "Speaker PGA"},
  774. {"RSYNC", NULL, "Speaker PGA"},
  775. {"RSYNC", NULL, "Earpiece PGA"},
  776. {"RSYNC", NULL, "Earpiece PGA"},
  777. {"HS1", NULL, "RSYNC"},
  778. {"HS2", NULL, "RSYNC"},
  779. {"LINEOUT1", NULL, "RSYNC"},
  780. {"LINEOUT2", NULL, "RSYNC"},
  781. {"LSP", NULL, "RSYNC"},
  782. {"LSN", NULL, "RSYNC"},
  783. {"EARP", NULL, "RSYNC"},
  784. {"EARN", NULL, "RSYNC"},
  785. };
  786. /*
  787. * Use MUTE_LEFT & MUTE_RIGHT to implement digital mute.
  788. * These bits can also be used to mute.
  789. */
  790. static int pm860x_digital_mute(struct snd_soc_dai *codec_dai, int mute)
  791. {
  792. struct snd_soc_codec *codec = codec_dai->codec;
  793. int data = 0, mask = MUTE_LEFT | MUTE_RIGHT;
  794. if (mute)
  795. data = mask;
  796. snd_soc_update_bits(codec, PM860X_DAC_OFFSET, mask, data);
  797. snd_soc_update_bits(codec, PM860X_EAR_CTRL_2,
  798. RSYNC_CHANGE, RSYNC_CHANGE);
  799. return 0;
  800. }
  801. static int pm860x_pcm_hw_params(struct snd_pcm_substream *substream,
  802. struct snd_pcm_hw_params *params,
  803. struct snd_soc_dai *dai)
  804. {
  805. struct snd_soc_codec *codec = dai->codec;
  806. unsigned char inf = 0, mask = 0;
  807. /* bit size */
  808. switch (params_format(params)) {
  809. case SNDRV_PCM_FORMAT_S16_LE:
  810. inf &= ~PCM_INF2_18WL;
  811. break;
  812. case SNDRV_PCM_FORMAT_S18_3LE:
  813. inf |= PCM_INF2_18WL;
  814. break;
  815. default:
  816. return -EINVAL;
  817. }
  818. mask |= PCM_INF2_18WL;
  819. snd_soc_update_bits(codec, PM860X_PCM_IFACE_2, mask, inf);
  820. /* sample rate */
  821. switch (params_rate(params)) {
  822. case 8000:
  823. inf = 0;
  824. break;
  825. case 16000:
  826. inf = 3;
  827. break;
  828. case 32000:
  829. inf = 6;
  830. break;
  831. case 48000:
  832. inf = 8;
  833. break;
  834. default:
  835. return -EINVAL;
  836. }
  837. snd_soc_update_bits(codec, PM860X_PCM_RATE, 0x0f, inf);
  838. return 0;
  839. }
  840. static int pm860x_pcm_set_dai_fmt(struct snd_soc_dai *codec_dai,
  841. unsigned int fmt)
  842. {
  843. struct snd_soc_codec *codec = codec_dai->codec;
  844. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  845. unsigned char inf = 0, mask = 0;
  846. int ret = -EINVAL;
  847. mask |= PCM_INF2_BCLK | PCM_INF2_FS | PCM_INF2_MASTER;
  848. /* set master/slave audio interface */
  849. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  850. case SND_SOC_DAIFMT_CBM_CFM:
  851. case SND_SOC_DAIFMT_CBM_CFS:
  852. if (pm860x->dir == PM860X_CLK_DIR_OUT) {
  853. inf |= PCM_INF2_MASTER;
  854. ret = 0;
  855. }
  856. break;
  857. case SND_SOC_DAIFMT_CBS_CFS:
  858. if (pm860x->dir == PM860X_CLK_DIR_IN) {
  859. inf &= ~PCM_INF2_MASTER;
  860. ret = 0;
  861. }
  862. break;
  863. }
  864. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  865. case SND_SOC_DAIFMT_I2S:
  866. inf |= PCM_EXACT_I2S;
  867. ret = 0;
  868. break;
  869. }
  870. mask |= PCM_MODE_MASK;
  871. if (ret)
  872. return ret;
  873. snd_soc_update_bits(codec, PM860X_PCM_IFACE_2, mask, inf);
  874. return 0;
  875. }
  876. static int pm860x_set_dai_sysclk(struct snd_soc_dai *codec_dai,
  877. int clk_id, unsigned int freq, int dir)
  878. {
  879. struct snd_soc_codec *codec = codec_dai->codec;
  880. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  881. if (dir == PM860X_CLK_DIR_OUT)
  882. pm860x->dir = PM860X_CLK_DIR_OUT;
  883. else {
  884. pm860x->dir = PM860X_CLK_DIR_IN;
  885. return -EINVAL;
  886. }
  887. return 0;
  888. }
  889. static int pm860x_i2s_hw_params(struct snd_pcm_substream *substream,
  890. struct snd_pcm_hw_params *params,
  891. struct snd_soc_dai *dai)
  892. {
  893. struct snd_soc_codec *codec = dai->codec;
  894. unsigned char inf;
  895. /* bit size */
  896. switch (params_format(params)) {
  897. case SNDRV_PCM_FORMAT_S16_LE:
  898. inf = 0;
  899. break;
  900. case SNDRV_PCM_FORMAT_S18_3LE:
  901. inf = PCM_INF2_18WL;
  902. break;
  903. default:
  904. return -EINVAL;
  905. }
  906. snd_soc_update_bits(codec, PM860X_I2S_IFACE_2, PCM_INF2_18WL, inf);
  907. /* sample rate */
  908. switch (params_rate(params)) {
  909. case 8000:
  910. inf = 0;
  911. break;
  912. case 11025:
  913. inf = 1;
  914. break;
  915. case 16000:
  916. inf = 3;
  917. break;
  918. case 22050:
  919. inf = 4;
  920. break;
  921. case 32000:
  922. inf = 6;
  923. break;
  924. case 44100:
  925. inf = 7;
  926. break;
  927. case 48000:
  928. inf = 8;
  929. break;
  930. default:
  931. return -EINVAL;
  932. }
  933. snd_soc_update_bits(codec, PM860X_I2S_IFACE_4, 0xf, inf);
  934. return 0;
  935. }
  936. static int pm860x_i2s_set_dai_fmt(struct snd_soc_dai *codec_dai,
  937. unsigned int fmt)
  938. {
  939. struct snd_soc_codec *codec = codec_dai->codec;
  940. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  941. unsigned char inf = 0, mask = 0;
  942. mask |= PCM_INF2_BCLK | PCM_INF2_FS | PCM_INF2_MASTER;
  943. /* set master/slave audio interface */
  944. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  945. case SND_SOC_DAIFMT_CBM_CFM:
  946. if (pm860x->dir == PM860X_CLK_DIR_OUT)
  947. inf |= PCM_INF2_MASTER;
  948. else
  949. return -EINVAL;
  950. break;
  951. case SND_SOC_DAIFMT_CBS_CFS:
  952. if (pm860x->dir == PM860X_CLK_DIR_IN)
  953. inf &= ~PCM_INF2_MASTER;
  954. else
  955. return -EINVAL;
  956. break;
  957. default:
  958. return -EINVAL;
  959. }
  960. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  961. case SND_SOC_DAIFMT_I2S:
  962. inf |= PCM_EXACT_I2S;
  963. break;
  964. default:
  965. return -EINVAL;
  966. }
  967. mask |= PCM_MODE_MASK;
  968. snd_soc_update_bits(codec, PM860X_I2S_IFACE_2, mask, inf);
  969. return 0;
  970. }
  971. static int pm860x_set_bias_level(struct snd_soc_codec *codec,
  972. enum snd_soc_bias_level level)
  973. {
  974. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  975. int data;
  976. switch (level) {
  977. case SND_SOC_BIAS_ON:
  978. break;
  979. case SND_SOC_BIAS_PREPARE:
  980. break;
  981. case SND_SOC_BIAS_STANDBY:
  982. if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
  983. /* Enable Audio PLL & Audio section */
  984. data = AUDIO_PLL | AUDIO_SECTION_ON;
  985. pm860x_reg_write(pm860x->i2c, REG_MISC2, data);
  986. udelay(300);
  987. data = AUDIO_PLL | AUDIO_SECTION_RESET
  988. | AUDIO_SECTION_ON;
  989. pm860x_reg_write(pm860x->i2c, REG_MISC2, data);
  990. }
  991. break;
  992. case SND_SOC_BIAS_OFF:
  993. data = AUDIO_PLL | AUDIO_SECTION_RESET | AUDIO_SECTION_ON;
  994. pm860x_set_bits(pm860x->i2c, REG_MISC2, data, 0);
  995. break;
  996. }
  997. codec->dapm.bias_level = level;
  998. return 0;
  999. }
  1000. static const struct snd_soc_dai_ops pm860x_pcm_dai_ops = {
  1001. .digital_mute = pm860x_digital_mute,
  1002. .hw_params = pm860x_pcm_hw_params,
  1003. .set_fmt = pm860x_pcm_set_dai_fmt,
  1004. .set_sysclk = pm860x_set_dai_sysclk,
  1005. };
  1006. static const struct snd_soc_dai_ops pm860x_i2s_dai_ops = {
  1007. .digital_mute = pm860x_digital_mute,
  1008. .hw_params = pm860x_i2s_hw_params,
  1009. .set_fmt = pm860x_i2s_set_dai_fmt,
  1010. .set_sysclk = pm860x_set_dai_sysclk,
  1011. };
  1012. #define PM860X_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 | \
  1013. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000)
  1014. static struct snd_soc_dai_driver pm860x_dai[] = {
  1015. {
  1016. /* DAI PCM */
  1017. .name = "88pm860x-pcm",
  1018. .id = 1,
  1019. .playback = {
  1020. .stream_name = "PCM Playback",
  1021. .channels_min = 2,
  1022. .channels_max = 2,
  1023. .rates = PM860X_RATES,
  1024. .formats = SNDRV_PCM_FORMAT_S16_LE | \
  1025. SNDRV_PCM_FORMAT_S18_3LE,
  1026. },
  1027. .capture = {
  1028. .stream_name = "PCM Capture",
  1029. .channels_min = 2,
  1030. .channels_max = 2,
  1031. .rates = PM860X_RATES,
  1032. .formats = SNDRV_PCM_FORMAT_S16_LE | \
  1033. SNDRV_PCM_FORMAT_S18_3LE,
  1034. },
  1035. .ops = &pm860x_pcm_dai_ops,
  1036. }, {
  1037. /* DAI I2S */
  1038. .name = "88pm860x-i2s",
  1039. .id = 2,
  1040. .playback = {
  1041. .stream_name = "I2S Playback",
  1042. .channels_min = 2,
  1043. .channels_max = 2,
  1044. .rates = SNDRV_PCM_RATE_8000_48000,
  1045. .formats = SNDRV_PCM_FORMAT_S16_LE | \
  1046. SNDRV_PCM_FORMAT_S18_3LE,
  1047. },
  1048. .capture = {
  1049. .stream_name = "I2S Capture",
  1050. .channels_min = 2,
  1051. .channels_max = 2,
  1052. .rates = SNDRV_PCM_RATE_8000_48000,
  1053. .formats = SNDRV_PCM_FORMAT_S16_LE | \
  1054. SNDRV_PCM_FORMAT_S18_3LE,
  1055. },
  1056. .ops = &pm860x_i2s_dai_ops,
  1057. },
  1058. };
  1059. static irqreturn_t pm860x_codec_handler(int irq, void *data)
  1060. {
  1061. struct pm860x_priv *pm860x = data;
  1062. int status, shrt, report = 0, mic_report = 0;
  1063. int mask;
  1064. status = pm860x_reg_read(pm860x->i2c, REG_STATUS_1);
  1065. shrt = pm860x_reg_read(pm860x->i2c, REG_SHORTS);
  1066. mask = pm860x->det.hs_shrt | pm860x->det.hook_det | pm860x->det.lo_shrt
  1067. | pm860x->det.hp_det;
  1068. #ifndef CONFIG_SND_SOC_88PM860X_MODULE
  1069. if (status & (HEADSET_STATUS | MIC_STATUS | SHORT_HS1 | SHORT_HS2 |
  1070. SHORT_LO1 | SHORT_LO2))
  1071. trace_snd_soc_jack_irq(dev_name(pm860x->codec->dev));
  1072. #endif
  1073. if ((pm860x->det.hp_det & SND_JACK_HEADPHONE)
  1074. && (status & HEADSET_STATUS))
  1075. report |= SND_JACK_HEADPHONE;
  1076. if ((pm860x->det.mic_det & SND_JACK_MICROPHONE)
  1077. && (status & MIC_STATUS))
  1078. mic_report |= SND_JACK_MICROPHONE;
  1079. if (pm860x->det.hs_shrt && (shrt & (SHORT_HS1 | SHORT_HS2)))
  1080. report |= pm860x->det.hs_shrt;
  1081. if (pm860x->det.hook_det && (status & HOOK_STATUS))
  1082. report |= pm860x->det.hook_det;
  1083. if (pm860x->det.lo_shrt && (shrt & (SHORT_LO1 | SHORT_LO2)))
  1084. report |= pm860x->det.lo_shrt;
  1085. if (report)
  1086. snd_soc_jack_report(pm860x->det.hp_jack, report, mask);
  1087. if (mic_report)
  1088. snd_soc_jack_report(pm860x->det.mic_jack, SND_JACK_MICROPHONE,
  1089. SND_JACK_MICROPHONE);
  1090. dev_dbg(pm860x->codec->dev, "headphone report:0x%x, mask:%x\n",
  1091. report, mask);
  1092. dev_dbg(pm860x->codec->dev, "microphone report:0x%x\n", mic_report);
  1093. return IRQ_HANDLED;
  1094. }
  1095. int pm860x_hs_jack_detect(struct snd_soc_codec *codec,
  1096. struct snd_soc_jack *jack,
  1097. int det, int hook, int hs_shrt, int lo_shrt)
  1098. {
  1099. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  1100. int data;
  1101. pm860x->det.hp_jack = jack;
  1102. pm860x->det.hp_det = det;
  1103. pm860x->det.hook_det = hook;
  1104. pm860x->det.hs_shrt = hs_shrt;
  1105. pm860x->det.lo_shrt = lo_shrt;
  1106. if (det & SND_JACK_HEADPHONE)
  1107. pm860x_set_bits(pm860x->i2c, REG_HS_DET,
  1108. EN_HS_DET, EN_HS_DET);
  1109. /* headset short detect */
  1110. if (hs_shrt) {
  1111. data = CLR_SHORT_HS2 | CLR_SHORT_HS1;
  1112. pm860x_set_bits(pm860x->i2c, REG_SHORTS, data, data);
  1113. }
  1114. /* Lineout short detect */
  1115. if (lo_shrt) {
  1116. data = CLR_SHORT_LO2 | CLR_SHORT_LO1;
  1117. pm860x_set_bits(pm860x->i2c, REG_SHORTS, data, data);
  1118. }
  1119. /* sync status */
  1120. pm860x_codec_handler(0, pm860x);
  1121. return 0;
  1122. }
  1123. EXPORT_SYMBOL_GPL(pm860x_hs_jack_detect);
  1124. int pm860x_mic_jack_detect(struct snd_soc_codec *codec,
  1125. struct snd_soc_jack *jack, int det)
  1126. {
  1127. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  1128. pm860x->det.mic_jack = jack;
  1129. pm860x->det.mic_det = det;
  1130. if (det & SND_JACK_MICROPHONE)
  1131. pm860x_set_bits(pm860x->i2c, REG_MIC_DET,
  1132. MICDET_MASK, MICDET_MASK);
  1133. /* sync status */
  1134. pm860x_codec_handler(0, pm860x);
  1135. return 0;
  1136. }
  1137. EXPORT_SYMBOL_GPL(pm860x_mic_jack_detect);
  1138. static int pm860x_probe(struct snd_soc_codec *codec)
  1139. {
  1140. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  1141. int i, ret;
  1142. pm860x->codec = codec;
  1143. codec->control_data = pm860x->regmap;
  1144. for (i = 0; i < 4; i++) {
  1145. ret = request_threaded_irq(pm860x->irq[i], NULL,
  1146. pm860x_codec_handler, IRQF_ONESHOT,
  1147. pm860x->name[i], pm860x);
  1148. if (ret < 0) {
  1149. dev_err(codec->dev, "Failed to request IRQ!\n");
  1150. goto out;
  1151. }
  1152. }
  1153. pm860x_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  1154. return 0;
  1155. out:
  1156. while (--i >= 0)
  1157. free_irq(pm860x->irq[i], pm860x);
  1158. return ret;
  1159. }
  1160. static int pm860x_remove(struct snd_soc_codec *codec)
  1161. {
  1162. struct pm860x_priv *pm860x = snd_soc_codec_get_drvdata(codec);
  1163. int i;
  1164. for (i = 3; i >= 0; i--)
  1165. free_irq(pm860x->irq[i], pm860x);
  1166. pm860x_set_bias_level(codec, SND_SOC_BIAS_OFF);
  1167. return 0;
  1168. }
  1169. static struct snd_soc_codec_driver soc_codec_dev_pm860x = {
  1170. .probe = pm860x_probe,
  1171. .remove = pm860x_remove,
  1172. .set_bias_level = pm860x_set_bias_level,
  1173. .controls = pm860x_snd_controls,
  1174. .num_controls = ARRAY_SIZE(pm860x_snd_controls),
  1175. .dapm_widgets = pm860x_dapm_widgets,
  1176. .num_dapm_widgets = ARRAY_SIZE(pm860x_dapm_widgets),
  1177. .dapm_routes = pm860x_dapm_routes,
  1178. .num_dapm_routes = ARRAY_SIZE(pm860x_dapm_routes),
  1179. };
  1180. static int pm860x_codec_probe(struct platform_device *pdev)
  1181. {
  1182. struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent);
  1183. struct pm860x_priv *pm860x;
  1184. struct resource *res;
  1185. int i, ret;
  1186. pm860x = devm_kzalloc(&pdev->dev, sizeof(struct pm860x_priv),
  1187. GFP_KERNEL);
  1188. if (pm860x == NULL)
  1189. return -ENOMEM;
  1190. pm860x->chip = chip;
  1191. pm860x->i2c = (chip->id == CHIP_PM8607) ? chip->client
  1192. : chip->companion;
  1193. pm860x->regmap = (chip->id == CHIP_PM8607) ? chip->regmap
  1194. : chip->regmap_companion;
  1195. platform_set_drvdata(pdev, pm860x);
  1196. for (i = 0; i < 4; i++) {
  1197. res = platform_get_resource(pdev, IORESOURCE_IRQ, i);
  1198. if (!res) {
  1199. dev_err(&pdev->dev, "Failed to get IRQ resources\n");
  1200. return -EINVAL;
  1201. }
  1202. pm860x->irq[i] = res->start + chip->irq_base;
  1203. strncpy(pm860x->name[i], res->name, MAX_NAME_LEN);
  1204. }
  1205. ret = snd_soc_register_codec(&pdev->dev, &soc_codec_dev_pm860x,
  1206. pm860x_dai, ARRAY_SIZE(pm860x_dai));
  1207. if (ret) {
  1208. dev_err(&pdev->dev, "Failed to register codec\n");
  1209. return -EINVAL;
  1210. }
  1211. return ret;
  1212. }
  1213. static int pm860x_codec_remove(struct platform_device *pdev)
  1214. {
  1215. snd_soc_unregister_codec(&pdev->dev);
  1216. return 0;
  1217. }
  1218. static struct platform_driver pm860x_codec_driver = {
  1219. .driver = {
  1220. .name = "88pm860x-codec",
  1221. .owner = THIS_MODULE,
  1222. },
  1223. .probe = pm860x_codec_probe,
  1224. .remove = pm860x_codec_remove,
  1225. };
  1226. module_platform_driver(pm860x_codec_driver);
  1227. MODULE_DESCRIPTION("ASoC 88PM860x driver");
  1228. MODULE_AUTHOR("Haojian Zhuang <haojian.zhuang@marvell.com>");
  1229. MODULE_LICENSE("GPL");
  1230. MODULE_ALIAS("platform:88pm860x-codec");