cregit-Linux how code gets into the kernel

Release 4.7 sound/soc/codecs/tas571x.c

Directory: sound/soc/codecs
/*
 * TAS571x amplifier audio driver
 *
 * Copyright (C) 2015 Google, Inc.
 * Copyright (c) 2013 Daniel Mack <zonque@gmail.com>
 *
 * TAS5721 support:
 * Copyright (C) 2016 Petr Kulhavy, Barix AG <petr@barix.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 */

#include <linux/clk.h>
#include <linux/delay.h>
#include <linux/device.h>
#include <linux/gpio/consumer.h>
#include <linux/i2c.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/of_device.h>
#include <linux/regmap.h>
#include <linux/regulator/consumer.h>
#include <linux/stddef.h>
#include <sound/pcm_params.h>
#include <sound/soc.h>
#include <sound/tlv.h>

#include "tas571x.h"


#define TAS571X_MAX_SUPPLIES		6


struct tas571x_chip {
	
const char			*const *supply_names;
	
int				num_supply_names;
	
const struct snd_kcontrol_new	*controls;
	
int				num_controls;
	
const struct regmap_config	*regmap_config;
	
int				vol_reg_size;
};


struct tas571x_private {
	
const struct tas571x_chip	*chip;
	
struct regmap			*regmap;
	
struct regulator_bulk_data	supplies[TAS571X_MAX_SUPPLIES];
	
struct clk			*mclk;
	
unsigned int			format;
	
struct gpio_desc		*reset_gpio;
	
struct gpio_desc		*pdn_gpio;
	
struct snd_soc_codec_driver	codec_driver;
};


static int tas571x_register_size(struct tas571x_private *priv, unsigned int reg) { switch (reg) { case TAS571X_MVOL_REG: case TAS571X_CH1_VOL_REG: case TAS571X_CH2_VOL_REG: return priv->chip->vol_reg_size; case TAS571X_INPUT_MUX_REG: case TAS571X_CH4_SRC_SELECT_REG: case TAS571X_PWM_MUX_REG: return 4; default: return 1; } }

Contributors

PersonTokensPropCommitsCommitProp
kevin cernekeekevin cernekee4177.36%150.00%
petr kulhavypetr kulhavy1222.64%150.00%
Total53100.00%2100.00%


static int tas571x_reg_write(void *context, unsigned int reg, unsigned int value) { struct i2c_client *client = context; struct tas571x_private *priv = i2c_get_clientdata(client); unsigned int i, size; uint8_t buf[5]; int ret; size = tas571x_register_size(priv, reg); buf[0] = reg; for (i = size; i >= 1; --i) { buf[i] = value; value >>= 8; } ret = i2c_master_send(client, buf, size + 1); if (ret == size + 1) return 0; else if (ret < 0) return ret; else return -EIO; }

Contributors

PersonTokensPropCommitsCommitProp
kevin cernekeekevin cernekee131100.00%1100.00%
Total131100.00%1100.00%


static int tas571x_reg_read(void *context, unsigned int reg, unsigned int *value) { struct i2c_client *client = context; struct tas571x_private *priv = i2c_get_clientdata(client); uint8_t send_buf, recv_buf[4]; struct i2c_msg msgs[2]; unsigned int size; unsigned int i; int ret; size = tas571x_register_size(priv, reg); send_buf = reg; msgs[0].addr = client->addr; msgs[0].len = sizeof(send_buf); msgs[0].buf = &send_buf; msgs[0].flags = 0; msgs[1].addr = client->addr; msgs[1].len = size; msgs[1].buf = recv_buf; msgs[1].flags = I2C_M_RD; ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs)); if (ret < 0) return ret; else if (ret != ARRAY_SIZE(msgs)) return -EIO; *value = 0; for (i = 0; i < size; i++) { *value <<= 8; *value |= recv_buf[i]; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
kevin cernekeekevin cernekee230100.00%1100.00%
Total230100.00%1100.00%


static int tas571x_set_dai_fmt(struct snd_soc_dai *dai, unsigned int format) { struct tas571x_private *priv = snd_soc_codec_get_drvdata(dai->codec); priv->format = format; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
kevin cernekeekevin cernekee36100.00%1100.00%
Total36100.00%1100.00%


static int tas571x_hw_params(struct snd_pcm_substream *substream, struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) { struct tas571x_private *priv = snd_soc_codec_get_drvdata(dai->codec); u32 val; switch (priv->format & SND_SOC_DAIFMT_FORMAT_MASK) { case SND_SOC_DAIFMT_RIGHT_J: val = 0x00; break; case SND_SOC_DAIFMT_I2S: val = 0x03; break; case SND_SOC_DAIFMT_LEFT_J: val = 0x06; break; default: return -EINVAL; } if (params_width(params) >= 24) val += 2; else if (params_width(params) >= 20) val += 1; return regmap_update_bits(priv->regmap, TAS571X_SDI_REG, TAS571X_SDI_FMT_MASK, val); }

Contributors

PersonTokensPropCommitsCommitProp
kevin cernekeekevin cernekee116100.00%1100.00%
Total116100.00%1100.00%


static int tas571x_mute(struct snd_soc_dai *dai, int mute) { struct snd_soc_codec *codec = dai->codec; u8 sysctl2; int ret; sysctl2 = mute ? TAS571X_SYS_CTRL_2_SDN_MASK : 0; ret = snd_soc_update_bits(codec, TAS571X_SYS_CTRL_2_REG, TAS571X_SYS_CTRL_2_SDN_MASK, sysctl2); usleep_range(1000, 2000); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
petr kulhavypetr kulhavy60100.00%1100.00%
Total60100.00%1100.00%


static int tas571x_set_bias_level(struct snd_soc_codec *codec, enum snd_soc_bias_level level) { struct tas571x_private *priv = snd_soc_codec_get_drvdata(codec); int ret; switch (level) { case SND_SOC_BIAS_ON: break; case SND_SOC_BIAS_PREPARE: break; case SND_SOC_BIAS_STANDBY: if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_OFF) { if (!IS_ERR(priv->mclk)) { ret = clk_prepare_enable(priv->mclk); if (ret) { dev_err(codec->dev, "Failed to enable master clock: %d\n", ret); return ret; } } gpiod_set_value(priv->pdn_gpio, 0); usleep_range(5000, 6000); regcache_cache_only(priv->regmap, false); ret = regcache_sync(priv->regmap); if (ret) return ret; } break; case SND_SOC_BIAS_OFF: regcache_cache_only(priv->regmap, true); gpiod_set_value(priv->pdn_gpio, 1); if (!IS_ERR(priv->mclk)) clk_disable_unprepare(priv->mclk); break; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
kevin cernekeekevin cernekee17898.34%150.00%
lars-peter clausenlars-peter clausen31.66%150.00%
Total181100.00%2100.00%

static const struct snd_soc_dai_ops tas571x_dai_ops = { .set_fmt = tas571x_set_dai_fmt, .hw_params = tas571x_hw_params, .digital_mute = tas571x_mute, }; static const char *const tas5711_supply_names[] = { "AVDD", "DVDD", "PVDD_A", "PVDD_B", "PVDD_C", "PVDD_D", }; static const DECLARE_TLV_DB_SCALE(tas5711_volume_tlv, -10350, 50, 1); static const struct snd_kcontrol_new tas5711_controls[] = { SOC_SINGLE_TLV("Master Volume", TAS571X_MVOL_REG, 0, 0xff, 1, tas5711_volume_tlv), SOC_DOUBLE_R_TLV("Speaker Volume", TAS571X_CH1_VOL_REG, TAS571X_CH2_VOL_REG, 0, 0xff, 1, tas5711_volume_tlv), SOC_DOUBLE("Speaker Switch", TAS571X_SOFT_MUTE_REG, TAS571X_SOFT_MUTE_CH1_SHIFT, TAS571X_SOFT_MUTE_CH2_SHIFT, 1, 1), }; static const struct regmap_range tas571x_readonly_regs_range[] = { regmap_reg_range(TAS571X_CLK_CTRL_REG, TAS571X_DEV_ID_REG), }; static const struct regmap_range tas571x_volatile_regs_range[] = { regmap_reg_range(TAS571X_CLK_CTRL_REG, TAS571X_ERR_STATUS_REG), regmap_reg_range(TAS571X_OSC_TRIM_REG, TAS571X_OSC_TRIM_REG), }; static const struct regmap_access_table tas571x_write_regs = { .no_ranges = tas571x_readonly_regs_range, .n_no_ranges = ARRAY_SIZE(tas571x_readonly_regs_range), }; static const struct regmap_access_table tas571x_volatile_regs = { .yes_ranges = tas571x_volatile_regs_range, .n_yes_ranges = ARRAY_SIZE(tas571x_volatile_regs_range), }; static const struct reg_default tas5711_reg_defaults[] = { { 0x04, 0x05 }, { 0x05, 0x40 }, { 0x06, 0x00 }, { 0x07, 0xff }, { 0x08, 0x30 }, { 0x09, 0x30 }, { 0x1b, 0x82 }, }; static const struct regmap_config tas5711_regmap_config = { .reg_bits = 8, .val_bits = 32, .max_register = 0xff, .reg_read = tas571x_reg_read, .reg_write = tas571x_reg_write, .reg_defaults = tas5711_reg_defaults, .num_reg_defaults = ARRAY_SIZE(tas5711_reg_defaults), .cache_type = REGCACHE_RBTREE, .wr_table = &tas571x_write_regs, .volatile_table = &tas571x_volatile_regs, }; static const struct tas571x_chip tas5711_chip = { .supply_names = tas5711_supply_names, .num_supply_names = ARRAY_SIZE(tas5711_supply_names), .controls = tas5711_controls, .num_controls = ARRAY_SIZE(tas5711_controls), .regmap_config = &tas5711_regmap_config, .vol_reg_size = 1, }; static const char *const tas5717_supply_names[] = { "AVDD", "DVDD", "HPVDD", "PVDD_AB", "PVDD_CD", }; static const DECLARE_TLV_DB_SCALE(tas5717_volume_tlv, -10375, 25, 0); static const struct snd_kcontrol_new tas5717_controls[] = { /* MVOL LSB is ignored - see comments in tas571x_i2c_probe() */ SOC_SINGLE_TLV("Master Volume", TAS571X_MVOL_REG, 1, 0x1ff, 1, tas5717_volume_tlv), SOC_DOUBLE_R_TLV("Speaker Volume", TAS571X_CH1_VOL_REG, TAS571X_CH2_VOL_REG, 1, 0x1ff, 1, tas5717_volume_tlv), SOC_DOUBLE("Speaker Switch", TAS571X_SOFT_MUTE_REG, TAS571X_SOFT_MUTE_CH1_SHIFT, TAS571X_SOFT_MUTE_CH2_SHIFT, 1, 1), }; static const struct reg_default tas5717_reg_defaults[] = { { 0x04, 0x05 }, { 0x05, 0x40 }, { 0x06, 0x00 }, { 0x07, 0x03ff }, { 0x08, 0x00c0 }, { 0x09, 0x00c0 }, { 0x1b, 0x82 }, }; static const struct regmap_config tas5717_regmap_config = { .reg_bits = 8, .val_bits = 32, .max_register = 0xff, .reg_read = tas571x_reg_read, .reg_write = tas571x_reg_write, .reg_defaults = tas5717_reg_defaults, .num_reg_defaults = ARRAY_SIZE(tas5717_reg_defaults), .cache_type = REGCACHE_RBTREE, .wr_table = &tas571x_write_regs, .volatile_table = &tas571x_volatile_regs, }; /* This entry is reused for tas5719 as the software interface is identical. */ static const struct tas571x_chip tas5717_chip = { .supply_names = tas5717_supply_names, .num_supply_names = ARRAY_SIZE(tas5717_supply_names), .controls = tas5717_controls, .num_controls = ARRAY_SIZE(tas5717_controls), .regmap_config = &tas5717_regmap_config, .vol_reg_size = 2, }; static const char *const tas5721_supply_names[] = { "AVDD", "DVDD", "DRVDD", "PVDD", }; static const struct snd_kcontrol_new tas5721_controls[] = { SOC_SINGLE_TLV("Master Volume", TAS571X_MVOL_REG, 0, 0xff, 1, tas5711_volume_tlv), SOC_DOUBLE_R_TLV("Speaker Volume", TAS571X_CH1_VOL_REG, TAS571X_CH2_VOL_REG, 0, 0xff, 1, tas5711_volume_tlv), SOC_DOUBLE("Speaker Switch", TAS571X_SOFT_MUTE_REG, TAS571X_SOFT_MUTE_CH1_SHIFT, TAS571X_SOFT_MUTE_CH2_SHIFT, 1, 1), }; static const struct reg_default tas5721_reg_defaults[] = { {TAS571X_CLK_CTRL_REG, 0x6c}, {TAS571X_DEV_ID_REG, 0x00}, {TAS571X_ERR_STATUS_REG, 0x00}, {TAS571X_SYS_CTRL_1_REG, 0xa0}, {TAS571X_SDI_REG, 0x05}, {TAS571X_SYS_CTRL_2_REG, 0x40}, {TAS571X_SOFT_MUTE_REG, 0x00}, {TAS571X_MVOL_REG, 0xff}, {TAS571X_CH1_VOL_REG, 0x30}, {TAS571X_CH2_VOL_REG, 0x30}, {TAS571X_CH3_VOL_REG, 0x30}, {TAS571X_VOL_CFG_REG, 0x91}, {TAS571X_MODULATION_LIMIT_REG, 0x02}, {TAS571X_IC_DELAY_CH1_REG, 0xac}, {TAS571X_IC_DELAY_CH2_REG, 0x54}, {TAS571X_IC_DELAY_CH3_REG, 0xac}, {TAS571X_IC_DELAY_CH4_REG, 0x54}, {TAS571X_PWM_CH_SDN_GROUP_REG, 0x30}, {TAS571X_START_STOP_PERIOD_REG, 0x0f}, {TAS571X_OSC_TRIM_REG, 0x82}, {TAS571X_BKND_ERR_REG, 0x02}, {TAS571X_INPUT_MUX_REG, 0x17772}, {TAS571X_CH4_SRC_SELECT_REG, 0x4303}, {TAS571X_PWM_MUX_REG, 0x1021345}, }; static const struct regmap_config tas5721_regmap_config = { .reg_bits = 8, .val_bits = 32, .max_register = 0xff, .reg_read = tas571x_reg_read, .reg_write = tas571x_reg_write, .reg_defaults = tas5721_reg_defaults, .num_reg_defaults = ARRAY_SIZE(tas5721_reg_defaults), .cache_type = REGCACHE_RBTREE, .wr_table = &tas571x_write_regs, .volatile_table = &tas571x_volatile_regs, }; static const struct tas571x_chip tas5721_chip = { .supply_names = tas5721_supply_names, .num_supply_names = ARRAY_SIZE(tas5721_supply_names), .controls = tas5711_controls, .num_controls = ARRAY_SIZE(tas5711_controls), .regmap_config = &tas5721_regmap_config, .vol_reg_size = 1, }; static const struct snd_soc_dapm_widget tas571x_dapm_widgets[] = { SND_SOC_DAPM_DAC("DACL", NULL, SND_SOC_NOPM, 0, 0), SND_SOC_DAPM_DAC("DACR", NULL, SND_SOC_NOPM, 0, 0), SND_SOC_DAPM_OUTPUT("OUT_A"), SND_SOC_DAPM_OUTPUT("OUT_B"), SND_SOC_DAPM_OUTPUT("OUT_C"), SND_SOC_DAPM_OUTPUT("OUT_D"), }; static const struct snd_soc_dapm_route tas571x_dapm_routes[] = { { "DACL", NULL, "Playback" }, { "DACR", NULL, "Playback" }, { "OUT_A", NULL, "DACL" }, { "OUT_B", NULL, "DACL" }, { "OUT_C", NULL, "DACR" }, { "OUT_D", NULL, "DACR" }, }; static const struct snd_soc_codec_driver tas571x_codec = { .set_bias_level = tas571x_set_bias_level, .idle_bias_off = true, .dapm_widgets = tas571x_dapm_widgets, .num_dapm_widgets = ARRAY_SIZE(tas571x_dapm_widgets), .dapm_routes = tas571x_dapm_routes, .num_dapm_routes = ARRAY_SIZE(tas571x_dapm_routes), }; static struct snd_soc_dai_driver tas571x_dai = { .name = "tas571x-hifi", .playback = { .stream_name = "Playback", .channels_min = 2, .channels_max = 2, .rates = SNDRV_PCM_RATE_8000_48000, .formats = SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE, }, .ops = &tas571x_dai_ops, }; static const struct of_device_id tas571x_of_match[];
static int tas571x_i2c_probe(struct i2c_client *client, const struct i2c_device_id *id) { struct tas571x_private *priv; struct device *dev = &client->dev; const struct of_device_id *of_id; int i, ret; priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); if (!priv) return -ENOMEM; i2c_set_clientdata(client, priv); of_id = of_match_device(tas571x_of_match, dev); if (of_id) priv->chip = of_id->data; else priv->chip = (void *) id->driver_data; priv->mclk = devm_clk_get(dev, "mclk"); if (IS_ERR(priv->mclk) && PTR_ERR(priv->mclk) != -ENOENT) { dev_err(dev, "Failed to request mclk: %ld\n", PTR_ERR(priv->mclk)); return PTR_ERR(priv->mclk); } BUG_ON(priv->chip->num_supply_names > TAS571X_MAX_SUPPLIES); for (i = 0; i < priv->chip->num_supply_names; i++) priv->supplies[i].supply = priv->chip->supply_names[i]; ret = devm_regulator_bulk_get(dev, priv->chip->num_supply_names, priv->supplies); if (ret) { dev_err(dev, "Failed to get supplies: %d\n", ret); return ret; } ret = regulator_bulk_enable(priv->chip->num_supply_names, priv->supplies); if (ret) { dev_err(dev, "Failed to enable supplies: %d\n", ret); return ret; } priv->regmap = devm_regmap_init(dev, NULL, client, priv->chip->regmap_config); if (IS_ERR(priv->regmap)) return PTR_ERR(priv->regmap); priv->pdn_gpio = devm_gpiod_get_optional(dev, "pdn", GPIOD_OUT_LOW); if (IS_ERR(priv->pdn_gpio)) { dev_err(dev, "error requesting pdn_gpio: %ld\n", PTR_ERR(priv->pdn_gpio)); return PTR_ERR(priv->pdn_gpio); } priv->reset_gpio = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_HIGH); if (IS_ERR(priv->reset_gpio)) { dev_err(dev, "error requesting reset_gpio: %ld\n", PTR_ERR(priv->reset_gpio)); return PTR_ERR(priv->reset_gpio); } else if (priv->reset_gpio) { /* pulse the active low reset line for ~100us */ usleep_range(100, 200); gpiod_set_value(priv->reset_gpio, 0); usleep_range(12000, 20000); } ret = regmap_write(priv->regmap, TAS571X_OSC_TRIM_REG, 0); if (ret) return ret; memcpy(&priv->codec_driver, &tas571x_codec, sizeof(priv->codec_driver)); priv->codec_driver.controls = priv->chip->controls; priv->codec_driver.num_controls = priv->chip->num_controls; if (priv->chip->vol_reg_size == 2) { /* * The master volume defaults to 0x3ff (mute), but we ignore * (zero) the LSB because the hardware step size is 0.125 dB * and TLV_DB_SCALE_ITEM has a resolution of 0.01 dB. */ ret = regmap_update_bits(priv->regmap, TAS571X_MVOL_REG, 1, 0); if (ret) return ret; } regcache_cache_only(priv->regmap, true); gpiod_set_value(priv->pdn_gpio, 1); return snd_soc_register_codec(&client->dev, &priv->codec_driver, &tas571x_dai, 1); }

Contributors

PersonTokensPropCommitsCommitProp
kevin cernekeekevin cernekee55897.72%266.67%
petr kulhavypetr kulhavy132.28%133.33%
Total571100.00%3100.00%


static int tas571x_i2c_remove(struct i2c_client *client) { struct tas571x_private *priv = i2c_get_clientdata(client); snd_soc_unregister_codec(&client->dev); regulator_bulk_disable(priv->chip->num_supply_names, priv->supplies); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
kevin cernekeekevin cernekee45100.00%1100.00%
Total45100.00%1100.00%

static const struct of_device_id tas571x_of_match[] = { { .compatible = "ti,tas5711", .data = &tas5711_chip, }, { .compatible = "ti,tas5717", .data = &tas5717_chip, }, { .compatible = "ti,tas5719", .data = &tas5717_chip, }, { .compatible = "ti,tas5721", .data = &tas5721_chip, }, { } }; MODULE_DEVICE_TABLE(of, tas571x_of_match); static const struct i2c_device_id tas571x_i2c_id[] = { { "tas5711", (kernel_ulong_t) &tas5711_chip }, { "tas5717", (kernel_ulong_t) &tas5717_chip }, { "tas5719", (kernel_ulong_t) &tas5717_chip }, { "tas5721", (kernel_ulong_t) &tas5721_chip }, { } }; MODULE_DEVICE_TABLE(i2c, tas571x_i2c_id); static struct i2c_driver tas571x_i2c_driver = { .driver = { .name = "tas571x", .of_match_table = of_match_ptr(tas571x_of_match), }, .probe = tas571x_i2c_probe, .remove = tas571x_i2c_remove, .id_table = tas571x_i2c_id, }; module_i2c_driver(tas571x_i2c_driver); MODULE_DESCRIPTION("ASoC TAS571x driver"); MODULE_AUTHOR("Kevin Cernekee <cernekee@chromium.org>"); MODULE_LICENSE("GPL");

Overall Contributors

PersonTokensPropCommitsCommitProp
kevin cernekeekevin cernekee232780.27%228.57%
petr kulhavypetr kulhavy56919.63%457.14%
lars-peter clausenlars-peter clausen30.10%114.29%
Total2899100.00%7100.00%
Directory: sound/soc/codecs
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
{% endraw %}