target/linux/brcm2708/patches-4.4/0371-New-driver-for-RRA-DigiDAC1-soundcard-using-WM8741-W.patch

   1 From c056c0b3563942ab9715c14fb2c4e24198f84b33 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 + WM8804
   5
   6 ---
   7  arch/arm/boot/dts/overlays/Makefile                |   1 +
   8  arch/arm/boot/dts/overlays/README                  |   6 +
   9  .../overlays/rra-digidac1-wm8741-audio-overlay.dts |  81 ++++
  10  arch/arm/configs/bcm2709_defconfig                 |   1 +
  11  arch/arm/configs/bcmrpi_defconfig                  |   1 +
  12  sound/soc/bcm/Kconfig                              |   8 +
  13  sound/soc/bcm/Makefile                             |   2 +
  14  sound/soc/bcm/digidac1-soundcard.c                 | 422 +++++++++++++++++++++
  15  8 files changed, 522 insertions(+)
  16  create mode 100644 arch/arm/boot/dts/overlays/rra-digidac1-wm8741-audio-overlay.dts
  17  create mode 100644 sound/soc/bcm/digidac1-soundcard.c
  18
  19 --- a/arch/arm/boot/dts/overlays/Makefile
  20 +++ b/arch/arm/boot/dts/overlays/Makefile
  21 @@ -67,6 +67,7 @@ dtbo-$(RPI_DT_OVERLAYS) += rpi-display.d
  22  dtbo-$(RPI_DT_OVERLAYS) += rpi-ft5406.dtbo
  23  dtbo-$(RPI_DT_OVERLAYS) += rpi-proto.dtbo
  24  dtbo-$(RPI_DT_OVERLAYS) += rpi-sense.dtbo
  25 +dtbo-$(RPI_DT_OVERLAYS) += rra-digidac1-wm8741-audio.dtbo
  26  dtbo-$(RPI_DT_OVERLAYS) += sdhost.dtbo
  27  dtbo-$(RPI_DT_OVERLAYS) += sdio.dtbo
  28  dtbo-$(RPI_DT_OVERLAYS) += sdio-1bit.dtbo
  29 --- a/arch/arm/boot/dts/overlays/README
  30 +++ b/arch/arm/boot/dts/overlays/README
  31 @@ -842,6 +842,12 @@ Load:   dtoverlay=rpi-sense
  32  Params: <None>
  33
  34
  35 +Name:   rra-digidac1-wm8741-audio
  36 +Info:   Configures the Red Rocks Audio DigiDAC1 soundcard
  37 +Load:   dtoverlay=rra-digidac1-wm8741-audio
  38 +Params: <None>
  39 +
  40 +
  41  Name:   sdhost
  42  Info:   Selects the bcm2835-sdhost SD/MMC driver, optionally with overclock.
  43          N.B. This overlay is designed for situations where the mmc driver is
  44 --- /dev/null
  45 +++ b/arch/arm/boot/dts/overlays/rra-digidac1-wm8741-audio-overlay.dts
  46 @@ -0,0 +1,81 @@
  47 +// Definitions for RRA DigiDAC1 Audio card
  48 +/dts-v1/;
  49 +/plugin/;
  50 +
  51 +/ {
  52 +       compatible = "brcm,bcm2708";
  53 +
  54 +       fragment@0 {
  55 +               target-path = "/";
  56 +               __overlay__ {
  57 +                       aliases {
  58 +                               ldo0 = &ldo0;
  59 +                               ldo1 = &ldo1;
  60 +                       };
  61 +               };
  62 +       };
  63 +
  64 +       fragment@1 {
  65 +               target-path = "/soc";
  66 +               __overlay__ {
  67 +
  68 +                       ldo1: ldo1 {
  69 +                               compatible = "regulator-fixed";
  70 +                               regulator-name = "DC_5V";
  71 +                               regulator-min-microvolt = <5000000>;
  72 +                               regulator-max-microvolt = <5000000>;
  73 +                               regulator-always-on;
  74 +                       };
  75 +
  76 +                       ldo0: ldo0 {
  77 +                               compatible = "regulator-fixed";
  78 +                               regulator-name = "DC_3V3";
  79 +                               regulator-min-microvolt = <3300000>;
  80 +                               regulator-max-microvolt = <3300000>;
  81 +                               regulator-always-on;
  82 +                       };
  83 +               };
  84 +       };
  85 +
  86 +       fragment@2 {
  87 +               target = <&i2s>;
  88 +               __overlay__ {
  89 +                       status = "okay";
  90 +               };
  91 +       };
  92 +
  93 +       fragment@3 {
  94 +               target = <&i2c1>;
  95 +               __overlay__ {
  96 +                       #address-cells = <1>;
  97 +                       #size-cells = <0>;
  98 +                       status = "okay";
  99 +
 100 +                       wm8804@3b {
 101 +                               #sound-dai-cells = <0>;
 102 +                               compatible = "wlf,wm8804";
 103 +                               reg = <0x3b>;
 104 +                               status = "okay";
 105 +                               PVDD-supply = <&ldo0>;
 106 +                               DVDD-supply = <&ldo0>;
 107 +                       };
 108 +
 109 +                       wm8742: wm8741@1a {
 110 +                               compatible = "wlf,wm8741";
 111 +                               reg = <0x1a>;
 112 +                               status = "okay";
 113 +                               AVDD-supply = <&ldo1>;
 114 +                               DVDD-supply = <&ldo0>;
 115 +                       };
 116 +               };
 117 +       };
 118 +
 119 +       fragment@4 {
 120 +               target = <&sound>;
 121 +               __overlay__ {
 122 +                       compatible = "rra,digidac1-soundcard";
 123 +                       i2s-controller = <&i2s>;
 124 +                       status = "okay";
 125 +               };
 126 +       };
 127 +};
 128 --- a/arch/arm/configs/bcm2709_defconfig
 129 +++ b/arch/arm/configs/bcm2709_defconfig
 130 @@ -866,6 +866,7 @@ CONFIG_SND_BCM2708_SOC_JUSTBOOM_DIGI=m
 131  CONFIG_SND_BCM2708_SOC_IQAUDIO_DAC=m
 132  CONFIG_SND_BCM2708_SOC_RASPIDAC3=m
 133  CONFIG_SND_AUDIOINJECTOR_PI_SOUNDCARD=m
 134 +CONFIG_SND_DIGIDAC1_SOUNDCARD=m
 135  CONFIG_SND_BCM2708_SOC_ADAU1977_ADC=m
 136  CONFIG_SND_SOC_ADAU1701=m
 137  CONFIG_SND_SOC_WM8804_I2C=m
 138 --- a/arch/arm/configs/bcmrpi_defconfig
 139 +++ b/arch/arm/configs/bcmrpi_defconfig
 140 @@ -858,6 +858,7 @@ CONFIG_SND_BCM2708_SOC_JUSTBOOM_DIGI=m
 141  CONFIG_SND_BCM2708_SOC_IQAUDIO_DAC=m
 142  CONFIG_SND_BCM2708_SOC_RASPIDAC3=m
 143  CONFIG_SND_AUDIOINJECTOR_PI_SOUNDCARD=m
 144 +CONFIG_SND_DIGIDAC1_SOUNDCARD=m
 145  CONFIG_SND_BCM2708_SOC_ADAU1977_ADC=m
 146  CONFIG_SND_SOC_ADAU1701=m
 147  CONFIG_SND_SOC_WM8804_I2C=m
 148 --- a/sound/soc/bcm/Kconfig
 149 +++ b/sound/soc/bcm/Kconfig
 150 @@ -92,3 +92,11 @@ config SND_AUDIOINJECTOR_PI_SOUNDCARD
 151         select SND_SOC_WM8731
 152         help
 153           Say Y or M if you want to add support for audioinjector.net Pi Hat
 154 +
 155 +config SND_DIGIDAC1_SOUNDCARD
 156 +        tristate "Support for Red Rocks Audio DigiDAC1"
 157 +        depends on SND_BCM2708_SOC_I2S || SND_BCM2835_SOC_I2S
 158 +        select SND_SOC_WM8804
 159 +        select SND_SOC_WM8741
 160 +        help
 161 +         Say Y or M if you want to add support for Red Rocks Audio DigiDAC1 board.
 162 --- a/sound/soc/bcm/Makefile
 163 +++ b/sound/soc/bcm/Makefile
 164 @@ -16,6 +16,7 @@ snd-soc-rpi-proto-objs := rpi-proto.o
 165  snd-soc-iqaudio-dac-objs := iqaudio-dac.o
 166  snd-soc-raspidac3-objs := raspidac3.o
 167  snd-soc-audioinjector-pi-soundcard-objs := audioinjector-pi-soundcard.o
 168 +snd-soc-digidac1-soundcard-objs := digidac1-soundcard.o
 169
 170  obj-$(CONFIG_SND_BCM2708_SOC_ADAU1977_ADC) += snd-soc-adau1977-adc.o
 171  obj-$(CONFIG_SND_BCM2708_SOC_HIFIBERRY_DAC) += snd-soc-hifiberry-dac.o
 172 @@ -29,4 +30,5 @@ obj-$(CONFIG_SND_BCM2708_SOC_RPI_PROTO)
 173  obj-$(CONFIG_SND_BCM2708_SOC_IQAUDIO_DAC) += snd-soc-iqaudio-dac.o
 174  obj-$(CONFIG_SND_BCM2708_SOC_RASPIDAC3) += snd-soc-raspidac3.o
 175  obj-$(CONFIG_SND_AUDIOINJECTOR_PI_SOUNDCARD) += snd-soc-audioinjector-pi-soundcard.o
 176 +obj-$(CONFIG_SND_DIGIDAC1_SOUNDCARD) += snd-soc-digidac1-soundcard.o
 177
 178 --- /dev/null
 179 +++ b/sound/soc/bcm/digidac1-soundcard.c
 180 @@ -0,0 +1,422 @@
 181 +/*
 182 + * ASoC Driver for RRA DigiDAC1
 183 + * Copyright 2016
 184 + * Author: José M. Tasende <vintage@redrocksaudio.es>
 185 + * based on the HifiBerry DAC driver by Florian Meier <florian.meier@koalo.de>
 186 + * and the Wolfson card driver by Nikesh Oswal, <Nikesh.Oswal@wolfsonmicro.com>
 187 + * This program is free software; you can redistribute it and/or
 188 + * modify it under the terms of the GNU General Public License
 189 + * version 2 as published by the Free Software Foundation.
 190 + *
 191 + * This program is distributed in the hope that it will be useful, but
 192 + * WITHOUT ANY WARRANTY; without even the implied warranty of
 193 + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 194 + * General Public License for more details.
 195 + */
 196 +
 197 +#include <linux/module.h>
 198 +#include <linux/platform_device.h>
 199 +#include <linux/i2c.h>
 200 +#include <sound/core.h>
 201 +#include <sound/pcm.h>
 202 +#include <sound/pcm_params.h>
 203 +#include <sound/soc.h>
 204 +#include <sound/jack.h>
 205 +#include <sound/soc-dapm.h>
 206 +#include <sound/tlv.h>
 207 +#include <linux/regulator/consumer.h>
 208 +
 209 +#include "../codecs/wm8804.h"
 210 +#include "../codecs/wm8741.h"
 211 +
 212 +#define WM8741_NUM_SUPPLIES 2
 213 +
 214 +/* codec private data */
 215 +struct wm8741_priv {
 216 +       struct wm8741_platform_data pdata;
 217 +       struct regmap *regmap;
 218 +       struct regulator_bulk_data supplies[WM8741_NUM_SUPPLIES];
 219 +       unsigned int sysclk;
 220 +       const struct snd_pcm_hw_constraint_list *sysclk_constraints;
 221 +};
 222 +
 223 +static int samplerate = 44100;
 224 +
 225 +/* New Alsa Controls not exposed by original wm8741 codec driver       */
 226 +/* in actual driver the att. adjustment is wrong because               */
 227 +/* this DAC has a coarse attenuation register with 4dB steps           */
 228 +/* and a fine level register with 0.125dB steps                                */
 229 +/* each register has 32 steps so combining both we have        1024 steps      */
 230 +/* of 0.125 dB.                                                                */
 231 +/* The original level controls from driver are removed at startup      */
 232 +/* and replaced by the corrected ones.                                 */
 233 +/* The same wm8741 driver can be used for wm8741 and wm8742 devices    */
 234 +
 235 +static const DECLARE_TLV_DB_SCALE(dac_tlv_fine, 0, 13, 0);
 236 +static const DECLARE_TLV_DB_SCALE(dac_tlv_coarse, -12700, 400, 1);
 237 +static const char *w8741_dither[4] = {"Off", "RPDF", "TPDF", "HPDF"};
 238 +static const char *w8741_filter[5] = {
 239 +               "Type 1", "Type 2", "Type 3", "Type 4", "Type 5"};
 240 +static const char *w8741_switch[2] = {"Off", "On"};
 241 +static const struct soc_enum w8741_enum[] = {
 242 +SOC_ENUM_SINGLE(WM8741_MODE_CONTROL_2, 0, 4, w8741_dither),/* dithering type */
 243 +SOC_ENUM_SINGLE(WM8741_FILTER_CONTROL, 0, 5, w8741_filter),/* filter type */
 244 +SOC_ENUM_SINGLE(WM8741_FORMAT_CONTROL, 6, 2, w8741_switch),/* phase invert */
 245 +SOC_ENUM_SINGLE(WM8741_VOLUME_CONTROL, 0, 2, w8741_switch),/* volume ramp */
 246 +SOC_ENUM_SINGLE(WM8741_VOLUME_CONTROL, 3, 2, w8741_switch),/* soft mute */
 247 +};
 248 +
 249 +static const struct snd_kcontrol_new w8741_snd_controls_stereo[] = {
 250 +SOC_DOUBLE_R_TLV("DAC Fine Playback Volume", WM8741_DACLLSB_ATTENUATION,
 251 +               WM8741_DACRLSB_ATTENUATION, 0, 31, 1, dac_tlv_fine),
 252 +SOC_DOUBLE_R_TLV("Digital Playback Volume", WM8741_DACLMSB_ATTENUATION,
 253 +               WM8741_DACRMSB_ATTENUATION, 0, 31, 1, dac_tlv_coarse),
 254 +SOC_ENUM("DAC Dither", w8741_enum[0]),
 255 +SOC_ENUM("DAC Digital Filter", w8741_enum[1]),
 256 +SOC_ENUM("DAC Phase Invert", w8741_enum[2]),
 257 +SOC_ENUM("DAC Volume Ramp", w8741_enum[3]),
 258 +SOC_ENUM("DAC Soft Mute", w8741_enum[4]),
 259 +};
 260 +
 261 +static const struct snd_kcontrol_new w8741_snd_controls_mono_left[] = {
 262 +SOC_SINGLE_TLV("DAC Fine Playback Volume", WM8741_DACLLSB_ATTENUATION,
 263 +               0, 31, 0, dac_tlv_fine),
 264 +SOC_SINGLE_TLV("Digital Playback Volume", WM8741_DACLMSB_ATTENUATION,
 265 +               0, 31, 1, dac_tlv_coarse),
 266 +SOC_ENUM("DAC Dither", w8741_enum[0]),
 267 +SOC_ENUM("DAC Digital Filter", w8741_enum[1]),
 268 +SOC_ENUM("DAC Phase Invert", w8741_enum[2]),
 269 +SOC_ENUM("DAC Volume Ramp", w8741_enum[3]),
 270 +SOC_ENUM("DAC Soft Mute", w8741_enum[4]),
 271 +};
 272 +
 273 +static const struct snd_kcontrol_new w8741_snd_controls_mono_right[] = {
 274 +SOC_SINGLE_TLV("DAC Fine Playback Volume", WM8741_DACRLSB_ATTENUATION,
 275 +       0, 31, 0, dac_tlv_fine),
 276 +SOC_SINGLE_TLV("Digital Playback Volume", WM8741_DACRMSB_ATTENUATION,
 277 +       0, 31, 1, dac_tlv_coarse),
 278 +SOC_ENUM("DAC Dither", w8741_enum[0]),
 279 +SOC_ENUM("DAC Digital Filter", w8741_enum[1]),
 280 +SOC_ENUM("DAC Phase Invert", w8741_enum[2]),
 281 +SOC_ENUM("DAC Volume Ramp", w8741_enum[3]),
 282 +SOC_ENUM("DAC Soft Mute", w8741_enum[4]),
 283 +};
 284 +
 285 +static int w8741_add_controls(struct snd_soc_codec *codec)
 286 +{
 287 +       struct wm8741_priv *wm8741 = snd_soc_codec_get_drvdata(codec);
 288 +
 289 +       switch (wm8741->pdata.diff_mode) {
 290 +       case WM8741_DIFF_MODE_STEREO:
 291 +       case WM8741_DIFF_MODE_STEREO_REVERSED:
 292 +               snd_soc_add_codec_controls(codec,
 293 +                               w8741_snd_controls_stereo,
 294 +                               ARRAY_SIZE(w8741_snd_controls_stereo));
 295 +               break;
 296 +       case WM8741_DIFF_MODE_MONO_LEFT:
 297 +               snd_soc_add_codec_controls(codec,
 298 +                               w8741_snd_controls_mono_left,
 299 +                               ARRAY_SIZE(w8741_snd_controls_mono_left));
 300 +               break;
 301 +       case WM8741_DIFF_MODE_MONO_RIGHT:
 302 +               snd_soc_add_codec_controls(codec,
 303 +                               w8741_snd_controls_mono_right,
 304 +                               ARRAY_SIZE(w8741_snd_controls_mono_right));
 305 +               break;
 306 +       default:
 307 +               return -EINVAL;
 308 +       }
 309 +
 310 +       return 0;
 311 +}
 312 +
 313 +static int digidac1_soundcard_init(struct snd_soc_pcm_runtime *rtd)
 314 +{
 315 +       struct snd_soc_codec *codec = rtd->codec;
 316 +       struct snd_soc_card *card = rtd->card;
 317 +       struct snd_soc_pcm_runtime *wm8741_rtd;
 318 +       struct snd_soc_codec *wm8741_codec;
 319 +       struct snd_card *sound_card = card->snd_card;
 320 +       struct snd_kcontrol *kctl;
 321 +       int ret;
 322 +
 323 +       wm8741_rtd = snd_soc_get_pcm_runtime(card, card->dai_link[1].name);
 324 +       if (!wm8741_rtd) {
 325 +               dev_warn(card->dev, "digidac1_soundcard_init: couldn't get wm8741 rtd\n");
 326 +               return -EFAULT;
 327 +       }
 328 +       wm8741_codec = wm8741_rtd->codec;
 329 +       ret = w8741_add_controls(wm8741_codec);
 330 +       if (ret < 0)
 331 +               dev_warn(card->dev, "Failed to add new wm8741 controls: %d\n",
 332 +               ret);
 333 +
 334 +       /* enable TX output */
 335 +       snd_soc_update_bits(codec, WM8804_PWRDN, 0x4, 0x0);
 336 +
 337 +       kctl = snd_soc_card_get_kcontrol(card,
 338 +               "Playback Volume");
 339 +       if (kctl) {
 340 +               kctl->vd[0].access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
 341 +               snd_ctl_remove(sound_card, kctl);
 342 +               }
 343 +       kctl = snd_soc_card_get_kcontrol(card,
 344 +               "Fine Playback Volume");
 345 +       if (kctl) {
 346 +               kctl->vd[0].access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
 347 +               snd_ctl_remove(sound_card, kctl);
 348 +               }
 349 +       return 0;
 350 +}
 351 +
 352 +static int digidac1_soundcard_startup(struct snd_pcm_substream *substream)
 353 +{
 354 +       /* turn on wm8804 digital output */
 355 +       struct snd_soc_pcm_runtime *rtd = substream->private_data;
 356 +       struct snd_soc_codec *codec = rtd->codec;
 357 +       struct snd_soc_card *card = rtd->card;
 358 +       struct snd_soc_pcm_runtime *wm8741_rtd;
 359 +       struct snd_soc_codec *wm8741_codec;
 360 +
 361 +       snd_soc_update_bits(codec, WM8804_PWRDN, 0x3c, 0x00);
 362 +       wm8741_rtd = snd_soc_get_pcm_runtime(card, card->dai_link[1].name);
 363 +       if (!wm8741_rtd) {
 364 +               dev_warn(card->dev, "digidac1_soundcard_startup: couldn't get WM8741 rtd\n");
 365 +               return -EFAULT;
 366 +       }
 367 +       wm8741_codec = wm8741_rtd->codec;
 368 +
 369 +       /* latch wm8741 level */
 370 +       snd_soc_update_bits(wm8741_codec, WM8741_DACLLSB_ATTENUATION,
 371 +               WM8741_UPDATELL, WM8741_UPDATELL);
 372 +       snd_soc_update_bits(wm8741_codec, WM8741_DACLMSB_ATTENUATION,
 373 +               WM8741_UPDATELM, WM8741_UPDATELM);
 374 +       snd_soc_update_bits(wm8741_codec, WM8741_DACRLSB_ATTENUATION,
 375 +               WM8741_UPDATERL, WM8741_UPDATERL);
 376 +       snd_soc_update_bits(wm8741_codec, WM8741_DACRMSB_ATTENUATION,
 377 +               WM8741_UPDATERM, WM8741_UPDATERM);
 378 +
 379 +       return 0;
 380 +}
 381 +
 382 +static void digidac1_soundcard_shutdown(struct snd_pcm_substream *substream)
 383 +{
 384 +       /* turn off wm8804 digital output */
 385 +       struct snd_soc_pcm_runtime *rtd = substream->private_data;
 386 +       struct snd_soc_codec *codec = rtd->codec;
 387 +
 388 +       snd_soc_update_bits(codec, WM8804_PWRDN, 0x3c, 0x3c);
 389 +}
 390 +
 391 +static int digidac1_soundcard_hw_params(struct snd_pcm_substream *substream,
 392 +                                      struct snd_pcm_hw_params *params)
 393 +{
 394 +       struct snd_soc_pcm_runtime *rtd = substream->private_data;
 395 +       struct snd_soc_dai *codec_dai = rtd->codec_dai;
 396 +       struct snd_soc_codec *codec = rtd->codec;
 397 +       struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 398 +       struct snd_soc_card *card = rtd->card;
 399 +       struct snd_soc_pcm_runtime *wm8741_rtd;
 400 +       struct snd_soc_codec *wm8741_codec;
 401 +
 402 +       int sysclk = 27000000;
 403 +       long mclk_freq = 0;
 404 +       int mclk_div = 1;
 405 +       int sampling_freq = 1;
 406 +       int ret;
 407 +
 408 +       wm8741_rtd = snd_soc_get_pcm_runtime(card, card->dai_link[1].name);
 409 +       if (!wm8741_rtd) {
 410 +               dev_warn(card->dev, "digidac1_soundcard_hw_params: couldn't get WM8741 rtd\n");
 411 +               return -EFAULT;
 412 +       }
 413 +       wm8741_codec = wm8741_rtd->codec;
 414 +       samplerate = params_rate(params);
 415 +
 416 +       if (samplerate <= 96000) {
 417 +               mclk_freq = samplerate*256;
 418 +               mclk_div = WM8804_MCLKDIV_256FS;
 419 +       } else {
 420 +               mclk_freq = samplerate*128;
 421 +               mclk_div = WM8804_MCLKDIV_128FS;
 422 +               }
 423 +
 424 +       switch (samplerate) {
 425 +       case 32000:
 426 +               sampling_freq = 0x03;
 427 +               break;
 428 +       case 44100:
 429 +               sampling_freq = 0x00;
 430 +               break;
 431 +       case 48000:
 432 +               sampling_freq = 0x02;
 433 +               break;
 434 +       case 88200:
 435 +               sampling_freq = 0x08;
 436 +               break;
 437 +       case 96000:
 438 +               sampling_freq = 0x0a;
 439 +               break;
 440 +       case 176400:
 441 +               sampling_freq = 0x0c;
 442 +               break;
 443 +       case 192000:
 444 +               sampling_freq = 0x0e;
 445 +               break;
 446 +       default:
 447 +               dev_err(codec->dev,
 448 +               "Failed to set WM8804 SYSCLK, unsupported samplerate %d\n",
 449 +               samplerate);
 450 +       }
 451 +
 452 +       snd_soc_dai_set_clkdiv(codec_dai, WM8804_MCLK_DIV, mclk_div);
 453 +       snd_soc_dai_set_pll(codec_dai, 0, 0, sysclk, mclk_freq);
 454 +
 455 +       ret = snd_soc_dai_set_sysclk(codec_dai, WM8804_TX_CLKSRC_PLL,
 456 +               sysclk, SND_SOC_CLOCK_OUT);
 457 +       if (ret < 0) {
 458 +               dev_err(codec->dev,
 459 +               "Failed to set WM8804 SYSCLK: %d\n", ret);
 460 +               return ret;
 461 +       }
 462 +       /* Enable wm8804 TX output */
 463 +       snd_soc_update_bits(codec, WM8804_PWRDN, 0x4, 0x0);
 464 +
 465 +       /* wm8804 Power on */
 466 +       snd_soc_update_bits(codec, WM8804_PWRDN, 0x9, 0);
 467 +
 468 +       /* wm8804 set sampling frequency status bits */
 469 +       snd_soc_update_bits(codec, WM8804_SPDTX4, 0x0f, sampling_freq);
 470 +
 471 +       /* Now update wm8741 registers for the correct oversampling */
 472 +       if (samplerate <= 48000)
 473 +               snd_soc_update_bits(wm8741_codec, WM8741_MODE_CONTROL_1,
 474 +                WM8741_OSR_MASK, 0x00);
 475 +       else if (samplerate <= 96000)
 476 +               snd_soc_update_bits(wm8741_codec, WM8741_MODE_CONTROL_1,
 477 +                WM8741_OSR_MASK, 0x20);
 478 +       else
 479 +               snd_soc_update_bits(wm8741_codec, WM8741_MODE_CONTROL_1,
 480 +                WM8741_OSR_MASK, 0x40);
 481 +
 482 +       /* wm8741 bit size */
 483 +       switch (params_width(params)) {
 484 +       case 16:
 485 +               snd_soc_update_bits(wm8741_codec, WM8741_FORMAT_CONTROL,
 486 +                WM8741_IWL_MASK, 0x00);
 487 +               break;
 488 +       case 20:
 489 +               snd_soc_update_bits(wm8741_codec, WM8741_FORMAT_CONTROL,
 490 +                WM8741_IWL_MASK, 0x01);
 491 +               break;
 492 +       case 24:
 493 +               snd_soc_update_bits(wm8741_codec, WM8741_FORMAT_CONTROL,
 494 +                WM8741_IWL_MASK, 0x02);
 495 +               break;
 496 +       case 32:
 497 +               snd_soc_update_bits(wm8741_codec, WM8741_FORMAT_CONTROL,
 498 +                WM8741_IWL_MASK, 0x03);
 499 +               break;
 500 +       default:
 501 +               dev_dbg(codec->dev, "wm8741_hw_params:    Unsupported bit size param = %d",
 502 +                       params_width(params));
 503 +               return -EINVAL;
 504 +       }
 505 +
 506 +       return snd_soc_dai_set_bclk_ratio(cpu_dai, 64);
 507 +}
 508 +/* machine stream operations */
 509 +static struct snd_soc_ops digidac1_soundcard_ops = {
 510 +       .hw_params      = digidac1_soundcard_hw_params,
 511 +       .startup        = digidac1_soundcard_startup,
 512 +       .shutdown       = digidac1_soundcard_shutdown,
 513 +};
 514 +
 515 +static struct snd_soc_dai_link digidac1_soundcard_dai[] = {
 516 +       {
 517 +       .name           = "RRA DigiDAC1",
 518 +       .stream_name    = "RRA DigiDAC1 HiFi",
 519 +       .cpu_dai_name   = "bcm2708-i2s.0",
 520 +       .codec_dai_name = "wm8804-spdif",
 521 +       .platform_name  = "bcm2708-i2s.0",
 522 +       .codec_name     = "wm8804.1-003b",
 523 +       .dai_fmt        = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
 524 +                               SND_SOC_DAIFMT_CBM_CFM,
 525 +       .ops            = &digidac1_soundcard_ops,
 526 +       .init           = digidac1_soundcard_init,
 527 +       },
 528 +       {
 529 +       .name           = "RRA DigiDAC11",
 530 +       .stream_name    = "RRA DigiDAC11 HiFi",
 531 +       .cpu_dai_name   = "wm8804-spdif",
 532 +       .codec_dai_name = "wm8741",
 533 +       .codec_name     = "wm8741.1-001a",
 534 +       .dai_fmt        = SND_SOC_DAIFMT_I2S
 535 +                       | SND_SOC_DAIFMT_NB_NF
 536 +                       | SND_SOC_DAIFMT_CBS_CFS,
 537 +       },
 538 +};
 539 +
 540 +/* audio machine driver */
 541 +static struct snd_soc_card digidac1_soundcard = {
 542 +       .name           = "digidac1-soundcard",
 543 +       .owner          = THIS_MODULE,
 544 +       .dai_link       = digidac1_soundcard_dai,
 545 +       .num_links      = ARRAY_SIZE(digidac1_soundcard_dai),
 546 +};
 547 +
 548 +static int digidac1_soundcard_probe(struct platform_device *pdev)
 549 +{
 550 +       int ret = 0;
 551 +
 552 +       digidac1_soundcard.dev = &pdev->dev;
 553 +
 554 +       if (pdev->dev.of_node) {
 555 +               struct device_node *i2s_node;
 556 +               struct snd_soc_dai_link *dai = &digidac1_soundcard_dai[0];
 557 +
 558 +               i2s_node = of_parse_phandle(pdev->dev.of_node,
 559 +                                       "i2s-controller", 0);
 560 +
 561 +               if (i2s_node) {
 562 +                       dai->cpu_dai_name = NULL;
 563 +                       dai->cpu_of_node = i2s_node;
 564 +                       dai->platform_name = NULL;
 565 +                       dai->platform_of_node = i2s_node;
 566 +               }
 567 +       }
 568 +
 569 +       ret = snd_soc_register_card(&digidac1_soundcard);
 570 +       if (ret)
 571 +               dev_err(&pdev->dev, "snd_soc_register_card() failed: %d\n",
 572 +                ret);
 573 +
 574 +       return ret;
 575 +}
 576 +
 577 +static int digidac1_soundcard_remove(struct platform_device *pdev)
 578 +{
 579 +       return snd_soc_unregister_card(&digidac1_soundcard);
 580 +}
 581 +
 582 +static const struct of_device_id digidac1_soundcard_of_match[] = {
 583 +       { .compatible = "rra,digidac1-soundcard", },
 584 +       {},
 585 +};
 586 +MODULE_DEVICE_TABLE(of, digidac1_soundcard_of_match);
 587 +
 588 +static struct platform_driver digidac1_soundcard_driver = {
 589 +       .driver = {
 590 +                       .name           = "digidac1-audio",
 591 +                       .owner          = THIS_MODULE,
 592 +                       .of_match_table = digidac1_soundcard_of_match,
 593 +       },
 594 +       .probe          = digidac1_soundcard_probe,
 595 +       .remove         = digidac1_soundcard_remove,
 596 +};
 597 +
 598 +module_platform_driver(digidac1_soundcard_driver);
 599 +
 600 +MODULE_AUTHOR("José M. Tasende <vintage@redrocksaudio.es>");
 601 +MODULE_DESCRIPTION("ASoC Driver for RRA DigiDAC1");
 602 +MODULE_LICENSE("GPL v2");