1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
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
31enum si476x_audio_registers {
32 SI476X_DIGITAL_IO_OUTPUT_FORMAT = 0x0203,
33 SI476X_DIGITAL_IO_OUTPUT_SAMPLE_RATE = 0x0202,
34};
35
36enum 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 ((0b111 << SI476X_DIGITAL_IO_SLOT_SIZE_SHIFT) | \
42 (0b111 << SI476X_DIGITAL_IO_SAMPLE_SIZE_SHIFT))
43#define SI476X_DIGITAL_IO_OUTPUT_FORMAT_MASK (0b1111110)
44
45enum 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
56enum 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
63static unsigned int si476x_codec_read(struct snd_soc_codec *codec,
64 unsigned int reg)
65{
66 int err;
67 unsigned int val;
68 struct si476x_core *core = codec->control_data;
69
70 si476x_core_lock(core);
71 if (!si476x_core_is_powered_up(core))
72 regcache_cache_only(core->regmap, true);
73
74 err = regmap_read(core->regmap, reg, &val);
75
76 if (!si476x_core_is_powered_up(core))
77 regcache_cache_only(core->regmap, false);
78 si476x_core_unlock(core);
79
80 if (err < 0)
81 return err;
82
83 return val;
84}
85
86static int si476x_codec_write(struct snd_soc_codec *codec,
87 unsigned int reg, unsigned int val)
88{
89 int err;
90 struct si476x_core *core = codec->control_data;
91
92 si476x_core_lock(core);
93 if (!si476x_core_is_powered_up(core))
94 regcache_cache_only(core->regmap, true);
95
96 err = regmap_write(core->regmap, reg, val);
97
98 if (!si476x_core_is_powered_up(core))
99 regcache_cache_only(core->regmap, false);
100 si476x_core_unlock(core);
101
102 return err;
103}
104
105static int si476x_codec_set_dai_fmt(struct snd_soc_dai *codec_dai,
106 unsigned int fmt)
107{
108 int err;
109 u16 format = 0;
110
111 if ((fmt & SND_SOC_DAIFMT_MASTER_MASK) != SND_SOC_DAIFMT_CBS_CFS)
112 return -EINVAL;
113
114 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
115 case SND_SOC_DAIFMT_DSP_A:
116 format |= SI476X_DAUDIO_MODE_DSP_A;
117 break;
118 case SND_SOC_DAIFMT_DSP_B:
119 format |= SI476X_DAUDIO_MODE_DSP_B;
120 break;
121 case SND_SOC_DAIFMT_I2S:
122 format |= SI476X_DAUDIO_MODE_I2S;
123 break;
124 case SND_SOC_DAIFMT_RIGHT_J:
125 format |= SI476X_DAUDIO_MODE_RIGHT_J;
126 break;
127 case SND_SOC_DAIFMT_LEFT_J:
128 format |= SI476X_DAUDIO_MODE_LEFT_J;
129 break;
130 default:
131 return -EINVAL;
132 }
133
134 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
135 case SND_SOC_DAIFMT_DSP_A:
136 case SND_SOC_DAIFMT_DSP_B:
137 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
138 case SND_SOC_DAIFMT_NB_NF:
139 break;
140 case SND_SOC_DAIFMT_IB_NF:
141 format |= SI476X_DAUDIO_MODE_IB;
142 break;
143 default:
144 return -EINVAL;
145 }
146 break;
147 case SND_SOC_DAIFMT_I2S:
148 case SND_SOC_DAIFMT_RIGHT_J:
149 case SND_SOC_DAIFMT_LEFT_J:
150 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
151 case SND_SOC_DAIFMT_NB_NF:
152 break;
153 case SND_SOC_DAIFMT_IB_IF:
154 format |= SI476X_DAUDIO_MODE_IB |
155 SI476X_DAUDIO_MODE_IF;
156 break;
157 case SND_SOC_DAIFMT_IB_NF:
158 format |= SI476X_DAUDIO_MODE_IB;
159 break;
160 case SND_SOC_DAIFMT_NB_IF:
161 format |= SI476X_DAUDIO_MODE_IF;
162 break;
163 default:
164 return -EINVAL;
165 }
166 break;
167 default:
168 return -EINVAL;
169 }
170
171 err = snd_soc_update_bits(codec_dai->codec, SI476X_DIGITAL_IO_OUTPUT_FORMAT,
172 SI476X_DIGITAL_IO_OUTPUT_FORMAT_MASK,
173 format);
174 if (err < 0) {
175 dev_err(codec_dai->codec->dev, "Failed to set output format\n");
176 return err;
177 }
178
179 return 0;
180}
181
182static int si476x_codec_hw_params(struct snd_pcm_substream *substream,
183 struct snd_pcm_hw_params *params,
184 struct snd_soc_dai *dai)
185{
186 int rate, width, err;
187
188 rate = params_rate(params);
189 if (rate < 32000 || rate > 48000) {
190 dev_err(dai->codec->dev, "Rate: %d is not supported\n", rate);
191 return -EINVAL;
192 }
193
194 switch (params_format(params)) {
195 case SNDRV_PCM_FORMAT_S8:
196 width = SI476X_PCM_FORMAT_S8;
197 break;
198 case SNDRV_PCM_FORMAT_S16_LE:
199 width = SI476X_PCM_FORMAT_S16_LE;
200 break;
201 case SNDRV_PCM_FORMAT_S20_3LE:
202 width = SI476X_PCM_FORMAT_S20_3LE;
203 break;
204 case SNDRV_PCM_FORMAT_S24_LE:
205 width = SI476X_PCM_FORMAT_S24_LE;
206 break;
207 default:
208 return -EINVAL;
209 }
210
211 err = snd_soc_write(dai->codec, SI476X_DIGITAL_IO_OUTPUT_SAMPLE_RATE,
212 rate);
213 if (err < 0) {
214 dev_err(dai->codec->dev, "Failed to set sample rate\n");
215 return err;
216 }
217
218 err = snd_soc_update_bits(dai->codec, SI476X_DIGITAL_IO_OUTPUT_FORMAT,
219 SI476X_DIGITAL_IO_OUTPUT_WIDTH_MASK,
220 (width << SI476X_DIGITAL_IO_SLOT_SIZE_SHIFT) |
221 (width << SI476X_DIGITAL_IO_SAMPLE_SIZE_SHIFT));
222 if (err < 0) {
223 dev_err(dai->codec->dev, "Failed to set output width\n");
224 return err;
225 }
226
227 return 0;
228}
229
230static int si476x_codec_probe(struct snd_soc_codec *codec)
231{
232 codec->control_data = i2c_mfd_cell_to_core(codec->dev);
233 return 0;
234}
235
236static struct snd_soc_dai_ops si476x_dai_ops = {
237 .hw_params = si476x_codec_hw_params,
238 .set_fmt = si476x_codec_set_dai_fmt,
239};
240
241static struct snd_soc_dai_driver si476x_dai = {
242 .name = "si476x-codec",
243 .capture = {
244 .stream_name = "Capture",
245 .channels_min = 2,
246 .channels_max = 2,
247
248 .rates = SNDRV_PCM_RATE_32000 |
249 SNDRV_PCM_RATE_44100 |
250 SNDRV_PCM_RATE_48000,
251 .formats = SNDRV_PCM_FMTBIT_S8 |
252 SNDRV_PCM_FMTBIT_S16_LE |
253 SNDRV_PCM_FMTBIT_S20_3LE |
254 SNDRV_PCM_FMTBIT_S24_LE
255 },
256 .ops = &si476x_dai_ops,
257};
258
259static struct snd_soc_codec_driver soc_codec_dev_si476x = {
260 .probe = si476x_codec_probe,
261 .read = si476x_codec_read,
262 .write = si476x_codec_write,
263};
264
265static int si476x_platform_probe(struct platform_device *pdev)
266{
267 return snd_soc_register_codec(&pdev->dev, &soc_codec_dev_si476x,
268 &si476x_dai, 1);
269}
270
271static int si476x_platform_remove(struct platform_device *pdev)
272{
273 snd_soc_unregister_codec(&pdev->dev);
274 return 0;
275}
276
277MODULE_ALIAS("platform:si476x-codec");
278
279static struct platform_driver si476x_platform_driver = {
280 .driver = {
281 .name = "si476x-codec",
282 .owner = THIS_MODULE,
283 },
284 .probe = si476x_platform_probe,
285 .remove = si476x_platform_remove,
286};
287module_platform_driver(si476x_platform_driver);
288
289MODULE_AUTHOR("Andrey Smirnov <andrew.smirnov@gmail.com>");
290MODULE_DESCRIPTION("ASoC Si4761/64 codec driver");
291MODULE_LICENSE("GPL");
292
