xref: /kernel/linux/linux-6.6/sound/soc/meson/axg-pdm.c (revision 62306a36)
162306a36Sopenharmony_ci// SPDX-License-Identifier: (GPL-2.0 OR MIT)
262306a36Sopenharmony_ci//
362306a36Sopenharmony_ci// Copyright (c) 2018 BayLibre, SAS.
462306a36Sopenharmony_ci// Author: Jerome Brunet <jbrunet@baylibre.com>
562306a36Sopenharmony_ci
662306a36Sopenharmony_ci#include <linux/clk.h>
762306a36Sopenharmony_ci#include <linux/module.h>
862306a36Sopenharmony_ci#include <linux/of_irq.h>
962306a36Sopenharmony_ci#include <linux/of_platform.h>
1062306a36Sopenharmony_ci#include <linux/regmap.h>
1162306a36Sopenharmony_ci#include <sound/soc.h>
1262306a36Sopenharmony_ci#include <sound/soc-dai.h>
1362306a36Sopenharmony_ci#include <sound/pcm_params.h>
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_ci#define PDM_CTRL			0x00
1662306a36Sopenharmony_ci#define  PDM_CTRL_EN			BIT(31)
1762306a36Sopenharmony_ci#define  PDM_CTRL_OUT_MODE		BIT(29)
1862306a36Sopenharmony_ci#define  PDM_CTRL_BYPASS_MODE		BIT(28)
1962306a36Sopenharmony_ci#define  PDM_CTRL_RST_FIFO		BIT(16)
2062306a36Sopenharmony_ci#define  PDM_CTRL_CHAN_RSTN_MASK	GENMASK(15, 8)
2162306a36Sopenharmony_ci#define  PDM_CTRL_CHAN_RSTN(x)		((x) << 8)
2262306a36Sopenharmony_ci#define  PDM_CTRL_CHAN_EN_MASK		GENMASK(7, 0)
2362306a36Sopenharmony_ci#define  PDM_CTRL_CHAN_EN(x)		((x) << 0)
2462306a36Sopenharmony_ci#define PDM_HCIC_CTRL1			0x04
2562306a36Sopenharmony_ci#define  PDM_FILTER_EN			BIT(31)
2662306a36Sopenharmony_ci#define  PDM_HCIC_CTRL1_GAIN_SFT_MASK	GENMASK(29, 24)
2762306a36Sopenharmony_ci#define  PDM_HCIC_CTRL1_GAIN_SFT(x)	((x) << 24)
2862306a36Sopenharmony_ci#define  PDM_HCIC_CTRL1_GAIN_MULT_MASK	GENMASK(23, 16)
2962306a36Sopenharmony_ci#define  PDM_HCIC_CTRL1_GAIN_MULT(x)	((x) << 16)
3062306a36Sopenharmony_ci#define  PDM_HCIC_CTRL1_DSR_MASK	GENMASK(8, 4)
3162306a36Sopenharmony_ci#define  PDM_HCIC_CTRL1_DSR(x)		((x) << 4)
3262306a36Sopenharmony_ci#define  PDM_HCIC_CTRL1_STAGE_NUM_MASK	GENMASK(3, 0)
3362306a36Sopenharmony_ci#define  PDM_HCIC_CTRL1_STAGE_NUM(x)	((x) << 0)
3462306a36Sopenharmony_ci#define PDM_HCIC_CTRL2			0x08
3562306a36Sopenharmony_ci#define PDM_F1_CTRL			0x0c
3662306a36Sopenharmony_ci#define  PDM_LPF_ROUND_MODE_MASK	GENMASK(17, 16)
3762306a36Sopenharmony_ci#define  PDM_LPF_ROUND_MODE(x)		((x) << 16)
3862306a36Sopenharmony_ci#define  PDM_LPF_DSR_MASK		GENMASK(15, 12)
3962306a36Sopenharmony_ci#define  PDM_LPF_DSR(x)			((x) << 12)
4062306a36Sopenharmony_ci#define  PDM_LPF_STAGE_NUM_MASK		GENMASK(8, 0)
4162306a36Sopenharmony_ci#define  PDM_LPF_STAGE_NUM(x)		((x) << 0)
4262306a36Sopenharmony_ci#define  PDM_LPF_MAX_STAGE		336
4362306a36Sopenharmony_ci#define  PDM_LPF_NUM			3
4462306a36Sopenharmony_ci#define PDM_F2_CTRL			0x10
4562306a36Sopenharmony_ci#define PDM_F3_CTRL			0x14
4662306a36Sopenharmony_ci#define PDM_HPF_CTRL			0x18
4762306a36Sopenharmony_ci#define  PDM_HPF_SFT_STEPS_MASK		GENMASK(20, 16)
4862306a36Sopenharmony_ci#define  PDM_HPF_SFT_STEPS(x)		((x) << 16)
4962306a36Sopenharmony_ci#define  PDM_HPF_OUT_FACTOR_MASK	GENMASK(15, 0)
5062306a36Sopenharmony_ci#define  PDM_HPF_OUT_FACTOR(x)		((x) << 0)
5162306a36Sopenharmony_ci#define PDM_CHAN_CTRL			0x1c
5262306a36Sopenharmony_ci#define  PDM_CHAN_CTRL_POINTER_WIDTH	8
5362306a36Sopenharmony_ci#define  PDM_CHAN_CTRL_POINTER_MAX	((1 << PDM_CHAN_CTRL_POINTER_WIDTH) - 1)
5462306a36Sopenharmony_ci#define  PDM_CHAN_CTRL_NUM		4
5562306a36Sopenharmony_ci#define PDM_CHAN_CTRL1			0x20
5662306a36Sopenharmony_ci#define PDM_COEFF_ADDR			0x24
5762306a36Sopenharmony_ci#define PDM_COEFF_DATA			0x28
5862306a36Sopenharmony_ci#define PDM_CLKG_CTRL			0x2c
5962306a36Sopenharmony_ci#define PDM_STS				0x30
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_cistruct axg_pdm_lpf {
6262306a36Sopenharmony_ci	unsigned int ds;
6362306a36Sopenharmony_ci	unsigned int round_mode;
6462306a36Sopenharmony_ci	const unsigned int *tap;
6562306a36Sopenharmony_ci	unsigned int tap_num;
6662306a36Sopenharmony_ci};
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_cistruct axg_pdm_hcic {
6962306a36Sopenharmony_ci	unsigned int shift;
7062306a36Sopenharmony_ci	unsigned int mult;
7162306a36Sopenharmony_ci	unsigned int steps;
7262306a36Sopenharmony_ci	unsigned int ds;
7362306a36Sopenharmony_ci};
7462306a36Sopenharmony_ci
7562306a36Sopenharmony_cistruct axg_pdm_hpf {
7662306a36Sopenharmony_ci	unsigned int out_factor;
7762306a36Sopenharmony_ci	unsigned int steps;
7862306a36Sopenharmony_ci};
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_cistruct axg_pdm_filters {
8162306a36Sopenharmony_ci	struct axg_pdm_hcic hcic;
8262306a36Sopenharmony_ci	struct axg_pdm_hpf hpf;
8362306a36Sopenharmony_ci	struct axg_pdm_lpf lpf[PDM_LPF_NUM];
8462306a36Sopenharmony_ci};
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_cistruct axg_pdm_cfg {
8762306a36Sopenharmony_ci	const struct axg_pdm_filters *filters;
8862306a36Sopenharmony_ci	unsigned int sys_rate;
8962306a36Sopenharmony_ci};
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_cistruct axg_pdm {
9262306a36Sopenharmony_ci	const struct axg_pdm_cfg *cfg;
9362306a36Sopenharmony_ci	struct regmap *map;
9462306a36Sopenharmony_ci	struct clk *dclk;
9562306a36Sopenharmony_ci	struct clk *sysclk;
9662306a36Sopenharmony_ci	struct clk *pclk;
9762306a36Sopenharmony_ci};
9862306a36Sopenharmony_ci
9962306a36Sopenharmony_cistatic void axg_pdm_enable(struct regmap *map)
10062306a36Sopenharmony_ci{
10162306a36Sopenharmony_ci	/* Reset AFIFO */
10262306a36Sopenharmony_ci	regmap_update_bits(map, PDM_CTRL, PDM_CTRL_RST_FIFO, PDM_CTRL_RST_FIFO);
10362306a36Sopenharmony_ci	regmap_update_bits(map, PDM_CTRL, PDM_CTRL_RST_FIFO, 0);
10462306a36Sopenharmony_ci
10562306a36Sopenharmony_ci	/* Enable PDM */
10662306a36Sopenharmony_ci	regmap_update_bits(map, PDM_CTRL, PDM_CTRL_EN, PDM_CTRL_EN);
10762306a36Sopenharmony_ci}
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_cistatic void axg_pdm_disable(struct regmap *map)
11062306a36Sopenharmony_ci{
11162306a36Sopenharmony_ci	regmap_update_bits(map, PDM_CTRL, PDM_CTRL_EN, 0);
11262306a36Sopenharmony_ci}
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_cistatic void axg_pdm_filters_enable(struct regmap *map, bool enable)
11562306a36Sopenharmony_ci{
11662306a36Sopenharmony_ci	unsigned int val = enable ? PDM_FILTER_EN : 0;
11762306a36Sopenharmony_ci
11862306a36Sopenharmony_ci	regmap_update_bits(map, PDM_HCIC_CTRL1, PDM_FILTER_EN, val);
11962306a36Sopenharmony_ci	regmap_update_bits(map, PDM_F1_CTRL, PDM_FILTER_EN, val);
12062306a36Sopenharmony_ci	regmap_update_bits(map, PDM_F2_CTRL, PDM_FILTER_EN, val);
12162306a36Sopenharmony_ci	regmap_update_bits(map, PDM_F3_CTRL, PDM_FILTER_EN, val);
12262306a36Sopenharmony_ci	regmap_update_bits(map, PDM_HPF_CTRL, PDM_FILTER_EN, val);
12362306a36Sopenharmony_ci}
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_cistatic int axg_pdm_trigger(struct snd_pcm_substream *substream, int cmd,
12662306a36Sopenharmony_ci			   struct snd_soc_dai *dai)
12762306a36Sopenharmony_ci{
12862306a36Sopenharmony_ci	struct axg_pdm *priv = snd_soc_dai_get_drvdata(dai);
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_ci	switch (cmd) {
13162306a36Sopenharmony_ci	case SNDRV_PCM_TRIGGER_START:
13262306a36Sopenharmony_ci	case SNDRV_PCM_TRIGGER_RESUME:
13362306a36Sopenharmony_ci	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
13462306a36Sopenharmony_ci		axg_pdm_enable(priv->map);
13562306a36Sopenharmony_ci		return 0;
13662306a36Sopenharmony_ci
13762306a36Sopenharmony_ci	case SNDRV_PCM_TRIGGER_STOP:
13862306a36Sopenharmony_ci	case SNDRV_PCM_TRIGGER_SUSPEND:
13962306a36Sopenharmony_ci	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
14062306a36Sopenharmony_ci		axg_pdm_disable(priv->map);
14162306a36Sopenharmony_ci		return 0;
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_ci	default:
14462306a36Sopenharmony_ci		return -EINVAL;
14562306a36Sopenharmony_ci	}
14662306a36Sopenharmony_ci}
14762306a36Sopenharmony_ci
14862306a36Sopenharmony_cistatic unsigned int axg_pdm_get_os(struct axg_pdm *priv)
14962306a36Sopenharmony_ci{
15062306a36Sopenharmony_ci	const struct axg_pdm_filters *filters = priv->cfg->filters;
15162306a36Sopenharmony_ci	unsigned int os = filters->hcic.ds;
15262306a36Sopenharmony_ci	int i;
15362306a36Sopenharmony_ci
15462306a36Sopenharmony_ci	/*
15562306a36Sopenharmony_ci	 * The global oversampling factor is defined by the down sampling
15662306a36Sopenharmony_ci	 * factor applied by each filter (HCIC and LPFs)
15762306a36Sopenharmony_ci	 */
15862306a36Sopenharmony_ci
15962306a36Sopenharmony_ci	for (i = 0; i < PDM_LPF_NUM; i++)
16062306a36Sopenharmony_ci		os *= filters->lpf[i].ds;
16162306a36Sopenharmony_ci
16262306a36Sopenharmony_ci	return os;
16362306a36Sopenharmony_ci}
16462306a36Sopenharmony_ci
16562306a36Sopenharmony_cistatic int axg_pdm_set_sysclk(struct axg_pdm *priv, unsigned int os,
16662306a36Sopenharmony_ci			      unsigned int rate)
16762306a36Sopenharmony_ci{
16862306a36Sopenharmony_ci	unsigned int sys_rate = os * 2 * rate * PDM_CHAN_CTRL_POINTER_MAX;
16962306a36Sopenharmony_ci
17062306a36Sopenharmony_ci	/*
17162306a36Sopenharmony_ci	 * Set the default system clock rate unless it is too fast for
17262306a36Sopenharmony_ci	 * the requested sample rate. In this case, the sample pointer
17362306a36Sopenharmony_ci	 * counter could overflow so set a lower system clock rate
17462306a36Sopenharmony_ci	 */
17562306a36Sopenharmony_ci	if (sys_rate < priv->cfg->sys_rate)
17662306a36Sopenharmony_ci		return clk_set_rate(priv->sysclk, sys_rate);
17762306a36Sopenharmony_ci
17862306a36Sopenharmony_ci	return clk_set_rate(priv->sysclk, priv->cfg->sys_rate);
17962306a36Sopenharmony_ci}
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_cistatic int axg_pdm_set_sample_pointer(struct axg_pdm *priv)
18262306a36Sopenharmony_ci{
18362306a36Sopenharmony_ci	unsigned int spmax, sp, val;
18462306a36Sopenharmony_ci	int i;
18562306a36Sopenharmony_ci
18662306a36Sopenharmony_ci	/* Max sample counter value per half period of dclk */
18762306a36Sopenharmony_ci	spmax = DIV_ROUND_UP_ULL((u64)clk_get_rate(priv->sysclk),
18862306a36Sopenharmony_ci				 clk_get_rate(priv->dclk) * 2);
18962306a36Sopenharmony_ci
19062306a36Sopenharmony_ci	/* Check if sysclk is not too fast - should not happen */
19162306a36Sopenharmony_ci	if (WARN_ON(spmax > PDM_CHAN_CTRL_POINTER_MAX))
19262306a36Sopenharmony_ci		return -EINVAL;
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_ci	/* Capture the data when we are at 75% of the half period */
19562306a36Sopenharmony_ci	sp = spmax * 3 / 4;
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_ci	for (i = 0, val = 0; i < PDM_CHAN_CTRL_NUM; i++)
19862306a36Sopenharmony_ci		val |= sp << (PDM_CHAN_CTRL_POINTER_WIDTH * i);
19962306a36Sopenharmony_ci
20062306a36Sopenharmony_ci	regmap_write(priv->map, PDM_CHAN_CTRL, val);
20162306a36Sopenharmony_ci	regmap_write(priv->map, PDM_CHAN_CTRL1, val);
20262306a36Sopenharmony_ci
20362306a36Sopenharmony_ci	return 0;
20462306a36Sopenharmony_ci}
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_cistatic void axg_pdm_set_channel_mask(struct axg_pdm *priv,
20762306a36Sopenharmony_ci				     unsigned int channels)
20862306a36Sopenharmony_ci{
20962306a36Sopenharmony_ci	unsigned int mask = GENMASK(channels - 1, 0);
21062306a36Sopenharmony_ci
21162306a36Sopenharmony_ci	/* Put all channel in reset */
21262306a36Sopenharmony_ci	regmap_update_bits(priv->map, PDM_CTRL,
21362306a36Sopenharmony_ci			   PDM_CTRL_CHAN_RSTN_MASK, 0);
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_ci	/* Take the necessary channels out of reset and enable them */
21662306a36Sopenharmony_ci	regmap_update_bits(priv->map, PDM_CTRL,
21762306a36Sopenharmony_ci			   PDM_CTRL_CHAN_RSTN_MASK |
21862306a36Sopenharmony_ci			   PDM_CTRL_CHAN_EN_MASK,
21962306a36Sopenharmony_ci			   PDM_CTRL_CHAN_RSTN(mask) |
22062306a36Sopenharmony_ci			   PDM_CTRL_CHAN_EN(mask));
22162306a36Sopenharmony_ci}
22262306a36Sopenharmony_ci
22362306a36Sopenharmony_cistatic int axg_pdm_hw_params(struct snd_pcm_substream *substream,
22462306a36Sopenharmony_ci			     struct snd_pcm_hw_params *params,
22562306a36Sopenharmony_ci			     struct snd_soc_dai *dai)
22662306a36Sopenharmony_ci{
22762306a36Sopenharmony_ci	struct axg_pdm *priv = snd_soc_dai_get_drvdata(dai);
22862306a36Sopenharmony_ci	unsigned int os = axg_pdm_get_os(priv);
22962306a36Sopenharmony_ci	unsigned int rate = params_rate(params);
23062306a36Sopenharmony_ci	unsigned int val;
23162306a36Sopenharmony_ci	int ret;
23262306a36Sopenharmony_ci
23362306a36Sopenharmony_ci	switch (params_width(params)) {
23462306a36Sopenharmony_ci	case 24:
23562306a36Sopenharmony_ci		val = PDM_CTRL_OUT_MODE;
23662306a36Sopenharmony_ci		break;
23762306a36Sopenharmony_ci	case 32:
23862306a36Sopenharmony_ci		val = 0;
23962306a36Sopenharmony_ci		break;
24062306a36Sopenharmony_ci	default:
24162306a36Sopenharmony_ci		dev_err(dai->dev, "unsupported sample width\n");
24262306a36Sopenharmony_ci		return -EINVAL;
24362306a36Sopenharmony_ci	}
24462306a36Sopenharmony_ci
24562306a36Sopenharmony_ci	regmap_update_bits(priv->map, PDM_CTRL, PDM_CTRL_OUT_MODE, val);
24662306a36Sopenharmony_ci
24762306a36Sopenharmony_ci	ret = axg_pdm_set_sysclk(priv, os, rate);
24862306a36Sopenharmony_ci	if (ret) {
24962306a36Sopenharmony_ci		dev_err(dai->dev, "failed to set system clock\n");
25062306a36Sopenharmony_ci		return ret;
25162306a36Sopenharmony_ci	}
25262306a36Sopenharmony_ci
25362306a36Sopenharmony_ci	ret = clk_set_rate(priv->dclk, rate * os);
25462306a36Sopenharmony_ci	if (ret) {
25562306a36Sopenharmony_ci		dev_err(dai->dev, "failed to set dclk\n");
25662306a36Sopenharmony_ci		return ret;
25762306a36Sopenharmony_ci	}
25862306a36Sopenharmony_ci
25962306a36Sopenharmony_ci	ret = axg_pdm_set_sample_pointer(priv);
26062306a36Sopenharmony_ci	if (ret) {
26162306a36Sopenharmony_ci		dev_err(dai->dev, "invalid clock setting\n");
26262306a36Sopenharmony_ci		return ret;
26362306a36Sopenharmony_ci	}
26462306a36Sopenharmony_ci
26562306a36Sopenharmony_ci	axg_pdm_set_channel_mask(priv, params_channels(params));
26662306a36Sopenharmony_ci
26762306a36Sopenharmony_ci	return 0;
26862306a36Sopenharmony_ci}
26962306a36Sopenharmony_ci
27062306a36Sopenharmony_cistatic int axg_pdm_startup(struct snd_pcm_substream *substream,
27162306a36Sopenharmony_ci			   struct snd_soc_dai *dai)
27262306a36Sopenharmony_ci{
27362306a36Sopenharmony_ci	struct axg_pdm *priv = snd_soc_dai_get_drvdata(dai);
27462306a36Sopenharmony_ci	int ret;
27562306a36Sopenharmony_ci
27662306a36Sopenharmony_ci	ret = clk_prepare_enable(priv->dclk);
27762306a36Sopenharmony_ci	if (ret) {
27862306a36Sopenharmony_ci		dev_err(dai->dev, "enabling dclk failed\n");
27962306a36Sopenharmony_ci		return ret;
28062306a36Sopenharmony_ci	}
28162306a36Sopenharmony_ci
28262306a36Sopenharmony_ci	/* Enable the filters */
28362306a36Sopenharmony_ci	axg_pdm_filters_enable(priv->map, true);
28462306a36Sopenharmony_ci
28562306a36Sopenharmony_ci	return ret;
28662306a36Sopenharmony_ci}
28762306a36Sopenharmony_ci
28862306a36Sopenharmony_cistatic void axg_pdm_shutdown(struct snd_pcm_substream *substream,
28962306a36Sopenharmony_ci			     struct snd_soc_dai *dai)
29062306a36Sopenharmony_ci{
29162306a36Sopenharmony_ci	struct axg_pdm *priv = snd_soc_dai_get_drvdata(dai);
29262306a36Sopenharmony_ci
29362306a36Sopenharmony_ci	axg_pdm_filters_enable(priv->map, false);
29462306a36Sopenharmony_ci	clk_disable_unprepare(priv->dclk);
29562306a36Sopenharmony_ci}
29662306a36Sopenharmony_ci
29762306a36Sopenharmony_cistatic void axg_pdm_set_hcic_ctrl(struct axg_pdm *priv)
29862306a36Sopenharmony_ci{
29962306a36Sopenharmony_ci	const struct axg_pdm_hcic *hcic = &priv->cfg->filters->hcic;
30062306a36Sopenharmony_ci	unsigned int val;
30162306a36Sopenharmony_ci
30262306a36Sopenharmony_ci	val = PDM_HCIC_CTRL1_STAGE_NUM(hcic->steps);
30362306a36Sopenharmony_ci	val |= PDM_HCIC_CTRL1_DSR(hcic->ds);
30462306a36Sopenharmony_ci	val |= PDM_HCIC_CTRL1_GAIN_MULT(hcic->mult);
30562306a36Sopenharmony_ci	val |= PDM_HCIC_CTRL1_GAIN_SFT(hcic->shift);
30662306a36Sopenharmony_ci
30762306a36Sopenharmony_ci	regmap_update_bits(priv->map, PDM_HCIC_CTRL1,
30862306a36Sopenharmony_ci			   PDM_HCIC_CTRL1_STAGE_NUM_MASK |
30962306a36Sopenharmony_ci			   PDM_HCIC_CTRL1_DSR_MASK |
31062306a36Sopenharmony_ci			   PDM_HCIC_CTRL1_GAIN_MULT_MASK |
31162306a36Sopenharmony_ci			   PDM_HCIC_CTRL1_GAIN_SFT_MASK,
31262306a36Sopenharmony_ci			   val);
31362306a36Sopenharmony_ci}
31462306a36Sopenharmony_ci
31562306a36Sopenharmony_cistatic void axg_pdm_set_lpf_ctrl(struct axg_pdm *priv, unsigned int index)
31662306a36Sopenharmony_ci{
31762306a36Sopenharmony_ci	const struct axg_pdm_lpf *lpf = &priv->cfg->filters->lpf[index];
31862306a36Sopenharmony_ci	unsigned int offset = index * regmap_get_reg_stride(priv->map)
31962306a36Sopenharmony_ci		+ PDM_F1_CTRL;
32062306a36Sopenharmony_ci	unsigned int val;
32162306a36Sopenharmony_ci
32262306a36Sopenharmony_ci	val = PDM_LPF_STAGE_NUM(lpf->tap_num);
32362306a36Sopenharmony_ci	val |= PDM_LPF_DSR(lpf->ds);
32462306a36Sopenharmony_ci	val |= PDM_LPF_ROUND_MODE(lpf->round_mode);
32562306a36Sopenharmony_ci
32662306a36Sopenharmony_ci	regmap_update_bits(priv->map, offset,
32762306a36Sopenharmony_ci			   PDM_LPF_STAGE_NUM_MASK |
32862306a36Sopenharmony_ci			   PDM_LPF_DSR_MASK |
32962306a36Sopenharmony_ci			   PDM_LPF_ROUND_MODE_MASK,
33062306a36Sopenharmony_ci			   val);
33162306a36Sopenharmony_ci}
33262306a36Sopenharmony_ci
33362306a36Sopenharmony_cistatic void axg_pdm_set_hpf_ctrl(struct axg_pdm *priv)
33462306a36Sopenharmony_ci{
33562306a36Sopenharmony_ci	const struct axg_pdm_hpf *hpf = &priv->cfg->filters->hpf;
33662306a36Sopenharmony_ci	unsigned int val;
33762306a36Sopenharmony_ci
33862306a36Sopenharmony_ci	val = PDM_HPF_OUT_FACTOR(hpf->out_factor);
33962306a36Sopenharmony_ci	val |= PDM_HPF_SFT_STEPS(hpf->steps);
34062306a36Sopenharmony_ci
34162306a36Sopenharmony_ci	regmap_update_bits(priv->map, PDM_HPF_CTRL,
34262306a36Sopenharmony_ci			   PDM_HPF_OUT_FACTOR_MASK |
34362306a36Sopenharmony_ci			   PDM_HPF_SFT_STEPS_MASK,
34462306a36Sopenharmony_ci			   val);
34562306a36Sopenharmony_ci}
34662306a36Sopenharmony_ci
34762306a36Sopenharmony_cistatic int axg_pdm_set_lpf_filters(struct axg_pdm *priv)
34862306a36Sopenharmony_ci{
34962306a36Sopenharmony_ci	const struct axg_pdm_lpf *lpf = priv->cfg->filters->lpf;
35062306a36Sopenharmony_ci	unsigned int count = 0;
35162306a36Sopenharmony_ci	int i, j;
35262306a36Sopenharmony_ci
35362306a36Sopenharmony_ci	for (i = 0; i < PDM_LPF_NUM; i++)
35462306a36Sopenharmony_ci		count += lpf[i].tap_num;
35562306a36Sopenharmony_ci
35662306a36Sopenharmony_ci	/* Make sure the coeffs fit in the memory */
35762306a36Sopenharmony_ci	if (count >= PDM_LPF_MAX_STAGE)
35862306a36Sopenharmony_ci		return -EINVAL;
35962306a36Sopenharmony_ci
36062306a36Sopenharmony_ci	/* Set the initial APB bus register address */
36162306a36Sopenharmony_ci	regmap_write(priv->map, PDM_COEFF_ADDR, 0);
36262306a36Sopenharmony_ci
36362306a36Sopenharmony_ci	/* Set the tap filter values of all 3 filters */
36462306a36Sopenharmony_ci	for (i = 0; i < PDM_LPF_NUM; i++) {
36562306a36Sopenharmony_ci		axg_pdm_set_lpf_ctrl(priv, i);
36662306a36Sopenharmony_ci
36762306a36Sopenharmony_ci		for (j = 0; j < lpf[i].tap_num; j++)
36862306a36Sopenharmony_ci			regmap_write(priv->map, PDM_COEFF_DATA, lpf[i].tap[j]);
36962306a36Sopenharmony_ci	}
37062306a36Sopenharmony_ci
37162306a36Sopenharmony_ci	return 0;
37262306a36Sopenharmony_ci}
37362306a36Sopenharmony_ci
37462306a36Sopenharmony_cistatic int axg_pdm_dai_probe(struct snd_soc_dai *dai)
37562306a36Sopenharmony_ci{
37662306a36Sopenharmony_ci	struct axg_pdm *priv = snd_soc_dai_get_drvdata(dai);
37762306a36Sopenharmony_ci	int ret;
37862306a36Sopenharmony_ci
37962306a36Sopenharmony_ci	ret = clk_prepare_enable(priv->pclk);
38062306a36Sopenharmony_ci	if (ret) {
38162306a36Sopenharmony_ci		dev_err(dai->dev, "enabling pclk failed\n");
38262306a36Sopenharmony_ci		return ret;
38362306a36Sopenharmony_ci	}
38462306a36Sopenharmony_ci
38562306a36Sopenharmony_ci	/*
38662306a36Sopenharmony_ci	 * sysclk must be set and enabled as well to access the pdm registers
38762306a36Sopenharmony_ci	 * Accessing the register w/o it will give a bus error.
38862306a36Sopenharmony_ci	 */
38962306a36Sopenharmony_ci	ret = clk_set_rate(priv->sysclk, priv->cfg->sys_rate);
39062306a36Sopenharmony_ci	if (ret) {
39162306a36Sopenharmony_ci		dev_err(dai->dev, "setting sysclk failed\n");
39262306a36Sopenharmony_ci		goto err_pclk;
39362306a36Sopenharmony_ci	}
39462306a36Sopenharmony_ci
39562306a36Sopenharmony_ci	ret = clk_prepare_enable(priv->sysclk);
39662306a36Sopenharmony_ci	if (ret) {
39762306a36Sopenharmony_ci		dev_err(dai->dev, "enabling sysclk failed\n");
39862306a36Sopenharmony_ci		goto err_pclk;
39962306a36Sopenharmony_ci	}
40062306a36Sopenharmony_ci
40162306a36Sopenharmony_ci	/* Make sure the device is initially disabled */
40262306a36Sopenharmony_ci	axg_pdm_disable(priv->map);
40362306a36Sopenharmony_ci
40462306a36Sopenharmony_ci	/* Make sure filter bypass is disabled */
40562306a36Sopenharmony_ci	regmap_update_bits(priv->map, PDM_CTRL, PDM_CTRL_BYPASS_MODE, 0);
40662306a36Sopenharmony_ci
40762306a36Sopenharmony_ci	/* Load filter settings */
40862306a36Sopenharmony_ci	axg_pdm_set_hcic_ctrl(priv);
40962306a36Sopenharmony_ci	axg_pdm_set_hpf_ctrl(priv);
41062306a36Sopenharmony_ci
41162306a36Sopenharmony_ci	ret = axg_pdm_set_lpf_filters(priv);
41262306a36Sopenharmony_ci	if (ret) {
41362306a36Sopenharmony_ci		dev_err(dai->dev, "invalid filter configuration\n");
41462306a36Sopenharmony_ci		goto err_sysclk;
41562306a36Sopenharmony_ci	}
41662306a36Sopenharmony_ci
41762306a36Sopenharmony_ci	return 0;
41862306a36Sopenharmony_ci
41962306a36Sopenharmony_cierr_sysclk:
42062306a36Sopenharmony_ci	clk_disable_unprepare(priv->sysclk);
42162306a36Sopenharmony_cierr_pclk:
42262306a36Sopenharmony_ci	clk_disable_unprepare(priv->pclk);
42362306a36Sopenharmony_ci	return ret;
42462306a36Sopenharmony_ci}
42562306a36Sopenharmony_ci
42662306a36Sopenharmony_cistatic int axg_pdm_dai_remove(struct snd_soc_dai *dai)
42762306a36Sopenharmony_ci{
42862306a36Sopenharmony_ci	struct axg_pdm *priv = snd_soc_dai_get_drvdata(dai);
42962306a36Sopenharmony_ci
43062306a36Sopenharmony_ci	clk_disable_unprepare(priv->sysclk);
43162306a36Sopenharmony_ci	clk_disable_unprepare(priv->pclk);
43262306a36Sopenharmony_ci
43362306a36Sopenharmony_ci	return 0;
43462306a36Sopenharmony_ci}
43562306a36Sopenharmony_ci
43662306a36Sopenharmony_cistatic const struct snd_soc_dai_ops axg_pdm_dai_ops = {
43762306a36Sopenharmony_ci	.probe		= axg_pdm_dai_probe,
43862306a36Sopenharmony_ci	.remove		= axg_pdm_dai_remove,
43962306a36Sopenharmony_ci	.trigger	= axg_pdm_trigger,
44062306a36Sopenharmony_ci	.hw_params	= axg_pdm_hw_params,
44162306a36Sopenharmony_ci	.startup	= axg_pdm_startup,
44262306a36Sopenharmony_ci	.shutdown	= axg_pdm_shutdown,
44362306a36Sopenharmony_ci};
44462306a36Sopenharmony_ci
44562306a36Sopenharmony_cistatic struct snd_soc_dai_driver axg_pdm_dai_drv = {
44662306a36Sopenharmony_ci	.name = "PDM",
44762306a36Sopenharmony_ci	.capture = {
44862306a36Sopenharmony_ci		.stream_name	= "Capture",
44962306a36Sopenharmony_ci		.channels_min	= 1,
45062306a36Sopenharmony_ci		.channels_max	= 8,
45162306a36Sopenharmony_ci		.rates		= SNDRV_PCM_RATE_CONTINUOUS,
45262306a36Sopenharmony_ci		.rate_min	= 5512,
45362306a36Sopenharmony_ci		.rate_max	= 48000,
45462306a36Sopenharmony_ci		.formats	= (SNDRV_PCM_FMTBIT_S24_LE |
45562306a36Sopenharmony_ci				   SNDRV_PCM_FMTBIT_S32_LE),
45662306a36Sopenharmony_ci	},
45762306a36Sopenharmony_ci	.ops		= &axg_pdm_dai_ops,
45862306a36Sopenharmony_ci};
45962306a36Sopenharmony_ci
46062306a36Sopenharmony_cistatic const struct snd_soc_component_driver axg_pdm_component_drv = {
46162306a36Sopenharmony_ci	.legacy_dai_naming = 1,
46262306a36Sopenharmony_ci};
46362306a36Sopenharmony_ci
46462306a36Sopenharmony_cistatic const struct regmap_config axg_pdm_regmap_cfg = {
46562306a36Sopenharmony_ci	.reg_bits	= 32,
46662306a36Sopenharmony_ci	.val_bits	= 32,
46762306a36Sopenharmony_ci	.reg_stride	= 4,
46862306a36Sopenharmony_ci	.max_register	= PDM_STS,
46962306a36Sopenharmony_ci};
47062306a36Sopenharmony_ci
47162306a36Sopenharmony_cistatic const unsigned int lpf1_default_tap[] = {
47262306a36Sopenharmony_ci	0x000014, 0xffffb2, 0xfffed9, 0xfffdce, 0xfffd45,
47362306a36Sopenharmony_ci	0xfffe32, 0x000147, 0x000645, 0x000b86, 0x000e21,
47462306a36Sopenharmony_ci	0x000ae3, 0x000000, 0xffeece, 0xffdca8, 0xffd212,
47562306a36Sopenharmony_ci	0xffd7d1, 0xfff2a7, 0x001f4c, 0x0050c2, 0x0072aa,
47662306a36Sopenharmony_ci	0x006ff1, 0x003c32, 0xffdc4e, 0xff6a18, 0xff0fef,
47762306a36Sopenharmony_ci	0xfefbaf, 0xff4c40, 0x000000, 0x00ebc8, 0x01c077,
47862306a36Sopenharmony_ci	0x02209e, 0x01c1a4, 0x008e60, 0xfebe52, 0xfcd690,
47962306a36Sopenharmony_ci	0xfb8fa5, 0xfba498, 0xfd9812, 0x0181ce, 0x06f5f3,
48062306a36Sopenharmony_ci	0x0d112f, 0x12a958, 0x169686, 0x18000e, 0x169686,
48162306a36Sopenharmony_ci	0x12a958, 0x0d112f, 0x06f5f3, 0x0181ce, 0xfd9812,
48262306a36Sopenharmony_ci	0xfba498, 0xfb8fa5, 0xfcd690, 0xfebe52, 0x008e60,
48362306a36Sopenharmony_ci	0x01c1a4, 0x02209e, 0x01c077, 0x00ebc8, 0x000000,
48462306a36Sopenharmony_ci	0xff4c40, 0xfefbaf, 0xff0fef, 0xff6a18, 0xffdc4e,
48562306a36Sopenharmony_ci	0x003c32, 0x006ff1, 0x0072aa, 0x0050c2, 0x001f4c,
48662306a36Sopenharmony_ci	0xfff2a7, 0xffd7d1, 0xffd212, 0xffdca8, 0xffeece,
48762306a36Sopenharmony_ci	0x000000, 0x000ae3, 0x000e21, 0x000b86, 0x000645,
48862306a36Sopenharmony_ci	0x000147, 0xfffe32, 0xfffd45, 0xfffdce, 0xfffed9,
48962306a36Sopenharmony_ci	0xffffb2, 0x000014,
49062306a36Sopenharmony_ci};
49162306a36Sopenharmony_ci
49262306a36Sopenharmony_cistatic const unsigned int lpf2_default_tap[] = {
49362306a36Sopenharmony_ci	0x00050a, 0xfff004, 0x0002c1, 0x003c12, 0xffa818,
49462306a36Sopenharmony_ci	0xffc87d, 0x010aef, 0xff5223, 0xfebd93, 0x028f41,
49562306a36Sopenharmony_ci	0xff5c0e, 0xfc63f8, 0x055f81, 0x000000, 0xf478a0,
49662306a36Sopenharmony_ci	0x11c5e3, 0x2ea74d, 0x11c5e3, 0xf478a0, 0x000000,
49762306a36Sopenharmony_ci	0x055f81, 0xfc63f8, 0xff5c0e, 0x028f41, 0xfebd93,
49862306a36Sopenharmony_ci	0xff5223, 0x010aef, 0xffc87d, 0xffa818, 0x003c12,
49962306a36Sopenharmony_ci	0x0002c1, 0xfff004, 0x00050a,
50062306a36Sopenharmony_ci};
50162306a36Sopenharmony_ci
50262306a36Sopenharmony_cistatic const unsigned int lpf3_default_tap[] = {
50362306a36Sopenharmony_ci	0x000000, 0x000081, 0x000000, 0xfffedb, 0x000000,
50462306a36Sopenharmony_ci	0x00022d, 0x000000, 0xfffc46, 0x000000, 0x0005f7,
50562306a36Sopenharmony_ci	0x000000, 0xfff6eb, 0x000000, 0x000d4e, 0x000000,
50662306a36Sopenharmony_ci	0xffed1e, 0x000000, 0x001a1c, 0x000000, 0xffdcb0,
50762306a36Sopenharmony_ci	0x000000, 0x002ede, 0x000000, 0xffc2d1, 0x000000,
50862306a36Sopenharmony_ci	0x004ebe, 0x000000, 0xff9beb, 0x000000, 0x007dd7,
50962306a36Sopenharmony_ci	0x000000, 0xff633a, 0x000000, 0x00c1d2, 0x000000,
51062306a36Sopenharmony_ci	0xff11d5, 0x000000, 0x012368, 0x000000, 0xfe9c45,
51162306a36Sopenharmony_ci	0x000000, 0x01b252, 0x000000, 0xfdebf6, 0x000000,
51262306a36Sopenharmony_ci	0x0290b8, 0x000000, 0xfcca0d, 0x000000, 0x041d7c,
51362306a36Sopenharmony_ci	0x000000, 0xfa8152, 0x000000, 0x07e9c6, 0x000000,
51462306a36Sopenharmony_ci	0xf28fb5, 0x000000, 0x28b216, 0x3fffde, 0x28b216,
51562306a36Sopenharmony_ci	0x000000, 0xf28fb5, 0x000000, 0x07e9c6, 0x000000,
51662306a36Sopenharmony_ci	0xfa8152, 0x000000, 0x041d7c, 0x000000, 0xfcca0d,
51762306a36Sopenharmony_ci	0x000000, 0x0290b8, 0x000000, 0xfdebf6, 0x000000,
51862306a36Sopenharmony_ci	0x01b252, 0x000000, 0xfe9c45, 0x000000, 0x012368,
51962306a36Sopenharmony_ci	0x000000, 0xff11d5, 0x000000, 0x00c1d2, 0x000000,
52062306a36Sopenharmony_ci	0xff633a, 0x000000, 0x007dd7, 0x000000, 0xff9beb,
52162306a36Sopenharmony_ci	0x000000, 0x004ebe, 0x000000, 0xffc2d1, 0x000000,
52262306a36Sopenharmony_ci	0x002ede, 0x000000, 0xffdcb0, 0x000000, 0x001a1c,
52362306a36Sopenharmony_ci	0x000000, 0xffed1e, 0x000000, 0x000d4e, 0x000000,
52462306a36Sopenharmony_ci	0xfff6eb, 0x000000, 0x0005f7, 0x000000, 0xfffc46,
52562306a36Sopenharmony_ci	0x000000, 0x00022d, 0x000000, 0xfffedb, 0x000000,
52662306a36Sopenharmony_ci	0x000081, 0x000000,
52762306a36Sopenharmony_ci};
52862306a36Sopenharmony_ci
52962306a36Sopenharmony_ci/*
53062306a36Sopenharmony_ci * These values are sane defaults for the axg platform:
53162306a36Sopenharmony_ci * - OS = 64
53262306a36Sopenharmony_ci * - Latency = 38700 (?)
53362306a36Sopenharmony_ci *
53462306a36Sopenharmony_ci * TODO: There is a lot of different HCIC, LPFs and HPF configurations possible.
53562306a36Sopenharmony_ci *       the configuration may depend on the dmic used by the platform, the
53662306a36Sopenharmony_ci *       expected tradeoff between latency and quality, etc ... If/When other
53762306a36Sopenharmony_ci *       settings are required, we should add a fw interface to this driver to
53862306a36Sopenharmony_ci *       load new filter settings.
53962306a36Sopenharmony_ci */
54062306a36Sopenharmony_cistatic const struct axg_pdm_filters axg_default_filters = {
54162306a36Sopenharmony_ci	.hcic = {
54262306a36Sopenharmony_ci		.shift = 0x15,
54362306a36Sopenharmony_ci		.mult = 0x80,
54462306a36Sopenharmony_ci		.steps = 7,
54562306a36Sopenharmony_ci		.ds = 8,
54662306a36Sopenharmony_ci	},
54762306a36Sopenharmony_ci	.hpf = {
54862306a36Sopenharmony_ci		.out_factor = 0x8000,
54962306a36Sopenharmony_ci		.steps = 13,
55062306a36Sopenharmony_ci	},
55162306a36Sopenharmony_ci	.lpf = {
55262306a36Sopenharmony_ci		[0] = {
55362306a36Sopenharmony_ci			.ds = 2,
55462306a36Sopenharmony_ci			.round_mode = 1,
55562306a36Sopenharmony_ci			.tap = lpf1_default_tap,
55662306a36Sopenharmony_ci			.tap_num = ARRAY_SIZE(lpf1_default_tap),
55762306a36Sopenharmony_ci		},
55862306a36Sopenharmony_ci		[1] = {
55962306a36Sopenharmony_ci			.ds = 2,
56062306a36Sopenharmony_ci			.round_mode = 0,
56162306a36Sopenharmony_ci			.tap = lpf2_default_tap,
56262306a36Sopenharmony_ci			.tap_num = ARRAY_SIZE(lpf2_default_tap),
56362306a36Sopenharmony_ci		},
56462306a36Sopenharmony_ci		[2] = {
56562306a36Sopenharmony_ci			.ds = 2,
56662306a36Sopenharmony_ci			.round_mode = 1,
56762306a36Sopenharmony_ci			.tap = lpf3_default_tap,
56862306a36Sopenharmony_ci			.tap_num = ARRAY_SIZE(lpf3_default_tap)
56962306a36Sopenharmony_ci		},
57062306a36Sopenharmony_ci	},
57162306a36Sopenharmony_ci};
57262306a36Sopenharmony_ci
57362306a36Sopenharmony_cistatic const struct axg_pdm_cfg axg_pdm_config = {
57462306a36Sopenharmony_ci	.filters = &axg_default_filters,
57562306a36Sopenharmony_ci	.sys_rate = 250000000,
57662306a36Sopenharmony_ci};
57762306a36Sopenharmony_ci
57862306a36Sopenharmony_cistatic const struct of_device_id axg_pdm_of_match[] = {
57962306a36Sopenharmony_ci	{
58062306a36Sopenharmony_ci		.compatible = "amlogic,axg-pdm",
58162306a36Sopenharmony_ci		.data = &axg_pdm_config,
58262306a36Sopenharmony_ci	}, {}
58362306a36Sopenharmony_ci};
58462306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, axg_pdm_of_match);
58562306a36Sopenharmony_ci
58662306a36Sopenharmony_cistatic int axg_pdm_probe(struct platform_device *pdev)
58762306a36Sopenharmony_ci{
58862306a36Sopenharmony_ci	struct device *dev = &pdev->dev;
58962306a36Sopenharmony_ci	struct axg_pdm *priv;
59062306a36Sopenharmony_ci	void __iomem *regs;
59162306a36Sopenharmony_ci
59262306a36Sopenharmony_ci	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
59362306a36Sopenharmony_ci	if (!priv)
59462306a36Sopenharmony_ci		return -ENOMEM;
59562306a36Sopenharmony_ci	platform_set_drvdata(pdev, priv);
59662306a36Sopenharmony_ci
59762306a36Sopenharmony_ci	priv->cfg = of_device_get_match_data(dev);
59862306a36Sopenharmony_ci	if (!priv->cfg) {
59962306a36Sopenharmony_ci		dev_err(dev, "failed to match device\n");
60062306a36Sopenharmony_ci		return -ENODEV;
60162306a36Sopenharmony_ci	}
60262306a36Sopenharmony_ci
60362306a36Sopenharmony_ci	regs = devm_platform_ioremap_resource(pdev, 0);
60462306a36Sopenharmony_ci	if (IS_ERR(regs))
60562306a36Sopenharmony_ci		return PTR_ERR(regs);
60662306a36Sopenharmony_ci
60762306a36Sopenharmony_ci	priv->map = devm_regmap_init_mmio(dev, regs, &axg_pdm_regmap_cfg);
60862306a36Sopenharmony_ci	if (IS_ERR(priv->map)) {
60962306a36Sopenharmony_ci		dev_err(dev, "failed to init regmap: %ld\n",
61062306a36Sopenharmony_ci			PTR_ERR(priv->map));
61162306a36Sopenharmony_ci		return PTR_ERR(priv->map);
61262306a36Sopenharmony_ci	}
61362306a36Sopenharmony_ci
61462306a36Sopenharmony_ci	priv->pclk = devm_clk_get(dev, "pclk");
61562306a36Sopenharmony_ci	if (IS_ERR(priv->pclk))
61662306a36Sopenharmony_ci		return dev_err_probe(dev, PTR_ERR(priv->pclk), "failed to get pclk\n");
61762306a36Sopenharmony_ci
61862306a36Sopenharmony_ci	priv->dclk = devm_clk_get(dev, "dclk");
61962306a36Sopenharmony_ci	if (IS_ERR(priv->dclk))
62062306a36Sopenharmony_ci		return dev_err_probe(dev, PTR_ERR(priv->dclk), "failed to get dclk\n");
62162306a36Sopenharmony_ci
62262306a36Sopenharmony_ci	priv->sysclk = devm_clk_get(dev, "sysclk");
62362306a36Sopenharmony_ci	if (IS_ERR(priv->sysclk))
62462306a36Sopenharmony_ci		return dev_err_probe(dev, PTR_ERR(priv->sysclk), "failed to get dclk\n");
62562306a36Sopenharmony_ci
62662306a36Sopenharmony_ci	return devm_snd_soc_register_component(dev, &axg_pdm_component_drv,
62762306a36Sopenharmony_ci					       &axg_pdm_dai_drv, 1);
62862306a36Sopenharmony_ci}
62962306a36Sopenharmony_ci
63062306a36Sopenharmony_cistatic struct platform_driver axg_pdm_pdrv = {
63162306a36Sopenharmony_ci	.probe = axg_pdm_probe,
63262306a36Sopenharmony_ci	.driver = {
63362306a36Sopenharmony_ci		.name = "axg-pdm",
63462306a36Sopenharmony_ci		.of_match_table = axg_pdm_of_match,
63562306a36Sopenharmony_ci	},
63662306a36Sopenharmony_ci};
63762306a36Sopenharmony_cimodule_platform_driver(axg_pdm_pdrv);
63862306a36Sopenharmony_ci
63962306a36Sopenharmony_ciMODULE_DESCRIPTION("Amlogic AXG PDM Input driver");
64062306a36Sopenharmony_ciMODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>");
64162306a36Sopenharmony_ciMODULE_LICENSE("GPL v2");
642