mirror of
git://nv-tegra.nvidia.com/linux-nv-oot.git
synced 2025-12-22 17:25:35 +03:00
ASoC: tegra-alt: re-organize XBAR code
XBAR related code is currently put under source files "tegra210_xbar_alt.c" and "tegra210_xbar_utils_alt.c". For upstream we are planning to use a single source file. Thus code in downstream is re-organized so that all XBAR code is moved under a single file. Following is the summary of changes, * All XBAR specific code is moved under, "tegra210_xbar_alt.c" and "tegra210_xbar_alt.h" * Only common code, which is required for other modules, remains in "tegra210_xbar_utils_alt.c" * unused macros or functions are removed Bug 200503387 Change-Id: I11cb93d3cdc07e14ef2e0b3b23ba6a98020a0373 Signed-off-by: Sameer Pujar <spujar@nvidia.com> Reviewed-on: https://git-master.nvidia.com/r/2265584 GVS: Gerrit_Virtual_Submit Reviewed-by: Dara Ramesh <dramesh@nvidia.com> Reviewed-by: Sharad Gupta <sharadg@nvidia.com> Reviewed-by: mobile promotions <svcmobile_promotions@nvidia.com> Tested-by: mobile promotions <svcmobile_promotions@nvidia.com>
This commit is contained in:
@@ -56,18 +56,6 @@
|
|||||||
#define TEGRA210_AHUBRAMCTL_CTRL_SEQ_ACCESS_EN (1 << 12)
|
#define TEGRA210_AHUBRAMCTL_CTRL_SEQ_ACCESS_EN (1 << 12)
|
||||||
#define TEGRA210_AHUBRAMCTL_CTRL_RAM_ADDR_MASK 0x1ff
|
#define TEGRA210_AHUBRAMCTL_CTRL_RAM_ADDR_MASK 0x1ff
|
||||||
|
|
||||||
#define TEGRA210_NUM_DAIS 67
|
|
||||||
#define TEGRA210_NUM_MUX_WIDGETS 50
|
|
||||||
|
|
||||||
/* size of TEGRA210_ROUTES */
|
|
||||||
#define TEGRA210_NUM_MUX_INPUT 54
|
|
||||||
|
|
||||||
#define TEGRA186_NUM_DAIS 108
|
|
||||||
#define TEGRA186_NUM_MUX_WIDGETS 79
|
|
||||||
|
|
||||||
/* size of TEGRA_ROUTES + TEGRA186_ROUTES */
|
|
||||||
#define TEGRA186_NUM_MUX_INPUT 82
|
|
||||||
|
|
||||||
#define TEGRA210_MAX_REGISTER_ADDR (TEGRA210_XBAR_PART2_RX + \
|
#define TEGRA210_MAX_REGISTER_ADDR (TEGRA210_XBAR_PART2_RX + \
|
||||||
(TEGRA210_XBAR_RX_STRIDE * (TEGRA210_XBAR_AUDIO_RX_COUNT - 1)))
|
(TEGRA210_XBAR_RX_STRIDE * (TEGRA210_XBAR_AUDIO_RX_COUNT - 1)))
|
||||||
|
|
||||||
@@ -91,6 +79,76 @@
|
|||||||
|
|
||||||
#define TEGRA_XBAR_UPDATE_MAX_REG (TEGRA186_XBAR_UPDATE_MAX_REG)
|
#define TEGRA_XBAR_UPDATE_MAX_REG (TEGRA186_XBAR_UPDATE_MAX_REG)
|
||||||
|
|
||||||
|
#define MUX_ENUM_CTRL_DECL(ename, id) \
|
||||||
|
SOC_VALUE_ENUM_WIDE_DECL(ename##_enum, MUX_REG(id), 0, \
|
||||||
|
tegra210_xbar_mux_texts, \
|
||||||
|
tegra210_xbar_mux_values); \
|
||||||
|
static const struct snd_kcontrol_new ename##_control = \
|
||||||
|
SOC_DAPM_ENUM_EXT("Route", ename##_enum, \
|
||||||
|
tegra_xbar_get_value_enum, \
|
||||||
|
tegra_xbar_put_value_enum)
|
||||||
|
|
||||||
|
#define MUX_ENUM_CTRL_DECL_186(ename, id) \
|
||||||
|
SOC_VALUE_ENUM_WIDE_DECL(ename##_enum, MUX_REG(id), 0, \
|
||||||
|
tegra186_xbar_mux_texts, \
|
||||||
|
tegra186_xbar_mux_values); \
|
||||||
|
static const struct snd_kcontrol_new ename##_control = \
|
||||||
|
SOC_DAPM_ENUM_EXT("Route", ename##_enum, \
|
||||||
|
tegra_xbar_get_value_enum, \
|
||||||
|
tegra_xbar_put_value_enum)
|
||||||
|
|
||||||
|
#define DAI(sname) \
|
||||||
|
{ \
|
||||||
|
.name = #sname, \
|
||||||
|
.playback = { \
|
||||||
|
.stream_name = #sname " Receive", \
|
||||||
|
.channels_min = 1, \
|
||||||
|
.channels_max = 16, \
|
||||||
|
.rates = SNDRV_PCM_RATE_8000_192000, \
|
||||||
|
.formats = SNDRV_PCM_FMTBIT_S8 | \
|
||||||
|
SNDRV_PCM_FMTBIT_S16_LE | \
|
||||||
|
SNDRV_PCM_FMTBIT_S24_LE | \
|
||||||
|
SNDRV_PCM_FMTBIT_S32_LE, \
|
||||||
|
}, \
|
||||||
|
.capture = { \
|
||||||
|
.stream_name = #sname " Transmit", \
|
||||||
|
.channels_min = 1, \
|
||||||
|
.channels_max = 16, \
|
||||||
|
.rates = SNDRV_PCM_RATE_8000_192000, \
|
||||||
|
.formats = SNDRV_PCM_FMTBIT_S8 | \
|
||||||
|
SNDRV_PCM_FMTBIT_S16_LE | \
|
||||||
|
SNDRV_PCM_FMTBIT_S24_LE | \
|
||||||
|
SNDRV_PCM_FMTBIT_S32_LE, \
|
||||||
|
}, \
|
||||||
|
}
|
||||||
|
|
||||||
|
#define MUX_REG(id) (TEGRA210_XBAR_RX_STRIDE * (id))
|
||||||
|
|
||||||
|
#define SOC_VALUE_ENUM_WIDE(xreg, shift, xmax, xtexts, xvalues) \
|
||||||
|
{ .reg = xreg, .shift_l = shift, .shift_r = shift, \
|
||||||
|
.items = xmax, .texts = xtexts, .values = xvalues, \
|
||||||
|
.mask = xmax ? roundup_pow_of_two(xmax) - 1 : 0}
|
||||||
|
|
||||||
|
#define SOC_VALUE_ENUM_WIDE_DECL(name, xreg, shift, xtexts, xvalues) \
|
||||||
|
static struct soc_enum name = SOC_VALUE_ENUM_WIDE(xreg, shift, \
|
||||||
|
ARRAY_SIZE(xtexts), xtexts, xvalues)
|
||||||
|
|
||||||
|
#define WIDGETS(sname, ename) \
|
||||||
|
SND_SOC_DAPM_AIF_IN(sname " RX", NULL, 0, SND_SOC_NOPM, 0, 0), \
|
||||||
|
SND_SOC_DAPM_AIF_OUT(sname " TX", NULL, 0, SND_SOC_NOPM, 0, 0), \
|
||||||
|
SND_SOC_DAPM_MUX(sname " Mux", SND_SOC_NOPM, 0, 0, \
|
||||||
|
&ename##_control)
|
||||||
|
|
||||||
|
#define TX_WIDGETS(sname) \
|
||||||
|
SND_SOC_DAPM_AIF_IN(sname " RX", NULL, 0, SND_SOC_NOPM, 0, 0), \
|
||||||
|
SND_SOC_DAPM_AIF_OUT(sname " TX", NULL, 0, SND_SOC_NOPM, 0, 0)
|
||||||
|
|
||||||
|
#define MUX_VALUE(npart, nbit) (1 + nbit + npart * 32)
|
||||||
|
|
||||||
|
#define IN_OUT_ROUTES(name) \
|
||||||
|
{ name " RX", NULL, name " Receive" }, \
|
||||||
|
{ name " Transmit", NULL, name " TX" },
|
||||||
|
|
||||||
struct tegra210_xbar_cif_conf {
|
struct tegra210_xbar_cif_conf {
|
||||||
unsigned int threshold;
|
unsigned int threshold;
|
||||||
unsigned int audio_channels;
|
unsigned int audio_channels;
|
||||||
@@ -111,8 +169,9 @@ struct tegra_xbar_soc_data {
|
|||||||
const struct regmap_config *regmap_config;
|
const struct regmap_config *regmap_config;
|
||||||
unsigned int mask[4];
|
unsigned int mask[4];
|
||||||
unsigned int reg_count;
|
unsigned int reg_count;
|
||||||
unsigned int reg_offset;
|
unsigned int num_dais;
|
||||||
int (*xbar_registration)(struct platform_device *pdev);
|
struct snd_soc_codec_driver *codec_drv;
|
||||||
|
struct snd_soc_dai_driver *dai_drv;
|
||||||
};
|
};
|
||||||
|
|
||||||
struct tegra_xbar {
|
struct tegra_xbar {
|
||||||
|
|||||||
@@ -28,10 +28,111 @@
|
|||||||
#include <sound/soc.h>
|
#include <sound/soc.h>
|
||||||
#include <linux/clk/tegra.h>
|
#include <linux/clk/tegra.h>
|
||||||
#include "tegra210_xbar_alt.h"
|
#include "tegra210_xbar_alt.h"
|
||||||
#include "tegra210_xbar_utils_alt.h"
|
|
||||||
|
|
||||||
#define DRV_NAME "tegra210-axbar"
|
#define DRV_NAME "tegra210-axbar"
|
||||||
|
|
||||||
|
static int tegra_xbar_get_value_enum(struct snd_kcontrol *kcontrol,
|
||||||
|
struct snd_ctl_elem_value *ucontrol)
|
||||||
|
{
|
||||||
|
struct snd_soc_codec *codec = snd_soc_dapm_kcontrol_codec(kcontrol);
|
||||||
|
struct tegra_xbar *xbar = snd_soc_codec_get_drvdata(codec);
|
||||||
|
struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
|
||||||
|
unsigned int reg_count, reg_val, val, bit_pos = 0, i;
|
||||||
|
unsigned int reg[TEGRA_XBAR_UPDATE_MAX_REG];
|
||||||
|
|
||||||
|
reg_count = xbar->soc_data->reg_count;
|
||||||
|
|
||||||
|
if (reg_count > TEGRA_XBAR_UPDATE_MAX_REG)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
for (i = 0; i < reg_count; i++) {
|
||||||
|
reg[i] = e->reg + TEGRA210_XBAR_PART1_RX * i;
|
||||||
|
reg_val = snd_soc_read(codec, reg[i]);
|
||||||
|
val = reg_val & xbar->soc_data->mask[i];
|
||||||
|
if (val != 0) {
|
||||||
|
bit_pos = ffs(val) +
|
||||||
|
(8*codec->component.val_bytes * i);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
for (i = 0; i < e->items; i++) {
|
||||||
|
if (bit_pos == e->values[i]) {
|
||||||
|
ucontrol->value.enumerated.item[0] = i;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int tegra_xbar_put_value_enum(struct snd_kcontrol *kcontrol,
|
||||||
|
struct snd_ctl_elem_value *ucontrol)
|
||||||
|
{
|
||||||
|
struct snd_soc_codec *codec = snd_soc_dapm_kcontrol_codec(kcontrol);
|
||||||
|
struct tegra_xbar *xbar = snd_soc_codec_get_drvdata(codec);
|
||||||
|
struct snd_soc_dapm_context *dapm =
|
||||||
|
snd_soc_dapm_kcontrol_dapm(kcontrol);
|
||||||
|
struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
|
||||||
|
unsigned int *item = ucontrol->value.enumerated.item;
|
||||||
|
unsigned int change = 0, reg_idx = 0, value, *mask, bit_pos = 0;
|
||||||
|
unsigned int i, reg_count, reg_val = 0, update_idx = 0;
|
||||||
|
unsigned int reg[TEGRA_XBAR_UPDATE_MAX_REG];
|
||||||
|
struct snd_soc_dapm_update update[TEGRA_XBAR_UPDATE_MAX_REG] = {
|
||||||
|
{ NULL } };
|
||||||
|
|
||||||
|
/* initialize the reg_count and mask from soc_data */
|
||||||
|
reg_count = xbar->soc_data->reg_count;
|
||||||
|
mask = (unsigned int *)xbar->soc_data->mask;
|
||||||
|
|
||||||
|
if (item[0] >= e->items || reg_count > TEGRA_XBAR_UPDATE_MAX_REG)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
value = e->values[item[0]];
|
||||||
|
|
||||||
|
if (value) {
|
||||||
|
/* get the register index and value to set */
|
||||||
|
reg_idx = (value - 1) / (8 * codec->component.val_bytes);
|
||||||
|
bit_pos = (value - 1) % (8 * codec->component.val_bytes);
|
||||||
|
reg_val = BIT(bit_pos);
|
||||||
|
}
|
||||||
|
|
||||||
|
for (i = 0; i < reg_count; i++) {
|
||||||
|
reg[i] = e->reg + TEGRA210_XBAR_PART1_RX * i;
|
||||||
|
if (i == reg_idx) {
|
||||||
|
change |= snd_soc_test_bits(codec, reg[i],
|
||||||
|
mask[i], reg_val);
|
||||||
|
/* set the selected register */
|
||||||
|
update[reg_count - 1].reg = reg[reg_idx];
|
||||||
|
update[reg_count - 1].mask = mask[reg_idx];
|
||||||
|
update[reg_count - 1].val = reg_val;
|
||||||
|
} else {
|
||||||
|
/*
|
||||||
|
* accumulate the change to update the DAPM path
|
||||||
|
* when none is selected
|
||||||
|
*/
|
||||||
|
change |= snd_soc_test_bits(codec, reg[i],
|
||||||
|
mask[i], 0);
|
||||||
|
|
||||||
|
/* clear the register when not selected */
|
||||||
|
update[update_idx].reg = reg[i];
|
||||||
|
update[update_idx].mask = mask[i];
|
||||||
|
update[update_idx++].val = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* power the widgets */
|
||||||
|
if (change) {
|
||||||
|
for (i = 0; i < reg_count; i++) {
|
||||||
|
update[i].kcontrol = kcontrol;
|
||||||
|
snd_soc_dapm_mux_update_power(dapm,
|
||||||
|
kcontrol, item[0], e, &update[i]);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return change;
|
||||||
|
}
|
||||||
|
|
||||||
static struct snd_soc_dai_driver tegra210_xbar_dais[] = {
|
static struct snd_soc_dai_driver tegra210_xbar_dais[] = {
|
||||||
DAI(ADMAIF1),
|
DAI(ADMAIF1),
|
||||||
DAI(ADMAIF2),
|
DAI(ADMAIF2),
|
||||||
@@ -1135,7 +1236,6 @@ static const struct regmap_config tegra210_xbar_regmap_config = {
|
|||||||
.val_bits = 32,
|
.val_bits = 32,
|
||||||
.reg_stride = 4,
|
.reg_stride = 4,
|
||||||
.max_register = TEGRA210_MAX_REGISTER_ADDR,
|
.max_register = TEGRA210_MAX_REGISTER_ADDR,
|
||||||
.volatile_reg = tegra_xbar_volatile_reg,
|
|
||||||
.cache_type = REGCACHE_FLAT,
|
.cache_type = REGCACHE_FLAT,
|
||||||
};
|
};
|
||||||
|
|
||||||
@@ -1144,64 +1244,9 @@ static const struct regmap_config tegra186_xbar_regmap_config = {
|
|||||||
.val_bits = 32,
|
.val_bits = 32,
|
||||||
.reg_stride = 4,
|
.reg_stride = 4,
|
||||||
.max_register = TEGRA186_MAX_REGISTER_ADDR,
|
.max_register = TEGRA186_MAX_REGISTER_ADDR,
|
||||||
.volatile_reg = tegra_xbar_volatile_reg,
|
|
||||||
.cache_type = REGCACHE_FLAT,
|
.cache_type = REGCACHE_FLAT,
|
||||||
};
|
};
|
||||||
|
|
||||||
static int tegra210_xbar_registration(struct platform_device *pdev)
|
|
||||||
{
|
|
||||||
int ret;
|
|
||||||
int num_dapm_widgets, num_dapm_routes;
|
|
||||||
|
|
||||||
num_dapm_widgets = (TEGRA210_NUM_MUX_WIDGETS * 3) +
|
|
||||||
(TEGRA210_NUM_DAIS - TEGRA210_NUM_MUX_WIDGETS) * 2;
|
|
||||||
num_dapm_routes =
|
|
||||||
(TEGRA210_NUM_DAIS - TEGRA210_NUM_MUX_WIDGETS) * 2 +
|
|
||||||
(TEGRA210_NUM_MUX_WIDGETS * TEGRA210_NUM_MUX_INPUT);
|
|
||||||
|
|
||||||
tegra210_xbar_codec.component_driver.num_dapm_widgets =
|
|
||||||
num_dapm_widgets;
|
|
||||||
tegra210_xbar_codec.component_driver.num_dapm_routes =
|
|
||||||
num_dapm_routes;
|
|
||||||
|
|
||||||
ret = snd_soc_register_codec(&pdev->dev, &tegra210_xbar_codec,
|
|
||||||
tegra210_xbar_dais, TEGRA210_NUM_DAIS);
|
|
||||||
|
|
||||||
if (ret != 0) {
|
|
||||||
dev_err(&pdev->dev, "Could not register CODEC: %d\n", ret);
|
|
||||||
return -EBUSY;
|
|
||||||
}
|
|
||||||
|
|
||||||
return of_platform_populate(pdev->dev.of_node, NULL, NULL, &pdev->dev);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int tegra186_xbar_registration(struct platform_device *pdev)
|
|
||||||
{
|
|
||||||
int ret;
|
|
||||||
int num_dapm_widgets, num_dapm_routes;
|
|
||||||
|
|
||||||
num_dapm_widgets = (TEGRA186_NUM_MUX_WIDGETS * 3) +
|
|
||||||
(TEGRA186_NUM_DAIS - TEGRA186_NUM_MUX_WIDGETS) * 2;
|
|
||||||
num_dapm_routes =
|
|
||||||
(TEGRA186_NUM_DAIS - TEGRA186_NUM_MUX_WIDGETS) * 2 +
|
|
||||||
(TEGRA186_NUM_MUX_WIDGETS * TEGRA186_NUM_MUX_INPUT);
|
|
||||||
|
|
||||||
tegra186_xbar_codec.component_driver.num_dapm_widgets =
|
|
||||||
num_dapm_widgets;
|
|
||||||
tegra186_xbar_codec.component_driver.num_dapm_routes =
|
|
||||||
num_dapm_routes;
|
|
||||||
|
|
||||||
ret = snd_soc_register_codec(&pdev->dev, &tegra186_xbar_codec,
|
|
||||||
tegra186_xbar_dais, TEGRA186_NUM_DAIS);
|
|
||||||
|
|
||||||
if (ret != 0) {
|
|
||||||
dev_err(&pdev->dev, "Could not register CODEC: %d\n", ret);
|
|
||||||
return -EBUSY;
|
|
||||||
}
|
|
||||||
|
|
||||||
return of_platform_populate(pdev->dev.of_node, NULL, NULL, &pdev->dev);
|
|
||||||
}
|
|
||||||
|
|
||||||
static const struct tegra_xbar_soc_data soc_data_tegra210 = {
|
static const struct tegra_xbar_soc_data soc_data_tegra210 = {
|
||||||
.regmap_config = &tegra210_xbar_regmap_config,
|
.regmap_config = &tegra210_xbar_regmap_config,
|
||||||
.mask[0] = TEGRA210_XBAR_REG_MASK_0,
|
.mask[0] = TEGRA210_XBAR_REG_MASK_0,
|
||||||
@@ -1209,8 +1254,9 @@ static const struct tegra_xbar_soc_data soc_data_tegra210 = {
|
|||||||
.mask[2] = TEGRA210_XBAR_REG_MASK_2,
|
.mask[2] = TEGRA210_XBAR_REG_MASK_2,
|
||||||
.mask[3] = TEGRA210_XBAR_REG_MASK_3,
|
.mask[3] = TEGRA210_XBAR_REG_MASK_3,
|
||||||
.reg_count = TEGRA210_XBAR_UPDATE_MAX_REG,
|
.reg_count = TEGRA210_XBAR_UPDATE_MAX_REG,
|
||||||
.reg_offset = TEGRA210_XBAR_PART1_RX,
|
.codec_drv = &tegra210_xbar_codec,
|
||||||
.xbar_registration = tegra210_xbar_registration,
|
.dai_drv = tegra210_xbar_dais,
|
||||||
|
.num_dais = ARRAY_SIZE(tegra210_xbar_dais),
|
||||||
};
|
};
|
||||||
|
|
||||||
static const struct tegra_xbar_soc_data soc_data_tegra186 = {
|
static const struct tegra_xbar_soc_data soc_data_tegra186 = {
|
||||||
@@ -1220,8 +1266,9 @@ static const struct tegra_xbar_soc_data soc_data_tegra186 = {
|
|||||||
.mask[2] = TEGRA186_XBAR_REG_MASK_2,
|
.mask[2] = TEGRA186_XBAR_REG_MASK_2,
|
||||||
.mask[3] = TEGRA186_XBAR_REG_MASK_3,
|
.mask[3] = TEGRA186_XBAR_REG_MASK_3,
|
||||||
.reg_count = TEGRA186_XBAR_UPDATE_MAX_REG,
|
.reg_count = TEGRA186_XBAR_UPDATE_MAX_REG,
|
||||||
.reg_offset = TEGRA210_XBAR_PART1_RX,
|
.codec_drv = &tegra186_xbar_codec,
|
||||||
.xbar_registration = tegra186_xbar_registration,
|
.dai_drv = tegra186_xbar_dais,
|
||||||
|
.num_dais = ARRAY_SIZE(tegra186_xbar_dais),
|
||||||
};
|
};
|
||||||
|
|
||||||
static const struct of_device_id tegra_xbar_of_match[] = {
|
static const struct of_device_id tegra_xbar_of_match[] = {
|
||||||
@@ -1230,19 +1277,122 @@ static const struct of_device_id tegra_xbar_of_match[] = {
|
|||||||
{},
|
{},
|
||||||
};
|
};
|
||||||
|
|
||||||
static int tegra_dev_xbar_probe(struct platform_device *pdev)
|
static int tegra_xbar_runtime_suspend(struct device *dev)
|
||||||
|
{
|
||||||
|
struct tegra_xbar *xbar = dev_get_drvdata(dev);
|
||||||
|
|
||||||
|
#ifdef CONFIG_TEGRA186_AHC
|
||||||
|
tegra186_free_ahc_interrupts();
|
||||||
|
#endif
|
||||||
|
regcache_cache_only(xbar->regmap, true);
|
||||||
|
regcache_mark_dirty(xbar->regmap);
|
||||||
|
|
||||||
|
if (!(tegra_platform_is_unit_fpga() || tegra_platform_is_fpga()))
|
||||||
|
clk_disable_unprepare(xbar->clk);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int tegra_xbar_runtime_resume(struct device *dev)
|
||||||
|
{
|
||||||
|
struct tegra_xbar *xbar = dev_get_drvdata(dev);
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
if (!(tegra_platform_is_unit_fpga() || tegra_platform_is_fpga())) {
|
||||||
|
ret = clk_prepare_enable(xbar->clk);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(dev, "clk_prepare_enable failed: %d\n", ret);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
#ifdef CONFIG_TEGRA186_AHC
|
||||||
|
tegra186_setup_ahc_interrupts();
|
||||||
|
#endif
|
||||||
|
regcache_cache_only(xbar->regmap, false);
|
||||||
|
regcache_sync(xbar->regmap);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int tegra_xbar_probe(struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
const struct of_device_id *match;
|
const struct of_device_id *match;
|
||||||
struct tegra_xbar_soc_data *soc_data;
|
struct tegra_xbar *xbar;
|
||||||
|
struct resource *res;
|
||||||
|
void __iomem *regs;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
xbar = devm_kzalloc(&pdev->dev, sizeof(*xbar), GFP_KERNEL);
|
||||||
|
if (!xbar)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
match = of_match_device(tegra_xbar_of_match, &pdev->dev);
|
match = of_match_device(tegra_xbar_of_match, &pdev->dev);
|
||||||
if (!match) {
|
if (!match) {
|
||||||
dev_err(&pdev->dev, "Error: No device match found\n");
|
dev_err(&pdev->dev, "Error: No device match found\n");
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
soc_data = (struct tegra_xbar_soc_data *)match->data;
|
|
||||||
|
|
||||||
return tegra_xbar_probe(pdev, soc_data);
|
xbar->soc_data = (struct tegra_xbar_soc_data *)match->data;
|
||||||
|
|
||||||
|
dev_set_drvdata(&pdev->dev, xbar);
|
||||||
|
|
||||||
|
if (!(tegra_platform_is_unit_fpga() || tegra_platform_is_fpga())) {
|
||||||
|
xbar->clk = devm_clk_get(&pdev->dev, "ahub");
|
||||||
|
if (IS_ERR(xbar->clk)) {
|
||||||
|
dev_err(&pdev->dev, "Can't retrieve ahub clock\n");
|
||||||
|
return PTR_ERR(xbar->clk);
|
||||||
|
}
|
||||||
|
|
||||||
|
xbar->clk_parent = devm_clk_get(&pdev->dev, "parent");
|
||||||
|
if (IS_ERR(xbar->clk_parent)) {
|
||||||
|
dev_err(&pdev->dev, "Can't retrieve parent clock\n");
|
||||||
|
return PTR_ERR(xbar->clk_parent);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||||
|
|
||||||
|
regs = devm_ioremap_resource(&pdev->dev, res);
|
||||||
|
if (IS_ERR(regs))
|
||||||
|
return PTR_ERR(regs);
|
||||||
|
|
||||||
|
xbar->regmap = devm_regmap_init_mmio(&pdev->dev, regs,
|
||||||
|
xbar->soc_data->regmap_config);
|
||||||
|
if (IS_ERR(xbar->regmap)) {
|
||||||
|
dev_err(&pdev->dev, "regmap init failed\n");
|
||||||
|
return PTR_ERR(xbar->regmap);
|
||||||
|
}
|
||||||
|
|
||||||
|
regcache_cache_only(xbar->regmap, true);
|
||||||
|
|
||||||
|
ret = snd_soc_register_codec(&pdev->dev,
|
||||||
|
xbar->soc_data->codec_drv,
|
||||||
|
xbar->soc_data->dai_drv,
|
||||||
|
xbar->soc_data->num_dais);
|
||||||
|
|
||||||
|
if (ret < 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
ret = of_platform_populate(pdev->dev.of_node, NULL, NULL, &pdev->dev);
|
||||||
|
if (ret < 0) {
|
||||||
|
snd_soc_unregister_codec(&pdev->dev);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
pm_runtime_enable(&pdev->dev);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int tegra_xbar_remove(struct platform_device *pdev)
|
||||||
|
{
|
||||||
|
snd_soc_unregister_codec(&pdev->dev);
|
||||||
|
|
||||||
|
pm_runtime_disable(&pdev->dev);
|
||||||
|
if (!pm_runtime_status_suspended(&pdev->dev))
|
||||||
|
tegra_xbar_runtime_suspend(&pdev->dev);
|
||||||
|
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static const struct dev_pm_ops tegra_xbar_pm_ops = {
|
static const struct dev_pm_ops tegra_xbar_pm_ops = {
|
||||||
@@ -1253,7 +1403,7 @@ static const struct dev_pm_ops tegra_xbar_pm_ops = {
|
|||||||
};
|
};
|
||||||
|
|
||||||
static struct platform_driver tegra_xbar_driver = {
|
static struct platform_driver tegra_xbar_driver = {
|
||||||
.probe = tegra_dev_xbar_probe,
|
.probe = tegra_xbar_probe,
|
||||||
.remove = tegra_xbar_remove,
|
.remove = tegra_xbar_remove,
|
||||||
.driver = {
|
.driver = {
|
||||||
.name = DRV_NAME,
|
.name = DRV_NAME,
|
||||||
|
|||||||
@@ -28,9 +28,6 @@
|
|||||||
#include <sound/soc.h>
|
#include <sound/soc.h>
|
||||||
#include <linux/clk/tegra.h>
|
#include <linux/clk/tegra.h>
|
||||||
#include "tegra210_xbar_alt.h"
|
#include "tegra210_xbar_alt.h"
|
||||||
#include "tegra210_xbar_utils_alt.h"
|
|
||||||
|
|
||||||
static struct tegra_xbar *xbar;
|
|
||||||
|
|
||||||
void tegra210_xbar_set_cif(struct regmap *regmap, unsigned int reg,
|
void tegra210_xbar_set_cif(struct regmap *regmap, unsigned int reg,
|
||||||
struct tegra210_xbar_cif_conf *conf)
|
struct tegra210_xbar_cif_conf *conf)
|
||||||
@@ -104,219 +101,4 @@ void tegra210_xbar_read_ahubram(struct regmap *regmap, unsigned int reg_ctrl,
|
|||||||
}
|
}
|
||||||
EXPORT_SYMBOL_GPL(tegra210_xbar_read_ahubram);
|
EXPORT_SYMBOL_GPL(tegra210_xbar_read_ahubram);
|
||||||
|
|
||||||
int tegra210_xbar_read_reg (unsigned int reg, unsigned int *val)
|
|
||||||
{
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
ret = regmap_read (xbar->regmap, reg, val);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL_GPL(tegra210_xbar_read_reg);
|
|
||||||
|
|
||||||
int tegra_xbar_get_value_enum(struct snd_kcontrol *kcontrol,
|
|
||||||
struct snd_ctl_elem_value *ucontrol)
|
|
||||||
{
|
|
||||||
struct snd_soc_codec *codec = snd_soc_dapm_kcontrol_codec(kcontrol);
|
|
||||||
struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
|
|
||||||
unsigned int reg_count, reg_val, val, bit_pos = 0, i;
|
|
||||||
unsigned int reg[TEGRA_XBAR_UPDATE_MAX_REG];
|
|
||||||
|
|
||||||
reg_count = xbar->soc_data->reg_count;
|
|
||||||
|
|
||||||
if (reg_count > TEGRA_XBAR_UPDATE_MAX_REG)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
for (i = 0; i < reg_count; i++) {
|
|
||||||
reg[i] = (e->reg +
|
|
||||||
xbar->soc_data->reg_offset * i);
|
|
||||||
reg_val = snd_soc_read(codec, reg[i]);
|
|
||||||
val = reg_val & xbar->soc_data->mask[i];
|
|
||||||
if (val != 0) {
|
|
||||||
bit_pos = ffs(val) +
|
|
||||||
(8*codec->component.val_bytes * i);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
for (i = 0; i < e->items; i++) {
|
|
||||||
if (bit_pos == e->values[i]) {
|
|
||||||
ucontrol->value.enumerated.item[0] = i;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL_GPL(tegra_xbar_get_value_enum);
|
|
||||||
|
|
||||||
int tegra_xbar_put_value_enum(struct snd_kcontrol *kcontrol,
|
|
||||||
struct snd_ctl_elem_value *ucontrol)
|
|
||||||
{
|
|
||||||
struct snd_soc_codec *codec = snd_soc_dapm_kcontrol_codec(kcontrol);
|
|
||||||
struct snd_soc_dapm_context *dapm =
|
|
||||||
snd_soc_dapm_kcontrol_dapm(kcontrol);
|
|
||||||
struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
|
|
||||||
unsigned int *item = ucontrol->value.enumerated.item;
|
|
||||||
unsigned int change = 0, reg_idx = 0, value, *mask, bit_pos = 0;
|
|
||||||
unsigned int i, reg_count, reg_val = 0, update_idx = 0;
|
|
||||||
unsigned int reg[TEGRA_XBAR_UPDATE_MAX_REG];
|
|
||||||
struct snd_soc_dapm_update update[TEGRA_XBAR_UPDATE_MAX_REG] = {
|
|
||||||
{ NULL } };
|
|
||||||
|
|
||||||
/* initialize the reg_count and mask from soc_data */
|
|
||||||
reg_count = xbar->soc_data->reg_count;
|
|
||||||
mask = (unsigned int *)xbar->soc_data->mask;
|
|
||||||
|
|
||||||
if (item[0] >= e->items || reg_count > TEGRA_XBAR_UPDATE_MAX_REG)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
value = e->values[item[0]];
|
|
||||||
|
|
||||||
if (value) {
|
|
||||||
/* get the register index and value to set */
|
|
||||||
reg_idx = (value - 1) / (8 * codec->component.val_bytes);
|
|
||||||
bit_pos = (value - 1) % (8 * codec->component.val_bytes);
|
|
||||||
reg_val = BIT(bit_pos);
|
|
||||||
}
|
|
||||||
|
|
||||||
for (i = 0; i < reg_count; i++) {
|
|
||||||
reg[i] = e->reg + xbar->soc_data->reg_offset * i;
|
|
||||||
if (i == reg_idx) {
|
|
||||||
change |= snd_soc_test_bits(codec, reg[i],
|
|
||||||
mask[i], reg_val);
|
|
||||||
/* set the selected register */
|
|
||||||
update[reg_count - 1].reg = reg[reg_idx];
|
|
||||||
update[reg_count - 1].mask = mask[reg_idx];
|
|
||||||
update[reg_count - 1].val = reg_val;
|
|
||||||
} else {
|
|
||||||
/* accumulate the change to update the DAPM path
|
|
||||||
when none is selected */
|
|
||||||
change |= snd_soc_test_bits(codec, reg[i],
|
|
||||||
mask[i], 0);
|
|
||||||
|
|
||||||
/* clear the register when not selected */
|
|
||||||
update[update_idx].reg = reg[i];
|
|
||||||
update[update_idx].mask = mask[i];
|
|
||||||
update[update_idx++].val = 0;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* power the widgets */
|
|
||||||
if (change) {
|
|
||||||
for (i = 0; i < reg_count; i++) {
|
|
||||||
update[i].kcontrol = kcontrol;
|
|
||||||
snd_soc_dapm_mux_update_power(dapm,
|
|
||||||
kcontrol, item[0], e, &update[i]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return change;
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL_GPL(tegra_xbar_put_value_enum);
|
|
||||||
|
|
||||||
bool tegra_xbar_volatile_reg(struct device *dev, unsigned int reg)
|
|
||||||
{
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL_GPL(tegra_xbar_volatile_reg);
|
|
||||||
|
|
||||||
int tegra_xbar_runtime_suspend(struct device *dev)
|
|
||||||
{
|
|
||||||
|
|
||||||
#ifdef CONFIG_TEGRA186_AHC
|
|
||||||
tegra186_free_ahc_interrupts();
|
|
||||||
#endif
|
|
||||||
regcache_cache_only(xbar->regmap, true);
|
|
||||||
regcache_mark_dirty(xbar->regmap);
|
|
||||||
|
|
||||||
if (!(tegra_platform_is_unit_fpga() || tegra_platform_is_fpga()))
|
|
||||||
clk_disable_unprepare(xbar->clk);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL_GPL(tegra_xbar_runtime_suspend);
|
|
||||||
|
|
||||||
int tegra_xbar_runtime_resume(struct device *dev)
|
|
||||||
{
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
if (!(tegra_platform_is_unit_fpga() || tegra_platform_is_fpga())) {
|
|
||||||
ret = clk_prepare_enable(xbar->clk);
|
|
||||||
if (ret) {
|
|
||||||
dev_err(dev, "clk_prepare_enable failed: %d\n", ret);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#ifdef CONFIG_TEGRA186_AHC
|
|
||||||
tegra186_setup_ahc_interrupts();
|
|
||||||
#endif
|
|
||||||
regcache_cache_only(xbar->regmap, false);
|
|
||||||
regcache_sync(xbar->regmap);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL_GPL(tegra_xbar_runtime_resume);
|
|
||||||
|
|
||||||
int tegra_xbar_remove(struct platform_device *pdev)
|
|
||||||
{
|
|
||||||
snd_soc_unregister_codec(&pdev->dev);
|
|
||||||
|
|
||||||
pm_runtime_disable(&pdev->dev);
|
|
||||||
if (!pm_runtime_status_suspended(&pdev->dev))
|
|
||||||
tegra_xbar_runtime_suspend(&pdev->dev);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL_GPL(tegra_xbar_remove);
|
|
||||||
|
|
||||||
int tegra_xbar_probe(struct platform_device *pdev,
|
|
||||||
struct tegra_xbar_soc_data *soc_data)
|
|
||||||
{
|
|
||||||
void __iomem *regs;
|
|
||||||
struct resource *res;
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
xbar = devm_kzalloc(&pdev->dev, sizeof(*xbar), GFP_KERNEL);
|
|
||||||
if (!xbar)
|
|
||||||
return -ENOMEM;
|
|
||||||
|
|
||||||
xbar->soc_data = soc_data;
|
|
||||||
platform_set_drvdata(pdev, xbar);
|
|
||||||
|
|
||||||
if (!(tegra_platform_is_unit_fpga() || tegra_platform_is_fpga())) {
|
|
||||||
xbar->clk = devm_clk_get(&pdev->dev, "ahub");
|
|
||||||
if (IS_ERR(xbar->clk)) {
|
|
||||||
dev_err(&pdev->dev, "Can't retrieve ahub clock\n");
|
|
||||||
return PTR_ERR(xbar->clk);
|
|
||||||
}
|
|
||||||
|
|
||||||
xbar->clk_parent = devm_clk_get(&pdev->dev, "parent");
|
|
||||||
if (IS_ERR(xbar->clk_parent)) {
|
|
||||||
dev_err(&pdev->dev, "Can't retrieve parent clock\n");
|
|
||||||
return PTR_ERR(xbar->clk_parent);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
||||||
regs = devm_ioremap_resource(&pdev->dev, res);
|
|
||||||
if (IS_ERR(regs))
|
|
||||||
return PTR_ERR(regs);
|
|
||||||
xbar->regmap = devm_regmap_init_mmio(&pdev->dev, regs,
|
|
||||||
soc_data->regmap_config);
|
|
||||||
if (IS_ERR(xbar->regmap)) {
|
|
||||||
dev_err(&pdev->dev, "regmap init failed\n");
|
|
||||||
return PTR_ERR(xbar->regmap);
|
|
||||||
}
|
|
||||||
regcache_cache_only(xbar->regmap, true);
|
|
||||||
|
|
||||||
pm_runtime_enable(&pdev->dev);
|
|
||||||
ret = soc_data->xbar_registration(pdev);
|
|
||||||
if (ret) {
|
|
||||||
pm_runtime_disable(&pdev->dev);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL_GPL(tegra_xbar_probe);
|
|
||||||
MODULE_LICENSE("GPL");
|
MODULE_LICENSE("GPL");
|
||||||
|
|||||||
Reference in New Issue
Block a user