162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Codec driver for ST STA350 2.1-channel high-efficiency digital audio system 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright: 2014 Raumfeld GmbH 662306a36Sopenharmony_ci * Author: Sven Brandau <info@brandau.biz> 762306a36Sopenharmony_ci * 862306a36Sopenharmony_ci * based on code from: 962306a36Sopenharmony_ci * Raumfeld GmbH 1062306a36Sopenharmony_ci * Johannes Stezenbach <js@sig21.net> 1162306a36Sopenharmony_ci * Wolfson Microelectronics PLC. 1262306a36Sopenharmony_ci * Mark Brown <broonie@opensource.wolfsonmicro.com> 1362306a36Sopenharmony_ci * Freescale Semiconductor, Inc. 1462306a36Sopenharmony_ci * Timur Tabi <timur@freescale.com> 1562306a36Sopenharmony_ci */ 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_ci#define pr_fmt(fmt) KBUILD_MODNAME ":%s:%d: " fmt, __func__, __LINE__ 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ci#include <linux/module.h> 2062306a36Sopenharmony_ci#include <linux/moduleparam.h> 2162306a36Sopenharmony_ci#include <linux/init.h> 2262306a36Sopenharmony_ci#include <linux/delay.h> 2362306a36Sopenharmony_ci#include <linux/pm.h> 2462306a36Sopenharmony_ci#include <linux/i2c.h> 2562306a36Sopenharmony_ci#include <linux/of_device.h> 2662306a36Sopenharmony_ci#include <linux/of_gpio.h> 2762306a36Sopenharmony_ci#include <linux/regmap.h> 2862306a36Sopenharmony_ci#include <linux/regulator/consumer.h> 2962306a36Sopenharmony_ci#include <linux/gpio/consumer.h> 3062306a36Sopenharmony_ci#include <linux/slab.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/sta350.h> 4062306a36Sopenharmony_ci#include "sta350.h" 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_ci#define STA350_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 STA350_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 sta350_regs[] = { 5762306a36Sopenharmony_ci { 0x0, 0x63 }, 5862306a36Sopenharmony_ci { 0x1, 0x80 }, 5962306a36Sopenharmony_ci { 0x2, 0xdf }, 6062306a36Sopenharmony_ci { 0x3, 0x40 }, 6162306a36Sopenharmony_ci { 0x4, 0xc2 }, 6262306a36Sopenharmony_ci { 0x5, 0x5c }, 6362306a36Sopenharmony_ci { 0x6, 0x00 }, 6462306a36Sopenharmony_ci { 0x7, 0xff }, 6562306a36Sopenharmony_ci { 0x8, 0x60 }, 6662306a36Sopenharmony_ci { 0x9, 0x60 }, 6762306a36Sopenharmony_ci { 0xa, 0x60 }, 6862306a36Sopenharmony_ci { 0xb, 0x00 }, 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, 0x2a }, 9762306a36Sopenharmony_ci { 0x28, 0xc0 }, 9862306a36Sopenharmony_ci { 0x29, 0xf3 }, 9962306a36Sopenharmony_ci { 0x2a, 0x33 }, 10062306a36Sopenharmony_ci { 0x2b, 0x00 }, 10162306a36Sopenharmony_ci { 0x2c, 0x0c }, 10262306a36Sopenharmony_ci { 0x31, 0x00 }, 10362306a36Sopenharmony_ci { 0x36, 0x00 }, 10462306a36Sopenharmony_ci { 0x37, 0x00 }, 10562306a36Sopenharmony_ci { 0x38, 0x00 }, 10662306a36Sopenharmony_ci { 0x39, 0x01 }, 10762306a36Sopenharmony_ci { 0x3a, 0xee }, 10862306a36Sopenharmony_ci { 0x3b, 0xff }, 10962306a36Sopenharmony_ci { 0x3c, 0x7e }, 11062306a36Sopenharmony_ci { 0x3d, 0xc0 }, 11162306a36Sopenharmony_ci { 0x3e, 0x26 }, 11262306a36Sopenharmony_ci { 0x3f, 0x00 }, 11362306a36Sopenharmony_ci { 0x48, 0x00 }, 11462306a36Sopenharmony_ci { 0x49, 0x00 }, 11562306a36Sopenharmony_ci { 0x4a, 0x00 }, 11662306a36Sopenharmony_ci { 0x4b, 0x04 }, 11762306a36Sopenharmony_ci { 0x4c, 0x00 }, 11862306a36Sopenharmony_ci}; 11962306a36Sopenharmony_ci 12062306a36Sopenharmony_cistatic const struct regmap_range sta350_write_regs_range[] = { 12162306a36Sopenharmony_ci regmap_reg_range(STA350_CONFA, STA350_AUTO2), 12262306a36Sopenharmony_ci regmap_reg_range(STA350_C1CFG, STA350_FDRC2), 12362306a36Sopenharmony_ci regmap_reg_range(STA350_EQCFG, STA350_EVOLRES), 12462306a36Sopenharmony_ci regmap_reg_range(STA350_NSHAPE, STA350_MISC2), 12562306a36Sopenharmony_ci}; 12662306a36Sopenharmony_ci 12762306a36Sopenharmony_cistatic const struct regmap_range sta350_read_regs_range[] = { 12862306a36Sopenharmony_ci regmap_reg_range(STA350_CONFA, STA350_AUTO2), 12962306a36Sopenharmony_ci regmap_reg_range(STA350_C1CFG, STA350_STATUS), 13062306a36Sopenharmony_ci regmap_reg_range(STA350_EQCFG, STA350_EVOLRES), 13162306a36Sopenharmony_ci regmap_reg_range(STA350_NSHAPE, STA350_MISC2), 13262306a36Sopenharmony_ci}; 13362306a36Sopenharmony_ci 13462306a36Sopenharmony_cistatic const struct regmap_range sta350_volatile_regs_range[] = { 13562306a36Sopenharmony_ci regmap_reg_range(STA350_CFADDR2, STA350_CFUD), 13662306a36Sopenharmony_ci regmap_reg_range(STA350_STATUS, STA350_STATUS), 13762306a36Sopenharmony_ci}; 13862306a36Sopenharmony_ci 13962306a36Sopenharmony_cistatic const struct regmap_access_table sta350_write_regs = { 14062306a36Sopenharmony_ci .yes_ranges = sta350_write_regs_range, 14162306a36Sopenharmony_ci .n_yes_ranges = ARRAY_SIZE(sta350_write_regs_range), 14262306a36Sopenharmony_ci}; 14362306a36Sopenharmony_ci 14462306a36Sopenharmony_cistatic const struct regmap_access_table sta350_read_regs = { 14562306a36Sopenharmony_ci .yes_ranges = sta350_read_regs_range, 14662306a36Sopenharmony_ci .n_yes_ranges = ARRAY_SIZE(sta350_read_regs_range), 14762306a36Sopenharmony_ci}; 14862306a36Sopenharmony_ci 14962306a36Sopenharmony_cistatic const struct regmap_access_table sta350_volatile_regs = { 15062306a36Sopenharmony_ci .yes_ranges = sta350_volatile_regs_range, 15162306a36Sopenharmony_ci .n_yes_ranges = ARRAY_SIZE(sta350_volatile_regs_range), 15262306a36Sopenharmony_ci}; 15362306a36Sopenharmony_ci 15462306a36Sopenharmony_ci/* regulator power supply names */ 15562306a36Sopenharmony_cistatic const char * const sta350_supply_names[] = { 15662306a36Sopenharmony_ci "vdd-dig", /* digital supply, 3.3V */ 15762306a36Sopenharmony_ci "vdd-pll", /* pll supply, 3.3V */ 15862306a36Sopenharmony_ci "vcc" /* power amp supply, 5V - 26V */ 15962306a36Sopenharmony_ci}; 16062306a36Sopenharmony_ci 16162306a36Sopenharmony_ci/* codec private data */ 16262306a36Sopenharmony_cistruct sta350_priv { 16362306a36Sopenharmony_ci struct regmap *regmap; 16462306a36Sopenharmony_ci struct regulator_bulk_data supplies[ARRAY_SIZE(sta350_supply_names)]; 16562306a36Sopenharmony_ci struct sta350_platform_data *pdata; 16662306a36Sopenharmony_ci 16762306a36Sopenharmony_ci unsigned int mclk; 16862306a36Sopenharmony_ci unsigned int format; 16962306a36Sopenharmony_ci 17062306a36Sopenharmony_ci u32 coef_shadow[STA350_COEF_COUNT]; 17162306a36Sopenharmony_ci int shutdown; 17262306a36Sopenharmony_ci 17362306a36Sopenharmony_ci struct gpio_desc *gpiod_nreset; 17462306a36Sopenharmony_ci struct gpio_desc *gpiod_power_down; 17562306a36Sopenharmony_ci 17662306a36Sopenharmony_ci struct mutex coeff_lock; 17762306a36Sopenharmony_ci}; 17862306a36Sopenharmony_ci 17962306a36Sopenharmony_cistatic const DECLARE_TLV_DB_SCALE(mvol_tlv, -12750, 50, 1); 18062306a36Sopenharmony_cistatic const DECLARE_TLV_DB_SCALE(chvol_tlv, -7950, 50, 1); 18162306a36Sopenharmony_cistatic const DECLARE_TLV_DB_SCALE(tone_tlv, -1200, 200, 0); 18262306a36Sopenharmony_ci 18362306a36Sopenharmony_cistatic const char * const sta350_drc_ac[] = { 18462306a36Sopenharmony_ci "Anti-Clipping", "Dynamic Range Compression" 18562306a36Sopenharmony_ci}; 18662306a36Sopenharmony_cistatic const char * const sta350_auto_gc_mode[] = { 18762306a36Sopenharmony_ci "User", "AC no clipping", "AC limited clipping (10%)", 18862306a36Sopenharmony_ci "DRC nighttime listening mode" 18962306a36Sopenharmony_ci}; 19062306a36Sopenharmony_cistatic const char * const sta350_auto_xo_mode[] = { 19162306a36Sopenharmony_ci "User", "80Hz", "100Hz", "120Hz", "140Hz", "160Hz", "180Hz", 19262306a36Sopenharmony_ci "200Hz", "220Hz", "240Hz", "260Hz", "280Hz", "300Hz", "320Hz", 19362306a36Sopenharmony_ci "340Hz", "360Hz" 19462306a36Sopenharmony_ci}; 19562306a36Sopenharmony_cistatic const char * const sta350_binary_output[] = { 19662306a36Sopenharmony_ci "FFX 3-state output - normal operation", "Binary output" 19762306a36Sopenharmony_ci}; 19862306a36Sopenharmony_cistatic const char * const sta350_limiter_select[] = { 19962306a36Sopenharmony_ci "Limiter Disabled", "Limiter #1", "Limiter #2" 20062306a36Sopenharmony_ci}; 20162306a36Sopenharmony_cistatic const char * const sta350_limiter_attack_rate[] = { 20262306a36Sopenharmony_ci "3.1584", "2.7072", "2.2560", "1.8048", "1.3536", "0.9024", 20362306a36Sopenharmony_ci "0.4512", "0.2256", "0.1504", "0.1123", "0.0902", "0.0752", 20462306a36Sopenharmony_ci "0.0645", "0.0564", "0.0501", "0.0451" 20562306a36Sopenharmony_ci}; 20662306a36Sopenharmony_cistatic const char * const sta350_limiter_release_rate[] = { 20762306a36Sopenharmony_ci "0.5116", "0.1370", "0.0744", "0.0499", "0.0360", "0.0299", 20862306a36Sopenharmony_ci "0.0264", "0.0208", "0.0198", "0.0172", "0.0147", "0.0137", 20962306a36Sopenharmony_ci "0.0134", "0.0117", "0.0110", "0.0104" 21062306a36Sopenharmony_ci}; 21162306a36Sopenharmony_cistatic const char * const sta350_noise_shaper_type[] = { 21262306a36Sopenharmony_ci "Third order", "Fourth order" 21362306a36Sopenharmony_ci}; 21462306a36Sopenharmony_ci 21562306a36Sopenharmony_cistatic DECLARE_TLV_DB_RANGE(sta350_limiter_ac_attack_tlv, 21662306a36Sopenharmony_ci 0, 7, TLV_DB_SCALE_ITEM(-1200, 200, 0), 21762306a36Sopenharmony_ci 8, 16, TLV_DB_SCALE_ITEM(300, 100, 0), 21862306a36Sopenharmony_ci); 21962306a36Sopenharmony_ci 22062306a36Sopenharmony_cistatic DECLARE_TLV_DB_RANGE(sta350_limiter_ac_release_tlv, 22162306a36Sopenharmony_ci 0, 0, TLV_DB_SCALE_ITEM(TLV_DB_GAIN_MUTE, 0, 0), 22262306a36Sopenharmony_ci 1, 1, TLV_DB_SCALE_ITEM(-2900, 0, 0), 22362306a36Sopenharmony_ci 2, 2, TLV_DB_SCALE_ITEM(-2000, 0, 0), 22462306a36Sopenharmony_ci 3, 8, TLV_DB_SCALE_ITEM(-1400, 200, 0), 22562306a36Sopenharmony_ci 8, 16, TLV_DB_SCALE_ITEM(-700, 100, 0), 22662306a36Sopenharmony_ci); 22762306a36Sopenharmony_ci 22862306a36Sopenharmony_cistatic DECLARE_TLV_DB_RANGE(sta350_limiter_drc_attack_tlv, 22962306a36Sopenharmony_ci 0, 7, TLV_DB_SCALE_ITEM(-3100, 200, 0), 23062306a36Sopenharmony_ci 8, 13, TLV_DB_SCALE_ITEM(-1600, 100, 0), 23162306a36Sopenharmony_ci 14, 16, TLV_DB_SCALE_ITEM(-1000, 300, 0), 23262306a36Sopenharmony_ci); 23362306a36Sopenharmony_ci 23462306a36Sopenharmony_cistatic DECLARE_TLV_DB_RANGE(sta350_limiter_drc_release_tlv, 23562306a36Sopenharmony_ci 0, 0, TLV_DB_SCALE_ITEM(TLV_DB_GAIN_MUTE, 0, 0), 23662306a36Sopenharmony_ci 1, 2, TLV_DB_SCALE_ITEM(-3800, 200, 0), 23762306a36Sopenharmony_ci 3, 4, TLV_DB_SCALE_ITEM(-3300, 200, 0), 23862306a36Sopenharmony_ci 5, 12, TLV_DB_SCALE_ITEM(-3000, 200, 0), 23962306a36Sopenharmony_ci 13, 16, TLV_DB_SCALE_ITEM(-1500, 300, 0), 24062306a36Sopenharmony_ci); 24162306a36Sopenharmony_ci 24262306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_drc_ac_enum, 24362306a36Sopenharmony_ci STA350_CONFD, STA350_CONFD_DRC_SHIFT, 24462306a36Sopenharmony_ci sta350_drc_ac); 24562306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_noise_shaper_enum, 24662306a36Sopenharmony_ci STA350_CONFE, STA350_CONFE_NSBW_SHIFT, 24762306a36Sopenharmony_ci sta350_noise_shaper_type); 24862306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_auto_gc_enum, 24962306a36Sopenharmony_ci STA350_AUTO1, STA350_AUTO1_AMGC_SHIFT, 25062306a36Sopenharmony_ci sta350_auto_gc_mode); 25162306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_auto_xo_enum, 25262306a36Sopenharmony_ci STA350_AUTO2, STA350_AUTO2_XO_SHIFT, 25362306a36Sopenharmony_ci sta350_auto_xo_mode); 25462306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_binary_output_ch1_enum, 25562306a36Sopenharmony_ci STA350_C1CFG, STA350_CxCFG_BO_SHIFT, 25662306a36Sopenharmony_ci sta350_binary_output); 25762306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_binary_output_ch2_enum, 25862306a36Sopenharmony_ci STA350_C2CFG, STA350_CxCFG_BO_SHIFT, 25962306a36Sopenharmony_ci sta350_binary_output); 26062306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_binary_output_ch3_enum, 26162306a36Sopenharmony_ci STA350_C3CFG, STA350_CxCFG_BO_SHIFT, 26262306a36Sopenharmony_ci sta350_binary_output); 26362306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_limiter_ch1_enum, 26462306a36Sopenharmony_ci STA350_C1CFG, STA350_CxCFG_LS_SHIFT, 26562306a36Sopenharmony_ci sta350_limiter_select); 26662306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_limiter_ch2_enum, 26762306a36Sopenharmony_ci STA350_C2CFG, STA350_CxCFG_LS_SHIFT, 26862306a36Sopenharmony_ci sta350_limiter_select); 26962306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_limiter_ch3_enum, 27062306a36Sopenharmony_ci STA350_C3CFG, STA350_CxCFG_LS_SHIFT, 27162306a36Sopenharmony_ci sta350_limiter_select); 27262306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_limiter1_attack_rate_enum, 27362306a36Sopenharmony_ci STA350_L1AR, STA350_LxA_SHIFT, 27462306a36Sopenharmony_ci sta350_limiter_attack_rate); 27562306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_limiter2_attack_rate_enum, 27662306a36Sopenharmony_ci STA350_L2AR, STA350_LxA_SHIFT, 27762306a36Sopenharmony_ci sta350_limiter_attack_rate); 27862306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_limiter1_release_rate_enum, 27962306a36Sopenharmony_ci STA350_L1AR, STA350_LxR_SHIFT, 28062306a36Sopenharmony_ci sta350_limiter_release_rate); 28162306a36Sopenharmony_cistatic SOC_ENUM_SINGLE_DECL(sta350_limiter2_release_rate_enum, 28262306a36Sopenharmony_ci STA350_L2AR, STA350_LxR_SHIFT, 28362306a36Sopenharmony_ci sta350_limiter_release_rate); 28462306a36Sopenharmony_ci 28562306a36Sopenharmony_ci/* 28662306a36Sopenharmony_ci * byte array controls for setting biquad, mixer, scaling coefficients; 28762306a36Sopenharmony_ci * for biquads all five coefficients need to be set in one go, 28862306a36Sopenharmony_ci * mixer and pre/postscale coefs can be set individually; 28962306a36Sopenharmony_ci * each coef is 24bit, the bytes are ordered in the same way 29062306a36Sopenharmony_ci * as given in the STA350 data sheet (big endian; b1, b2, a1, a2, b0) 29162306a36Sopenharmony_ci */ 29262306a36Sopenharmony_ci 29362306a36Sopenharmony_cistatic int sta350_coefficient_info(struct snd_kcontrol *kcontrol, 29462306a36Sopenharmony_ci struct snd_ctl_elem_info *uinfo) 29562306a36Sopenharmony_ci{ 29662306a36Sopenharmony_ci int numcoef = kcontrol->private_value >> 16; 29762306a36Sopenharmony_ci uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES; 29862306a36Sopenharmony_ci uinfo->count = 3 * numcoef; 29962306a36Sopenharmony_ci return 0; 30062306a36Sopenharmony_ci} 30162306a36Sopenharmony_ci 30262306a36Sopenharmony_cistatic int sta350_coefficient_get(struct snd_kcontrol *kcontrol, 30362306a36Sopenharmony_ci struct snd_ctl_elem_value *ucontrol) 30462306a36Sopenharmony_ci{ 30562306a36Sopenharmony_ci struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 30662306a36Sopenharmony_ci struct sta350_priv *sta350 = snd_soc_component_get_drvdata(component); 30762306a36Sopenharmony_ci int numcoef = kcontrol->private_value >> 16; 30862306a36Sopenharmony_ci int index = kcontrol->private_value & 0xffff; 30962306a36Sopenharmony_ci unsigned int cfud, val; 31062306a36Sopenharmony_ci int i, ret = 0; 31162306a36Sopenharmony_ci 31262306a36Sopenharmony_ci mutex_lock(&sta350->coeff_lock); 31362306a36Sopenharmony_ci 31462306a36Sopenharmony_ci /* preserve reserved bits in STA350_CFUD */ 31562306a36Sopenharmony_ci regmap_read(sta350->regmap, STA350_CFUD, &cfud); 31662306a36Sopenharmony_ci cfud &= 0xf0; 31762306a36Sopenharmony_ci /* 31862306a36Sopenharmony_ci * chip documentation does not say if the bits are self clearing, 31962306a36Sopenharmony_ci * so do it explicitly 32062306a36Sopenharmony_ci */ 32162306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_CFUD, cfud); 32262306a36Sopenharmony_ci 32362306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_CFADDR2, index); 32462306a36Sopenharmony_ci if (numcoef == 1) { 32562306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_CFUD, cfud | 0x04); 32662306a36Sopenharmony_ci } else if (numcoef == 5) { 32762306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_CFUD, cfud | 0x08); 32862306a36Sopenharmony_ci } else { 32962306a36Sopenharmony_ci ret = -EINVAL; 33062306a36Sopenharmony_ci goto exit_unlock; 33162306a36Sopenharmony_ci } 33262306a36Sopenharmony_ci 33362306a36Sopenharmony_ci for (i = 0; i < 3 * numcoef; i++) { 33462306a36Sopenharmony_ci regmap_read(sta350->regmap, STA350_B1CF1 + i, &val); 33562306a36Sopenharmony_ci ucontrol->value.bytes.data[i] = val; 33662306a36Sopenharmony_ci } 33762306a36Sopenharmony_ci 33862306a36Sopenharmony_ciexit_unlock: 33962306a36Sopenharmony_ci mutex_unlock(&sta350->coeff_lock); 34062306a36Sopenharmony_ci 34162306a36Sopenharmony_ci return ret; 34262306a36Sopenharmony_ci} 34362306a36Sopenharmony_ci 34462306a36Sopenharmony_cistatic int sta350_coefficient_put(struct snd_kcontrol *kcontrol, 34562306a36Sopenharmony_ci struct snd_ctl_elem_value *ucontrol) 34662306a36Sopenharmony_ci{ 34762306a36Sopenharmony_ci struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 34862306a36Sopenharmony_ci struct sta350_priv *sta350 = snd_soc_component_get_drvdata(component); 34962306a36Sopenharmony_ci int numcoef = kcontrol->private_value >> 16; 35062306a36Sopenharmony_ci int index = kcontrol->private_value & 0xffff; 35162306a36Sopenharmony_ci unsigned int cfud; 35262306a36Sopenharmony_ci int i; 35362306a36Sopenharmony_ci 35462306a36Sopenharmony_ci /* preserve reserved bits in STA350_CFUD */ 35562306a36Sopenharmony_ci regmap_read(sta350->regmap, STA350_CFUD, &cfud); 35662306a36Sopenharmony_ci cfud &= 0xf0; 35762306a36Sopenharmony_ci /* 35862306a36Sopenharmony_ci * chip documentation does not say if the bits are self clearing, 35962306a36Sopenharmony_ci * so do it explicitly 36062306a36Sopenharmony_ci */ 36162306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_CFUD, cfud); 36262306a36Sopenharmony_ci 36362306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_CFADDR2, index); 36462306a36Sopenharmony_ci for (i = 0; i < numcoef && (index + i < STA350_COEF_COUNT); i++) 36562306a36Sopenharmony_ci sta350->coef_shadow[index + i] = 36662306a36Sopenharmony_ci (ucontrol->value.bytes.data[3 * i] << 16) 36762306a36Sopenharmony_ci | (ucontrol->value.bytes.data[3 * i + 1] << 8) 36862306a36Sopenharmony_ci | (ucontrol->value.bytes.data[3 * i + 2]); 36962306a36Sopenharmony_ci for (i = 0; i < 3 * numcoef; i++) 37062306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_B1CF1 + i, 37162306a36Sopenharmony_ci ucontrol->value.bytes.data[i]); 37262306a36Sopenharmony_ci if (numcoef == 1) 37362306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_CFUD, cfud | 0x01); 37462306a36Sopenharmony_ci else if (numcoef == 5) 37562306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_CFUD, cfud | 0x02); 37662306a36Sopenharmony_ci else 37762306a36Sopenharmony_ci return -EINVAL; 37862306a36Sopenharmony_ci 37962306a36Sopenharmony_ci return 0; 38062306a36Sopenharmony_ci} 38162306a36Sopenharmony_ci 38262306a36Sopenharmony_cistatic int sta350_sync_coef_shadow(struct snd_soc_component *component) 38362306a36Sopenharmony_ci{ 38462306a36Sopenharmony_ci struct sta350_priv *sta350 = snd_soc_component_get_drvdata(component); 38562306a36Sopenharmony_ci unsigned int cfud; 38662306a36Sopenharmony_ci int i; 38762306a36Sopenharmony_ci 38862306a36Sopenharmony_ci /* preserve reserved bits in STA350_CFUD */ 38962306a36Sopenharmony_ci regmap_read(sta350->regmap, STA350_CFUD, &cfud); 39062306a36Sopenharmony_ci cfud &= 0xf0; 39162306a36Sopenharmony_ci 39262306a36Sopenharmony_ci for (i = 0; i < STA350_COEF_COUNT; i++) { 39362306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_CFADDR2, i); 39462306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_B1CF1, 39562306a36Sopenharmony_ci (sta350->coef_shadow[i] >> 16) & 0xff); 39662306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_B1CF2, 39762306a36Sopenharmony_ci (sta350->coef_shadow[i] >> 8) & 0xff); 39862306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_B1CF3, 39962306a36Sopenharmony_ci (sta350->coef_shadow[i]) & 0xff); 40062306a36Sopenharmony_ci /* 40162306a36Sopenharmony_ci * chip documentation does not say if the bits are 40262306a36Sopenharmony_ci * self-clearing, so do it explicitly 40362306a36Sopenharmony_ci */ 40462306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_CFUD, cfud); 40562306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_CFUD, cfud | 0x01); 40662306a36Sopenharmony_ci } 40762306a36Sopenharmony_ci return 0; 40862306a36Sopenharmony_ci} 40962306a36Sopenharmony_ci 41062306a36Sopenharmony_cistatic int sta350_cache_sync(struct snd_soc_component *component) 41162306a36Sopenharmony_ci{ 41262306a36Sopenharmony_ci struct sta350_priv *sta350 = snd_soc_component_get_drvdata(component); 41362306a36Sopenharmony_ci unsigned int mute; 41462306a36Sopenharmony_ci int rc; 41562306a36Sopenharmony_ci 41662306a36Sopenharmony_ci /* mute during register sync */ 41762306a36Sopenharmony_ci regmap_read(sta350->regmap, STA350_CFUD, &mute); 41862306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_MMUTE, mute | STA350_MMUTE_MMUTE); 41962306a36Sopenharmony_ci sta350_sync_coef_shadow(component); 42062306a36Sopenharmony_ci rc = regcache_sync(sta350->regmap); 42162306a36Sopenharmony_ci regmap_write(sta350->regmap, STA350_MMUTE, mute); 42262306a36Sopenharmony_ci return rc; 42362306a36Sopenharmony_ci} 42462306a36Sopenharmony_ci 42562306a36Sopenharmony_ci#define SINGLE_COEF(xname, index) \ 42662306a36Sopenharmony_ci{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \ 42762306a36Sopenharmony_ci .info = sta350_coefficient_info, \ 42862306a36Sopenharmony_ci .get = sta350_coefficient_get,\ 42962306a36Sopenharmony_ci .put = sta350_coefficient_put, \ 43062306a36Sopenharmony_ci .private_value = index | (1 << 16) } 43162306a36Sopenharmony_ci 43262306a36Sopenharmony_ci#define BIQUAD_COEFS(xname, index) \ 43362306a36Sopenharmony_ci{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \ 43462306a36Sopenharmony_ci .info = sta350_coefficient_info, \ 43562306a36Sopenharmony_ci .get = sta350_coefficient_get,\ 43662306a36Sopenharmony_ci .put = sta350_coefficient_put, \ 43762306a36Sopenharmony_ci .private_value = index | (5 << 16) } 43862306a36Sopenharmony_ci 43962306a36Sopenharmony_cistatic const struct snd_kcontrol_new sta350_snd_controls[] = { 44062306a36Sopenharmony_ciSOC_SINGLE_TLV("Master Volume", STA350_MVOL, 0, 0xff, 1, mvol_tlv), 44162306a36Sopenharmony_ci/* VOL */ 44262306a36Sopenharmony_ciSOC_SINGLE_TLV("Ch1 Volume", STA350_C1VOL, 0, 0xff, 1, chvol_tlv), 44362306a36Sopenharmony_ciSOC_SINGLE_TLV("Ch2 Volume", STA350_C2VOL, 0, 0xff, 1, chvol_tlv), 44462306a36Sopenharmony_ciSOC_SINGLE_TLV("Ch3 Volume", STA350_C3VOL, 0, 0xff, 1, chvol_tlv), 44562306a36Sopenharmony_ci/* CONFD */ 44662306a36Sopenharmony_ciSOC_SINGLE("High Pass Filter Bypass Switch", 44762306a36Sopenharmony_ci STA350_CONFD, STA350_CONFD_HPB_SHIFT, 1, 1), 44862306a36Sopenharmony_ciSOC_SINGLE("De-emphasis Filter Switch", 44962306a36Sopenharmony_ci STA350_CONFD, STA350_CONFD_DEMP_SHIFT, 1, 0), 45062306a36Sopenharmony_ciSOC_SINGLE("DSP Bypass Switch", 45162306a36Sopenharmony_ci STA350_CONFD, STA350_CONFD_DSPB_SHIFT, 1, 0), 45262306a36Sopenharmony_ciSOC_SINGLE("Post-scale Link Switch", 45362306a36Sopenharmony_ci STA350_CONFD, STA350_CONFD_PSL_SHIFT, 1, 0), 45462306a36Sopenharmony_ciSOC_SINGLE("Biquad Coefficient Link Switch", 45562306a36Sopenharmony_ci STA350_CONFD, STA350_CONFD_BQL_SHIFT, 1, 0), 45662306a36Sopenharmony_ciSOC_ENUM("Compressor/Limiter Switch", sta350_drc_ac_enum), 45762306a36Sopenharmony_ciSOC_ENUM("Noise Shaper Bandwidth", sta350_noise_shaper_enum), 45862306a36Sopenharmony_ciSOC_SINGLE("Zero-detect Mute Enable Switch", 45962306a36Sopenharmony_ci STA350_CONFD, STA350_CONFD_ZDE_SHIFT, 1, 0), 46062306a36Sopenharmony_ciSOC_SINGLE("Submix Mode Switch", 46162306a36Sopenharmony_ci STA350_CONFD, STA350_CONFD_SME_SHIFT, 1, 0), 46262306a36Sopenharmony_ci/* CONFE */ 46362306a36Sopenharmony_ciSOC_SINGLE("Zero Cross Switch", STA350_CONFE, STA350_CONFE_ZCE_SHIFT, 1, 0), 46462306a36Sopenharmony_ciSOC_SINGLE("Soft Ramp Switch", STA350_CONFE, STA350_CONFE_SVE_SHIFT, 1, 0), 46562306a36Sopenharmony_ci/* MUTE */ 46662306a36Sopenharmony_ciSOC_SINGLE("Master Switch", STA350_MMUTE, STA350_MMUTE_MMUTE_SHIFT, 1, 1), 46762306a36Sopenharmony_ciSOC_SINGLE("Ch1 Switch", STA350_MMUTE, STA350_MMUTE_C1M_SHIFT, 1, 1), 46862306a36Sopenharmony_ciSOC_SINGLE("Ch2 Switch", STA350_MMUTE, STA350_MMUTE_C2M_SHIFT, 1, 1), 46962306a36Sopenharmony_ciSOC_SINGLE("Ch3 Switch", STA350_MMUTE, STA350_MMUTE_C3M_SHIFT, 1, 1), 47062306a36Sopenharmony_ci/* AUTOx */ 47162306a36Sopenharmony_ciSOC_ENUM("Automode GC", sta350_auto_gc_enum), 47262306a36Sopenharmony_ciSOC_ENUM("Automode XO", sta350_auto_xo_enum), 47362306a36Sopenharmony_ci/* CxCFG */ 47462306a36Sopenharmony_ciSOC_SINGLE("Ch1 Tone Control Bypass Switch", 47562306a36Sopenharmony_ci STA350_C1CFG, STA350_CxCFG_TCB_SHIFT, 1, 0), 47662306a36Sopenharmony_ciSOC_SINGLE("Ch2 Tone Control Bypass Switch", 47762306a36Sopenharmony_ci STA350_C2CFG, STA350_CxCFG_TCB_SHIFT, 1, 0), 47862306a36Sopenharmony_ciSOC_SINGLE("Ch1 EQ Bypass Switch", 47962306a36Sopenharmony_ci STA350_C1CFG, STA350_CxCFG_EQBP_SHIFT, 1, 0), 48062306a36Sopenharmony_ciSOC_SINGLE("Ch2 EQ Bypass Switch", 48162306a36Sopenharmony_ci STA350_C2CFG, STA350_CxCFG_EQBP_SHIFT, 1, 0), 48262306a36Sopenharmony_ciSOC_SINGLE("Ch1 Master Volume Bypass Switch", 48362306a36Sopenharmony_ci STA350_C1CFG, STA350_CxCFG_VBP_SHIFT, 1, 0), 48462306a36Sopenharmony_ciSOC_SINGLE("Ch2 Master Volume Bypass Switch", 48562306a36Sopenharmony_ci STA350_C1CFG, STA350_CxCFG_VBP_SHIFT, 1, 0), 48662306a36Sopenharmony_ciSOC_SINGLE("Ch3 Master Volume Bypass Switch", 48762306a36Sopenharmony_ci STA350_C1CFG, STA350_CxCFG_VBP_SHIFT, 1, 0), 48862306a36Sopenharmony_ciSOC_ENUM("Ch1 Binary Output Select", sta350_binary_output_ch1_enum), 48962306a36Sopenharmony_ciSOC_ENUM("Ch2 Binary Output Select", sta350_binary_output_ch2_enum), 49062306a36Sopenharmony_ciSOC_ENUM("Ch3 Binary Output Select", sta350_binary_output_ch3_enum), 49162306a36Sopenharmony_ciSOC_ENUM("Ch1 Limiter Select", sta350_limiter_ch1_enum), 49262306a36Sopenharmony_ciSOC_ENUM("Ch2 Limiter Select", sta350_limiter_ch2_enum), 49362306a36Sopenharmony_ciSOC_ENUM("Ch3 Limiter Select", sta350_limiter_ch3_enum), 49462306a36Sopenharmony_ci/* TONE */ 49562306a36Sopenharmony_ciSOC_SINGLE_RANGE_TLV("Bass Tone Control Volume", 49662306a36Sopenharmony_ci STA350_TONE, STA350_TONE_BTC_SHIFT, 1, 13, 0, tone_tlv), 49762306a36Sopenharmony_ciSOC_SINGLE_RANGE_TLV("Treble Tone Control Volume", 49862306a36Sopenharmony_ci STA350_TONE, STA350_TONE_TTC_SHIFT, 1, 13, 0, tone_tlv), 49962306a36Sopenharmony_ciSOC_ENUM("Limiter1 Attack Rate (dB/ms)", sta350_limiter1_attack_rate_enum), 50062306a36Sopenharmony_ciSOC_ENUM("Limiter2 Attack Rate (dB/ms)", sta350_limiter2_attack_rate_enum), 50162306a36Sopenharmony_ciSOC_ENUM("Limiter1 Release Rate (dB/ms)", sta350_limiter1_release_rate_enum), 50262306a36Sopenharmony_ciSOC_ENUM("Limiter2 Release Rate (dB/ms)", sta350_limiter2_release_rate_enum), 50362306a36Sopenharmony_ci 50462306a36Sopenharmony_ci/* 50562306a36Sopenharmony_ci * depending on mode, the attack/release thresholds have 50662306a36Sopenharmony_ci * two different enum definitions; provide both 50762306a36Sopenharmony_ci */ 50862306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter1 Attack Threshold (AC Mode)", 50962306a36Sopenharmony_ci STA350_L1ATRT, STA350_LxA_SHIFT, 51062306a36Sopenharmony_ci 16, 0, sta350_limiter_ac_attack_tlv), 51162306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter2 Attack Threshold (AC Mode)", 51262306a36Sopenharmony_ci STA350_L2ATRT, STA350_LxA_SHIFT, 51362306a36Sopenharmony_ci 16, 0, sta350_limiter_ac_attack_tlv), 51462306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter1 Release Threshold (AC Mode)", 51562306a36Sopenharmony_ci STA350_L1ATRT, STA350_LxR_SHIFT, 51662306a36Sopenharmony_ci 16, 0, sta350_limiter_ac_release_tlv), 51762306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter2 Release Threshold (AC Mode)", 51862306a36Sopenharmony_ci STA350_L2ATRT, STA350_LxR_SHIFT, 51962306a36Sopenharmony_ci 16, 0, sta350_limiter_ac_release_tlv), 52062306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter1 Attack Threshold (DRC Mode)", 52162306a36Sopenharmony_ci STA350_L1ATRT, STA350_LxA_SHIFT, 52262306a36Sopenharmony_ci 16, 0, sta350_limiter_drc_attack_tlv), 52362306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter2 Attack Threshold (DRC Mode)", 52462306a36Sopenharmony_ci STA350_L2ATRT, STA350_LxA_SHIFT, 52562306a36Sopenharmony_ci 16, 0, sta350_limiter_drc_attack_tlv), 52662306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter1 Release Threshold (DRC Mode)", 52762306a36Sopenharmony_ci STA350_L1ATRT, STA350_LxR_SHIFT, 52862306a36Sopenharmony_ci 16, 0, sta350_limiter_drc_release_tlv), 52962306a36Sopenharmony_ciSOC_SINGLE_TLV("Limiter2 Release Threshold (DRC Mode)", 53062306a36Sopenharmony_ci STA350_L2ATRT, STA350_LxR_SHIFT, 53162306a36Sopenharmony_ci 16, 0, sta350_limiter_drc_release_tlv), 53262306a36Sopenharmony_ci 53362306a36Sopenharmony_ciBIQUAD_COEFS("Ch1 - Biquad 1", 0), 53462306a36Sopenharmony_ciBIQUAD_COEFS("Ch1 - Biquad 2", 5), 53562306a36Sopenharmony_ciBIQUAD_COEFS("Ch1 - Biquad 3", 10), 53662306a36Sopenharmony_ciBIQUAD_COEFS("Ch1 - Biquad 4", 15), 53762306a36Sopenharmony_ciBIQUAD_COEFS("Ch2 - Biquad 1", 20), 53862306a36Sopenharmony_ciBIQUAD_COEFS("Ch2 - Biquad 2", 25), 53962306a36Sopenharmony_ciBIQUAD_COEFS("Ch2 - Biquad 3", 30), 54062306a36Sopenharmony_ciBIQUAD_COEFS("Ch2 - Biquad 4", 35), 54162306a36Sopenharmony_ciBIQUAD_COEFS("High-pass", 40), 54262306a36Sopenharmony_ciBIQUAD_COEFS("Low-pass", 45), 54362306a36Sopenharmony_ciSINGLE_COEF("Ch1 - Prescale", 50), 54462306a36Sopenharmony_ciSINGLE_COEF("Ch2 - Prescale", 51), 54562306a36Sopenharmony_ciSINGLE_COEF("Ch1 - Postscale", 52), 54662306a36Sopenharmony_ciSINGLE_COEF("Ch2 - Postscale", 53), 54762306a36Sopenharmony_ciSINGLE_COEF("Ch3 - Postscale", 54), 54862306a36Sopenharmony_ciSINGLE_COEF("Thermal warning - Postscale", 55), 54962306a36Sopenharmony_ciSINGLE_COEF("Ch1 - Mix 1", 56), 55062306a36Sopenharmony_ciSINGLE_COEF("Ch1 - Mix 2", 57), 55162306a36Sopenharmony_ciSINGLE_COEF("Ch2 - Mix 1", 58), 55262306a36Sopenharmony_ciSINGLE_COEF("Ch2 - Mix 2", 59), 55362306a36Sopenharmony_ciSINGLE_COEF("Ch3 - Mix 1", 60), 55462306a36Sopenharmony_ciSINGLE_COEF("Ch3 - Mix 2", 61), 55562306a36Sopenharmony_ci}; 55662306a36Sopenharmony_ci 55762306a36Sopenharmony_cistatic const struct snd_soc_dapm_widget sta350_dapm_widgets[] = { 55862306a36Sopenharmony_ciSND_SOC_DAPM_DAC("DAC", NULL, SND_SOC_NOPM, 0, 0), 55962306a36Sopenharmony_ciSND_SOC_DAPM_OUTPUT("LEFT"), 56062306a36Sopenharmony_ciSND_SOC_DAPM_OUTPUT("RIGHT"), 56162306a36Sopenharmony_ciSND_SOC_DAPM_OUTPUT("SUB"), 56262306a36Sopenharmony_ci}; 56362306a36Sopenharmony_ci 56462306a36Sopenharmony_cistatic const struct snd_soc_dapm_route sta350_dapm_routes[] = { 56562306a36Sopenharmony_ci { "LEFT", NULL, "DAC" }, 56662306a36Sopenharmony_ci { "RIGHT", NULL, "DAC" }, 56762306a36Sopenharmony_ci { "SUB", NULL, "DAC" }, 56862306a36Sopenharmony_ci { "DAC", NULL, "Playback" }, 56962306a36Sopenharmony_ci}; 57062306a36Sopenharmony_ci 57162306a36Sopenharmony_ci/* MCLK interpolation ratio per fs */ 57262306a36Sopenharmony_cistatic struct { 57362306a36Sopenharmony_ci int fs; 57462306a36Sopenharmony_ci int ir; 57562306a36Sopenharmony_ci} interpolation_ratios[] = { 57662306a36Sopenharmony_ci { 32000, 0 }, 57762306a36Sopenharmony_ci { 44100, 0 }, 57862306a36Sopenharmony_ci { 48000, 0 }, 57962306a36Sopenharmony_ci { 88200, 1 }, 58062306a36Sopenharmony_ci { 96000, 1 }, 58162306a36Sopenharmony_ci { 176400, 2 }, 58262306a36Sopenharmony_ci { 192000, 2 }, 58362306a36Sopenharmony_ci}; 58462306a36Sopenharmony_ci 58562306a36Sopenharmony_ci/* MCLK to fs clock ratios */ 58662306a36Sopenharmony_cistatic int mcs_ratio_table[3][6] = { 58762306a36Sopenharmony_ci { 768, 512, 384, 256, 128, 576 }, 58862306a36Sopenharmony_ci { 384, 256, 192, 128, 64, 0 }, 58962306a36Sopenharmony_ci { 192, 128, 96, 64, 32, 0 }, 59062306a36Sopenharmony_ci}; 59162306a36Sopenharmony_ci 59262306a36Sopenharmony_ci/** 59362306a36Sopenharmony_ci * sta350_set_dai_sysclk - configure MCLK 59462306a36Sopenharmony_ci * @codec_dai: the codec DAI 59562306a36Sopenharmony_ci * @clk_id: the clock ID (ignored) 59662306a36Sopenharmony_ci * @freq: the MCLK input frequency 59762306a36Sopenharmony_ci * @dir: the clock direction (ignored) 59862306a36Sopenharmony_ci * 59962306a36Sopenharmony_ci * The value of MCLK is used to determine which sample rates are supported 60062306a36Sopenharmony_ci * by the STA350, based on the mcs_ratio_table. 60162306a36Sopenharmony_ci * 60262306a36Sopenharmony_ci * This function must be called by the machine driver's 'startup' function, 60362306a36Sopenharmony_ci * otherwise the list of supported sample rates will not be available in 60462306a36Sopenharmony_ci * time for ALSA. 60562306a36Sopenharmony_ci */ 60662306a36Sopenharmony_cistatic int sta350_set_dai_sysclk(struct snd_soc_dai *codec_dai, 60762306a36Sopenharmony_ci int clk_id, unsigned int freq, int dir) 60862306a36Sopenharmony_ci{ 60962306a36Sopenharmony_ci struct snd_soc_component *component = codec_dai->component; 61062306a36Sopenharmony_ci struct sta350_priv *sta350 = snd_soc_component_get_drvdata(component); 61162306a36Sopenharmony_ci 61262306a36Sopenharmony_ci dev_dbg(component->dev, "mclk=%u\n", freq); 61362306a36Sopenharmony_ci sta350->mclk = freq; 61462306a36Sopenharmony_ci 61562306a36Sopenharmony_ci return 0; 61662306a36Sopenharmony_ci} 61762306a36Sopenharmony_ci 61862306a36Sopenharmony_ci/** 61962306a36Sopenharmony_ci * sta350_set_dai_fmt - configure the codec for the selected audio format 62062306a36Sopenharmony_ci * @codec_dai: the codec DAI 62162306a36Sopenharmony_ci * @fmt: a SND_SOC_DAIFMT_x value indicating the data format 62262306a36Sopenharmony_ci * 62362306a36Sopenharmony_ci * This function takes a bitmask of SND_SOC_DAIFMT_x bits and programs the 62462306a36Sopenharmony_ci * codec accordingly. 62562306a36Sopenharmony_ci */ 62662306a36Sopenharmony_cistatic int sta350_set_dai_fmt(struct snd_soc_dai *codec_dai, 62762306a36Sopenharmony_ci unsigned int fmt) 62862306a36Sopenharmony_ci{ 62962306a36Sopenharmony_ci struct snd_soc_component *component = codec_dai->component; 63062306a36Sopenharmony_ci struct sta350_priv *sta350 = snd_soc_component_get_drvdata(component); 63162306a36Sopenharmony_ci unsigned int confb = 0; 63262306a36Sopenharmony_ci 63362306a36Sopenharmony_ci switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) { 63462306a36Sopenharmony_ci case SND_SOC_DAIFMT_CBC_CFC: 63562306a36Sopenharmony_ci break; 63662306a36Sopenharmony_ci default: 63762306a36Sopenharmony_ci return -EINVAL; 63862306a36Sopenharmony_ci } 63962306a36Sopenharmony_ci 64062306a36Sopenharmony_ci switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 64162306a36Sopenharmony_ci case SND_SOC_DAIFMT_I2S: 64262306a36Sopenharmony_ci case SND_SOC_DAIFMT_RIGHT_J: 64362306a36Sopenharmony_ci case SND_SOC_DAIFMT_LEFT_J: 64462306a36Sopenharmony_ci sta350->format = fmt & SND_SOC_DAIFMT_FORMAT_MASK; 64562306a36Sopenharmony_ci break; 64662306a36Sopenharmony_ci default: 64762306a36Sopenharmony_ci return -EINVAL; 64862306a36Sopenharmony_ci } 64962306a36Sopenharmony_ci 65062306a36Sopenharmony_ci switch (fmt & SND_SOC_DAIFMT_INV_MASK) { 65162306a36Sopenharmony_ci case SND_SOC_DAIFMT_NB_NF: 65262306a36Sopenharmony_ci confb |= STA350_CONFB_C2IM; 65362306a36Sopenharmony_ci break; 65462306a36Sopenharmony_ci case SND_SOC_DAIFMT_NB_IF: 65562306a36Sopenharmony_ci confb |= STA350_CONFB_C1IM; 65662306a36Sopenharmony_ci break; 65762306a36Sopenharmony_ci default: 65862306a36Sopenharmony_ci return -EINVAL; 65962306a36Sopenharmony_ci } 66062306a36Sopenharmony_ci 66162306a36Sopenharmony_ci return regmap_update_bits(sta350->regmap, STA350_CONFB, 66262306a36Sopenharmony_ci STA350_CONFB_C1IM | STA350_CONFB_C2IM, confb); 66362306a36Sopenharmony_ci} 66462306a36Sopenharmony_ci 66562306a36Sopenharmony_ci/** 66662306a36Sopenharmony_ci * sta350_hw_params - program the STA350 with the given hardware parameters. 66762306a36Sopenharmony_ci * @substream: the audio stream 66862306a36Sopenharmony_ci * @params: the hardware parameters to set 66962306a36Sopenharmony_ci * @dai: the SOC DAI (ignored) 67062306a36Sopenharmony_ci * 67162306a36Sopenharmony_ci * This function programs the hardware with the values provided. 67262306a36Sopenharmony_ci * Specifically, the sample rate and the data format. 67362306a36Sopenharmony_ci */ 67462306a36Sopenharmony_cistatic int sta350_hw_params(struct snd_pcm_substream *substream, 67562306a36Sopenharmony_ci struct snd_pcm_hw_params *params, 67662306a36Sopenharmony_ci struct snd_soc_dai *dai) 67762306a36Sopenharmony_ci{ 67862306a36Sopenharmony_ci struct snd_soc_component *component = dai->component; 67962306a36Sopenharmony_ci struct sta350_priv *sta350 = snd_soc_component_get_drvdata(component); 68062306a36Sopenharmony_ci int i, mcs = -EINVAL, ir = -EINVAL; 68162306a36Sopenharmony_ci unsigned int confa, confb; 68262306a36Sopenharmony_ci unsigned int rate, ratio; 68362306a36Sopenharmony_ci int ret; 68462306a36Sopenharmony_ci 68562306a36Sopenharmony_ci if (!sta350->mclk) { 68662306a36Sopenharmony_ci dev_err(component->dev, 68762306a36Sopenharmony_ci "sta350->mclk is unset. Unable to determine ratio\n"); 68862306a36Sopenharmony_ci return -EIO; 68962306a36Sopenharmony_ci } 69062306a36Sopenharmony_ci 69162306a36Sopenharmony_ci rate = params_rate(params); 69262306a36Sopenharmony_ci ratio = sta350->mclk / rate; 69362306a36Sopenharmony_ci dev_dbg(component->dev, "rate: %u, ratio: %u\n", rate, ratio); 69462306a36Sopenharmony_ci 69562306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(interpolation_ratios); i++) { 69662306a36Sopenharmony_ci if (interpolation_ratios[i].fs == rate) { 69762306a36Sopenharmony_ci ir = interpolation_ratios[i].ir; 69862306a36Sopenharmony_ci break; 69962306a36Sopenharmony_ci } 70062306a36Sopenharmony_ci } 70162306a36Sopenharmony_ci 70262306a36Sopenharmony_ci if (ir < 0) { 70362306a36Sopenharmony_ci dev_err(component->dev, "Unsupported samplerate: %u\n", rate); 70462306a36Sopenharmony_ci return -EINVAL; 70562306a36Sopenharmony_ci } 70662306a36Sopenharmony_ci 70762306a36Sopenharmony_ci for (i = 0; i < 6; i++) { 70862306a36Sopenharmony_ci if (mcs_ratio_table[ir][i] == ratio) { 70962306a36Sopenharmony_ci mcs = i; 71062306a36Sopenharmony_ci break; 71162306a36Sopenharmony_ci } 71262306a36Sopenharmony_ci } 71362306a36Sopenharmony_ci 71462306a36Sopenharmony_ci if (mcs < 0) { 71562306a36Sopenharmony_ci dev_err(component->dev, "Unresolvable ratio: %u\n", ratio); 71662306a36Sopenharmony_ci return -EINVAL; 71762306a36Sopenharmony_ci } 71862306a36Sopenharmony_ci 71962306a36Sopenharmony_ci confa = (ir << STA350_CONFA_IR_SHIFT) | 72062306a36Sopenharmony_ci (mcs << STA350_CONFA_MCS_SHIFT); 72162306a36Sopenharmony_ci confb = 0; 72262306a36Sopenharmony_ci 72362306a36Sopenharmony_ci switch (params_width(params)) { 72462306a36Sopenharmony_ci case 24: 72562306a36Sopenharmony_ci dev_dbg(component->dev, "24bit\n"); 72662306a36Sopenharmony_ci fallthrough; 72762306a36Sopenharmony_ci case 32: 72862306a36Sopenharmony_ci dev_dbg(component->dev, "24bit or 32bit\n"); 72962306a36Sopenharmony_ci switch (sta350->format) { 73062306a36Sopenharmony_ci case SND_SOC_DAIFMT_I2S: 73162306a36Sopenharmony_ci confb |= 0x0; 73262306a36Sopenharmony_ci break; 73362306a36Sopenharmony_ci case SND_SOC_DAIFMT_LEFT_J: 73462306a36Sopenharmony_ci confb |= 0x1; 73562306a36Sopenharmony_ci break; 73662306a36Sopenharmony_ci case SND_SOC_DAIFMT_RIGHT_J: 73762306a36Sopenharmony_ci confb |= 0x2; 73862306a36Sopenharmony_ci break; 73962306a36Sopenharmony_ci } 74062306a36Sopenharmony_ci 74162306a36Sopenharmony_ci break; 74262306a36Sopenharmony_ci case 20: 74362306a36Sopenharmony_ci dev_dbg(component->dev, "20bit\n"); 74462306a36Sopenharmony_ci switch (sta350->format) { 74562306a36Sopenharmony_ci case SND_SOC_DAIFMT_I2S: 74662306a36Sopenharmony_ci confb |= 0x4; 74762306a36Sopenharmony_ci break; 74862306a36Sopenharmony_ci case SND_SOC_DAIFMT_LEFT_J: 74962306a36Sopenharmony_ci confb |= 0x5; 75062306a36Sopenharmony_ci break; 75162306a36Sopenharmony_ci case SND_SOC_DAIFMT_RIGHT_J: 75262306a36Sopenharmony_ci confb |= 0x6; 75362306a36Sopenharmony_ci break; 75462306a36Sopenharmony_ci } 75562306a36Sopenharmony_ci 75662306a36Sopenharmony_ci break; 75762306a36Sopenharmony_ci case 18: 75862306a36Sopenharmony_ci dev_dbg(component->dev, "18bit\n"); 75962306a36Sopenharmony_ci switch (sta350->format) { 76062306a36Sopenharmony_ci case SND_SOC_DAIFMT_I2S: 76162306a36Sopenharmony_ci confb |= 0x8; 76262306a36Sopenharmony_ci break; 76362306a36Sopenharmony_ci case SND_SOC_DAIFMT_LEFT_J: 76462306a36Sopenharmony_ci confb |= 0x9; 76562306a36Sopenharmony_ci break; 76662306a36Sopenharmony_ci case SND_SOC_DAIFMT_RIGHT_J: 76762306a36Sopenharmony_ci confb |= 0xa; 76862306a36Sopenharmony_ci break; 76962306a36Sopenharmony_ci } 77062306a36Sopenharmony_ci 77162306a36Sopenharmony_ci break; 77262306a36Sopenharmony_ci case 16: 77362306a36Sopenharmony_ci dev_dbg(component->dev, "16bit\n"); 77462306a36Sopenharmony_ci switch (sta350->format) { 77562306a36Sopenharmony_ci case SND_SOC_DAIFMT_I2S: 77662306a36Sopenharmony_ci confb |= 0x0; 77762306a36Sopenharmony_ci break; 77862306a36Sopenharmony_ci case SND_SOC_DAIFMT_LEFT_J: 77962306a36Sopenharmony_ci confb |= 0xd; 78062306a36Sopenharmony_ci break; 78162306a36Sopenharmony_ci case SND_SOC_DAIFMT_RIGHT_J: 78262306a36Sopenharmony_ci confb |= 0xe; 78362306a36Sopenharmony_ci break; 78462306a36Sopenharmony_ci } 78562306a36Sopenharmony_ci 78662306a36Sopenharmony_ci break; 78762306a36Sopenharmony_ci default: 78862306a36Sopenharmony_ci return -EINVAL; 78962306a36Sopenharmony_ci } 79062306a36Sopenharmony_ci 79162306a36Sopenharmony_ci ret = regmap_update_bits(sta350->regmap, STA350_CONFA, 79262306a36Sopenharmony_ci STA350_CONFA_MCS_MASK | STA350_CONFA_IR_MASK, 79362306a36Sopenharmony_ci confa); 79462306a36Sopenharmony_ci if (ret < 0) 79562306a36Sopenharmony_ci return ret; 79662306a36Sopenharmony_ci 79762306a36Sopenharmony_ci ret = regmap_update_bits(sta350->regmap, STA350_CONFB, 79862306a36Sopenharmony_ci STA350_CONFB_SAI_MASK | STA350_CONFB_SAIFB, 79962306a36Sopenharmony_ci confb); 80062306a36Sopenharmony_ci if (ret < 0) 80162306a36Sopenharmony_ci return ret; 80262306a36Sopenharmony_ci 80362306a36Sopenharmony_ci return 0; 80462306a36Sopenharmony_ci} 80562306a36Sopenharmony_ci 80662306a36Sopenharmony_cistatic int sta350_startup_sequence(struct sta350_priv *sta350) 80762306a36Sopenharmony_ci{ 80862306a36Sopenharmony_ci if (sta350->gpiod_power_down) 80962306a36Sopenharmony_ci gpiod_set_value(sta350->gpiod_power_down, 1); 81062306a36Sopenharmony_ci 81162306a36Sopenharmony_ci if (sta350->gpiod_nreset) { 81262306a36Sopenharmony_ci gpiod_set_value(sta350->gpiod_nreset, 0); 81362306a36Sopenharmony_ci mdelay(1); 81462306a36Sopenharmony_ci gpiod_set_value(sta350->gpiod_nreset, 1); 81562306a36Sopenharmony_ci mdelay(1); 81662306a36Sopenharmony_ci } 81762306a36Sopenharmony_ci 81862306a36Sopenharmony_ci return 0; 81962306a36Sopenharmony_ci} 82062306a36Sopenharmony_ci 82162306a36Sopenharmony_ci/** 82262306a36Sopenharmony_ci * sta350_set_bias_level - DAPM callback 82362306a36Sopenharmony_ci * @component: the component device 82462306a36Sopenharmony_ci * @level: DAPM power level 82562306a36Sopenharmony_ci * 82662306a36Sopenharmony_ci * This is called by ALSA to put the component into low power mode 82762306a36Sopenharmony_ci * or to wake it up. If the component is powered off completely 82862306a36Sopenharmony_ci * all registers must be restored after power on. 82962306a36Sopenharmony_ci */ 83062306a36Sopenharmony_cistatic int sta350_set_bias_level(struct snd_soc_component *component, 83162306a36Sopenharmony_ci enum snd_soc_bias_level level) 83262306a36Sopenharmony_ci{ 83362306a36Sopenharmony_ci struct sta350_priv *sta350 = snd_soc_component_get_drvdata(component); 83462306a36Sopenharmony_ci int ret; 83562306a36Sopenharmony_ci 83662306a36Sopenharmony_ci dev_dbg(component->dev, "level = %d\n", level); 83762306a36Sopenharmony_ci switch (level) { 83862306a36Sopenharmony_ci case SND_SOC_BIAS_ON: 83962306a36Sopenharmony_ci break; 84062306a36Sopenharmony_ci 84162306a36Sopenharmony_ci case SND_SOC_BIAS_PREPARE: 84262306a36Sopenharmony_ci /* Full power on */ 84362306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFF, 84462306a36Sopenharmony_ci STA350_CONFF_PWDN | STA350_CONFF_EAPD, 84562306a36Sopenharmony_ci STA350_CONFF_PWDN | STA350_CONFF_EAPD); 84662306a36Sopenharmony_ci break; 84762306a36Sopenharmony_ci 84862306a36Sopenharmony_ci case SND_SOC_BIAS_STANDBY: 84962306a36Sopenharmony_ci if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) { 85062306a36Sopenharmony_ci ret = regulator_bulk_enable( 85162306a36Sopenharmony_ci ARRAY_SIZE(sta350->supplies), 85262306a36Sopenharmony_ci sta350->supplies); 85362306a36Sopenharmony_ci if (ret < 0) { 85462306a36Sopenharmony_ci dev_err(component->dev, 85562306a36Sopenharmony_ci "Failed to enable supplies: %d\n", 85662306a36Sopenharmony_ci ret); 85762306a36Sopenharmony_ci return ret; 85862306a36Sopenharmony_ci } 85962306a36Sopenharmony_ci sta350_startup_sequence(sta350); 86062306a36Sopenharmony_ci sta350_cache_sync(component); 86162306a36Sopenharmony_ci } 86262306a36Sopenharmony_ci 86362306a36Sopenharmony_ci /* Power down */ 86462306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFF, 86562306a36Sopenharmony_ci STA350_CONFF_PWDN | STA350_CONFF_EAPD, 86662306a36Sopenharmony_ci 0); 86762306a36Sopenharmony_ci 86862306a36Sopenharmony_ci break; 86962306a36Sopenharmony_ci 87062306a36Sopenharmony_ci case SND_SOC_BIAS_OFF: 87162306a36Sopenharmony_ci /* The chip runs through the power down sequence for us */ 87262306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFF, 87362306a36Sopenharmony_ci STA350_CONFF_PWDN | STA350_CONFF_EAPD, 0); 87462306a36Sopenharmony_ci 87562306a36Sopenharmony_ci /* power down: low */ 87662306a36Sopenharmony_ci if (sta350->gpiod_power_down) 87762306a36Sopenharmony_ci gpiod_set_value(sta350->gpiod_power_down, 0); 87862306a36Sopenharmony_ci 87962306a36Sopenharmony_ci if (sta350->gpiod_nreset) 88062306a36Sopenharmony_ci gpiod_set_value(sta350->gpiod_nreset, 0); 88162306a36Sopenharmony_ci 88262306a36Sopenharmony_ci regulator_bulk_disable(ARRAY_SIZE(sta350->supplies), 88362306a36Sopenharmony_ci sta350->supplies); 88462306a36Sopenharmony_ci break; 88562306a36Sopenharmony_ci } 88662306a36Sopenharmony_ci return 0; 88762306a36Sopenharmony_ci} 88862306a36Sopenharmony_ci 88962306a36Sopenharmony_cistatic const struct snd_soc_dai_ops sta350_dai_ops = { 89062306a36Sopenharmony_ci .hw_params = sta350_hw_params, 89162306a36Sopenharmony_ci .set_sysclk = sta350_set_dai_sysclk, 89262306a36Sopenharmony_ci .set_fmt = sta350_set_dai_fmt, 89362306a36Sopenharmony_ci}; 89462306a36Sopenharmony_ci 89562306a36Sopenharmony_cistatic struct snd_soc_dai_driver sta350_dai = { 89662306a36Sopenharmony_ci .name = "sta350-hifi", 89762306a36Sopenharmony_ci .playback = { 89862306a36Sopenharmony_ci .stream_name = "Playback", 89962306a36Sopenharmony_ci .channels_min = 2, 90062306a36Sopenharmony_ci .channels_max = 2, 90162306a36Sopenharmony_ci .rates = STA350_RATES, 90262306a36Sopenharmony_ci .formats = STA350_FORMATS, 90362306a36Sopenharmony_ci }, 90462306a36Sopenharmony_ci .ops = &sta350_dai_ops, 90562306a36Sopenharmony_ci}; 90662306a36Sopenharmony_ci 90762306a36Sopenharmony_cistatic int sta350_probe(struct snd_soc_component *component) 90862306a36Sopenharmony_ci{ 90962306a36Sopenharmony_ci struct sta350_priv *sta350 = snd_soc_component_get_drvdata(component); 91062306a36Sopenharmony_ci struct sta350_platform_data *pdata = sta350->pdata; 91162306a36Sopenharmony_ci int i, ret = 0, thermal = 0; 91262306a36Sopenharmony_ci 91362306a36Sopenharmony_ci ret = regulator_bulk_enable(ARRAY_SIZE(sta350->supplies), 91462306a36Sopenharmony_ci sta350->supplies); 91562306a36Sopenharmony_ci if (ret < 0) { 91662306a36Sopenharmony_ci dev_err(component->dev, "Failed to enable supplies: %d\n", ret); 91762306a36Sopenharmony_ci return ret; 91862306a36Sopenharmony_ci } 91962306a36Sopenharmony_ci 92062306a36Sopenharmony_ci ret = sta350_startup_sequence(sta350); 92162306a36Sopenharmony_ci if (ret < 0) { 92262306a36Sopenharmony_ci dev_err(component->dev, "Failed to startup device\n"); 92362306a36Sopenharmony_ci return ret; 92462306a36Sopenharmony_ci } 92562306a36Sopenharmony_ci 92662306a36Sopenharmony_ci /* CONFA */ 92762306a36Sopenharmony_ci if (!pdata->thermal_warning_recovery) 92862306a36Sopenharmony_ci thermal |= STA350_CONFA_TWAB; 92962306a36Sopenharmony_ci if (!pdata->thermal_warning_adjustment) 93062306a36Sopenharmony_ci thermal |= STA350_CONFA_TWRB; 93162306a36Sopenharmony_ci if (!pdata->fault_detect_recovery) 93262306a36Sopenharmony_ci thermal |= STA350_CONFA_FDRB; 93362306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFA, 93462306a36Sopenharmony_ci STA350_CONFA_TWAB | STA350_CONFA_TWRB | 93562306a36Sopenharmony_ci STA350_CONFA_FDRB, 93662306a36Sopenharmony_ci thermal); 93762306a36Sopenharmony_ci 93862306a36Sopenharmony_ci /* CONFC */ 93962306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFC, 94062306a36Sopenharmony_ci STA350_CONFC_OM_MASK, 94162306a36Sopenharmony_ci pdata->ffx_power_output_mode 94262306a36Sopenharmony_ci << STA350_CONFC_OM_SHIFT); 94362306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFC, 94462306a36Sopenharmony_ci STA350_CONFC_CSZ_MASK, 94562306a36Sopenharmony_ci pdata->drop_compensation_ns 94662306a36Sopenharmony_ci << STA350_CONFC_CSZ_SHIFT); 94762306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, 94862306a36Sopenharmony_ci STA350_CONFC, 94962306a36Sopenharmony_ci STA350_CONFC_OCRB, 95062306a36Sopenharmony_ci pdata->oc_warning_adjustment ? 95162306a36Sopenharmony_ci STA350_CONFC_OCRB : 0); 95262306a36Sopenharmony_ci 95362306a36Sopenharmony_ci /* CONFE */ 95462306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFE, 95562306a36Sopenharmony_ci STA350_CONFE_MPCV, 95662306a36Sopenharmony_ci pdata->max_power_use_mpcc ? 95762306a36Sopenharmony_ci STA350_CONFE_MPCV : 0); 95862306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFE, 95962306a36Sopenharmony_ci STA350_CONFE_MPC, 96062306a36Sopenharmony_ci pdata->max_power_correction ? 96162306a36Sopenharmony_ci STA350_CONFE_MPC : 0); 96262306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFE, 96362306a36Sopenharmony_ci STA350_CONFE_AME, 96462306a36Sopenharmony_ci pdata->am_reduction_mode ? 96562306a36Sopenharmony_ci STA350_CONFE_AME : 0); 96662306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFE, 96762306a36Sopenharmony_ci STA350_CONFE_PWMS, 96862306a36Sopenharmony_ci pdata->odd_pwm_speed_mode ? 96962306a36Sopenharmony_ci STA350_CONFE_PWMS : 0); 97062306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFE, 97162306a36Sopenharmony_ci STA350_CONFE_DCCV, 97262306a36Sopenharmony_ci pdata->distortion_compensation ? 97362306a36Sopenharmony_ci STA350_CONFE_DCCV : 0); 97462306a36Sopenharmony_ci /* CONFF */ 97562306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFF, 97662306a36Sopenharmony_ci STA350_CONFF_IDE, 97762306a36Sopenharmony_ci pdata->invalid_input_detect_mute ? 97862306a36Sopenharmony_ci STA350_CONFF_IDE : 0); 97962306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_CONFF, 98062306a36Sopenharmony_ci STA350_CONFF_OCFG_MASK, 98162306a36Sopenharmony_ci pdata->output_conf 98262306a36Sopenharmony_ci << STA350_CONFF_OCFG_SHIFT); 98362306a36Sopenharmony_ci 98462306a36Sopenharmony_ci /* channel to output mapping */ 98562306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_C1CFG, 98662306a36Sopenharmony_ci STA350_CxCFG_OM_MASK, 98762306a36Sopenharmony_ci pdata->ch1_output_mapping 98862306a36Sopenharmony_ci << STA350_CxCFG_OM_SHIFT); 98962306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_C2CFG, 99062306a36Sopenharmony_ci STA350_CxCFG_OM_MASK, 99162306a36Sopenharmony_ci pdata->ch2_output_mapping 99262306a36Sopenharmony_ci << STA350_CxCFG_OM_SHIFT); 99362306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_C3CFG, 99462306a36Sopenharmony_ci STA350_CxCFG_OM_MASK, 99562306a36Sopenharmony_ci pdata->ch3_output_mapping 99662306a36Sopenharmony_ci << STA350_CxCFG_OM_SHIFT); 99762306a36Sopenharmony_ci 99862306a36Sopenharmony_ci /* miscellaneous registers */ 99962306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_MISC1, 100062306a36Sopenharmony_ci STA350_MISC1_CPWMEN, 100162306a36Sopenharmony_ci pdata->activate_mute_output ? 100262306a36Sopenharmony_ci STA350_MISC1_CPWMEN : 0); 100362306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_MISC1, 100462306a36Sopenharmony_ci STA350_MISC1_BRIDGOFF, 100562306a36Sopenharmony_ci pdata->bridge_immediate_off ? 100662306a36Sopenharmony_ci STA350_MISC1_BRIDGOFF : 0); 100762306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_MISC1, 100862306a36Sopenharmony_ci STA350_MISC1_NSHHPEN, 100962306a36Sopenharmony_ci pdata->noise_shape_dc_cut ? 101062306a36Sopenharmony_ci STA350_MISC1_NSHHPEN : 0); 101162306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_MISC1, 101262306a36Sopenharmony_ci STA350_MISC1_RPDNEN, 101362306a36Sopenharmony_ci pdata->powerdown_master_vol ? 101462306a36Sopenharmony_ci STA350_MISC1_RPDNEN: 0); 101562306a36Sopenharmony_ci 101662306a36Sopenharmony_ci regmap_update_bits(sta350->regmap, STA350_MISC2, 101762306a36Sopenharmony_ci STA350_MISC2_PNDLSL_MASK, 101862306a36Sopenharmony_ci pdata->powerdown_delay_divider 101962306a36Sopenharmony_ci << STA350_MISC2_PNDLSL_SHIFT); 102062306a36Sopenharmony_ci 102162306a36Sopenharmony_ci /* initialize coefficient shadow RAM with reset values */ 102262306a36Sopenharmony_ci for (i = 4; i <= 49; i += 5) 102362306a36Sopenharmony_ci sta350->coef_shadow[i] = 0x400000; 102462306a36Sopenharmony_ci for (i = 50; i <= 54; i++) 102562306a36Sopenharmony_ci sta350->coef_shadow[i] = 0x7fffff; 102662306a36Sopenharmony_ci sta350->coef_shadow[55] = 0x5a9df7; 102762306a36Sopenharmony_ci sta350->coef_shadow[56] = 0x7fffff; 102862306a36Sopenharmony_ci sta350->coef_shadow[59] = 0x7fffff; 102962306a36Sopenharmony_ci sta350->coef_shadow[60] = 0x400000; 103062306a36Sopenharmony_ci sta350->coef_shadow[61] = 0x400000; 103162306a36Sopenharmony_ci 103262306a36Sopenharmony_ci snd_soc_component_force_bias_level(component, SND_SOC_BIAS_STANDBY); 103362306a36Sopenharmony_ci /* Bias level configuration will have done an extra enable */ 103462306a36Sopenharmony_ci regulator_bulk_disable(ARRAY_SIZE(sta350->supplies), sta350->supplies); 103562306a36Sopenharmony_ci 103662306a36Sopenharmony_ci return 0; 103762306a36Sopenharmony_ci} 103862306a36Sopenharmony_ci 103962306a36Sopenharmony_cistatic void sta350_remove(struct snd_soc_component *component) 104062306a36Sopenharmony_ci{ 104162306a36Sopenharmony_ci struct sta350_priv *sta350 = snd_soc_component_get_drvdata(component); 104262306a36Sopenharmony_ci 104362306a36Sopenharmony_ci regulator_bulk_disable(ARRAY_SIZE(sta350->supplies), sta350->supplies); 104462306a36Sopenharmony_ci} 104562306a36Sopenharmony_ci 104662306a36Sopenharmony_cistatic const struct snd_soc_component_driver sta350_component = { 104762306a36Sopenharmony_ci .probe = sta350_probe, 104862306a36Sopenharmony_ci .remove = sta350_remove, 104962306a36Sopenharmony_ci .set_bias_level = sta350_set_bias_level, 105062306a36Sopenharmony_ci .controls = sta350_snd_controls, 105162306a36Sopenharmony_ci .num_controls = ARRAY_SIZE(sta350_snd_controls), 105262306a36Sopenharmony_ci .dapm_widgets = sta350_dapm_widgets, 105362306a36Sopenharmony_ci .num_dapm_widgets = ARRAY_SIZE(sta350_dapm_widgets), 105462306a36Sopenharmony_ci .dapm_routes = sta350_dapm_routes, 105562306a36Sopenharmony_ci .num_dapm_routes = ARRAY_SIZE(sta350_dapm_routes), 105662306a36Sopenharmony_ci .suspend_bias_off = 1, 105762306a36Sopenharmony_ci .idle_bias_on = 1, 105862306a36Sopenharmony_ci .use_pmdown_time = 1, 105962306a36Sopenharmony_ci .endianness = 1, 106062306a36Sopenharmony_ci}; 106162306a36Sopenharmony_ci 106262306a36Sopenharmony_cistatic const struct regmap_config sta350_regmap = { 106362306a36Sopenharmony_ci .reg_bits = 8, 106462306a36Sopenharmony_ci .val_bits = 8, 106562306a36Sopenharmony_ci .max_register = STA350_MISC2, 106662306a36Sopenharmony_ci .reg_defaults = sta350_regs, 106762306a36Sopenharmony_ci .num_reg_defaults = ARRAY_SIZE(sta350_regs), 106862306a36Sopenharmony_ci .cache_type = REGCACHE_MAPLE, 106962306a36Sopenharmony_ci .wr_table = &sta350_write_regs, 107062306a36Sopenharmony_ci .rd_table = &sta350_read_regs, 107162306a36Sopenharmony_ci .volatile_table = &sta350_volatile_regs, 107262306a36Sopenharmony_ci}; 107362306a36Sopenharmony_ci 107462306a36Sopenharmony_ci#ifdef CONFIG_OF 107562306a36Sopenharmony_cistatic const struct of_device_id st350_dt_ids[] = { 107662306a36Sopenharmony_ci { .compatible = "st,sta350", }, 107762306a36Sopenharmony_ci { } 107862306a36Sopenharmony_ci}; 107962306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, st350_dt_ids); 108062306a36Sopenharmony_ci 108162306a36Sopenharmony_cistatic const char * const sta350_ffx_modes[] = { 108262306a36Sopenharmony_ci [STA350_FFX_PM_DROP_COMP] = "drop-compensation", 108362306a36Sopenharmony_ci [STA350_FFX_PM_TAPERED_COMP] = "tapered-compensation", 108462306a36Sopenharmony_ci [STA350_FFX_PM_FULL_POWER] = "full-power-mode", 108562306a36Sopenharmony_ci [STA350_FFX_PM_VARIABLE_DROP_COMP] = "variable-drop-compensation", 108662306a36Sopenharmony_ci}; 108762306a36Sopenharmony_ci 108862306a36Sopenharmony_cistatic int sta350_probe_dt(struct device *dev, struct sta350_priv *sta350) 108962306a36Sopenharmony_ci{ 109062306a36Sopenharmony_ci struct device_node *np = dev->of_node; 109162306a36Sopenharmony_ci struct sta350_platform_data *pdata; 109262306a36Sopenharmony_ci const char *ffx_power_mode; 109362306a36Sopenharmony_ci u16 tmp; 109462306a36Sopenharmony_ci u8 tmp8; 109562306a36Sopenharmony_ci 109662306a36Sopenharmony_ci pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL); 109762306a36Sopenharmony_ci if (!pdata) 109862306a36Sopenharmony_ci return -ENOMEM; 109962306a36Sopenharmony_ci 110062306a36Sopenharmony_ci of_property_read_u8(np, "st,output-conf", 110162306a36Sopenharmony_ci &pdata->output_conf); 110262306a36Sopenharmony_ci of_property_read_u8(np, "st,ch1-output-mapping", 110362306a36Sopenharmony_ci &pdata->ch1_output_mapping); 110462306a36Sopenharmony_ci of_property_read_u8(np, "st,ch2-output-mapping", 110562306a36Sopenharmony_ci &pdata->ch2_output_mapping); 110662306a36Sopenharmony_ci of_property_read_u8(np, "st,ch3-output-mapping", 110762306a36Sopenharmony_ci &pdata->ch3_output_mapping); 110862306a36Sopenharmony_ci 110962306a36Sopenharmony_ci pdata->thermal_warning_recovery = 111062306a36Sopenharmony_ci of_property_read_bool(np, "st,thermal-warning-recovery"); 111162306a36Sopenharmony_ci pdata->thermal_warning_adjustment = 111262306a36Sopenharmony_ci of_property_read_bool(np, "st,thermal-warning-adjustment"); 111362306a36Sopenharmony_ci pdata->fault_detect_recovery = 111462306a36Sopenharmony_ci of_property_read_bool(np, "st,fault-detect-recovery"); 111562306a36Sopenharmony_ci 111662306a36Sopenharmony_ci pdata->ffx_power_output_mode = STA350_FFX_PM_VARIABLE_DROP_COMP; 111762306a36Sopenharmony_ci if (!of_property_read_string(np, "st,ffx-power-output-mode", 111862306a36Sopenharmony_ci &ffx_power_mode)) { 111962306a36Sopenharmony_ci int i, mode = -EINVAL; 112062306a36Sopenharmony_ci 112162306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(sta350_ffx_modes); i++) 112262306a36Sopenharmony_ci if (!strcasecmp(ffx_power_mode, sta350_ffx_modes[i])) 112362306a36Sopenharmony_ci mode = i; 112462306a36Sopenharmony_ci 112562306a36Sopenharmony_ci if (mode < 0) 112662306a36Sopenharmony_ci dev_warn(dev, "Unsupported ffx output mode: %s\n", 112762306a36Sopenharmony_ci ffx_power_mode); 112862306a36Sopenharmony_ci else 112962306a36Sopenharmony_ci pdata->ffx_power_output_mode = mode; 113062306a36Sopenharmony_ci } 113162306a36Sopenharmony_ci 113262306a36Sopenharmony_ci tmp = 140; 113362306a36Sopenharmony_ci of_property_read_u16(np, "st,drop-compensation-ns", &tmp); 113462306a36Sopenharmony_ci pdata->drop_compensation_ns = clamp_t(u16, tmp, 0, 300) / 20; 113562306a36Sopenharmony_ci 113662306a36Sopenharmony_ci pdata->oc_warning_adjustment = 113762306a36Sopenharmony_ci of_property_read_bool(np, "st,overcurrent-warning-adjustment"); 113862306a36Sopenharmony_ci 113962306a36Sopenharmony_ci /* CONFE */ 114062306a36Sopenharmony_ci pdata->max_power_use_mpcc = 114162306a36Sopenharmony_ci of_property_read_bool(np, "st,max-power-use-mpcc"); 114262306a36Sopenharmony_ci pdata->max_power_correction = 114362306a36Sopenharmony_ci of_property_read_bool(np, "st,max-power-correction"); 114462306a36Sopenharmony_ci pdata->am_reduction_mode = 114562306a36Sopenharmony_ci of_property_read_bool(np, "st,am-reduction-mode"); 114662306a36Sopenharmony_ci pdata->odd_pwm_speed_mode = 114762306a36Sopenharmony_ci of_property_read_bool(np, "st,odd-pwm-speed-mode"); 114862306a36Sopenharmony_ci pdata->distortion_compensation = 114962306a36Sopenharmony_ci of_property_read_bool(np, "st,distortion-compensation"); 115062306a36Sopenharmony_ci 115162306a36Sopenharmony_ci /* CONFF */ 115262306a36Sopenharmony_ci pdata->invalid_input_detect_mute = 115362306a36Sopenharmony_ci of_property_read_bool(np, "st,invalid-input-detect-mute"); 115462306a36Sopenharmony_ci 115562306a36Sopenharmony_ci /* MISC */ 115662306a36Sopenharmony_ci pdata->activate_mute_output = 115762306a36Sopenharmony_ci of_property_read_bool(np, "st,activate-mute-output"); 115862306a36Sopenharmony_ci pdata->bridge_immediate_off = 115962306a36Sopenharmony_ci of_property_read_bool(np, "st,bridge-immediate-off"); 116062306a36Sopenharmony_ci pdata->noise_shape_dc_cut = 116162306a36Sopenharmony_ci of_property_read_bool(np, "st,noise-shape-dc-cut"); 116262306a36Sopenharmony_ci pdata->powerdown_master_vol = 116362306a36Sopenharmony_ci of_property_read_bool(np, "st,powerdown-master-volume"); 116462306a36Sopenharmony_ci 116562306a36Sopenharmony_ci if (!of_property_read_u8(np, "st,powerdown-delay-divider", &tmp8)) { 116662306a36Sopenharmony_ci if (is_power_of_2(tmp8) && tmp8 >= 1 && tmp8 <= 128) 116762306a36Sopenharmony_ci pdata->powerdown_delay_divider = ilog2(tmp8); 116862306a36Sopenharmony_ci else 116962306a36Sopenharmony_ci dev_warn(dev, "Unsupported powerdown delay divider %d\n", 117062306a36Sopenharmony_ci tmp8); 117162306a36Sopenharmony_ci } 117262306a36Sopenharmony_ci 117362306a36Sopenharmony_ci sta350->pdata = pdata; 117462306a36Sopenharmony_ci 117562306a36Sopenharmony_ci return 0; 117662306a36Sopenharmony_ci} 117762306a36Sopenharmony_ci#endif 117862306a36Sopenharmony_ci 117962306a36Sopenharmony_cistatic int sta350_i2c_probe(struct i2c_client *i2c) 118062306a36Sopenharmony_ci{ 118162306a36Sopenharmony_ci struct device *dev = &i2c->dev; 118262306a36Sopenharmony_ci struct sta350_priv *sta350; 118362306a36Sopenharmony_ci int ret, i; 118462306a36Sopenharmony_ci 118562306a36Sopenharmony_ci sta350 = devm_kzalloc(dev, sizeof(struct sta350_priv), GFP_KERNEL); 118662306a36Sopenharmony_ci if (!sta350) 118762306a36Sopenharmony_ci return -ENOMEM; 118862306a36Sopenharmony_ci 118962306a36Sopenharmony_ci mutex_init(&sta350->coeff_lock); 119062306a36Sopenharmony_ci sta350->pdata = dev_get_platdata(dev); 119162306a36Sopenharmony_ci 119262306a36Sopenharmony_ci#ifdef CONFIG_OF 119362306a36Sopenharmony_ci if (dev->of_node) { 119462306a36Sopenharmony_ci ret = sta350_probe_dt(dev, sta350); 119562306a36Sopenharmony_ci if (ret < 0) 119662306a36Sopenharmony_ci return ret; 119762306a36Sopenharmony_ci } 119862306a36Sopenharmony_ci#endif 119962306a36Sopenharmony_ci 120062306a36Sopenharmony_ci /* GPIOs */ 120162306a36Sopenharmony_ci sta350->gpiod_nreset = devm_gpiod_get_optional(dev, "reset", 120262306a36Sopenharmony_ci GPIOD_OUT_LOW); 120362306a36Sopenharmony_ci if (IS_ERR(sta350->gpiod_nreset)) 120462306a36Sopenharmony_ci return PTR_ERR(sta350->gpiod_nreset); 120562306a36Sopenharmony_ci 120662306a36Sopenharmony_ci sta350->gpiod_power_down = devm_gpiod_get_optional(dev, "power-down", 120762306a36Sopenharmony_ci GPIOD_OUT_LOW); 120862306a36Sopenharmony_ci if (IS_ERR(sta350->gpiod_power_down)) 120962306a36Sopenharmony_ci return PTR_ERR(sta350->gpiod_power_down); 121062306a36Sopenharmony_ci 121162306a36Sopenharmony_ci /* regulators */ 121262306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(sta350->supplies); i++) 121362306a36Sopenharmony_ci sta350->supplies[i].supply = sta350_supply_names[i]; 121462306a36Sopenharmony_ci 121562306a36Sopenharmony_ci ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(sta350->supplies), 121662306a36Sopenharmony_ci sta350->supplies); 121762306a36Sopenharmony_ci if (ret < 0) { 121862306a36Sopenharmony_ci dev_err(dev, "Failed to request supplies: %d\n", ret); 121962306a36Sopenharmony_ci return ret; 122062306a36Sopenharmony_ci } 122162306a36Sopenharmony_ci 122262306a36Sopenharmony_ci sta350->regmap = devm_regmap_init_i2c(i2c, &sta350_regmap); 122362306a36Sopenharmony_ci if (IS_ERR(sta350->regmap)) { 122462306a36Sopenharmony_ci ret = PTR_ERR(sta350->regmap); 122562306a36Sopenharmony_ci dev_err(dev, "Failed to init regmap: %d\n", ret); 122662306a36Sopenharmony_ci return ret; 122762306a36Sopenharmony_ci } 122862306a36Sopenharmony_ci 122962306a36Sopenharmony_ci i2c_set_clientdata(i2c, sta350); 123062306a36Sopenharmony_ci 123162306a36Sopenharmony_ci ret = devm_snd_soc_register_component(dev, &sta350_component, &sta350_dai, 1); 123262306a36Sopenharmony_ci if (ret < 0) 123362306a36Sopenharmony_ci dev_err(dev, "Failed to register component (%d)\n", ret); 123462306a36Sopenharmony_ci 123562306a36Sopenharmony_ci return ret; 123662306a36Sopenharmony_ci} 123762306a36Sopenharmony_ci 123862306a36Sopenharmony_cistatic void sta350_i2c_remove(struct i2c_client *client) 123962306a36Sopenharmony_ci{} 124062306a36Sopenharmony_ci 124162306a36Sopenharmony_cistatic const struct i2c_device_id sta350_i2c_id[] = { 124262306a36Sopenharmony_ci { "sta350", 0 }, 124362306a36Sopenharmony_ci { } 124462306a36Sopenharmony_ci}; 124562306a36Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, sta350_i2c_id); 124662306a36Sopenharmony_ci 124762306a36Sopenharmony_cistatic struct i2c_driver sta350_i2c_driver = { 124862306a36Sopenharmony_ci .driver = { 124962306a36Sopenharmony_ci .name = "sta350", 125062306a36Sopenharmony_ci .of_match_table = of_match_ptr(st350_dt_ids), 125162306a36Sopenharmony_ci }, 125262306a36Sopenharmony_ci .probe = sta350_i2c_probe, 125362306a36Sopenharmony_ci .remove = sta350_i2c_remove, 125462306a36Sopenharmony_ci .id_table = sta350_i2c_id, 125562306a36Sopenharmony_ci}; 125662306a36Sopenharmony_ci 125762306a36Sopenharmony_cimodule_i2c_driver(sta350_i2c_driver); 125862306a36Sopenharmony_ci 125962306a36Sopenharmony_ciMODULE_DESCRIPTION("ASoC STA350 driver"); 126062306a36Sopenharmony_ciMODULE_AUTHOR("Sven Brandau <info@brandau.biz>"); 126162306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 1262