OpenIPC
/
firmware
mirror of https://github.com/OpenIPC/firmware.git
1
0
Fork 0
Code Activity
firmware/br-ext-chip-allwinner/board/v83x/kernel/patches/00000-sound_soc_sunxi_sunxi...

2756 lines
83 KiB
Diff
Raw Blame History

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. <www.allwinnertech.com>
+ * wolfgang huang <huangjinhui@allwinnertech.com>
+ * yumingfeng <yumingfeng@allwinnertech.com>
+ *
+ * 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 <linux/init.h>
+#include <linux/module.h>
+#include <linux/device.h>
+#include <linux/clk.h>
+#include <linux/of.h>
+#include <linux/of_device.h>
+#include <linux/of_address.h>
+#include <linux/regmap.h>
+#include <linux/dma/sunxi-dma.h>
+#include <linux/pinctrl/consumer.h>
+#include <linux/regulator/consumer.h>
+#include <sound/core.h>
+#include <sound/pcm.h>
+#include <sound/dmaengine_pcm.h>
+#include <sound/pcm_params.h>
+#include <sound/initval.h>
+#include <sound/soc.h>
+#include <linux/delay.h>
+#include <linux/debugfs.h>
+#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, &reg_val);
+ ucontrol->value.integer.value[0] = ((reg_val & (1<<HUB_EN)) ? 2 : 1);
+
+ return 0;
+}
+
+static int sunxi_daudio_set_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);
+
+ switch (ucontrol->value.integer.value[0]) {
+ case 0:
+ case 1:
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FIFOCTL,
+ (1<<HUB_EN), (0<<HUB_EN));
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL,
+ (1<<CTL_TXEN), (0<<CTL_TXEN));
+ sunxi_daudio->hub_mode = 0;
+ break;
+ case 2:
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FIFOCTL,
+ (1<<HUB_EN), (1<<HUB_EN));
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL,
+ (1<<CTL_TXEN), (1<<CTL_TXEN));
+ sunxi_daudio->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<<CTL_RXEN), (1<<CTL_RXEN));
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_INTCTL,
+ (1<<RXDRQEN), (1<<RXDRQEN));
+#ifdef CONFIG_SND_SUN8IW8_TRIGGER_SYNC_WITH_DAUDIO_CAPTURE
+ sun8iw8_codec_adc_drq_enable(1);
+#endif
+
+ #if SUNXI_RX_SYNC_EN
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL,
+ (1<<RX_EN_MUX), (1<<RX_EN_MUX));
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL,
+ (1<<RX_SYNC_EN), (1<<RX_SYNC_EN));
+ #endif
+ } else {
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_INTCTL,
+ (1<<RXDRQEN), (0<<RXDRQEN));
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL,
+ (1<<CTL_RXEN), (0<<CTL_RXEN));
+#ifdef CONFIG_SND_SUN8IW8_TRIGGER_SYNC_WITH_DAUDIO_CAPTURE
+ sun8iw8_codec_adc_drq_enable(0);
+#endif
+
+ #if SUNXI_RX_SYNC_EN
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL,
+ (1<<RX_EN_MUX), (0<<RX_EN_MUX));
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL,
+ (1<<RX_SYNC_EN), (0<<RX_SYNC_EN));
+ #endif
+ }
+}
+
+#ifdef CONFIG_SND_SUNXI_MAD
+/* should set it after sram reset. */
+static int sunxi_daudio_mad_set_path(struct sunxi_daudio_info *sunxi_daudio,
+ bool enable)
+{
+ enum mad_path_sel path_sel;
+
+ switch (sunxi_daudio->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<<CTL_RXEN), (1<<CTL_RXEN));
+}
+
+static void sunxi_daudio_rxctrl_mad_enable(struct sunxi_daudio_info *sunxi_daudio,
+ bool enable)
+{
+ if (enable) {
+ /* should set it after sram reset. */
+ regmap_update_bits(sunxi_daudio->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<<CTL_RXEN), (1<<CTL_RXEN));
+ } else {
+ /* disable daudio */
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL,
+ (1<<CTL_RXEN), (0<<CTL_RXEN));
+ sunxi_mad_dma_enable(false);
+
+ regmap_update_bits(sunxi_daudio->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_EN), (1<<GLOBAL_EN));
+ } else {
+ if (--sunxi_daudio->global_enable == 0)
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL,
+ (1<<GLOBAL_EN), (0<<GLOBAL_EN));
+ }
+
+ return 0;
+}
+
+static int sunxi_daudio_mclk_setting(struct sunxi_daudio_info *sunxi_daudio)
+{
+ unsigned int mclk_div;
+
+ if (sunxi_daudio->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<<MCLK_DIV),
+ (mclk_div<<MCLK_DIV));
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CLKDIV,
+ (1<<MCLKOUT_EN), (1<<MCLKOUT_EN));
+ } else {
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CLKDIV,
+ (1<<MCLKOUT_EN), (0<<MCLKOUT_EN));
+ }
+
+ return 0;
+}
+
+static int sunxi_daudio_init_fmt(struct sunxi_daudio_info *sunxi_daudio,
+ unsigned int fmt)
+{
+ unsigned int offset, mode;
+ unsigned int lrck_polarity, brck_polarity;
+
+ switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
+ case SND_SOC_DAIFMT_CBM_CFM:
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL,
+ (SUNXI_DAUDIO_LRCK_OUT_MASK<<LRCK_OUT),
+ (SUNXI_DAUDIO_LRCK_OUT_DISABLE<<LRCK_OUT));
+ break;
+ case SND_SOC_DAIFMT_CBS_CFS:
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_CTL,
+ (SUNXI_DAUDIO_LRCK_OUT_MASK<<LRCK_OUT),
+ (SUNXI_DAUDIO_LRCK_OUT_ENABLE<<LRCK_OUT));
+ break;
+ default:
+ dev_err(sunxi_daudio->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<<MODE_SEL),
+ (mode<<MODE_SEL));
+
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_TX0CHSEL,
+ (SUNXI_DAUDIO_TX_OFFSET_MASK<<TX_OFFSET),
+ (offset<<TX_OFFSET));
+
+ if (sunxi_daudio->hdmi_en) {
+#ifndef CONFIG_ARCH_SUN8IW18
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_TX1CHSEL,
+ (SUNXI_DAUDIO_TX_OFFSET_MASK<<TX_OFFSET),
+ (offset<<TX_OFFSET));
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_TX2CHSEL,
+ (SUNXI_DAUDIO_TX_OFFSET_MASK<<TX_OFFSET),
+ (offset<<TX_OFFSET));
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_TX3CHSEL,
+ (SUNXI_DAUDIO_TX_OFFSET_MASK<<TX_OFFSET),
+ (offset<<TX_OFFSET));
+#endif
+ }
+
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_RXCHSEL,
+ (SUNXI_DAUDIO_RX_OFFSET_MASK<<RX_OFFSET),
+ (offset<<RX_OFFSET));
+
+ switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
+ case SND_SOC_DAIFMT_NB_NF:
+ lrck_polarity = SUNXI_DAUDIO_LRCK_POLARITY_NOR;
+ brck_polarity = SUNXI_DAUDIO_BCLK_POLARITY_NOR;
+ break;
+ case SND_SOC_DAIFMT_NB_IF:
+ lrck_polarity = SUNXI_DAUDIO_LRCK_POLARITY_INV;
+ brck_polarity = SUNXI_DAUDIO_BCLK_POLARITY_NOR;
+ break;
+ case SND_SOC_DAIFMT_IB_NF:
+ lrck_polarity = SUNXI_DAUDIO_LRCK_POLARITY_NOR;
+ brck_polarity = SUNXI_DAUDIO_BCLK_POLARITY_INV;
+ break;
+ case SND_SOC_DAIFMT_IB_IF:
+ lrck_polarity = SUNXI_DAUDIO_LRCK_POLARITY_INV;
+ brck_polarity = SUNXI_DAUDIO_BCLK_POLARITY_INV;
+ break;
+ default:
+ dev_err(sunxi_daudio->dev, "invert clk setting failed\n");
+ return -EINVAL;
+ }
+
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT0,
+ (1<<LRCK_POLARITY), (lrck_polarity<<LRCK_POLARITY));
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT0,
+ (1<<BRCK_POLARITY), (brck_polarity<<BRCK_POLARITY));
+
+ return 0;
+}
+
+static int sunxi_daudio_init(struct sunxi_daudio_info *sunxi_daudio)
+{
+ struct sunxi_daudio_platform_data *pdat = sunxi_daudio->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<Eourpean standard> or U-law<US-Japan> 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<<DAUDIO_SAMPLE_RESOLUTION),
+ (SUNXI_DAUDIO_SR_24BIT<<DAUDIO_SAMPLE_RESOLUTION));
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_FIFOCTL,
+ (SUNXI_DAUDIO_TXIM_MASK<<TXIM),
+ (SUNXI_DAUDIO_TXIM_VALID_MSB<<TXIM));
+ } else {
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_FMT0,
+ (SUNXI_DAUDIO_SR_MASK<<DAUDIO_SAMPLE_RESOLUTION),
+ (SUNXI_DAUDIO_SR_16BIT<<DAUDIO_SAMPLE_RESOLUTION));
+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_FIFOCTL,
+ (SUNXI_DAUDIO_TXIM_MASK<<TXIM),
+ (SUNXI_DAUDIO_TXIM_VALID_LSB<<TXIM));
+ else
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_FIFOCTL,
+ (SUNXI_DAUDIO_RXOM_MASK<<RXOM),
+ (SUNXI_DAUDIO_RXOM_EXPH<<RXOM));
+ }
+ break;
+ case SNDRV_PCM_FORMAT_S20_3LE:
+ case SNDRV_PCM_FORMAT_S24_LE:
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT0,
+ (SUNXI_DAUDIO_SR_MASK<<DAUDIO_SAMPLE_RESOLUTION),
+ (SUNXI_DAUDIO_SR_24BIT<<DAUDIO_SAMPLE_RESOLUTION));
+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_FIFOCTL,
+ (SUNXI_DAUDIO_TXIM_MASK<<TXIM),
+ (SUNXI_DAUDIO_TXIM_VALID_LSB<<TXIM));
+ else
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_FIFOCTL,
+ (SUNXI_DAUDIO_RXOM_MASK<<RXOM),
+ (SUNXI_DAUDIO_RXOM_EXPH<<RXOM));
+ break;
+ case SNDRV_PCM_FORMAT_S32_LE:
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_FMT0,
+ (SUNXI_DAUDIO_SR_MASK<<DAUDIO_SAMPLE_RESOLUTION),
+ (SUNXI_DAUDIO_SR_32BIT<<DAUDIO_SAMPLE_RESOLUTION));
+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_FIFOCTL,
+ (SUNXI_DAUDIO_TXIM_MASK<<TXIM),
+ (SUNXI_DAUDIO_TXIM_VALID_LSB<<TXIM));
+ else
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_FIFOCTL,
+ (SUNXI_DAUDIO_RXOM_MASK<<RXOM),
+ (SUNXI_DAUDIO_RXOM_EXPH<<RXOM));
+ break;
+ default:
+ dev_err(sunxi_daudio->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<<TX_SLOT_NUM),
+ ((params_channels(params)-1)<<TX_SLOT_NUM));
+ if (sunxi_daudio->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<<TX_CHSEL),
+ ((params_channels(params)-1)<<TX_CHSEL));
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_TX0CHSEL,
+ (SUNXI_DAUDIO_TX_CHEN_MASK<<TX_CHEN),
+ ((1<<params_channels(params))-1)<<TX_CHEN);
+ } else {
+ /* HDMI multi-channel processing */
+#ifdef SUNXI_HDMI_AUDIO_ENABLE
+#ifdef SUNXI_DAUDIO_MODE_B
+ regmap_write(sunxi_daudio->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)<<TX_CHEN, 0x03 << TX_CHEN);
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_TX2CHSEL,
+ 0x01 << TX_CHSEL, 0x01 << TX_CHSEL);
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_TX2CHSEL,
+ (0x03)<<TX_CHEN, 0x03 << TX_CHEN);
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_TX3CHSEL,
+ 0x01 << TX_CHSEL, 0x01 << TX_CHSEL);
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_TX3CHSEL,
+ (0x03)<<TX_CHEN, 0x03 << TX_CHEN);
+#endif /* HDMI */
+ }
+ } else {
+#ifdef SUNXI_DAUDIO_MODE_B
+#if defined(CONFIG_ARCH_SUN8IW18) || defined(CONFIG_ARCH_SUN8IW19) || \
+ defined(CONFIG_ARCH_SUN50IW10)
+ unsigned int SUNXI_DAUDIO_RXCHMAPX = 0;
+ int index = 0;
+
+ for (index = 0; index < 16; index++) {
+ if (index >= 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<<RX_SLOT_NUM),
+ ((params_channels(params)-1)<<RX_SLOT_NUM));
+ regmap_update_bits(sunxi_daudio->regmap, SUNXI_DAUDIO_RXCHSEL,
+ (SUNXI_DAUDIO_RX_CHSEL_MASK<<RX_CHSEL),
+ ((params_channels(params)-1)<<RX_CHSEL));
+ }
+#ifdef SUNXI_HDMI_AUDIO_ENABLE
+ /* Special processing for HDMI hub playback to enable 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_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<<BCLK_DIV),
+ (bclk_div<<BCLK_DIV));
+
+ return 0;
+}
+
+#ifdef CONFIG_SND_SUNXI_MAD
+static int sunxi_daudio_dai_mad_startup(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 (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<<CTL_TXEN), (1<<CTL_TXEN));
+ if (substream->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, &reg_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, &reg_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<<FIFO_CTL_FRX), (1<<FIFO_CTL_FRX));
+ regmap_write(sunxi_daudio->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<<FIFO_CTL_FTX), (1<<FIFO_CTL_FTX));
+ mdelay(1);
+ }
+ regmap_write(sunxi_daudio->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<<FIFO_CTL_FRX), (1<<FIFO_CTL_FRX));
+ regmap_write(sunxi_daudio->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<<CTL_RXEN), (0<<CTL_RXEN));
+ regmap_update_bits(sunxi_daudio->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<<CTL_TXEN), (0<<CTL_TXEN));
+
+ return 0;
+}
+
+#ifdef DAUDIO_STANDBY_DEBUG
+static int daudio_standby_debug;
+
+static int sunxi_daudio_debug_suspend(struct sunxi_daudio_info *sunxi_daudio)
+{
+ int ret = 0;
+ int i = 0;
+
+ pr_debug("[daudio] suspend .%s start\n", dev_name(sunxi_daudio->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<<CTL_TXEN), (0<<CTL_TXEN));
+ }
+
+ sunxi_daudio->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<<FIFO_CTL_FTX), (1<<FIFO_CTL_FTX));
+ mdelay(1);
+ }
+ regmap_write(sunxi_daudio->regmap, SUNXI_DAUDIO_TXCNT, 0);
+ 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);
+
+ 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));
+ if (sunxi_daudio->hdmi_en) {
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL, (1<<SDO1_EN), (1<<SDO1_EN));
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL, (1<<SDO2_EN), (1<<SDO2_EN));
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL, (1<<SDO3_EN), (1<<SDO3_EN));
+ }
+ /* Global enable I2S/TDM module */
+ mutex_lock(&sunxi_daudio->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<<CTL_TXEN), (1<<CTL_TXEN));
+ }
+
+ pr_debug("[%s] resume .%s end\n", __func__,
+ dev_name(sunxi_daudio->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<<CTL_TXEN), (0<<CTL_TXEN));
+ }
+
+ sunxi_daudio->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<<FIFO_CTL_FTX), (1<<FIFO_CTL_FTX));
+ mdelay(1);
+ }
+
+ regmap_write(sunxi_daudio->regmap, SUNXI_DAUDIO_TXCNT, 0);
+ 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);
+
+ 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));
+ if (sunxi_daudio->hdmi_en) {
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL, (1<<SDO1_EN), (1<<SDO1_EN));
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL, (1<<SDO2_EN), (1<<SDO2_EN));
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL, (1<<SDO3_EN), (1<<SDO3_EN));
+ }
+ /* Global enable I2S/TDM module */
+ mutex_lock(&sunxi_daudio->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<<CTL_TXEN), (1<<CTL_TXEN));
+ }
+
+ pr_debug("[%s] resume .%s end\n", __func__,
+ dev_name(sunxi_daudio->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<<SDO0_EN), (1<<SDO0_EN));
+ if (sunxi_daudio->hdmi_en) {
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL, (1<<SDO1_EN), (1<<SDO1_EN));
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL, (1<<SDO2_EN), (1<<SDO2_EN));
+ regmap_update_bits(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_CTL, (1<<SDO3_EN), (1<<SDO3_EN));
+ }
+ sunxi_daudio_global_enable(sunxi_daudio, true);
+ }
+
+ return 0;
+
+err_unregister_component:
+ snd_soc_unregister_component(&pdev->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 <huangjinhui@allwinnertech.com>");
+MODULE_DESCRIPTION("SUNXI DAI AUDIO ASoC Interface");
+MODULE_LICENSE("GPL");
+MODULE_ALIAS("platform:sunxi-daudio");
View Git Blame Copy Permalink