linux/sound/soc/codecs/tas571x.c
<<
>>
Prefs
   1/*
   2 * TAS571x amplifier audio driver
   3 *
   4 * Copyright (C) 2015 Google, Inc.
   5 * Copyright (c) 2013 Daniel Mack <zonque@gmail.com>
   6 *
   7 * TAS5721 support:
   8 * Copyright (C) 2016 Petr Kulhavy, Barix AG <petr@barix.com>
   9 *
  10 * This program is free software; you can redistribute it and/or modify
  11 * it under the terms of the GNU General Public License as published by
  12 * the Free Software Foundation; either version 2 of the License, or
  13 * (at your option) any later version.
  14 */
  15
  16#include <linux/clk.h>
  17#include <linux/delay.h>
  18#include <linux/device.h>
  19#include <linux/gpio/consumer.h>
  20#include <linux/i2c.h>
  21#include <linux/init.h>
  22#include <linux/kernel.h>
  23#include <linux/module.h>
  24#include <linux/of_device.h>
  25#include <linux/regmap.h>
  26#include <linux/regulator/consumer.h>
  27#include <linux/stddef.h>
  28#include <sound/pcm_params.h>
  29#include <sound/soc.h>
  30#include <sound/tlv.h>
  31#include <asm/unaligned.h>
  32
  33#include "tas571x.h"
  34
  35#define TAS571X_MAX_SUPPLIES            6
  36
  37struct tas571x_chip {
  38        const char                      *const *supply_names;
  39        int                             num_supply_names;
  40        const struct snd_kcontrol_new   *controls;
  41        int                             num_controls;
  42        const struct regmap_config      *regmap_config;
  43        int                             vol_reg_size;
  44};
  45
  46struct tas571x_private {
  47        const struct tas571x_chip       *chip;
  48        struct regmap                   *regmap;
  49        struct regulator_bulk_data      supplies[TAS571X_MAX_SUPPLIES];
  50        struct clk                      *mclk;
  51        unsigned int                    format;
  52        struct gpio_desc                *reset_gpio;
  53        struct gpio_desc                *pdn_gpio;
  54        struct snd_soc_component_driver component_driver;
  55};
  56
  57static int tas571x_register_size(struct tas571x_private *priv, unsigned int reg)
  58{
  59        switch (reg) {
  60        case TAS571X_MVOL_REG:
  61        case TAS571X_CH1_VOL_REG:
  62        case TAS571X_CH2_VOL_REG:
  63                return priv->chip->vol_reg_size;
  64        case TAS571X_INPUT_MUX_REG:
  65        case TAS571X_CH4_SRC_SELECT_REG:
  66        case TAS571X_PWM_MUX_REG:
  67        case TAS5717_CH1_RIGHT_CH_MIX_REG:
  68        case TAS5717_CH1_LEFT_CH_MIX_REG:
  69        case TAS5717_CH2_LEFT_CH_MIX_REG:
  70        case TAS5717_CH2_RIGHT_CH_MIX_REG:
  71                return 4;
  72        default:
  73                return 1;
  74        }
  75}
  76
  77static int tas571x_reg_write(void *context, unsigned int reg,
  78                             unsigned int value)
  79{
  80        struct i2c_client *client = context;
  81        struct tas571x_private *priv = i2c_get_clientdata(client);
  82        unsigned int i, size;
  83        uint8_t buf[5];
  84        int ret;
  85
  86        size = tas571x_register_size(priv, reg);
  87        buf[0] = reg;
  88
  89        for (i = size; i >= 1; --i) {
  90                buf[i] = value;
  91                value >>= 8;
  92        }
  93
  94        ret = i2c_master_send(client, buf, size + 1);
  95        if (ret == size + 1)
  96                return 0;
  97        else if (ret < 0)
  98                return ret;
  99        else
 100                return -EIO;
 101}
 102
 103static int tas571x_reg_read(void *context, unsigned int reg,
 104                            unsigned int *value)
 105{
 106        struct i2c_client *client = context;
 107        struct tas571x_private *priv = i2c_get_clientdata(client);
 108        uint8_t send_buf, recv_buf[4];
 109        struct i2c_msg msgs[2];
 110        unsigned int size;
 111        unsigned int i;
 112        int ret;
 113
 114        size = tas571x_register_size(priv, reg);
 115        send_buf = reg;
 116
 117        msgs[0].addr = client->addr;
 118        msgs[0].len = sizeof(send_buf);
 119        msgs[0].buf = &send_buf;
 120        msgs[0].flags = 0;
 121
 122        msgs[1].addr = client->addr;
 123        msgs[1].len = size;
 124        msgs[1].buf = recv_buf;
 125        msgs[1].flags = I2C_M_RD;
 126
 127        ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
 128        if (ret < 0)
 129                return ret;
 130        else if (ret != ARRAY_SIZE(msgs))
 131                return -EIO;
 132
 133        *value = 0;
 134
 135        for (i = 0; i < size; i++) {
 136                *value <<= 8;
 137                *value |= recv_buf[i];
 138        }
 139
 140        return 0;
 141}
 142
 143/*
 144 * register write for 8- and 20-byte registers
 145 */
 146static int tas571x_reg_write_multiword(struct i2c_client *client,
 147                unsigned int reg, const long values[], size_t len)
 148{
 149        size_t i;
 150        uint8_t *buf, *p;
 151        int ret;
 152        size_t send_size = 1 + len * sizeof(uint32_t);
 153
 154        buf = kzalloc(send_size, GFP_KERNEL | GFP_DMA);
 155        if (!buf)
 156                return -ENOMEM;
 157        buf[0] = reg;
 158
 159        for (i = 0, p = buf + 1; i < len; i++, p += sizeof(uint32_t))
 160                put_unaligned_be32(values[i], p);
 161
 162        ret = i2c_master_send(client, buf, send_size);
 163
 164        kfree(buf);
 165
 166        if (ret == send_size)
 167                return 0;
 168        else if (ret < 0)
 169                return ret;
 170        else
 171                return -EIO;
 172}
 173
 174/*
 175 * register read for 8- and 20-byte registers
 176 */
 177static int tas571x_reg_read_multiword(struct i2c_client *client,
 178                unsigned int reg, long values[], size_t len)
 179{
 180        unsigned int i;
 181        uint8_t send_buf;
 182        uint8_t *recv_buf, *p;
 183        struct i2c_msg msgs[2];
 184        unsigned int recv_size = len * sizeof(uint32_t);
 185        int ret;
 186
 187        recv_buf = kzalloc(recv_size, GFP_KERNEL | GFP_DMA);
 188        if (!recv_buf)
 189                return -ENOMEM;
 190
 191        send_buf = reg;
 192
 193        msgs[0].addr = client->addr;
 194        msgs[0].len = sizeof(send_buf);
 195        msgs[0].buf = &send_buf;
 196        msgs[0].flags = 0;
 197
 198        msgs[1].addr = client->addr;
 199        msgs[1].len = recv_size;
 200        msgs[1].buf = recv_buf;
 201        msgs[1].flags = I2C_M_RD;
 202
 203        ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
 204        if (ret < 0)
 205                goto err_ret;
 206        else if (ret != ARRAY_SIZE(msgs)) {
 207                ret = -EIO;
 208                goto err_ret;
 209        }
 210
 211        for (i = 0, p = recv_buf; i < len; i++, p += sizeof(uint32_t))
 212                values[i] = get_unaligned_be32(p);
 213
 214err_ret:
 215        kfree(recv_buf);
 216        return ret;
 217}
 218
 219/*
 220 * Integer array controls for setting biquad, mixer, DRC coefficients.
 221 * According to the datasheet each coefficient is effectively 26bits,
 222 * i.e. stored as 32bits, where bits [31:26] are ignored.
 223 * TI's TAS57xx Graphical Development Environment tool however produces
 224 * coefficients with more than 26 bits. For this reason we allow values
 225 * in the full 32-bits reange.
 226 * The coefficients are ordered as given in the TAS571x data sheet:
 227 * b0, b1, b2, a1, a2
 228 */
 229
 230static int tas571x_coefficient_info(struct snd_kcontrol *kcontrol,
 231                                   struct snd_ctl_elem_info *uinfo)
 232{
 233        int numcoef = kcontrol->private_value >> 16;
 234
 235        uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 236        uinfo->count = numcoef;
 237        uinfo->value.integer.min = 0;
 238        uinfo->value.integer.max = 0xffffffff;
 239        return 0;
 240}
 241
 242static int tas571x_coefficient_get(struct snd_kcontrol *kcontrol,
 243                                  struct snd_ctl_elem_value *ucontrol)
 244{
 245        struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 246        struct i2c_client *i2c = to_i2c_client(component->dev);
 247        int numcoef = kcontrol->private_value >> 16;
 248        int index = kcontrol->private_value & 0xffff;
 249
 250        return tas571x_reg_read_multiword(i2c, index,
 251                ucontrol->value.integer.value, numcoef);
 252}
 253
 254static int tas571x_coefficient_put(struct snd_kcontrol *kcontrol,
 255                                  struct snd_ctl_elem_value *ucontrol)
 256{
 257        struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 258        struct i2c_client *i2c = to_i2c_client(component->dev);
 259        int numcoef = kcontrol->private_value >> 16;
 260        int index = kcontrol->private_value & 0xffff;
 261
 262        return tas571x_reg_write_multiword(i2c, index,
 263                ucontrol->value.integer.value, numcoef);
 264}
 265
 266static int tas571x_set_dai_fmt(struct snd_soc_dai *dai, unsigned int format)
 267{
 268        struct tas571x_private *priv = snd_soc_component_get_drvdata(dai->component);
 269
 270        priv->format = format;
 271
 272        return 0;
 273}
 274
 275static int tas571x_hw_params(struct snd_pcm_substream *substream,
 276                             struct snd_pcm_hw_params *params,
 277                             struct snd_soc_dai *dai)
 278{
 279        struct tas571x_private *priv = snd_soc_component_get_drvdata(dai->component);
 280        u32 val;
 281
 282        switch (priv->format & SND_SOC_DAIFMT_FORMAT_MASK) {
 283        case SND_SOC_DAIFMT_RIGHT_J:
 284                val = 0x00;
 285                break;
 286        case SND_SOC_DAIFMT_I2S:
 287                val = 0x03;
 288                break;
 289        case SND_SOC_DAIFMT_LEFT_J:
 290                val = 0x06;
 291                break;
 292        default:
 293                return -EINVAL;
 294        }
 295
 296        if (params_width(params) >= 24)
 297                val += 2;
 298        else if (params_width(params) >= 20)
 299                val += 1;
 300
 301        return regmap_update_bits(priv->regmap, TAS571X_SDI_REG,
 302                                  TAS571X_SDI_FMT_MASK, val);
 303}
 304
 305static int tas571x_mute(struct snd_soc_dai *dai, int mute)
 306{
 307        struct snd_soc_component *component = dai->component;
 308        u8 sysctl2;
 309        int ret;
 310
 311        sysctl2 = mute ? TAS571X_SYS_CTRL_2_SDN_MASK : 0;
 312
 313        ret = snd_soc_component_update_bits(component,
 314                            TAS571X_SYS_CTRL_2_REG,
 315                     TAS571X_SYS_CTRL_2_SDN_MASK,
 316                     sysctl2);
 317        usleep_range(1000, 2000);
 318
 319        return ret;
 320}
 321
 322static int tas571x_set_bias_level(struct snd_soc_component *component,
 323                                  enum snd_soc_bias_level level)
 324{
 325        struct tas571x_private *priv = snd_soc_component_get_drvdata(component);
 326        int ret;
 327
 328        switch (level) {
 329        case SND_SOC_BIAS_ON:
 330                break;
 331        case SND_SOC_BIAS_PREPARE:
 332                break;
 333        case SND_SOC_BIAS_STANDBY:
 334                if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {
 335                        if (!IS_ERR(priv->mclk)) {
 336                                ret = clk_prepare_enable(priv->mclk);
 337                                if (ret) {
 338                                        dev_err(component->dev,
 339                                                "Failed to enable master clock: %d\n",
 340                                                ret);
 341                                        return ret;
 342                                }
 343                        }
 344                }
 345                break;
 346        case SND_SOC_BIAS_OFF:
 347                if (!IS_ERR(priv->mclk))
 348                        clk_disable_unprepare(priv->mclk);
 349                break;
 350        }
 351
 352        return 0;
 353}
 354
 355static const struct snd_soc_dai_ops tas571x_dai_ops = {
 356        .set_fmt        = tas571x_set_dai_fmt,
 357        .hw_params      = tas571x_hw_params,
 358        .digital_mute   = tas571x_mute,
 359};
 360
 361
 362#define BIQUAD_COEFS(xname, reg) \
 363{       .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
 364        .info = tas571x_coefficient_info, \
 365        .get = tas571x_coefficient_get,\
 366        .put = tas571x_coefficient_put, \
 367        .access = SNDRV_CTL_ELEM_ACCESS_READWRITE, \
 368        .private_value = reg | (5 << 16) }
 369
 370static const char *const tas5711_supply_names[] = {
 371        "AVDD",
 372        "DVDD",
 373        "PVDD_A",
 374        "PVDD_B",
 375        "PVDD_C",
 376        "PVDD_D",
 377};
 378
 379static const DECLARE_TLV_DB_SCALE(tas5711_volume_tlv, -10350, 50, 1);
 380
 381static const struct snd_kcontrol_new tas5711_controls[] = {
 382        SOC_SINGLE_TLV("Master Volume",
 383                       TAS571X_MVOL_REG,
 384                       0, 0xff, 1, tas5711_volume_tlv),
 385        SOC_DOUBLE_R_TLV("Speaker Volume",
 386                         TAS571X_CH1_VOL_REG,
 387                         TAS571X_CH2_VOL_REG,
 388                         0, 0xff, 1, tas5711_volume_tlv),
 389        SOC_DOUBLE("Speaker Switch",
 390                   TAS571X_SOFT_MUTE_REG,
 391                   TAS571X_SOFT_MUTE_CH1_SHIFT, TAS571X_SOFT_MUTE_CH2_SHIFT,
 392                   1, 1),
 393};
 394
 395static const struct regmap_range tas571x_readonly_regs_range[] = {
 396        regmap_reg_range(TAS571X_CLK_CTRL_REG,  TAS571X_DEV_ID_REG),
 397};
 398
 399static const struct regmap_range tas571x_volatile_regs_range[] = {
 400        regmap_reg_range(TAS571X_CLK_CTRL_REG,  TAS571X_ERR_STATUS_REG),
 401        regmap_reg_range(TAS571X_OSC_TRIM_REG,  TAS571X_OSC_TRIM_REG),
 402};
 403
 404static const struct regmap_access_table tas571x_write_regs = {
 405        .no_ranges =    tas571x_readonly_regs_range,
 406        .n_no_ranges =  ARRAY_SIZE(tas571x_readonly_regs_range),
 407};
 408
 409static const struct regmap_access_table tas571x_volatile_regs = {
 410        .yes_ranges =   tas571x_volatile_regs_range,
 411        .n_yes_ranges = ARRAY_SIZE(tas571x_volatile_regs_range),
 412
 413};
 414
 415static const struct reg_default tas5711_reg_defaults[] = {
 416        { 0x04, 0x05 },
 417        { 0x05, 0x40 },
 418        { 0x06, 0x00 },
 419        { 0x07, 0xff },
 420        { 0x08, 0x30 },
 421        { 0x09, 0x30 },
 422        { 0x1b, 0x82 },
 423};
 424
 425static const struct regmap_config tas5711_regmap_config = {
 426        .reg_bits                       = 8,
 427        .val_bits                       = 32,
 428        .max_register                   = 0xff,
 429        .reg_read                       = tas571x_reg_read,
 430        .reg_write                      = tas571x_reg_write,
 431        .reg_defaults                   = tas5711_reg_defaults,
 432        .num_reg_defaults               = ARRAY_SIZE(tas5711_reg_defaults),
 433        .cache_type                     = REGCACHE_RBTREE,
 434        .wr_table                       = &tas571x_write_regs,
 435        .volatile_table                 = &tas571x_volatile_regs,
 436};
 437
 438static const struct tas571x_chip tas5711_chip = {
 439        .supply_names                   = tas5711_supply_names,
 440        .num_supply_names               = ARRAY_SIZE(tas5711_supply_names),
 441        .controls                       = tas5711_controls,
 442        .num_controls                   = ARRAY_SIZE(tas5711_controls),
 443        .regmap_config                  = &tas5711_regmap_config,
 444        .vol_reg_size                   = 1,
 445};
 446
 447static const char *const tas5717_supply_names[] = {
 448        "AVDD",
 449        "DVDD",
 450        "HPVDD",
 451        "PVDD_AB",
 452        "PVDD_CD",
 453};
 454
 455static const DECLARE_TLV_DB_SCALE(tas5717_volume_tlv, -10375, 25, 0);
 456
 457static const struct snd_kcontrol_new tas5717_controls[] = {
 458        /* MVOL LSB is ignored - see comments in tas571x_i2c_probe() */
 459        SOC_SINGLE_TLV("Master Volume",
 460                       TAS571X_MVOL_REG, 1, 0x1ff, 1,
 461                       tas5717_volume_tlv),
 462        SOC_DOUBLE_R_TLV("Speaker Volume",
 463                         TAS571X_CH1_VOL_REG, TAS571X_CH2_VOL_REG,
 464                         1, 0x1ff, 1, tas5717_volume_tlv),
 465        SOC_DOUBLE("Speaker Switch",
 466                   TAS571X_SOFT_MUTE_REG,
 467                   TAS571X_SOFT_MUTE_CH1_SHIFT, TAS571X_SOFT_MUTE_CH2_SHIFT,
 468                   1, 1),
 469
 470        SOC_DOUBLE_R_RANGE("CH1 Mixer Volume",
 471                           TAS5717_CH1_LEFT_CH_MIX_REG,
 472                           TAS5717_CH1_RIGHT_CH_MIX_REG,
 473                           16, 0, 0x80, 0),
 474
 475        SOC_DOUBLE_R_RANGE("CH2 Mixer Volume",
 476                           TAS5717_CH2_LEFT_CH_MIX_REG,
 477                           TAS5717_CH2_RIGHT_CH_MIX_REG,
 478                           16, 0, 0x80, 0),
 479
 480        /*
 481         * The biquads are named according to the register names.
 482         * Please note that TI's TAS57xx Graphical Development Environment
 483         * tool names them different.
 484         */
 485        BIQUAD_COEFS("CH1 - Biquad 0", TAS5717_CH1_BQ0_REG),
 486        BIQUAD_COEFS("CH1 - Biquad 1", TAS5717_CH1_BQ1_REG),
 487        BIQUAD_COEFS("CH1 - Biquad 2", TAS5717_CH1_BQ2_REG),
 488        BIQUAD_COEFS("CH1 - Biquad 3", TAS5717_CH1_BQ3_REG),
 489        BIQUAD_COEFS("CH1 - Biquad 4", TAS5717_CH1_BQ4_REG),
 490        BIQUAD_COEFS("CH1 - Biquad 5", TAS5717_CH1_BQ5_REG),
 491        BIQUAD_COEFS("CH1 - Biquad 6", TAS5717_CH1_BQ6_REG),
 492        BIQUAD_COEFS("CH1 - Biquad 7", TAS5717_CH1_BQ7_REG),
 493        BIQUAD_COEFS("CH1 - Biquad 8", TAS5717_CH1_BQ8_REG),
 494        BIQUAD_COEFS("CH1 - Biquad 9", TAS5717_CH1_BQ9_REG),
 495        BIQUAD_COEFS("CH1 - Biquad 10", TAS5717_CH1_BQ10_REG),
 496        BIQUAD_COEFS("CH1 - Biquad 11", TAS5717_CH1_BQ11_REG),
 497
 498        BIQUAD_COEFS("CH2 - Biquad 0", TAS5717_CH2_BQ0_REG),
 499        BIQUAD_COEFS("CH2 - Biquad 1", TAS5717_CH2_BQ1_REG),
 500        BIQUAD_COEFS("CH2 - Biquad 2", TAS5717_CH2_BQ2_REG),
 501        BIQUAD_COEFS("CH2 - Biquad 3", TAS5717_CH2_BQ3_REG),
 502        BIQUAD_COEFS("CH2 - Biquad 4", TAS5717_CH2_BQ4_REG),
 503        BIQUAD_COEFS("CH2 - Biquad 5", TAS5717_CH2_BQ5_REG),
 504        BIQUAD_COEFS("CH2 - Biquad 6", TAS5717_CH2_BQ6_REG),
 505        BIQUAD_COEFS("CH2 - Biquad 7", TAS5717_CH2_BQ7_REG),
 506        BIQUAD_COEFS("CH2 - Biquad 8", TAS5717_CH2_BQ8_REG),
 507        BIQUAD_COEFS("CH2 - Biquad 9", TAS5717_CH2_BQ9_REG),
 508        BIQUAD_COEFS("CH2 - Biquad 10", TAS5717_CH2_BQ10_REG),
 509        BIQUAD_COEFS("CH2 - Biquad 11", TAS5717_CH2_BQ11_REG),
 510
 511        BIQUAD_COEFS("CH3 - Biquad 0", TAS5717_CH3_BQ0_REG),
 512        BIQUAD_COEFS("CH3 - Biquad 1", TAS5717_CH3_BQ1_REG),
 513
 514        BIQUAD_COEFS("CH4 - Biquad 0", TAS5717_CH4_BQ0_REG),
 515        BIQUAD_COEFS("CH4 - Biquad 1", TAS5717_CH4_BQ1_REG),
 516};
 517
 518static const struct reg_default tas5717_reg_defaults[] = {
 519        { 0x04, 0x05 },
 520        { 0x05, 0x40 },
 521        { 0x06, 0x00 },
 522        { 0x07, 0x03ff },
 523        { 0x08, 0x00c0 },
 524        { 0x09, 0x00c0 },
 525        { 0x1b, 0x82 },
 526        { TAS5717_CH1_RIGHT_CH_MIX_REG, 0x0 },
 527        { TAS5717_CH1_LEFT_CH_MIX_REG, 0x800000},
 528        { TAS5717_CH2_LEFT_CH_MIX_REG, 0x0 },
 529        { TAS5717_CH2_RIGHT_CH_MIX_REG, 0x800000},
 530};
 531
 532static const struct regmap_config tas5717_regmap_config = {
 533        .reg_bits                       = 8,
 534        .val_bits                       = 32,
 535        .max_register                   = 0xff,
 536        .reg_read                       = tas571x_reg_read,
 537        .reg_write                      = tas571x_reg_write,
 538        .reg_defaults                   = tas5717_reg_defaults,
 539        .num_reg_defaults               = ARRAY_SIZE(tas5717_reg_defaults),
 540        .cache_type                     = REGCACHE_RBTREE,
 541        .wr_table                       = &tas571x_write_regs,
 542        .volatile_table                 = &tas571x_volatile_regs,
 543};
 544
 545/* This entry is reused for tas5719 as the software interface is identical. */
 546static const struct tas571x_chip tas5717_chip = {
 547        .supply_names                   = tas5717_supply_names,
 548        .num_supply_names               = ARRAY_SIZE(tas5717_supply_names),
 549        .controls                       = tas5717_controls,
 550        .num_controls                   = ARRAY_SIZE(tas5717_controls),
 551        .regmap_config                  = &tas5717_regmap_config,
 552        .vol_reg_size                   = 2,
 553};
 554
 555static const char *const tas5721_supply_names[] = {
 556        "AVDD",
 557        "DVDD",
 558        "DRVDD",
 559        "PVDD",
 560};
 561
 562static const struct snd_kcontrol_new tas5721_controls[] = {
 563        SOC_SINGLE_TLV("Master Volume",
 564                       TAS571X_MVOL_REG,
 565                       0, 0xff, 1, tas5711_volume_tlv),
 566        SOC_DOUBLE_R_TLV("Speaker Volume",
 567                         TAS571X_CH1_VOL_REG,
 568                         TAS571X_CH2_VOL_REG,
 569                         0, 0xff, 1, tas5711_volume_tlv),
 570        SOC_DOUBLE("Speaker Switch",
 571                   TAS571X_SOFT_MUTE_REG,
 572                   TAS571X_SOFT_MUTE_CH1_SHIFT, TAS571X_SOFT_MUTE_CH2_SHIFT,
 573                   1, 1),
 574};
 575
 576static const struct reg_default tas5721_reg_defaults[] = {
 577        {TAS571X_CLK_CTRL_REG,          0x6c},
 578        {TAS571X_DEV_ID_REG,            0x00},
 579        {TAS571X_ERR_STATUS_REG,        0x00},
 580        {TAS571X_SYS_CTRL_1_REG,        0xa0},
 581        {TAS571X_SDI_REG,               0x05},
 582        {TAS571X_SYS_CTRL_2_REG,        0x40},
 583        {TAS571X_SOFT_MUTE_REG,         0x00},
 584        {TAS571X_MVOL_REG,              0xff},
 585        {TAS571X_CH1_VOL_REG,           0x30},
 586        {TAS571X_CH2_VOL_REG,           0x30},
 587        {TAS571X_CH3_VOL_REG,           0x30},
 588        {TAS571X_VOL_CFG_REG,           0x91},
 589        {TAS571X_MODULATION_LIMIT_REG,  0x02},
 590        {TAS571X_IC_DELAY_CH1_REG,      0xac},
 591        {TAS571X_IC_DELAY_CH2_REG,      0x54},
 592        {TAS571X_IC_DELAY_CH3_REG,      0xac},
 593        {TAS571X_IC_DELAY_CH4_REG,      0x54},
 594        {TAS571X_PWM_CH_SDN_GROUP_REG,  0x30},
 595        {TAS571X_START_STOP_PERIOD_REG, 0x0f},
 596        {TAS571X_OSC_TRIM_REG,          0x82},
 597        {TAS571X_BKND_ERR_REG,          0x02},
 598        {TAS571X_INPUT_MUX_REG,         0x17772},
 599        {TAS571X_CH4_SRC_SELECT_REG,    0x4303},
 600        {TAS571X_PWM_MUX_REG,           0x1021345},
 601};
 602
 603static const struct regmap_config tas5721_regmap_config = {
 604        .reg_bits                       = 8,
 605        .val_bits                       = 32,
 606        .max_register                   = 0xff,
 607        .reg_read                       = tas571x_reg_read,
 608        .reg_write                      = tas571x_reg_write,
 609        .reg_defaults                   = tas5721_reg_defaults,
 610        .num_reg_defaults               = ARRAY_SIZE(tas5721_reg_defaults),
 611        .cache_type                     = REGCACHE_RBTREE,
 612        .wr_table                       = &tas571x_write_regs,
 613        .volatile_table                 = &tas571x_volatile_regs,
 614};
 615
 616
 617static const struct tas571x_chip tas5721_chip = {
 618        .supply_names                   = tas5721_supply_names,
 619        .num_supply_names               = ARRAY_SIZE(tas5721_supply_names),
 620        .controls                       = tas5711_controls,
 621        .num_controls                   = ARRAY_SIZE(tas5711_controls),
 622        .regmap_config                  = &tas5721_regmap_config,
 623        .vol_reg_size                   = 1,
 624};
 625
 626static const struct snd_soc_dapm_widget tas571x_dapm_widgets[] = {
 627        SND_SOC_DAPM_DAC("DACL", NULL, SND_SOC_NOPM, 0, 0),
 628        SND_SOC_DAPM_DAC("DACR", NULL, SND_SOC_NOPM, 0, 0),
 629
 630        SND_SOC_DAPM_OUTPUT("OUT_A"),
 631        SND_SOC_DAPM_OUTPUT("OUT_B"),
 632        SND_SOC_DAPM_OUTPUT("OUT_C"),
 633        SND_SOC_DAPM_OUTPUT("OUT_D"),
 634};
 635
 636static const struct snd_soc_dapm_route tas571x_dapm_routes[] = {
 637        { "DACL",  NULL, "Playback" },
 638        { "DACR",  NULL, "Playback" },
 639
 640        { "OUT_A", NULL, "DACL" },
 641        { "OUT_B", NULL, "DACL" },
 642        { "OUT_C", NULL, "DACR" },
 643        { "OUT_D", NULL, "DACR" },
 644};
 645
 646static const struct snd_soc_component_driver tas571x_component = {
 647        .set_bias_level         = tas571x_set_bias_level,
 648        .dapm_widgets           = tas571x_dapm_widgets,
 649        .num_dapm_widgets       = ARRAY_SIZE(tas571x_dapm_widgets),
 650        .dapm_routes            = tas571x_dapm_routes,
 651        .num_dapm_routes        = ARRAY_SIZE(tas571x_dapm_routes),
 652        .use_pmdown_time        = 1,
 653        .endianness             = 1,
 654        .non_legacy_dai_naming  = 1,
 655};
 656
 657static struct snd_soc_dai_driver tas571x_dai = {
 658        .name = "tas571x-hifi",
 659        .playback = {
 660                .stream_name = "Playback",
 661                .channels_min = 2,
 662                .channels_max = 2,
 663                .rates = SNDRV_PCM_RATE_8000_48000,
 664                .formats = SNDRV_PCM_FMTBIT_S32_LE |
 665                           SNDRV_PCM_FMTBIT_S24_LE |
 666                           SNDRV_PCM_FMTBIT_S16_LE,
 667        },
 668        .ops = &tas571x_dai_ops,
 669};
 670
 671static const struct of_device_id tas571x_of_match[];
 672
 673static int tas571x_i2c_probe(struct i2c_client *client,
 674                             const struct i2c_device_id *id)
 675{
 676        struct tas571x_private *priv;
 677        struct device *dev = &client->dev;
 678        const struct of_device_id *of_id;
 679        int i, ret;
 680
 681        priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
 682        if (!priv)
 683                return -ENOMEM;
 684        i2c_set_clientdata(client, priv);
 685
 686        of_id = of_match_device(tas571x_of_match, dev);
 687        if (of_id)
 688                priv->chip = of_id->data;
 689        else
 690                priv->chip = (void *) id->driver_data;
 691
 692        priv->mclk = devm_clk_get(dev, "mclk");
 693        if (IS_ERR(priv->mclk) && PTR_ERR(priv->mclk) != -ENOENT) {
 694                dev_err(dev, "Failed to request mclk: %ld\n",
 695                        PTR_ERR(priv->mclk));
 696                return PTR_ERR(priv->mclk);
 697        }
 698
 699        if (WARN_ON(priv->chip->num_supply_names > TAS571X_MAX_SUPPLIES))
 700                return -EINVAL;
 701        for (i = 0; i < priv->chip->num_supply_names; i++)
 702                priv->supplies[i].supply = priv->chip->supply_names[i];
 703
 704        ret = devm_regulator_bulk_get(dev, priv->chip->num_supply_names,
 705                                      priv->supplies);
 706        if (ret) {
 707                dev_err(dev, "Failed to get supplies: %d\n", ret);
 708                return ret;
 709        }
 710        ret = regulator_bulk_enable(priv->chip->num_supply_names,
 711                                    priv->supplies);
 712        if (ret) {
 713                dev_err(dev, "Failed to enable supplies: %d\n", ret);
 714                return ret;
 715        }
 716
 717        priv->regmap = devm_regmap_init(dev, NULL, client,
 718                                        priv->chip->regmap_config);
 719        if (IS_ERR(priv->regmap))
 720                return PTR_ERR(priv->regmap);
 721
 722        priv->pdn_gpio = devm_gpiod_get_optional(dev, "pdn", GPIOD_OUT_LOW);
 723        if (IS_ERR(priv->pdn_gpio)) {
 724                dev_err(dev, "error requesting pdn_gpio: %ld\n",
 725                        PTR_ERR(priv->pdn_gpio));
 726                return PTR_ERR(priv->pdn_gpio);
 727        }
 728
 729        priv->reset_gpio = devm_gpiod_get_optional(dev, "reset",
 730                                                   GPIOD_OUT_HIGH);
 731        if (IS_ERR(priv->reset_gpio)) {
 732                dev_err(dev, "error requesting reset_gpio: %ld\n",
 733                        PTR_ERR(priv->reset_gpio));
 734                return PTR_ERR(priv->reset_gpio);
 735        } else if (priv->reset_gpio) {
 736                /* pulse the active low reset line for ~100us */
 737                usleep_range(100, 200);
 738                gpiod_set_value(priv->reset_gpio, 0);
 739                usleep_range(13500, 20000);
 740        }
 741
 742        ret = regmap_write(priv->regmap, TAS571X_OSC_TRIM_REG, 0);
 743        if (ret)
 744                return ret;
 745
 746        usleep_range(50000, 60000);
 747
 748        memcpy(&priv->component_driver, &tas571x_component, sizeof(priv->component_driver));
 749        priv->component_driver.controls = priv->chip->controls;
 750        priv->component_driver.num_controls = priv->chip->num_controls;
 751
 752        if (priv->chip->vol_reg_size == 2) {
 753                /*
 754                 * The master volume defaults to 0x3ff (mute), but we ignore
 755                 * (zero) the LSB because the hardware step size is 0.125 dB
 756                 * and TLV_DB_SCALE_ITEM has a resolution of 0.01 dB.
 757                 */
 758                ret = regmap_update_bits(priv->regmap, TAS571X_MVOL_REG, 1, 0);
 759                if (ret)
 760                        return ret;
 761        }
 762
 763        return devm_snd_soc_register_component(&client->dev,
 764                                      &priv->component_driver,
 765                                      &tas571x_dai, 1);
 766}
 767
 768static int tas571x_i2c_remove(struct i2c_client *client)
 769{
 770        struct tas571x_private *priv = i2c_get_clientdata(client);
 771
 772        regulator_bulk_disable(priv->chip->num_supply_names, priv->supplies);
 773
 774        return 0;
 775}
 776
 777static const struct of_device_id tas571x_of_match[] = {
 778        { .compatible = "ti,tas5711", .data = &tas5711_chip, },
 779        { .compatible = "ti,tas5717", .data = &tas5717_chip, },
 780        { .compatible = "ti,tas5719", .data = &tas5717_chip, },
 781        { .compatible = "ti,tas5721", .data = &tas5721_chip, },
 782        { }
 783};
 784MODULE_DEVICE_TABLE(of, tas571x_of_match);
 785
 786static const struct i2c_device_id tas571x_i2c_id[] = {
 787        { "tas5711", (kernel_ulong_t) &tas5711_chip },
 788        { "tas5717", (kernel_ulong_t) &tas5717_chip },
 789        { "tas5719", (kernel_ulong_t) &tas5717_chip },
 790        { "tas5721", (kernel_ulong_t) &tas5721_chip },
 791        { }
 792};
 793MODULE_DEVICE_TABLE(i2c, tas571x_i2c_id);
 794
 795static struct i2c_driver tas571x_i2c_driver = {
 796        .driver = {
 797                .name = "tas571x",
 798                .of_match_table = of_match_ptr(tas571x_of_match),
 799        },
 800        .probe = tas571x_i2c_probe,
 801        .remove = tas571x_i2c_remove,
 802        .id_table = tas571x_i2c_id,
 803};
 804module_i2c_driver(tas571x_i2c_driver);
 805
 806MODULE_DESCRIPTION("ASoC TAS571x driver");
 807MODULE_AUTHOR("Kevin Cernekee <cernekee@chromium.org>");
 808MODULE_LICENSE("GPL");
 809