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

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