Version:  2.6.34 2.6.35 2.6.36 2.6.37 2.6.38 2.6.39 3.0 3.1 3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14

Linux/sound/soc/codecs/si476x.c

  1 /*
  2  * sound/soc/codecs/si476x.c -- Codec driver for SI476X chips
  3  *
  4  * Copyright (C) 2012 Innovative Converged Devices(ICD)
  5  * Copyright (C) 2013 Andrey Smirnov
  6  *
  7  * Author: Andrey Smirnov <andrew.smirnov@gmail.com>
  8  *
  9  * This program is free software; you can redistribute it and/or modify
 10  * it under the terms of the GNU General Public License as published by
 11  * the Free Software Foundation; version 2 of the License.
 12  *
 13  * This program is distributed in the hope that it will be useful, but
 14  * WITHOUT ANY WARRANTY; without even the implied warranty of
 15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 16  * General Public License for more details.
 17  *
 18  */
 19 
 20 #include <linux/module.h>
 21 #include <linux/slab.h>
 22 #include <sound/pcm.h>
 23 #include <sound/pcm_params.h>
 24 #include <sound/soc.h>
 25 #include <sound/initval.h>
 26 
 27 #include <linux/i2c.h>
 28 
 29 #include <linux/mfd/si476x-core.h>
 30 
 31 enum si476x_audio_registers {
 32         SI476X_DIGITAL_IO_OUTPUT_FORMAT         = 0x0203,
 33         SI476X_DIGITAL_IO_OUTPUT_SAMPLE_RATE    = 0x0202,
 34 };
 35 
 36 enum si476x_digital_io_output_format {
 37         SI476X_DIGITAL_IO_SLOT_SIZE_SHIFT       = 11,
 38         SI476X_DIGITAL_IO_SAMPLE_SIZE_SHIFT     = 8,
 39 };
 40 
 41 #define SI476X_DIGITAL_IO_OUTPUT_WIDTH_MASK     ((0x7 << SI476X_DIGITAL_IO_SLOT_SIZE_SHIFT) | \
 42                                                   (0x7 << SI476X_DIGITAL_IO_SAMPLE_SIZE_SHIFT))
 43 #define SI476X_DIGITAL_IO_OUTPUT_FORMAT_MASK    (0x7e)
 44 
 45 enum si476x_daudio_formats {
 46         SI476X_DAUDIO_MODE_I2S          = (0x0 << 1),
 47         SI476X_DAUDIO_MODE_DSP_A        = (0x6 << 1),
 48         SI476X_DAUDIO_MODE_DSP_B        = (0x7 << 1),
 49         SI476X_DAUDIO_MODE_LEFT_J       = (0x8 << 1),
 50         SI476X_DAUDIO_MODE_RIGHT_J      = (0x9 << 1),
 51 
 52         SI476X_DAUDIO_MODE_IB           = (1 << 5),
 53         SI476X_DAUDIO_MODE_IF           = (1 << 6),
 54 };
 55 
 56 enum si476x_pcm_format {
 57         SI476X_PCM_FORMAT_S8            = 2,
 58         SI476X_PCM_FORMAT_S16_LE        = 4,
 59         SI476X_PCM_FORMAT_S20_3LE       = 5,
 60         SI476X_PCM_FORMAT_S24_LE        = 6,
 61 };
 62 
 63 static const struct snd_soc_dapm_widget si476x_dapm_widgets[] = {
 64 SND_SOC_DAPM_OUTPUT("LOUT"),
 65 SND_SOC_DAPM_OUTPUT("ROUT"),
 66 };
 67 
 68 static const struct snd_soc_dapm_route si476x_dapm_routes[] = {
 69         { "Capture", NULL, "LOUT" },
 70         { "Capture", NULL, "ROUT" },
 71 };
 72 
 73 static int si476x_codec_set_dai_fmt(struct snd_soc_dai *codec_dai,
 74                                     unsigned int fmt)
 75 {
 76         struct si476x_core *core = i2c_mfd_cell_to_core(codec_dai->dev);
 77         int err;
 78         u16 format = 0;
 79 
 80         if ((fmt & SND_SOC_DAIFMT_MASTER_MASK) != SND_SOC_DAIFMT_CBS_CFS)
 81                 return -EINVAL;
 82 
 83         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
 84         case SND_SOC_DAIFMT_DSP_A:
 85                 format |= SI476X_DAUDIO_MODE_DSP_A;
 86                 break;
 87         case SND_SOC_DAIFMT_DSP_B:
 88                 format |= SI476X_DAUDIO_MODE_DSP_B;
 89                 break;
 90         case SND_SOC_DAIFMT_I2S:
 91                 format |= SI476X_DAUDIO_MODE_I2S;
 92                 break;
 93         case SND_SOC_DAIFMT_RIGHT_J:
 94                 format |= SI476X_DAUDIO_MODE_RIGHT_J;
 95                 break;
 96         case SND_SOC_DAIFMT_LEFT_J:
 97                 format |= SI476X_DAUDIO_MODE_LEFT_J;
 98                 break;
 99         default:
100                 return -EINVAL;
101         }
102 
103         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
104         case SND_SOC_DAIFMT_DSP_A:
105         case SND_SOC_DAIFMT_DSP_B:
106                 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
107                 case SND_SOC_DAIFMT_NB_NF:
108                         break;
109                 case SND_SOC_DAIFMT_IB_NF:
110                         format |= SI476X_DAUDIO_MODE_IB;
111                         break;
112                 default:
113                         return -EINVAL;
114                 }
115                 break;
116         case SND_SOC_DAIFMT_I2S:
117         case SND_SOC_DAIFMT_RIGHT_J:
118         case SND_SOC_DAIFMT_LEFT_J:
119                 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
120                 case SND_SOC_DAIFMT_NB_NF:
121                         break;
122                 case SND_SOC_DAIFMT_IB_IF:
123                         format |= SI476X_DAUDIO_MODE_IB |
124                                 SI476X_DAUDIO_MODE_IF;
125                         break;
126                 case SND_SOC_DAIFMT_IB_NF:
127                         format |= SI476X_DAUDIO_MODE_IB;
128                         break;
129                 case SND_SOC_DAIFMT_NB_IF:
130                         format |= SI476X_DAUDIO_MODE_IF;
131                         break;
132                 default:
133                         return -EINVAL;
134                 }
135                 break;
136         default:
137                 return -EINVAL;
138         }
139 
140         si476x_core_lock(core);
141 
142         err = snd_soc_update_bits(codec_dai->codec, SI476X_DIGITAL_IO_OUTPUT_FORMAT,
143                                   SI476X_DIGITAL_IO_OUTPUT_FORMAT_MASK,
144                                   format);
145 
146         si476x_core_unlock(core);
147 
148         if (err < 0) {
149                 dev_err(codec_dai->codec->dev, "Failed to set output format\n");
150                 return err;
151         }
152 
153         return 0;
154 }
155 
156 static int si476x_codec_hw_params(struct snd_pcm_substream *substream,
157                                   struct snd_pcm_hw_params *params,
158                                   struct snd_soc_dai *dai)
159 {
160         struct si476x_core *core = i2c_mfd_cell_to_core(dai->dev);
161         int rate, width, err;
162 
163         rate = params_rate(params);
164         if (rate < 32000 || rate > 48000) {
165                 dev_err(dai->codec->dev, "Rate: %d is not supported\n", rate);
166                 return -EINVAL;
167         }
168 
169         switch (params_format(params)) {
170         case SNDRV_PCM_FORMAT_S8:
171                 width = SI476X_PCM_FORMAT_S8;
172                 break;
173         case SNDRV_PCM_FORMAT_S16_LE:
174                 width = SI476X_PCM_FORMAT_S16_LE;
175                 break;
176         case SNDRV_PCM_FORMAT_S20_3LE:
177                 width = SI476X_PCM_FORMAT_S20_3LE;
178                 break;
179         case SNDRV_PCM_FORMAT_S24_LE:
180                 width = SI476X_PCM_FORMAT_S24_LE;
181                 break;
182         default:
183                 return -EINVAL;
184         }
185 
186         si476x_core_lock(core);
187 
188         err = snd_soc_write(dai->codec, SI476X_DIGITAL_IO_OUTPUT_SAMPLE_RATE,
189                             rate);
190         if (err < 0) {
191                 dev_err(dai->codec->dev, "Failed to set sample rate\n");
192                 goto out;
193         }
194 
195         err = snd_soc_update_bits(dai->codec, SI476X_DIGITAL_IO_OUTPUT_FORMAT,
196                                   SI476X_DIGITAL_IO_OUTPUT_WIDTH_MASK,
197                                   (width << SI476X_DIGITAL_IO_SLOT_SIZE_SHIFT) |
198                                   (width << SI476X_DIGITAL_IO_SAMPLE_SIZE_SHIFT));
199         if (err < 0) {
200                 dev_err(dai->codec->dev, "Failed to set output width\n");
201                 goto out;
202         }
203 
204 out:
205         si476x_core_unlock(core);
206 
207         return err;
208 }
209 
210 static int si476x_codec_probe(struct snd_soc_codec *codec)
211 {
212         codec->control_data = dev_get_regmap(codec->dev->parent, NULL);
213         return snd_soc_codec_set_cache_io(codec, 0, 0, SND_SOC_REGMAP);
214 }
215 
216 static struct snd_soc_dai_ops si476x_dai_ops = {
217         .hw_params      = si476x_codec_hw_params,
218         .set_fmt        = si476x_codec_set_dai_fmt,
219 };
220 
221 static struct snd_soc_dai_driver si476x_dai = {
222         .name           = "si476x-codec",
223         .capture        = {
224                 .stream_name    = "Capture",
225                 .channels_min   = 2,
226                 .channels_max   = 2,
227 
228                 .rates = SNDRV_PCM_RATE_32000 |
229                 SNDRV_PCM_RATE_44100 |
230                 SNDRV_PCM_RATE_48000,
231                 .formats = SNDRV_PCM_FMTBIT_S8 |
232                 SNDRV_PCM_FMTBIT_S16_LE |
233                 SNDRV_PCM_FMTBIT_S20_3LE |
234                 SNDRV_PCM_FMTBIT_S24_LE
235         },
236         .ops            = &si476x_dai_ops,
237 };
238 
239 static struct snd_soc_codec_driver soc_codec_dev_si476x = {
240         .probe  = si476x_codec_probe,
241         .dapm_widgets = si476x_dapm_widgets,
242         .num_dapm_widgets = ARRAY_SIZE(si476x_dapm_widgets),
243         .dapm_routes = si476x_dapm_routes,
244         .num_dapm_routes = ARRAY_SIZE(si476x_dapm_routes),
245 };
246 
247 static int si476x_platform_probe(struct platform_device *pdev)
248 {
249         return snd_soc_register_codec(&pdev->dev, &soc_codec_dev_si476x,
250                                       &si476x_dai, 1);
251 }
252 
253 static int si476x_platform_remove(struct platform_device *pdev)
254 {
255         snd_soc_unregister_codec(&pdev->dev);
256         return 0;
257 }
258 
259 MODULE_ALIAS("platform:si476x-codec");
260 
261 static struct platform_driver si476x_platform_driver = {
262         .driver         = {
263                 .name   = "si476x-codec",
264                 .owner  = THIS_MODULE,
265         },
266         .probe          = si476x_platform_probe,
267         .remove         = si476x_platform_remove,
268 };
269 module_platform_driver(si476x_platform_driver);
270 
271 MODULE_AUTHOR("Andrey Smirnov <andrew.smirnov@gmail.com>");
272 MODULE_DESCRIPTION("ASoC Si4761/64 codec driver");
273 MODULE_LICENSE("GPL");
274 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us