1 #include <linux/module.h>
2 #include <linux/slab.h>
4 #include <sound/pcm_params.h>
6 #include <sound/initval.h>
10 #include <linux/mfd/si476x-core.h>
12 enum si476x_audio_registers
{
13 SI476X_DIGITAL_IO_OUTPUT_FORMAT
= 0x0203,
14 SI476X_DIGITAL_IO_OUTPUT_SAMPLE_RATE
= 0x0202,
17 enum si476x_digital_io_output_format
{
18 SI476X_DIGITAL_IO_SLOT_SIZE_SHIFT
= 11,
19 SI476X_DIGITAL_IO_SAMPLE_SIZE_SHIFT
= 8,
22 #define SI476X_DIGITAL_IO_OUTPUT_WIDTH_MASK ((0b111 << SI476X_DIGITAL_IO_SLOT_SIZE_SHIFT) | \
23 (0b111 << SI476X_DIGITAL_IO_SAMPLE_SIZE_SHIFT))
24 #define SI476X_DIGITAL_IO_OUTPUT_FORMAT_MASK (0b1111110)
26 enum si476x_daudio_formats
{
27 SI476X_DAUDIO_MODE_I2S
= (0x0 << 1),
28 SI476X_DAUDIO_MODE_DSP_A
= (0x6 << 1),
29 SI476X_DAUDIO_MODE_DSP_B
= (0x7 << 1),
30 SI476X_DAUDIO_MODE_LEFT_J
= (0x8 << 1),
31 SI476X_DAUDIO_MODE_RIGHT_J
= (0x9 << 1),
33 SI476X_DAUDIO_MODE_IB
= (1 << 5),
34 SI476X_DAUDIO_MODE_IF
= (1 << 6),
37 enum si476x_pcm_format
{
38 SI476X_PCM_FORMAT_S8
= 2,
39 SI476X_PCM_FORMAT_S16_LE
= 4,
40 SI476X_PCM_FORMAT_S20_3LE
= 5,
41 SI476X_PCM_FORMAT_S24_LE
= 6,
44 static unsigned int si476x_codec_read(struct snd_soc_codec
*codec
,
48 struct si476x_core
*core
= codec
->control_data
;
50 si476x_core_lock(core
);
51 err
= si476x_core_cmd_get_property(core
, reg
);
52 si476x_core_unlock(core
);
57 static int si476x_codec_write(struct snd_soc_codec
*codec
,
58 unsigned int reg
, unsigned int val
)
61 struct si476x_core
*core
= codec
->control_data
;
63 si476x_core_lock(core
);
64 err
= si476x_core_cmd_set_property(core
, reg
, val
);
65 si476x_core_unlock(core
);
70 static int si476x_codec_set_dai_fmt(struct snd_soc_dai
*codec_dai
,
76 if ((fmt
& SND_SOC_DAIFMT_MASTER_MASK
) != SND_SOC_DAIFMT_CBS_CFS
)
79 switch (fmt
& SND_SOC_DAIFMT_FORMAT_MASK
) {
80 case SND_SOC_DAIFMT_DSP_A
:
81 format
|= SI476X_DAUDIO_MODE_DSP_A
;
83 case SND_SOC_DAIFMT_DSP_B
:
84 format
|= SI476X_DAUDIO_MODE_DSP_B
;
86 case SND_SOC_DAIFMT_I2S
:
87 format
|= SI476X_DAUDIO_MODE_I2S
;
89 case SND_SOC_DAIFMT_RIGHT_J
:
90 format
|= SI476X_DAUDIO_MODE_RIGHT_J
;
92 case SND_SOC_DAIFMT_LEFT_J
:
93 format
|= SI476X_DAUDIO_MODE_LEFT_J
;
99 switch (fmt
& SND_SOC_DAIFMT_FORMAT_MASK
) {
100 case SND_SOC_DAIFMT_DSP_A
:
101 case SND_SOC_DAIFMT_DSP_B
:
102 switch (fmt
& SND_SOC_DAIFMT_INV_MASK
) {
103 case SND_SOC_DAIFMT_NB_NF
:
105 case SND_SOC_DAIFMT_IB_NF
:
106 format
|= SI476X_DAUDIO_MODE_IB
;
112 case SND_SOC_DAIFMT_I2S
:
113 case SND_SOC_DAIFMT_RIGHT_J
:
114 case SND_SOC_DAIFMT_LEFT_J
:
115 switch (fmt
& SND_SOC_DAIFMT_INV_MASK
) {
116 case SND_SOC_DAIFMT_NB_NF
:
118 case SND_SOC_DAIFMT_IB_IF
:
119 format
|= SI476X_DAUDIO_MODE_IB
|
120 SI476X_DAUDIO_MODE_IF
;
122 case SND_SOC_DAIFMT_IB_NF
:
123 format
|= SI476X_DAUDIO_MODE_IB
;
125 case SND_SOC_DAIFMT_NB_IF
:
126 format
|= SI476X_DAUDIO_MODE_IF
;
136 err
= snd_soc_update_bits(codec_dai
->codec
, SI476X_DIGITAL_IO_OUTPUT_FORMAT
,
137 SI476X_DIGITAL_IO_OUTPUT_FORMAT_MASK
,
140 dev_err(codec_dai
->codec
->dev
, "Failed to set output format\n");
147 static int si476x_codec_hw_params(struct snd_pcm_substream
*substream
,
148 struct snd_pcm_hw_params
*params
,
149 struct snd_soc_dai
*dai
)
151 int rate
, width
, err
;
153 rate
= params_rate(params
);
154 if (rate
< 32000 || rate
> 48000) {
155 dev_err(dai
->codec
->dev
, "Rate: %d is not supported\n", rate
);
159 switch (params_format(params
)) {
160 case SNDRV_PCM_FORMAT_S8
:
161 width
= SI476X_PCM_FORMAT_S8
;
162 case SNDRV_PCM_FORMAT_S16_LE
:
163 width
= SI476X_PCM_FORMAT_S16_LE
;
165 case SNDRV_PCM_FORMAT_S20_3LE
:
166 width
= SI476X_PCM_FORMAT_S20_3LE
;
168 case SNDRV_PCM_FORMAT_S24_LE
:
169 width
= SI476X_PCM_FORMAT_S24_LE
;
175 err
= snd_soc_write(dai
->codec
, SI476X_DIGITAL_IO_OUTPUT_SAMPLE_RATE
,
178 dev_err(dai
->codec
->dev
, "Failed to set sample rate\n");
182 err
= snd_soc_update_bits(dai
->codec
, SI476X_DIGITAL_IO_OUTPUT_FORMAT
,
183 SI476X_DIGITAL_IO_OUTPUT_WIDTH_MASK
,
184 (width
<< SI476X_DIGITAL_IO_SLOT_SIZE_SHIFT
) |
185 (width
<< SI476X_DIGITAL_IO_SAMPLE_SIZE_SHIFT
));
187 dev_err(dai
->codec
->dev
, "Failed to set output width\n");
194 static int si476x_codec_probe(struct snd_soc_codec
*codec
)
196 codec
->control_data
= i2c_mfd_cell_to_core(codec
->dev
);
200 static struct snd_soc_dai_ops si476x_dai_ops
= {
201 .hw_params
= si476x_codec_hw_params
,
202 .set_fmt
= si476x_codec_set_dai_fmt
,
205 static struct snd_soc_dai_driver si476x_dai
= {
206 .name
= "si476x-codec",
208 .stream_name
= "Capture",
212 .rates
= SNDRV_PCM_RATE_32000
|
213 SNDRV_PCM_RATE_44100
|
214 SNDRV_PCM_RATE_48000
,
215 .formats
= SNDRV_PCM_FMTBIT_S8
|
216 SNDRV_PCM_FMTBIT_S16_LE
|
217 SNDRV_PCM_FMTBIT_S20_3LE
|
218 SNDRV_PCM_FMTBIT_S24_LE
220 .ops
= &si476x_dai_ops
,
223 static struct snd_soc_codec_driver soc_codec_dev_si476x
= {
224 .probe
= si476x_codec_probe
,
225 .read
= si476x_codec_read
,
226 .write
= si476x_codec_write
,
229 static int __devinit
si476x_platform_probe(struct platform_device
*pdev
)
231 return snd_soc_register_codec(&pdev
->dev
, &soc_codec_dev_si476x
,
235 static int __devexit
si476x_platform_remove(struct platform_device
*pdev
)
237 snd_soc_unregister_codec(&pdev
->dev
);
241 MODULE_ALIAS("platform:si476x-codec");
243 static struct platform_driver si476x_platform_driver
= {
245 .name
= "si476x-codec",
246 .owner
= THIS_MODULE
,
248 .probe
= si476x_platform_probe
,
249 .remove
= __devexit_p(si476x_platform_remove
),
251 module_platform_driver(si476x_platform_driver
);
253 MODULE_AUTHOR("Andrey Smirnov <andrey.smirnov@convergeddevices.net>");
254 MODULE_DESCRIPTION("ASoC Si4761/64 codec driver");
255 MODULE_LICENSE("GPL");