diff -drupN a/sound/soc/sunxi/sunxi-daudio.c b/sound/soc/sunxi/sunxi-daudio.c --- a/sound/soc/sunxi/sunxi-daudio.c 1970-01-01 03:00:00.000000000 +0300 +++ b/sound/soc/sunxi/sunxi-daudio.c 2022-06-12 05:28:14.000000000 +0300 @@ -0,0 +1,2751 @@ +/* sound\soc\sunxi\sunxi-daudio.c + * (C) Copyright 2015-2018 + * Allwinner Technology Co., Ltd. + * wolfgang huang + * yumingfeng + * + * some simple description for this code + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License as + * published by the Free Software Foundation; either version 2 of + * the License, or (at your option) any later version. + * + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "sunxi-daudio.h" +#include "sunxi-snddaudio.h" +#include "sunxi-pcm.h" +#ifdef CONFIG_SND_SUNXI_MAD +#include "sunxi-mad.h" +#endif +#ifdef CONFIG_SUNXI_MPP_AIO +#include "sunxi-aio/mpp-aio.h" +extern struct sunxi_audio_mpp_debugfs *mpp_audio_debugfs; +#endif +#ifdef CONFIG_SND_SUN8IW8_ADC_TRIGGER_SYNC_WITH_OTHER_CODEC +#include "sun8iw8/sun8iw8_sndcodec.h" +#endif + + +#define DRV_NAME "sunxi-daudio" + +#define SUNXI_RX_SYNC_EN (0) +#define SUNXI_DAUDIO_RATES (SNDRV_PCM_RATE_8000_192000 \ + | SNDRV_PCM_RATE_KNOT) + +#define SUNXI_DAUDIO_EXTERNAL_TYPE 1 +#define SUNXI_DAUDIO_TDMHDMI_TYPE 2 +#define SUNXI_DAUDIO_DRQDST(sunxi_daudio, x) \ + ((sunxi_daudio)->playback_dma_param.dma_drq_type_num = \ + DRQDST_DAUDIO_##x##_TX) +#define SUNXI_DAUDIO_DRQSRC(sunxi_daudio, x) \ + ((sunxi_daudio)->capture_dma_param.dma_drq_type_num = \ + DRQSRC_DAUDIO_##x##_RX) + +struct sunxi_daudio_platform_data { + unsigned int daudio_type; + unsigned int external_type; + + /* should be setup at machine driver. */ + unsigned int daudio_master; + unsigned int audio_format; + unsigned int signal_inversion; + + unsigned int pcm_lrck_period; + unsigned int msb_lsb_first:1; + unsigned int sign_extend:2; + unsigned int tx_data_mode:2; + unsigned int rx_data_mode:2; + unsigned int slot_width_select; + unsigned int frame_type; + unsigned int tdm_config; + unsigned int tdm_num; + unsigned int mclk_div; +}; + +struct daudio_label { + unsigned int address; + int value; +}; + +struct voltage_supply { + struct regulator *daudio_regulator; + const char *regulator_name; +}; + +struct sunxi_daudio_info { + struct device *dev; + struct resource res; + struct regmap *regmap; + void __iomem *membase; + struct resource *memregion; + struct clk *pllclk; +#ifdef DAUDIO_PLL_AUDIO_X4 + struct clk *pllclkx4; +#endif + struct clk *moduleclk; + struct voltage_supply vol_supply; + struct mutex mutex; + struct mutex global_mutex; + struct sunxi_dma_params playback_dma_param; + struct sunxi_dma_params capture_dma_param; + struct pinctrl *pinctrl; + struct pinctrl_state *pinstate; +#ifdef DAUDIO_PINCTRL_STATE_DEFAULT_B + struct pinctrl_state *pinstate_b; +#endif + struct pinctrl_state *pinstate_sleep; + struct sunxi_daudio_platform_data *pdata; + unsigned int hub_mode; + bool playback_en; + bool capture_en; + unsigned int hdmi_en; + int global_enable; + struct snd_soc_dai *cpu_dai; + struct daudio_label *reg_label; + +#ifdef CONFIG_SND_SUNXI_MAD + struct work_struct ws_rx_mad_reset; + struct sunxi_mad_priv *mad_priv; +#endif +}; + +#ifdef DAUDIO_CLASS_DEBUG +static struct reg_label reg_labels[] = { + REG_LABEL(SUNXI_DAUDIO_CTL), + REG_LABEL(SUNXI_DAUDIO_FMT0), + REG_LABEL(SUNXI_DAUDIO_FMT1), + REG_LABEL(SUNXI_DAUDIO_INTSTA), + REG_LABEL(SUNXI_DAUDIO_FIFOCTL), + REG_LABEL(SUNXI_DAUDIO_FIFOSTA), + REG_LABEL(SUNXI_DAUDIO_INTCTL), + REG_LABEL(SUNXI_DAUDIO_CLKDIV), + REG_LABEL(SUNXI_DAUDIO_TXCNT), + REG_LABEL(SUNXI_DAUDIO_RXCNT), + REG_LABEL(SUNXI_DAUDIO_CHCFG), + REG_LABEL(SUNXI_DAUDIO_TX0CHSEL), +#ifndef CONFIG_ARCH_SUN8IW18 + REG_LABEL(SUNXI_DAUDIO_TX1CHSEL), + REG_LABEL(SUNXI_DAUDIO_TX2CHSEL), + REG_LABEL(SUNXI_DAUDIO_TX3CHSEL), +#endif +#if defined(SUNXI_DAUDIO_MODE_B) + REG_LABEL(SUNXI_DAUDIO_TX0CHMAP0), + REG_LABEL(SUNXI_DAUDIO_TX0CHMAP1), + REG_LABEL(SUNXI_DAUDIO_TX1CHMAP0), + REG_LABEL(SUNXI_DAUDIO_TX1CHMAP1), + REG_LABEL(SUNXI_DAUDIO_TX2CHMAP0), + REG_LABEL(SUNXI_DAUDIO_TX2CHMAP1), + REG_LABEL(SUNXI_DAUDIO_TX3CHMAP0), + REG_LABEL(SUNXI_DAUDIO_TX3CHMAP1), + REG_LABEL(SUNXI_DAUDIO_RXCHSEL), + REG_LABEL(SUNXI_DAUDIO_RXCHMAP0), + REG_LABEL(SUNXI_DAUDIO_RXCHMAP1), +#if defined(CONFIG_ARCH_SUN8IW18) || defined(CONFIG_ARCH_SUN8IW19) || \ + defined(CONFIG_ARCH_SUN50IW10) + REG_LABEL(SUNXI_DAUDIO_RXCHMAP2), + REG_LABEL(SUNXI_DAUDIO_RXCHMAP3), +#endif + REG_LABEL(SUNXI_DAUDIO_DEBUG), +#else + REG_LABEL(SUNXI_DAUDIO_TX0CHMAP0), + REG_LABEL(SUNXI_DAUDIO_TX1CHMAP0), + REG_LABEL(SUNXI_DAUDIO_TX2CHMAP0), + REG_LABEL(SUNXI_DAUDIO_TX3CHMAP0), + REG_LABEL(SUNXI_DAUDIO_RXCHSEL), + REG_LABEL(SUNXI_DAUDIO_RXCHMAP), + REG_LABEL(SUNXI_DAUDIO_DEBUG), +#endif + REG_LABEL_END, +}; +#endif + +static struct sunxi_daudio_info *sunxi_daudio_global[DAUDIO_NUM_MAX]; +#ifdef DAUDIO_CLASS_DEBUG +static int daudio_class_dev_cnt; +#endif + +/* + * Some codec on electric timing need debugging + */ +int daudio_set_clk_onoff(struct snd_soc_dai *dai, u32 mask, bool enable) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + + switch (mask) { + case SUNXI_DAUDIO_BCLK: + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_FIFOCTL, + (0x1 << BCLK_OUT), (enable << BCLK_OUT)); + break; + case SUNXI_DAUDIO_LRCK: + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_FIFOCTL, + (0x1 << LRCK_OUT), (enable << LRCK_OUT)); + break; + case SUNXI_DAUDIO_MCLK: + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CLKDIV, + (0x1 << MCLKOUT_EN), (enable << MCLKOUT_EN)); + break; + case SUNXI_DAUDIO_GEN: + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (0x1 << GLOBAL_EN), (enable << GLOBAL_EN)); + break; + default: + return -EINVAL; + } + + return 0; +} +EXPORT_SYMBOL_GPL(daudio_set_clk_onoff); + +static int sunxi_daudio_get_hub_mode(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); + struct snd_soc_codec *codec = snd_soc_component_to_codec(component); + struct sunxi_daudio_info *sunxi_daudio = + snd_soc_codec_get_drvdata(codec); + unsigned int reg_val; + + regmap_read(sunxi_daudio->regmap, SUNXI_DAUDIO_FIFOCTL, ®_val); + ucontrol->value.integer.value[0] = ((reg_val & (1<value.integer.value[0]) { + case 0: + case 1: + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FIFOCTL, + (1<regmap, SUNXI_DAUDIO_CTL, + (1<hub_mode = 0; + break; + case 2: + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FIFOCTL, + (1<regmap, SUNXI_DAUDIO_CTL, + (1<hub_mode = 1; + break; + default: + return -EINVAL; + } + + return 0; +} + +static const char *daudio_format_function[] = {"null", + "hub_disable", "hub_enable"}; + +static const struct soc_enum daudio_format_enum[] = { + SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(daudio_format_function), + daudio_format_function), +}; + +/* dts pcm Audio Mode Select */ +static const struct snd_kcontrol_new sunxi_daudio_controls[] = { + SOC_ENUM_EXT("sunxi daudio audio hub mode", daudio_format_enum[0], + sunxi_daudio_get_hub_mode, sunxi_daudio_set_hub_mode), + SOC_SINGLE("sunxi daudio loopback debug", SUNXI_DAUDIO_CTL, + LOOP_EN, 1, 0), +}; + +static void sunxi_daudio_txctrl_enable(struct sunxi_daudio_info *sunxi_daudio, + bool enable) +{ + if (enable) { + /* HDMI audio Transmit Clock just enable at startup */ + if (sunxi_daudio->pdata->daudio_type != SUNXI_DAUDIO_TDMHDMI_TYPE) { + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1 << SDO0_EN), (1 << SDO0_EN)); + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1 << CTL_TXEN), (1 << CTL_TXEN)); + } + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_INTCTL, + (1 << TXDRQEN), (1 << TXDRQEN)); + } else { + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_INTCTL, + (1 << TXDRQEN), (0 << TXDRQEN)); + if (sunxi_daudio->pdata->daudio_type != SUNXI_DAUDIO_TDMHDMI_TYPE) { + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1 << CTL_TXEN), (0 << CTL_TXEN)); + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1 << SDO0_EN), (0 << SDO0_EN)); + } + } +} + +static void sunxi_daudio_rxctrl_enable(struct sunxi_daudio_info *sunxi_daudio, + bool enable) +{ + if (enable) { + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1<regmap, + SUNXI_DAUDIO_INTCTL, + (1<regmap, + SUNXI_DAUDIO_CTL, + (1<regmap, + SUNXI_DAUDIO_CTL, + (1<regmap, + SUNXI_DAUDIO_INTCTL, + (1<regmap, + SUNXI_DAUDIO_CTL, + (1<regmap, + SUNXI_DAUDIO_CTL, + (1<regmap, + SUNXI_DAUDIO_CTL, + (1<pdata->tdm_num) { + case 0: + path_sel = MAD_PATH_I2S0; + break; + case 1: + path_sel = MAD_PATH_I2S1; + break; + case 2: + path_sel = MAD_PATH_I2S2; + break; + default: + path_sel = MAD_PATH_NONE; + dev_err(sunxi_daudio->dev, "unsupported I2S number!\n"); + return -EINVAL; + } + sunxi_mad_audio_source_sel(path_sel, enable); + + return 0; +} + +static void sunxi_mad_debug_chan_echange(struct sunxi_daudio_info *sunxi_daudio) +{ + struct sunxi_mad_priv *mad_priv = sunxi_daudio->mad_priv; + + /* + * only for reset mad module by ccmu. + * should not be callback at dai_ops->trigger + * because it maybe running at interrupt! + */ + sunxi_mad_module_clk_enable(false); + sunxi_mad_module_clk_enable(true); + + /* sunxi_mad_close();*/ + sunxi_mad_open(); + + sunxi_mad_hw_params(mad_priv->audio_src_chan_num, + mad_priv->sample_rate); + + sunxi_mad_audio_src_chan_num(mad_priv->audio_src_chan_num); + sunxi_lpsd_chan_sel(mad_priv->lpsd_chan_sel); + sunxi_mad_standby_chan_sel(mad_priv->mad_standby_chan_sel); + sunxi_mad_dma_type(SUNXI_MAD_DMA_IO); + sunxi_sram_ahb1_threshole_init(); + sunxi_mad_sram_init(); + + /* should set it after sram reset. */ + sunxi_daudio_mad_set_path(sunxi_daudio, true); +} + +static void sunxi_daudio_rxctrl_stop_mad_reset(struct work_struct *work) +{ + struct sunxi_daudio_info *sunxi_daudio = + container_of(work, struct sunxi_daudio_info, ws_rx_mad_reset); + + /* should be flush fifo */ + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FIFOCTL, + (1 << FIFO_CTL_FRX), (1 << FIFO_CTL_FRX)); + regmap_write(sunxi_daudio->regmap, SUNXI_DAUDIO_RXCNT, 0); + + sunxi_mad_debug_chan_echange(sunxi_daudio); + + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL, + (0x1 << DAUDIO_MAD_DATA_EN), + (0x1 << DAUDIO_MAD_DATA_EN)); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL, + (1<regmap, + SUNXI_DAUDIO_CTL, + (0x1 << DAUDIO_MAD_DATA_EN), + (0x1 << DAUDIO_MAD_DATA_EN)); + sunxi_mad_dma_enable(true); + + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1<regmap, + SUNXI_DAUDIO_CTL, + (1<regmap, + SUNXI_DAUDIO_CTL, + (0x1 << DAUDIO_MAD_DATA_EN), + (0x0 << DAUDIO_MAD_DATA_EN)); + + /* mad reset and daudio rxctrl enable */ + schedule_work(&(sunxi_daudio->ws_rx_mad_reset)); + } +} + +static int sunxi_daudio_mad_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + struct snd_soc_pcm_runtime *rtd = substream->private_data; + struct snd_soc_card *card = rtd->card; + struct sunxi_snddaudio_priv *snddaudio_priv = + snd_soc_card_get_drvdata(card); + struct sunxi_mad_priv *mad_priv = &(snddaudio_priv->mad_priv); + + if ((substream->stream == SNDRV_PCM_STREAM_CAPTURE) && + (snddaudio_priv->mad_priv.mad_bind == 1)) { + /* for reset sram point */ +#ifdef MAD_CLK_ALWAYS_ON + sunxi_mad_module_clk_enable(false); +#endif + sunxi_mad_module_clk_enable(true); + + /* mad only receive the high 16bit */ + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_FIFOCTL, + (SUNXI_DAUDIO_RXOM_MASK << RXOM), + (SUNXI_DAUDIO_RXOM_TUNL << RXOM)); + + /* mad config */ + if (params_format(params) != SNDRV_PCM_FORMAT_S16_LE) { + dev_err(sunxi_daudio->dev, "unsupported mad sample bits\n"); + return -EINVAL; + } + mad_priv->sample_rate = params_rate(params); + mad_priv->audio_src_chan_num = params_channels(params); + /* setup open status */ + sunxi_mad_open(); + + /* setup hw_params status */ + if (sunxi_mad_hw_params(mad_priv->audio_src_chan_num, + mad_priv->sample_rate)) { + dev_err(sunxi_daudio->dev, "mad hw_params error.\n"); + sunxi_mad_close(); + return -EINVAL; + } + + sunxi_mad_audio_src_chan_num(mad_priv->audio_src_chan_num); + sunxi_lpsd_chan_sel(mad_priv->lpsd_chan_sel); + sunxi_mad_standby_chan_sel(mad_priv->mad_standby_chan_sel); + sunxi_sram_ahb1_threshole_init(); + /* changed it's dma addr */ + sunxi_sram_dma_config(&sunxi_daudio->capture_dma_param); + sunxi_mad_dma_type(SUNXI_MAD_DMA_IO); + /* sram sram reset for load setup */ + sunxi_mad_sram_init(); + /* should set it after sram reset. */ + sunxi_daudio_mad_set_path(sunxi_daudio, true); + } + + return 0; +} +#endif + +static int sunxi_daudio_global_enable(struct sunxi_daudio_info *sunxi_daudio, + bool enable) +{ + if (enable) { + if (sunxi_daudio->global_enable++ == 0) + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1<global_enable == 0) + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1<pdata->mclk_div) { + + switch (sunxi_daudio->pdata->mclk_div) { + case 1: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_1; + break; + case 2: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_2; + break; + case 4: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_3; + break; + case 6: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_4; + break; + case 8: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_5; + break; + case 12: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_6; + break; + case 16: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_7; + break; + case 24: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_8; + break; + case 32: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_9; + break; + case 48: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_10; + break; + case 64: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_11; + break; + case 96: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_12; + break; + case 128: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_13; + break; + case 176: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_14; + break; + case 192: + mclk_div = SUNXI_DAUDIO_MCLK_DIV_15; + break; + default: + dev_err(sunxi_daudio->dev, "unsupport mclk_div\n"); + return -EINVAL; + } + /* setting Mclk as external codec input clk */ + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CLKDIV, + (SUNXI_DAUDIO_MCLK_DIV_MASK<regmap, SUNXI_DAUDIO_CLKDIV, + (1<regmap, SUNXI_DAUDIO_CLKDIV, + (1<regmap, SUNXI_DAUDIO_CTL, + (SUNXI_DAUDIO_LRCK_OUT_MASK<regmap, SUNXI_DAUDIO_CTL, + (SUNXI_DAUDIO_LRCK_OUT_MASK<dev, "unknown maser/slave format\n"); + return -EINVAL; + } + + switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { + case SND_SOC_DAIFMT_I2S: + offset = SUNXI_DAUDIO_TX_OFFSET_1; + mode = SUNXI_DAUDIO_MODE_CTL_I2S; + break; + case SND_SOC_DAIFMT_RIGHT_J: + offset = SUNXI_DAUDIO_TX_OFFSET_0; + mode = SUNXI_DAUDIO_MODE_CTL_RIGHT; + break; + case SND_SOC_DAIFMT_LEFT_J: + offset = SUNXI_DAUDIO_TX_OFFSET_0; + mode = SUNXI_DAUDIO_MODE_CTL_LEFT; + break; + case SND_SOC_DAIFMT_DSP_A: + offset = SUNXI_DAUDIO_TX_OFFSET_1; + mode = SUNXI_DAUDIO_MODE_CTL_PCM; + break; + case SND_SOC_DAIFMT_DSP_B: + offset = SUNXI_DAUDIO_TX_OFFSET_0; + mode = SUNXI_DAUDIO_MODE_CTL_PCM; + break; + default: + dev_err(sunxi_daudio->dev, "format setting failed\n"); + return -EINVAL; + } + + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL, + (SUNXI_DAUDIO_MODE_CTL_MASK<regmap, SUNXI_DAUDIO_TX0CHSEL, + (SUNXI_DAUDIO_TX_OFFSET_MASK<hdmi_en) { +#ifndef CONFIG_ARCH_SUN8IW18 + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_TX1CHSEL, + (SUNXI_DAUDIO_TX_OFFSET_MASK<regmap, SUNXI_DAUDIO_TX2CHSEL, + (SUNXI_DAUDIO_TX_OFFSET_MASK<regmap, SUNXI_DAUDIO_TX3CHSEL, + (SUNXI_DAUDIO_TX_OFFSET_MASK<regmap, SUNXI_DAUDIO_RXCHSEL, + (SUNXI_DAUDIO_RX_OFFSET_MASK<dev, "invert clk setting failed\n"); + return -EINVAL; + } + + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT0, + (1<regmap, SUNXI_DAUDIO_FMT0, + (1<pdata; + + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT0, + (1 << LRCK_WIDTH), + (pdat->frame_type << LRCK_WIDTH)); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT0, + (SUNXI_DAUDIO_LRCK_PERIOD_MASK) << LRCK_PERIOD, + ((pdat->pcm_lrck_period - 1) << LRCK_PERIOD)); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT0, + (SUNXI_DAUDIO_SLOT_WIDTH_MASK << SLOT_WIDTH), + (((pdat->slot_width_select >> 2) - 1) << SLOT_WIDTH)); + + /* + * MSB on the transmit format, always be first. + * default using Linear-PCM, without no companding. + * A-law or U-law not working ok. + */ + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT1, + (0x1 << TX_MLS), + (pdat->msb_lsb_first << TX_MLS)); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT1, + (0x1 << RX_MLS), + (pdat->msb_lsb_first << RX_MLS)); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT1, + (0x3 << SEXT), + (pdat->sign_extend << SEXT)); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT1, + (0x3 << TX_PDM), + (pdat->tx_data_mode << TX_PDM)); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT1, + (0x3 << RX_PDM), + (pdat->rx_data_mode << RX_PDM)); + + /* maybe set the i2s fmt for hdmi at init */ + if (pdat->daudio_type == SUNXI_DAUDIO_TDMHDMI_TYPE) + sunxi_daudio_init_fmt(sunxi_daudio, (pdat->audio_format + | (pdat->signal_inversion << SND_SOC_DAIFMT_SIG_SHIFT) + | (pdat->daudio_master << SND_SOC_DAIFMT_MASTER_SHIFT))); + + return sunxi_daudio_mclk_setting(sunxi_daudio); +} + +#ifdef CONFIG_SUNXI_MPP_AIO +static int sunxi_daudio_mpp_aio_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) +{ + unsigned int bitwidth = 0; + + if (mpp_audio_debugfs) { + mpp_aio_info_set(mpp_audio_debugfs->ao_devenable, 32, 1); + mpp_aio_info_set(mpp_audio_debugfs->ao_cardtype, 64, 1); + mpp_aio_info_set(mpp_audio_debugfs->ao_samplerate, 32, + params_rate(params)); + + switch (params_format(params)) { + case SNDRV_PCM_FORMAT_S16_LE: + bitwidth = 16; + break; + case SNDRV_PCM_FORMAT_S20_3LE: + bitwidth = 20; + break; + case SNDRV_PCM_FORMAT_S24_LE: + bitwidth = 24; + break; + case SNDRV_PCM_FORMAT_S32_LE: + bitwidth = 32; + break; + default: + bitwidth = 16; + break; + } + mpp_aio_info_set(mpp_audio_debugfs->ao_bitwidth, 32, bitwidth); + } + return 0; +} +#endif + +static int sunxi_daudio_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + struct snd_soc_pcm_runtime *rtd = substream->private_data; + struct snd_soc_card *card = rtd->card; + struct sndhdmi_priv *sndhdmi_priv = snd_soc_card_get_drvdata(card); + + switch (params_format(params)) { + case SNDRV_PCM_FORMAT_S16_LE: + /* + * Special procesing for hdmi, HDMI card name is + * "sndhdmi" or sndhdmiraw. if card not HDMI, + * strstr func just return NULL, jump to right section. + * Not HDMI card, sunxi_hdmi maybe a NULL pointer. + */ + if (sunxi_daudio->pdata->daudio_type == + SUNXI_DAUDIO_TDMHDMI_TYPE + && (sndhdmi_priv->hdmi_format > 1)) { + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_FMT0, + (SUNXI_DAUDIO_SR_MASK<regmap, + SUNXI_DAUDIO_FIFOCTL, + (SUNXI_DAUDIO_TXIM_MASK<regmap, + SUNXI_DAUDIO_FMT0, + (SUNXI_DAUDIO_SR_MASK<stream == SNDRV_PCM_STREAM_PLAYBACK) + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_FIFOCTL, + (SUNXI_DAUDIO_TXIM_MASK<regmap, + SUNXI_DAUDIO_FIFOCTL, + (SUNXI_DAUDIO_RXOM_MASK<regmap, SUNXI_DAUDIO_FMT0, + (SUNXI_DAUDIO_SR_MASK<stream == SNDRV_PCM_STREAM_PLAYBACK) + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_FIFOCTL, + (SUNXI_DAUDIO_TXIM_MASK<regmap, + SUNXI_DAUDIO_FIFOCTL, + (SUNXI_DAUDIO_RXOM_MASK<regmap, SUNXI_DAUDIO_FMT0, + (SUNXI_DAUDIO_SR_MASK<stream == SNDRV_PCM_STREAM_PLAYBACK) + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_FIFOCTL, + (SUNXI_DAUDIO_TXIM_MASK<regmap, + SUNXI_DAUDIO_FIFOCTL, + (SUNXI_DAUDIO_RXOM_MASK<dev, "unrecognized format\n"); + return -EINVAL; + } + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CHCFG, + (SUNXI_DAUDIO_TX_SLOT_MASK<hdmi_en == 0) { +#ifdef SUNXI_DAUDIO_MODE_B + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX0CHMAP0, SUNXI_DEFAULT_CHMAP0); + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX0CHMAP1, SUNXI_DEFAULT_CHMAP1); +#else + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX0CHMAP0, SUNXI_DEFAULT_CHMAP); +#endif + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX0CHSEL, + (SUNXI_DAUDIO_TX_CHSEL_MASK<regmap, + SUNXI_DAUDIO_TX0CHSEL, + (SUNXI_DAUDIO_TX_CHEN_MASK<regmap, + SUNXI_DAUDIO_TX0CHMAP1, 0x10); + if (sndhdmi_priv->hdmi_format > 1) { + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX1CHMAP1, 0x32); + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX2CHMAP1, 0x54); + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX3CHMAP1, 0x76); + } else { + if (params_channels(params) > 2) + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX1CHMAP1, 0x23); + if (params_channels(params) > 4) { + if (params_channels(params) == 6) + regmap_write( + sunxi_daudio->regmap, + SUNXI_DAUDIO_TX2CHMAP1, + 0x54); + else + regmap_write( + sunxi_daudio->regmap, + SUNXI_DAUDIO_TX2CHMAP1, + 0x76); + } + if (params_channels(params) > 6) + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX3CHMAP1, + 0x54); + } +#else + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX0CHMAP0, 0x10); + if (sndhdmi_priv->hdmi_format > 1) { + /* support for HBR */ + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX1CHMAP0, 0x32); + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX2CHMAP0, 0x54); + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX3CHMAP0, 0x76); + } else { + /* LPCM 5.1 & 7.1 support */ + if (params_channels(params) > 2) + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX1CHMAP0, 0x23); + if (params_channels(params) > 4) { + if (params_channels(params) == 6) + regmap_write( + sunxi_daudio->regmap, + SUNXI_DAUDIO_TX2CHMAP0, + 0x54); + else + regmap_write( + sunxi_daudio->regmap, + SUNXI_DAUDIO_TX2CHMAP0, + 0x76); + } + if (params_channels(params) > 6) + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX3CHMAP0, + 0x54); + } +#endif + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX0CHSEL, + 0x01 << TX_CHSEL, 0x01 << TX_CHSEL); + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX0CHSEL, + 0x03 << TX_CHEN, 0x03 << TX_CHEN); + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX1CHSEL, + 0x01 << TX_CHSEL, 0x01 << TX_CHSEL); + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX1CHSEL, + (0x03)<regmap, + SUNXI_DAUDIO_TX2CHSEL, + 0x01 << TX_CHSEL, 0x01 << TX_CHSEL); + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX2CHSEL, + (0x03)<regmap, + SUNXI_DAUDIO_TX3CHSEL, + 0x01 << TX_CHSEL, 0x01 << TX_CHSEL); + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_TX3CHSEL, + (0x03)<= 12) + SUNXI_DAUDIO_RXCHMAPX = SUNXI_DAUDIO_RXCHMAP0; + else if (index >= 8) + SUNXI_DAUDIO_RXCHMAPX = SUNXI_DAUDIO_RXCHMAP1; + else if (index >= 4) + SUNXI_DAUDIO_RXCHMAPX = SUNXI_DAUDIO_RXCHMAP2; + else + SUNXI_DAUDIO_RXCHMAPX = SUNXI_DAUDIO_RXCHMAP3; + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_RXCHMAPX, + DAUDIO_RXCHMAP(index), + DAUDIO_RXCH_DEF_MAP(index)); + } +#else + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_RXCHMAP0, SUNXI_DEFAULT_CHMAP0); + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_RXCHMAP1, SUNXI_DEFAULT_CHMAP1); +#endif +#else + regmap_write(sunxi_daudio->regmap, + SUNXI_DAUDIO_RXCHMAP, SUNXI_DEFAULT_CHMAP); +#endif + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CHCFG, + (SUNXI_DAUDIO_RX_SLOT_MASK<regmap, SUNXI_DAUDIO_RXCHSEL, + (SUNXI_DAUDIO_RX_CHSEL_MASK<pdata->daudio_type == SUNXI_DAUDIO_TDMHDMI_TYPE) { + mutex_lock(&sunxi_daudio->mutex); + if (sunxi_daudio->hub_mode) { + sunxi_hdmi_codec_hw_params(substream, params, NULL); + sunxi_hdmi_codec_prepare(substream, NULL); + } + mutex_unlock(&sunxi_daudio->mutex); +#ifdef CONFIG_SUNXI_MPP_AIO + sunxi_daudio_mpp_aio_hw_params(substream, params, dai); +#endif + } +#endif + +#ifdef CONFIG_SND_SUNXI_MAD + /*mad only supported 16k/48KHz samplerate when capturing*/ + return sunxi_daudio_mad_hw_params(substream, params, dai); +#else + return 0; +#endif +} + +static int sunxi_daudio_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + +#ifdef USE_ASOC_FMT_SETTING + sunxi_daudio_init_fmt(sunxi_daudio, fmt); +#else + struct sunxi_daudio_platform_data *pdat = sunxi_daudio->pdata; + + sunxi_daudio_init_fmt(sunxi_daudio, (pdat->audio_format + | (pdat->signal_inversion << SND_SOC_DAIFMT_SIG_SHIFT) + | (pdat->daudio_master << SND_SOC_DAIFMT_MASTER_SHIFT))); +#endif + return 0; +} + +static int sunxi_daudio_set_sysclk(struct snd_soc_dai *dai, + int clk_id, unsigned int freq, int dir) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + if (clk_set_rate(sunxi_daudio->pllclk, freq)) { + dev_err(sunxi_daudio->dev, "set pllclk rate failed\n"); + + return -EBUSY; + } + return 0; +} + +static int sunxi_daudio_set_clkdiv(struct snd_soc_dai *dai, + int clk_id, int clk_div) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + unsigned int bclk_div, div_ratio; + + if (sunxi_daudio->pdata->tdm_config) + /* I2S/TDM two channel mode */ + div_ratio = clk_div/(2 * sunxi_daudio->pdata->pcm_lrck_period); + else + /* PCM mode */ + div_ratio = clk_div / sunxi_daudio->pdata->pcm_lrck_period; + + switch (div_ratio) { + case 1: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_1; + break; + case 2: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_2; + break; + case 4: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_3; + break; + case 6: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_4; + break; + case 8: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_5; + break; + case 12: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_6; + break; + case 16: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_7; + break; + case 24: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_8; + break; + case 32: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_9; + break; + case 48: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_10; + break; + case 64: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_11; + break; + case 96: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_12; + break; + case 128: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_13; + break; + case 176: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_14; + break; + case 192: + bclk_div = SUNXI_DAUDIO_BCLK_DIV_15; + break; + default: + dev_err(sunxi_daudio->dev, "unsupport clk_div\n"); + return -EINVAL; + } + /* setting bclk to driver external codec bit clk */ + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CLKDIV, + (SUNXI_DAUDIO_BCLK_DIV_MASK<private_data; + struct snd_soc_card *card = rtd->card; + struct sunxi_snddaudio_priv *snddaudio_priv = + snd_soc_card_get_drvdata(card); + + if (snddaudio_priv->mad_priv.sunxi_mad != sunxi_mad_get_mad_info()) + snddaudio_priv->mad_priv.sunxi_mad = sunxi_mad_get_mad_info(); + + sunxi_daudio->mad_priv = &(snddaudio_priv->mad_priv); + + return 0; +} +#endif + +static int sunxi_daudio_dai_startup(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + + /* FIXME: As HDMI module to play audio, it need at least 1100ms to sync. + * if we not wait we lost audio data to playback, or we wait for 1100ms + * to playback, user experience worst than you can imagine. So we need + * to cutdown that sync time by keeping clock signal on. we just enable + * it at startup and resume, cutdown it at remove and suspend time. + */ + if (sunxi_daudio->pdata->daudio_type == SUNXI_DAUDIO_TDMHDMI_TYPE) + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL, + (1<stream == SNDRV_PCM_STREAM_PLAYBACK) { + snd_soc_dai_set_dma_data(dai, substream, + &sunxi_daudio->playback_dma_param); + } else { + snd_soc_dai_set_dma_data(dai, substream, + &sunxi_daudio->capture_dma_param); + } + +#ifdef CONFIG_SND_SUNXI_MAD + sunxi_daudio_dai_mad_startup(substream, dai); +#endif + + return 0; +} + +static int sunxi_daudio_trigger(struct snd_pcm_substream *substream, + int cmd, struct snd_soc_dai *dai) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + struct sunxi_daudio_platform_data *pdata = sunxi_daudio->pdata; + + switch (cmd) { + case SNDRV_PCM_TRIGGER_START: + case SNDRV_PCM_TRIGGER_RESUME: + case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + sunxi_daudio_txctrl_enable(sunxi_daudio, true); + /* Global enable I2S/TDM module */ + if ((pdata->daudio_type != SUNXI_DAUDIO_TDMHDMI_TYPE) && + (!sunxi_daudio->playback_en)) { + sunxi_daudio_global_enable(sunxi_daudio, true); + sunxi_daudio->playback_en = 1; + } + } else { +#ifdef CONFIG_SND_SUNXI_MAD + if (pdata->daudio_type != SUNXI_DAUDIO_TDMHDMI_TYPE) { + switch (sunxi_daudio->mad_priv->mad_bind) { + case 0: + default: + sunxi_daudio_rxctrl_enable(sunxi_daudio, true); + sunxi_daudio_global_enable(sunxi_daudio, true); + break; + case 1: + sunxi_daudio_rxctrl_mad_enable(sunxi_daudio, true); + if (sunxi_daudio->capture_en) + break; + sunxi_daudio_global_enable(sunxi_daudio, true); + sunxi_daudio->capture_en = 1; + break; + } + } else + sunxi_daudio_rxctrl_enable(sunxi_daudio, true); +#else + sunxi_daudio_rxctrl_enable(sunxi_daudio, true); + if (pdata->daudio_type != SUNXI_DAUDIO_TDMHDMI_TYPE) + sunxi_daudio_global_enable(sunxi_daudio, true); +#endif + } + break; + case SNDRV_PCM_TRIGGER_STOP: + case SNDRV_PCM_TRIGGER_SUSPEND: + case SNDRV_PCM_TRIGGER_PAUSE_PUSH: + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + sunxi_daudio_txctrl_enable(sunxi_daudio, false); + /* Global enable I2S/TDM module */ + if ((pdata->daudio_type != SUNXI_DAUDIO_TDMHDMI_TYPE) && + (sunxi_daudio->playback_en)) { + sunxi_daudio_global_enable(sunxi_daudio, false); + sunxi_daudio->playback_en = 0; + } + } else { + if (sunxi_daudio->pdata->daudio_type != SUNXI_DAUDIO_TDMHDMI_TYPE) { +#ifdef CONFIG_SND_SUNXI_MAD + /* should not shutdown when capturing at mad working. */ + if (sunxi_daudio->mad_priv->mad_bind) { + sunxi_daudio_rxctrl_mad_enable(sunxi_daudio, false); + if (sunxi_daudio->capture_en) + break; + } else +#endif + { + sunxi_daudio_rxctrl_enable(sunxi_daudio, false); + } + sunxi_daudio_global_enable(sunxi_daudio, false); + } else + sunxi_daudio_rxctrl_enable(sunxi_daudio, false); + } + break; + default: + return -EINVAL; + } + + return 0; +} + +#ifdef CONFIG_SND_SUNXI_MAD +static int sunxi_daudio_mad_prepare(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + struct snd_soc_pcm_runtime *rtd = substream->private_data; + struct snd_soc_card *card = rtd->card; + struct sunxi_snddaudio_priv *snddaudio_priv = + snd_soc_card_get_drvdata(card); + struct sunxi_mad_priv *mad_priv = &(snddaudio_priv->mad_priv); + unsigned int reg_val = 0; + + if ((substream->runtime->status->state != SNDRV_PCM_STATE_XRUN) + && (mad_priv->mad_bind && sunxi_daudio->capture_en)) { + regmap_read(sunxi_daudio->regmap, SUNXI_DAUDIO_INTSTA, ®_val); + pr_warn("[%s] %d SUNXI_DAUDIO_INTSTA[0x%x]: 0x%x.\n", + __func__, __LINE__, SUNXI_DAUDIO_INTSTA, reg_val); + return 0; + } + + if ((substream->runtime->status->state == SNDRV_PCM_STATE_XRUN) + && sunxi_daudio->capture_en) { + regmap_read(sunxi_daudio->regmap, SUNXI_DAUDIO_INTSTA, ®_val); + pr_warn("[%s] %d SUNXI_DAUDIO_INTSTA[0x%x]: 0x%x.\n", + __func__, __LINE__, SUNXI_DAUDIO_INTSTA, reg_val); + pr_warn("[%s] PCM occurs xrun.\n", __func__); + + if (mad_priv->mad_bind) + return 0; + } + + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FIFOCTL, + (1<regmap, SUNXI_DAUDIO_RXCNT, 0); + + return 0; +} +#endif + +static int sunxi_daudio_prepare(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + unsigned int i; + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + for (i = 0 ; i < SUNXI_DAUDIO_FTX_TIMES ; i++) { + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_FIFOCTL, + (1<regmap, SUNXI_DAUDIO_TXCNT, 0); + + if (sunxi_daudio->hub_mode && + sunxi_daudio->pdata->daudio_type != SUNXI_DAUDIO_TDMHDMI_TYPE) { + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1 << SDO0_EN), (1 << SDO0_EN)); + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1 << CTL_TXEN), (1 << CTL_TXEN)); + mutex_lock(&sunxi_daudio->global_mutex); + sunxi_daudio_global_enable(sunxi_daudio, true); + sunxi_daudio->playback_en = 1; + mutex_unlock(&sunxi_daudio->global_mutex); + } + } else { +#ifdef CONFIG_SND_SUNXI_MAD + sunxi_daudio_mad_prepare(substream, dai); +#else + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FIFOCTL, + (1<regmap, SUNXI_DAUDIO_RXCNT, 0); +#endif + } + + return 0; +} + +static int sunxi_daudio_probe(struct snd_soc_dai *dai) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + + mutex_init(&sunxi_daudio->mutex); + mutex_init(&sunxi_daudio->global_mutex); + sunxi_daudio_init(sunxi_daudio); + + return 0; +} + +#ifdef CONFIG_SND_SUNXI_MAD +static void sunxi_daudio_mad_shutdown(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + struct snd_soc_pcm_runtime *rtd = substream->private_data; + struct snd_soc_card *card = rtd->card; + struct sunxi_snddaudio_priv *snddaudio_priv = + snd_soc_card_get_drvdata(card); + + if ((substream->stream == SNDRV_PCM_STREAM_CAPTURE) && + (snddaudio_priv->mad_priv.mad_bind == 1)) { + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1<regmap, SUNXI_DAUDIO_CTL, + (0x1 << DAUDIO_MAD_DATA_EN), + (0x0 << DAUDIO_MAD_DATA_EN)); + + /* diable daudio src*/ + sunxi_daudio_mad_set_path(sunxi_daudio, false); + + sunxi_mad_close(); + + sunxi_daudio->capture_en = 0; + sunxi_daudio_global_enable(sunxi_daudio, false); +#ifndef MAD_CLK_ALWAYS_ON + sunxi_mad_module_clk_enable(false); +#endif + /* if not use mad again*/ + sunxi_daudio->capture_dma_param.dma_addr = + sunxi_daudio->res.start + SUNXI_DAUDIO_RXFIFO; + + switch (sunxi_daudio->pdata->tdm_num) { + case 0: + SUNXI_DAUDIO_DRQSRC(sunxi_daudio, 0); + break; + case 1: + SUNXI_DAUDIO_DRQSRC(sunxi_daudio, 1); + break; + case 2: + SUNXI_DAUDIO_DRQSRC(sunxi_daudio, 2); + break; + case 3: + SUNXI_DAUDIO_DRQSRC(sunxi_daudio, 3); + break; + default: + pr_alert("tdm_num setting overflow\n"); + break; + } + } +} +#endif + +static void sunxi_daudio_shutdown(struct snd_pcm_substream *substream, + struct snd_soc_dai *dai) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + + /* Special processing for HDMI hub playback to shutdown hdmi module */ + if (sunxi_daudio->pdata->daudio_type == SUNXI_DAUDIO_TDMHDMI_TYPE) { + mutex_lock(&sunxi_daudio->mutex); + if (sunxi_daudio->hub_mode) + sunxi_hdmi_codec_shutdown(substream, NULL); + mutex_unlock(&sunxi_daudio->mutex); + } else if ((substream->stream == SNDRV_PCM_STREAM_PLAYBACK) && + (sunxi_daudio->hub_mode)) { + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1 << SDO0_EN), (0 << SDO0_EN)); + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, + (1 << CTL_TXEN), (0 << CTL_TXEN)); + if (sunxi_daudio->playback_en) { + mutex_lock(&sunxi_daudio->global_mutex); + sunxi_daudio_global_enable(sunxi_daudio, false); + mutex_unlock(&sunxi_daudio->global_mutex); + sunxi_daudio->playback_en = 0; + } + return; + } +#ifdef CONFIG_SND_SUNXI_MAD + sunxi_daudio_mad_shutdown(substream, dai); +#endif +} + +static int sunxi_daudio_remove(struct snd_soc_dai *dai) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + + if (sunxi_daudio->pdata->daudio_type == SUNXI_DAUDIO_TDMHDMI_TYPE) + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL, + (1<dev)); + + if (sunxi_daudio->pdata->daudio_type == SUNXI_DAUDIO_TDMHDMI_TYPE) { + /* Global disable I2S/TDM module */ + mutex_lock(&sunxi_daudio->global_mutex); + sunxi_daudio_global_enable(sunxi_daudio, false); + mutex_unlock(&sunxi_daudio->global_mutex); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL, + (1<reg_label = kzalloc(sizeof(struct daudio_label) * SUNXI_DAUDIO_REG_NUM_MAX, + GFP_KERNEL); + /* for save daudio reg */ + for (i = 0; i < SUNXI_DAUDIO_REG_NUM_MAX; i++) + regmap_read(sunxi_daudio->regmap, i << 2, + &((sunxi_daudio->reg_label+i)->value)); + + if (sunxi_daudio->moduleclk != NULL) + clk_disable_unprepare(sunxi_daudio->moduleclk); +#ifdef DAUDIO_PLL_AUDIO_X4 + if (sunxi_daudio->pllclkx4 != NULL) + clk_disable_unprepare(sunxi_daudio->pllclkx4); +#endif + if (sunxi_daudio->pllclk != NULL) + clk_disable_unprepare(sunxi_daudio->pllclk); + + if (sunxi_daudio->pdata->external_type) { + ret = pinctrl_select_state(sunxi_daudio->pinctrl, + sunxi_daudio->pinstate_sleep); + if (ret) { + pr_warn("[daudio]select pin sleep state failed\n"); + return ret; + } + devm_pinctrl_put(sunxi_daudio->pinctrl); + } + + if (sunxi_daudio->vol_supply.daudio_regulator) + regulator_disable(sunxi_daudio->vol_supply.daudio_regulator); + + pr_debug("[daudio] suspend .%s end\n", dev_name(sunxi_daudio->dev)); + + return 0; +} + +static int sunxi_daudio_debug_resume(struct sunxi_daudio_info *sunxi_daudio) +{ + int ret = 0; + int i = 0; + + pr_debug("[%s] resume .%s start\n", __func__, + dev_name(sunxi_daudio->dev)); + + if (sunxi_daudio->vol_supply.daudio_regulator) { + ret = regulator_enable(sunxi_daudio->vol_supply.daudio_regulator); + if (ret) { + dev_err(sunxi_daudio->dev, + "resume enable duaido[%d] vcc-pin failed\n", + sunxi_daudio->pdata->tdm_num); + goto err_resume_out; + } + } + + if (clk_prepare_enable(sunxi_daudio->pllclk)) { + dev_err(sunxi_daudio->dev, "pllclk resume failed\n"); + ret = -EBUSY; + goto err_resume_out; + } +#ifdef DAUDIO_PLL_AUDIO_X4 + if (clk_prepare_enable(sunxi_daudio->pllclkx4)) { + dev_err(sunxi_daudio->dev, "pllclkx4 resume failed\n"); + ret = -EBUSY; + goto err_pllclk_disable; + } + if (clk_prepare_enable(sunxi_daudio->moduleclk)) { + dev_err(sunxi_daudio->dev, "moduleclk resume failed\n"); + ret = -EBUSY; + goto err_pllclkx4_disable; + } +#else + if (clk_prepare_enable(sunxi_daudio->moduleclk)) { + dev_err(sunxi_daudio->dev, "moduleclk resume failed\n"); + ret = -EBUSY; + goto err_pllclk_disable; + } +#endif + + if (sunxi_daudio->pdata->external_type) { + sunxi_daudio->pinctrl = devm_pinctrl_get(sunxi_daudio->dev); + if (IS_ERR_OR_NULL(sunxi_daudio)) { + dev_err(sunxi_daudio->dev, "pinctrl resume get fail\n"); + ret = -ENOMEM; + goto err_moduleclk_disable; + } + sunxi_daudio->pinstate = pinctrl_lookup_state( + sunxi_daudio->pinctrl, PINCTRL_STATE_DEFAULT); + if (IS_ERR_OR_NULL(sunxi_daudio->pinstate)) { + dev_err(sunxi_daudio->dev, + "pinctrl default state get failed\n"); + ret = -EINVAL; + goto err_pinctrl_put; + } +#ifdef DAUDIO_PINCTRL_STATE_DEFAULT_B + sunxi_daudio->pinstate_b = pinctrl_lookup_state( + sunxi_daudio->pinctrl, + DAUDIO_PINCTRL_STATE_DEFAULT_B); + if (IS_ERR_OR_NULL(sunxi_daudio->pinstate_b)) { + dev_err(&pdev->dev, "pinctrl default state get fail\n"); + ret = -EINVAL; + goto err_pinctrl_put; + } +#endif + sunxi_daudio->pinstate_sleep = pinctrl_lookup_state( + sunxi_daudio->pinctrl, PINCTRL_STATE_SLEEP); + if (IS_ERR_OR_NULL(sunxi_daudio->pinstate_sleep)) { + dev_err(sunxi_daudio->dev, + "pinctrl sleep state get failed\n"); + ret = -EINVAL; + goto err_pinctrl_put; + } + ret = pinctrl_select_state(sunxi_daudio->pinctrl, + sunxi_daudio->pinstate); + if (ret) + dev_warn(sunxi_daudio->dev, + "daudio set pinctrl default state fail\n"); +#ifdef DAUDIO_PINCTRL_STATE_DEFAULT_B + ret = pinctrl_select_state(sunxi_daudio->pinctrl, + sunxi_daudio->pinstate_b); + if (ret) + dev_warn(sunxi_daudio->dev, + "daudio set pinctrl pins_b state fail\n"); +#endif + } + + sunxi_daudio_init(sunxi_daudio); + + /* for echo the save reg */ + for (i = 0; i < SUNXI_DAUDIO_REG_NUM_MAX; i++) + regmap_write(sunxi_daudio->regmap, i << 2, + (sunxi_daudio->reg_label+i)->value); + kfree(sunxi_daudio->reg_label); + /* for clear fifo */ + for (i = 0 ; i < SUNXI_DAUDIO_FTX_TIMES ; i++) { + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FIFOCTL, + (1<regmap, SUNXI_DAUDIO_TXCNT, 0); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FIFOCTL, + (1<regmap, SUNXI_DAUDIO_RXCNT, 0); + + if (sunxi_daudio->pdata->daudio_type == SUNXI_DAUDIO_TDMHDMI_TYPE) { + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL, + (1<hdmi_en) { + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, (1<regmap, + SUNXI_DAUDIO_CTL, (1<regmap, + SUNXI_DAUDIO_CTL, (1<global_mutex); + sunxi_daudio_global_enable(sunxi_daudio, true); + mutex_unlock(&sunxi_daudio->global_mutex); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL, + (1<dev)); + return 0; +err_pinctrl_put: + devm_pinctrl_put(sunxi_daudio->pinctrl); +err_moduleclk_disable: + clk_disable_unprepare(sunxi_daudio->moduleclk); +#ifdef DAUDIO_PLL_AUDIO_X4 +err_pllclkx4_disable: + clk_disable_unprepare(sunxi_daudio->pllclkx4); +#endif +err_pllclk_disable: + clk_disable_unprepare(sunxi_daudio->pllclk); +err_resume_out: + return ret; +} +#endif + +static int sunxi_daudio_suspend(struct snd_soc_dai *dai) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + int ret = 0; + int i = 0; + + pr_debug("[daudio] suspend .%s start\n", dev_name(sunxi_daudio->dev)); + +#ifdef CONFIG_SND_SUNXI_MAD + if (sunxi_daudio->mad_priv && sunxi_daudio->mad_priv->mad_bind + && (sunxi_daudio->capture_en == 1)) { + /* + * must ensure that the sunxi_daudio_rxctrl_stop_mad_reset + * was calling has finished. Because mad need the data source. + */ + sunxi_mad_suspend_external(); + pr_debug("mad suspend succeed %s\n", __func__); + return 0; + } +#endif + + if (sunxi_daudio->pdata->daudio_type == SUNXI_DAUDIO_TDMHDMI_TYPE) { + /* Global disable I2S/TDM module */ + mutex_lock(&sunxi_daudio->global_mutex); + sunxi_daudio_global_enable(sunxi_daudio, 0); + mutex_unlock(&sunxi_daudio->global_mutex); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL, + (1<reg_label = kzalloc(sizeof(struct daudio_label) * SUNXI_DAUDIO_REG_NUM_MAX, + GFP_KERNEL); + /* for save daudio reg */ + for (i = 0; i < SUNXI_DAUDIO_REG_NUM_MAX; i++) + regmap_read(sunxi_daudio->regmap, i << 2, + &((sunxi_daudio->reg_label+i)->value)); + + if (sunxi_daudio->moduleclk != NULL) + clk_disable_unprepare(sunxi_daudio->moduleclk); +#ifdef DAUDIO_PLL_AUDIO_X4 + if (sunxi_daudio->pllclkx4 != NULL) + clk_disable_unprepare(sunxi_daudio->pllclkx4); +#endif + if (sunxi_daudio->pllclk != NULL) + clk_disable_unprepare(sunxi_daudio->pllclk); + if (sunxi_daudio->pdata->external_type) { + ret = pinctrl_select_state(sunxi_daudio->pinctrl, + sunxi_daudio->pinstate_sleep); + if (ret) { + pr_warn("[daudio]select pin sleep state failed\n"); + return ret; + } + devm_pinctrl_put(sunxi_daudio->pinctrl); + } + + if (sunxi_daudio->vol_supply.daudio_regulator) + regulator_disable(sunxi_daudio->vol_supply.daudio_regulator); + + pr_debug("[daudio] suspend .%s end \n", dev_name(sunxi_daudio->dev)); + return 0; +} + +static int sunxi_daudio_resume(struct snd_soc_dai *dai) +{ + struct sunxi_daudio_info *sunxi_daudio = snd_soc_dai_get_drvdata(dai); + int ret; + int i = 0; + + pr_debug("[%s] resume .%s start\n", __func__, + dev_name(sunxi_daudio->dev)); + +#ifdef CONFIG_SND_SUNXI_MAD + if (sunxi_daudio->mad_priv && sunxi_daudio->mad_priv->mad_bind + && (sunxi_daudio->capture_en == 1)) { + sunxi_mad_resume_external(); + pr_debug("mad resume succeed %s\n", __func__); + return 0; + } +#endif + if (sunxi_daudio->vol_supply.daudio_regulator) { + ret = regulator_enable(sunxi_daudio->vol_supply.daudio_regulator); + if (ret) { + dev_err(sunxi_daudio->dev, + "resume enable duaido vcc-pin failed\n"); + goto err_resume_out; + } + } + if (clk_prepare_enable(sunxi_daudio->pllclk)) { + dev_err(sunxi_daudio->dev, "pllclk resume failed\n"); + ret = -EBUSY; + goto err_resume_out; + } +#ifdef DAUDIO_PLL_AUDIO_X4 + if (clk_prepare_enable(sunxi_daudio->pllclkx4)) { + dev_err(sunxi_daudio->dev, "pllclkx4 resume failed\n"); + ret = -EBUSY; + goto err_pllclk_disable; + } + if (clk_prepare_enable(sunxi_daudio->moduleclk)) { + dev_err(sunxi_daudio->dev, "moduleclk resume failed\n"); + ret = -EBUSY; + goto err_pllclkx4_disable; + } +#else + if (clk_prepare_enable(sunxi_daudio->moduleclk)) { + dev_err(sunxi_daudio->dev, "moduleclk resume failed\n"); + ret = -EBUSY; + goto err_pllclk_disable; + } +#endif + if (sunxi_daudio->pdata->external_type) { + sunxi_daudio->pinctrl = devm_pinctrl_get(sunxi_daudio->dev); + if (IS_ERR_OR_NULL(sunxi_daudio)) { + dev_err(sunxi_daudio->dev, "pinctrl resume get fail\n"); + ret = -ENOMEM; + goto err_moduleclk_disable; + } + sunxi_daudio->pinstate = pinctrl_lookup_state( + sunxi_daudio->pinctrl, PINCTRL_STATE_DEFAULT); + if (IS_ERR_OR_NULL(sunxi_daudio->pinstate)) { + dev_err(sunxi_daudio->dev, + "pinctrl default state get failed\n"); + ret = -EINVAL; + goto err_pinctrl_put; + } +#ifdef DAUDIO_PINCTRL_STATE_DEFAULT_B + sunxi_daudio->pinstate_b = pinctrl_lookup_state( + sunxi_daudio->pinctrl, + DAUDIO_PINCTRL_STATE_DEFAULT_B); + if (IS_ERR_OR_NULL(sunxi_daudio->pinstate_b)) { + dev_err(sunxi_daudio->dev, + "pinctrl default state get fail\n"); + ret = -EINVAL; + goto err_pinctrl_put; + } +#endif + sunxi_daudio->pinstate_sleep = pinctrl_lookup_state( + sunxi_daudio->pinctrl, PINCTRL_STATE_SLEEP); + if (IS_ERR_OR_NULL(sunxi_daudio->pinstate_sleep)) { + dev_err(sunxi_daudio->dev, + "pinctrl sleep state get failed\n"); + ret = -EINVAL; + goto err_pinctrl_put; + } + ret = pinctrl_select_state(sunxi_daudio->pinctrl, + sunxi_daudio->pinstate); + if (ret) + dev_warn(sunxi_daudio->dev, + "daudio set pinctrl default state fail\n"); +#ifdef DAUDIO_PINCTRL_STATE_DEFAULT_B + ret = pinctrl_select_state(sunxi_daudio->pinctrl, + sunxi_daudio->pinstate_b); + if (ret) + dev_warn(sunxi_daudio->dev, + "daudio set pinctrl pins_b state fail\n"); +#endif + } + + sunxi_daudio_init(sunxi_daudio); + + /* for echo the save reg */ + for (i = 0; i < SUNXI_DAUDIO_REG_NUM_MAX; i++) + regmap_write(sunxi_daudio->regmap, i << 2, + (sunxi_daudio->reg_label+i)->value); + kfree(sunxi_daudio->reg_label); + + /* for clear fifo */ + for (i = 0 ; i < SUNXI_DAUDIO_FTX_TIMES ; i++) { + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FIFOCTL, + (1<regmap, SUNXI_DAUDIO_TXCNT, 0); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FIFOCTL, + (1<regmap, SUNXI_DAUDIO_RXCNT, 0); + + if (sunxi_daudio->pdata->daudio_type == SUNXI_DAUDIO_TDMHDMI_TYPE) { + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL, + (1<hdmi_en) { + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, (1<regmap, + SUNXI_DAUDIO_CTL, (1<regmap, + SUNXI_DAUDIO_CTL, (1<global_mutex); + sunxi_daudio_global_enable(sunxi_daudio, true); + mutex_unlock(&sunxi_daudio->global_mutex); + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL, + (1<dev)); + + return 0; + +err_pinctrl_put: + devm_pinctrl_put(sunxi_daudio->pinctrl); +err_moduleclk_disable: + clk_disable_unprepare(sunxi_daudio->moduleclk); +#ifdef DAUDIO_PLL_AUDIO_X4 +err_pllclkx4_disable: + clk_disable_unprepare(sunxi_daudio->pllclkx4); +#endif +err_pllclk_disable: + clk_disable_unprepare(sunxi_daudio->pllclk); +err_resume_out: + if (sunxi_daudio->vol_supply.daudio_regulator) + regulator_disable(sunxi_daudio->vol_supply.daudio_regulator); + return ret; +} + +#ifdef DAUDIO_CLASS_DEBUG +#ifdef DAUDIO_STANDBY_DEBUG +/* + * ex: + * param 1: 0 daudio0; 1 daudio1;... + * param 2: 0 suspend; 1 resume; + * param 3: 0 disabled; 1 enabled; + * + * write: + * echo 0,0x1,0x1 > daudio_standby + * echo 1,0x1,0x1 > daudio_standby + */ +static ssize_t daudio_class_standby_show(struct class *class, + struct class_attribute *attr, char *buf) +{ + int i; + ssize_t count = 0; + int daudio_num = daudio_standby_debug >> 4; + int standby_mode = (daudio_standby_debug >> 1) & 0x1; + int enable = daudio_standby_debug & 0x1; + + if (daudio_standby_debug == 0) { + count += sprintf(buf, "Example(:daudio_num->%d):\n", DAUDIO_NUM_MAX); + count += sprintf(buf + count, "echo 0,0x1,0x1 > daudio_standby\n\n"); + count += sprintf(buf + count, "param 1: 0 Daudio0; 1 Daudio1;...\n"); + count += sprintf(buf + count, "param 2: 0 Suspend; 1 Resume;\n"); + count += sprintf(buf + count, "param 3: 0 disabled; 1 enabled;\n"); + count += sprintf(buf + count, "Daudio[1], Standby->[resume], Enable\n\n"); + return count; + } + pr_err("[%s], Daudio[%d], Standby->[%s], %s\n", __func__, + daudio_num, + standby_mode ? "resume":"suspend", + enable ? "Enable":"Disable"); + + for (i = 0; i < DAUDIO_NUM_MAX; i++) { + if (sunxi_daudio_global[i] && sunxi_daudio_global[i]->pdata) { + if ((sunxi_daudio_global[i]->pdata->tdm_num == + (daudio_standby_debug >> 4)) && + (daudio_standby_debug & 0x1)) { + if ((daudio_standby_debug >> 1) & 0x1) { + sunxi_daudio_debug_resume( + sunxi_daudio_global[i]); + } else { + sunxi_daudio_debug_suspend( + sunxi_daudio_global[i]); + } + } + } + } + + daudio_standby_debug = 0; + + return 0; +} + +static ssize_t daudio_class_standby_store(struct class *class, + struct class_attribute *attr, const char *buf, size_t count) +{ + int ret; + int input_reg_group = 0; + int standby_mode = 0; + int input_bool_val = 0; + + ret = sscanf(buf, "%d,0x%x,0x%x", &input_reg_group, + &standby_mode, &input_bool_val); + + if ((input_reg_group >= DAUDIO_NUM_MAX) || (input_reg_group < 0)) { + pr_err("not exist daudio%d\n", input_reg_group); + return count; + } + + if ((standby_mode > 1) || (standby_mode < 0) || + (input_bool_val > 1) || (input_bool_val < 0)) { + pr_err("is bool vaule!!\n"); + return count; + } + + daudio_standby_debug = (input_reg_group << 4) & 0xf0; + daudio_standby_debug |= (standby_mode << 1) & 0x2; + daudio_standby_debug |= input_bool_val & 0x1; + pr_err("ret:%d, Daudio[%d], Standby->[%s], %s\n", + ret, input_reg_group, standby_mode ? "resume":"suspend", + input_bool_val ? "Enable":"Disable"); + + return count; +} +#endif + +/* + * ex: + * param 1: 0 read;1 write + * param 2: 0 daudio0; 1 daudio1; + * param 3: address; + * param 4: write value; + * read: + * echo 0,0 > daudio_reg_debug + * echo 0,1 > daudio_reg_debug + * echo 0,0,0x4 > daudio_reg_debug + * echo 0,1,0x0a > daudio_reg_debug + * write: + * echo 1,0,0x00,0xa > daudio_reg_debug + * echo 1,0,0x00,0xff > daudio_reg_debug + */ +static ssize_t daudio_class_debug_store(struct class *class, + struct class_attribute *attr, const char *buf, size_t count) +{ + int ret; + int rw_flag; + int reg_val_read; + unsigned int input_reg_val = 0; + int input_reg_group = 0; + unsigned int input_reg_offset = 0; + int i = 0; + + ret = sscanf(buf, "%d,%d,0x%x,0x%x", &rw_flag, &input_reg_group, + &input_reg_offset, &input_reg_val); + if (!(rw_flag == 1 || rw_flag == 0)) { + pr_err("not rw_flag\n"); + return count; + } + if ((input_reg_group >= DAUDIO_NUM_MAX) || + !sunxi_daudio_global[input_reg_group]) { + pr_err("not exist daudio[%d] driver or device\n", + input_reg_group); + pr_err("Daudio device list:\n\n"); + for (i = 0; i < DAUDIO_NUM_MAX; i++) { + if (sunxi_daudio_global[i] != NULL) + pr_err(" Daudio[%d]\n", i); + } + return count; + } + + pr_err("Dump daudio reg:\n"); + if (rw_flag) { + if (ret == 4) { + writel(input_reg_val, + sunxi_daudio_global[input_reg_group]->membase + + input_reg_offset); + reg_val_read = readl( + sunxi_daudio_global[input_reg_group]->membase + + input_reg_offset); + pr_err("\n\n Daudio[%d] Reg[0x%x] : 0x%x\n\n", + input_reg_group, input_reg_offset, + reg_val_read); + } else { + pr_err("\nnum of params invalid\n"); + } + } else { + switch (ret) { + case 2: + while (reg_labels[i].name != NULL) { + pr_err("%s 0x%p: 0x%x\n", reg_labels[i].name, + (sunxi_daudio_global[input_reg_group]->membase + + reg_labels[i].address), + readl(sunxi_daudio_global[input_reg_group]->membase + + reg_labels[i].address)); + i++; + } + break; + case 3: + reg_val_read = readl( + sunxi_daudio_global[input_reg_group]->membase + + input_reg_offset); + pr_err("\n\n Daudio[%d] Reg[0x%x] : 0x%x\n\n", + input_reg_group, input_reg_offset, + reg_val_read); + break; + default: + pr_err("\nnum of params invalid\n"); + break; + } + } + + return count; +} + +static ssize_t daudio_class_debug_show(struct class *class, + struct class_attribute *attr, char *buf) +{ + int count = 0; + int i = 0; + + count += sprintf(buf, "Example(:daudio_num->%d):\n", DAUDIO_NUM_MAX); + count += sprintf(buf + count, "param 1: 0 read; 1 write;\n"); + count += sprintf(buf + count, "param 2: 0 daudio0; 1 dauido1...;\n"); + count += sprintf(buf + count, "param 3: address\n"); + count += sprintf(buf + count, "param 4: reg value\n\n"); + count += sprintf(buf + count, "echo 0,0 > daudio_reg_debug\n"); + count += sprintf(buf + count, "echo 0,1,0x4 > daudio_reg_debug\n"); + count += sprintf(buf + count, "echo 1,0,0x4,0x1 > daudio_reg_debug\n"); + count += sprintf(buf + count, "echo 1,1,0x14,0xa > daudio_reg_debug\n\n"); + count += sprintf(buf + count, "daudio device list:\n\n"); + + for (i = 0; i < DAUDIO_NUM_MAX; i++) { + if (sunxi_daudio_global[i] != NULL) + count += sprintf(buf + count, " Daudio[%d]\n", i); + } + return count; +} + +static struct class_attribute daudio_class_attrs[] = { +#ifdef DAUDIO_STANDBY_DEBUG + __ATTR(daudio_standby, S_IRUGO|S_IWUSR, daudio_class_standby_show, daudio_class_standby_store), +#endif + __ATTR(daudio_reg_debug, S_IRUGO|S_IWUSR, daudio_class_debug_show, daudio_class_debug_store), + __ATTR_NULL +}; +static struct class daudio_class = { + .name = "daudio", + .class_attrs = daudio_class_attrs, +}; +#endif + +static struct snd_soc_dai_ops sunxi_daudio_dai_ops = { + .hw_params = sunxi_daudio_hw_params, + .set_sysclk = sunxi_daudio_set_sysclk, + .set_clkdiv = sunxi_daudio_set_clkdiv, + .set_fmt = sunxi_daudio_set_fmt, + .startup = sunxi_daudio_dai_startup, + .trigger = sunxi_daudio_trigger, + .prepare = sunxi_daudio_prepare, + .shutdown = sunxi_daudio_shutdown, +}; + +static struct snd_soc_dai_driver sunxi_daudio_dai = { + .probe = sunxi_daudio_probe, + .suspend = sunxi_daudio_suspend, + .resume = sunxi_daudio_resume, + .remove = sunxi_daudio_remove, + .playback = { + .channels_min = 1, + .channels_max = 8, + .rates = SUNXI_DAUDIO_RATES, + .formats = SNDRV_PCM_FMTBIT_S16_LE + | SNDRV_PCM_FMTBIT_S20_3LE + | SNDRV_PCM_FMTBIT_S24_LE + | SNDRV_PCM_FMTBIT_S32_LE, + }, + .capture = { + .channels_min = 1, + .channels_max = 8, + .rates = SUNXI_DAUDIO_RATES, + .formats = SNDRV_PCM_FMTBIT_S16_LE + | SNDRV_PCM_FMTBIT_S20_3LE + | SNDRV_PCM_FMTBIT_S24_LE + | SNDRV_PCM_FMTBIT_S32_LE, + }, + .ops = &sunxi_daudio_dai_ops, +}; + +static const struct snd_soc_component_driver sunxi_daudio_component = { + .name = DRV_NAME, + .controls = sunxi_daudio_controls, + .num_controls = ARRAY_SIZE(sunxi_daudio_controls), +}; + +static struct sunxi_daudio_platform_data sunxi_daudio = { + .daudio_type = SUNXI_DAUDIO_EXTERNAL_TYPE, + .external_type = 1, +}; + +/* + * For HDMI default: + * daudio_master: + *; 1: SND_SOC_DAIFMT_CBM_CFM(codec clk & FRM master) + *; 4: SND_SOC_DAIFMT_CBS_CFS(codec clk & FRM slave) + *;audio_format: + *; 1:SND_SOC_DAIFMT_I2S(standard i2s format). use + *; 2:SND_SOC_DAIFMT_RIGHT_J(right justfied format). + *; 3:SND_SOC_DAIFMT_LEFT_J(left justfied format) + *; 4:SND_SOC_DAIFMT_DSP_A + * (pcm. MSB is available on 2nd BCLK rising edge after LRC rising edge) + *; 5:SND_SOC_DAIFMT_DSP_B + * (pcm. MSB is available on 1nd BCLK rising edge after LRC rising edge) + *;signal_inversion: + *; 1:SND_SOC_DAIFMT_NB_NF(normal bit clock + frame) use + *; 2:SND_SOC_DAIFMT_NB_IF(normal BCLK + inv FRM) + *; 3:SND_SOC_DAIFMT_IB_NF(invert BCLK + nor FRM) use + *; 4:SND_SOC_DAIFMT_IB_IF(invert BCLK + FRM) + * + *.audio_format = 1, + *.signal_inversion = 1, + *.daudio_master = 4, + */ +static struct sunxi_daudio_platform_data sunxi_tdmhdmi = { + .daudio_type = SUNXI_DAUDIO_TDMHDMI_TYPE, + .external_type = 0, + .audio_format = 1, + .signal_inversion = 1, + .daudio_master = 4, + .pcm_lrck_period = 32, + .slot_width_select = 32, + .tdm_config = 1, + .mclk_div = 0, +}; + +static const struct of_device_id sunxi_daudio_of_match[] = { + { + .compatible = "allwinner,sunxi-daudio", + .data = &sunxi_daudio, + }, + { + .compatible = "allwinner,sunxi-tdmhdmi", + .data = &sunxi_tdmhdmi, + }, + {}, +}; +MODULE_DEVICE_TABLE(of, sunxi_daudio_of_match); + +static struct regmap_config sunxi_daudio_regmap_config = { + .reg_bits = 32, + .reg_stride = 4, + .val_bits = 32, + .max_register = SUNXI_DAUDIO_DEBUG, + .cache_type = REGCACHE_NONE, +}; + +static int sunxi_daudio_dev_probe(struct platform_device *pdev) +{ + const struct of_device_id *match; + struct sunxi_daudio_info *sunxi_daudio; + struct device_node *np = pdev->dev.of_node; + unsigned int temp_val; + int ret; + + match = of_match_device(sunxi_daudio_of_match, &pdev->dev); + if (match) { + sunxi_daudio = devm_kzalloc(&pdev->dev, + sizeof(struct sunxi_daudio_info), + GFP_KERNEL); + if (!sunxi_daudio) { + dev_err(&pdev->dev, "alloc sunxi_daudio failed\n"); + ret = -ENOMEM; + goto err_node_put; + } + dev_set_drvdata(&pdev->dev, sunxi_daudio); + + sunxi_daudio->dev = &pdev->dev; + sunxi_daudio->pdata = devm_kzalloc(&pdev->dev, + sizeof(struct sunxi_daudio_platform_data), + GFP_KERNEL); + if (!sunxi_daudio->pdata) { + dev_err(&pdev->dev, + "alloc sunxi daudio platform data failed\n"); + ret = -ENOMEM; + goto err_devm_kfree; + } + memcpy(sunxi_daudio->pdata, match->data, + sizeof(struct sunxi_daudio_platform_data)); + } else { + dev_err(&pdev->dev, "node match failed\n"); + return -EINVAL; + } + + ret = of_address_to_resource(np, 0, &(sunxi_daudio->res)); + if (ret) { + dev_err(&pdev->dev, "parse device node resource failed\n"); + ret = -EINVAL; + goto err_devm_kfree; + } + + /* init some params */ + sunxi_daudio->hub_mode = 0; + sunxi_daudio->playback_en = 0; + sunxi_daudio->capture_en = 0; + + sunxi_daudio->pllclk = of_clk_get(np, 0); + if (IS_ERR_OR_NULL(sunxi_daudio->pllclk)) { + dev_err(&pdev->dev, "pllclk get failed\n"); + ret = PTR_ERR(sunxi_daudio->pllclk); + goto err_devm_kfree; + } + +#ifdef DAUDIO_PLL_AUDIO_X4 + sunxi_daudio->pllclkx4 = of_clk_get(np, 1); + if (IS_ERR_OR_NULL(sunxi_daudio->pllclkx4)) { + dev_err(&pdev->dev, "pllclkx4 get failed\n"); + ret = PTR_ERR(sunxi_daudio->pllclkx4); + goto err_pllclk_put; + } + sunxi_daudio->moduleclk = of_clk_get(np, 2); + if (IS_ERR_OR_NULL(sunxi_daudio->moduleclk)) { + dev_err(&pdev->dev, "moduleclk get failed\n"); + ret = PTR_ERR(sunxi_daudio->moduleclk); + goto err_pllclkx4_put; + } + if (clk_set_parent(sunxi_daudio->moduleclk, sunxi_daudio->pllclkx4)) { + dev_err(&pdev->dev, "set parent of moduleclk to pllclkx4 fail\n"); + ret = -EBUSY; + goto err_moduleclk_put; + } + if (clk_prepare_enable(sunxi_daudio->pllclk)) { + dev_err(&pdev->dev, "pllclk enable failed\n"); + ret = -EBUSY; + goto err_moduleclk_put; + } + if (clk_prepare_enable(sunxi_daudio->pllclkx4)) { + dev_err(&pdev->dev, "pllclkx4 enable failed\n"); + ret = -EBUSY; + goto err_pllclk_disable; + } + if (clk_prepare_enable(sunxi_daudio->moduleclk)) { + dev_err(&pdev->dev, "moduleclk enable failed\n"); + ret = -EBUSY; + goto err_pllclkx4_disable; + } +#else + sunxi_daudio->moduleclk = of_clk_get(np, 1); + if (IS_ERR_OR_NULL(sunxi_daudio->moduleclk)) { + dev_err(&pdev->dev, "moduleclk get failed\n"); + ret = PTR_ERR(sunxi_daudio->moduleclk); + goto err_pllclk_put; + } + if (clk_set_parent(sunxi_daudio->moduleclk, sunxi_daudio->pllclk)) { + dev_err(&pdev->dev, "set parent of moduleclk to pllclk fail\n"); + ret = -EBUSY; + goto err_moduleclk_put; + } + if (clk_prepare_enable(sunxi_daudio->pllclk)) { + dev_err(&pdev->dev, "pllclk enable failed\n"); + ret = -EBUSY; + goto err_moduleclk_put; + } + if (clk_prepare_enable(sunxi_daudio->moduleclk)) { + dev_err(&pdev->dev, "moduleclk enable failed\n"); + ret = -EBUSY; + goto err_pllclk_disable; + } +#endif + if (sunxi_daudio->pdata->external_type) { + sunxi_daudio->pinctrl = devm_pinctrl_get(&pdev->dev); + if (IS_ERR_OR_NULL(sunxi_daudio->pinctrl)) { + dev_err(&pdev->dev, "pinctrl get failed\n"); + ret = -EINVAL; + goto err_moduleclk_disable; + } + sunxi_daudio->pinstate = pinctrl_lookup_state( + sunxi_daudio->pinctrl, PINCTRL_STATE_DEFAULT); + if (IS_ERR_OR_NULL(sunxi_daudio->pinstate)) { + dev_err(&pdev->dev, "pinctrl default state get fail\n"); + ret = -EINVAL; + goto err_pinctrl_put; + } +#ifdef DAUDIO_PINCTRL_STATE_DEFAULT_B + sunxi_daudio->pinstate_b = pinctrl_lookup_state( + sunxi_daudio->pinctrl, + DAUDIO_PINCTRL_STATE_DEFAULT_B); + if (IS_ERR_OR_NULL(sunxi_daudio->pinstate_b)) { + dev_err(&pdev->dev, "pinctrl default state get fail\n"); + ret = -EINVAL; + goto err_pinctrl_put; + } +#endif + sunxi_daudio->pinstate_sleep = pinctrl_lookup_state( + sunxi_daudio->pinctrl, PINCTRL_STATE_SLEEP); + if (IS_ERR_OR_NULL(sunxi_daudio->pinstate_sleep)) { + dev_err(&pdev->dev, "pinctrl sleep state get failed\n"); + ret = -EINVAL; + goto err_pinctrl_put; + } + + ret = pinctrl_select_state(sunxi_daudio->pinctrl, + sunxi_daudio->pinstate); + if (ret) + dev_warn(sunxi_daudio->dev, + "daudio set pinctrl default state fail\n"); +#ifdef DAUDIO_PINCTRL_STATE_DEFAULT_B + ret = pinctrl_select_state(sunxi_daudio->pinctrl, + sunxi_daudio->pinstate_b); + if (ret) + dev_warn(sunxi_daudio->dev, + "daudio set pinctrl pins_b state fail\n"); +#endif + } + + switch (sunxi_daudio->pdata->daudio_type) { + case SUNXI_DAUDIO_EXTERNAL_TYPE: + ret = of_property_read_u32(np, "tdm_num", &temp_val); + if (ret < 0) { + dev_warn(&pdev->dev, "tdm configuration missing\n"); + /* + * warnning just continue, + * making tdm_num as default setting + */ + sunxi_daudio->pdata->tdm_num = 0; + } else { + /* + * FIXME, for channel number mess, + * so just not check channel overflow + */ + sunxi_daudio->pdata->tdm_num = temp_val; + } + + sunxi_daudio->playback_dma_param.src_maxburst = 4; + sunxi_daudio->playback_dma_param.dst_maxburst = 4; + sunxi_daudio->capture_dma_param.dma_addr = + sunxi_daudio->res.start + SUNXI_DAUDIO_RXFIFO; + sunxi_daudio->capture_dma_param.src_maxburst = 4; + sunxi_daudio->capture_dma_param.dst_maxburst = 4; + sunxi_daudio->playback_dma_param.dma_addr = + sunxi_daudio->res.start + SUNXI_DAUDIO_TXFIFO; + + switch (sunxi_daudio->pdata->tdm_num) { + case 0: + SUNXI_DAUDIO_DRQDST(sunxi_daudio, 0); + SUNXI_DAUDIO_DRQSRC(sunxi_daudio, 0); + break; + case 1: + SUNXI_DAUDIO_DRQDST(sunxi_daudio, 1); + SUNXI_DAUDIO_DRQSRC(sunxi_daudio, 1); + break; + case 2: + SUNXI_DAUDIO_DRQDST(sunxi_daudio, 2); + SUNXI_DAUDIO_DRQSRC(sunxi_daudio, 2); + break; + case 3: + SUNXI_DAUDIO_DRQDST(sunxi_daudio, 3); + SUNXI_DAUDIO_DRQSRC(sunxi_daudio, 3); + break; + default: + dev_warn(&pdev->dev, "tdm_num setting overflow\n"); + ret = -EFAULT; + goto err_pinctrl_put; + break; + } + + sunxi_daudio->vol_supply.regulator_name = NULL; + ret = of_property_read_string(np, "daudio_regulator", + &sunxi_daudio->vol_supply.regulator_name); + if (ret < 0) { + dev_warn(&pdev->dev, "regulator missing or invalid\n"); + sunxi_daudio->vol_supply.daudio_regulator = NULL; + } else { + sunxi_daudio->vol_supply.daudio_regulator = + regulator_get(NULL, sunxi_daudio->vol_supply.regulator_name); + if (IS_ERR(sunxi_daudio->vol_supply.daudio_regulator)) { + pr_err("get duaido[%d] vcc-pin failed\n", + sunxi_daudio->pdata->tdm_num); + ret = -EFAULT; + goto err_pinctrl_put; + } + ret = regulator_set_voltage( + sunxi_daudio->vol_supply.daudio_regulator, + 3300000, 3300000); + if (ret) { + pr_err("set duaido[%d] voltage failed\n", + sunxi_daudio->pdata->tdm_num); + ret = -EFAULT; + goto err_regulator_get; + } + ret = regulator_enable( + sunxi_daudio->vol_supply.daudio_regulator); + if (ret) { + pr_err("enable duaido[%d] vcc-pin failed\n", + sunxi_daudio->pdata->tdm_num); + ret = -EFAULT; + goto err_regulator_get; + } + } + +#ifndef USE_ASOC_FMT_SETTING + ret = of_property_read_u32(np, "daudio_master", &temp_val); + if (ret < 0) { + dev_warn(&pdev->dev, "daudio_master configuration missing or invalid\n"); + /* + * default setting SND_SOC_DAIFMT_CBS_CFS mode + * codec clk & FRM slave + */ + sunxi_daudio->pdata->daudio_master = 4; + } else { + sunxi_daudio->pdata->daudio_master = temp_val; + } + + ret = of_property_read_u32(np, "audio_format", &temp_val); + if (ret < 0) { + dev_warn(&pdev->dev, "audio_format configuration missing or invalid\n"); + sunxi_daudio->pdata->audio_format = 1; + } else { + sunxi_daudio->pdata->audio_format = temp_val; + } + + ret = of_property_read_u32(np, "signal_inversion", &temp_val); + if (ret < 0) { + dev_warn(&pdev->dev, "signal_inversion configuration missing or invalid\n"); + sunxi_daudio->pdata->signal_inversion = 1; + } else { + sunxi_daudio->pdata->signal_inversion = temp_val; + } +#endif + + ret = of_property_read_u32(np, "pcm_lrck_period", &temp_val); + if (ret < 0) { + dev_warn(&pdev->dev, "pcm_lrck_period configuration missing or invalid\n"); + sunxi_daudio->pdata->pcm_lrck_period = 0; + } else { + sunxi_daudio->pdata->pcm_lrck_period = temp_val; + } + + ret = of_property_read_u32(np, "msb_lsb_first", &temp_val); + if (ret < 0) { + dev_warn(&pdev->dev, "msb_lsb_first configuration missing or invalid\n"); + sunxi_daudio->pdata->msb_lsb_first = 0; + } else + sunxi_daudio->pdata->msb_lsb_first = temp_val; + + ret = of_property_read_u32(np, "slot_width_select", &temp_val); + if (ret < 0) { + dev_warn(&pdev->dev, "slot_width_select configuration missing or invalid\n"); + sunxi_daudio->pdata->slot_width_select = 0; + } else { + sunxi_daudio->pdata->slot_width_select = temp_val; + } + + ret = of_property_read_u32(np, "frametype", &temp_val); + if (ret < 0) { + dev_warn(&pdev->dev, "frametype configuration missing or invalid\n"); + sunxi_daudio->pdata->frame_type = 0; + } else { + sunxi_daudio->pdata->frame_type = temp_val; + } + + ret = of_property_read_u32(np, "sign_extend", &temp_val); + if (ret < 0) { + dev_warn(&pdev->dev, "sign_extend configuration missing or invalid\n"); + sunxi_daudio->pdata->sign_extend = 0; + } else + sunxi_daudio->pdata->sign_extend = temp_val; + + ret = of_property_read_u32(np, "tx_data_mode", &temp_val); + if (ret < 0) { + dev_warn(&pdev->dev, "tx_data_mode configuration missing or invalid\n"); + sunxi_daudio->pdata->tx_data_mode = 0; + } else + sunxi_daudio->pdata->tx_data_mode = temp_val; + + ret = of_property_read_u32(np, "rx_data_mode", &temp_val); + if (ret < 0) { + dev_warn(&pdev->dev, "rx_data_mode configuration missing or invalid\n"); + sunxi_daudio->pdata->rx_data_mode = 0; + } else + sunxi_daudio->pdata->rx_data_mode = temp_val; + + ret = of_property_read_u32(np, "tdm_config", &temp_val); + if (ret < 0) { + dev_warn(&pdev->dev, "tdm_config configuration missing or invalid\n"); + sunxi_daudio->pdata->tdm_config = 1; + } else { + sunxi_daudio->pdata->tdm_config = temp_val; + } + + ret = of_property_read_u32(np, "mclk_div", &temp_val); + if (ret < 0) + sunxi_daudio->pdata->mclk_div = 0; + else + sunxi_daudio->pdata->mclk_div = temp_val; + break; + case SUNXI_DAUDIO_TDMHDMI_TYPE: +#ifdef SUNXI_HDMI_AUDIO_ENABLE + sunxi_daudio->playback_dma_param.dma_addr = + sunxi_daudio->res.start + SUNXI_DAUDIO_TXFIFO; + sunxi_daudio->playback_dma_param.dma_drq_type_num = + DRQDST_HDMI_TX; + sunxi_daudio->playback_dma_param.src_maxburst = 8; + sunxi_daudio->playback_dma_param.dst_maxburst = 8; + sunxi_daudio->hdmi_en = 1; +#ifdef CONFIG_SUNXI_AUDIO_DEBUG + sunxi_daudio->capture_dma_param.dma_addr = + sunxi_daudio->res.start + SUNXI_DAUDIO_RXFIFO; + sunxi_daudio->capture_dma_param.dma_drq_type_num = + DRQDST_HDMI_RX; + sunxi_daudio->capture_dma_param.src_maxburst = 8; + sunxi_daudio->capture_dma_param.dst_maxburst = 8; +#endif +#endif + break; + default: + dev_err(&pdev->dev, "missing digital audio type\n"); + ret = -EINVAL; + goto err_moduleclk_put; + } + + sunxi_daudio->memregion = devm_request_mem_region(&pdev->dev, + sunxi_daudio->res.start, + resource_size(&sunxi_daudio->res), + DRV_NAME); + if (!sunxi_daudio->memregion) { + dev_err(&pdev->dev, "Memory region already claimed\n"); + ret = -EBUSY; + goto err_regulator_disable; + } + + sunxi_daudio->membase = devm_ioremap(&pdev->dev, + sunxi_daudio->memregion->start, + resource_size(sunxi_daudio->memregion)); + if (!sunxi_daudio->membase) { + dev_err(&pdev->dev, "ioremap failed\n"); + ret = -EBUSY; + goto err_devm_free_memregion; + } + + sunxi_daudio->regmap = devm_regmap_init_mmio(&pdev->dev, + sunxi_daudio->membase, + &sunxi_daudio_regmap_config); + if (IS_ERR_OR_NULL(sunxi_daudio->regmap)) { + dev_err(&pdev->dev, "regmap init failed\n"); + ret = PTR_ERR(sunxi_daudio->regmap); + goto err_iounmap; + } + + ret = snd_soc_register_component(&pdev->dev, &sunxi_daudio_component, + &sunxi_daudio_dai, 1); + if (ret) { + dev_err(&pdev->dev, "component register failed\n"); + ret = -ENOMEM; + goto err_iounmap; + } + + switch (sunxi_daudio->pdata->daudio_type) { + case SUNXI_DAUDIO_EXTERNAL_TYPE: + ret = asoc_dma_platform_register(&pdev->dev, 0); + if (ret) { + dev_err(&pdev->dev, "register ASoC platform failed\n"); + ret = -ENOMEM; + goto err_unregister_component; + } + break; + case SUNXI_DAUDIO_TDMHDMI_TYPE: + ret = asoc_dma_platform_register(&pdev->dev, + SND_DMAENGINE_PCM_FLAG_NO_DT); + if (ret) { + dev_err(&pdev->dev, "register ASoC platform failed\n"); + ret = -ENOMEM; + goto err_unregister_component; + } + break; + default: + dev_err(&pdev->dev, "missing digital audio type\n"); + ret = -EINVAL; + goto err_unregister_component; + } +#ifdef DAUDIO_CLASS_DEBUG + if (daudio_class_dev_cnt++ == 0) { + ret = class_register(&daudio_class); + if (ret) + pr_warn("daudio: Failed to create debugfs directory\n"); + } +#endif + +#ifdef CONFIG_SND_SUNXI_MAD + INIT_WORK(&(sunxi_daudio->ws_rx_mad_reset), + sunxi_daudio_rxctrl_stop_mad_reset); +#endif + + sunxi_daudio_global[sunxi_daudio->pdata->tdm_num] = sunxi_daudio; + + if (sunxi_daudio->pdata->daudio_type == SUNXI_DAUDIO_TDMHDMI_TYPE) { + regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL, + (1<hdmi_en) { + regmap_update_bits(sunxi_daudio->regmap, + SUNXI_DAUDIO_CTL, (1<regmap, + SUNXI_DAUDIO_CTL, (1<regmap, + SUNXI_DAUDIO_CTL, (1<dev); +err_iounmap: + devm_iounmap(&pdev->dev, sunxi_daudio->membase); +err_devm_free_memregion: + devm_release_mem_region(&pdev->dev, sunxi_daudio->memregion->start, + resource_size(sunxi_daudio->memregion)); +err_regulator_disable: + if (sunxi_daudio->pdata->external_type && + sunxi_daudio->vol_supply.daudio_regulator) + regulator_disable(sunxi_daudio->vol_supply.daudio_regulator); +err_regulator_get: + if (sunxi_daudio->pdata->external_type && + sunxi_daudio->vol_supply.daudio_regulator) + regulator_put(sunxi_daudio->vol_supply.daudio_regulator); +err_pinctrl_put: + if (sunxi_daudio->pdata->external_type) + devm_pinctrl_put(sunxi_daudio->pinctrl); +err_moduleclk_disable: + clk_disable_unprepare(sunxi_daudio->moduleclk); +#ifdef DAUDIO_PLL_AUDIO_X4 +err_pllclkx4_disable: + clk_disable_unprepare(sunxi_daudio->pllclkx4); +#endif +err_pllclk_disable: + clk_disable_unprepare(sunxi_daudio->pllclk); +err_moduleclk_put: + clk_put(sunxi_daudio->moduleclk); +#ifdef DAUDIO_PLL_AUDIO_X4 +err_pllclkx4_put: + clk_put(sunxi_daudio->pllclkx4); +#endif +err_pllclk_put: + clk_put(sunxi_daudio->pllclk); +err_devm_kfree: + devm_kfree(&pdev->dev, sunxi_daudio); +err_node_put: + of_node_put(np); + return ret; +} + +static int __exit sunxi_daudio_dev_remove(struct platform_device *pdev) +{ + struct sunxi_daudio_info *sunxi_daudio = dev_get_drvdata(&pdev->dev); + +#ifdef DAUDIO_CLASS_DEBUG + if (--daudio_class_dev_cnt == 0) + class_unregister(&daudio_class); +#endif + +#ifdef CONFIG_SND_SUNXI_MAD + cancel_work_sync(&sunxi_daudio->ws_rx_mad_reset); +#endif + + if (sunxi_daudio->pdata->external_type) + devm_pinctrl_put(sunxi_daudio->pinctrl); + + if (sunxi_daudio->vol_supply.daudio_regulator) { + regulator_disable(sunxi_daudio->vol_supply.daudio_regulator); + regulator_put(sunxi_daudio->vol_supply.daudio_regulator); + } + + devm_iounmap(&pdev->dev, sunxi_daudio->membase); + + devm_release_mem_region(&pdev->dev, sunxi_daudio->memregion->start, + resource_size(sunxi_daudio->memregion)); + + asoc_dma_platform_unregister(&pdev->dev); + snd_soc_unregister_component(&pdev->dev); + + clk_disable_unprepare(sunxi_daudio->moduleclk); + clk_put(sunxi_daudio->moduleclk); +#ifdef DAUDIO_PLL_AUDIO_X4 + clk_disable_unprepare(sunxi_daudio->pllclkx4); + clk_put(sunxi_daudio->pllclkx4); +#endif + clk_disable_unprepare(sunxi_daudio->pllclk); + clk_put(sunxi_daudio->pllclk); + + devm_kfree(&pdev->dev, sunxi_daudio); + + return 0; +} + +static struct platform_driver sunxi_daudio_driver = { + .probe = sunxi_daudio_dev_probe, + .remove = __exit_p(sunxi_daudio_dev_remove), + .driver = { + .name = DRV_NAME, + .owner = THIS_MODULE, + .of_match_table = sunxi_daudio_of_match, + }, +}; + +module_platform_driver(sunxi_daudio_driver); +MODULE_AUTHOR("wolfgang huang "); +MODULE_DESCRIPTION("SUNXI DAI AUDIO ASoC Interface"); +MODULE_LICENSE("GPL"); +MODULE_ALIAS("platform:sunxi-daudio");