cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

hi6210-i2s.c (16450B)


      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * linux/sound/soc/m8m/hi6210_i2s.c - I2S IP driver
      4 *
      5 * Copyright (C) 2015 Linaro, Ltd
      6 * Author: Andy Green <andy.green@linaro.org>
      7 *
      8 * This driver only deals with S2 interface (BT)
      9 */
     10
     11#include <linux/init.h>
     12#include <linux/module.h>
     13#include <linux/device.h>
     14#include <linux/delay.h>
     15#include <linux/clk.h>
     16#include <linux/jiffies.h>
     17#include <linux/io.h>
     18#include <linux/gpio.h>
     19#include <sound/core.h>
     20#include <sound/pcm.h>
     21#include <sound/pcm_params.h>
     22#include <sound/dmaengine_pcm.h>
     23#include <sound/initval.h>
     24#include <sound/soc.h>
     25#include <linux/interrupt.h>
     26#include <linux/reset.h>
     27#include <linux/of_address.h>
     28#include <linux/of_irq.h>
     29#include <linux/mfd/syscon.h>
     30#include <linux/reset-controller.h>
     31
     32#include "hi6210-i2s.h"
     33
     34struct hi6210_i2s {
     35	struct device *dev;
     36	struct reset_control *rc;
     37	struct clk *clk[8];
     38	int clocks;
     39	struct snd_soc_dai_driver dai;
     40	void __iomem *base;
     41	struct regmap *sysctrl;
     42	phys_addr_t base_phys;
     43	struct snd_dmaengine_dai_dma_data dma_data[2];
     44	int clk_rate;
     45	spinlock_t lock;
     46	int rate;
     47	int format;
     48	u8 bits;
     49	u8 channels;
     50	u8 id;
     51	u8 channel_length;
     52	u8 use;
     53	u32 master:1;
     54	u32 status:1;
     55};
     56
     57#define SC_PERIPH_CLKEN1	0x210
     58#define SC_PERIPH_CLKDIS1	0x214
     59
     60#define SC_PERIPH_CLKEN3	0x230
     61#define SC_PERIPH_CLKDIS3	0x234
     62
     63#define SC_PERIPH_CLKEN12	0x270
     64#define SC_PERIPH_CLKDIS12	0x274
     65
     66#define SC_PERIPH_RSTEN1	0x310
     67#define SC_PERIPH_RSTDIS1	0x314
     68#define SC_PERIPH_RSTSTAT1	0x318
     69
     70#define SC_PERIPH_RSTEN2	0x320
     71#define SC_PERIPH_RSTDIS2	0x324
     72#define SC_PERIPH_RSTSTAT2	0x328
     73
     74#define SOC_PMCTRL_BBPPLLALIAS	0x48
     75
     76enum {
     77	CLK_DACODEC,
     78	CLK_I2S_BASE,
     79};
     80
     81static inline void hi6210_write_reg(struct hi6210_i2s *i2s, int reg, u32 val)
     82{
     83	writel(val, i2s->base + reg);
     84}
     85
     86static inline u32 hi6210_read_reg(struct hi6210_i2s *i2s, int reg)
     87{
     88	return readl(i2s->base + reg);
     89}
     90
     91static int hi6210_i2s_startup(struct snd_pcm_substream *substream,
     92			      struct snd_soc_dai *cpu_dai)
     93{
     94	struct hi6210_i2s *i2s = dev_get_drvdata(cpu_dai->dev);
     95	int ret, n;
     96	u32 val;
     97
     98	/* deassert reset on ABB */
     99	regmap_read(i2s->sysctrl, SC_PERIPH_RSTSTAT2, &val);
    100	if (val & BIT(4))
    101		regmap_write(i2s->sysctrl, SC_PERIPH_RSTDIS2, BIT(4));
    102
    103	for (n = 0; n < i2s->clocks; n++) {
    104		ret = clk_prepare_enable(i2s->clk[n]);
    105		if (ret)
    106			goto err_unprepare_clk;
    107	}
    108
    109	ret = clk_set_rate(i2s->clk[CLK_I2S_BASE], 49152000);
    110	if (ret) {
    111		dev_err(i2s->dev, "%s: setting 49.152MHz base rate failed %d\n",
    112			__func__, ret);
    113		goto err_unprepare_clk;
    114	}
    115
    116	/* enable clock before frequency division */
    117	regmap_write(i2s->sysctrl, SC_PERIPH_CLKEN12, BIT(9));
    118
    119	/* enable codec working clock / == "codec bus clock" */
    120	regmap_write(i2s->sysctrl, SC_PERIPH_CLKEN1, BIT(5));
    121
    122	/* deassert reset on codec / interface clock / working clock */
    123	regmap_write(i2s->sysctrl, SC_PERIPH_RSTEN1, BIT(5));
    124	regmap_write(i2s->sysctrl, SC_PERIPH_RSTDIS1, BIT(5));
    125
    126	/* not interested in i2s irqs */
    127	val = hi6210_read_reg(i2s, HII2S_CODEC_IRQ_MASK);
    128	val |= 0x3f;
    129	hi6210_write_reg(i2s, HII2S_CODEC_IRQ_MASK, val);
    130
    131
    132	/* reset the stereo downlink fifo */
    133	val = hi6210_read_reg(i2s, HII2S_APB_AFIFO_CFG_1);
    134	val |= (BIT(5) | BIT(4));
    135	hi6210_write_reg(i2s, HII2S_APB_AFIFO_CFG_1, val);
    136
    137	val = hi6210_read_reg(i2s, HII2S_APB_AFIFO_CFG_1);
    138	val &= ~(BIT(5) | BIT(4));
    139	hi6210_write_reg(i2s, HII2S_APB_AFIFO_CFG_1, val);
    140
    141
    142	val = hi6210_read_reg(i2s, HII2S_SW_RST_N);
    143	val &= ~(HII2S_SW_RST_N__ST_DL_WORDLEN_MASK <<
    144			HII2S_SW_RST_N__ST_DL_WORDLEN_SHIFT);
    145	val |= (HII2S_BITS_16 << HII2S_SW_RST_N__ST_DL_WORDLEN_SHIFT);
    146	hi6210_write_reg(i2s, HII2S_SW_RST_N, val);
    147
    148	val = hi6210_read_reg(i2s, HII2S_MISC_CFG);
    149	/* mux 11/12 = APB not i2s */
    150	val &= ~HII2S_MISC_CFG__ST_DL_TEST_SEL;
    151	/* BT R ch  0 = mixer op of DACR ch */
    152	val &= ~HII2S_MISC_CFG__S2_DOUT_RIGHT_SEL;
    153	val &= ~HII2S_MISC_CFG__S2_DOUT_TEST_SEL;
    154
    155	val |= HII2S_MISC_CFG__S2_DOUT_RIGHT_SEL;
    156	/* BT L ch = 1 = mux 7 = "mixer output of DACL */
    157	val |= HII2S_MISC_CFG__S2_DOUT_TEST_SEL;
    158	hi6210_write_reg(i2s, HII2S_MISC_CFG, val);
    159
    160	val = hi6210_read_reg(i2s, HII2S_SW_RST_N);
    161	val |= HII2S_SW_RST_N__SW_RST_N;
    162	hi6210_write_reg(i2s, HII2S_SW_RST_N, val);
    163
    164	return 0;
    165
    166err_unprepare_clk:
    167	while (n--)
    168		clk_disable_unprepare(i2s->clk[n]);
    169	return ret;
    170}
    171
    172static void hi6210_i2s_shutdown(struct snd_pcm_substream *substream,
    173				struct snd_soc_dai *cpu_dai)
    174{
    175	struct hi6210_i2s *i2s = dev_get_drvdata(cpu_dai->dev);
    176	int n;
    177
    178	for (n = 0; n < i2s->clocks; n++)
    179		clk_disable_unprepare(i2s->clk[n]);
    180
    181	regmap_write(i2s->sysctrl, SC_PERIPH_RSTEN1, BIT(5));
    182}
    183
    184static void hi6210_i2s_txctrl(struct snd_soc_dai *cpu_dai, int on)
    185{
    186	struct hi6210_i2s *i2s = dev_get_drvdata(cpu_dai->dev);
    187	u32 val;
    188
    189	spin_lock(&i2s->lock);
    190	if (on) {
    191		/* enable S2 TX */
    192		val = hi6210_read_reg(i2s, HII2S_I2S_CFG);
    193		val |= HII2S_I2S_CFG__S2_IF_TX_EN;
    194		hi6210_write_reg(i2s, HII2S_I2S_CFG, val);
    195	} else {
    196		/* disable S2 TX */
    197		val = hi6210_read_reg(i2s, HII2S_I2S_CFG);
    198		val &= ~HII2S_I2S_CFG__S2_IF_TX_EN;
    199		hi6210_write_reg(i2s, HII2S_I2S_CFG, val);
    200	}
    201	spin_unlock(&i2s->lock);
    202}
    203
    204static void hi6210_i2s_rxctrl(struct snd_soc_dai *cpu_dai, int on)
    205{
    206	struct hi6210_i2s *i2s = dev_get_drvdata(cpu_dai->dev);
    207	u32 val;
    208
    209	spin_lock(&i2s->lock);
    210	if (on) {
    211		val = hi6210_read_reg(i2s, HII2S_I2S_CFG);
    212		val |= HII2S_I2S_CFG__S2_IF_RX_EN;
    213		hi6210_write_reg(i2s, HII2S_I2S_CFG, val);
    214	} else {
    215		val = hi6210_read_reg(i2s, HII2S_I2S_CFG);
    216		val &= ~HII2S_I2S_CFG__S2_IF_RX_EN;
    217		hi6210_write_reg(i2s, HII2S_I2S_CFG, val);
    218	}
    219	spin_unlock(&i2s->lock);
    220}
    221
    222static int hi6210_i2s_set_fmt(struct snd_soc_dai *cpu_dai, unsigned int fmt)
    223{
    224	struct hi6210_i2s *i2s = dev_get_drvdata(cpu_dai->dev);
    225
    226	/*
    227	 * We don't actually set the hardware until the hw_params
    228	 * call, but we need to validate the user input here.
    229	 */
    230	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
    231	case SND_SOC_DAIFMT_CBM_CFM:
    232	case SND_SOC_DAIFMT_CBS_CFS:
    233		break;
    234	default:
    235		return -EINVAL;
    236	}
    237
    238	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
    239	case SND_SOC_DAIFMT_I2S:
    240	case SND_SOC_DAIFMT_LEFT_J:
    241	case SND_SOC_DAIFMT_RIGHT_J:
    242		break;
    243	default:
    244		return -EINVAL;
    245	}
    246
    247	i2s->format = fmt;
    248	i2s->master = (i2s->format & SND_SOC_DAIFMT_MASTER_MASK) ==
    249		      SND_SOC_DAIFMT_CBS_CFS;
    250
    251	return 0;
    252}
    253
    254static int hi6210_i2s_hw_params(struct snd_pcm_substream *substream,
    255			    struct snd_pcm_hw_params *params,
    256			    struct snd_soc_dai *cpu_dai)
    257{
    258	struct hi6210_i2s *i2s = dev_get_drvdata(cpu_dai->dev);
    259	u32 bits = 0, rate = 0, signed_data = 0, fmt = 0;
    260	u32 val;
    261	struct snd_dmaengine_dai_dma_data *dma_data;
    262
    263	switch (params_format(params)) {
    264	case SNDRV_PCM_FORMAT_U16_LE:
    265		signed_data = HII2S_I2S_CFG__S2_CODEC_DATA_FORMAT;
    266		fallthrough;
    267	case SNDRV_PCM_FORMAT_S16_LE:
    268		bits = HII2S_BITS_16;
    269		break;
    270	case SNDRV_PCM_FORMAT_U24_LE:
    271		signed_data = HII2S_I2S_CFG__S2_CODEC_DATA_FORMAT;
    272		fallthrough;
    273	case SNDRV_PCM_FORMAT_S24_LE:
    274		bits = HII2S_BITS_24;
    275		break;
    276	default:
    277		dev_err(cpu_dai->dev, "Bad format\n");
    278		return -EINVAL;
    279	}
    280
    281
    282	switch (params_rate(params)) {
    283	case 8000:
    284		rate = HII2S_FS_RATE_8KHZ;
    285		break;
    286	case 16000:
    287		rate = HII2S_FS_RATE_16KHZ;
    288		break;
    289	case 32000:
    290		rate = HII2S_FS_RATE_32KHZ;
    291		break;
    292	case 48000:
    293		rate = HII2S_FS_RATE_48KHZ;
    294		break;
    295	case 96000:
    296		rate = HII2S_FS_RATE_96KHZ;
    297		break;
    298	case 192000:
    299		rate = HII2S_FS_RATE_192KHZ;
    300		break;
    301	default:
    302		dev_err(cpu_dai->dev, "Bad rate: %d\n", params_rate(params));
    303		return -EINVAL;
    304	}
    305
    306	if (!(params_channels(params))) {
    307		dev_err(cpu_dai->dev, "Bad channels\n");
    308		return -EINVAL;
    309	}
    310
    311	dma_data = snd_soc_dai_get_dma_data(cpu_dai, substream);
    312
    313	switch (bits) {
    314	case HII2S_BITS_24:
    315		i2s->bits = 32;
    316		dma_data->addr_width = 3;
    317		break;
    318	default:
    319		i2s->bits = 16;
    320		dma_data->addr_width = 2;
    321		break;
    322	}
    323	i2s->rate = params_rate(params);
    324	i2s->channels = params_channels(params);
    325	i2s->channel_length = i2s->channels * i2s->bits;
    326
    327	val = hi6210_read_reg(i2s, HII2S_ST_DL_FIFO_TH_CFG);
    328	val &= ~((HII2S_ST_DL_FIFO_TH_CFG__ST_DL_R_AEMPTY_MASK <<
    329			HII2S_ST_DL_FIFO_TH_CFG__ST_DL_R_AEMPTY_SHIFT) |
    330		(HII2S_ST_DL_FIFO_TH_CFG__ST_DL_R_AFULL_MASK <<
    331			HII2S_ST_DL_FIFO_TH_CFG__ST_DL_R_AFULL_SHIFT) |
    332		(HII2S_ST_DL_FIFO_TH_CFG__ST_DL_L_AEMPTY_MASK <<
    333			HII2S_ST_DL_FIFO_TH_CFG__ST_DL_L_AEMPTY_SHIFT) |
    334		(HII2S_ST_DL_FIFO_TH_CFG__ST_DL_L_AFULL_MASK <<
    335			HII2S_ST_DL_FIFO_TH_CFG__ST_DL_L_AFULL_SHIFT));
    336	val |= ((16 << HII2S_ST_DL_FIFO_TH_CFG__ST_DL_R_AEMPTY_SHIFT) |
    337		(30 << HII2S_ST_DL_FIFO_TH_CFG__ST_DL_R_AFULL_SHIFT) |
    338		(16 << HII2S_ST_DL_FIFO_TH_CFG__ST_DL_L_AEMPTY_SHIFT) |
    339		(30 << HII2S_ST_DL_FIFO_TH_CFG__ST_DL_L_AFULL_SHIFT));
    340	hi6210_write_reg(i2s, HII2S_ST_DL_FIFO_TH_CFG, val);
    341
    342
    343	val = hi6210_read_reg(i2s, HII2S_IF_CLK_EN_CFG);
    344	val |= (BIT(19) | BIT(18) | BIT(17) |
    345		HII2S_IF_CLK_EN_CFG__S2_IF_CLK_EN |
    346		HII2S_IF_CLK_EN_CFG__S2_OL_MIXER_EN |
    347		HII2S_IF_CLK_EN_CFG__S2_OL_SRC_EN |
    348		HII2S_IF_CLK_EN_CFG__ST_DL_R_EN |
    349		HII2S_IF_CLK_EN_CFG__ST_DL_L_EN);
    350	hi6210_write_reg(i2s, HII2S_IF_CLK_EN_CFG, val);
    351
    352
    353	val = hi6210_read_reg(i2s, HII2S_DIG_FILTER_CLK_EN_CFG);
    354	val &= ~(HII2S_DIG_FILTER_CLK_EN_CFG__DACR_SDM_EN |
    355		 HII2S_DIG_FILTER_CLK_EN_CFG__DACR_HBF2I_EN |
    356		 HII2S_DIG_FILTER_CLK_EN_CFG__DACR_AGC_EN |
    357		 HII2S_DIG_FILTER_CLK_EN_CFG__DACL_SDM_EN |
    358		 HII2S_DIG_FILTER_CLK_EN_CFG__DACL_HBF2I_EN |
    359		 HII2S_DIG_FILTER_CLK_EN_CFG__DACL_AGC_EN);
    360	val |= (HII2S_DIG_FILTER_CLK_EN_CFG__DACR_MIXER_EN |
    361		HII2S_DIG_FILTER_CLK_EN_CFG__DACL_MIXER_EN);
    362	hi6210_write_reg(i2s, HII2S_DIG_FILTER_CLK_EN_CFG, val);
    363
    364
    365	val = hi6210_read_reg(i2s, HII2S_DIG_FILTER_MODULE_CFG);
    366	val &= ~(HII2S_DIG_FILTER_MODULE_CFG__DACR_MIXER_IN2_MUTE |
    367		 HII2S_DIG_FILTER_MODULE_CFG__DACL_MIXER_IN2_MUTE);
    368	hi6210_write_reg(i2s, HII2S_DIG_FILTER_MODULE_CFG, val);
    369
    370	val = hi6210_read_reg(i2s, HII2S_MUX_TOP_MODULE_CFG);
    371	val &= ~(HII2S_MUX_TOP_MODULE_CFG__S2_OL_MIXER_IN1_MUTE |
    372		 HII2S_MUX_TOP_MODULE_CFG__S2_OL_MIXER_IN2_MUTE |
    373		 HII2S_MUX_TOP_MODULE_CFG__VOICE_DLINK_MIXER_IN1_MUTE |
    374		 HII2S_MUX_TOP_MODULE_CFG__VOICE_DLINK_MIXER_IN2_MUTE);
    375	hi6210_write_reg(i2s, HII2S_MUX_TOP_MODULE_CFG, val);
    376
    377
    378	switch (i2s->format & SND_SOC_DAIFMT_MASTER_MASK) {
    379	case SND_SOC_DAIFMT_CBM_CFM:
    380		i2s->master = false;
    381		val = hi6210_read_reg(i2s, HII2S_I2S_CFG);
    382		val |= HII2S_I2S_CFG__S2_MST_SLV;
    383		hi6210_write_reg(i2s, HII2S_I2S_CFG, val);
    384		break;
    385	case SND_SOC_DAIFMT_CBS_CFS:
    386		i2s->master = true;
    387		val = hi6210_read_reg(i2s, HII2S_I2S_CFG);
    388		val &= ~HII2S_I2S_CFG__S2_MST_SLV;
    389		hi6210_write_reg(i2s, HII2S_I2S_CFG, val);
    390		break;
    391	default:
    392		WARN_ONCE(1, "Invalid i2s->fmt MASTER_MASK. This shouldn't happen\n");
    393		return -EINVAL;
    394	}
    395
    396	switch (i2s->format & SND_SOC_DAIFMT_FORMAT_MASK) {
    397	case SND_SOC_DAIFMT_I2S:
    398		fmt = HII2S_FORMAT_I2S;
    399		break;
    400	case SND_SOC_DAIFMT_LEFT_J:
    401		fmt = HII2S_FORMAT_LEFT_JUST;
    402		break;
    403	case SND_SOC_DAIFMT_RIGHT_J:
    404		fmt = HII2S_FORMAT_RIGHT_JUST;
    405		break;
    406	default:
    407		WARN_ONCE(1, "Invalid i2s->fmt FORMAT_MASK. This shouldn't happen\n");
    408		return -EINVAL;
    409	}
    410
    411	val = hi6210_read_reg(i2s, HII2S_I2S_CFG);
    412	val &= ~(HII2S_I2S_CFG__S2_FUNC_MODE_MASK <<
    413			HII2S_I2S_CFG__S2_FUNC_MODE_SHIFT);
    414	val |= fmt << HII2S_I2S_CFG__S2_FUNC_MODE_SHIFT;
    415	hi6210_write_reg(i2s, HII2S_I2S_CFG, val);
    416
    417
    418	val = hi6210_read_reg(i2s, HII2S_CLK_SEL);
    419	val &= ~(HII2S_CLK_SEL__I2S_BT_FM_SEL | /* BT gets the I2S */
    420			HII2S_CLK_SEL__EXT_12_288MHZ_SEL);
    421	hi6210_write_reg(i2s, HII2S_CLK_SEL, val);
    422
    423	dma_data->maxburst = 2;
    424
    425	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
    426		dma_data->addr = i2s->base_phys + HII2S_ST_DL_CHANNEL;
    427	else
    428		dma_data->addr = i2s->base_phys + HII2S_STEREO_UPLINK_CHANNEL;
    429
    430	switch (i2s->channels) {
    431	case 1:
    432		val = hi6210_read_reg(i2s, HII2S_I2S_CFG);
    433		val |= HII2S_I2S_CFG__S2_FRAME_MODE;
    434		hi6210_write_reg(i2s, HII2S_I2S_CFG, val);
    435		break;
    436	default:
    437		val = hi6210_read_reg(i2s, HII2S_I2S_CFG);
    438		val &= ~HII2S_I2S_CFG__S2_FRAME_MODE;
    439		hi6210_write_reg(i2s, HII2S_I2S_CFG, val);
    440		break;
    441	}
    442
    443	/* clear loopback, set signed type and word length */
    444	val = hi6210_read_reg(i2s, HII2S_I2S_CFG);
    445	val &= ~HII2S_I2S_CFG__S2_CODEC_DATA_FORMAT;
    446	val &= ~(HII2S_I2S_CFG__S2_CODEC_IO_WORDLENGTH_MASK <<
    447			HII2S_I2S_CFG__S2_CODEC_IO_WORDLENGTH_SHIFT);
    448	val &= ~(HII2S_I2S_CFG__S2_DIRECT_LOOP_MASK <<
    449			HII2S_I2S_CFG__S2_DIRECT_LOOP_SHIFT);
    450	val |= signed_data;
    451	val |= (bits << HII2S_I2S_CFG__S2_CODEC_IO_WORDLENGTH_SHIFT);
    452	hi6210_write_reg(i2s, HII2S_I2S_CFG, val);
    453
    454
    455	if (!i2s->master)
    456		return 0;
    457
    458	/* set DAC and related units to correct rate */
    459	val = hi6210_read_reg(i2s, HII2S_FS_CFG);
    460	val &= ~(HII2S_FS_CFG__FS_S2_MASK << HII2S_FS_CFG__FS_S2_SHIFT);
    461	val &= ~(HII2S_FS_CFG__FS_DACLR_MASK << HII2S_FS_CFG__FS_DACLR_SHIFT);
    462	val &= ~(HII2S_FS_CFG__FS_ST_DL_R_MASK <<
    463					HII2S_FS_CFG__FS_ST_DL_R_SHIFT);
    464	val &= ~(HII2S_FS_CFG__FS_ST_DL_L_MASK <<
    465					HII2S_FS_CFG__FS_ST_DL_L_SHIFT);
    466	val |= (rate << HII2S_FS_CFG__FS_S2_SHIFT);
    467	val |= (rate << HII2S_FS_CFG__FS_DACLR_SHIFT);
    468	val |= (rate << HII2S_FS_CFG__FS_ST_DL_R_SHIFT);
    469	val |= (rate << HII2S_FS_CFG__FS_ST_DL_L_SHIFT);
    470	hi6210_write_reg(i2s, HII2S_FS_CFG, val);
    471
    472	return 0;
    473}
    474
    475static int hi6210_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
    476			  struct snd_soc_dai *cpu_dai)
    477{
    478	pr_debug("%s\n", __func__);
    479	switch (cmd) {
    480	case SNDRV_PCM_TRIGGER_START:
    481	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
    482		if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
    483			hi6210_i2s_rxctrl(cpu_dai, 1);
    484		else
    485			hi6210_i2s_txctrl(cpu_dai, 1);
    486		break;
    487	case SNDRV_PCM_TRIGGER_STOP:
    488	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
    489		if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
    490			hi6210_i2s_rxctrl(cpu_dai, 0);
    491		else
    492			hi6210_i2s_txctrl(cpu_dai, 0);
    493		break;
    494	default:
    495		dev_err(cpu_dai->dev, "unknown cmd\n");
    496		return -EINVAL;
    497	}
    498	return 0;
    499}
    500
    501static int hi6210_i2s_dai_probe(struct snd_soc_dai *dai)
    502{
    503	struct hi6210_i2s *i2s = snd_soc_dai_get_drvdata(dai);
    504
    505	snd_soc_dai_init_dma_data(dai,
    506				  &i2s->dma_data[SNDRV_PCM_STREAM_PLAYBACK],
    507				  &i2s->dma_data[SNDRV_PCM_STREAM_CAPTURE]);
    508
    509	return 0;
    510}
    511
    512
    513static const struct snd_soc_dai_ops hi6210_i2s_dai_ops = {
    514	.trigger	= hi6210_i2s_trigger,
    515	.hw_params	= hi6210_i2s_hw_params,
    516	.set_fmt	= hi6210_i2s_set_fmt,
    517	.startup	= hi6210_i2s_startup,
    518	.shutdown	= hi6210_i2s_shutdown,
    519};
    520
    521static const struct snd_soc_dai_driver hi6210_i2s_dai_init = {
    522	.probe		= hi6210_i2s_dai_probe,
    523	.playback = {
    524		.channels_min = 2,
    525		.channels_max = 2,
    526		.formats = SNDRV_PCM_FMTBIT_S16_LE |
    527			   SNDRV_PCM_FMTBIT_U16_LE,
    528		.rates = SNDRV_PCM_RATE_48000,
    529	},
    530	.capture = {
    531		.channels_min = 2,
    532		.channels_max = 2,
    533		.formats = SNDRV_PCM_FMTBIT_S16_LE |
    534			   SNDRV_PCM_FMTBIT_U16_LE,
    535		.rates = SNDRV_PCM_RATE_48000,
    536	},
    537	.ops = &hi6210_i2s_dai_ops,
    538};
    539
    540static const struct snd_soc_component_driver hi6210_i2s_i2s_comp = {
    541	.name = "hi6210_i2s-i2s",
    542};
    543
    544static int hi6210_i2s_probe(struct platform_device *pdev)
    545{
    546	struct device_node *node = pdev->dev.of_node;
    547	struct device *dev = &pdev->dev;
    548	struct hi6210_i2s *i2s;
    549	struct resource *res;
    550	int ret;
    551
    552	i2s = devm_kzalloc(dev, sizeof(*i2s), GFP_KERNEL);
    553	if (!i2s)
    554		return -ENOMEM;
    555
    556	i2s->dev = dev;
    557	spin_lock_init(&i2s->lock);
    558
    559	i2s->base = devm_platform_get_and_ioremap_resource(pdev, 0, &res);
    560	if (IS_ERR(i2s->base))
    561		return PTR_ERR(i2s->base);
    562
    563	i2s->base_phys = (phys_addr_t)res->start;
    564	i2s->dai = hi6210_i2s_dai_init;
    565
    566	dev_set_drvdata(dev, i2s);
    567
    568	i2s->sysctrl = syscon_regmap_lookup_by_phandle(node,
    569						"hisilicon,sysctrl-syscon");
    570	if (IS_ERR(i2s->sysctrl))
    571		return PTR_ERR(i2s->sysctrl);
    572
    573	i2s->clk[CLK_DACODEC] = devm_clk_get(dev, "dacodec");
    574	if (IS_ERR(i2s->clk[CLK_DACODEC]))
    575		return PTR_ERR(i2s->clk[CLK_DACODEC]);
    576	i2s->clocks++;
    577
    578	i2s->clk[CLK_I2S_BASE] = devm_clk_get(dev, "i2s-base");
    579	if (IS_ERR(i2s->clk[CLK_I2S_BASE]))
    580		return PTR_ERR(i2s->clk[CLK_I2S_BASE]);
    581	i2s->clocks++;
    582
    583	ret = devm_snd_dmaengine_pcm_register(dev, NULL, 0);
    584	if (ret)
    585		return ret;
    586
    587	ret = devm_snd_soc_register_component(dev, &hi6210_i2s_i2s_comp,
    588					 &i2s->dai, 1);
    589	return ret;
    590}
    591
    592static const struct of_device_id hi6210_i2s_dt_ids[] = {
    593	{ .compatible = "hisilicon,hi6210-i2s" },
    594	{ /* sentinel */ }
    595};
    596
    597MODULE_DEVICE_TABLE(of, hi6210_i2s_dt_ids);
    598
    599static struct platform_driver hi6210_i2s_driver = {
    600	.probe = hi6210_i2s_probe,
    601	.driver = {
    602		.name = "hi6210_i2s",
    603		.of_match_table = hi6210_i2s_dt_ids,
    604	},
    605};
    606
    607module_platform_driver(hi6210_i2s_driver);
    608
    609MODULE_DESCRIPTION("Hisilicon HI6210 I2S driver");
    610MODULE_AUTHOR("Andy Green <andy.green@linaro.org>");
    611MODULE_LICENSE("GPL");