162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Codec driver for ST STA32x 2.1-channel high-efficiency digital audio system
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright: 2011 Raumfeld GmbH
662306a36Sopenharmony_ci * Author: Johannes Stezenbach <js@sig21.net>
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci * based on code from:
962306a36Sopenharmony_ci *	Wolfson Microelectronics PLC.
1062306a36Sopenharmony_ci *	  Mark Brown <broonie@opensource.wolfsonmicro.com>
1162306a36Sopenharmony_ci *	Freescale Semiconductor, Inc.
1262306a36Sopenharmony_ci *	  Timur Tabi <timur@freescale.com>
1362306a36Sopenharmony_ci */
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_ci#define pr_fmt(fmt) KBUILD_MODNAME ":%s:%d: " fmt, __func__, __LINE__
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#include <linux/module.h>
1862306a36Sopenharmony_ci#include <linux/moduleparam.h>
1962306a36Sopenharmony_ci#include <linux/init.h>
2062306a36Sopenharmony_ci#include <linux/clk.h>
2162306a36Sopenharmony_ci#include <linux/delay.h>
2262306a36Sopenharmony_ci#include <linux/pm.h>
2362306a36Sopenharmony_ci#include <linux/i2c.h>
2462306a36Sopenharmony_ci#include <linux/of_device.h>
2562306a36Sopenharmony_ci#include <linux/of_gpio.h>
2662306a36Sopenharmony_ci#include <linux/regmap.h>
2762306a36Sopenharmony_ci#include <linux/regulator/consumer.h>
2862306a36Sopenharmony_ci#include <linux/gpio/consumer.h>
2962306a36Sopenharmony_ci#include <linux/slab.h>
3062306a36Sopenharmony_ci#include <linux/workqueue.h>
3162306a36Sopenharmony_ci#include <sound/core.h>
3262306a36Sopenharmony_ci#include <sound/pcm.h>
3362306a36Sopenharmony_ci#include <sound/pcm_params.h>
3462306a36Sopenharmony_ci#include <sound/soc.h>
3562306a36Sopenharmony_ci#include <sound/soc-dapm.h>
3662306a36Sopenharmony_ci#include <sound/initval.h>
3762306a36Sopenharmony_ci#include <sound/tlv.h>
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci#include <sound/sta32x.h>
4062306a36Sopenharmony_ci#include "sta32x.h"
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_ci#define STA32X_RATES (SNDRV_PCM_RATE_32000 | \
4362306a36Sopenharmony_ci		      SNDRV_PCM_RATE_44100 | \
4462306a36Sopenharmony_ci		      SNDRV_PCM_RATE_48000 | \
4562306a36Sopenharmony_ci		      SNDRV_PCM_RATE_88200 | \
4662306a36Sopenharmony_ci		      SNDRV_PCM_RATE_96000 | \
4762306a36Sopenharmony_ci		      SNDRV_PCM_RATE_176400 | \
4862306a36Sopenharmony_ci		      SNDRV_PCM_RATE_192000)
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_ci#define STA32X_FORMATS \
5162306a36Sopenharmony_ci	(SNDRV_PCM_FMTBIT_S16_LE  | SNDRV_PCM_FMTBIT_S18_3LE | \
5262306a36Sopenharmony_ci	 SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S24_3LE | \
5362306a36Sopenharmony_ci	 SNDRV_PCM_FMTBIT_S24_LE  | SNDRV_PCM_FMTBIT_S32_LE)
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ci/* Power-up register defaults */
5662306a36Sopenharmony_cistatic const struct reg_default sta32x_regs[] = {
5762306a36Sopenharmony_ci	{  0x0, 0x63 },
5862306a36Sopenharmony_ci	{  0x1, 0x80 },
5962306a36Sopenharmony_ci	{  0x2, 0xc2 },
6062306a36Sopenharmony_ci	{  0x3, 0x40 },
6162306a36Sopenharmony_ci	{  0x4, 0xc2 },
6262306a36Sopenharmony_ci	{  0x5, 0x5c },
6362306a36Sopenharmony_ci	{  0x6, 0x10 },
6462306a36Sopenharmony_ci	{  0x7, 0xff },
6562306a36Sopenharmony_ci	{  0x8, 0x60 },
6662306a36Sopenharmony_ci	{  0x9, 0x60 },
6762306a36Sopenharmony_ci	{  0xa, 0x60 },
6862306a36Sopenharmony_ci	{  0xb, 0x80 },
6962306a36Sopenharmony_ci	{  0xc, 0x00 },
7062306a36Sopenharmony_ci	{  0xd, 0x00 },
7162306a36Sopenharmony_ci	{  0xe, 0x00 },
7262306a36Sopenharmony_ci	{  0xf, 0x40 },
7362306a36Sopenharmony_ci	{ 0x10, 0x80 },
7462306a36Sopenharmony_ci	{ 0x11, 0x77 },
7562306a36Sopenharmony_ci	{ 0x12, 0x6a },
7662306a36Sopenharmony_ci	{ 0x13, 0x69 },
7762306a36Sopenharmony_ci	{ 0x14, 0x6a },
7862306a36Sopenharmony_ci	{ 0x15, 0x69 },
7962306a36Sopenharmony_ci	{ 0x16, 0x00 },
8062306a36Sopenharmony_ci	{ 0x17, 0x00 },
8162306a36Sopenharmony_ci	{ 0x18, 0x00 },
8262306a36Sopenharmony_ci	{ 0x19, 0x00 },
8362306a36Sopenharmony_ci	{ 0x1a, 0x00 },
8462306a36Sopenharmony_ci	{ 0x1b, 0x00 },
8562306a36Sopenharmony_ci	{ 0x1c, 0x00 },
8662306a36Sopenharmony_ci	{ 0x1d, 0x00 },
8762306a36Sopenharmony_ci	{ 0x1e, 0x00 },
8862306a36Sopenharmony_ci	{ 0x1f, 0x00 },
8962306a36Sopenharmony_ci	{ 0x20, 0x00 },
9062306a36Sopenharmony_ci	{ 0x21, 0x00 },
9162306a36Sopenharmony_ci	{ 0x22, 0x00 },
9262306a36Sopenharmony_ci	{ 0x23, 0x00 },
9362306a36Sopenharmony_ci	{ 0x24, 0x00 },
9462306a36Sopenharmony_ci	{ 0x25, 0x00 },
9562306a36Sopenharmony_ci	{ 0x26, 0x00 },
9662306a36Sopenharmony_ci	{ 0x27, 0x2d },
9762306a36Sopenharmony_ci	{ 0x28, 0xc0 },
9862306a36Sopenharmony_ci	{ 0x2b, 0x00 },
9962306a36Sopenharmony_ci	{ 0x2c, 0x0c },
10062306a36Sopenharmony_ci};
10162306a36Sopenharmony_ci
10262306a36Sopenharmony_cistatic const struct regmap_range sta32x_write_regs_range[] = {
10362306a36Sopenharmony_ci	regmap_reg_range(STA32X_CONFA,  STA32X_FDRC2),
10462306a36Sopenharmony_ci};
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_cistatic const struct regmap_range sta32x_read_regs_range[] = {
10762306a36Sopenharmony_ci	regmap_reg_range(STA32X_CONFA,  STA32X_FDRC2),
10862306a36Sopenharmony_ci};
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_cistatic const struct regmap_range sta32x_volatile_regs_range[] = {
11162306a36Sopenharmony_ci	regmap_reg_range(STA32X_CFADDR2, STA32X_CFUD),
11262306a36Sopenharmony_ci};
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_cistatic const struct regmap_access_table sta32x_write_regs = {
11562306a36Sopenharmony_ci	.yes_ranges =	sta32x_write_regs_range,
11662306a36Sopenharmony_ci	.n_yes_ranges =	ARRAY_SIZE(sta32x_write_regs_range),
11762306a36Sopenharmony_ci};
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_cistatic const struct regmap_access_table sta32x_read_regs = {
12062306a36Sopenharmony_ci	.yes_ranges =	sta32x_read_regs_range,
12162306a36Sopenharmony_ci	.n_yes_ranges =	ARRAY_SIZE(sta32x_read_regs_range),
12262306a36Sopenharmony_ci};
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_cistatic const struct regmap_access_table sta32x_volatile_regs = {
12562306a36Sopenharmony_ci	.yes_ranges =	sta32x_volatile_regs_range,
12662306a36Sopenharmony_ci	.n_yes_ranges =	ARRAY_SIZE(sta32x_volatile_regs_range),
12762306a36Sopenharmony_ci};
12862306a36Sopenharmony_ci
12962306a36Sopenharmony_ci/* regulator power supply names */
13062306a36Sopenharmony_cistatic const char *sta32x_supply_names[] = {
13162306a36Sopenharmony_ci	"Vdda",	/* analog supply, 3.3VV */
13262306a36Sopenharmony_ci	"Vdd3",	/* digital supply, 3.3V */
13362306a36Sopenharmony_ci	"Vcc"	/* power amp spply, 10V - 36V */
13462306a36Sopenharmony_ci};
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_ci/* codec private data */
13762306a36Sopenharmony_cistruct sta32x_priv {
13862306a36Sopenharmony_ci	struct regmap *regmap;
13962306a36Sopenharmony_ci	struct clk *xti_clk;
14062306a36Sopenharmony_ci	struct regulator_bulk_data supplies[ARRAY_SIZE(sta32x_supply_names)];
14162306a36Sopenharmony_ci	struct snd_soc_component *component;
14262306a36Sopenharmony_ci	struct sta32x_platform_data *pdata;
14362306a36Sopenharmony_ci
14462306a36Sopenharmony_ci	unsigned int mclk;
14562306a36Sopenharmony_ci	unsigned int format;
14662306a36Sopenharmony_ci
14762306a36Sopenharmony_ci	u32 coef_shadow[STA32X_COEF_COUNT];
14862306a36Sopenharmony_ci	struct delayed_work watchdog_work;
14962306a36Sopenharmony_ci	int shutdown;
15062306a36Sopenharmony_ci	struct gpio_desc *gpiod_nreset;
15162306a36Sopenharmony_ci	struct mutex coeff_lock;
15262306a36Sopenharmony_ci};
15362306a36Sopenharmony_ci
15462306a36Sopenharmony_cistatic const DECLARE_TLV_DB_SCALE(mvol_tlv, -12700, 50, 1);
15562306a36Sopenharmony_cistatic const DECLARE_TLV_DB_SCALE(chvol_tlv, -7950, 50, 1);
15662306a36Sopenharmony_cistatic const DECLARE_TLV_DB_SCALE(tone_tlv, -120, 200, 0);
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_cistatic const char *sta32x_drc_ac[] = {
15962306a36Sopenharmony_ci	"Anti-Clipping", "Dynamic Range Compression" };
16062306a36Sopenharmony_cistatic const char *sta32x_auto_eq_mode[] = {
16162306a36Sopenharmony_ci	"User", "Preset", "Loudness" };
16262306a36Sopenharmony_cistatic const char *sta32x_auto_gc_mode[] = {
16362306a36Sopenharmony_ci	"User", "AC no clipping", "AC limited clipping (10%)",
16462306a36Sopenharmony_ci	"DRC nighttime listening mode" };
16562306a36Sopenharmony_cistatic const char *sta32x_auto_xo_mode[] = {
16662306a36Sopenharmony_ci	"User", "80Hz", "100Hz", "120Hz", "140Hz", "160Hz", "180Hz", "200Hz",
16762306a36Sopenharmony_ci	"220Hz", "240Hz", "260Hz", "280Hz", "300Hz", "320Hz", "340Hz", "360Hz" };
16862306a36Sopenharmony_cistatic const char *sta32x_preset_eq_mode[] = {
16962306a36Sopenharmony_ci	"Flat", "Rock", "Soft Rock", "Jazz", "Classical", "Dance", "Pop", "Soft",
17062306a36Sopenharmony_ci	"Hard", "Party", "Vocal", "Hip-Hop", "Dialog", "Bass-boost #1",
17162306a36Sopenharmony_ci	"Bass-boost #2", "Bass-boost #3", "Loudness 1", "Loudness 2",
17262306a36Sopenharmony_ci	"Loudness 3", "Loudness 4", "Loudness 5", "Loudness 6", "Loudness 7",
17362306a36Sopenharmony_ci	"Loudness 8", "Loudness 9", "Loudness 10", "Loudness 11", "Loudness 12",
17462306a36Sopenharmony_ci	"Loudness 13", "Loudness 14", "Loudness 15", "Loudness 16" };
17562306a36Sopenharmony_cistatic const char *sta32x_limiter_select[] = {
17662306a36Sopenharmony_ci	"Limiter Disabled", "Limiter #1", "Limiter #2" };
17762306a36Sopenharmony_cistatic const char *sta32x_limiter_attack_rate[] = {
17862306a36Sopenharmony_ci	"3.1584", "2.7072", "2.2560", "1.8048", "1.3536", "0.9024",
17962306a36Sopenharmony_ci	"0.4512", "0.2256", "0.1504", "0.1123", "0.0902", "0.0752",
18062306a36Sopenharmony_ci	"0.0645", "0.0564", "0.0501", "0.0451" };
18162306a36Sopenharmony_cistatic const char *sta32x_limiter_release_rate[] = {
18262306a36Sopenharmony_ci	"0.5116", "0.1370", "0.0744", "0.0499", "0.0360", "0.0299",
18362306a36Sopenharmony_ci	"0.0264", "0.0208", "0.0198", "0.0172", "0.0147", "0.0137",
18462306a36Sopenharmony_ci	"0.0134", "0.0117", "0.0110", "0.0104" };
18562306a36Sopenharmony_cistatic DECLARE_TLV_DB_RANGE(sta32x_limiter_ac_attack_tlv,
18662306a36Sopenharmony_ci	0, 7, TLV_DB_SCALE_ITEM(-1200, 200, 0),
18762306a36Sopenharmony_ci	8, 16, TLV_DB_SCALE_ITEM(300, 100, 0),
18862306a36Sopenharmony_ci);
18962306a36Sopenharmony_ci
19062306a36Sopenharmony_cistatic DECLARE_TLV_DB_RANGE(sta32x_limiter_ac_release_tlv,
19162306a36Sopenharmony_ci	0, 0, TLV_DB_SCALE_ITEM(TLV_DB_GAIN_MUTE, 0, 0),
19262306a36Sopenharmony_ci	1, 1, TLV_DB_SCALE_ITEM(-2900, 0, 0),
19362306a36Sopenharmony_ci	2, 2, TLV_DB_SCALE_ITEM(-2000, 0, 0),
19462306a36Sopenharmony_ci	3, 8, TLV_DB_SCALE_ITEM(-1400, 200, 0),
19562306a36Sopenharmony_ci	8, 16, TLV_DB_SCALE_ITEM(-700, 100, 0),
19662306a36Sopenharmony_ci);
19762306a36Sopenharmony_ci
19862306a36Sopenharmony_cistatic DECLARE_TLV_DB_RANGE(sta32x_limiter_drc_attack_tlv,
19962306a36Sopenharmony_ci	0, 7, TLV_DB_SCALE_ITEM(-3100, 200, 0),
20062306a36Sopenharmony_ci	8, 13, TLV_DB_SCALE_ITEM(-1600, 100, 0),
20162306a36Sopenharmony_ci	14, 16, TLV_DB_SCALE_ITEM(-1000, 300, 0),
20262306a36Sopenharmony_ci);
20362306a36Sopenharmony_ci
20462306a36Sopenharmony_cistatic DECLARE_TLV_DB_RANGE(sta32x_limiter_drc_release_tlv,
20562306a36Sopenharmony_ci	0, 0, TLV_DB_SCALE_ITEM(TLV_DB_GAIN_MUTE, 0, 0),
20662306a36Sopenharmony_ci	1, 2, TLV_DB_SCALE_ITEM(-3800, 200, 0),
20762306a36Sopenharmony_ci	3, 4, TLV_DB_SCALE_ITEM(-3300, 200, 0),
20862306a36Sopenharmony_ci	5, 12, TLV_DB_SCALE_ITEM(-3000, 200, 0),
20962306a36Sopenharmony_ci	13, 16, TLV_DB_SCALE_ITEM(-1500, 300, 0),
21062306a36Sopenharmony_ci);
21162306a36Sopenharmony_ci
21262306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta32x_drc_ac_enum,
21362306a36Sopenharmony_ci			    STA32X_CONFD, STA32X_CONFD_DRC_SHIFT,
21462306a36Sopenharmony_ci			    sta32x_drc_ac);
21562306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta32x_auto_eq_enum,
21662306a36Sopenharmony_ci			    STA32X_AUTO1, STA32X_AUTO1_AMEQ_SHIFT,
21762306a36Sopenharmony_ci			    sta32x_auto_eq_mode);
21862306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta32x_auto_gc_enum,
21962306a36Sopenharmony_ci			    STA32X_AUTO1, STA32X_AUTO1_AMGC_SHIFT,
22062306a36Sopenharmony_ci			    sta32x_auto_gc_mode);
22162306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta32x_auto_xo_enum,
22262306a36Sopenharmony_ci			    STA32X_AUTO2, STA32X_AUTO2_XO_SHIFT,
22362306a36Sopenharmony_ci			    sta32x_auto_xo_mode);
22462306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta32x_preset_eq_enum,
22562306a36Sopenharmony_ci			    STA32X_AUTO3, STA32X_AUTO3_PEQ_SHIFT,
22662306a36Sopenharmony_ci			    sta32x_preset_eq_mode);
22762306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta32x_limiter_ch1_enum,
22862306a36Sopenharmony_ci			    STA32X_C1CFG, STA32X_CxCFG_LS_SHIFT,
22962306a36Sopenharmony_ci			    sta32x_limiter_select);
23062306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta32x_limiter_ch2_enum,
23162306a36Sopenharmony_ci			    STA32X_C2CFG, STA32X_CxCFG_LS_SHIFT,
23262306a36Sopenharmony_ci			    sta32x_limiter_select);
23362306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta32x_limiter_ch3_enum,
23462306a36Sopenharmony_ci			    STA32X_C3CFG, STA32X_CxCFG_LS_SHIFT,
23562306a36Sopenharmony_ci			    sta32x_limiter_select);
23662306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta32x_limiter1_attack_rate_enum,
23762306a36Sopenharmony_ci			    STA32X_L1AR, STA32X_LxA_SHIFT,
23862306a36Sopenharmony_ci			    sta32x_limiter_attack_rate);
23962306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta32x_limiter2_attack_rate_enum,
24062306a36Sopenharmony_ci			    STA32X_L2AR, STA32X_LxA_SHIFT,
24162306a36Sopenharmony_ci			    sta32x_limiter_attack_rate);
24262306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta32x_limiter1_release_rate_enum,
24362306a36Sopenharmony_ci			    STA32X_L1AR, STA32X_LxR_SHIFT,
24462306a36Sopenharmony_ci			    sta32x_limiter_release_rate);
24562306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta32x_limiter2_release_rate_enum,
24662306a36Sopenharmony_ci			    STA32X_L2AR, STA32X_LxR_SHIFT,
24762306a36Sopenharmony_ci			    sta32x_limiter_release_rate);
24862306a36Sopenharmony_ci
24962306a36Sopenharmony_ci/* byte array controls for setting biquad, mixer, scaling coefficients;
25062306a36Sopenharmony_ci * for biquads all five coefficients need to be set in one go,
25162306a36Sopenharmony_ci * mixer and pre/postscale coefs can be set individually;
25262306a36Sopenharmony_ci * each coef is 24bit, the bytes are ordered in the same way
25362306a36Sopenharmony_ci * as given in the STA32x data sheet (big endian; b1, b2, a1, a2, b0)
25462306a36Sopenharmony_ci */
25562306a36Sopenharmony_ci
25662306a36Sopenharmony_cistatic int sta32x_coefficient_info(struct snd_kcontrol *kcontrol,
25762306a36Sopenharmony_ci				   struct snd_ctl_elem_info *uinfo)
25862306a36Sopenharmony_ci{
25962306a36Sopenharmony_ci	int numcoef = kcontrol->private_value >> 16;
26062306a36Sopenharmony_ci	uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
26162306a36Sopenharmony_ci	uinfo->count = 3 * numcoef;
26262306a36Sopenharmony_ci	return 0;
26362306a36Sopenharmony_ci}
26462306a36Sopenharmony_ci
26562306a36Sopenharmony_cistatic int sta32x_coefficient_get(struct snd_kcontrol *kcontrol,
26662306a36Sopenharmony_ci				  struct snd_ctl_elem_value *ucontrol)
26762306a36Sopenharmony_ci{
26862306a36Sopenharmony_ci	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
26962306a36Sopenharmony_ci	struct sta32x_priv *sta32x = snd_soc_component_get_drvdata(component);
27062306a36Sopenharmony_ci	int numcoef = kcontrol->private_value >> 16;
27162306a36Sopenharmony_ci	int index = kcontrol->private_value & 0xffff;
27262306a36Sopenharmony_ci	unsigned int cfud, val;
27362306a36Sopenharmony_ci	int i, ret = 0;
27462306a36Sopenharmony_ci
27562306a36Sopenharmony_ci	mutex_lock(&sta32x->coeff_lock);
27662306a36Sopenharmony_ci
27762306a36Sopenharmony_ci	/* preserve reserved bits in STA32X_CFUD */
27862306a36Sopenharmony_ci	regmap_read(sta32x->regmap, STA32X_CFUD, &cfud);
27962306a36Sopenharmony_ci	cfud &= 0xf0;
28062306a36Sopenharmony_ci	/*
28162306a36Sopenharmony_ci	 * chip documentation does not say if the bits are self clearing,
28262306a36Sopenharmony_ci	 * so do it explicitly
28362306a36Sopenharmony_ci	 */
28462306a36Sopenharmony_ci	regmap_write(sta32x->regmap, STA32X_CFUD, cfud);
28562306a36Sopenharmony_ci
28662306a36Sopenharmony_ci	regmap_write(sta32x->regmap, STA32X_CFADDR2, index);
28762306a36Sopenharmony_ci	if (numcoef == 1) {
28862306a36Sopenharmony_ci		regmap_write(sta32x->regmap, STA32X_CFUD, cfud | 0x04);
28962306a36Sopenharmony_ci	} else if (numcoef == 5) {
29062306a36Sopenharmony_ci		regmap_write(sta32x->regmap, STA32X_CFUD, cfud | 0x08);
29162306a36Sopenharmony_ci	} else {
29262306a36Sopenharmony_ci		ret = -EINVAL;
29362306a36Sopenharmony_ci		goto exit_unlock;
29462306a36Sopenharmony_ci	}
29562306a36Sopenharmony_ci
29662306a36Sopenharmony_ci	for (i = 0; i < 3 * numcoef; i++) {
29762306a36Sopenharmony_ci		regmap_read(sta32x->regmap, STA32X_B1CF1 + i, &val);
29862306a36Sopenharmony_ci		ucontrol->value.bytes.data[i] = val;
29962306a36Sopenharmony_ci	}
30062306a36Sopenharmony_ci
30162306a36Sopenharmony_ciexit_unlock:
30262306a36Sopenharmony_ci	mutex_unlock(&sta32x->coeff_lock);
30362306a36Sopenharmony_ci
30462306a36Sopenharmony_ci	return ret;
30562306a36Sopenharmony_ci}
30662306a36Sopenharmony_ci
30762306a36Sopenharmony_cistatic int sta32x_coefficient_put(struct snd_kcontrol *kcontrol,
30862306a36Sopenharmony_ci				  struct snd_ctl_elem_value *ucontrol)
30962306a36Sopenharmony_ci{
31062306a36Sopenharmony_ci	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
31162306a36Sopenharmony_ci	struct sta32x_priv *sta32x = snd_soc_component_get_drvdata(component);
31262306a36Sopenharmony_ci	int numcoef = kcontrol->private_value >> 16;
31362306a36Sopenharmony_ci	int index = kcontrol->private_value & 0xffff;
31462306a36Sopenharmony_ci	unsigned int cfud;
31562306a36Sopenharmony_ci	int i;
31662306a36Sopenharmony_ci
31762306a36Sopenharmony_ci	/* preserve reserved bits in STA32X_CFUD */
31862306a36Sopenharmony_ci	regmap_read(sta32x->regmap, STA32X_CFUD, &cfud);
31962306a36Sopenharmony_ci	cfud &= 0xf0;
32062306a36Sopenharmony_ci	/*
32162306a36Sopenharmony_ci	 * chip documentation does not say if the bits are self clearing,
32262306a36Sopenharmony_ci	 * so do it explicitly
32362306a36Sopenharmony_ci	 */
32462306a36Sopenharmony_ci	regmap_write(sta32x->regmap, STA32X_CFUD, cfud);
32562306a36Sopenharmony_ci
32662306a36Sopenharmony_ci	regmap_write(sta32x->regmap, STA32X_CFADDR2, index);
32762306a36Sopenharmony_ci	for (i = 0; i < numcoef && (index + i < STA32X_COEF_COUNT); i++)
32862306a36Sopenharmony_ci		sta32x->coef_shadow[index + i] =
32962306a36Sopenharmony_ci			  (ucontrol->value.bytes.data[3 * i] << 16)
33062306a36Sopenharmony_ci			| (ucontrol->value.bytes.data[3 * i + 1] << 8)
33162306a36Sopenharmony_ci			| (ucontrol->value.bytes.data[3 * i + 2]);
33262306a36Sopenharmony_ci	for (i = 0; i < 3 * numcoef; i++)
33362306a36Sopenharmony_ci		regmap_write(sta32x->regmap, STA32X_B1CF1 + i,
33462306a36Sopenharmony_ci			     ucontrol->value.bytes.data[i]);
33562306a36Sopenharmony_ci	if (numcoef == 1)
33662306a36Sopenharmony_ci		regmap_write(sta32x->regmap, STA32X_CFUD, cfud | 0x01);
33762306a36Sopenharmony_ci	else if (numcoef == 5)
33862306a36Sopenharmony_ci		regmap_write(sta32x->regmap, STA32X_CFUD, cfud | 0x02);
33962306a36Sopenharmony_ci	else
34062306a36Sopenharmony_ci		return -EINVAL;
34162306a36Sopenharmony_ci
34262306a36Sopenharmony_ci	return 0;
34362306a36Sopenharmony_ci}
34462306a36Sopenharmony_ci
34562306a36Sopenharmony_cistatic int sta32x_sync_coef_shadow(struct snd_soc_component *component)
34662306a36Sopenharmony_ci{
34762306a36Sopenharmony_ci	struct sta32x_priv *sta32x = snd_soc_component_get_drvdata(component);
34862306a36Sopenharmony_ci	unsigned int cfud;
34962306a36Sopenharmony_ci	int i;
35062306a36Sopenharmony_ci
35162306a36Sopenharmony_ci	/* preserve reserved bits in STA32X_CFUD */
35262306a36Sopenharmony_ci	regmap_read(sta32x->regmap, STA32X_CFUD, &cfud);
35362306a36Sopenharmony_ci	cfud &= 0xf0;
35462306a36Sopenharmony_ci
35562306a36Sopenharmony_ci	for (i = 0; i < STA32X_COEF_COUNT; i++) {
35662306a36Sopenharmony_ci		regmap_write(sta32x->regmap, STA32X_CFADDR2, i);
35762306a36Sopenharmony_ci		regmap_write(sta32x->regmap, STA32X_B1CF1,
35862306a36Sopenharmony_ci			     (sta32x->coef_shadow[i] >> 16) & 0xff);
35962306a36Sopenharmony_ci		regmap_write(sta32x->regmap, STA32X_B1CF2,
36062306a36Sopenharmony_ci			     (sta32x->coef_shadow[i] >> 8) & 0xff);
36162306a36Sopenharmony_ci		regmap_write(sta32x->regmap, STA32X_B1CF3,
36262306a36Sopenharmony_ci			     (sta32x->coef_shadow[i]) & 0xff);
36362306a36Sopenharmony_ci		/*
36462306a36Sopenharmony_ci		 * chip documentation does not say if the bits are
36562306a36Sopenharmony_ci		 * self-clearing, so do it explicitly
36662306a36Sopenharmony_ci		 */
36762306a36Sopenharmony_ci		regmap_write(sta32x->regmap, STA32X_CFUD, cfud);
36862306a36Sopenharmony_ci		regmap_write(sta32x->regmap, STA32X_CFUD, cfud | 0x01);
36962306a36Sopenharmony_ci	}
37062306a36Sopenharmony_ci	return 0;
37162306a36Sopenharmony_ci}
37262306a36Sopenharmony_ci
37362306a36Sopenharmony_cistatic int sta32x_cache_sync(struct snd_soc_component *component)
37462306a36Sopenharmony_ci{
37562306a36Sopenharmony_ci	struct sta32x_priv *sta32x = snd_soc_component_get_drvdata(component);
37662306a36Sopenharmony_ci	unsigned int mute;
37762306a36Sopenharmony_ci	int rc;
37862306a36Sopenharmony_ci
37962306a36Sopenharmony_ci	/* mute during register sync */
38062306a36Sopenharmony_ci	regmap_read(sta32x->regmap, STA32X_MMUTE, &mute);
38162306a36Sopenharmony_ci	regmap_write(sta32x->regmap, STA32X_MMUTE, mute | STA32X_MMUTE_MMUTE);
38262306a36Sopenharmony_ci	sta32x_sync_coef_shadow(component);
38362306a36Sopenharmony_ci	rc = regcache_sync(sta32x->regmap);
38462306a36Sopenharmony_ci	regmap_write(sta32x->regmap, STA32X_MMUTE, mute);
38562306a36Sopenharmony_ci	return rc;
38662306a36Sopenharmony_ci}
38762306a36Sopenharmony_ci
38862306a36Sopenharmony_ci/* work around ESD issue where sta32x resets and loses all configuration */
38962306a36Sopenharmony_cistatic void sta32x_watchdog(struct work_struct *work)
39062306a36Sopenharmony_ci{
39162306a36Sopenharmony_ci	struct sta32x_priv *sta32x = container_of(work, struct sta32x_priv,
39262306a36Sopenharmony_ci						  watchdog_work.work);
39362306a36Sopenharmony_ci	struct snd_soc_component *component = sta32x->component;
39462306a36Sopenharmony_ci	unsigned int confa, confa_cached;
39562306a36Sopenharmony_ci
39662306a36Sopenharmony_ci	/* check if sta32x has reset itself */
39762306a36Sopenharmony_ci	confa_cached = snd_soc_component_read(component, STA32X_CONFA);
39862306a36Sopenharmony_ci	regcache_cache_bypass(sta32x->regmap, true);
39962306a36Sopenharmony_ci	confa = snd_soc_component_read(component, STA32X_CONFA);
40062306a36Sopenharmony_ci	regcache_cache_bypass(sta32x->regmap, false);
40162306a36Sopenharmony_ci	if (confa != confa_cached) {
40262306a36Sopenharmony_ci		regcache_mark_dirty(sta32x->regmap);
40362306a36Sopenharmony_ci		sta32x_cache_sync(component);
40462306a36Sopenharmony_ci	}
40562306a36Sopenharmony_ci
40662306a36Sopenharmony_ci	if (!sta32x->shutdown)
40762306a36Sopenharmony_ci		queue_delayed_work(system_power_efficient_wq,
40862306a36Sopenharmony_ci				   &sta32x->watchdog_work,
40962306a36Sopenharmony_ci				   round_jiffies_relative(HZ));
41062306a36Sopenharmony_ci}
41162306a36Sopenharmony_ci
41262306a36Sopenharmony_cistatic void sta32x_watchdog_start(struct sta32x_priv *sta32x)
41362306a36Sopenharmony_ci{
41462306a36Sopenharmony_ci	if (sta32x->pdata->needs_esd_watchdog) {
41562306a36Sopenharmony_ci		sta32x->shutdown = 0;
41662306a36Sopenharmony_ci		queue_delayed_work(system_power_efficient_wq,
41762306a36Sopenharmony_ci				   &sta32x->watchdog_work,
41862306a36Sopenharmony_ci				   round_jiffies_relative(HZ));
41962306a36Sopenharmony_ci	}
42062306a36Sopenharmony_ci}
42162306a36Sopenharmony_ci
42262306a36Sopenharmony_cistatic void sta32x_watchdog_stop(struct sta32x_priv *sta32x)
42362306a36Sopenharmony_ci{
42462306a36Sopenharmony_ci	if (sta32x->pdata->needs_esd_watchdog) {
42562306a36Sopenharmony_ci		sta32x->shutdown = 1;
42662306a36Sopenharmony_ci		cancel_delayed_work_sync(&sta32x->watchdog_work);
42762306a36Sopenharmony_ci	}
42862306a36Sopenharmony_ci}
42962306a36Sopenharmony_ci
43062306a36Sopenharmony_ci#define SINGLE_COEF(xname, index) \
43162306a36Sopenharmony_ci{	.iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
43262306a36Sopenharmony_ci	.info = sta32x_coefficient_info, \
43362306a36Sopenharmony_ci	.get = sta32x_coefficient_get,\
43462306a36Sopenharmony_ci	.put = sta32x_coefficient_put, \
43562306a36Sopenharmony_ci	.private_value = index | (1 << 16) }
43662306a36Sopenharmony_ci
43762306a36Sopenharmony_ci#define BIQUAD_COEFS(xname, index) \
43862306a36Sopenharmony_ci{	.iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
43962306a36Sopenharmony_ci	.info = sta32x_coefficient_info, \
44062306a36Sopenharmony_ci	.get = sta32x_coefficient_get,\
44162306a36Sopenharmony_ci	.put = sta32x_coefficient_put, \
44262306a36Sopenharmony_ci	.private_value = index | (5 << 16) }
44362306a36Sopenharmony_ci
44462306a36Sopenharmony_cistatic const struct snd_kcontrol_new sta32x_snd_controls[] = {
44562306a36Sopenharmony_ciSOC_SINGLE_TLV("Master Volume", STA32X_MVOL, 0, 0xff, 1, mvol_tlv),
44662306a36Sopenharmony_ciSOC_SINGLE("Master Switch", STA32X_MMUTE, 0, 1, 1),
44762306a36Sopenharmony_ciSOC_SINGLE("Ch1 Switch", STA32X_MMUTE, 1, 1, 1),
44862306a36Sopenharmony_ciSOC_SINGLE("Ch2 Switch", STA32X_MMUTE, 2, 1, 1),
44962306a36Sopenharmony_ciSOC_SINGLE("Ch3 Switch", STA32X_MMUTE, 3, 1, 1),
45062306a36Sopenharmony_ciSOC_SINGLE_TLV("Ch1 Volume", STA32X_C1VOL, 0, 0xff, 1, chvol_tlv),
45162306a36Sopenharmony_ciSOC_SINGLE_TLV("Ch2 Volume", STA32X_C2VOL, 0, 0xff, 1, chvol_tlv),
45262306a36Sopenharmony_ciSOC_SINGLE_TLV("Ch3 Volume", STA32X_C3VOL, 0, 0xff, 1, chvol_tlv),
45362306a36Sopenharmony_ciSOC_SINGLE("De-emphasis Filter Switch", STA32X_CONFD, STA32X_CONFD_DEMP_SHIFT, 1, 0),
45462306a36Sopenharmony_ciSOC_ENUM("Compressor/Limiter Switch", sta32x_drc_ac_enum),
45562306a36Sopenharmony_ciSOC_SINGLE("Miami Mode Switch", STA32X_CONFD, STA32X_CONFD_MME_SHIFT, 1, 0),
45662306a36Sopenharmony_ciSOC_SINGLE("Zero Cross Switch", STA32X_CONFE, STA32X_CONFE_ZCE_SHIFT, 1, 0),
45762306a36Sopenharmony_ciSOC_SINGLE("Soft Ramp Switch", STA32X_CONFE, STA32X_CONFE_SVE_SHIFT, 1, 0),
45862306a36Sopenharmony_ciSOC_SINGLE("Auto-Mute Switch", STA32X_CONFF, STA32X_CONFF_IDE_SHIFT, 1, 0),
45962306a36Sopenharmony_ciSOC_ENUM("Automode EQ", sta32x_auto_eq_enum),
46062306a36Sopenharmony_ciSOC_ENUM("Automode GC", sta32x_auto_gc_enum),
46162306a36Sopenharmony_ciSOC_ENUM("Automode XO", sta32x_auto_xo_enum),
46262306a36Sopenharmony_ciSOC_ENUM("Preset EQ", sta32x_preset_eq_enum),
46362306a36Sopenharmony_ciSOC_SINGLE("Ch1 Tone Control Bypass Switch", STA32X_C1CFG, STA32X_CxCFG_TCB_SHIFT, 1, 0),
46462306a36Sopenharmony_ciSOC_SINGLE("Ch2 Tone Control Bypass Switch", STA32X_C2CFG, STA32X_CxCFG_TCB_SHIFT, 1, 0),
46562306a36Sopenharmony_ciSOC_SINGLE("Ch1 EQ Bypass Switch", STA32X_C1CFG, STA32X_CxCFG_EQBP_SHIFT, 1, 0),
46662306a36Sopenharmony_ciSOC_SINGLE("Ch2 EQ Bypass Switch", STA32X_C2CFG, STA32X_CxCFG_EQBP_SHIFT, 1, 0),
46762306a36Sopenharmony_ciSOC_SINGLE("Ch1 Master Volume Bypass Switch", STA32X_C1CFG, STA32X_CxCFG_VBP_SHIFT, 1, 0),
46862306a36Sopenharmony_ciSOC_SINGLE("Ch2 Master Volume Bypass Switch", STA32X_C1CFG, STA32X_CxCFG_VBP_SHIFT, 1, 0),
46962306a36Sopenharmony_ciSOC_SINGLE("Ch3 Master Volume Bypass Switch", STA32X_C1CFG, STA32X_CxCFG_VBP_SHIFT, 1, 0),
47062306a36Sopenharmony_ciSOC_ENUM("Ch1 Limiter Select", sta32x_limiter_ch1_enum),
47162306a36Sopenharmony_ciSOC_ENUM("Ch2 Limiter Select", sta32x_limiter_ch2_enum),
47262306a36Sopenharmony_ciSOC_ENUM("Ch3 Limiter Select", sta32x_limiter_ch3_enum),
47362306a36Sopenharmony_ciSOC_SINGLE_TLV("Bass Tone Control", STA32X_TONE, STA32X_TONE_BTC_SHIFT, 15, 0, tone_tlv),
47462306a36Sopenharmony_ciSOC_SINGLE_TLV("Treble Tone Control", STA32X_TONE, STA32X_TONE_TTC_SHIFT, 15, 0, tone_tlv),
47562306a36Sopenharmony_ciSOC_ENUM("Limiter1 Attack Rate (dB/ms)", sta32x_limiter1_attack_rate_enum),
47662306a36Sopenharmony_ciSOC_ENUM("Limiter2 Attack Rate (dB/ms)", sta32x_limiter2_attack_rate_enum),
47762306a36Sopenharmony_ciSOC_ENUM("Limiter1 Release Rate (dB/ms)", sta32x_limiter1_release_rate_enum),
47862306a36Sopenharmony_ciSOC_ENUM("Limiter2 Release Rate (dB/ms)", sta32x_limiter2_release_rate_enum),
47962306a36Sopenharmony_ci
48062306a36Sopenharmony_ci/* depending on mode, the attack/release thresholds have
48162306a36Sopenharmony_ci * two different enum definitions; provide both
48262306a36Sopenharmony_ci */
48362306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter1 Attack Threshold (AC Mode)", STA32X_L1ATRT, STA32X_LxA_SHIFT,
48462306a36Sopenharmony_ci	       16, 0, sta32x_limiter_ac_attack_tlv),
48562306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter2 Attack Threshold (AC Mode)", STA32X_L2ATRT, STA32X_LxA_SHIFT,
48662306a36Sopenharmony_ci	       16, 0, sta32x_limiter_ac_attack_tlv),
48762306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter1 Release Threshold (AC Mode)", STA32X_L1ATRT, STA32X_LxR_SHIFT,
48862306a36Sopenharmony_ci	       16, 0, sta32x_limiter_ac_release_tlv),
48962306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter2 Release Threshold (AC Mode)", STA32X_L2ATRT, STA32X_LxR_SHIFT,
49062306a36Sopenharmony_ci	       16, 0, sta32x_limiter_ac_release_tlv),
49162306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter1 Attack Threshold (DRC Mode)", STA32X_L1ATRT, STA32X_LxA_SHIFT,
49262306a36Sopenharmony_ci	       16, 0, sta32x_limiter_drc_attack_tlv),
49362306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter2 Attack Threshold (DRC Mode)", STA32X_L2ATRT, STA32X_LxA_SHIFT,
49462306a36Sopenharmony_ci	       16, 0, sta32x_limiter_drc_attack_tlv),
49562306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter1 Release Threshold (DRC Mode)", STA32X_L1ATRT, STA32X_LxR_SHIFT,
49662306a36Sopenharmony_ci	       16, 0, sta32x_limiter_drc_release_tlv),
49762306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter2 Release Threshold (DRC Mode)", STA32X_L2ATRT, STA32X_LxR_SHIFT,
49862306a36Sopenharmony_ci	       16, 0, sta32x_limiter_drc_release_tlv),
49962306a36Sopenharmony_ci
50062306a36Sopenharmony_ciBIQUAD_COEFS("Ch1 - Biquad 1", 0),
50162306a36Sopenharmony_ciBIQUAD_COEFS("Ch1 - Biquad 2", 5),
50262306a36Sopenharmony_ciBIQUAD_COEFS("Ch1 - Biquad 3", 10),
50362306a36Sopenharmony_ciBIQUAD_COEFS("Ch1 - Biquad 4", 15),
50462306a36Sopenharmony_ciBIQUAD_COEFS("Ch2 - Biquad 1", 20),
50562306a36Sopenharmony_ciBIQUAD_COEFS("Ch2 - Biquad 2", 25),
50662306a36Sopenharmony_ciBIQUAD_COEFS("Ch2 - Biquad 3", 30),
50762306a36Sopenharmony_ciBIQUAD_COEFS("Ch2 - Biquad 4", 35),
50862306a36Sopenharmony_ciBIQUAD_COEFS("High-pass", 40),
50962306a36Sopenharmony_ciBIQUAD_COEFS("Low-pass", 45),
51062306a36Sopenharmony_ciSINGLE_COEF("Ch1 - Prescale", 50),
51162306a36Sopenharmony_ciSINGLE_COEF("Ch2 - Prescale", 51),
51262306a36Sopenharmony_ciSINGLE_COEF("Ch1 - Postscale", 52),
51362306a36Sopenharmony_ciSINGLE_COEF("Ch2 - Postscale", 53),
51462306a36Sopenharmony_ciSINGLE_COEF("Ch3 - Postscale", 54),
51562306a36Sopenharmony_ciSINGLE_COEF("Thermal warning - Postscale", 55),
51662306a36Sopenharmony_ciSINGLE_COEF("Ch1 - Mix 1", 56),
51762306a36Sopenharmony_ciSINGLE_COEF("Ch1 - Mix 2", 57),
51862306a36Sopenharmony_ciSINGLE_COEF("Ch2 - Mix 1", 58),
51962306a36Sopenharmony_ciSINGLE_COEF("Ch2 - Mix 2", 59),
52062306a36Sopenharmony_ciSINGLE_COEF("Ch3 - Mix 1", 60),
52162306a36Sopenharmony_ciSINGLE_COEF("Ch3 - Mix 2", 61),
52262306a36Sopenharmony_ci};
52362306a36Sopenharmony_ci
52462306a36Sopenharmony_cistatic const struct snd_soc_dapm_widget sta32x_dapm_widgets[] = {
52562306a36Sopenharmony_ciSND_SOC_DAPM_DAC("DAC", "Playback", SND_SOC_NOPM, 0, 0),
52662306a36Sopenharmony_ciSND_SOC_DAPM_OUTPUT("LEFT"),
52762306a36Sopenharmony_ciSND_SOC_DAPM_OUTPUT("RIGHT"),
52862306a36Sopenharmony_ciSND_SOC_DAPM_OUTPUT("SUB"),
52962306a36Sopenharmony_ci};
53062306a36Sopenharmony_ci
53162306a36Sopenharmony_cistatic const struct snd_soc_dapm_route sta32x_dapm_routes[] = {
53262306a36Sopenharmony_ci	{ "LEFT", NULL, "DAC" },
53362306a36Sopenharmony_ci	{ "RIGHT", NULL, "DAC" },
53462306a36Sopenharmony_ci	{ "SUB", NULL, "DAC" },
53562306a36Sopenharmony_ci};
53662306a36Sopenharmony_ci
53762306a36Sopenharmony_ci/* MCLK interpolation ratio per fs */
53862306a36Sopenharmony_cistatic struct {
53962306a36Sopenharmony_ci	int fs;
54062306a36Sopenharmony_ci	int ir;
54162306a36Sopenharmony_ci} interpolation_ratios[] = {
54262306a36Sopenharmony_ci	{ 32000, 0 },
54362306a36Sopenharmony_ci	{ 44100, 0 },
54462306a36Sopenharmony_ci	{ 48000, 0 },
54562306a36Sopenharmony_ci	{ 88200, 1 },
54662306a36Sopenharmony_ci	{ 96000, 1 },
54762306a36Sopenharmony_ci	{ 176400, 2 },
54862306a36Sopenharmony_ci	{ 192000, 2 },
54962306a36Sopenharmony_ci};
55062306a36Sopenharmony_ci
55162306a36Sopenharmony_ci/* MCLK to fs clock ratios */
55262306a36Sopenharmony_cistatic int mcs_ratio_table[3][7] = {
55362306a36Sopenharmony_ci	{ 768, 512, 384, 256, 128, 576, 0 },
55462306a36Sopenharmony_ci	{ 384, 256, 192, 128,  64,   0 },
55562306a36Sopenharmony_ci	{ 384, 256, 192, 128,  64,   0 },
55662306a36Sopenharmony_ci};
55762306a36Sopenharmony_ci
55862306a36Sopenharmony_ci/**
55962306a36Sopenharmony_ci * sta32x_set_dai_sysclk - configure MCLK
56062306a36Sopenharmony_ci * @codec_dai: the codec DAI
56162306a36Sopenharmony_ci * @clk_id: the clock ID (ignored)
56262306a36Sopenharmony_ci * @freq: the MCLK input frequency
56362306a36Sopenharmony_ci * @dir: the clock direction (ignored)
56462306a36Sopenharmony_ci *
56562306a36Sopenharmony_ci * The value of MCLK is used to determine which sample rates are supported
56662306a36Sopenharmony_ci * by the STA32X, based on the mclk_ratios table.
56762306a36Sopenharmony_ci *
56862306a36Sopenharmony_ci * This function must be called by the machine driver's 'startup' function,
56962306a36Sopenharmony_ci * otherwise the list of supported sample rates will not be available in
57062306a36Sopenharmony_ci * time for ALSA.
57162306a36Sopenharmony_ci *
57262306a36Sopenharmony_ci * For setups with variable MCLKs, pass 0 as 'freq' argument. This will cause
57362306a36Sopenharmony_ci * theoretically possible sample rates to be enabled. Call it again with a
57462306a36Sopenharmony_ci * proper value set one the external clock is set (most probably you would do
57562306a36Sopenharmony_ci * that from a machine's driver 'hw_param' hook.
57662306a36Sopenharmony_ci */
57762306a36Sopenharmony_cistatic int sta32x_set_dai_sysclk(struct snd_soc_dai *codec_dai,
57862306a36Sopenharmony_ci		int clk_id, unsigned int freq, int dir)
57962306a36Sopenharmony_ci{
58062306a36Sopenharmony_ci	struct snd_soc_component *component = codec_dai->component;
58162306a36Sopenharmony_ci	struct sta32x_priv *sta32x = snd_soc_component_get_drvdata(component);
58262306a36Sopenharmony_ci
58362306a36Sopenharmony_ci	dev_dbg(component->dev, "mclk=%u\n", freq);
58462306a36Sopenharmony_ci	sta32x->mclk = freq;
58562306a36Sopenharmony_ci
58662306a36Sopenharmony_ci	return 0;
58762306a36Sopenharmony_ci}
58862306a36Sopenharmony_ci
58962306a36Sopenharmony_ci/**
59062306a36Sopenharmony_ci * sta32x_set_dai_fmt - configure the codec for the selected audio format
59162306a36Sopenharmony_ci * @codec_dai: the codec DAI
59262306a36Sopenharmony_ci * @fmt: a SND_SOC_DAIFMT_x value indicating the data format
59362306a36Sopenharmony_ci *
59462306a36Sopenharmony_ci * This function takes a bitmask of SND_SOC_DAIFMT_x bits and programs the
59562306a36Sopenharmony_ci * codec accordingly.
59662306a36Sopenharmony_ci */
59762306a36Sopenharmony_cistatic int sta32x_set_dai_fmt(struct snd_soc_dai *codec_dai,
59862306a36Sopenharmony_ci			      unsigned int fmt)
59962306a36Sopenharmony_ci{
60062306a36Sopenharmony_ci	struct snd_soc_component *component = codec_dai->component;
60162306a36Sopenharmony_ci	struct sta32x_priv *sta32x = snd_soc_component_get_drvdata(component);
60262306a36Sopenharmony_ci	u8 confb = 0;
60362306a36Sopenharmony_ci
60462306a36Sopenharmony_ci	switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
60562306a36Sopenharmony_ci	case SND_SOC_DAIFMT_CBC_CFC:
60662306a36Sopenharmony_ci		break;
60762306a36Sopenharmony_ci	default:
60862306a36Sopenharmony_ci		return -EINVAL;
60962306a36Sopenharmony_ci	}
61062306a36Sopenharmony_ci
61162306a36Sopenharmony_ci	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
61262306a36Sopenharmony_ci	case SND_SOC_DAIFMT_I2S:
61362306a36Sopenharmony_ci	case SND_SOC_DAIFMT_RIGHT_J:
61462306a36Sopenharmony_ci	case SND_SOC_DAIFMT_LEFT_J:
61562306a36Sopenharmony_ci		sta32x->format = fmt & SND_SOC_DAIFMT_FORMAT_MASK;
61662306a36Sopenharmony_ci		break;
61762306a36Sopenharmony_ci	default:
61862306a36Sopenharmony_ci		return -EINVAL;
61962306a36Sopenharmony_ci	}
62062306a36Sopenharmony_ci
62162306a36Sopenharmony_ci	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
62262306a36Sopenharmony_ci	case SND_SOC_DAIFMT_NB_NF:
62362306a36Sopenharmony_ci		confb |= STA32X_CONFB_C2IM;
62462306a36Sopenharmony_ci		break;
62562306a36Sopenharmony_ci	case SND_SOC_DAIFMT_NB_IF:
62662306a36Sopenharmony_ci		confb |= STA32X_CONFB_C1IM;
62762306a36Sopenharmony_ci		break;
62862306a36Sopenharmony_ci	default:
62962306a36Sopenharmony_ci		return -EINVAL;
63062306a36Sopenharmony_ci	}
63162306a36Sopenharmony_ci
63262306a36Sopenharmony_ci	return regmap_update_bits(sta32x->regmap, STA32X_CONFB,
63362306a36Sopenharmony_ci				  STA32X_CONFB_C1IM | STA32X_CONFB_C2IM, confb);
63462306a36Sopenharmony_ci}
63562306a36Sopenharmony_ci
63662306a36Sopenharmony_ci/**
63762306a36Sopenharmony_ci * sta32x_hw_params - program the STA32X with the given hardware parameters.
63862306a36Sopenharmony_ci * @substream: the audio stream
63962306a36Sopenharmony_ci * @params: the hardware parameters to set
64062306a36Sopenharmony_ci * @dai: the SOC DAI (ignored)
64162306a36Sopenharmony_ci *
64262306a36Sopenharmony_ci * This function programs the hardware with the values provided.
64362306a36Sopenharmony_ci * Specifically, the sample rate and the data format.
64462306a36Sopenharmony_ci */
64562306a36Sopenharmony_cistatic int sta32x_hw_params(struct snd_pcm_substream *substream,
64662306a36Sopenharmony_ci			    struct snd_pcm_hw_params *params,
64762306a36Sopenharmony_ci			    struct snd_soc_dai *dai)
64862306a36Sopenharmony_ci{
64962306a36Sopenharmony_ci	struct snd_soc_component *component = dai->component;
65062306a36Sopenharmony_ci	struct sta32x_priv *sta32x = snd_soc_component_get_drvdata(component);
65162306a36Sopenharmony_ci	int i, mcs = -EINVAL, ir = -EINVAL;
65262306a36Sopenharmony_ci	unsigned int confa, confb;
65362306a36Sopenharmony_ci	unsigned int rate, ratio;
65462306a36Sopenharmony_ci	int ret;
65562306a36Sopenharmony_ci
65662306a36Sopenharmony_ci	if (!sta32x->mclk) {
65762306a36Sopenharmony_ci		dev_err(component->dev,
65862306a36Sopenharmony_ci			"sta32x->mclk is unset. Unable to determine ratio\n");
65962306a36Sopenharmony_ci		return -EIO;
66062306a36Sopenharmony_ci	}
66162306a36Sopenharmony_ci
66262306a36Sopenharmony_ci	rate = params_rate(params);
66362306a36Sopenharmony_ci	ratio = sta32x->mclk / rate;
66462306a36Sopenharmony_ci	dev_dbg(component->dev, "rate: %u, ratio: %u\n", rate, ratio);
66562306a36Sopenharmony_ci
66662306a36Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(interpolation_ratios); i++) {
66762306a36Sopenharmony_ci		if (interpolation_ratios[i].fs == rate) {
66862306a36Sopenharmony_ci			ir = interpolation_ratios[i].ir;
66962306a36Sopenharmony_ci			break;
67062306a36Sopenharmony_ci		}
67162306a36Sopenharmony_ci	}
67262306a36Sopenharmony_ci
67362306a36Sopenharmony_ci	if (ir < 0) {
67462306a36Sopenharmony_ci		dev_err(component->dev, "Unsupported samplerate: %u\n", rate);
67562306a36Sopenharmony_ci		return -EINVAL;
67662306a36Sopenharmony_ci	}
67762306a36Sopenharmony_ci
67862306a36Sopenharmony_ci	for (i = 0; i < 6; i++) {
67962306a36Sopenharmony_ci		if (mcs_ratio_table[ir][i] == ratio) {
68062306a36Sopenharmony_ci			mcs = i;
68162306a36Sopenharmony_ci			break;
68262306a36Sopenharmony_ci		}
68362306a36Sopenharmony_ci	}
68462306a36Sopenharmony_ci
68562306a36Sopenharmony_ci	if (mcs < 0) {
68662306a36Sopenharmony_ci		dev_err(component->dev, "Unresolvable ratio: %u\n", ratio);
68762306a36Sopenharmony_ci		return -EINVAL;
68862306a36Sopenharmony_ci	}
68962306a36Sopenharmony_ci
69062306a36Sopenharmony_ci	confa = (ir << STA32X_CONFA_IR_SHIFT) |
69162306a36Sopenharmony_ci		(mcs << STA32X_CONFA_MCS_SHIFT);
69262306a36Sopenharmony_ci	confb = 0;
69362306a36Sopenharmony_ci
69462306a36Sopenharmony_ci	switch (params_width(params)) {
69562306a36Sopenharmony_ci	case 24:
69662306a36Sopenharmony_ci		dev_dbg(component->dev, "24bit\n");
69762306a36Sopenharmony_ci		fallthrough;
69862306a36Sopenharmony_ci	case 32:
69962306a36Sopenharmony_ci		dev_dbg(component->dev, "24bit or 32bit\n");
70062306a36Sopenharmony_ci		switch (sta32x->format) {
70162306a36Sopenharmony_ci		case SND_SOC_DAIFMT_I2S:
70262306a36Sopenharmony_ci			confb |= 0x0;
70362306a36Sopenharmony_ci			break;
70462306a36Sopenharmony_ci		case SND_SOC_DAIFMT_LEFT_J:
70562306a36Sopenharmony_ci			confb |= 0x1;
70662306a36Sopenharmony_ci			break;
70762306a36Sopenharmony_ci		case SND_SOC_DAIFMT_RIGHT_J:
70862306a36Sopenharmony_ci			confb |= 0x2;
70962306a36Sopenharmony_ci			break;
71062306a36Sopenharmony_ci		}
71162306a36Sopenharmony_ci
71262306a36Sopenharmony_ci		break;
71362306a36Sopenharmony_ci	case 20:
71462306a36Sopenharmony_ci		dev_dbg(component->dev, "20bit\n");
71562306a36Sopenharmony_ci		switch (sta32x->format) {
71662306a36Sopenharmony_ci		case SND_SOC_DAIFMT_I2S:
71762306a36Sopenharmony_ci			confb |= 0x4;
71862306a36Sopenharmony_ci			break;
71962306a36Sopenharmony_ci		case SND_SOC_DAIFMT_LEFT_J:
72062306a36Sopenharmony_ci			confb |= 0x5;
72162306a36Sopenharmony_ci			break;
72262306a36Sopenharmony_ci		case SND_SOC_DAIFMT_RIGHT_J:
72362306a36Sopenharmony_ci			confb |= 0x6;
72462306a36Sopenharmony_ci			break;
72562306a36Sopenharmony_ci		}
72662306a36Sopenharmony_ci
72762306a36Sopenharmony_ci		break;
72862306a36Sopenharmony_ci	case 18:
72962306a36Sopenharmony_ci		dev_dbg(component->dev, "18bit\n");
73062306a36Sopenharmony_ci		switch (sta32x->format) {
73162306a36Sopenharmony_ci		case SND_SOC_DAIFMT_I2S:
73262306a36Sopenharmony_ci			confb |= 0x8;
73362306a36Sopenharmony_ci			break;
73462306a36Sopenharmony_ci		case SND_SOC_DAIFMT_LEFT_J:
73562306a36Sopenharmony_ci			confb |= 0x9;
73662306a36Sopenharmony_ci			break;
73762306a36Sopenharmony_ci		case SND_SOC_DAIFMT_RIGHT_J:
73862306a36Sopenharmony_ci			confb |= 0xa;
73962306a36Sopenharmony_ci			break;
74062306a36Sopenharmony_ci		}
74162306a36Sopenharmony_ci
74262306a36Sopenharmony_ci		break;
74362306a36Sopenharmony_ci	case 16:
74462306a36Sopenharmony_ci		dev_dbg(component->dev, "16bit\n");
74562306a36Sopenharmony_ci		switch (sta32x->format) {
74662306a36Sopenharmony_ci		case SND_SOC_DAIFMT_I2S:
74762306a36Sopenharmony_ci			confb |= 0x0;
74862306a36Sopenharmony_ci			break;
74962306a36Sopenharmony_ci		case SND_SOC_DAIFMT_LEFT_J:
75062306a36Sopenharmony_ci			confb |= 0xd;
75162306a36Sopenharmony_ci			break;
75262306a36Sopenharmony_ci		case SND_SOC_DAIFMT_RIGHT_J:
75362306a36Sopenharmony_ci			confb |= 0xe;
75462306a36Sopenharmony_ci			break;
75562306a36Sopenharmony_ci		}
75662306a36Sopenharmony_ci
75762306a36Sopenharmony_ci		break;
75862306a36Sopenharmony_ci	default:
75962306a36Sopenharmony_ci		return -EINVAL;
76062306a36Sopenharmony_ci	}
76162306a36Sopenharmony_ci
76262306a36Sopenharmony_ci	ret = regmap_update_bits(sta32x->regmap, STA32X_CONFA,
76362306a36Sopenharmony_ci				 STA32X_CONFA_MCS_MASK | STA32X_CONFA_IR_MASK,
76462306a36Sopenharmony_ci				 confa);
76562306a36Sopenharmony_ci	if (ret < 0)
76662306a36Sopenharmony_ci		return ret;
76762306a36Sopenharmony_ci
76862306a36Sopenharmony_ci	ret = regmap_update_bits(sta32x->regmap, STA32X_CONFB,
76962306a36Sopenharmony_ci				 STA32X_CONFB_SAI_MASK | STA32X_CONFB_SAIFB,
77062306a36Sopenharmony_ci				 confb);
77162306a36Sopenharmony_ci	if (ret < 0)
77262306a36Sopenharmony_ci		return ret;
77362306a36Sopenharmony_ci
77462306a36Sopenharmony_ci	return 0;
77562306a36Sopenharmony_ci}
77662306a36Sopenharmony_ci
77762306a36Sopenharmony_cistatic int sta32x_startup_sequence(struct sta32x_priv *sta32x)
77862306a36Sopenharmony_ci{
77962306a36Sopenharmony_ci	if (sta32x->gpiod_nreset) {
78062306a36Sopenharmony_ci		gpiod_set_value(sta32x->gpiod_nreset, 0);
78162306a36Sopenharmony_ci		mdelay(1);
78262306a36Sopenharmony_ci		gpiod_set_value(sta32x->gpiod_nreset, 1);
78362306a36Sopenharmony_ci		mdelay(1);
78462306a36Sopenharmony_ci	}
78562306a36Sopenharmony_ci
78662306a36Sopenharmony_ci	return 0;
78762306a36Sopenharmony_ci}
78862306a36Sopenharmony_ci
78962306a36Sopenharmony_ci/**
79062306a36Sopenharmony_ci * sta32x_set_bias_level - DAPM callback
79162306a36Sopenharmony_ci * @component: the component device
79262306a36Sopenharmony_ci * @level: DAPM power level
79362306a36Sopenharmony_ci *
79462306a36Sopenharmony_ci * This is called by ALSA to put the component into low power mode
79562306a36Sopenharmony_ci * or to wake it up.  If the component is powered off completely
79662306a36Sopenharmony_ci * all registers must be restored after power on.
79762306a36Sopenharmony_ci */
79862306a36Sopenharmony_cistatic int sta32x_set_bias_level(struct snd_soc_component *component,
79962306a36Sopenharmony_ci				 enum snd_soc_bias_level level)
80062306a36Sopenharmony_ci{
80162306a36Sopenharmony_ci	int ret;
80262306a36Sopenharmony_ci	struct sta32x_priv *sta32x = snd_soc_component_get_drvdata(component);
80362306a36Sopenharmony_ci
80462306a36Sopenharmony_ci	dev_dbg(component->dev, "level = %d\n", level);
80562306a36Sopenharmony_ci	switch (level) {
80662306a36Sopenharmony_ci	case SND_SOC_BIAS_ON:
80762306a36Sopenharmony_ci		break;
80862306a36Sopenharmony_ci
80962306a36Sopenharmony_ci	case SND_SOC_BIAS_PREPARE:
81062306a36Sopenharmony_ci		/* Full power on */
81162306a36Sopenharmony_ci		regmap_update_bits(sta32x->regmap, STA32X_CONFF,
81262306a36Sopenharmony_ci				    STA32X_CONFF_PWDN | STA32X_CONFF_EAPD,
81362306a36Sopenharmony_ci				    STA32X_CONFF_PWDN | STA32X_CONFF_EAPD);
81462306a36Sopenharmony_ci		break;
81562306a36Sopenharmony_ci
81662306a36Sopenharmony_ci	case SND_SOC_BIAS_STANDBY:
81762306a36Sopenharmony_ci		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {
81862306a36Sopenharmony_ci			ret = regulator_bulk_enable(ARRAY_SIZE(sta32x->supplies),
81962306a36Sopenharmony_ci						    sta32x->supplies);
82062306a36Sopenharmony_ci			if (ret != 0) {
82162306a36Sopenharmony_ci				dev_err(component->dev,
82262306a36Sopenharmony_ci					"Failed to enable supplies: %d\n", ret);
82362306a36Sopenharmony_ci				return ret;
82462306a36Sopenharmony_ci			}
82562306a36Sopenharmony_ci
82662306a36Sopenharmony_ci			sta32x_startup_sequence(sta32x);
82762306a36Sopenharmony_ci			sta32x_cache_sync(component);
82862306a36Sopenharmony_ci			sta32x_watchdog_start(sta32x);
82962306a36Sopenharmony_ci		}
83062306a36Sopenharmony_ci
83162306a36Sopenharmony_ci		/* Power down */
83262306a36Sopenharmony_ci		regmap_update_bits(sta32x->regmap, STA32X_CONFF,
83362306a36Sopenharmony_ci				   STA32X_CONFF_PWDN | STA32X_CONFF_EAPD,
83462306a36Sopenharmony_ci				   0);
83562306a36Sopenharmony_ci
83662306a36Sopenharmony_ci		break;
83762306a36Sopenharmony_ci
83862306a36Sopenharmony_ci	case SND_SOC_BIAS_OFF:
83962306a36Sopenharmony_ci		/* The chip runs through the power down sequence for us. */
84062306a36Sopenharmony_ci		regmap_update_bits(sta32x->regmap, STA32X_CONFF,
84162306a36Sopenharmony_ci				   STA32X_CONFF_PWDN | STA32X_CONFF_EAPD, 0);
84262306a36Sopenharmony_ci		msleep(300);
84362306a36Sopenharmony_ci		sta32x_watchdog_stop(sta32x);
84462306a36Sopenharmony_ci
84562306a36Sopenharmony_ci		gpiod_set_value(sta32x->gpiod_nreset, 0);
84662306a36Sopenharmony_ci
84762306a36Sopenharmony_ci		regulator_bulk_disable(ARRAY_SIZE(sta32x->supplies),
84862306a36Sopenharmony_ci				       sta32x->supplies);
84962306a36Sopenharmony_ci		break;
85062306a36Sopenharmony_ci	}
85162306a36Sopenharmony_ci	return 0;
85262306a36Sopenharmony_ci}
85362306a36Sopenharmony_ci
85462306a36Sopenharmony_cistatic const struct snd_soc_dai_ops sta32x_dai_ops = {
85562306a36Sopenharmony_ci	.hw_params	= sta32x_hw_params,
85662306a36Sopenharmony_ci	.set_sysclk	= sta32x_set_dai_sysclk,
85762306a36Sopenharmony_ci	.set_fmt	= sta32x_set_dai_fmt,
85862306a36Sopenharmony_ci};
85962306a36Sopenharmony_ci
86062306a36Sopenharmony_cistatic struct snd_soc_dai_driver sta32x_dai = {
86162306a36Sopenharmony_ci	.name = "sta32x-hifi",
86262306a36Sopenharmony_ci	.playback = {
86362306a36Sopenharmony_ci		.stream_name = "Playback",
86462306a36Sopenharmony_ci		.channels_min = 2,
86562306a36Sopenharmony_ci		.channels_max = 2,
86662306a36Sopenharmony_ci		.rates = STA32X_RATES,
86762306a36Sopenharmony_ci		.formats = STA32X_FORMATS,
86862306a36Sopenharmony_ci	},
86962306a36Sopenharmony_ci	.ops = &sta32x_dai_ops,
87062306a36Sopenharmony_ci};
87162306a36Sopenharmony_ci
87262306a36Sopenharmony_cistatic int sta32x_probe(struct snd_soc_component *component)
87362306a36Sopenharmony_ci{
87462306a36Sopenharmony_ci	struct sta32x_priv *sta32x = snd_soc_component_get_drvdata(component);
87562306a36Sopenharmony_ci	struct sta32x_platform_data *pdata = sta32x->pdata;
87662306a36Sopenharmony_ci	int i, ret = 0, thermal = 0;
87762306a36Sopenharmony_ci
87862306a36Sopenharmony_ci	sta32x->component = component;
87962306a36Sopenharmony_ci
88062306a36Sopenharmony_ci	if (sta32x->xti_clk) {
88162306a36Sopenharmony_ci		ret = clk_prepare_enable(sta32x->xti_clk);
88262306a36Sopenharmony_ci		if (ret != 0) {
88362306a36Sopenharmony_ci			dev_err(component->dev,
88462306a36Sopenharmony_ci				"Failed to enable clock: %d\n", ret);
88562306a36Sopenharmony_ci			return ret;
88662306a36Sopenharmony_ci		}
88762306a36Sopenharmony_ci	}
88862306a36Sopenharmony_ci
88962306a36Sopenharmony_ci	ret = regulator_bulk_enable(ARRAY_SIZE(sta32x->supplies),
89062306a36Sopenharmony_ci				    sta32x->supplies);
89162306a36Sopenharmony_ci	if (ret != 0) {
89262306a36Sopenharmony_ci		dev_err(component->dev, "Failed to enable supplies: %d\n", ret);
89362306a36Sopenharmony_ci		goto err_clk_disable_unprepare;
89462306a36Sopenharmony_ci	}
89562306a36Sopenharmony_ci
89662306a36Sopenharmony_ci	ret = sta32x_startup_sequence(sta32x);
89762306a36Sopenharmony_ci	if (ret < 0) {
89862306a36Sopenharmony_ci		dev_err(component->dev, "Failed to startup device\n");
89962306a36Sopenharmony_ci		goto err_regulator_bulk_disable;
90062306a36Sopenharmony_ci	}
90162306a36Sopenharmony_ci
90262306a36Sopenharmony_ci	/* CONFA */
90362306a36Sopenharmony_ci	if (!pdata->thermal_warning_recovery)
90462306a36Sopenharmony_ci		thermal |= STA32X_CONFA_TWAB;
90562306a36Sopenharmony_ci	if (!pdata->thermal_warning_adjustment)
90662306a36Sopenharmony_ci		thermal |= STA32X_CONFA_TWRB;
90762306a36Sopenharmony_ci	if (!pdata->fault_detect_recovery)
90862306a36Sopenharmony_ci		thermal |= STA32X_CONFA_FDRB;
90962306a36Sopenharmony_ci	regmap_update_bits(sta32x->regmap, STA32X_CONFA,
91062306a36Sopenharmony_ci			   STA32X_CONFA_TWAB | STA32X_CONFA_TWRB |
91162306a36Sopenharmony_ci			   STA32X_CONFA_FDRB,
91262306a36Sopenharmony_ci			   thermal);
91362306a36Sopenharmony_ci
91462306a36Sopenharmony_ci	/* CONFC */
91562306a36Sopenharmony_ci	regmap_update_bits(sta32x->regmap, STA32X_CONFC,
91662306a36Sopenharmony_ci			   STA32X_CONFC_CSZ_MASK,
91762306a36Sopenharmony_ci			   pdata->drop_compensation_ns
91862306a36Sopenharmony_ci				<< STA32X_CONFC_CSZ_SHIFT);
91962306a36Sopenharmony_ci
92062306a36Sopenharmony_ci	/* CONFE */
92162306a36Sopenharmony_ci	regmap_update_bits(sta32x->regmap, STA32X_CONFE,
92262306a36Sopenharmony_ci			   STA32X_CONFE_MPCV,
92362306a36Sopenharmony_ci			   pdata->max_power_use_mpcc ?
92462306a36Sopenharmony_ci				STA32X_CONFE_MPCV : 0);
92562306a36Sopenharmony_ci	regmap_update_bits(sta32x->regmap, STA32X_CONFE,
92662306a36Sopenharmony_ci			   STA32X_CONFE_MPC,
92762306a36Sopenharmony_ci			   pdata->max_power_correction ?
92862306a36Sopenharmony_ci				STA32X_CONFE_MPC : 0);
92962306a36Sopenharmony_ci	regmap_update_bits(sta32x->regmap, STA32X_CONFE,
93062306a36Sopenharmony_ci			   STA32X_CONFE_AME,
93162306a36Sopenharmony_ci			   pdata->am_reduction_mode ?
93262306a36Sopenharmony_ci				STA32X_CONFE_AME : 0);
93362306a36Sopenharmony_ci	regmap_update_bits(sta32x->regmap, STA32X_CONFE,
93462306a36Sopenharmony_ci			   STA32X_CONFE_PWMS,
93562306a36Sopenharmony_ci			   pdata->odd_pwm_speed_mode ?
93662306a36Sopenharmony_ci				STA32X_CONFE_PWMS : 0);
93762306a36Sopenharmony_ci
93862306a36Sopenharmony_ci	/*  CONFF */
93962306a36Sopenharmony_ci	regmap_update_bits(sta32x->regmap, STA32X_CONFF,
94062306a36Sopenharmony_ci			   STA32X_CONFF_IDE,
94162306a36Sopenharmony_ci			   pdata->invalid_input_detect_mute ?
94262306a36Sopenharmony_ci				STA32X_CONFF_IDE : 0);
94362306a36Sopenharmony_ci
94462306a36Sopenharmony_ci	/* select output configuration  */
94562306a36Sopenharmony_ci	regmap_update_bits(sta32x->regmap, STA32X_CONFF,
94662306a36Sopenharmony_ci			   STA32X_CONFF_OCFG_MASK,
94762306a36Sopenharmony_ci			   pdata->output_conf
94862306a36Sopenharmony_ci				<< STA32X_CONFF_OCFG_SHIFT);
94962306a36Sopenharmony_ci
95062306a36Sopenharmony_ci	/* channel to output mapping */
95162306a36Sopenharmony_ci	regmap_update_bits(sta32x->regmap, STA32X_C1CFG,
95262306a36Sopenharmony_ci			   STA32X_CxCFG_OM_MASK,
95362306a36Sopenharmony_ci			   pdata->ch1_output_mapping
95462306a36Sopenharmony_ci				<< STA32X_CxCFG_OM_SHIFT);
95562306a36Sopenharmony_ci	regmap_update_bits(sta32x->regmap, STA32X_C2CFG,
95662306a36Sopenharmony_ci			   STA32X_CxCFG_OM_MASK,
95762306a36Sopenharmony_ci			   pdata->ch2_output_mapping
95862306a36Sopenharmony_ci				<< STA32X_CxCFG_OM_SHIFT);
95962306a36Sopenharmony_ci	regmap_update_bits(sta32x->regmap, STA32X_C3CFG,
96062306a36Sopenharmony_ci			   STA32X_CxCFG_OM_MASK,
96162306a36Sopenharmony_ci			   pdata->ch3_output_mapping
96262306a36Sopenharmony_ci				<< STA32X_CxCFG_OM_SHIFT);
96362306a36Sopenharmony_ci
96462306a36Sopenharmony_ci	/* initialize coefficient shadow RAM with reset values */
96562306a36Sopenharmony_ci	for (i = 4; i <= 49; i += 5)
96662306a36Sopenharmony_ci		sta32x->coef_shadow[i] = 0x400000;
96762306a36Sopenharmony_ci	for (i = 50; i <= 54; i++)
96862306a36Sopenharmony_ci		sta32x->coef_shadow[i] = 0x7fffff;
96962306a36Sopenharmony_ci	sta32x->coef_shadow[55] = 0x5a9df7;
97062306a36Sopenharmony_ci	sta32x->coef_shadow[56] = 0x7fffff;
97162306a36Sopenharmony_ci	sta32x->coef_shadow[59] = 0x7fffff;
97262306a36Sopenharmony_ci	sta32x->coef_shadow[60] = 0x400000;
97362306a36Sopenharmony_ci	sta32x->coef_shadow[61] = 0x400000;
97462306a36Sopenharmony_ci
97562306a36Sopenharmony_ci	if (sta32x->pdata->needs_esd_watchdog)
97662306a36Sopenharmony_ci		INIT_DELAYED_WORK(&sta32x->watchdog_work, sta32x_watchdog);
97762306a36Sopenharmony_ci
97862306a36Sopenharmony_ci	snd_soc_component_force_bias_level(component, SND_SOC_BIAS_STANDBY);
97962306a36Sopenharmony_ci	/* Bias level configuration will have done an extra enable */
98062306a36Sopenharmony_ci	regulator_bulk_disable(ARRAY_SIZE(sta32x->supplies), sta32x->supplies);
98162306a36Sopenharmony_ci
98262306a36Sopenharmony_ci	return 0;
98362306a36Sopenharmony_ci
98462306a36Sopenharmony_cierr_regulator_bulk_disable:
98562306a36Sopenharmony_ci	regulator_bulk_disable(ARRAY_SIZE(sta32x->supplies), sta32x->supplies);
98662306a36Sopenharmony_cierr_clk_disable_unprepare:
98762306a36Sopenharmony_ci	if (sta32x->xti_clk)
98862306a36Sopenharmony_ci		clk_disable_unprepare(sta32x->xti_clk);
98962306a36Sopenharmony_ci	return ret;
99062306a36Sopenharmony_ci}
99162306a36Sopenharmony_ci
99262306a36Sopenharmony_cistatic void sta32x_remove(struct snd_soc_component *component)
99362306a36Sopenharmony_ci{
99462306a36Sopenharmony_ci	struct sta32x_priv *sta32x = snd_soc_component_get_drvdata(component);
99562306a36Sopenharmony_ci
99662306a36Sopenharmony_ci	sta32x_watchdog_stop(sta32x);
99762306a36Sopenharmony_ci	regulator_bulk_disable(ARRAY_SIZE(sta32x->supplies), sta32x->supplies);
99862306a36Sopenharmony_ci
99962306a36Sopenharmony_ci	if (sta32x->xti_clk)
100062306a36Sopenharmony_ci		clk_disable_unprepare(sta32x->xti_clk);
100162306a36Sopenharmony_ci}
100262306a36Sopenharmony_ci
100362306a36Sopenharmony_cistatic const struct snd_soc_component_driver sta32x_component = {
100462306a36Sopenharmony_ci	.probe			= sta32x_probe,
100562306a36Sopenharmony_ci	.remove			= sta32x_remove,
100662306a36Sopenharmony_ci	.set_bias_level		= sta32x_set_bias_level,
100762306a36Sopenharmony_ci	.controls		= sta32x_snd_controls,
100862306a36Sopenharmony_ci	.num_controls		= ARRAY_SIZE(sta32x_snd_controls),
100962306a36Sopenharmony_ci	.dapm_widgets		= sta32x_dapm_widgets,
101062306a36Sopenharmony_ci	.num_dapm_widgets	= ARRAY_SIZE(sta32x_dapm_widgets),
101162306a36Sopenharmony_ci	.dapm_routes		= sta32x_dapm_routes,
101262306a36Sopenharmony_ci	.num_dapm_routes	= ARRAY_SIZE(sta32x_dapm_routes),
101362306a36Sopenharmony_ci	.suspend_bias_off	= 1,
101462306a36Sopenharmony_ci	.idle_bias_on		= 1,
101562306a36Sopenharmony_ci	.use_pmdown_time	= 1,
101662306a36Sopenharmony_ci	.endianness		= 1,
101762306a36Sopenharmony_ci};
101862306a36Sopenharmony_ci
101962306a36Sopenharmony_cistatic const struct regmap_config sta32x_regmap = {
102062306a36Sopenharmony_ci	.reg_bits =		8,
102162306a36Sopenharmony_ci	.val_bits =		8,
102262306a36Sopenharmony_ci	.max_register =		STA32X_FDRC2,
102362306a36Sopenharmony_ci	.reg_defaults =		sta32x_regs,
102462306a36Sopenharmony_ci	.num_reg_defaults =	ARRAY_SIZE(sta32x_regs),
102562306a36Sopenharmony_ci	.cache_type =		REGCACHE_MAPLE,
102662306a36Sopenharmony_ci	.wr_table =		&sta32x_write_regs,
102762306a36Sopenharmony_ci	.rd_table =		&sta32x_read_regs,
102862306a36Sopenharmony_ci	.volatile_table =	&sta32x_volatile_regs,
102962306a36Sopenharmony_ci};
103062306a36Sopenharmony_ci
103162306a36Sopenharmony_ci#ifdef CONFIG_OF
103262306a36Sopenharmony_cistatic const struct of_device_id st32x_dt_ids[] = {
103362306a36Sopenharmony_ci	{ .compatible = "st,sta32x", },
103462306a36Sopenharmony_ci	{ }
103562306a36Sopenharmony_ci};
103662306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, st32x_dt_ids);
103762306a36Sopenharmony_ci
103862306a36Sopenharmony_cistatic int sta32x_probe_dt(struct device *dev, struct sta32x_priv *sta32x)
103962306a36Sopenharmony_ci{
104062306a36Sopenharmony_ci	struct device_node *np = dev->of_node;
104162306a36Sopenharmony_ci	struct sta32x_platform_data *pdata;
104262306a36Sopenharmony_ci	u16 tmp;
104362306a36Sopenharmony_ci
104462306a36Sopenharmony_ci	pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
104562306a36Sopenharmony_ci	if (!pdata)
104662306a36Sopenharmony_ci		return -ENOMEM;
104762306a36Sopenharmony_ci
104862306a36Sopenharmony_ci	of_property_read_u8(np, "st,output-conf",
104962306a36Sopenharmony_ci			    &pdata->output_conf);
105062306a36Sopenharmony_ci	of_property_read_u8(np, "st,ch1-output-mapping",
105162306a36Sopenharmony_ci			    &pdata->ch1_output_mapping);
105262306a36Sopenharmony_ci	of_property_read_u8(np, "st,ch2-output-mapping",
105362306a36Sopenharmony_ci			    &pdata->ch2_output_mapping);
105462306a36Sopenharmony_ci	of_property_read_u8(np, "st,ch3-output-mapping",
105562306a36Sopenharmony_ci			    &pdata->ch3_output_mapping);
105662306a36Sopenharmony_ci
105762306a36Sopenharmony_ci	pdata->fault_detect_recovery =
105862306a36Sopenharmony_ci		of_property_read_bool(np, "st,fault-detect-recovery");
105962306a36Sopenharmony_ci	pdata->thermal_warning_recovery =
106062306a36Sopenharmony_ci		of_property_read_bool(np, "st,thermal-warning-recovery");
106162306a36Sopenharmony_ci	pdata->thermal_warning_adjustment =
106262306a36Sopenharmony_ci		of_property_read_bool(np, "st,thermal-warning-adjustment");
106362306a36Sopenharmony_ci	pdata->needs_esd_watchdog =
106462306a36Sopenharmony_ci		of_property_read_bool(np, "st,needs_esd_watchdog");
106562306a36Sopenharmony_ci
106662306a36Sopenharmony_ci	tmp = 140;
106762306a36Sopenharmony_ci	of_property_read_u16(np, "st,drop-compensation-ns", &tmp);
106862306a36Sopenharmony_ci	pdata->drop_compensation_ns = clamp_t(u16, tmp, 0, 300) / 20;
106962306a36Sopenharmony_ci
107062306a36Sopenharmony_ci	/* CONFE */
107162306a36Sopenharmony_ci	pdata->max_power_use_mpcc =
107262306a36Sopenharmony_ci		of_property_read_bool(np, "st,max-power-use-mpcc");
107362306a36Sopenharmony_ci	pdata->max_power_correction =
107462306a36Sopenharmony_ci		of_property_read_bool(np, "st,max-power-correction");
107562306a36Sopenharmony_ci	pdata->am_reduction_mode =
107662306a36Sopenharmony_ci		of_property_read_bool(np, "st,am-reduction-mode");
107762306a36Sopenharmony_ci	pdata->odd_pwm_speed_mode =
107862306a36Sopenharmony_ci		of_property_read_bool(np, "st,odd-pwm-speed-mode");
107962306a36Sopenharmony_ci
108062306a36Sopenharmony_ci	/* CONFF */
108162306a36Sopenharmony_ci	pdata->invalid_input_detect_mute =
108262306a36Sopenharmony_ci		of_property_read_bool(np, "st,invalid-input-detect-mute");
108362306a36Sopenharmony_ci
108462306a36Sopenharmony_ci	sta32x->pdata = pdata;
108562306a36Sopenharmony_ci
108662306a36Sopenharmony_ci	return 0;
108762306a36Sopenharmony_ci}
108862306a36Sopenharmony_ci#endif
108962306a36Sopenharmony_ci
109062306a36Sopenharmony_cistatic int sta32x_i2c_probe(struct i2c_client *i2c)
109162306a36Sopenharmony_ci{
109262306a36Sopenharmony_ci	struct device *dev = &i2c->dev;
109362306a36Sopenharmony_ci	struct sta32x_priv *sta32x;
109462306a36Sopenharmony_ci	int ret, i;
109562306a36Sopenharmony_ci
109662306a36Sopenharmony_ci	sta32x = devm_kzalloc(&i2c->dev, sizeof(struct sta32x_priv),
109762306a36Sopenharmony_ci			      GFP_KERNEL);
109862306a36Sopenharmony_ci	if (!sta32x)
109962306a36Sopenharmony_ci		return -ENOMEM;
110062306a36Sopenharmony_ci
110162306a36Sopenharmony_ci	mutex_init(&sta32x->coeff_lock);
110262306a36Sopenharmony_ci	sta32x->pdata = dev_get_platdata(dev);
110362306a36Sopenharmony_ci
110462306a36Sopenharmony_ci#ifdef CONFIG_OF
110562306a36Sopenharmony_ci	if (dev->of_node) {
110662306a36Sopenharmony_ci		ret = sta32x_probe_dt(dev, sta32x);
110762306a36Sopenharmony_ci		if (ret < 0)
110862306a36Sopenharmony_ci			return ret;
110962306a36Sopenharmony_ci	}
111062306a36Sopenharmony_ci#endif
111162306a36Sopenharmony_ci
111262306a36Sopenharmony_ci	/* Clock */
111362306a36Sopenharmony_ci	sta32x->xti_clk = devm_clk_get(dev, "xti");
111462306a36Sopenharmony_ci	if (IS_ERR(sta32x->xti_clk)) {
111562306a36Sopenharmony_ci		ret = PTR_ERR(sta32x->xti_clk);
111662306a36Sopenharmony_ci
111762306a36Sopenharmony_ci		if (ret == -EPROBE_DEFER)
111862306a36Sopenharmony_ci			return ret;
111962306a36Sopenharmony_ci
112062306a36Sopenharmony_ci		sta32x->xti_clk = NULL;
112162306a36Sopenharmony_ci	}
112262306a36Sopenharmony_ci
112362306a36Sopenharmony_ci	/* GPIOs */
112462306a36Sopenharmony_ci	sta32x->gpiod_nreset = devm_gpiod_get_optional(dev, "reset",
112562306a36Sopenharmony_ci						       GPIOD_OUT_LOW);
112662306a36Sopenharmony_ci	if (IS_ERR(sta32x->gpiod_nreset))
112762306a36Sopenharmony_ci		return PTR_ERR(sta32x->gpiod_nreset);
112862306a36Sopenharmony_ci
112962306a36Sopenharmony_ci	/* regulators */
113062306a36Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(sta32x->supplies); i++)
113162306a36Sopenharmony_ci		sta32x->supplies[i].supply = sta32x_supply_names[i];
113262306a36Sopenharmony_ci
113362306a36Sopenharmony_ci	ret = devm_regulator_bulk_get(&i2c->dev, ARRAY_SIZE(sta32x->supplies),
113462306a36Sopenharmony_ci				      sta32x->supplies);
113562306a36Sopenharmony_ci	if (ret != 0) {
113662306a36Sopenharmony_ci		dev_err(&i2c->dev, "Failed to request supplies: %d\n", ret);
113762306a36Sopenharmony_ci		return ret;
113862306a36Sopenharmony_ci	}
113962306a36Sopenharmony_ci
114062306a36Sopenharmony_ci	sta32x->regmap = devm_regmap_init_i2c(i2c, &sta32x_regmap);
114162306a36Sopenharmony_ci	if (IS_ERR(sta32x->regmap)) {
114262306a36Sopenharmony_ci		ret = PTR_ERR(sta32x->regmap);
114362306a36Sopenharmony_ci		dev_err(dev, "Failed to init regmap: %d\n", ret);
114462306a36Sopenharmony_ci		return ret;
114562306a36Sopenharmony_ci	}
114662306a36Sopenharmony_ci
114762306a36Sopenharmony_ci	i2c_set_clientdata(i2c, sta32x);
114862306a36Sopenharmony_ci
114962306a36Sopenharmony_ci	ret = devm_snd_soc_register_component(dev, &sta32x_component,
115062306a36Sopenharmony_ci					      &sta32x_dai, 1);
115162306a36Sopenharmony_ci	if (ret < 0)
115262306a36Sopenharmony_ci		dev_err(dev, "Failed to register component (%d)\n", ret);
115362306a36Sopenharmony_ci
115462306a36Sopenharmony_ci	return ret;
115562306a36Sopenharmony_ci}
115662306a36Sopenharmony_ci
115762306a36Sopenharmony_cistatic const struct i2c_device_id sta32x_i2c_id[] = {
115862306a36Sopenharmony_ci	{ "sta326", 0 },
115962306a36Sopenharmony_ci	{ "sta328", 0 },
116062306a36Sopenharmony_ci	{ "sta329", 0 },
116162306a36Sopenharmony_ci	{ }
116262306a36Sopenharmony_ci};
116362306a36Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, sta32x_i2c_id);
116462306a36Sopenharmony_ci
116562306a36Sopenharmony_cistatic struct i2c_driver sta32x_i2c_driver = {
116662306a36Sopenharmony_ci	.driver = {
116762306a36Sopenharmony_ci		.name = "sta32x",
116862306a36Sopenharmony_ci		.of_match_table = of_match_ptr(st32x_dt_ids),
116962306a36Sopenharmony_ci	},
117062306a36Sopenharmony_ci	.probe = sta32x_i2c_probe,
117162306a36Sopenharmony_ci	.id_table = sta32x_i2c_id,
117262306a36Sopenharmony_ci};
117362306a36Sopenharmony_ci
117462306a36Sopenharmony_cimodule_i2c_driver(sta32x_i2c_driver);
117562306a36Sopenharmony_ci
117662306a36Sopenharmony_ciMODULE_DESCRIPTION("ASoC STA32X driver");
117762306a36Sopenharmony_ciMODULE_AUTHOR("Johannes Stezenbach <js@sig21.net>");
117862306a36Sopenharmony_ciMODULE_LICENSE("GPL");
1179