linux/sound/soc/codecs/si476x.c
<<
>>
Prefs
   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
  32enum si476x_audio_registers {
  33        SI476X_DIGITAL_IO_OUTPUT_FORMAT         = 0x0203,
  34        SI476X_DIGITAL_IO_OUTPUT_SAMPLE_RATE    = 0x0202,
  35};
  36
  37enum 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
  46enum 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
  57enum 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
  64static const struct snd_soc_dapm_widget si476x_dapm_widgets[] = {
  65SND_SOC_DAPM_OUTPUT("LOUT"),
  66SND_SOC_DAPM_OUTPUT("ROUT"),
  67};
  68
  69static const struct snd_soc_dapm_route si476x_dapm_routes[] = {
  70        { "Capture", NULL, "LOUT" },
  71        { "Capture", NULL, "ROUT" },
  72};
  73
  74static 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
 157static 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
 205out:
 206        si476x_core_unlock(core);
 207
 208        return err;
 209}
 210
 211static 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
 216static 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
 234static struct regmap *si476x_get_regmap(struct device *dev)
 235{
 236        return dev_get_regmap(dev->parent, NULL);
 237}
 238
 239static struct snd_soc_codec_driver soc_codec_dev_si476x = {
 240        .get_regmap = si476x_get_regmap,
 241        .component_driver = {
 242                .dapm_widgets           = si476x_dapm_widgets,
 243                .num_dapm_widgets       = ARRAY_SIZE(si476x_dapm_widgets),
 244                .dapm_routes            = si476x_dapm_routes,
 245                .num_dapm_routes        = ARRAY_SIZE(si476x_dapm_routes),
 246        },
 247};
 248
 249static int si476x_platform_probe(struct platform_device *pdev)
 250{
 251        return snd_soc_register_codec(&pdev->dev, &soc_codec_dev_si476x,
 252                                      &si476x_dai, 1);
 253}
 254
 255static int si476x_platform_remove(struct platform_device *pdev)
 256{
 257        snd_soc_unregister_codec(&pdev->dev);
 258        return 0;
 259}
 260
 261MODULE_ALIAS("platform:si476x-codec");
 262
 263static struct platform_driver si476x_platform_driver = {
 264        .driver         = {
 265                .name   = "si476x-codec",
 266        },
 267        .probe          = si476x_platform_probe,
 268        .remove         = si476x_platform_remove,
 269};
 270module_platform_driver(si476x_platform_driver);
 271
 272MODULE_AUTHOR("Andrey Smirnov <andrew.smirnov@gmail.com>");
 273MODULE_DESCRIPTION("ASoC Si4761/64 codec driver");
 274MODULE_LICENSE("GPL");
 275