mirror of
https://github.com/torvalds/linux.git
synced 2024-11-29 23:51:37 +00:00
b17cf43d70
The .remove() callback for a platform driver returns an int which makes many driver authors wrongly assume it's possible to do error handling by returning an error code. However the value returned is (mostly) ignored and this typically results in resource leaks. To improve here there is a quest to make the remove callback return void. In the first step of this quest all drivers are converted to .remove_new() which already returns void. Trivially convert this driver from always returning zero in the remove callback to the void returning variant. Signed-off-by: Uwe Kleine-König <u.kleine-koenig@pengutronix.de> Acked-by: Takashi Iwai <tiwai@suse.de> Acked-by: Nicolas Ferre <nicolas.ferre@microchip.com> Link: https://lore.kernel.org/r/20230315150745.67084-160-u.kleine-koenig@pengutronix.de Signed-off-by: Mark Brown <broonie@kernel.org>
689 lines
18 KiB
C
689 lines
18 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* tegra30_ahub.c - Tegra30 AHUB driver
|
|
*
|
|
* Copyright (c) 2011,2012, NVIDIA CORPORATION. All rights reserved.
|
|
*/
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/device.h>
|
|
#include <linux/io.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of_platform.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/reset.h>
|
|
#include <linux/slab.h>
|
|
#include <sound/soc.h>
|
|
#include "tegra30_ahub.h"
|
|
|
|
#define DRV_NAME "tegra30-ahub"
|
|
|
|
static struct tegra30_ahub *ahub;
|
|
|
|
static inline void tegra30_apbif_write(u32 reg, u32 val)
|
|
{
|
|
regmap_write(ahub->regmap_apbif, reg, val);
|
|
}
|
|
|
|
static inline u32 tegra30_apbif_read(u32 reg)
|
|
{
|
|
u32 val;
|
|
|
|
regmap_read(ahub->regmap_apbif, reg, &val);
|
|
return val;
|
|
}
|
|
|
|
static inline void tegra30_audio_write(u32 reg, u32 val)
|
|
{
|
|
regmap_write(ahub->regmap_ahub, reg, val);
|
|
}
|
|
|
|
static __maybe_unused int tegra30_ahub_runtime_suspend(struct device *dev)
|
|
{
|
|
regcache_cache_only(ahub->regmap_apbif, true);
|
|
regcache_cache_only(ahub->regmap_ahub, true);
|
|
|
|
clk_bulk_disable_unprepare(ahub->nclocks, ahub->clocks);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* clk_apbif isn't required for an I2S<->I2S configuration where no PCM data
|
|
* is read from or sent to memory. However, that's not something the rest of
|
|
* the driver supports right now, so we'll just treat the two clocks as one
|
|
* for now.
|
|
*
|
|
* These functions should not be a plain ref-count. Instead, each active stream
|
|
* contributes some requirement to the minimum clock rate, so starting or
|
|
* stopping streams should dynamically adjust the clock as required. However,
|
|
* this is not yet implemented.
|
|
*/
|
|
static __maybe_unused int tegra30_ahub_runtime_resume(struct device *dev)
|
|
{
|
|
int ret;
|
|
|
|
ret = reset_control_bulk_assert(ahub->nresets, ahub->resets);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = clk_bulk_prepare_enable(ahub->nclocks, ahub->clocks);
|
|
if (ret)
|
|
return ret;
|
|
|
|
usleep_range(10, 100);
|
|
|
|
ret = reset_control_bulk_deassert(ahub->nresets, ahub->resets);
|
|
if (ret)
|
|
goto disable_clocks;
|
|
|
|
regcache_cache_only(ahub->regmap_apbif, false);
|
|
regcache_cache_only(ahub->regmap_ahub, false);
|
|
regcache_mark_dirty(ahub->regmap_apbif);
|
|
regcache_mark_dirty(ahub->regmap_ahub);
|
|
|
|
ret = regcache_sync(ahub->regmap_apbif);
|
|
if (ret)
|
|
goto disable_clocks;
|
|
|
|
ret = regcache_sync(ahub->regmap_ahub);
|
|
if (ret)
|
|
goto disable_clocks;
|
|
|
|
return 0;
|
|
|
|
disable_clocks:
|
|
clk_bulk_disable_unprepare(ahub->nclocks, ahub->clocks);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int tegra30_ahub_allocate_rx_fifo(enum tegra30_ahub_rxcif *rxcif,
|
|
char *dmachan, int dmachan_len,
|
|
dma_addr_t *fiforeg)
|
|
{
|
|
int channel;
|
|
u32 reg, val;
|
|
struct tegra30_ahub_cif_conf cif_conf;
|
|
|
|
channel = find_first_zero_bit(ahub->rx_usage,
|
|
TEGRA30_AHUB_CHANNEL_CTRL_COUNT);
|
|
if (channel >= TEGRA30_AHUB_CHANNEL_CTRL_COUNT)
|
|
return -EBUSY;
|
|
|
|
__set_bit(channel, ahub->rx_usage);
|
|
|
|
*rxcif = TEGRA30_AHUB_RXCIF_APBIF_RX0 + channel;
|
|
snprintf(dmachan, dmachan_len, "rx%d", channel);
|
|
*fiforeg = ahub->apbif_addr + TEGRA30_AHUB_CHANNEL_RXFIFO +
|
|
(channel * TEGRA30_AHUB_CHANNEL_RXFIFO_STRIDE);
|
|
|
|
pm_runtime_get_sync(ahub->dev);
|
|
|
|
reg = TEGRA30_AHUB_CHANNEL_CTRL +
|
|
(channel * TEGRA30_AHUB_CHANNEL_CTRL_STRIDE);
|
|
val = tegra30_apbif_read(reg);
|
|
val &= ~(TEGRA30_AHUB_CHANNEL_CTRL_RX_THRESHOLD_MASK |
|
|
TEGRA30_AHUB_CHANNEL_CTRL_RX_PACK_MASK);
|
|
val |= (7 << TEGRA30_AHUB_CHANNEL_CTRL_RX_THRESHOLD_SHIFT) |
|
|
TEGRA30_AHUB_CHANNEL_CTRL_RX_PACK_EN |
|
|
TEGRA30_AHUB_CHANNEL_CTRL_RX_PACK_16;
|
|
tegra30_apbif_write(reg, val);
|
|
|
|
cif_conf.threshold = 0;
|
|
cif_conf.audio_channels = 2;
|
|
cif_conf.client_channels = 2;
|
|
cif_conf.audio_bits = TEGRA30_AUDIOCIF_BITS_16;
|
|
cif_conf.client_bits = TEGRA30_AUDIOCIF_BITS_16;
|
|
cif_conf.expand = 0;
|
|
cif_conf.stereo_conv = 0;
|
|
cif_conf.replicate = 0;
|
|
cif_conf.direction = TEGRA30_AUDIOCIF_DIRECTION_RX;
|
|
cif_conf.truncate = 0;
|
|
cif_conf.mono_conv = 0;
|
|
|
|
reg = TEGRA30_AHUB_CIF_RX_CTRL +
|
|
(channel * TEGRA30_AHUB_CIF_RX_CTRL_STRIDE);
|
|
ahub->soc_data->set_audio_cif(ahub->regmap_apbif, reg, &cif_conf);
|
|
|
|
pm_runtime_put(ahub->dev);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(tegra30_ahub_allocate_rx_fifo);
|
|
|
|
int tegra30_ahub_enable_rx_fifo(enum tegra30_ahub_rxcif rxcif)
|
|
{
|
|
int channel = rxcif - TEGRA30_AHUB_RXCIF_APBIF_RX0;
|
|
int reg, val;
|
|
|
|
pm_runtime_get_sync(ahub->dev);
|
|
|
|
reg = TEGRA30_AHUB_CHANNEL_CTRL +
|
|
(channel * TEGRA30_AHUB_CHANNEL_CTRL_STRIDE);
|
|
val = tegra30_apbif_read(reg);
|
|
val |= TEGRA30_AHUB_CHANNEL_CTRL_RX_EN;
|
|
tegra30_apbif_write(reg, val);
|
|
|
|
pm_runtime_put(ahub->dev);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(tegra30_ahub_enable_rx_fifo);
|
|
|
|
int tegra30_ahub_disable_rx_fifo(enum tegra30_ahub_rxcif rxcif)
|
|
{
|
|
int channel = rxcif - TEGRA30_AHUB_RXCIF_APBIF_RX0;
|
|
int reg, val;
|
|
|
|
pm_runtime_get_sync(ahub->dev);
|
|
|
|
reg = TEGRA30_AHUB_CHANNEL_CTRL +
|
|
(channel * TEGRA30_AHUB_CHANNEL_CTRL_STRIDE);
|
|
val = tegra30_apbif_read(reg);
|
|
val &= ~TEGRA30_AHUB_CHANNEL_CTRL_RX_EN;
|
|
tegra30_apbif_write(reg, val);
|
|
|
|
pm_runtime_put(ahub->dev);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(tegra30_ahub_disable_rx_fifo);
|
|
|
|
int tegra30_ahub_free_rx_fifo(enum tegra30_ahub_rxcif rxcif)
|
|
{
|
|
int channel = rxcif - TEGRA30_AHUB_RXCIF_APBIF_RX0;
|
|
|
|
__clear_bit(channel, ahub->rx_usage);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(tegra30_ahub_free_rx_fifo);
|
|
|
|
int tegra30_ahub_allocate_tx_fifo(enum tegra30_ahub_txcif *txcif,
|
|
char *dmachan, int dmachan_len,
|
|
dma_addr_t *fiforeg)
|
|
{
|
|
int channel;
|
|
u32 reg, val;
|
|
struct tegra30_ahub_cif_conf cif_conf;
|
|
|
|
channel = find_first_zero_bit(ahub->tx_usage,
|
|
TEGRA30_AHUB_CHANNEL_CTRL_COUNT);
|
|
if (channel >= TEGRA30_AHUB_CHANNEL_CTRL_COUNT)
|
|
return -EBUSY;
|
|
|
|
__set_bit(channel, ahub->tx_usage);
|
|
|
|
*txcif = TEGRA30_AHUB_TXCIF_APBIF_TX0 + channel;
|
|
snprintf(dmachan, dmachan_len, "tx%d", channel);
|
|
*fiforeg = ahub->apbif_addr + TEGRA30_AHUB_CHANNEL_TXFIFO +
|
|
(channel * TEGRA30_AHUB_CHANNEL_TXFIFO_STRIDE);
|
|
|
|
pm_runtime_get_sync(ahub->dev);
|
|
|
|
reg = TEGRA30_AHUB_CHANNEL_CTRL +
|
|
(channel * TEGRA30_AHUB_CHANNEL_CTRL_STRIDE);
|
|
val = tegra30_apbif_read(reg);
|
|
val &= ~(TEGRA30_AHUB_CHANNEL_CTRL_TX_THRESHOLD_MASK |
|
|
TEGRA30_AHUB_CHANNEL_CTRL_TX_PACK_MASK);
|
|
val |= (7 << TEGRA30_AHUB_CHANNEL_CTRL_TX_THRESHOLD_SHIFT) |
|
|
TEGRA30_AHUB_CHANNEL_CTRL_TX_PACK_EN |
|
|
TEGRA30_AHUB_CHANNEL_CTRL_TX_PACK_16;
|
|
tegra30_apbif_write(reg, val);
|
|
|
|
cif_conf.threshold = 0;
|
|
cif_conf.audio_channels = 2;
|
|
cif_conf.client_channels = 2;
|
|
cif_conf.audio_bits = TEGRA30_AUDIOCIF_BITS_16;
|
|
cif_conf.client_bits = TEGRA30_AUDIOCIF_BITS_16;
|
|
cif_conf.expand = 0;
|
|
cif_conf.stereo_conv = 0;
|
|
cif_conf.replicate = 0;
|
|
cif_conf.direction = TEGRA30_AUDIOCIF_DIRECTION_TX;
|
|
cif_conf.truncate = 0;
|
|
cif_conf.mono_conv = 0;
|
|
|
|
reg = TEGRA30_AHUB_CIF_TX_CTRL +
|
|
(channel * TEGRA30_AHUB_CIF_TX_CTRL_STRIDE);
|
|
ahub->soc_data->set_audio_cif(ahub->regmap_apbif, reg, &cif_conf);
|
|
|
|
pm_runtime_put(ahub->dev);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(tegra30_ahub_allocate_tx_fifo);
|
|
|
|
int tegra30_ahub_enable_tx_fifo(enum tegra30_ahub_txcif txcif)
|
|
{
|
|
int channel = txcif - TEGRA30_AHUB_TXCIF_APBIF_TX0;
|
|
int reg, val;
|
|
|
|
pm_runtime_get_sync(ahub->dev);
|
|
|
|
reg = TEGRA30_AHUB_CHANNEL_CTRL +
|
|
(channel * TEGRA30_AHUB_CHANNEL_CTRL_STRIDE);
|
|
val = tegra30_apbif_read(reg);
|
|
val |= TEGRA30_AHUB_CHANNEL_CTRL_TX_EN;
|
|
tegra30_apbif_write(reg, val);
|
|
|
|
pm_runtime_put(ahub->dev);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(tegra30_ahub_enable_tx_fifo);
|
|
|
|
int tegra30_ahub_disable_tx_fifo(enum tegra30_ahub_txcif txcif)
|
|
{
|
|
int channel = txcif - TEGRA30_AHUB_TXCIF_APBIF_TX0;
|
|
int reg, val;
|
|
|
|
pm_runtime_get_sync(ahub->dev);
|
|
|
|
reg = TEGRA30_AHUB_CHANNEL_CTRL +
|
|
(channel * TEGRA30_AHUB_CHANNEL_CTRL_STRIDE);
|
|
val = tegra30_apbif_read(reg);
|
|
val &= ~TEGRA30_AHUB_CHANNEL_CTRL_TX_EN;
|
|
tegra30_apbif_write(reg, val);
|
|
|
|
pm_runtime_put(ahub->dev);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(tegra30_ahub_disable_tx_fifo);
|
|
|
|
int tegra30_ahub_free_tx_fifo(enum tegra30_ahub_txcif txcif)
|
|
{
|
|
int channel = txcif - TEGRA30_AHUB_TXCIF_APBIF_TX0;
|
|
|
|
__clear_bit(channel, ahub->tx_usage);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(tegra30_ahub_free_tx_fifo);
|
|
|
|
int tegra30_ahub_set_rx_cif_source(enum tegra30_ahub_rxcif rxcif,
|
|
enum tegra30_ahub_txcif txcif)
|
|
{
|
|
int channel = rxcif - TEGRA30_AHUB_RXCIF_APBIF_RX0;
|
|
int reg;
|
|
|
|
pm_runtime_get_sync(ahub->dev);
|
|
|
|
reg = TEGRA30_AHUB_AUDIO_RX +
|
|
(channel * TEGRA30_AHUB_AUDIO_RX_STRIDE);
|
|
tegra30_audio_write(reg, 1 << txcif);
|
|
|
|
pm_runtime_put(ahub->dev);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(tegra30_ahub_set_rx_cif_source);
|
|
|
|
int tegra30_ahub_unset_rx_cif_source(enum tegra30_ahub_rxcif rxcif)
|
|
{
|
|
int channel = rxcif - TEGRA30_AHUB_RXCIF_APBIF_RX0;
|
|
int reg;
|
|
|
|
pm_runtime_get_sync(ahub->dev);
|
|
|
|
reg = TEGRA30_AHUB_AUDIO_RX +
|
|
(channel * TEGRA30_AHUB_AUDIO_RX_STRIDE);
|
|
tegra30_audio_write(reg, 0);
|
|
|
|
pm_runtime_put(ahub->dev);
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(tegra30_ahub_unset_rx_cif_source);
|
|
|
|
static const struct reset_control_bulk_data tegra30_ahub_resets_data[] = {
|
|
{ "d_audio" },
|
|
{ "apbif" },
|
|
{ "i2s0" },
|
|
{ "i2s1" },
|
|
{ "i2s2" },
|
|
{ "i2s3" },
|
|
{ "i2s4" },
|
|
{ "dam0" },
|
|
{ "dam1" },
|
|
{ "dam2" },
|
|
{ "spdif" },
|
|
{ "amx" }, /* Tegra114+ */
|
|
{ "adx" }, /* Tegra114+ */
|
|
{ "amx1" }, /* Tegra124 */
|
|
{ "adx1" }, /* Tegra124 */
|
|
{ "afc0" }, /* Tegra124 */
|
|
{ "afc1" }, /* Tegra124 */
|
|
{ "afc2" }, /* Tegra124 */
|
|
{ "afc3" }, /* Tegra124 */
|
|
{ "afc4" }, /* Tegra124 */
|
|
{ "afc5" }, /* Tegra124 */
|
|
};
|
|
|
|
#define LAST_REG(name) \
|
|
(TEGRA30_AHUB_##name + \
|
|
(TEGRA30_AHUB_##name##_STRIDE * TEGRA30_AHUB_##name##_COUNT) - 4)
|
|
|
|
#define REG_IN_ARRAY(reg, name) \
|
|
((reg >= TEGRA30_AHUB_##name) && \
|
|
(reg <= LAST_REG(name) && \
|
|
(!((reg - TEGRA30_AHUB_##name) % TEGRA30_AHUB_##name##_STRIDE))))
|
|
|
|
static bool tegra30_ahub_apbif_wr_rd_reg(struct device *dev, unsigned int reg)
|
|
{
|
|
switch (reg) {
|
|
case TEGRA30_AHUB_CONFIG_LINK_CTRL:
|
|
case TEGRA30_AHUB_MISC_CTRL:
|
|
case TEGRA30_AHUB_APBDMA_LIVE_STATUS:
|
|
case TEGRA30_AHUB_I2S_LIVE_STATUS:
|
|
case TEGRA30_AHUB_SPDIF_LIVE_STATUS:
|
|
case TEGRA30_AHUB_I2S_INT_MASK:
|
|
case TEGRA30_AHUB_DAM_INT_MASK:
|
|
case TEGRA30_AHUB_SPDIF_INT_MASK:
|
|
case TEGRA30_AHUB_APBIF_INT_MASK:
|
|
case TEGRA30_AHUB_I2S_INT_STATUS:
|
|
case TEGRA30_AHUB_DAM_INT_STATUS:
|
|
case TEGRA30_AHUB_SPDIF_INT_STATUS:
|
|
case TEGRA30_AHUB_APBIF_INT_STATUS:
|
|
case TEGRA30_AHUB_I2S_INT_SOURCE:
|
|
case TEGRA30_AHUB_DAM_INT_SOURCE:
|
|
case TEGRA30_AHUB_SPDIF_INT_SOURCE:
|
|
case TEGRA30_AHUB_APBIF_INT_SOURCE:
|
|
case TEGRA30_AHUB_I2S_INT_SET:
|
|
case TEGRA30_AHUB_DAM_INT_SET:
|
|
case TEGRA30_AHUB_SPDIF_INT_SET:
|
|
case TEGRA30_AHUB_APBIF_INT_SET:
|
|
return true;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
if (REG_IN_ARRAY(reg, CHANNEL_CTRL) ||
|
|
REG_IN_ARRAY(reg, CHANNEL_CLEAR) ||
|
|
REG_IN_ARRAY(reg, CHANNEL_STATUS) ||
|
|
REG_IN_ARRAY(reg, CHANNEL_TXFIFO) ||
|
|
REG_IN_ARRAY(reg, CHANNEL_RXFIFO) ||
|
|
REG_IN_ARRAY(reg, CIF_TX_CTRL) ||
|
|
REG_IN_ARRAY(reg, CIF_RX_CTRL) ||
|
|
REG_IN_ARRAY(reg, DAM_LIVE_STATUS))
|
|
return true;
|
|
|
|
return false;
|
|
}
|
|
|
|
static bool tegra30_ahub_apbif_volatile_reg(struct device *dev,
|
|
unsigned int reg)
|
|
{
|
|
switch (reg) {
|
|
case TEGRA30_AHUB_CONFIG_LINK_CTRL:
|
|
case TEGRA30_AHUB_MISC_CTRL:
|
|
case TEGRA30_AHUB_APBDMA_LIVE_STATUS:
|
|
case TEGRA30_AHUB_I2S_LIVE_STATUS:
|
|
case TEGRA30_AHUB_SPDIF_LIVE_STATUS:
|
|
case TEGRA30_AHUB_I2S_INT_STATUS:
|
|
case TEGRA30_AHUB_DAM_INT_STATUS:
|
|
case TEGRA30_AHUB_SPDIF_INT_STATUS:
|
|
case TEGRA30_AHUB_APBIF_INT_STATUS:
|
|
case TEGRA30_AHUB_I2S_INT_SET:
|
|
case TEGRA30_AHUB_DAM_INT_SET:
|
|
case TEGRA30_AHUB_SPDIF_INT_SET:
|
|
case TEGRA30_AHUB_APBIF_INT_SET:
|
|
return true;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
if (REG_IN_ARRAY(reg, CHANNEL_CLEAR) ||
|
|
REG_IN_ARRAY(reg, CHANNEL_STATUS) ||
|
|
REG_IN_ARRAY(reg, CHANNEL_TXFIFO) ||
|
|
REG_IN_ARRAY(reg, CHANNEL_RXFIFO) ||
|
|
REG_IN_ARRAY(reg, DAM_LIVE_STATUS))
|
|
return true;
|
|
|
|
return false;
|
|
}
|
|
|
|
static bool tegra30_ahub_apbif_precious_reg(struct device *dev,
|
|
unsigned int reg)
|
|
{
|
|
if (REG_IN_ARRAY(reg, CHANNEL_TXFIFO) ||
|
|
REG_IN_ARRAY(reg, CHANNEL_RXFIFO))
|
|
return true;
|
|
|
|
return false;
|
|
}
|
|
|
|
static const struct regmap_config tegra30_ahub_apbif_regmap_config = {
|
|
.name = "apbif",
|
|
.reg_bits = 32,
|
|
.val_bits = 32,
|
|
.reg_stride = 4,
|
|
.max_register = TEGRA30_AHUB_APBIF_INT_SET,
|
|
.writeable_reg = tegra30_ahub_apbif_wr_rd_reg,
|
|
.readable_reg = tegra30_ahub_apbif_wr_rd_reg,
|
|
.volatile_reg = tegra30_ahub_apbif_volatile_reg,
|
|
.precious_reg = tegra30_ahub_apbif_precious_reg,
|
|
.cache_type = REGCACHE_FLAT,
|
|
};
|
|
|
|
static bool tegra30_ahub_ahub_wr_rd_reg(struct device *dev, unsigned int reg)
|
|
{
|
|
if (REG_IN_ARRAY(reg, AUDIO_RX))
|
|
return true;
|
|
|
|
return false;
|
|
}
|
|
|
|
static const struct regmap_config tegra30_ahub_ahub_regmap_config = {
|
|
.name = "ahub",
|
|
.reg_bits = 32,
|
|
.val_bits = 32,
|
|
.reg_stride = 4,
|
|
.max_register = LAST_REG(AUDIO_RX),
|
|
.writeable_reg = tegra30_ahub_ahub_wr_rd_reg,
|
|
.readable_reg = tegra30_ahub_ahub_wr_rd_reg,
|
|
.cache_type = REGCACHE_FLAT,
|
|
};
|
|
|
|
static struct tegra30_ahub_soc_data soc_data_tegra30 = {
|
|
.num_resets = 11,
|
|
.set_audio_cif = tegra30_ahub_set_cif,
|
|
};
|
|
|
|
static struct tegra30_ahub_soc_data soc_data_tegra114 = {
|
|
.num_resets = 13,
|
|
.set_audio_cif = tegra30_ahub_set_cif,
|
|
};
|
|
|
|
static struct tegra30_ahub_soc_data soc_data_tegra124 = {
|
|
.num_resets = 21,
|
|
.set_audio_cif = tegra124_ahub_set_cif,
|
|
};
|
|
|
|
static const struct of_device_id tegra30_ahub_of_match[] = {
|
|
{ .compatible = "nvidia,tegra124-ahub", .data = &soc_data_tegra124 },
|
|
{ .compatible = "nvidia,tegra114-ahub", .data = &soc_data_tegra114 },
|
|
{ .compatible = "nvidia,tegra30-ahub", .data = &soc_data_tegra30 },
|
|
{},
|
|
};
|
|
|
|
static int tegra30_ahub_probe(struct platform_device *pdev)
|
|
{
|
|
const struct tegra30_ahub_soc_data *soc_data;
|
|
struct resource *res0;
|
|
void __iomem *regs_apbif, *regs_ahub;
|
|
int ret = 0;
|
|
|
|
soc_data = of_device_get_match_data(&pdev->dev);
|
|
if (!soc_data)
|
|
return -EINVAL;
|
|
|
|
ahub = devm_kzalloc(&pdev->dev, sizeof(struct tegra30_ahub),
|
|
GFP_KERNEL);
|
|
if (!ahub)
|
|
return -ENOMEM;
|
|
dev_set_drvdata(&pdev->dev, ahub);
|
|
|
|
BUILD_BUG_ON(sizeof(ahub->resets) != sizeof(tegra30_ahub_resets_data));
|
|
memcpy(ahub->resets, tegra30_ahub_resets_data, sizeof(ahub->resets));
|
|
|
|
ahub->nresets = soc_data->num_resets;
|
|
ahub->soc_data = soc_data;
|
|
ahub->dev = &pdev->dev;
|
|
|
|
ahub->clocks[ahub->nclocks++].id = "apbif";
|
|
ahub->clocks[ahub->nclocks++].id = "d_audio";
|
|
|
|
ret = devm_clk_bulk_get(&pdev->dev, ahub->nclocks, ahub->clocks);
|
|
if (ret)
|
|
goto err_unset_ahub;
|
|
|
|
ret = devm_reset_control_bulk_get_exclusive(&pdev->dev, ahub->nresets,
|
|
ahub->resets);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "Can't get resets: %d\n", ret);
|
|
goto err_unset_ahub;
|
|
}
|
|
|
|
regs_apbif = devm_platform_get_and_ioremap_resource(pdev, 0, &res0);
|
|
if (IS_ERR(regs_apbif)) {
|
|
ret = PTR_ERR(regs_apbif);
|
|
goto err_unset_ahub;
|
|
}
|
|
|
|
ahub->apbif_addr = res0->start;
|
|
|
|
ahub->regmap_apbif = devm_regmap_init_mmio(&pdev->dev, regs_apbif,
|
|
&tegra30_ahub_apbif_regmap_config);
|
|
if (IS_ERR(ahub->regmap_apbif)) {
|
|
dev_err(&pdev->dev, "apbif regmap init failed\n");
|
|
ret = PTR_ERR(ahub->regmap_apbif);
|
|
goto err_unset_ahub;
|
|
}
|
|
regcache_cache_only(ahub->regmap_apbif, true);
|
|
|
|
regs_ahub = devm_platform_ioremap_resource(pdev, 1);
|
|
if (IS_ERR(regs_ahub)) {
|
|
ret = PTR_ERR(regs_ahub);
|
|
goto err_unset_ahub;
|
|
}
|
|
|
|
ahub->regmap_ahub = devm_regmap_init_mmio(&pdev->dev, regs_ahub,
|
|
&tegra30_ahub_ahub_regmap_config);
|
|
if (IS_ERR(ahub->regmap_ahub)) {
|
|
dev_err(&pdev->dev, "ahub regmap init failed\n");
|
|
ret = PTR_ERR(ahub->regmap_ahub);
|
|
goto err_unset_ahub;
|
|
}
|
|
regcache_cache_only(ahub->regmap_ahub, true);
|
|
|
|
pm_runtime_enable(&pdev->dev);
|
|
|
|
of_platform_populate(pdev->dev.of_node, NULL, NULL, &pdev->dev);
|
|
|
|
return 0;
|
|
|
|
err_unset_ahub:
|
|
ahub = NULL;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void tegra30_ahub_remove(struct platform_device *pdev)
|
|
{
|
|
pm_runtime_disable(&pdev->dev);
|
|
|
|
ahub = NULL;
|
|
}
|
|
|
|
static const struct dev_pm_ops tegra30_ahub_pm_ops = {
|
|
SET_RUNTIME_PM_OPS(tegra30_ahub_runtime_suspend,
|
|
tegra30_ahub_runtime_resume, NULL)
|
|
SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
|
|
pm_runtime_force_resume)
|
|
};
|
|
|
|
static struct platform_driver tegra30_ahub_driver = {
|
|
.probe = tegra30_ahub_probe,
|
|
.remove_new = tegra30_ahub_remove,
|
|
.driver = {
|
|
.name = DRV_NAME,
|
|
.of_match_table = tegra30_ahub_of_match,
|
|
.pm = &tegra30_ahub_pm_ops,
|
|
},
|
|
};
|
|
module_platform_driver(tegra30_ahub_driver);
|
|
|
|
void tegra30_ahub_set_cif(struct regmap *regmap, unsigned int reg,
|
|
struct tegra30_ahub_cif_conf *conf)
|
|
{
|
|
unsigned int value;
|
|
|
|
value = (conf->threshold <<
|
|
TEGRA30_AUDIOCIF_CTRL_FIFO_THRESHOLD_SHIFT) |
|
|
((conf->audio_channels - 1) <<
|
|
TEGRA30_AUDIOCIF_CTRL_AUDIO_CHANNELS_SHIFT) |
|
|
((conf->client_channels - 1) <<
|
|
TEGRA30_AUDIOCIF_CTRL_CLIENT_CHANNELS_SHIFT) |
|
|
(conf->audio_bits <<
|
|
TEGRA30_AUDIOCIF_CTRL_AUDIO_BITS_SHIFT) |
|
|
(conf->client_bits <<
|
|
TEGRA30_AUDIOCIF_CTRL_CLIENT_BITS_SHIFT) |
|
|
(conf->expand <<
|
|
TEGRA30_AUDIOCIF_CTRL_EXPAND_SHIFT) |
|
|
(conf->stereo_conv <<
|
|
TEGRA30_AUDIOCIF_CTRL_STEREO_CONV_SHIFT) |
|
|
(conf->replicate <<
|
|
TEGRA30_AUDIOCIF_CTRL_REPLICATE_SHIFT) |
|
|
(conf->direction <<
|
|
TEGRA30_AUDIOCIF_CTRL_DIRECTION_SHIFT) |
|
|
(conf->truncate <<
|
|
TEGRA30_AUDIOCIF_CTRL_TRUNCATE_SHIFT) |
|
|
(conf->mono_conv <<
|
|
TEGRA30_AUDIOCIF_CTRL_MONO_CONV_SHIFT);
|
|
|
|
regmap_write(regmap, reg, value);
|
|
}
|
|
EXPORT_SYMBOL_GPL(tegra30_ahub_set_cif);
|
|
|
|
void tegra124_ahub_set_cif(struct regmap *regmap, unsigned int reg,
|
|
struct tegra30_ahub_cif_conf *conf)
|
|
{
|
|
unsigned int value;
|
|
|
|
value = (conf->threshold <<
|
|
TEGRA124_AUDIOCIF_CTRL_FIFO_THRESHOLD_SHIFT) |
|
|
((conf->audio_channels - 1) <<
|
|
TEGRA124_AUDIOCIF_CTRL_AUDIO_CHANNELS_SHIFT) |
|
|
((conf->client_channels - 1) <<
|
|
TEGRA124_AUDIOCIF_CTRL_CLIENT_CHANNELS_SHIFT) |
|
|
(conf->audio_bits <<
|
|
TEGRA30_AUDIOCIF_CTRL_AUDIO_BITS_SHIFT) |
|
|
(conf->client_bits <<
|
|
TEGRA30_AUDIOCIF_CTRL_CLIENT_BITS_SHIFT) |
|
|
(conf->expand <<
|
|
TEGRA30_AUDIOCIF_CTRL_EXPAND_SHIFT) |
|
|
(conf->stereo_conv <<
|
|
TEGRA30_AUDIOCIF_CTRL_STEREO_CONV_SHIFT) |
|
|
(conf->replicate <<
|
|
TEGRA30_AUDIOCIF_CTRL_REPLICATE_SHIFT) |
|
|
(conf->direction <<
|
|
TEGRA30_AUDIOCIF_CTRL_DIRECTION_SHIFT) |
|
|
(conf->truncate <<
|
|
TEGRA30_AUDIOCIF_CTRL_TRUNCATE_SHIFT) |
|
|
(conf->mono_conv <<
|
|
TEGRA30_AUDIOCIF_CTRL_MONO_CONV_SHIFT);
|
|
|
|
regmap_write(regmap, reg, value);
|
|
}
|
|
EXPORT_SYMBOL_GPL(tegra124_ahub_set_cif);
|
|
|
|
MODULE_AUTHOR("Stephen Warren <swarren@nvidia.com>");
|
|
MODULE_DESCRIPTION("Tegra30 AHUB driver");
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_ALIAS("platform:" DRV_NAME);
|
|
MODULE_DEVICE_TABLE(of, tegra30_ahub_of_match);
|