/* * linux/sound/soc/m8m/hi6210_i2s.c - I2S IP driver * * Copyright (C) 2015 Linaro, Ltd * Author: Andy Green * * 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, version 2 of the License. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * This driver only deals with S2 interface (BT) */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "hi6210-i2s.h" struct hi6210_i2s { struct device *dev; struct reset_control *rc; struct clk *clk[8]; int clocks; struct snd_soc_dai_driver dai; void __iomem *base; struct regmap *sysctrl; phys_addr_t base_phys; struct snd_dmaengine_dai_dma_data dma_data[2]; int clk_rate; spinlock_t lock; int rate; int format; u8 bits; u8 channels; u8 id; u8 channel_length; u8 use; u32 master:1; u32 status:1; }; #define SC_PERIPH_CLKEN1 0x210 #define SC_PERIPH_CLKDIS1 0x214 #define SC_PERIPH_CLKEN3 0x230 #define SC_PERIPH_CLKDIS3 0x234 #define SC_PERIPH_CLKEN12 0x270 #define SC_PERIPH_CLKDIS12 0x274 #define SC_PERIPH_RSTEN1 0x310 #define SC_PERIPH_RSTDIS1 0x314 #define SC_PERIPH_RSTSTAT1 0x318 #define SC_PERIPH_RSTEN2 0x320 #define SC_PERIPH_RSTDIS2 0x324 #define SC_PERIPH_RSTSTAT2 0x328 #define SOC_PMCTRL_BBPPLLALIAS 0x48 enum { CLK_DACODEC, CLK_I2S_BASE, }; static inline void hi6210_write_reg(struct hi6210_i2s *i2s, int reg, u32 val) { writel(val, i2s->base + reg); } static inline u32 hi6210_read_reg(struct hi6210_i2s *i2s, int reg) { return readl(i2s->base + reg); } static int hi6210_i2s_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *cpu_dai) { struct hi6210_i2s *i2s = dev_get_drvdata(cpu_dai->dev); int ret, n; u32 val; /* deassert reset on ABB */ regmap_read(i2s->sysctrl, SC_PERIPH_RSTSTAT2, &val); if (val & BIT(4)) regmap_write(i2s->sysctrl, SC_PERIPH_RSTDIS2, BIT(4)); for (n = 0; n < i2s->clocks; n++) { ret = clk_prepare_enable(i2s->clk[n]); if (ret) { while (n--) clk_disable_unprepare(i2s->clk[n]); return ret; } } ret = clk_set_rate(i2s->clk[CLK_I2S_BASE], 49152000); if (ret) { dev_err(i2s->dev, "%s: setting 49.152MHz base rate failed %d\n", __func__, ret); return ret; } /* enable clock before frequency division */ regmap_write(i2s->sysctrl, SC_PERIPH_CLKEN12, BIT(9)); /* enable codec working clock / == "codec bus clock" */ regmap_write(i2s->sysctrl, SC_PERIPH_CLKEN1, BIT(5)); /* deassert reset on codec / interface clock / working clock */ regmap_write(i2s->sysctrl, SC_PERIPH_RSTEN1, BIT(5)); regmap_write(i2s->sysctrl, SC_PERIPH_RSTDIS1, BIT(5)); /* not interested in i2s irqs */ val = hi6210_read_reg(i2s, HII2S_CODEC_IRQ_MASK); val |= 0x3f; hi6210_write_reg(i2s, HII2S_CODEC_IRQ_MASK, val); /* reset the stereo downlink fifo */ val = hi6210_read_reg(i2s, HII2S_APB_AFIFO_CFG_1); val |= (BIT(5) | BIT(4)); hi6210_write_reg(i2s, HII2S_APB_AFIFO_CFG_1, val); val = hi6210_read_reg(i2s, HII2S_APB_AFIFO_CFG_1); val &= ~(BIT(5) | BIT(4)); hi6210_write_reg(i2s, HII2S_APB_AFIFO_CFG_1, val); val = hi6210_read_reg(i2s, HII2S_SW_RST_N); val &= ~(HII2S_SW_RST_N__ST_DL_WORDLEN_MASK << HII2S_SW_RST_N__ST_DL_WORDLEN_SHIFT); val |= (HII2S_BITS_16 << HII2S_SW_RST_N__ST_DL_WORDLEN_SHIFT); hi6210_write_reg(i2s, HII2S_SW_RST_N, val); val = hi6210_read_reg(i2s, HII2S_MISC_CFG); /* mux 11/12 = APB not i2s */ val &= ~HII2S_MISC_CFG__ST_DL_TEST_SEL; /* BT R ch 0 = mixer op of DACR ch */ val &= ~HII2S_MISC_CFG__S2_DOUT_RIGHT_SEL; val &= ~HII2S_MISC_CFG__S2_DOUT_TEST_SEL; val |= HII2S_MISC_CFG__S2_DOUT_RIGHT_SEL; /* BT L ch = 1 = mux 7 = "mixer output of DACL */ val |= HII2S_MISC_CFG__S2_DOUT_TEST_SEL; hi6210_write_reg(i2s, HII2S_MISC_CFG, val); val = hi6210_read_reg(i2s, HII2S_SW_RST_N); val |= HII2S_SW_RST_N__SW_RST_N; hi6210_write_reg(i2s, HII2S_SW_RST_N, val); return 0; } static void hi6210_i2s_shutdown(struct snd_pcm_substream *substream, struct snd_soc_dai *cpu_dai) { struct hi6210_i2s *i2s = dev_get_drvdata(cpu_dai->dev); int n; for (n = 0; n < i2s->clocks; n++) clk_disable_unprepare(i2s->clk[n]); regmap_write(i2s->sysctrl, SC_PERIPH_RSTEN1, BIT(5)); } static void hi6210_i2s_txctrl(struct snd_soc_dai *cpu_dai, int on) { struct hi6210_i2s *i2s = dev_get_drvdata(cpu_dai->dev); u32 val; spin_lock(&i2s->lock); if (on) { /* enable S2 TX */ val = hi6210_read_reg(i2s, HII2S_I2S_CFG); val |= HII2S_I2S_CFG__S2_IF_TX_EN; hi6210_write_reg(i2s, HII2S_I2S_CFG, val); } else { /* disable S2 TX */ val = hi6210_read_reg(i2s, HII2S_I2S_CFG); val &= ~HII2S_I2S_CFG__S2_IF_TX_EN; hi6210_write_reg(i2s, HII2S_I2S_CFG, val); } spin_unlock(&i2s->lock); } static void hi6210_i2s_rxctrl(struct snd_soc_dai *cpu_dai, int on) { struct hi6210_i2s *i2s = dev_get_drvdata(cpu_dai->dev); u32 val; spin_lock(&i2s->lock); if (on) { val = hi6210_read_reg(i2s, HII2S_I2S_CFG); val |= HII2S_I2S_CFG__S2_IF_RX_EN; hi6210_write_reg(i2s, HII2S_I2S_CFG, val); } else { val = hi6210_read_reg(i2s, HII2S_I2S_CFG); val &= ~HII2S_I2S_CFG__S2_IF_RX_EN; hi6210_write_reg(i2s, HII2S_I2S_CFG, val); } spin_unlock(&i2s->lock); } static int hi6210_i2s_set_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt) { struct hi6210_i2s *i2s = dev_get_drvdata(cpu_dai->dev); /* * We don't actually set the hardware until the hw_params * call, but we need to validate the user input here. */ switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { case SND_SOC_DAIFMT_CBM_CFM: case SND_SOC_DAIFMT_CBS_CFS: break; default: return -EINVAL; } switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { case SND_SOC_DAIFMT_I2S: case SND_SOC_DAIFMT_LEFT_J: case SND_SOC_DAIFMT_RIGHT_J: break; default: return -EINVAL; } i2s->format = fmt; i2s->master = (i2s->format & SND_SOC_DAIFMT_MASTER_MASK) == SND_SOC_DAIFMT_CBS_CFS; return 0; } static int hi6210_i2s_hw_params(struct snd_pcm_substream *substream, struct snd_pcm_hw_params *params, struct snd_soc_dai *cpu_dai) { struct hi6210_i2s *i2s = dev_get_drvdata(cpu_dai->dev); u32 bits = 0, rate = 0, signed_data = 0, fmt = 0; u32 val; struct snd_dmaengine_dai_dma_data *dma_data; switch (params_format(params)) { case SNDRV_PCM_FORMAT_U16_LE: signed_data = HII2S_I2S_CFG__S2_CODEC_DATA_FORMAT; /* fallthru */ case SNDRV_PCM_FORMAT_S16_LE: bits = HII2S_BITS_16; break; case SNDRV_PCM_FORMAT_U24_LE: signed_data = HII2S_I2S_CFG__S2_CODEC_DATA_FORMAT; /* fallthru */ case SNDRV_PCM_FORMAT_S24_LE: bits = HII2S_BITS_24; break; default: dev_err(cpu_dai->dev, "Bad format\n"); return -EINVAL; } switch (params_rate(params)) { case 8000: rate = HII2S_FS_RATE_8KHZ; break; case 16000: rate = HII2S_FS_RATE_16KHZ; break; case 32000: rate = HII2S_FS_RATE_32KHZ; break; case 48000: rate = HII2S_FS_RATE_48KHZ; break; case 96000: rate = HII2S_FS_RATE_96KHZ; break; case 192000: rate = HII2S_FS_RATE_192KHZ; break; default: dev_err(cpu_dai->dev, "Bad rate: %d\n", params_rate(params)); return -EINVAL; } if (!(params_channels(params))) { dev_err(cpu_dai->dev, "Bad channels\n"); return -EINVAL; } dma_data = snd_soc_dai_get_dma_data(cpu_dai, substream); switch (bits) { case HII2S_BITS_24: i2s->bits = 32; dma_data->addr_width = 3; break; default: i2s->bits = 16; dma_data->addr_width = 2; break; } i2s->rate = params_rate(params); i2s->channels = params_channels(params); i2s->channel_length = i2s->channels * i2s->bits; val = hi6210_read_reg(i2s, HII2S_ST_DL_FIFO_TH_CFG); val &= ~((HII2S_ST_DL_FIFO_TH_CFG__ST_DL_R_AEMPTY_MASK << HII2S_ST_DL_FIFO_TH_CFG__ST_DL_R_AEMPTY_SHIFT) | (HII2S_ST_DL_FIFO_TH_CFG__ST_DL_R_AFULL_MASK << HII2S_ST_DL_FIFO_TH_CFG__ST_DL_R_AFULL_SHIFT) | (HII2S_ST_DL_FIFO_TH_CFG__ST_DL_L_AEMPTY_MASK << HII2S_ST_DL_FIFO_TH_CFG__ST_DL_L_AEMPTY_SHIFT) | (HII2S_ST_DL_FIFO_TH_CFG__ST_DL_L_AFULL_MASK << HII2S_ST_DL_FIFO_TH_CFG__ST_DL_L_AFULL_SHIFT)); val |= ((16 << HII2S_ST_DL_FIFO_TH_CFG__ST_DL_R_AEMPTY_SHIFT) | (30 << HII2S_ST_DL_FIFO_TH_CFG__ST_DL_R_AFULL_SHIFT) | (16 << HII2S_ST_DL_FIFO_TH_CFG__ST_DL_L_AEMPTY_SHIFT) | (30 << HII2S_ST_DL_FIFO_TH_CFG__ST_DL_L_AFULL_SHIFT)); hi6210_write_reg(i2s, HII2S_ST_DL_FIFO_TH_CFG, val); val = hi6210_read_reg(i2s, HII2S_IF_CLK_EN_CFG); val |= (BIT(19) | BIT(18) | BIT(17) | HII2S_IF_CLK_EN_CFG__S2_IF_CLK_EN | HII2S_IF_CLK_EN_CFG__S2_OL_MIXER_EN | HII2S_IF_CLK_EN_CFG__S2_OL_SRC_EN | HII2S_IF_CLK_EN_CFG__ST_DL_R_EN | HII2S_IF_CLK_EN_CFG__ST_DL_L_EN); hi6210_write_reg(i2s, HII2S_IF_CLK_EN_CFG, val); val = hi6210_read_reg(i2s, HII2S_DIG_FILTER_CLK_EN_CFG); val &= ~(HII2S_DIG_FILTER_CLK_EN_CFG__DACR_SDM_EN | HII2S_DIG_FILTER_CLK_EN_CFG__DACR_HBF2I_EN | HII2S_DIG_FILTER_CLK_EN_CFG__DACR_AGC_EN | HII2S_DIG_FILTER_CLK_EN_CFG__DACL_SDM_EN | HII2S_DIG_FILTER_CLK_EN_CFG__DACL_HBF2I_EN | HII2S_DIG_FILTER_CLK_EN_CFG__DACL_AGC_EN); val |= (HII2S_DIG_FILTER_CLK_EN_CFG__DACR_MIXER_EN | HII2S_DIG_FILTER_CLK_EN_CFG__DACL_MIXER_EN); hi6210_write_reg(i2s, HII2S_DIG_FILTER_CLK_EN_CFG, val); val = hi6210_read_reg(i2s, HII2S_DIG_FILTER_MODULE_CFG); val &= ~(HII2S_DIG_FILTER_MODULE_CFG__DACR_MIXER_IN2_MUTE | HII2S_DIG_FILTER_MODULE_CFG__DACL_MIXER_IN2_MUTE); hi6210_write_reg(i2s, HII2S_DIG_FILTER_MODULE_CFG, val); val = hi6210_read_reg(i2s, HII2S_MUX_TOP_MODULE_CFG); val &= ~(HII2S_MUX_TOP_MODULE_CFG__S2_OL_MIXER_IN1_MUTE | HII2S_MUX_TOP_MODULE_CFG__S2_OL_MIXER_IN2_MUTE | HII2S_MUX_TOP_MODULE_CFG__VOICE_DLINK_MIXER_IN1_MUTE | HII2S_MUX_TOP_MODULE_CFG__VOICE_DLINK_MIXER_IN2_MUTE); hi6210_write_reg(i2s, HII2S_MUX_TOP_MODULE_CFG, val); switch (i2s->format & SND_SOC_DAIFMT_MASTER_MASK) { case SND_SOC_DAIFMT_CBM_CFM: i2s->master = false; val = hi6210_read_reg(i2s, HII2S_I2S_CFG); val |= HII2S_I2S_CFG__S2_MST_SLV; hi6210_write_reg(i2s, HII2S_I2S_CFG, val); break; case SND_SOC_DAIFMT_CBS_CFS: i2s->master = true; val = hi6210_read_reg(i2s, HII2S_I2S_CFG); val &= ~HII2S_I2S_CFG__S2_MST_SLV; hi6210_write_reg(i2s, HII2S_I2S_CFG, val); break; default: WARN_ONCE(1, "Invalid i2s->fmt MASTER_MASK. This shouldn't happen\n"); return -EINVAL; } switch (i2s->format & SND_SOC_DAIFMT_FORMAT_MASK) { case SND_SOC_DAIFMT_I2S: fmt = HII2S_FORMAT_I2S; break; case SND_SOC_DAIFMT_LEFT_J: fmt = HII2S_FORMAT_LEFT_JUST; break; case SND_SOC_DAIFMT_RIGHT_J: fmt = HII2S_FORMAT_RIGHT_JUST; break; default: WARN_ONCE(1, "Invalid i2s->fmt FORMAT_MASK. This shouldn't happen\n"); return -EINVAL; } val = hi6210_read_reg(i2s, HII2S_I2S_CFG); val &= ~(HII2S_I2S_CFG__S2_FUNC_MODE_MASK << HII2S_I2S_CFG__S2_FUNC_MODE_SHIFT); val |= fmt << HII2S_I2S_CFG__S2_FUNC_MODE_SHIFT; hi6210_write_reg(i2s, HII2S_I2S_CFG, val); val = hi6210_read_reg(i2s, HII2S_CLK_SEL); val &= ~(HII2S_CLK_SEL__I2S_BT_FM_SEL | /* BT gets the I2S */ HII2S_CLK_SEL__EXT_12_288MHZ_SEL); hi6210_write_reg(i2s, HII2S_CLK_SEL, val); dma_data->maxburst = 2; if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) dma_data->addr = i2s->base_phys + HII2S_ST_DL_CHANNEL; else dma_data->addr = i2s->base_phys + HII2S_STEREO_UPLINK_CHANNEL; switch (i2s->channels) { case 1: val = hi6210_read_reg(i2s, HII2S_I2S_CFG); val |= HII2S_I2S_CFG__S2_FRAME_MODE; hi6210_write_reg(i2s, HII2S_I2S_CFG, val); break; default: val = hi6210_read_reg(i2s, HII2S_I2S_CFG); val &= ~HII2S_I2S_CFG__S2_FRAME_MODE; hi6210_write_reg(i2s, HII2S_I2S_CFG, val); break; } /* clear loopback, set signed type and word length */ val = hi6210_read_reg(i2s, HII2S_I2S_CFG); val &= ~HII2S_I2S_CFG__S2_CODEC_DATA_FORMAT; val &= ~(HII2S_I2S_CFG__S2_CODEC_IO_WORDLENGTH_MASK << HII2S_I2S_CFG__S2_CODEC_IO_WORDLENGTH_SHIFT); val &= ~(HII2S_I2S_CFG__S2_DIRECT_LOOP_MASK << HII2S_I2S_CFG__S2_DIRECT_LOOP_SHIFT); val |= signed_data; val |= (bits << HII2S_I2S_CFG__S2_CODEC_IO_WORDLENGTH_SHIFT); hi6210_write_reg(i2s, HII2S_I2S_CFG, val); if (!i2s->master) return 0; /* set DAC and related units to correct rate */ val = hi6210_read_reg(i2s, HII2S_FS_CFG); val &= ~(HII2S_FS_CFG__FS_S2_MASK << HII2S_FS_CFG__FS_S2_SHIFT); val &= ~(HII2S_FS_CFG__FS_DACLR_MASK << HII2S_FS_CFG__FS_DACLR_SHIFT); val &= ~(HII2S_FS_CFG__FS_ST_DL_R_MASK << HII2S_FS_CFG__FS_ST_DL_R_SHIFT); val &= ~(HII2S_FS_CFG__FS_ST_DL_L_MASK << HII2S_FS_CFG__FS_ST_DL_L_SHIFT); val |= (rate << HII2S_FS_CFG__FS_S2_SHIFT); val |= (rate << HII2S_FS_CFG__FS_DACLR_SHIFT); val |= (rate << HII2S_FS_CFG__FS_ST_DL_R_SHIFT); val |= (rate << HII2S_FS_CFG__FS_ST_DL_L_SHIFT); hi6210_write_reg(i2s, HII2S_FS_CFG, val); return 0; } static int hi6210_i2s_trigger(struct snd_pcm_substream *substream, int cmd, struct snd_soc_dai *cpu_dai) { pr_debug("%s\n", __func__); switch (cmd) { case SNDRV_PCM_TRIGGER_START: case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) hi6210_i2s_rxctrl(cpu_dai, 1); else hi6210_i2s_txctrl(cpu_dai, 1); break; case SNDRV_PCM_TRIGGER_STOP: case SNDRV_PCM_TRIGGER_PAUSE_PUSH: if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) hi6210_i2s_rxctrl(cpu_dai, 0); else hi6210_i2s_txctrl(cpu_dai, 0); break; default: dev_err(cpu_dai->dev, "uknown cmd\n"); return -EINVAL; } return 0; } static int hi6210_i2s_dai_probe(struct snd_soc_dai *dai) { struct hi6210_i2s *i2s = snd_soc_dai_get_drvdata(dai); snd_soc_dai_init_dma_data(dai, &i2s->dma_data[SNDRV_PCM_STREAM_PLAYBACK], &i2s->dma_data[SNDRV_PCM_STREAM_CAPTURE]); return 0; } static const struct snd_soc_dai_ops hi6210_i2s_dai_ops = { .trigger = hi6210_i2s_trigger, .hw_params = hi6210_i2s_hw_params, .set_fmt = hi6210_i2s_set_fmt, .startup = hi6210_i2s_startup, .shutdown = hi6210_i2s_shutdown, }; static const struct snd_soc_dai_driver hi6210_i2s_dai_init = { .probe = hi6210_i2s_dai_probe, .playback = { .channels_min = 2, .channels_max = 2, .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_U16_LE, .rates = SNDRV_PCM_RATE_48000, }, .capture = { .channels_min = 2, .channels_max = 2, .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_U16_LE, .rates = SNDRV_PCM_RATE_48000, }, .ops = &hi6210_i2s_dai_ops, }; static const struct snd_soc_component_driver hi6210_i2s_i2s_comp = { .name = "hi6210_i2s-i2s", }; static int hi6210_i2s_probe(struct platform_device *pdev) { struct device_node *node = pdev->dev.of_node; struct device *dev = &pdev->dev; struct hi6210_i2s *i2s; struct resource *res; int ret; i2s = devm_kzalloc(&pdev->dev, sizeof(*i2s), GFP_KERNEL); if (!i2s) return -ENOMEM; i2s->dev = dev; spin_lock_init(&i2s->lock); res = platform_get_resource(pdev, IORESOURCE_MEM, 0); i2s->base = devm_ioremap_resource(dev, res); if (IS_ERR(i2s->base)) return PTR_ERR(i2s->base); i2s->base_phys = (phys_addr_t)res->start; i2s->dai = hi6210_i2s_dai_init; dev_set_drvdata(&pdev->dev, i2s); i2s->sysctrl = syscon_regmap_lookup_by_phandle(node, "hisilicon,sysctrl-syscon"); if (IS_ERR(i2s->sysctrl)) return PTR_ERR(i2s->sysctrl); i2s->clk[CLK_DACODEC] = devm_clk_get(&pdev->dev, "dacodec"); if (IS_ERR_OR_NULL(i2s->clk[CLK_DACODEC])) return PTR_ERR(i2s->clk[CLK_DACODEC]); i2s->clocks++; i2s->clk[CLK_I2S_BASE] = devm_clk_get(&pdev->dev, "i2s-base"); if (IS_ERR_OR_NULL(i2s->clk[CLK_I2S_BASE])) return PTR_ERR(i2s->clk[CLK_I2S_BASE]); i2s->clocks++; ret = devm_snd_dmaengine_pcm_register(&pdev->dev, NULL, 0); if (ret) return ret; ret = devm_snd_soc_register_component(&pdev->dev, &hi6210_i2s_i2s_comp, &i2s->dai, 1); return ret; } static const struct of_device_id hi6210_i2s_dt_ids[] = { { .compatible = "hisilicon,hi6210-i2s" }, { /* sentinel */ } }; MODULE_DEVICE_TABLE(of, hi6210_i2s_dt_ids); static struct platform_driver hi6210_i2s_driver = { .probe = hi6210_i2s_probe, .driver = { .name = "hi6210_i2s", .of_match_table = hi6210_i2s_dt_ids, }, }; module_platform_driver(hi6210_i2s_driver); MODULE_DESCRIPTION("Hisilicon HI6210 I2S driver"); MODULE_AUTHOR("Andy Green "); MODULE_LICENSE("GPL");