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