Merge tag 'lsk-v3.10-android-14.12'
[firefly-linux-kernel-4.4.55.git] / sound / soc / rockchip / rk_rt5640.c
1 /*
2  * rk29_rt5640.c  --  SoC audio for rockchip
3  *
4  * Driver for rockchip rt5640 audio
5  *
6  *  This program is free software; you can redistribute  it and/or modify it
7  *  under  the terms of  the GNU General  Public License as published by the
8  *  Free Software Foundation;  either version 2 of the  License, or (at your
9  *  option) any later version.
10  *
11  *
12  */
13
14 #include <linux/module.h>
15 #include <linux/device.h>
16 #include <linux/of.h>
17 #include <linux/of_gpio.h>
18 #include <sound/core.h>
19 #include <sound/pcm.h>
20 #include <sound/soc.h>
21 #include <sound/soc-dapm.h>
22
23 #include "../codecs/rt5640.h"
24 #include "card_info.h"
25 #include "rk_pcm.h"
26 #include "rk_i2s.h"
27
28
29 #if 0
30 #define DBG(x...)       printk(KERN_INFO x)
31 #else
32 #define DBG(x...)
33 #endif
34
35 static int rk29_hw_params(struct snd_pcm_substream *substream,
36         struct snd_pcm_hw_params *params)
37 {
38         struct snd_soc_pcm_runtime *rtd = substream->private_data;
39         struct snd_soc_dai *codec_dai = rtd->codec_dai;
40         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
41         unsigned int pll_out = 0, dai_fmt = rtd->dai_link->dai_fmt;
42         int ret;
43
44         DBG("Enter::%s----%d\n", __FUNCTION__, __LINE__);
45
46         /* set codec DAI configuration */
47         ret = snd_soc_dai_set_fmt(codec_dai, dai_fmt);
48         if (ret < 0) {
49                 printk("%s():failed to set the format for codec side\n", __FUNCTION__);
50                 return ret;
51         }
52
53         /* set cpu DAI configuration */
54         ret = snd_soc_dai_set_fmt(cpu_dai, dai_fmt);
55         if (ret < 0) {
56                 printk("%s():failed to set the format for cpu side\n", __FUNCTION__);
57                 return ret;
58         }
59
60         switch(params_rate(params)) {
61                 case 8000:
62                 case 16000:
63                 case 24000:
64                 case 32000:
65                 case 48000:
66                         pll_out = 12288000;
67                         break;
68                 case 11025:
69                 case 22050:
70                 case 44100:
71                         pll_out = 11289600;
72                         break;
73                 default:
74                         DBG("Enter:%s, %d, Error rate=%d\n", __FUNCTION__, __LINE__, params_rate(params));
75                         return -EINVAL;
76                         break;
77         }
78
79         DBG("Enter:%s, %d, rate=%d\n", __FUNCTION__, __LINE__, params_rate(params));
80
81         /*Set the system clk for codec*/
82         ret = snd_soc_dai_set_sysclk(codec_dai, 0, pll_out, SND_SOC_CLOCK_IN);
83         if (ret < 0)
84         {
85                 DBG("rk29_hw_params_rt5640:failed to set the sysclk for codec side\n"); 
86                 return ret;
87         }
88
89         snd_soc_dai_set_sysclk(cpu_dai, 0, pll_out, 0);
90         snd_soc_dai_set_clkdiv(cpu_dai, ROCKCHIP_DIV_BCLK, (pll_out/4)/params_rate(params)-1);
91         snd_soc_dai_set_clkdiv(cpu_dai, ROCKCHIP_DIV_MCLK, 3);
92
93         DBG("Enter:%s, %d, pll_out/4/params_rate(params) = %d \n", __FUNCTION__, __LINE__, (pll_out/4)/params_rate(params));
94  
95         return 0;
96 }
97
98 static int rt5640_voice_hw_params(struct snd_pcm_substream *substream,
99         struct snd_pcm_hw_params *params)
100 {
101         struct snd_soc_pcm_runtime *rtd = substream->private_data;
102         struct snd_soc_dai *codec_dai = rtd->codec_dai;
103         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
104         unsigned int pll_out = 0, dai_fmt = rtd->dai_link->dai_fmt;
105         int ret;
106
107         DBG("Enter::%s----%d\n", __FUNCTION__, __LINE__);
108
109         /* set codec DAI configuration */
110         ret = snd_soc_dai_set_fmt(codec_dai, dai_fmt);
111         if (ret < 0) {
112                 printk("%s():failed to set the format for codec side\n", __FUNCTION__);
113                 return ret;
114         }
115
116         switch(params_rate(params)) {
117                 case 8000:
118                 case 16000:
119                 case 24000:
120                 case 32000:
121                 case 48000:
122                         pll_out = 12288000;
123                         break;
124                 case 11025:
125                 case 22050:
126                 case 44100:
127                         pll_out = 11289600;
128                         break;
129                 default:
130                         DBG("Enter:%s, %d, Error rate=%d\n", __FUNCTION__, __LINE__, params_rate(params));
131                         return -EINVAL;
132                         break;
133         }
134
135         DBG("Enter:%s, %d, rate=%d\n", __FUNCTION__, __LINE__, params_rate(params));
136
137         /*Set the system clk for codec*/
138         snd_soc_dai_set_pll(codec_dai, 0, RT5640_PLL1_S_MCLK, pll_out, 24576000);
139
140         ret = snd_soc_dai_set_sysclk(codec_dai, RT5640_SCLK_S_PLL1, 24576000, SND_SOC_CLOCK_IN);
141
142
143         if (ret < 0) {
144                 printk("rk29_hw_params_rt5640:failed to set the sysclk for codec side\n"); 
145                 return ret;
146         }
147
148         snd_soc_dai_set_sysclk(cpu_dai, 0, pll_out, 0);
149         snd_soc_dai_set_clkdiv(cpu_dai, ROCKCHIP_DIV_BCLK, (pll_out/4)/params_rate(params)-1);
150         snd_soc_dai_set_clkdiv(cpu_dai, ROCKCHIP_DIV_MCLK, 3);
151
152         DBG("Enter:%s, %d, pll_out/4/params_rate(params) = %d \n", __FUNCTION__, __LINE__, (pll_out/4)/params_rate(params));
153  
154         return 0;
155 }
156
157 static const struct snd_soc_dapm_widget rk_rt5640_dapm_widgets[] = {
158         SND_SOC_DAPM_MIC("Mic Jack", NULL),
159         SND_SOC_DAPM_MIC("Headset Jack", NULL), 
160         SND_SOC_DAPM_SPK("Ext Spk", NULL),
161         SND_SOC_DAPM_HP("Headphone Jack", NULL),
162 };
163
164 static const struct snd_soc_dapm_route rk_rt5640_audio_map[]={
165
166         /* Mic Jack --> MIC_IN*/
167         {"micbias1", NULL, "Mic Jack"},
168         {"MIC1", NULL, "micbias1"},
169         
170         // HP MIC
171         {"micbias1", NULL, "Headset Jack"},
172         {"MIC3", NULL, "micbias1"},
173
174         {"Ext Spk", NULL, "SPOLP"},
175         {"Ext Spk", NULL, "SPOLN"},
176         {"Ext Spk", NULL, "SPORP"},
177         {"Ext Spk", NULL, "SPORN"},
178
179         {"Headphone Jack", NULL, "HPOL"},
180         {"Headphone Jack", NULL, "HPOR"},
181 } ;
182
183 static const struct snd_kcontrol_new rk_rt5640_controls[] = {
184         SOC_DAPM_PIN_SWITCH("Mic Jack"),
185         SOC_DAPM_PIN_SWITCH("Headset Jack"),
186         SOC_DAPM_PIN_SWITCH("Ext Spk"),
187         SOC_DAPM_PIN_SWITCH("Headphone Jack"),
188 };
189
190 /*
191  * Logic for a rt5640 as connected on a rockchip board.
192  */
193 static int rk29_rt5640_init(struct snd_soc_pcm_runtime *rtd)
194 {
195         struct snd_soc_codec *codec = rtd->codec;
196         struct snd_soc_dapm_context *dapm = &codec->dapm;
197
198         DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
199
200         mutex_lock(&dapm->card->dapm_mutex);
201
202         snd_soc_dapm_enable_pin(dapm, "Mic Jack");
203         snd_soc_dapm_enable_pin(dapm, "Headset Jack");
204         snd_soc_dapm_enable_pin(dapm, "Ext Spk");
205         snd_soc_dapm_enable_pin(dapm, "Headphone Jack");
206
207         mutex_unlock(&dapm->card->dapm_mutex);
208
209         snd_soc_dapm_sync(dapm);
210
211         return 0;
212 }
213
214 static struct snd_soc_ops rk29_ops = {
215         .hw_params = rk29_hw_params,
216 };
217
218 static struct snd_soc_ops rt5640_voice_ops = {
219         .hw_params = rt5640_voice_hw_params,
220 };
221
222 static struct snd_soc_dai_link rk29_dai[] = {
223         {
224                 .name = "RT5640 I2S1",
225                 .stream_name = "RT5640 PCM",
226                 .codec_dai_name = "rt5640-aif1",
227                 .init = rk29_rt5640_init,
228                 .ops = &rk29_ops,
229         },
230         {
231                 .name = "RT5640 I2S2",
232                 .stream_name = "RT5640 PCM",
233                 .codec_dai_name = "rt5640-aif2",
234                 .ops = &rt5640_voice_ops,
235         },
236 };
237
238 static struct snd_soc_card rockchip_rt5640_snd_card = {
239         .name = "RK_RT5640",
240         .dai_link = rk29_dai,
241         .num_links = 2,
242         .controls = rk_rt5640_controls,
243         .num_controls = ARRAY_SIZE(rk_rt5640_controls),
244         .dapm_widgets    = rk_rt5640_dapm_widgets,
245         .num_dapm_widgets = ARRAY_SIZE(rk_rt5640_dapm_widgets),
246         .dapm_routes    = rk_rt5640_audio_map,
247         .num_dapm_routes = ARRAY_SIZE(rk_rt5640_audio_map),
248 };
249
250 static int rockchip_rt5640_audio_probe(struct platform_device *pdev)
251 {
252         int ret;
253         struct snd_soc_card *card = &rockchip_rt5640_snd_card;
254
255         card->dev = &pdev->dev;
256
257         ret = rockchip_of_get_sound_card_info(card);
258         if (ret) {
259                 printk("%s() get sound card info failed:%d\n", __FUNCTION__, ret);
260                 return ret;
261         }
262
263         ret = snd_soc_register_card(card);
264         if (ret)
265                 printk("%s() register card failed:%d\n", __FUNCTION__, ret);
266
267         return ret;
268 }
269
270 static int rockchip_rt5640_audio_remove(struct platform_device *pdev)
271 {
272         struct snd_soc_card *card = platform_get_drvdata(pdev);
273
274         snd_soc_unregister_card(card);
275
276         return 0;
277 }
278
279 #ifdef CONFIG_OF
280 static const struct of_device_id rockchip_rt5640_of_match[] = {
281         { .compatible = "rockchip-rt5640", },
282         {},
283 };
284 MODULE_DEVICE_TABLE(of, rockchip_rt5640_of_match);
285 #endif /* CONFIG_OF */
286
287 static struct platform_driver rockchip_rt5640_audio_driver = {
288         .driver         = {
289                 .name   = "rockchip-rt5640",
290                 .owner  = THIS_MODULE,
291                 .pm = &snd_soc_pm_ops,
292                 .of_match_table = of_match_ptr(rockchip_rt5640_of_match),
293         },
294         .probe          = rockchip_rt5640_audio_probe,
295         .remove         = rockchip_rt5640_audio_remove,
296 };
297
298 module_platform_driver(rockchip_rt5640_audio_driver);
299
300 /* Module information */
301 MODULE_AUTHOR("rockchip");
302 MODULE_DESCRIPTION("ROCKCHIP i2s ASoC Interface");
303 MODULE_LICENSE("GPL");