Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / sound / soc / samsung / h1940_uda1380.c
1 /*
2  * h1940-uda1380.c  --  ALSA Soc Audio Layer
3  *
4  * Copyright (c) 2010 Arnaud Patard <arnaud.patard@rtp-net.org>
5  * Copyright (c) 2010 Vasily Khoruzhick <anarsoul@gmail.com>
6  *
7  * Based on version from Arnaud Patard <arnaud.patard@rtp-net.org>
8  *
9  * This program is free software; you can redistribute  it and/or modify it
10  * under  the terms of  the GNU General  Public License as published by the
11  * Free Software Foundation;  either version 2 of the  License, or (at your
12  * option) any later version.
13  *
14  */
15
16 #include <linux/types.h>
17 #include <linux/gpio.h>
18 #include <linux/module.h>
19
20 #include <sound/soc.h>
21 #include <sound/jack.h>
22
23 #include "regs-iis.h"
24 #include <asm/mach-types.h>
25
26 #include <mach/gpio-samsung.h>
27 #include "s3c24xx-i2s.h"
28
29 static unsigned int rates[] = {
30         11025,
31         22050,
32         44100,
33 };
34
35 static struct snd_pcm_hw_constraint_list hw_rates = {
36         .count = ARRAY_SIZE(rates),
37         .list = rates,
38         .mask = 0,
39 };
40
41 static struct snd_soc_jack hp_jack;
42
43 static struct snd_soc_jack_pin hp_jack_pins[] = {
44         {
45                 .pin    = "Headphone Jack",
46                 .mask   = SND_JACK_HEADPHONE,
47         },
48         {
49                 .pin    = "Speaker",
50                 .mask   = SND_JACK_HEADPHONE,
51                 .invert = 1,
52         },
53 };
54
55 static struct snd_soc_jack_gpio hp_jack_gpios[] = {
56         {
57                 .gpio                   = S3C2410_GPG(4),
58                 .name                   = "hp-gpio",
59                 .report                 = SND_JACK_HEADPHONE,
60                 .invert                 = 1,
61                 .debounce_time          = 200,
62         },
63 };
64
65 static int h1940_startup(struct snd_pcm_substream *substream)
66 {
67         struct snd_pcm_runtime *runtime = substream->runtime;
68
69         return snd_pcm_hw_constraint_list(runtime, 0,
70                                         SNDRV_PCM_HW_PARAM_RATE,
71                                         &hw_rates);
72 }
73
74 static int h1940_hw_params(struct snd_pcm_substream *substream,
75                                 struct snd_pcm_hw_params *params)
76 {
77         struct snd_soc_pcm_runtime *rtd = substream->private_data;
78         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
79         int div;
80         int ret;
81         unsigned int rate = params_rate(params);
82
83         switch (rate) {
84         case 11025:
85         case 22050:
86         case 44100:
87                 div = s3c24xx_i2s_get_clockrate() / (384 * rate);
88                 if (s3c24xx_i2s_get_clockrate() % (384 * rate) > (192 * rate))
89                         div++;
90                 break;
91         default:
92                 dev_err(rtd->dev, "%s: rate %d is not supported\n",
93                         __func__, rate);
94                 return -EINVAL;
95         }
96
97         /* select clock source */
98         ret = snd_soc_dai_set_sysclk(cpu_dai, S3C24XX_CLKSRC_PCLK, rate,
99                         SND_SOC_CLOCK_OUT);
100         if (ret < 0)
101                 return ret;
102
103         /* set MCLK division for sample rate */
104         ret = snd_soc_dai_set_clkdiv(cpu_dai, S3C24XX_DIV_MCLK,
105                 S3C2410_IISMOD_384FS);
106         if (ret < 0)
107                 return ret;
108
109         /* set BCLK division for sample rate */
110         ret = snd_soc_dai_set_clkdiv(cpu_dai, S3C24XX_DIV_BCLK,
111                 S3C2410_IISMOD_32FS);
112         if (ret < 0)
113                 return ret;
114
115         /* set prescaler division for sample rate */
116         ret = snd_soc_dai_set_clkdiv(cpu_dai, S3C24XX_DIV_PRESCALER,
117                 S3C24XX_PRESCALE(div, div));
118         if (ret < 0)
119                 return ret;
120
121         return 0;
122 }
123
124 static struct snd_soc_ops h1940_ops = {
125         .startup        = h1940_startup,
126         .hw_params      = h1940_hw_params,
127 };
128
129 static int h1940_spk_power(struct snd_soc_dapm_widget *w,
130                                 struct snd_kcontrol *kcontrol, int event)
131 {
132         if (SND_SOC_DAPM_EVENT_ON(event))
133                 gpio_set_value(S3C_GPIO_END + 9, 1);
134         else
135                 gpio_set_value(S3C_GPIO_END + 9, 0);
136
137         return 0;
138 }
139
140 /* h1940 machine dapm widgets */
141 static const struct snd_soc_dapm_widget uda1380_dapm_widgets[] = {
142         SND_SOC_DAPM_HP("Headphone Jack", NULL),
143         SND_SOC_DAPM_MIC("Mic Jack", NULL),
144         SND_SOC_DAPM_SPK("Speaker", h1940_spk_power),
145 };
146
147 /* h1940 machine audio_map */
148 static const struct snd_soc_dapm_route audio_map[] = {
149         /* headphone connected to VOUTLHP, VOUTRHP */
150         {"Headphone Jack", NULL, "VOUTLHP"},
151         {"Headphone Jack", NULL, "VOUTRHP"},
152
153         /* ext speaker connected to VOUTL, VOUTR  */
154         {"Speaker", NULL, "VOUTL"},
155         {"Speaker", NULL, "VOUTR"},
156
157         /* mic is connected to VINM */
158         {"VINM", NULL, "Mic Jack"},
159 };
160
161 static struct platform_device *s3c24xx_snd_device;
162
163 static int h1940_uda1380_init(struct snd_soc_pcm_runtime *rtd)
164 {
165         snd_soc_card_jack_new(rtd->card, "Headphone Jack", SND_JACK_HEADPHONE,
166                 &hp_jack, hp_jack_pins, ARRAY_SIZE(hp_jack_pins));
167
168         snd_soc_jack_add_gpios(&hp_jack, ARRAY_SIZE(hp_jack_gpios),
169                 hp_jack_gpios);
170
171         return 0;
172 }
173
174 static int h1940_uda1380_card_remove(struct snd_soc_card *card)
175 {
176         snd_soc_jack_free_gpios(&hp_jack, ARRAY_SIZE(hp_jack_gpios),
177                 hp_jack_gpios);
178
179         return 0;
180 }
181
182 /* s3c24xx digital audio interface glue - connects codec <--> CPU */
183 static struct snd_soc_dai_link h1940_uda1380_dai[] = {
184         {
185                 .name           = "uda1380",
186                 .stream_name    = "UDA1380 Duplex",
187                 .cpu_dai_name   = "s3c24xx-iis",
188                 .codec_dai_name = "uda1380-hifi",
189                 .init           = h1940_uda1380_init,
190                 .platform_name  = "s3c24xx-iis",
191                 .codec_name     = "uda1380-codec.0-001a",
192                 .dai_fmt        = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
193                                   SND_SOC_DAIFMT_CBS_CFS,
194                 .ops            = &h1940_ops,
195         },
196 };
197
198 static struct snd_soc_card h1940_asoc = {
199         .name = "h1940",
200         .owner = THIS_MODULE,
201         .remove = h1940_uda1380_card_remove,
202         .dai_link = h1940_uda1380_dai,
203         .num_links = ARRAY_SIZE(h1940_uda1380_dai),
204
205         .dapm_widgets = uda1380_dapm_widgets,
206         .num_dapm_widgets = ARRAY_SIZE(uda1380_dapm_widgets),
207         .dapm_routes = audio_map,
208         .num_dapm_routes = ARRAY_SIZE(audio_map),
209 };
210
211 static int __init h1940_init(void)
212 {
213         int ret;
214
215         if (!machine_is_h1940())
216                 return -ENODEV;
217
218         /* configure some gpios */
219         ret = gpio_request(S3C_GPIO_END + 9, "speaker-power");
220         if (ret)
221                 goto err_out;
222
223         ret = gpio_direction_output(S3C_GPIO_END + 9, 0);
224         if (ret)
225                 goto err_gpio;
226
227         s3c24xx_snd_device = platform_device_alloc("soc-audio", -1);
228         if (!s3c24xx_snd_device) {
229                 ret = -ENOMEM;
230                 goto err_gpio;
231         }
232
233         platform_set_drvdata(s3c24xx_snd_device, &h1940_asoc);
234         ret = platform_device_add(s3c24xx_snd_device);
235
236         if (ret)
237                 goto err_plat;
238
239         return 0;
240
241 err_plat:
242         platform_device_put(s3c24xx_snd_device);
243 err_gpio:
244         gpio_free(S3C_GPIO_END + 9);
245
246 err_out:
247         return ret;
248 }
249
250 static void __exit h1940_exit(void)
251 {
252         platform_device_unregister(s3c24xx_snd_device);
253         gpio_free(S3C_GPIO_END + 9);
254 }
255
256 module_init(h1940_init);
257 module_exit(h1940_exit);
258
259 /* Module information */
260 MODULE_AUTHOR("Arnaud Patard, Vasily Khoruzhick");
261 MODULE_DESCRIPTION("ALSA SoC H1940");
262 MODULE_LICENSE("GPL");