target/linux/bcm27xx/patches-4.19/950-0072-New-driver-for-RRA-DigiDAC1-soundcard-using-WM8741-W.patch

   1 From 13efe81b4ab9321290d6973e90d00b7caf37b47f Mon Sep 17 00:00:00 2001
   2 From: escalator2015 <jmtasende@gmail.com>
   3 Date: Tue, 24 May 2016 16:20:09 +0100
   4 Subject: [PATCH] New driver for RRA DigiDAC1 soundcard using WM8741 +
   5  WM8804
   6
   7 ---
   8  sound/soc/bcm/digidac1-soundcard.c | 416 +++++++++++++++++++++++++++++
   9  1 file changed, 416 insertions(+)
  10  create mode 100644 sound/soc/bcm/digidac1-soundcard.c
  11
  12 --- /dev/null
  13 +++ b/sound/soc/bcm/digidac1-soundcard.c
  14 @@ -0,0 +1,416 @@
  15 +/*
  16 + * ASoC Driver for RRA DigiDAC1
  17 + * Copyright 2016
  18 + * Author: José M. Tasende <vintage@redrocksaudio.es>
  19 + * based on the HifiBerry DAC driver by Florian Meier <florian.meier@koalo.de>
  20 + * and the Wolfson card driver by Nikesh Oswal, <Nikesh.Oswal@wolfsonmicro.com>
  21 + * This program is free software; you can redistribute it and/or
  22 + * modify it under the terms of the GNU General Public License
  23 + * version 2 as published by the Free Software Foundation.
  24 + *
  25 + * This program is distributed in the hope that it will be useful, but
  26 + * WITHOUT ANY WARRANTY; without even the implied warranty of
  27 + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  28 + * General Public License for more details.
  29 + */
  30 +
  31 +#include <linux/module.h>
  32 +#include <linux/platform_device.h>
  33 +#include <linux/i2c.h>
  34 +#include <sound/core.h>
  35 +#include <sound/pcm.h>
  36 +#include <sound/pcm_params.h>
  37 +#include <sound/soc.h>
  38 +#include <sound/jack.h>
  39 +#include <sound/soc-dapm.h>
  40 +#include <sound/tlv.h>
  41 +#include <linux/regulator/consumer.h>
  42 +
  43 +#include "../codecs/wm8804.h"
  44 +#include "../codecs/wm8741.h"
  45 +
  46 +#define WM8741_NUM_SUPPLIES 2
  47 +
  48 +/* codec private data */
  49 +struct wm8741_priv {
  50 +       struct wm8741_platform_data pdata;
  51 +       struct regmap *regmap;
  52 +       struct regulator_bulk_data supplies[WM8741_NUM_SUPPLIES];
  53 +       unsigned int sysclk;
  54 +       const struct snd_pcm_hw_constraint_list *sysclk_constraints;
  55 +};
  56 +
  57 +static int samplerate = 44100;
  58 +
  59 +/* New Alsa Controls not exposed by original wm8741 codec driver       */
  60 +/* in actual driver the att. adjustment is wrong because               */
  61 +/* this DAC has a coarse attenuation register with 4dB steps           */
  62 +/* and a fine level register with 0.125dB steps                                */
  63 +/* each register has 32 steps so combining both we have        1024 steps      */
  64 +/* of 0.125 dB.                                                                */
  65 +/* The original level controls from driver are removed at startup      */
  66 +/* and replaced by the corrected ones.                                 */
  67 +/* The same wm8741 driver can be used for wm8741 and wm8742 devices    */
  68 +
  69 +static const DECLARE_TLV_DB_SCALE(dac_tlv_fine, 0, 13, 0);
  70 +static const DECLARE_TLV_DB_SCALE(dac_tlv_coarse, -12700, 400, 1);
  71 +static const char *w8741_dither[4] = {"Off", "RPDF", "TPDF", "HPDF"};
  72 +static const char *w8741_filter[5] = {
  73 +               "Type 1", "Type 2", "Type 3", "Type 4", "Type 5"};
  74 +static const char *w8741_switch[2] = {"Off", "On"};
  75 +static const struct soc_enum w8741_enum[] = {
  76 +SOC_ENUM_SINGLE(WM8741_MODE_CONTROL_2, 0, 4, w8741_dither),/* dithering type */
  77 +SOC_ENUM_SINGLE(WM8741_FILTER_CONTROL, 0, 5, w8741_filter),/* filter type */
  78 +SOC_ENUM_SINGLE(WM8741_FORMAT_CONTROL, 6, 2, w8741_switch),/* phase invert */
  79 +SOC_ENUM_SINGLE(WM8741_VOLUME_CONTROL, 0, 2, w8741_switch),/* volume ramp */
  80 +SOC_ENUM_SINGLE(WM8741_VOLUME_CONTROL, 3, 2, w8741_switch),/* soft mute */
  81 +};
  82 +
  83 +static const struct snd_kcontrol_new w8741_snd_controls_stereo[] = {
  84 +SOC_DOUBLE_R_TLV("DAC Fine Playback Volume", WM8741_DACLLSB_ATTENUATION,
  85 +               WM8741_DACRLSB_ATTENUATION, 0, 31, 1, dac_tlv_fine),
  86 +SOC_DOUBLE_R_TLV("Digital Playback Volume", WM8741_DACLMSB_ATTENUATION,
  87 +               WM8741_DACRMSB_ATTENUATION, 0, 31, 1, dac_tlv_coarse),
  88 +SOC_ENUM("DAC Dither", w8741_enum[0]),
  89 +SOC_ENUM("DAC Digital Filter", w8741_enum[1]),
  90 +SOC_ENUM("DAC Phase Invert", w8741_enum[2]),
  91 +SOC_ENUM("DAC Volume Ramp", w8741_enum[3]),
  92 +SOC_ENUM("DAC Soft Mute", w8741_enum[4]),
  93 +};
  94 +
  95 +static const struct snd_kcontrol_new w8741_snd_controls_mono_left[] = {
  96 +SOC_SINGLE_TLV("DAC Fine Playback Volume", WM8741_DACLLSB_ATTENUATION,
  97 +               0, 31, 0, dac_tlv_fine),
  98 +SOC_SINGLE_TLV("Digital Playback Volume", WM8741_DACLMSB_ATTENUATION,
  99 +               0, 31, 1, dac_tlv_coarse),
 100 +SOC_ENUM("DAC Dither", w8741_enum[0]),
 101 +SOC_ENUM("DAC Digital Filter", w8741_enum[1]),
 102 +SOC_ENUM("DAC Phase Invert", w8741_enum[2]),
 103 +SOC_ENUM("DAC Volume Ramp", w8741_enum[3]),
 104 +SOC_ENUM("DAC Soft Mute", w8741_enum[4]),
 105 +};
 106 +
 107 +static const struct snd_kcontrol_new w8741_snd_controls_mono_right[] = {
 108 +SOC_SINGLE_TLV("DAC Fine Playback Volume", WM8741_DACRLSB_ATTENUATION,
 109 +       0, 31, 0, dac_tlv_fine),
 110 +SOC_SINGLE_TLV("Digital Playback Volume", WM8741_DACRMSB_ATTENUATION,
 111 +       0, 31, 1, dac_tlv_coarse),
 112 +SOC_ENUM("DAC Dither", w8741_enum[0]),
 113 +SOC_ENUM("DAC Digital Filter", w8741_enum[1]),
 114 +SOC_ENUM("DAC Phase Invert", w8741_enum[2]),
 115 +SOC_ENUM("DAC Volume Ramp", w8741_enum[3]),
 116 +SOC_ENUM("DAC Soft Mute", w8741_enum[4]),
 117 +};
 118 +
 119 +static int w8741_add_controls(struct snd_soc_component *component)
 120 +{
 121 +       struct wm8741_priv *wm8741 = snd_soc_component_get_drvdata(component);
 122 +
 123 +       switch (wm8741->pdata.diff_mode) {
 124 +       case WM8741_DIFF_MODE_STEREO:
 125 +       case WM8741_DIFF_MODE_STEREO_REVERSED:
 126 +               snd_soc_add_component_controls(component,
 127 +                               w8741_snd_controls_stereo,
 128 +                               ARRAY_SIZE(w8741_snd_controls_stereo));
 129 +               break;
 130 +       case WM8741_DIFF_MODE_MONO_LEFT:
 131 +               snd_soc_add_component_controls(component,
 132 +                               w8741_snd_controls_mono_left,
 133 +                               ARRAY_SIZE(w8741_snd_controls_mono_left));
 134 +               break;
 135 +       case WM8741_DIFF_MODE_MONO_RIGHT:
 136 +               snd_soc_add_component_controls(component,
 137 +                               w8741_snd_controls_mono_right,
 138 +                               ARRAY_SIZE(w8741_snd_controls_mono_right));
 139 +               break;
 140 +       default:
 141 +               return -EINVAL;
 142 +       }
 143 +
 144 +       return 0;
 145 +}
 146 +
 147 +static int digidac1_soundcard_init(struct snd_soc_pcm_runtime *rtd)
 148 +{
 149 +       struct snd_soc_component *component = rtd->codec_dai->component;
 150 +       struct snd_soc_card *card = rtd->card;
 151 +       struct snd_soc_pcm_runtime *wm8741_rtd;
 152 +       struct snd_soc_component *wm8741_component;
 153 +       struct snd_card *sound_card = card->snd_card;
 154 +       struct snd_kcontrol *kctl;
 155 +       int ret;
 156 +
 157 +       wm8741_rtd = snd_soc_get_pcm_runtime(card, card->dai_link[1].name);
 158 +       if (!wm8741_rtd) {
 159 +               dev_warn(card->dev, "digidac1_soundcard_init: couldn't get wm8741 rtd\n");
 160 +               return -EFAULT;
 161 +       }
 162 +       wm8741_component = wm8741_rtd->codec_dai->component;
 163 +       ret = w8741_add_controls(wm8741_component);
 164 +       if (ret < 0)
 165 +               dev_warn(card->dev, "Failed to add new wm8741 controls: %d\n",
 166 +               ret);
 167 +
 168 +       /* enable TX output */
 169 +       snd_soc_component_update_bits(component, WM8804_PWRDN, 0x4, 0x0);
 170 +
 171 +       kctl = snd_soc_card_get_kcontrol(card,
 172 +               "Playback Volume");
 173 +       if (kctl) {
 174 +               kctl->vd[0].access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
 175 +               snd_ctl_remove(sound_card, kctl);
 176 +               }
 177 +       kctl = snd_soc_card_get_kcontrol(card,
 178 +               "Fine Playback Volume");
 179 +       if (kctl) {
 180 +               kctl->vd[0].access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
 181 +               snd_ctl_remove(sound_card, kctl);
 182 +               }
 183 +       return 0;
 184 +}
 185 +
 186 +static int digidac1_soundcard_startup(struct snd_pcm_substream *substream)
 187 +{
 188 +       /* turn on wm8804 digital output */
 189 +       struct snd_soc_pcm_runtime *rtd = substream->private_data;
 190 +       struct snd_soc_component *component = rtd->codec_dai->component;
 191 +       struct snd_soc_card *card = rtd->card;
 192 +       struct snd_soc_pcm_runtime *wm8741_rtd;
 193 +       struct snd_soc_component *wm8741_component;
 194 +
 195 +       snd_soc_component_update_bits(component, WM8804_PWRDN, 0x3c, 0x00);
 196 +       wm8741_rtd = snd_soc_get_pcm_runtime(card, card->dai_link[1].name);
 197 +       if (!wm8741_rtd) {
 198 +               dev_warn(card->dev, "digidac1_soundcard_startup: couldn't get WM8741 rtd\n");
 199 +               return -EFAULT;
 200 +       }
 201 +       wm8741_component = wm8741_rtd->codec_dai->component;
 202 +
 203 +       /* latch wm8741 level */
 204 +       snd_soc_component_update_bits(wm8741_component, WM8741_DACLLSB_ATTENUATION,
 205 +               WM8741_UPDATELL, WM8741_UPDATELL);
 206 +       snd_soc_component_update_bits(wm8741_component, WM8741_DACLMSB_ATTENUATION,
 207 +               WM8741_UPDATELM, WM8741_UPDATELM);
 208 +       snd_soc_component_update_bits(wm8741_component, WM8741_DACRLSB_ATTENUATION,
 209 +               WM8741_UPDATERL, WM8741_UPDATERL);
 210 +       snd_soc_component_update_bits(wm8741_component, WM8741_DACRMSB_ATTENUATION,
 211 +               WM8741_UPDATERM, WM8741_UPDATERM);
 212 +
 213 +       return 0;
 214 +}
 215 +
 216 +static void digidac1_soundcard_shutdown(struct snd_pcm_substream *substream)
 217 +{
 218 +       /* turn off wm8804 digital output */
 219 +       struct snd_soc_pcm_runtime *rtd = substream->private_data;
 220 +       struct snd_soc_component *component = rtd->codec_dai->component;
 221 +
 222 +       snd_soc_component_update_bits(component, WM8804_PWRDN, 0x3c, 0x3c);
 223 +}
 224 +
 225 +static int digidac1_soundcard_hw_params(struct snd_pcm_substream *substream,
 226 +                                      struct snd_pcm_hw_params *params)
 227 +{
 228 +       struct snd_soc_pcm_runtime *rtd = substream->private_data;
 229 +       struct snd_soc_dai *codec_dai = rtd->codec_dai;
 230 +       struct snd_soc_component *component = rtd->codec_dai->component;
 231 +       struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 232 +       struct snd_soc_card *card = rtd->card;
 233 +       struct snd_soc_pcm_runtime *wm8741_rtd;
 234 +       struct snd_soc_component *wm8741_component;
 235 +
 236 +       int sysclk = 27000000;
 237 +       long mclk_freq = 0;
 238 +       int mclk_div = 1;
 239 +       int sampling_freq = 1;
 240 +       int ret;
 241 +
 242 +       wm8741_rtd = snd_soc_get_pcm_runtime(card, card->dai_link[1].name);
 243 +       if (!wm8741_rtd) {
 244 +               dev_warn(card->dev, "digidac1_soundcard_hw_params: couldn't get WM8741 rtd\n");
 245 +               return -EFAULT;
 246 +       }
 247 +       wm8741_component = wm8741_rtd->codec_dai->component;
 248 +       samplerate = params_rate(params);
 249 +
 250 +       if (samplerate <= 96000) {
 251 +               mclk_freq = samplerate*256;
 252 +               mclk_div = WM8804_MCLKDIV_256FS;
 253 +       } else {
 254 +               mclk_freq = samplerate*128;
 255 +               mclk_div = WM8804_MCLKDIV_128FS;
 256 +               }
 257 +
 258 +       switch (samplerate) {
 259 +       case 32000:
 260 +               sampling_freq = 0x03;
 261 +               break;
 262 +       case 44100:
 263 +               sampling_freq = 0x00;
 264 +               break;
 265 +       case 48000:
 266 +               sampling_freq = 0x02;
 267 +               break;
 268 +       case 88200:
 269 +               sampling_freq = 0x08;
 270 +               break;
 271 +       case 96000:
 272 +               sampling_freq = 0x0a;
 273 +               break;
 274 +       case 176400:
 275 +               sampling_freq = 0x0c;
 276 +               break;
 277 +       case 192000:
 278 +               sampling_freq = 0x0e;
 279 +               break;
 280 +       default:
 281 +               dev_err(card->dev,
 282 +               "Failed to set WM8804 SYSCLK, unsupported samplerate %d\n",
 283 +               samplerate);
 284 +       }
 285 +
 286 +       snd_soc_dai_set_clkdiv(codec_dai, WM8804_MCLK_DIV, mclk_div);
 287 +       snd_soc_dai_set_pll(codec_dai, 0, 0, sysclk, mclk_freq);
 288 +
 289 +       ret = snd_soc_dai_set_sysclk(codec_dai, WM8804_TX_CLKSRC_PLL,
 290 +               sysclk, SND_SOC_CLOCK_OUT);
 291 +       if (ret < 0) {
 292 +               dev_err(card->dev,
 293 +               "Failed to set WM8804 SYSCLK: %d\n", ret);
 294 +               return ret;
 295 +       }
 296 +       /* Enable wm8804 TX output */
 297 +       snd_soc_component_update_bits(component, WM8804_PWRDN, 0x4, 0x0);
 298 +
 299 +       /* wm8804 Power on */
 300 +       snd_soc_component_update_bits(component, WM8804_PWRDN, 0x9, 0);
 301 +
 302 +       /* wm8804 set sampling frequency status bits */
 303 +       snd_soc_component_update_bits(component, WM8804_SPDTX4, 0x0f, sampling_freq);
 304 +
 305 +       /* Now update wm8741 registers for the correct oversampling */
 306 +       if (samplerate <= 48000)
 307 +               snd_soc_component_update_bits(wm8741_component, WM8741_MODE_CONTROL_1,
 308 +                WM8741_OSR_MASK, 0x00);
 309 +       else if (samplerate <= 96000)
 310 +               snd_soc_component_update_bits(wm8741_component, WM8741_MODE_CONTROL_1,
 311 +                WM8741_OSR_MASK, 0x20);
 312 +       else
 313 +               snd_soc_component_update_bits(wm8741_component, WM8741_MODE_CONTROL_1,
 314 +                WM8741_OSR_MASK, 0x40);
 315 +
 316 +       /* wm8741 bit size */
 317 +       switch (params_width(params)) {
 318 +       case 16:
 319 +               snd_soc_component_update_bits(wm8741_component, WM8741_FORMAT_CONTROL,
 320 +                WM8741_IWL_MASK, 0x00);
 321 +               break;
 322 +       case 20:
 323 +               snd_soc_component_update_bits(wm8741_component, WM8741_FORMAT_CONTROL,
 324 +                WM8741_IWL_MASK, 0x01);
 325 +               break;
 326 +       case 24:
 327 +               snd_soc_component_update_bits(wm8741_component, WM8741_FORMAT_CONTROL,
 328 +                WM8741_IWL_MASK, 0x02);
 329 +               break;
 330 +       case 32:
 331 +               snd_soc_component_update_bits(wm8741_component, WM8741_FORMAT_CONTROL,
 332 +                WM8741_IWL_MASK, 0x03);
 333 +               break;
 334 +       default:
 335 +               dev_dbg(card->dev, "wm8741_hw_params:    Unsupported bit size param = %d",
 336 +                       params_width(params));
 337 +               return -EINVAL;
 338 +       }
 339 +
 340 +       return snd_soc_dai_set_bclk_ratio(cpu_dai, 64);
 341 +}
 342 +/* machine stream operations */
 343 +static struct snd_soc_ops digidac1_soundcard_ops = {
 344 +       .hw_params      = digidac1_soundcard_hw_params,
 345 +       .startup        = digidac1_soundcard_startup,
 346 +       .shutdown       = digidac1_soundcard_shutdown,
 347 +};
 348 +
 349 +static struct snd_soc_dai_link digidac1_soundcard_dai[] = {
 350 +       {
 351 +       .name           = "RRA DigiDAC1",
 352 +       .stream_name    = "RRA DigiDAC1 HiFi",
 353 +       .cpu_dai_name   = "bcm2708-i2s.0",
 354 +       .codec_dai_name = "wm8804-spdif",
 355 +       .platform_name  = "bcm2708-i2s.0",
 356 +       .codec_name     = "wm8804.1-003b",
 357 +       .dai_fmt        = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
 358 +                               SND_SOC_DAIFMT_CBM_CFM,
 359 +       .ops            = &digidac1_soundcard_ops,
 360 +       .init           = digidac1_soundcard_init,
 361 +       },
 362 +       {
 363 +       .name           = "RRA DigiDAC11",
 364 +       .stream_name    = "RRA DigiDAC11 HiFi",
 365 +       .cpu_dai_name   = "wm8804-spdif",
 366 +       .codec_dai_name = "wm8741",
 367 +       .codec_name     = "wm8741.1-001a",
 368 +       .dai_fmt        = SND_SOC_DAIFMT_I2S
 369 +                       | SND_SOC_DAIFMT_NB_NF
 370 +                       | SND_SOC_DAIFMT_CBS_CFS,
 371 +       },
 372 +};
 373 +
 374 +/* audio machine driver */
 375 +static struct snd_soc_card digidac1_soundcard = {
 376 +       .name           = "digidac1-soundcard",
 377 +       .owner          = THIS_MODULE,
 378 +       .dai_link       = digidac1_soundcard_dai,
 379 +       .num_links      = ARRAY_SIZE(digidac1_soundcard_dai),
 380 +};
 381 +
 382 +static int digidac1_soundcard_probe(struct platform_device *pdev)
 383 +{
 384 +       int ret = 0;
 385 +
 386 +       digidac1_soundcard.dev = &pdev->dev;
 387 +
 388 +       if (pdev->dev.of_node) {
 389 +               struct device_node *i2s_node;
 390 +               struct snd_soc_dai_link *dai = &digidac1_soundcard_dai[0];
 391 +
 392 +               i2s_node = of_parse_phandle(pdev->dev.of_node,
 393 +                                       "i2s-controller", 0);
 394 +
 395 +               if (i2s_node) {
 396 +                       dai->cpu_dai_name = NULL;
 397 +                       dai->cpu_of_node = i2s_node;
 398 +                       dai->platform_name = NULL;
 399 +                       dai->platform_of_node = i2s_node;
 400 +               }
 401 +       }
 402 +
 403 +       ret = devm_snd_soc_register_card(&pdev->dev, &digidac1_soundcard);
 404 +       if (ret && ret != -EPROBE_DEFER)
 405 +               dev_err(&pdev->dev, "snd_soc_register_card() failed: %d\n",
 406 +                       ret);
 407 +
 408 +       return ret;
 409 +}
 410 +
 411 +static const struct of_device_id digidac1_soundcard_of_match[] = {
 412 +       { .compatible = "rra,digidac1-soundcard", },
 413 +       {},
 414 +};
 415 +MODULE_DEVICE_TABLE(of, digidac1_soundcard_of_match);
 416 +
 417 +static struct platform_driver digidac1_soundcard_driver = {
 418 +       .driver = {
 419 +                       .name           = "digidac1-audio",
 420 +                       .owner          = THIS_MODULE,
 421 +                       .of_match_table = digidac1_soundcard_of_match,
 422 +       },
 423 +       .probe          = digidac1_soundcard_probe,
 424 +};
 425 +
 426 +module_platform_driver(digidac1_soundcard_driver);
 427 +
 428 +MODULE_AUTHOR("José M. Tasende <vintage@redrocksaudio.es>");
 429 +MODULE_DESCRIPTION("ASoC Driver for RRA DigiDAC1");
 430 +MODULE_LICENSE("GPL v2");