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