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_sun8i...

1726 lines
51 KiB
Diff
Raw Blame History

diff -drupN a/sound/soc/sunxi/sun8iw19-daudio.c b/sound/soc/sunxi/sun8iw19-daudio.c
--- a/sound/soc/sunxi/sun8iw19-daudio.c 1970-01-01 03:00:00.000000000 +0300
+++ b/sound/soc/sunxi/sun8iw19-daudio.c 2022-06-12 05:28:14.000000000 +0300
@@ -0,0 +1,1721 @@
+/* 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 "sun8iw19-daudio.h"
+#include "sun8iw19-snddaudio.h"
+#include "sun8iw19-pcm.h"
+#ifdef CONFIG_SUNXI_MPP_AIO
+#include "sunxi-aio/mpp-aio.h"
+extern struct sunxi_audio_mpp_debugfs *mpp_audio_debugfs;
+#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_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)
+
+#ifdef DAUDIO_CLASS_DEBUG
+static struct daudio_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),
+ REG_LABEL(SUNXI_DAUDIO_TX1CHSEL),
+ REG_LABEL(SUNXI_DAUDIO_TX2CHSEL),
+ REG_LABEL(SUNXI_DAUDIO_TX3CHSEL),
+ 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),
+ REG_LABEL(SUNXI_DAUDIO_RXCHMAP2),
+ REG_LABEL(SUNXI_DAUDIO_RXCHMAP3),
+ REG_LABEL(SUNXI_DAUDIO_DEBUG),
+ 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
+
+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;
+}
+
+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_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) {
+ 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));
+ 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));
+ }
+}
+
+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));
+ } 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));
+ }
+}
+
+
+
+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));
+
+ 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));
+
+ 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);
+
+ switch (params_format(params)) {
+ case SNDRV_PCM_FORMAT_S16_LE:
+ 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;
+ }
+
+#ifdef CONFIG_SUNXI_MPP_AIO
+ sunxi_daudio_mpp_aio_hw_params(substream, params, dai);
+#endif
+
+ 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));
+ regmap_write(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_TX0CHMAP0, SUNXI_DEFAULT_CHMAP0);
+ regmap_write(sunxi_daudio->regmap,
+ SUNXI_DAUDIO_TX0CHMAP1, SUNXI_DEFAULT_CHMAP1);
+ 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 {
+ 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));
+ }
+ 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));
+ }
+
+ return 0;
+}
+
+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;
+}
+
+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);
+
+ 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);
+ }
+
+ return 0;
+}
+
+/* for adc and i2s rx sync */
+#ifdef CONFIG_SUNXI_ADC_DAUDIO_SYNC
+void sunxi_daudio_rx_drq_enable(void *sunxi_daudio, bool enable)
+{
+ struct sunxi_daudio_info *daudio_info =
+ (struct sunxi_daudio_info *)sunxi_daudio;
+ if (!daudio_info) {
+ pr_err("[%s] sunxi_daudio is null.\n", __func__);
+ return;
+ }
+ sunxi_daudio_rxctrl_enable(daudio_info, enable);
+ sunxi_daudio_global_enable(daudio_info, enable);
+}
+EXPORT_SYMBOL_GPL(sunxi_daudio_rx_drq_enable);
+#endif
+
+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);
+#ifdef CONFIG_SUNXI_ADC_DAUDIO_SYNC
+ unsigned int sync_mode = 0;
+ int adc_sync_flag = 0;
+#endif
+
+ 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 (!sunxi_daudio->playback_en) {
+ sunxi_daudio_global_enable(sunxi_daudio, true);
+ sunxi_daudio->playback_en = 1;
+ }
+ } else {
+#ifdef CONFIG_SUNXI_ADC_DAUDIO_SYNC
+ if (sunxi_daudio->pdata->tdm_num == 0) {
+ audio_trigger_lock_spinlock();
+ sync_mode = sunxi_codec_get_pcm_trigger_substream_mode();
+ if (sync_mode) {
+ adc_sync_flag = sunxi_codec_get_pcm_adc_sync_flag();
+ adc_sync_flag |= (0x1 << ADC_I2S_SYNC);
+ if (adc_sync_flag & (0x1 << ADC_I2S_RUNNING)) {
+ sunxi_daudio_rx_drq_enable(sunxi_daudio, true);
+ } else if ((adc_sync_flag & (0x1 << ADC_CODEC_SYNC)) &&
+ (adc_sync_flag & (0x1 << ADC_I2S_SYNC))) {
+ adc_sync_flag |= (0x1 << ADC_I2S_RUNNING);
+ sunxi_cpudai_adc_drq_enable(true);
+ sunxi_daudio_rx_drq_enable(sunxi_daudio, true);
+ sunxi_codec_set_pcm_trigger_capture_tv();
+ }
+ sunxi_codec_set_pcm_adc_sync_flag(adc_sync_flag);
+ } else
+ sunxi_daudio_rx_drq_enable(sunxi_daudio, true);
+ audio_trigger_unlock_spinlock();
+ } else
+#endif
+ {
+ sunxi_daudio_rxctrl_enable(sunxi_daudio, true);
+ sunxi_daudio_global_enable(sunxi_daudio, true);
+ }
+ }
+ 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 (sunxi_daudio->playback_en) {
+ sunxi_daudio_global_enable(sunxi_daudio, false);
+ sunxi_daudio->playback_en = 0;
+ }
+ } else {
+#ifdef CONFIG_SUNXI_ADC_DAUDIO_SYNC
+ if (sunxi_daudio->pdata->tdm_num == 0) {
+ audio_trigger_lock_spinlock();
+ adc_sync_flag = sunxi_codec_get_pcm_adc_sync_flag();
+ adc_sync_flag &= ~(0x1 << ADC_I2S_SYNC);
+ if (!((adc_sync_flag >> ADC_CODEC_SYNC) & 0x1) &&
+ (!((adc_sync_flag >> ADC_I2S_SYNC) & 0x1))) {
+ adc_sync_flag &= ~(0x1 << ADC_I2S_RUNNING);
+ }
+ sunxi_codec_set_pcm_adc_sync_flag(adc_sync_flag);
+ sunxi_daudio_rx_drq_enable(sunxi_daudio, false);
+ audio_trigger_unlock_spinlock();
+ } else
+#endif
+ {
+ sunxi_daudio_rxctrl_enable(sunxi_daudio, false);
+ sunxi_daudio_global_enable(sunxi_daudio, false);
+ }
+ }
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
+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) {
+ 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);
+ if (!sunxi_daudio->playback_en) {
+ sunxi_daudio_global_enable(sunxi_daudio, true);
+ sunxi_daudio->playback_en = 1;
+ }
+ mutex_unlock(&sunxi_daudio->global_mutex);
+ }
+ } 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);
+ }
+
+ 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;
+}
+
+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);
+
+ 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;
+ }
+}
+
+static int sunxi_daudio_remove(struct snd_soc_dai *dai)
+{
+ return 0;
+}
+
+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));
+
+ 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));
+ 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);
+
+ 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
+/*
+ * 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[] = {
+ __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,
+};
+
+static const struct of_device_id sunxi_daudio_of_match[] = {
+ {
+ .compatible = "allwinner,sunxi-daudio",
+ .data = &sunxi_daudio,
+ },
+ {},
+};
+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;
+
+ pr_err("--->%s<--- strat.\n", __func__);
+ 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:
+#ifdef CONFIG_SUNXI_ADC_DAUDIO_SYNC
+ sunxi_codec_set_pcm_adc_daudio0((void *)sunxi_daudio);
+#endif
+ 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;
+ 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;
+ 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
+
+ sunxi_daudio_global[sunxi_daudio->pdata->tdm_num] = sunxi_daudio;
+ pr_err("--->%s<--- end.\n", __func__);
+
+ 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
+
+ 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