tegrakernel/kernel/nvidia/sound/soc/tegra-alt/tegra186_arad_alt.c

841 lines
25 KiB
C
Raw Permalink Normal View History

2022-02-16 09:13:02 -06:00
/*
* tegra186_arad_alt.c - Tegra186 ARAD driver
*
* Copyright (c) 2015-2019, NVIDIA CORPORATION. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify it
* under the terms and conditions of the GNU General Public License,
* version 2, as published by the Free Software Foundation.
*
* This program is distributed in the hope it will be useful, but WITHOUT
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
* more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
#include <linux/delay.h>
#include <linux/clk.h>
#include <linux/device.h>
#include <linux/io.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/platform_device.h>
#include <linux/pm_runtime.h>
#include <linux/regmap.h>
#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
#include <sound/soc.h>
#include <linux/of_device.h>
#include <linux/tegra186_ahc.h>
#include "tegra186_asrc_alt.h"
#include "tegra186_arad_alt.h"
#define DRV_NAME "tegra186-arad"
static struct device *arad_dev;
#define ARAD_LANE_NUMERATOR_MUX(id) \
(TEGRA186_ARAD_LANE1_NUMERATOR_MUX_SEL + id*TEGRA186_ARAD_LANE_STRIDE)
#define ARAD_LANE_DENOMINATOR_MUX(id) \
(TEGRA186_ARAD_LANE1_DENOMINATOR_MUX_SEL + id*TEGRA186_ARAD_LANE_STRIDE)
#define ARAD_LANE_REG(reg, id) (reg + (id * TEGRA186_ARAD_LANE_STRIDE))
#define ARAD_LANE_REG_DEFAULTS(id) \
{ ARAD_LANE_REG(TEGRA186_ARAD_LANE1_NUMERATOR_MUX_SEL, id), 0x0}, \
{ ARAD_LANE_REG(TEGRA186_ARAD_LANE1_RATIO_INTEGER_PART, id), 0x0}, \
{ ARAD_LANE_REG(TEGRA186_ARAD_LANE1_RATIO_FRACTIONAL_PART, id), 0x0}, \
{ ARAD_LANE_REG(TEGRA186_ARAD_LANE1_NUMERATOR_PRESCALAR, id), 0x0}, \
{ ARAD_LANE_REG(TEGRA186_ARAD_LANE1_DENOMINATOR_MUX_SEL, id), 0x0}, \
{ ARAD_LANE_REG(TEGRA186_ARAD_LANE1_DENOMINATOR_PRESCALAR, id), 0x0}, \
{ ARAD_LANE_REG(TEGRA186_ARAD_LANE1_SERVO_LOOP_CONFIG, id), 0xd5e7}, \
{ ARAD_LANE_REG(TEGRA186_ARAD_LANE1_LOCK_UNLOCK_DETECTOR_CONFIG, id), 0x840500}, \
{ ARAD_LANE_REG(TEGRA186_ARAD_LANE1_ERROR_LOCK_THRESHOLD, id), 0x400000}, \
{ ARAD_LANE_REG(TEGRA186_ARAD_LANE1_ERROR_UNLOCK_THRESHOLD, id), 0xa00000}, \
{ ARAD_LANE_REG(TEGRA186_ARAD_LANE1_RATIO_CALCULATOR_CONFIG, id), 0xf000006}, \
{ ARAD_LANE_REG(TEGRA186_ARAD_LANE1_CYA, id), 0x0}
static const struct reg_default tegra186_arad_reg_defaults[] = {
{ TEGRA186_ARAD_LANE_ENABLE, 0x0},
{ TEGRA186_ARAD_LANE_SOFT_RESET, 0x0},
{ TEGRA186_ARAD_LANE_INT_MASK, 0x0},
{ TEGRA186_ARAD_LANE_INT_SET, 0x0},
{ TEGRA186_ARAD_LANE_INT_CLEAR, 0x0},
{ TEGRA186_ARAD_LANE_INT_CLEAR, 0x0},
{ TEGRA186_ARAD_CG, 0x0},
{ TEGRA186_ARAD_CYA_GLOBAL, 0x0},
ARAD_LANE_REG_DEFAULTS(0),
ARAD_LANE_REG_DEFAULTS(1),
ARAD_LANE_REG_DEFAULTS(2),
ARAD_LANE_REG_DEFAULTS(3),
ARAD_LANE_REG_DEFAULTS(4),
ARAD_LANE_REG_DEFAULTS(5),
{ TEGRA186_ARAD_TX_CIF_CTRL, 0x115500},
};
static int tegra186_arad_runtime_suspend(struct device *dev)
{
struct tegra186_arad *arad = dev_get_drvdata(dev);
regcache_cache_only(arad->regmap, true);
regcache_mark_dirty(arad->regmap);
return 0;
}
#ifdef CONFIG_PM
static int tegra186_arad_runtime_resume(struct device *dev)
{
struct tegra186_arad *arad = dev_get_drvdata(dev);
regcache_cache_only(arad->regmap, false);
regcache_sync(arad->regmap);
return 0;
}
#endif
static int tegra186_arad_get_lane_lock_status(
struct tegra186_arad *arad, unsigned int lane_id)
{
unsigned int val;
regmap_read(arad->regmap,
TEGRA186_ARAD_LANE_STATUS, &val);
val = (val >> (16 + lane_id)) & 0x1;
return val;
}
#if defined(CONFIG_SND_SOC_TEGRA186_ARAD_WAR) || defined(CONFIG_SND_SOC_TEGRA186_ASRC_WAR)
static int tegra186_arad_get_lane_ratio_change_status(
struct tegra186_arad *arad, unsigned int lane_id)
{
unsigned int val;
regmap_read(arad->regmap,
TEGRA186_ARAD_LANE_INT_STATUS, &val);
val = (val >> (16 + lane_id)) & 0x1;
return val;
}
#endif
static struct snd_soc_dai_ops tegra186_arad_out_dai_ops = {
};
static struct snd_soc_dai_driver tegra186_arad_dais[] = {
{
.name = "ARAD OUT",
.capture = {
.stream_name = "ARAD Transmit",
.channels_min = 2,
.channels_max = 2,
.rates = SNDRV_PCM_RATE_8000_192000,
.formats = SNDRV_PCM_FMTBIT_S24_LE,
},
.ops = &tegra186_arad_out_dai_ops,
},
};
static const int tegra186_arad_mux_value[] = {
-1, /* None */
0, 1, 2, 3, 4, 5, /* I2S1~6 */
12, 13, 14, 15, /* DMIC1~4 */
24, 25, /* DSPK1~2 */
26, 27, /* IQC1~2 */
};
static const char * const tegra186_arad_mux_text[] = {
"None",
"I2S1",
"I2S2",
"I2S3",
"I2S4",
"I2S5",
"I2S6",
"DMIC1",
"DMIC2",
"DMIC3",
"DMIC4",
"DSPK1",
"DSPK2",
"IQC1",
"IQC2",
};
static int tegra186_arad_mux_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct soc_enum *arad_private =
(struct soc_enum *)kcontrol->private_value;
struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
struct tegra186_arad *arad = snd_soc_codec_get_drvdata(codec);
unsigned int val, loop = 0;
regmap_read(arad->regmap, arad_private->reg, &val);
if (val) {
for (loop = 1; loop < 19; loop++)
if (val & (1<<arad_private->values[loop])) {
val = loop;
break;
}
}
ucontrol->value.integer.value[0] = val;
return 0;
}
static int tegra186_arad_mux_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct soc_enum *arad_private =
(struct soc_enum *)kcontrol->private_value;
struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
struct tegra186_arad *arad = snd_soc_codec_get_drvdata(codec);
unsigned int val = ucontrol->value.integer.value[0];
if (!val)
regmap_write(arad->regmap, arad_private->reg, 0);
else
regmap_write(arad->regmap, arad_private->reg,
1 << arad_private->values[val]);
return 0;
}
static int tegra186_arad_get_info(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_info *uinfo)
{
struct soc_mixer_control *arad_private =
(struct soc_mixer_control *)kcontrol->private_value;
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
uinfo->count = 1;
uinfo->value.integer.min = 0;
uinfo->value.integer.max = arad_private->max;
return 0;
}
static int tegra186_arad_get_ratio_int(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct soc_mixer_control *arad_private =
(struct soc_mixer_control *)kcontrol->private_value;
struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
struct tegra186_arad *arad = snd_soc_codec_get_drvdata(codec);
unsigned int val;
regmap_read(arad->regmap, arad_private->reg, &val);
ucontrol->value.integer.value[0] = val;
return 0;
}
static int tegra186_arad_get_ratio_frac(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct soc_mixer_control *arad_private =
(struct soc_mixer_control *)kcontrol->private_value;
struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
struct tegra186_arad *arad = snd_soc_codec_get_drvdata(codec);
unsigned int val;
regmap_read(arad->regmap, arad_private->reg, &val);
ucontrol->value.integer.value[0] = val;
return 0;
}
static int tegra186_arad_get_enable_lane(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct soc_mixer_control *arad_private =
(struct soc_mixer_control *)kcontrol->private_value;
struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
struct tegra186_arad *arad = snd_soc_codec_get_drvdata(codec);
unsigned int enable;
regmap_read(arad->regmap, arad_private->reg, &enable);
enable = (enable >> arad_private->shift) & arad_private->max;
ucontrol->value.integer.value[0] = enable;
return 0;
}
static int tegra186_arad_put_enable_lane(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct soc_mixer_control *arad_private =
(struct soc_mixer_control *)kcontrol->private_value;
struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
struct device *dev = codec->dev;
struct tegra186_arad *arad = snd_soc_codec_get_drvdata(codec);
unsigned int enable = 0, lane_id = arad_private->shift, state;
int dcnt = 10;
pm_runtime_get_sync(dev);
regmap_read(arad->regmap,
TEGRA186_ARAD_LANE_STATUS, &state);
enable = ucontrol->value.integer.value[0];
/* Return, if current state and requested state of lane is disable */
if (!enable && !((state >> lane_id) & 1)) {
pm_runtime_put_sync(dev);
return 0;
}
regmap_update_bits(arad->regmap,
arad_private->reg, 1<<arad_private->shift,
enable<<arad_private->shift);
if (enable)
while (!tegra186_arad_get_lane_lock_status(arad, lane_id) &&
dcnt--)
udelay(10000);
else {
regmap_update_bits(arad->regmap,
TEGRA186_ARAD_LANE_SOFT_RESET, 1<<arad_private->shift,
1<<arad_private->shift);
while (tegra186_arad_get_lane_lock_status(arad, lane_id) &&
dcnt--)
udelay(100);
}
pm_runtime_put_sync(dev);
if (dcnt < 0) {
if (enable)
pr_err("ARAD Lane %d can't be locked\n", lane_id+1);
else
pr_err("ARAD Lane %d can't be unlocked\n", lane_id+1);
return -ETIMEDOUT;
} else
return 0;
}
static int tegra186_arad_tx_stop(struct snd_soc_dapm_widget *w,
struct snd_kcontrol *kcontrol, int event)
{
struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
struct device *dev = codec->dev;
struct tegra186_arad *arad = dev_get_drvdata(dev);
regmap_write(arad->regmap, TEGRA186_ARAD_LANE_ENABLE, 0);
regmap_write(arad->regmap, TEGRA186_ARAD_GLOBAL_SOFT_RESET, 1);
return 0;
}
static const struct snd_soc_dapm_widget tegra186_arad_widgets[] = {
SND_SOC_DAPM_SIGGEN("Lane1 SIG"),
SND_SOC_DAPM_SIGGEN("Lane2 SIG"),
SND_SOC_DAPM_SIGGEN("Lane3 SIG"),
SND_SOC_DAPM_SIGGEN("Lane4 SIG"),
SND_SOC_DAPM_SIGGEN("Lane5 SIG"),
SND_SOC_DAPM_SIGGEN("Lane6 SIG"),
SND_SOC_DAPM_AIF_OUT_E("Packetizer", NULL, 0, SND_SOC_NOPM, 0, 0,
tegra186_arad_tx_stop, SND_SOC_DAPM_PRE_PMD),
};
static const struct snd_soc_dapm_route tegra186_arad_routes[] = {
{ "Packetizer", NULL, "Lane1 SIG"},
{ "Packetizer", NULL, "Lane2 SIG"},
{ "Packetizer", NULL, "Lane3 SIG"},
{ "Packetizer", NULL, "Lane4 SIG"},
{ "Packetizer", NULL, "Lane5 SIG"},
{ "Packetizer", NULL, "Lane6 SIG"},
{ "ARAD Transmit", NULL, "Packetizer" },
};
static int tegra186_arad_get_prescalar(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct soc_mixer_control *arad_private =
(struct soc_mixer_control *)kcontrol->private_value;
struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
struct tegra186_arad *arad = snd_soc_codec_get_drvdata(codec);
unsigned int reg = arad_private->reg;
unsigned int val = 0;
regmap_read(arad->regmap, reg, &val);
ucontrol->value.integer.value[0] = val;
return 0;
}
static int tegra186_arad_put_prescalar(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct soc_mixer_control *arad_private =
(struct soc_mixer_control *)kcontrol->private_value;
struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
struct tegra186_arad *arad = snd_soc_codec_get_drvdata(codec);
unsigned int reg = arad_private->reg;
regmap_write(arad->regmap, reg, ucontrol->value.integer.value[0]);
return 0;
}
#define ARAD_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 ARAD_SOC_VALUE_ENUM_WIDE_DECL(name, xreg, shift, \
xtexts, xvalues) \
struct soc_enum name = ARAD_SOC_VALUE_ENUM_WIDE(xreg, shift, \
ARRAY_SIZE(xtexts), xtexts, xvalues)
#define ARAD_MUX_ENUM_CTRL_DECL(ename, reg) \
ARAD_SOC_VALUE_ENUM_WIDE_DECL(ename##_enum, reg, 0, \
tegra186_arad_mux_text, tegra186_arad_mux_value);
static ARAD_MUX_ENUM_CTRL_DECL(numerator1,
TEGRA186_ARAD_LANE1_NUMERATOR_MUX_SEL);
static ARAD_MUX_ENUM_CTRL_DECL(numerator2,
TEGRA186_ARAD_LANE2_NUMERATOR_MUX_SEL);
static ARAD_MUX_ENUM_CTRL_DECL(numerator3,
TEGRA186_ARAD_LANE3_NUMERATOR_MUX_SEL);
static ARAD_MUX_ENUM_CTRL_DECL(numerator4,
TEGRA186_ARAD_LANE4_NUMERATOR_MUX_SEL);
static ARAD_MUX_ENUM_CTRL_DECL(numerator5,
TEGRA186_ARAD_LANE5_NUMERATOR_MUX_SEL);
static ARAD_MUX_ENUM_CTRL_DECL(numerator6,
TEGRA186_ARAD_LANE6_NUMERATOR_MUX_SEL);
static ARAD_MUX_ENUM_CTRL_DECL(denominator1,
TEGRA186_ARAD_LANE1_DENOMINATOR_MUX_SEL);
static ARAD_MUX_ENUM_CTRL_DECL(denominator2,
TEGRA186_ARAD_LANE2_DENOMINATOR_MUX_SEL);
static ARAD_MUX_ENUM_CTRL_DECL(denominator3,
TEGRA186_ARAD_LANE3_DENOMINATOR_MUX_SEL);
static ARAD_MUX_ENUM_CTRL_DECL(denominator4,
TEGRA186_ARAD_LANE4_DENOMINATOR_MUX_SEL);
static ARAD_MUX_ENUM_CTRL_DECL(denominator5,
TEGRA186_ARAD_LANE5_DENOMINATOR_MUX_SEL);
static ARAD_MUX_ENUM_CTRL_DECL(denominator6,
TEGRA186_ARAD_LANE6_DENOMINATOR_MUX_SEL);
#define ARAD_NUMERATOR_PRESCALAR(id) \
SOC_SINGLE_EXT("Numerator"#id" Prescalar", \
TEGRA186_ARAD_LANE1_NUMERATOR_PRESCALAR + (id-1)*TEGRA186_ARAD_LANE_STRIDE, \
0, 0xffff, 0, tegra186_arad_get_prescalar, \
tegra186_arad_put_prescalar)
#define ARAD_DENOMINATOR_PRESCALAR(id) \
SOC_SINGLE_EXT("Denominator"#id" Prescalar", \
TEGRA186_ARAD_LANE1_DENOMINATOR_PRESCALAR + (id-1)*TEGRA186_ARAD_LANE_STRIDE, \
0, 0xffff, 0, tegra186_arad_get_prescalar, \
tegra186_arad_put_prescalar)
#define ARAD_LINE_RATIO_INT(id) { \
.iface = SNDRV_CTL_ELEM_IFACE_MIXER, \
.name = "Lane"#id" Ratio Int", \
.access = SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE, \
.info = tegra186_arad_get_info, \
.get = tegra186_arad_get_ratio_int, \
.private_value = SOC_SINGLE_VALUE( \
TEGRA186_ARAD_LANE##id##_RATIO_INTEGER_PART, 0, \
TEGRA186_ARAD_LANE_RATIO_INTEGER_PART_MASK, 0, 0) }
#define ARAD_LINE_RATIO_FRAC(id) { \
.iface = SNDRV_CTL_ELEM_IFACE_MIXER,\
.name = "Lane"#id" Ratio Frac",\
.access = SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,\
.info = tegra186_arad_get_info, \
.get = tegra186_arad_get_ratio_frac,\
.private_value = SOC_SINGLE_VALUE(\
TEGRA186_ARAD_LANE##id##_RATIO_FRACTIONAL_PART, 0, \
TEGRA186_ARAD_LANE_RATIO_FRAC_PART_MASK, 0, 0) }
static const struct snd_kcontrol_new tegra186_arad_controls[] = {
SOC_SINGLE_EXT("Lane1 enable", TEGRA186_ARAD_LANE_ENABLE, 0, 1, 0,
tegra186_arad_get_enable_lane, tegra186_arad_put_enable_lane),
SOC_SINGLE_EXT("Lane2 enable", TEGRA186_ARAD_LANE_ENABLE, 1, 1, 0,
tegra186_arad_get_enable_lane, tegra186_arad_put_enable_lane),
SOC_SINGLE_EXT("Lane3 enable", TEGRA186_ARAD_LANE_ENABLE, 2, 1, 0,
tegra186_arad_get_enable_lane, tegra186_arad_put_enable_lane),
SOC_SINGLE_EXT("Lane4 enable", TEGRA186_ARAD_LANE_ENABLE, 3, 1, 0,
tegra186_arad_get_enable_lane, tegra186_arad_put_enable_lane),
SOC_SINGLE_EXT("Lane5 enable", TEGRA186_ARAD_LANE_ENABLE, 4, 1, 0,
tegra186_arad_get_enable_lane, tegra186_arad_put_enable_lane),
SOC_SINGLE_EXT("Lane6 enable", TEGRA186_ARAD_LANE_ENABLE, 5, 1, 0,
tegra186_arad_get_enable_lane, tegra186_arad_put_enable_lane),
SOC_ENUM_EXT("Numerator1 Mux", numerator1_enum,
tegra186_arad_mux_get, tegra186_arad_mux_put),
SOC_ENUM_EXT("Numerator2 Mux", numerator2_enum,
tegra186_arad_mux_get, tegra186_arad_mux_put),
SOC_ENUM_EXT("Numerator3 Mux", numerator3_enum,
tegra186_arad_mux_get, tegra186_arad_mux_put),
SOC_ENUM_EXT("Numerator4 Mux", numerator4_enum,
tegra186_arad_mux_get, tegra186_arad_mux_put),
SOC_ENUM_EXT("Numerator5 Mux", numerator5_enum,
tegra186_arad_mux_get, tegra186_arad_mux_put),
SOC_ENUM_EXT("Numerator6 Mux", numerator6_enum,
tegra186_arad_mux_get, tegra186_arad_mux_put),
SOC_ENUM_EXT("Denominator1 Mux", denominator1_enum,
tegra186_arad_mux_get, tegra186_arad_mux_put),
SOC_ENUM_EXT("Denominator2 Mux", denominator2_enum,
tegra186_arad_mux_get, tegra186_arad_mux_put),
SOC_ENUM_EXT("Denominator3 Mux", denominator3_enum,
tegra186_arad_mux_get, tegra186_arad_mux_put),
SOC_ENUM_EXT("Denominator4 Mux", denominator4_enum,
tegra186_arad_mux_get, tegra186_arad_mux_put),
SOC_ENUM_EXT("Denominator5 Mux", denominator5_enum,
tegra186_arad_mux_get, tegra186_arad_mux_put),
SOC_ENUM_EXT("Denominator6 Mux", denominator6_enum,
tegra186_arad_mux_get, tegra186_arad_mux_put),
ARAD_LINE_RATIO_INT(1),
ARAD_LINE_RATIO_FRAC(1),
ARAD_LINE_RATIO_INT(2),
ARAD_LINE_RATIO_FRAC(2),
ARAD_LINE_RATIO_INT(3),
ARAD_LINE_RATIO_FRAC(3),
ARAD_LINE_RATIO_INT(4),
ARAD_LINE_RATIO_FRAC(4),
ARAD_LINE_RATIO_INT(5),
ARAD_LINE_RATIO_FRAC(5),
ARAD_LINE_RATIO_INT(6),
ARAD_LINE_RATIO_FRAC(6),
ARAD_NUMERATOR_PRESCALAR(1),
ARAD_NUMERATOR_PRESCALAR(2),
ARAD_NUMERATOR_PRESCALAR(3),
ARAD_NUMERATOR_PRESCALAR(4),
ARAD_NUMERATOR_PRESCALAR(5),
ARAD_NUMERATOR_PRESCALAR(6),
ARAD_DENOMINATOR_PRESCALAR(1),
ARAD_DENOMINATOR_PRESCALAR(2),
ARAD_DENOMINATOR_PRESCALAR(3),
ARAD_DENOMINATOR_PRESCALAR(4),
ARAD_DENOMINATOR_PRESCALAR(5),
ARAD_DENOMINATOR_PRESCALAR(6),
};
void tegra186_arad_send_ratio(void)
{
struct tegra186_arad *arad = dev_get_drvdata(arad_dev);
if (!arad)
return;
pm_runtime_get_sync(arad_dev);
regmap_write(arad->regmap, TEGRA186_ARAD_SEND_RATIO, 0x1);
pm_runtime_put(arad_dev);
}
EXPORT_SYMBOL(tegra186_arad_send_ratio);
static struct snd_soc_codec_driver tegra186_arad_codec = {
.idle_bias_off = 1,
.component_driver = {
.dapm_widgets = tegra186_arad_widgets,
.num_dapm_widgets = ARRAY_SIZE(tegra186_arad_widgets),
.dapm_routes = tegra186_arad_routes,
.num_dapm_routes = ARRAY_SIZE(tegra186_arad_routes),
.controls = tegra186_arad_controls,
.num_controls = ARRAY_SIZE(tegra186_arad_controls),
},
};
static bool tegra186_arad_wr_reg(struct device *dev, unsigned int reg)
{
if ((reg >= TEGRA186_ARAD_LANE_START) &&
(reg <= TEGRA186_ARAD_LANE_LIMIT)) {
reg -= TEGRA186_ARAD_LANE_START;
reg %= TEGRA186_ARAD_LANE_STRIDE;
reg += TEGRA186_ARAD_LANE_START;
}
switch (reg) {
case TEGRA186_ARAD_LANE_ENABLE:
case TEGRA186_ARAD_LANE_SOFT_RESET:
case TEGRA186_ARAD_LANE_INT_MASK:
case TEGRA186_ARAD_LANE_INT_SET:
case TEGRA186_ARAD_LANE_INT_CLEAR:
case TEGRA186_ARAD_GLOBAL_SOFT_RESET:
case TEGRA186_ARAD_SEND_RATIO:
case TEGRA186_ARAD_CG:
case TEGRA186_ARAD_CYA_GLOBAL:
case TEGRA186_ARAD_LANE1_NUMERATOR_MUX_SEL:
case TEGRA186_ARAD_LANE1_NUMERATOR_PRESCALAR:
case TEGRA186_ARAD_LANE1_DENOMINATOR_MUX_SEL:
case TEGRA186_ARAD_LANE1_DENOMINATOR_PRESCALAR:
case TEGRA186_ARAD_LANE1_SERVO_LOOP_CONFIG:
case TEGRA186_ARAD_LANE1_LOCK_UNLOCK_DETECTOR_CONFIG:
case TEGRA186_ARAD_LANE1_ERROR_LOCK_THRESHOLD:
case TEGRA186_ARAD_LANE1_ERROR_UNLOCK_THRESHOLD:
case TEGRA186_ARAD_LANE1_RATIO_CALCULATOR_CONFIG:
case TEGRA186_ARAD_LANE1_CYA:
return true;
default:
return false;
};
}
static bool tegra186_arad_rd_reg(struct device *dev, unsigned int reg)
{
if ((reg >= TEGRA186_ARAD_LANE_START) &&
(reg <= TEGRA186_ARAD_LANE_LIMIT)) {
reg -= TEGRA186_ARAD_LANE_START;
reg %= TEGRA186_ARAD_LANE_STRIDE;
reg += TEGRA186_ARAD_LANE_START;
}
switch (reg) {
case TEGRA186_ARAD_LANE_ENABLE:
case TEGRA186_ARAD_LANE_STATUS:
case TEGRA186_ARAD_LANE_SOFT_RESET:
case TEGRA186_ARAD_LANE_INT_STATUS:
case TEGRA186_ARAD_LANE_INT_MASK:
case TEGRA186_ARAD_LANE_INT_SET:
case TEGRA186_ARAD_LANE_INT_CLEAR:
case TEGRA186_ARAD_GLOBAL_SOFT_RESET:
case TEGRA186_ARAD_CG:
case TEGRA186_ARAD_STATUS:
case TEGRA186_ARAD_CYA_GLOBAL:
case TEGRA186_ARAD_LANE1_NUMERATOR_MUX_SEL:
case TEGRA186_ARAD_LANE1_NUMERATOR_PRESCALAR:
case TEGRA186_ARAD_LANE1_DENOMINATOR_MUX_SEL:
case TEGRA186_ARAD_LANE1_DENOMINATOR_PRESCALAR:
case TEGRA186_ARAD_LANE1_RATIO_INTEGER_PART:
case TEGRA186_ARAD_LANE1_RATIO_FRACTIONAL_PART:
case TEGRA186_ARAD_LANE1_PERIOD_COUNT:
case TEGRA186_ARAD_LANE1_SERVO_LOOP_CONFIG:
case TEGRA186_ARAD_LANE1_LOCK_UNLOCK_DETECTOR_CONFIG:
case TEGRA186_ARAD_LANE1_ERROR_LOCK_THRESHOLD:
case TEGRA186_ARAD_LANE1_ERROR_UNLOCK_THRESHOLD:
case TEGRA186_ARAD_LANE1_RATIO_CALCULATOR_CONFIG:
case TEGRA186_ARAD_LANE1_CYA:
return true;
default:
return false;
};
}
static bool tegra186_arad_volatile_reg(struct device *dev, unsigned int reg)
{
if ((reg >= TEGRA186_ARAD_LANE_START) &&
(reg <= TEGRA186_ARAD_LANE_LIMIT)) {
reg -= TEGRA186_ARAD_LANE_START;
reg %= TEGRA186_ARAD_LANE_STRIDE;
reg += TEGRA186_ARAD_LANE_START;
}
switch (reg) {
case TEGRA186_ARAD_LANE_STATUS:
case TEGRA186_ARAD_LANE_INT_STATUS:
case TEGRA186_ARAD_STATUS:
case TEGRA186_ARAD_LANE1_RATIO_INTEGER_PART:
case TEGRA186_ARAD_LANE1_RATIO_FRACTIONAL_PART:
case TEGRA186_ARAD_LANE1_PERIOD_COUNT:
return true;
default:
return false;
};
}
static const struct regmap_config tegra186_arad_regmap_config = {
.reg_bits = 32,
.reg_stride = 4,
.val_bits = 32,
.max_register = TEGRA186_ARAD_TX_CIF_CTRL,
.writeable_reg = tegra186_arad_wr_reg,
.readable_reg = tegra186_arad_rd_reg,
.volatile_reg = tegra186_arad_volatile_reg,
.reg_defaults = tegra186_arad_reg_defaults,
.num_reg_defaults = ARRAY_SIZE(tegra186_arad_reg_defaults),
.cache_type = REGCACHE_FLAT,
};
static const struct of_device_id tegra186_arad_of_match[] = {
{ .compatible = "nvidia,tegra186-arad" },
{},
};
#ifdef CONFIG_SND_SOC_TEGRA186_ARAD_WAR
static void tegra186_arad_ahc_cb(void *data)
{
int i = 0;
unsigned int val = 0, status;
struct tegra186_arad *arad = dev_get_drvdata(
(struct device *) data);
/* WAR for Bug 200102368 */
regmap_read(arad->regmap,
TEGRA186_ARAD_LANE_INT_STATUS, &status);
for (i = 0; i < TEGRA186_ARAD_LANE_MAX; i++) {
if ((1 << i) & status) {
/*Its a case where interrupt is because the lane
is unlocked */
regmap_read(arad->regmap,
TEGRA186_ARAD_LANE_ENABLE, &val);
val |= 1<<i;
regmap_write(arad->regmap,
TEGRA186_ARAD_LANE_INT_CLEAR, 1<<i);
regmap_write(arad->regmap,
TEGRA186_ARAD_LANE_SOFT_RESET, 1<<i);
regmap_write(arad->regmap,
TEGRA186_ARAD_LANE_ENABLE, val);
val = 0;
} else if (tegra186_arad_get_lane_ratio_change_status(arad, i)) {
/*Its a case where interrupt is because of
ratio change, clear the interrupt*/
regmap_write(arad->regmap,
TEGRA186_ARAD_LANE_INT_CLEAR,
1<<(TEGRA186_ARAD_LANE_INT_RATIO_CHANGE_SHIFT+i));
}
}
spin_lock(&arad->status_lock);
arad->int_status = status;
spin_unlock(&arad->status_lock);
}
#ifdef CONFIG_SND_SOC_TEGRA186_ASRC_WAR
void tegra186_arad_ahc_deferred_cb(void *data)
{
struct tegra186_arad *arad = dev_get_drvdata(
(struct device *)data);
int i = 0, inte = 0, frac = 0;
unsigned int status;
spin_lock(&arad->status_lock);
status = &arad->int_status;
spin_unlock(&arad->status_lock);
for (i = 0; i < TEGRA186_ARAD_LANE_MAX; i++) {
if ((1 << i) & status)
tegra186_asrc_handle_arad_unlock(i, 0);
else if (tegra186_arad_get_lane_lock_status(arad, i) &&
tegra186_arad_get_lane_ratio_change_status(arad, i)) {
regmap_read(arad->regmap, ARAD_LANE_REG(
TEGRA186_ARAD_LANE1_RATIO_INTEGER_PART,
i), &inte);
regmap_read(arad->regmap, ARAD_LANE_REG(
TEGRA186_ARAD_LANE1_RATIO_FRACTIONAL_PART,
i), &frac);
/* source SW:1 and ARAD:0 */
tegra186_asrc_set_source(i, 1);
tegra186_asrc_update_ratio(i, inte, frac);
tegra186_asrc_set_source(i, 0);
tegra186_asrc_handle_arad_unlock(i, 1);
}
}
}
#endif
#endif
static int tegra186_arad_platform_probe(struct platform_device *pdev)
{
struct tegra186_arad *arad;
struct resource *mem;
void __iomem *regs;
int ret = 0;
const struct of_device_id *match;
match = of_match_device(tegra186_arad_of_match, &pdev->dev);
if (!match) {
dev_err(&pdev->dev, "Error: No device match found\n");
return -ENODEV;
}
arad = devm_kzalloc(&pdev->dev, sizeof(*arad), GFP_KERNEL);
if (!arad)
return -ENOMEM;
arad_dev = &pdev->dev;
dev_set_drvdata(&pdev->dev, arad);
mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
regs = devm_ioremap_resource(&pdev->dev, mem);
if (IS_ERR(regs))
return PTR_ERR(regs);
arad->regmap = devm_regmap_init_mmio(&pdev->dev, regs,
&tegra186_arad_regmap_config);
if (IS_ERR(arad->regmap)) {
dev_err(&pdev->dev, "regmap init failed\n");
return PTR_ERR(arad->regmap);
}
regcache_cache_only(arad->regmap, true);
ret = of_property_read_u32(pdev->dev.of_node, "nvidia,ahub-arad-id",
&pdev->dev.id);
if (ret < 0) {
dev_err(&pdev->dev, "Missing property nvidia,ahub-arad-id\n");
return ret;
}
pm_runtime_enable(&pdev->dev);
ret = snd_soc_register_codec(&pdev->dev, &tegra186_arad_codec,
tegra186_arad_dais,
ARRAY_SIZE(tegra186_arad_dais));
if (ret != 0) {
dev_err(&pdev->dev, "Could not register CODEC: %d\n", ret);
pm_runtime_disable(&pdev->dev);
return ret;
}
#ifdef CONFIG_SND_SOC_TEGRA186_ARAD_WAR
spin_lock_init(&arad->status_lock);
tegra186_ahc_register_cb(tegra186_arad_ahc_cb,
TEGRA186_AHC_ARAD1_CB, &pdev->dev);
#ifdef CONFIG_SND_SOC_TEGRA186_ASRC_WAR
tegra186_ahc_register_deferred_cb(tegra186_arad_ahc_deferred_cb,
TEGRA186_AHC_ARAD1_CB, &pdev->dev);
#endif
#endif
return 0;
}
static int tegra186_arad_platform_remove(struct platform_device *pdev)
{
snd_soc_unregister_codec(&pdev->dev);
pm_runtime_disable(&pdev->dev);
if (!pm_runtime_status_suspended(&pdev->dev))
tegra186_arad_runtime_suspend(&pdev->dev);
return 0;
}
static const struct dev_pm_ops tegra186_arad_pm_ops = {
SET_RUNTIME_PM_OPS(tegra186_arad_runtime_suspend,
tegra186_arad_runtime_resume, NULL)
SET_LATE_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
pm_runtime_force_resume)
};
static struct platform_driver tegra186_arad_driver = {
.driver = {
.name = DRV_NAME,
.owner = THIS_MODULE,
.of_match_table = tegra186_arad_of_match,
.pm = &tegra186_arad_pm_ops,
},
.probe = tegra186_arad_platform_probe,
.remove = tegra186_arad_platform_remove,
};
module_platform_driver(tegra186_arad_driver)
MODULE_AUTHOR("Junghyun Kim <juskim@nvidia.com>");
MODULE_DESCRIPTION("Tegra186 ARAD ASoC driver");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:" DRV_NAME);
MODULE_DEVICE_TABLE(of, tegra186_arad_of_match);