| // SPDX-License-Identifier: GPL-2.0-only |
| // |
| // tegra210_mvc.c - Tegra210 MVC driver |
| // |
| // Copyright (c) 2021 NVIDIA CORPORATION. All rights reserved. |
| |
| #include <linux/clk.h> |
| #include <linux/device.h> |
| #include <linux/io.h> |
| #include <linux/module.h> |
| #include <linux/of.h> |
| #include <linux/of_device.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 "tegra210_mvc.h" |
| #include "tegra_cif.h" |
| |
| static const struct reg_default tegra210_mvc_reg_defaults[] = { |
| { TEGRA210_MVC_RX_INT_MASK, 0x00000001}, |
| { TEGRA210_MVC_RX_CIF_CTRL, 0x00007700}, |
| { TEGRA210_MVC_TX_INT_MASK, 0x00000001}, |
| { TEGRA210_MVC_TX_CIF_CTRL, 0x00007700}, |
| { TEGRA210_MVC_CG, 0x1}, |
| { TEGRA210_MVC_CTRL, TEGRA210_MVC_CTRL_DEFAULT}, |
| { TEGRA210_MVC_INIT_VOL, 0x00800000}, |
| { TEGRA210_MVC_TARGET_VOL, 0x00800000}, |
| { TEGRA210_MVC_DURATION, 0x000012c0}, |
| { TEGRA210_MVC_DURATION_INV, 0x0006d3a0}, |
| { TEGRA210_MVC_POLY_N1, 0x0000007d}, |
| { TEGRA210_MVC_POLY_N2, 0x00000271}, |
| { TEGRA210_MVC_PEAK_CTRL, 0x000012c0}, |
| { TEGRA210_MVC_CFG_RAM_CTRL, 0x00004000}, |
| }; |
| |
| static const struct tegra210_mvc_gain_params gain_params = { |
| .poly_coeff = { 23738319, 659403, -3680, |
| 15546680, 2530732, -120985, |
| 12048422, 5527252, -785042 }, |
| .poly_n1 = 16, |
| .poly_n2 = 63, |
| .duration = 150, |
| .duration_inv = 14316558, |
| }; |
| |
| static int __maybe_unused tegra210_mvc_runtime_suspend(struct device *dev) |
| { |
| struct tegra210_mvc *mvc = dev_get_drvdata(dev); |
| |
| regmap_read(mvc->regmap, TEGRA210_MVC_CTRL, &(mvc->ctrl_value)); |
| |
| regcache_cache_only(mvc->regmap, true); |
| regcache_mark_dirty(mvc->regmap); |
| |
| return 0; |
| } |
| |
| static int __maybe_unused tegra210_mvc_runtime_resume(struct device *dev) |
| { |
| struct tegra210_mvc *mvc = dev_get_drvdata(dev); |
| |
| regcache_cache_only(mvc->regmap, false); |
| regcache_sync(mvc->regmap); |
| |
| regmap_write(mvc->regmap, TEGRA210_MVC_CTRL, mvc->ctrl_value); |
| regmap_update_bits(mvc->regmap, |
| TEGRA210_MVC_SWITCH, |
| TEGRA210_MVC_VOLUME_SWITCH_MASK, |
| TEGRA210_MVC_VOLUME_SWITCH_TRIGGER); |
| |
| return 0; |
| } |
| |
| static void tegra210_mvc_write_ram(struct regmap *regmap) |
| { |
| int i; |
| |
| regmap_write(regmap, TEGRA210_MVC_CFG_RAM_CTRL, |
| TEGRA210_MVC_CFG_RAM_CTRL_SEQ_ACCESS_EN | |
| TEGRA210_MVC_CFG_RAM_CTRL_ADDR_INIT_EN | |
| TEGRA210_MVC_CFG_RAM_CTRL_RW_WRITE); |
| |
| for (i = 0; i < NUM_GAIN_POLY_COEFFS; i++) |
| regmap_write(regmap, TEGRA210_MVC_CFG_RAM_DATA, |
| gain_params.poly_coeff[i]); |
| } |
| |
| static void tegra210_mvc_conv_vol(struct tegra210_mvc *mvc, u8 chan, s32 val) |
| { |
| /* |
| * Volume control read from mixer control is with |
| * 100x scaling; for CURVE_POLY the reg range |
| * is 0-100 (linear, Q24) and for CURVE_LINEAR |
| * it is -120dB to +40dB (Q8) |
| */ |
| if (mvc->curve_type == CURVE_POLY) { |
| if (val > 10000) |
| val = 10000; |
| mvc->volume[chan] = ((val * (1<<8)) / 100) << 16; |
| } else { |
| val -= 12000; |
| mvc->volume[chan] = (val * (1<<8)) / 100; |
| } |
| } |
| |
| static int tegra210_mvc_get_mute(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol); |
| struct tegra210_mvc *mvc = snd_soc_component_get_drvdata(cmpnt); |
| u8 mute_mask; |
| u32 val; |
| |
| pm_runtime_get_sync(cmpnt->dev); |
| regmap_read(mvc->regmap, TEGRA210_MVC_CTRL, &val); |
| pm_runtime_put(cmpnt->dev); |
| |
| mute_mask = (val >> TEGRA210_MVC_MUTE_SHIFT) & |
| TEGRA210_MUTE_MASK_EN; |
| |
| ucontrol->value.integer.value[0] = mute_mask; |
| |
| return 0; |
| } |
| |
| static int tegra210_mvc_put_mute(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol); |
| struct tegra210_mvc *mvc = snd_soc_component_get_drvdata(cmpnt); |
| unsigned int value; |
| u8 new_mask, old_mask; |
| int err; |
| |
| pm_runtime_get_sync(cmpnt->dev); |
| |
| /* Check if VOLUME_SWITCH is triggered */ |
| err = regmap_read_poll_timeout(mvc->regmap, TEGRA210_MVC_SWITCH, |
| value, !(value & TEGRA210_MVC_VOLUME_SWITCH_MASK), |
| 10, 10000); |
| if (err < 0) |
| goto end; |
| |
| regmap_read(mvc->regmap, TEGRA210_MVC_CTRL, &value); |
| |
| old_mask = (value >> TEGRA210_MVC_MUTE_SHIFT) & TEGRA210_MUTE_MASK_EN; |
| new_mask = ucontrol->value.integer.value[0]; |
| |
| if (new_mask == old_mask) { |
| err = 0; |
| goto end; |
| } |
| |
| err = regmap_update_bits(mvc->regmap, mc->reg, |
| TEGRA210_MVC_MUTE_MASK, |
| new_mask << TEGRA210_MVC_MUTE_SHIFT); |
| if (err < 0) |
| goto end; |
| |
| return 1; |
| |
| end: |
| pm_runtime_put(cmpnt->dev); |
| return err; |
| } |
| |
| static int tegra210_mvc_get_vol(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol); |
| struct tegra210_mvc *mvc = snd_soc_component_get_drvdata(cmpnt); |
| u8 chan = (mc->reg - TEGRA210_MVC_TARGET_VOL) / REG_SIZE; |
| s32 val = mvc->volume[chan]; |
| |
| if (mvc->curve_type == CURVE_POLY) { |
| val = ((val >> 16) * 100) >> 8; |
| } else { |
| val = (val * 100) >> 8; |
| val += 12000; |
| } |
| |
| ucontrol->value.integer.value[0] = val; |
| |
| return 0; |
| } |
| |
| static int tegra210_mvc_put_vol(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct soc_mixer_control *mc = |
| (struct soc_mixer_control *)kcontrol->private_value; |
| struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol); |
| struct tegra210_mvc *mvc = snd_soc_component_get_drvdata(cmpnt); |
| unsigned int reg = mc->reg; |
| unsigned int value; |
| u8 chan; |
| int err, old_volume; |
| |
| pm_runtime_get_sync(cmpnt->dev); |
| |
| /* Check if VOLUME_SWITCH is triggered */ |
| err = regmap_read_poll_timeout(mvc->regmap, TEGRA210_MVC_SWITCH, |
| value, !(value & TEGRA210_MVC_VOLUME_SWITCH_MASK), |
| 10, 10000); |
| if (err < 0) |
| goto end; |
| |
| chan = (reg - TEGRA210_MVC_TARGET_VOL) / REG_SIZE; |
| old_volume = mvc->volume[chan]; |
| |
| tegra210_mvc_conv_vol(mvc, chan, |
| ucontrol->value.integer.value[0]); |
| |
| if (mvc->volume[chan] == old_volume) { |
| err = 0; |
| goto end; |
| } |
| |
| /* Configure init volume same as target volume */ |
| regmap_write(mvc->regmap, |
| TEGRA210_MVC_REG_OFFSET(TEGRA210_MVC_INIT_VOL, chan), |
| mvc->volume[chan]); |
| |
| regmap_write(mvc->regmap, reg, mvc->volume[chan]); |
| |
| regmap_update_bits(mvc->regmap, TEGRA210_MVC_SWITCH, |
| TEGRA210_MVC_VOLUME_SWITCH_MASK, |
| TEGRA210_MVC_VOLUME_SWITCH_TRIGGER); |
| |
| return 1; |
| |
| end: |
| pm_runtime_put(cmpnt->dev); |
| return err; |
| } |
| |
| static void tegra210_mvc_reset_vol_settings(struct tegra210_mvc *mvc, |
| struct device *dev) |
| { |
| int i; |
| |
| /* Change volume to default init for new curve type */ |
| if (mvc->curve_type == CURVE_POLY) { |
| for (i = 0; i < TEGRA210_MVC_MAX_CHAN_COUNT; i++) |
| mvc->volume[i] = TEGRA210_MVC_INIT_VOL_DEFAULT_POLY; |
| } else { |
| for (i = 0; i < TEGRA210_MVC_MAX_CHAN_COUNT; i++) |
| mvc->volume[i] = TEGRA210_MVC_INIT_VOL_DEFAULT_LINEAR; |
| } |
| |
| pm_runtime_get_sync(dev); |
| |
| /* Program curve type */ |
| regmap_update_bits(mvc->regmap, TEGRA210_MVC_CTRL, |
| TEGRA210_MVC_CURVE_TYPE_MASK, |
| mvc->curve_type << |
| TEGRA210_MVC_CURVE_TYPE_SHIFT); |
| |
| /* Init volume for all channels */ |
| for (i = 0; i < TEGRA210_MVC_MAX_CHAN_COUNT; i++) { |
| regmap_write(mvc->regmap, |
| TEGRA210_MVC_REG_OFFSET(TEGRA210_MVC_INIT_VOL, i), |
| mvc->volume[i]); |
| regmap_write(mvc->regmap, |
| TEGRA210_MVC_REG_OFFSET(TEGRA210_MVC_TARGET_VOL, i), |
| mvc->volume[i]); |
| } |
| |
| /* Trigger volume switch */ |
| regmap_update_bits(mvc->regmap, TEGRA210_MVC_SWITCH, |
| TEGRA210_MVC_VOLUME_SWITCH_MASK, |
| TEGRA210_MVC_VOLUME_SWITCH_TRIGGER); |
| |
| pm_runtime_put(dev); |
| } |
| |
| static int tegra210_mvc_get_curve_type(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol); |
| struct tegra210_mvc *mvc = snd_soc_component_get_drvdata(cmpnt); |
| |
| ucontrol->value.enumerated.item[0] = mvc->curve_type; |
| |
| return 0; |
| } |
| |
| static int tegra210_mvc_put_curve_type(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol); |
| struct tegra210_mvc *mvc = snd_soc_component_get_drvdata(cmpnt); |
| unsigned int value; |
| |
| regmap_read(mvc->regmap, TEGRA210_MVC_ENABLE, &value); |
| if (value & TEGRA210_MVC_EN) { |
| dev_err(cmpnt->dev, |
| "Curve type can't be set when MVC is running\n"); |
| return -EINVAL; |
| } |
| |
| if (mvc->curve_type == ucontrol->value.enumerated.item[0]) |
| return 0; |
| |
| mvc->curve_type = ucontrol->value.enumerated.item[0]; |
| |
| tegra210_mvc_reset_vol_settings(mvc, cmpnt->dev); |
| |
| return 1; |
| } |
| |
| static int tegra210_mvc_set_audio_cif(struct tegra210_mvc *mvc, |
| struct snd_pcm_hw_params *params, |
| unsigned int reg) |
| { |
| unsigned int channels, audio_bits; |
| struct tegra_cif_conf cif_conf; |
| |
| memset(&cif_conf, 0, sizeof(struct tegra_cif_conf)); |
| |
| channels = params_channels(params); |
| |
| switch (params_format(params)) { |
| case SNDRV_PCM_FORMAT_S16_LE: |
| audio_bits = TEGRA_ACIF_BITS_16; |
| break; |
| case SNDRV_PCM_FORMAT_S32_LE: |
| audio_bits = TEGRA_ACIF_BITS_32; |
| break; |
| default: |
| return -EINVAL; |
| } |
| |
| cif_conf.audio_ch = channels; |
| cif_conf.client_ch = channels; |
| cif_conf.audio_bits = audio_bits; |
| cif_conf.client_bits = audio_bits; |
| |
| tegra_set_cif(mvc->regmap, reg, &cif_conf); |
| |
| return 0; |
| } |
| |
| static int tegra210_mvc_hw_params(struct snd_pcm_substream *substream, |
| struct snd_pcm_hw_params *params, |
| struct snd_soc_dai *dai) |
| { |
| struct device *dev = dai->dev; |
| struct tegra210_mvc *mvc = snd_soc_dai_get_drvdata(dai); |
| int err, val; |
| |
| /* |
| * Soft Reset: Below performs module soft reset which clears |
| * all FSM logic, flushes flow control of FIFO and resets the |
| * state register. It also brings module back to disabled |
| * state (without flushing the data in the pipe). |
| */ |
| regmap_write(mvc->regmap, TEGRA210_MVC_SOFT_RESET, 1); |
| |
| err = regmap_read_poll_timeout(mvc->regmap, TEGRA210_MVC_SOFT_RESET, |
| val, !val, 10, 10000); |
| if (err < 0) { |
| dev_err(dev, "SW reset failed, err = %d\n", err); |
| return err; |
| } |
| |
| /* Set RX CIF */ |
| err = tegra210_mvc_set_audio_cif(mvc, params, TEGRA210_MVC_RX_CIF_CTRL); |
| if (err) { |
| dev_err(dev, "Can't set MVC RX CIF: %d\n", err); |
| return err; |
| } |
| |
| /* Set TX CIF */ |
| err = tegra210_mvc_set_audio_cif(mvc, params, TEGRA210_MVC_TX_CIF_CTRL); |
| if (err) { |
| dev_err(dev, "Can't set MVC TX CIF: %d\n", err); |
| return err; |
| } |
| |
| tegra210_mvc_write_ram(mvc->regmap); |
| |
| /* Program poly_n1, poly_n2, duration */ |
| regmap_write(mvc->regmap, TEGRA210_MVC_POLY_N1, gain_params.poly_n1); |
| regmap_write(mvc->regmap, TEGRA210_MVC_POLY_N2, gain_params.poly_n2); |
| regmap_write(mvc->regmap, TEGRA210_MVC_DURATION, gain_params.duration); |
| |
| /* Program duration_inv */ |
| regmap_write(mvc->regmap, TEGRA210_MVC_DURATION_INV, |
| gain_params.duration_inv); |
| |
| return 0; |
| } |
| |
| static const struct snd_soc_dai_ops tegra210_mvc_dai_ops = { |
| .hw_params = tegra210_mvc_hw_params, |
| }; |
| |
| static const char * const tegra210_mvc_curve_type_text[] = { |
| "Poly", |
| "Linear", |
| }; |
| |
| static const struct soc_enum tegra210_mvc_curve_type_ctrl = |
| SOC_ENUM_SINGLE_EXT(2, tegra210_mvc_curve_type_text); |
| |
| #define TEGRA210_MVC_VOL_CTRL(chan) \ |
| SOC_SINGLE_EXT("Channel" #chan " Volume", \ |
| TEGRA210_MVC_REG_OFFSET(TEGRA210_MVC_TARGET_VOL, \ |
| (chan - 1)), \ |
| 0, 16000, 0, tegra210_mvc_get_vol, \ |
| tegra210_mvc_put_vol) |
| |
| static const struct snd_kcontrol_new tegra210_mvc_vol_ctrl[] = { |
| /* Per channel volume control */ |
| TEGRA210_MVC_VOL_CTRL(1), |
| TEGRA210_MVC_VOL_CTRL(2), |
| TEGRA210_MVC_VOL_CTRL(3), |
| TEGRA210_MVC_VOL_CTRL(4), |
| TEGRA210_MVC_VOL_CTRL(5), |
| TEGRA210_MVC_VOL_CTRL(6), |
| TEGRA210_MVC_VOL_CTRL(7), |
| TEGRA210_MVC_VOL_CTRL(8), |
| |
| /* Per channel mute */ |
| SOC_SINGLE_EXT("Per Chan Mute Mask", |
| TEGRA210_MVC_CTRL, 0, TEGRA210_MUTE_MASK_EN, 0, |
| tegra210_mvc_get_mute, tegra210_mvc_put_mute), |
| |
| SOC_ENUM_EXT("Curve Type", tegra210_mvc_curve_type_ctrl, |
| tegra210_mvc_get_curve_type, tegra210_mvc_put_curve_type), |
| }; |
| |
| static struct snd_soc_dai_driver tegra210_mvc_dais[] = { |
| /* Input */ |
| { |
| .name = "MVC-RX-CIF", |
| .playback = { |
| .stream_name = "RX-CIF-Playback", |
| .channels_min = 1, |
| .channels_max = 8, |
| .rates = SNDRV_PCM_RATE_8000_192000, |
| .formats = SNDRV_PCM_FMTBIT_S8 | |
| SNDRV_PCM_FMTBIT_S16_LE | |
| SNDRV_PCM_FMTBIT_S32_LE, |
| }, |
| .capture = { |
| .stream_name = "RX-CIF-Capture", |
| .channels_min = 1, |
| .channels_max = 8, |
| .rates = SNDRV_PCM_RATE_8000_192000, |
| .formats = SNDRV_PCM_FMTBIT_S8 | |
| SNDRV_PCM_FMTBIT_S16_LE | |
| SNDRV_PCM_FMTBIT_S32_LE, |
| }, |
| }, |
| |
| /* Output */ |
| { |
| .name = "MVC-TX-CIF", |
| .playback = { |
| .stream_name = "TX-CIF-Playback", |
| .channels_min = 1, |
| .channels_max = 8, |
| .rates = SNDRV_PCM_RATE_8000_192000, |
| .formats = SNDRV_PCM_FMTBIT_S8 | |
| SNDRV_PCM_FMTBIT_S16_LE | |
| SNDRV_PCM_FMTBIT_S32_LE, |
| }, |
| .capture = { |
| .stream_name = "TX-CIF-Capture", |
| .channels_min = 1, |
| .channels_max = 8, |
| .rates = SNDRV_PCM_RATE_8000_192000, |
| .formats = SNDRV_PCM_FMTBIT_S8 | |
| SNDRV_PCM_FMTBIT_S16_LE | |
| SNDRV_PCM_FMTBIT_S32_LE, |
| }, |
| .ops = &tegra210_mvc_dai_ops, |
| } |
| }; |
| |
| static const struct snd_soc_dapm_widget tegra210_mvc_widgets[] = { |
| SND_SOC_DAPM_AIF_IN("RX", NULL, 0, SND_SOC_NOPM, 0, 0), |
| SND_SOC_DAPM_AIF_OUT("TX", NULL, 0, TEGRA210_MVC_ENABLE, |
| TEGRA210_MVC_EN_SHIFT, 0), |
| }; |
| |
| #define MVC_ROUTES(sname) \ |
| { "RX XBAR-" sname, NULL, "XBAR-TX" }, \ |
| { "RX-CIF-" sname, NULL, "RX XBAR-" sname }, \ |
| { "RX", NULL, "RX-CIF-" sname }, \ |
| { "TX-CIF-" sname, NULL, "TX" }, \ |
| { "TX XBAR-" sname, NULL, "TX-CIF-" sname }, \ |
| { "XBAR-RX", NULL, "TX XBAR-" sname } |
| |
| static const struct snd_soc_dapm_route tegra210_mvc_routes[] = { |
| { "TX", NULL, "RX" }, |
| MVC_ROUTES("Playback"), |
| MVC_ROUTES("Capture"), |
| }; |
| |
| static const struct snd_soc_component_driver tegra210_mvc_cmpnt = { |
| .dapm_widgets = tegra210_mvc_widgets, |
| .num_dapm_widgets = ARRAY_SIZE(tegra210_mvc_widgets), |
| .dapm_routes = tegra210_mvc_routes, |
| .num_dapm_routes = ARRAY_SIZE(tegra210_mvc_routes), |
| .controls = tegra210_mvc_vol_ctrl, |
| .num_controls = ARRAY_SIZE(tegra210_mvc_vol_ctrl), |
| }; |
| |
| static bool tegra210_mvc_rd_reg(struct device *dev, unsigned int reg) |
| { |
| switch (reg) { |
| case TEGRA210_MVC_RX_STATUS ... TEGRA210_MVC_CONFIG_ERR_TYPE: |
| return true; |
| default: |
| return false; |
| }; |
| } |
| |
| static bool tegra210_mvc_wr_reg(struct device *dev, unsigned int reg) |
| { |
| switch (reg) { |
| case TEGRA210_MVC_RX_INT_MASK ... TEGRA210_MVC_RX_CIF_CTRL: |
| case TEGRA210_MVC_TX_INT_MASK ... TEGRA210_MVC_TX_CIF_CTRL: |
| case TEGRA210_MVC_ENABLE ... TEGRA210_MVC_CG: |
| case TEGRA210_MVC_CTRL ... TEGRA210_MVC_CFG_RAM_DATA: |
| return true; |
| default: |
| return false; |
| } |
| } |
| |
| static bool tegra210_mvc_volatile_reg(struct device *dev, unsigned int reg) |
| { |
| switch (reg) { |
| case TEGRA210_MVC_RX_STATUS: |
| case TEGRA210_MVC_RX_INT_STATUS: |
| case TEGRA210_MVC_RX_INT_SET: |
| |
| case TEGRA210_MVC_TX_STATUS: |
| case TEGRA210_MVC_TX_INT_STATUS: |
| case TEGRA210_MVC_TX_INT_SET: |
| |
| case TEGRA210_MVC_SOFT_RESET: |
| case TEGRA210_MVC_STATUS: |
| case TEGRA210_MVC_INT_STATUS: |
| case TEGRA210_MVC_SWITCH: |
| case TEGRA210_MVC_CFG_RAM_CTRL: |
| case TEGRA210_MVC_CFG_RAM_DATA: |
| case TEGRA210_MVC_PEAK_VALUE: |
| case TEGRA210_MVC_CTRL: |
| return true; |
| default: |
| return false; |
| } |
| } |
| |
| static const struct regmap_config tegra210_mvc_regmap_config = { |
| .reg_bits = 32, |
| .reg_stride = 4, |
| .val_bits = 32, |
| .max_register = TEGRA210_MVC_CONFIG_ERR_TYPE, |
| .writeable_reg = tegra210_mvc_wr_reg, |
| .readable_reg = tegra210_mvc_rd_reg, |
| .volatile_reg = tegra210_mvc_volatile_reg, |
| .reg_defaults = tegra210_mvc_reg_defaults, |
| .num_reg_defaults = ARRAY_SIZE(tegra210_mvc_reg_defaults), |
| .cache_type = REGCACHE_FLAT, |
| }; |
| |
| static const struct of_device_id tegra210_mvc_of_match[] = { |
| { .compatible = "nvidia,tegra210-mvc" }, |
| {}, |
| }; |
| MODULE_DEVICE_TABLE(of, tegra210_mvc_of_match); |
| |
| static int tegra210_mvc_platform_probe(struct platform_device *pdev) |
| { |
| struct device *dev = &pdev->dev; |
| struct tegra210_mvc *mvc; |
| void __iomem *regs; |
| int err; |
| |
| mvc = devm_kzalloc(dev, sizeof(*mvc), GFP_KERNEL); |
| if (!mvc) |
| return -ENOMEM; |
| |
| dev_set_drvdata(dev, mvc); |
| |
| mvc->curve_type = CURVE_LINEAR; |
| mvc->ctrl_value = TEGRA210_MVC_CTRL_DEFAULT; |
| |
| regs = devm_platform_ioremap_resource(pdev, 0); |
| if (IS_ERR(regs)) |
| return PTR_ERR(regs); |
| |
| mvc->regmap = devm_regmap_init_mmio(dev, regs, |
| &tegra210_mvc_regmap_config); |
| if (IS_ERR(mvc->regmap)) { |
| dev_err(dev, "regmap init failed\n"); |
| return PTR_ERR(mvc->regmap); |
| } |
| |
| regcache_cache_only(mvc->regmap, true); |
| |
| err = devm_snd_soc_register_component(dev, &tegra210_mvc_cmpnt, |
| tegra210_mvc_dais, |
| ARRAY_SIZE(tegra210_mvc_dais)); |
| if (err) { |
| dev_err(dev, "can't register MVC component, err: %d\n", err); |
| return err; |
| } |
| |
| pm_runtime_enable(dev); |
| |
| tegra210_mvc_reset_vol_settings(mvc, &pdev->dev); |
| |
| return 0; |
| } |
| |
| static int tegra210_mvc_platform_remove(struct platform_device *pdev) |
| { |
| pm_runtime_disable(&pdev->dev); |
| |
| return 0; |
| } |
| |
| static const struct dev_pm_ops tegra210_mvc_pm_ops = { |
| SET_RUNTIME_PM_OPS(tegra210_mvc_runtime_suspend, |
| tegra210_mvc_runtime_resume, NULL) |
| SET_LATE_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, |
| pm_runtime_force_resume) |
| }; |
| |
| static struct platform_driver tegra210_mvc_driver = { |
| .driver = { |
| .name = "tegra210-mvc", |
| .of_match_table = tegra210_mvc_of_match, |
| .pm = &tegra210_mvc_pm_ops, |
| }, |
| .probe = tegra210_mvc_platform_probe, |
| .remove = tegra210_mvc_platform_remove, |
| }; |
| module_platform_driver(tegra210_mvc_driver) |
| |
| MODULE_AUTHOR("Arun Shamanna Lakshmi <aruns@nvidia.com>"); |
| MODULE_DESCRIPTION("Tegra210 MVC ASoC driver"); |
| MODULE_LICENSE("GPL v2"); |