FILE
max98373-sdw.c
File preview with syntax highlighting.
linux-6.19.14/sound/soc/codecs/max98373-sdw.c
1// SPDX-License-Identifier: GPL-2.0-only 2// Copyright (c) 2020, Maxim Integrated 3 4#include <linux/acpi.h> 5#include <linux/delay.h> 6#include <linux/module.h> 7#include <linux/mod_devicetable.h> 8#include <linux/pm_runtime.h> 9#include <linux/regmap.h> 10#include <linux/slab.h> 11#include <sound/pcm.h> 12#include <sound/pcm_params.h> 13#include <sound/sdw.h> 14#include <sound/soc.h> 15#include <sound/tlv.h> 16#include <linux/of.h> 17#include <linux/soundwire/sdw.h> 18#include <linux/soundwire/sdw_type.h> 19#include <linux/soundwire/sdw_registers.h> 20#include "max98373.h" 21#include "max98373-sdw.h" 22 23static const u32 max98373_sdw_cache_reg[] = { 24 MAX98373_R2054_MEAS_ADC_PVDD_CH_READBACK, 25 MAX98373_R2055_MEAS_ADC_THERM_CH_READBACK, 26 MAX98373_R20B6_BDE_CUR_STATE_READBACK, 27}; 28 29static const struct reg_default max98373_reg[] = { 30 {MAX98373_R0040_SCP_INIT_STAT_1, 0x00}, 31 {MAX98373_R0041_SCP_INIT_MASK_1, 0x00}, 32 {MAX98373_R0042_SCP_INIT_STAT_2, 0x00}, 33 {MAX98373_R0044_SCP_CTRL, 0x00}, 34 {MAX98373_R0045_SCP_SYSTEM_CTRL, 0x00}, 35 {MAX98373_R0046_SCP_DEV_NUMBER, 0x00}, 36 {MAX98373_R0050_SCP_DEV_ID_0, 0x21}, 37 {MAX98373_R0051_SCP_DEV_ID_1, 0x01}, 38 {MAX98373_R0052_SCP_DEV_ID_2, 0x9F}, 39 {MAX98373_R0053_SCP_DEV_ID_3, 0x87}, 40 {MAX98373_R0054_SCP_DEV_ID_4, 0x08}, 41 {MAX98373_R0055_SCP_DEV_ID_5, 0x00}, 42 {MAX98373_R0060_SCP_FRAME_CTLR, 0x00}, 43 {MAX98373_R0070_SCP_FRAME_CTLR, 0x00}, 44 {MAX98373_R0100_DP1_INIT_STAT, 0x00}, 45 {MAX98373_R0101_DP1_INIT_MASK, 0x00}, 46 {MAX98373_R0102_DP1_PORT_CTRL, 0x00}, 47 {MAX98373_R0103_DP1_BLOCK_CTRL_1, 0x00}, 48 {MAX98373_R0104_DP1_PREPARE_STATUS, 0x00}, 49 {MAX98373_R0105_DP1_PREPARE_CTRL, 0x00}, 50 {MAX98373_R0120_DP1_CHANNEL_EN, 0x00}, 51 {MAX98373_R0122_DP1_SAMPLE_CTRL1, 0x00}, 52 {MAX98373_R0123_DP1_SAMPLE_CTRL2, 0x00}, 53 {MAX98373_R0124_DP1_OFFSET_CTRL1, 0x00}, 54 {MAX98373_R0125_DP1_OFFSET_CTRL2, 0x00}, 55 {MAX98373_R0126_DP1_HCTRL, 0x00}, 56 {MAX98373_R0127_DP1_BLOCK_CTRL3, 0x00}, 57 {MAX98373_R0130_DP1_CHANNEL_EN, 0x00}, 58 {MAX98373_R0132_DP1_SAMPLE_CTRL1, 0x00}, 59 {MAX98373_R0133_DP1_SAMPLE_CTRL2, 0x00}, 60 {MAX98373_R0134_DP1_OFFSET_CTRL1, 0x00}, 61 {MAX98373_R0135_DP1_OFFSET_CTRL2, 0x00}, 62 {MAX98373_R0136_DP1_HCTRL, 0x0136}, 63 {MAX98373_R0137_DP1_BLOCK_CTRL3, 0x00}, 64 {MAX98373_R0300_DP3_INIT_STAT, 0x00}, 65 {MAX98373_R0301_DP3_INIT_MASK, 0x00}, 66 {MAX98373_R0302_DP3_PORT_CTRL, 0x00}, 67 {MAX98373_R0303_DP3_BLOCK_CTRL_1, 0x00}, 68 {MAX98373_R0304_DP3_PREPARE_STATUS, 0x00}, 69 {MAX98373_R0305_DP3_PREPARE_CTRL, 0x00}, 70 {MAX98373_R0320_DP3_CHANNEL_EN, 0x00}, 71 {MAX98373_R0322_DP3_SAMPLE_CTRL1, 0x00}, 72 {MAX98373_R0323_DP3_SAMPLE_CTRL2, 0x00}, 73 {MAX98373_R0324_DP3_OFFSET_CTRL1, 0x00}, 74 {MAX98373_R0325_DP3_OFFSET_CTRL2, 0x00}, 75 {MAX98373_R0326_DP3_HCTRL, 0x00}, 76 {MAX98373_R0327_DP3_BLOCK_CTRL3, 0x00}, 77 {MAX98373_R0330_DP3_CHANNEL_EN, 0x00}, 78 {MAX98373_R0332_DP3_SAMPLE_CTRL1, 0x00}, 79 {MAX98373_R0333_DP3_SAMPLE_CTRL2, 0x00}, 80 {MAX98373_R0334_DP3_OFFSET_CTRL1, 0x00}, 81 {MAX98373_R0335_DP3_OFFSET_CTRL2, 0x00}, 82 {MAX98373_R0336_DP3_HCTRL, 0x00}, 83 {MAX98373_R0337_DP3_BLOCK_CTRL3, 0x00}, 84 {MAX98373_R2000_SW_RESET, 0x00}, 85 {MAX98373_R2001_INT_RAW1, 0x00}, 86 {MAX98373_R2002_INT_RAW2, 0x00}, 87 {MAX98373_R2003_INT_RAW3, 0x00}, 88 {MAX98373_R2004_INT_STATE1, 0x00}, 89 {MAX98373_R2005_INT_STATE2, 0x00}, 90 {MAX98373_R2006_INT_STATE3, 0x00}, 91 {MAX98373_R2007_INT_FLAG1, 0x00}, 92 {MAX98373_R2008_INT_FLAG2, 0x00}, 93 {MAX98373_R2009_INT_FLAG3, 0x00}, 94 {MAX98373_R200A_INT_EN1, 0x00}, 95 {MAX98373_R200B_INT_EN2, 0x00}, 96 {MAX98373_R200C_INT_EN3, 0x00}, 97 {MAX98373_R200D_INT_FLAG_CLR1, 0x00}, 98 {MAX98373_R200E_INT_FLAG_CLR2, 0x00}, 99 {MAX98373_R200F_INT_FLAG_CLR3, 0x00}, 100 {MAX98373_R2010_IRQ_CTRL, 0x00}, 101 {MAX98373_R2014_THERM_WARN_THRESH, 0x10}, 102 {MAX98373_R2015_THERM_SHDN_THRESH, 0x27}, 103 {MAX98373_R2016_THERM_HYSTERESIS, 0x01}, 104 {MAX98373_R2017_THERM_FOLDBACK_SET, 0xC0}, 105 {MAX98373_R2018_THERM_FOLDBACK_EN, 0x00}, 106 {MAX98373_R201E_PIN_DRIVE_STRENGTH, 0x55}, 107 {MAX98373_R2020_PCM_TX_HIZ_EN_1, 0xFE}, 108 {MAX98373_R2021_PCM_TX_HIZ_EN_2, 0xFF}, 109 {MAX98373_R2022_PCM_TX_SRC_1, 0x00}, 110 {MAX98373_R2023_PCM_TX_SRC_2, 0x00}, 111 {MAX98373_R2024_PCM_DATA_FMT_CFG, 0xC0}, 112 {MAX98373_R2025_AUDIO_IF_MODE, 0x00}, 113 {MAX98373_R2026_PCM_CLOCK_RATIO, 0x04}, 114 {MAX98373_R2027_PCM_SR_SETUP_1, 0x08}, 115 {MAX98373_R2028_PCM_SR_SETUP_2, 0x88}, 116 {MAX98373_R2029_PCM_TO_SPK_MONO_MIX_1, 0x00}, 117 {MAX98373_R202A_PCM_TO_SPK_MONO_MIX_2, 0x00}, 118 {MAX98373_R202B_PCM_RX_EN, 0x00}, 119 {MAX98373_R202C_PCM_TX_EN, 0x00}, 120 {MAX98373_R202E_ICC_RX_CH_EN_1, 0x00}, 121 {MAX98373_R202F_ICC_RX_CH_EN_2, 0x00}, 122 {MAX98373_R2030_ICC_TX_HIZ_EN_1, 0xFF}, 123 {MAX98373_R2031_ICC_TX_HIZ_EN_2, 0xFF}, 124 {MAX98373_R2032_ICC_LINK_EN_CFG, 0x30}, 125 {MAX98373_R2034_ICC_TX_CNTL, 0x00}, 126 {MAX98373_R2035_ICC_TX_EN, 0x00}, 127 {MAX98373_R2036_SOUNDWIRE_CTRL, 0x05}, 128 {MAX98373_R203D_AMP_DIG_VOL_CTRL, 0x00}, 129 {MAX98373_R203E_AMP_PATH_GAIN, 0x08}, 130 {MAX98373_R203F_AMP_DSP_CFG, 0x02}, 131 {MAX98373_R2040_TONE_GEN_CFG, 0x00}, 132 {MAX98373_R2041_AMP_CFG, 0x03}, 133 {MAX98373_R2042_AMP_EDGE_RATE_CFG, 0x00}, 134 {MAX98373_R2043_AMP_EN, 0x00}, 135 {MAX98373_R2046_IV_SENSE_ADC_DSP_CFG, 0x04}, 136 {MAX98373_R2047_IV_SENSE_ADC_EN, 0x00}, 137 {MAX98373_R2051_MEAS_ADC_SAMPLING_RATE, 0x00}, 138 {MAX98373_R2052_MEAS_ADC_PVDD_FLT_CFG, 0x00}, 139 {MAX98373_R2053_MEAS_ADC_THERM_FLT_CFG, 0x00}, 140 {MAX98373_R2054_MEAS_ADC_PVDD_CH_READBACK, 0x00}, 141 {MAX98373_R2055_MEAS_ADC_THERM_CH_READBACK, 0x00}, 142 {MAX98373_R2056_MEAS_ADC_PVDD_CH_EN, 0x00}, 143 {MAX98373_R2090_BDE_LVL_HOLD, 0x00}, 144 {MAX98373_R2091_BDE_GAIN_ATK_REL_RATE, 0x00}, 145 {MAX98373_R2092_BDE_CLIPPER_MODE, 0x00}, 146 {MAX98373_R2097_BDE_L1_THRESH, 0x00}, 147 {MAX98373_R2098_BDE_L2_THRESH, 0x00}, 148 {MAX98373_R2099_BDE_L3_THRESH, 0x00}, 149 {MAX98373_R209A_BDE_L4_THRESH, 0x00}, 150 {MAX98373_R209B_BDE_THRESH_HYST, 0x00}, 151 {MAX98373_R20A8_BDE_L1_CFG_1, 0x00}, 152 {MAX98373_R20A9_BDE_L1_CFG_2, 0x00}, 153 {MAX98373_R20AA_BDE_L1_CFG_3, 0x00}, 154 {MAX98373_R20AB_BDE_L2_CFG_1, 0x00}, 155 {MAX98373_R20AC_BDE_L2_CFG_2, 0x00}, 156 {MAX98373_R20AD_BDE_L2_CFG_3, 0x00}, 157 {MAX98373_R20AE_BDE_L3_CFG_1, 0x00}, 158 {MAX98373_R20AF_BDE_L3_CFG_2, 0x00}, 159 {MAX98373_R20B0_BDE_L3_CFG_3, 0x00}, 160 {MAX98373_R20B1_BDE_L4_CFG_1, 0x00}, 161 {MAX98373_R20B2_BDE_L4_CFG_2, 0x00}, 162 {MAX98373_R20B3_BDE_L4_CFG_3, 0x00}, 163 {MAX98373_R20B4_BDE_INFINITE_HOLD_RELEASE, 0x00}, 164 {MAX98373_R20B5_BDE_EN, 0x00}, 165 {MAX98373_R20B6_BDE_CUR_STATE_READBACK, 0x00}, 166 {MAX98373_R20D1_DHT_CFG, 0x01}, 167 {MAX98373_R20D2_DHT_ATTACK_CFG, 0x02}, 168 {MAX98373_R20D3_DHT_RELEASE_CFG, 0x03}, 169 {MAX98373_R20D4_DHT_EN, 0x00}, 170 {MAX98373_R20E0_LIMITER_THRESH_CFG, 0x00}, 171 {MAX98373_R20E1_LIMITER_ATK_REL_RATES, 0x00}, 172 {MAX98373_R20E2_LIMITER_EN, 0x00}, 173 {MAX98373_R20FE_DEVICE_AUTO_RESTART_CFG, 0x00}, 174 {MAX98373_R20FF_GLOBAL_SHDN, 0x00}, 175 {MAX98373_R21FF_REV_ID, 0x42}, 176}; 177 178static bool max98373_readable_register(struct device *dev, unsigned int reg) 179{ 180 switch (reg) { 181 case MAX98373_R21FF_REV_ID: 182 case MAX98373_R2010_IRQ_CTRL: 183 /* SoundWire Control Port Registers */ 184 case MAX98373_R0040_SCP_INIT_STAT_1 ... MAX98373_R0070_SCP_FRAME_CTLR: 185 /* Soundwire Data Port 1 Registers */ 186 case MAX98373_R0100_DP1_INIT_STAT ... MAX98373_R0137_DP1_BLOCK_CTRL3: 187 /* Soundwire Data Port 3 Registers */ 188 case MAX98373_R0300_DP3_INIT_STAT ... MAX98373_R0337_DP3_BLOCK_CTRL3: 189 case MAX98373_R2000_SW_RESET ... MAX98373_R200C_INT_EN3: 190 case MAX98373_R2014_THERM_WARN_THRESH 191 ... MAX98373_R2018_THERM_FOLDBACK_EN: 192 case MAX98373_R201E_PIN_DRIVE_STRENGTH 193 ... MAX98373_R2036_SOUNDWIRE_CTRL: 194 case MAX98373_R203D_AMP_DIG_VOL_CTRL ... MAX98373_R2043_AMP_EN: 195 case MAX98373_R2046_IV_SENSE_ADC_DSP_CFG 196 ... MAX98373_R2047_IV_SENSE_ADC_EN: 197 case MAX98373_R2051_MEAS_ADC_SAMPLING_RATE 198 ... MAX98373_R2056_MEAS_ADC_PVDD_CH_EN: 199 case MAX98373_R2090_BDE_LVL_HOLD ... MAX98373_R2092_BDE_CLIPPER_MODE: 200 case MAX98373_R2097_BDE_L1_THRESH 201 ... MAX98373_R209B_BDE_THRESH_HYST: 202 case MAX98373_R20A8_BDE_L1_CFG_1 ... MAX98373_R20B3_BDE_L4_CFG_3: 203 case MAX98373_R20B5_BDE_EN ... MAX98373_R20B6_BDE_CUR_STATE_READBACK: 204 case MAX98373_R20D1_DHT_CFG ... MAX98373_R20D4_DHT_EN: 205 case MAX98373_R20E0_LIMITER_THRESH_CFG ... MAX98373_R20E2_LIMITER_EN: 206 case MAX98373_R20FE_DEVICE_AUTO_RESTART_CFG 207 ... MAX98373_R20FF_GLOBAL_SHDN: 208 return true; 209 default: 210 return false; 211 } 212}; 213 214static bool max98373_volatile_reg(struct device *dev, unsigned int reg) 215{ 216 switch (reg) { 217 case MAX98373_R2054_MEAS_ADC_PVDD_CH_READBACK: 218 case MAX98373_R2055_MEAS_ADC_THERM_CH_READBACK: 219 case MAX98373_R20B6_BDE_CUR_STATE_READBACK: 220 case MAX98373_R20FF_GLOBAL_SHDN: 221 case MAX98373_R21FF_REV_ID: 222 /* SoundWire Control Port Registers */ 223 case MAX98373_R0040_SCP_INIT_STAT_1 ... MAX98373_R0070_SCP_FRAME_CTLR: 224 /* Soundwire Data Port 1 Registers */ 225 case MAX98373_R0100_DP1_INIT_STAT ... MAX98373_R0137_DP1_BLOCK_CTRL3: 226 /* Soundwire Data Port 3 Registers */ 227 case MAX98373_R0300_DP3_INIT_STAT ... MAX98373_R0337_DP3_BLOCK_CTRL3: 228 case MAX98373_R2000_SW_RESET ... MAX98373_R2009_INT_FLAG3: 229 return true; 230 default: 231 return false; 232 } 233} 234 235static const struct regmap_config max98373_sdw_regmap = { 236 .reg_bits = 32, 237 .val_bits = 8, 238 .max_register = MAX98373_R21FF_REV_ID, 239 .reg_defaults = max98373_reg, 240 .num_reg_defaults = ARRAY_SIZE(max98373_reg), 241 .readable_reg = max98373_readable_register, 242 .volatile_reg = max98373_volatile_reg, 243 .cache_type = REGCACHE_RBTREE, 244 .use_single_read = true, 245 .use_single_write = true, 246}; 247 248/* Power management functions and structure */ 249static int max98373_suspend(struct device *dev) 250{ 251 struct max98373_priv *max98373 = dev_get_drvdata(dev); 252 int i; 253 254 /* cache feedback register values before suspend */ 255 for (i = 0; i < max98373->cache_num; i++) 256 regmap_read(max98373->regmap, max98373->cache[i].reg, &max98373->cache[i].val); 257 258 regcache_cache_only(max98373->regmap, true); 259 260 return 0; 261} 262 263#define MAX98373_PROBE_TIMEOUT 5000 264 265static int max98373_resume(struct device *dev) 266{ 267 struct sdw_slave *slave = dev_to_sdw_dev(dev); 268 struct max98373_priv *max98373 = dev_get_drvdata(dev); 269 unsigned long time; 270 271 if (!max98373->first_hw_init) 272 return 0; 273 274 if (!slave->unattach_request) 275 goto regmap_sync; 276 277 time = wait_for_completion_timeout(&slave->initialization_complete, 278 msecs_to_jiffies(MAX98373_PROBE_TIMEOUT)); 279 if (!time) { 280 dev_err(dev, "Initialization not complete, timed out\n"); 281 sdw_show_ping_status(slave->bus, true); 282 283 return -ETIMEDOUT; 284 } 285 286regmap_sync: 287 slave->unattach_request = 0; 288 regcache_cache_only(max98373->regmap, false); 289 regcache_sync(max98373->regmap); 290 291 return 0; 292} 293 294static const struct dev_pm_ops max98373_pm = { 295 SYSTEM_SLEEP_PM_OPS(max98373_suspend, max98373_resume) 296 RUNTIME_PM_OPS(max98373_suspend, max98373_resume, NULL) 297}; 298 299static int max98373_read_prop(struct sdw_slave *slave) 300{ 301 struct sdw_slave_prop *prop = &slave->prop; 302 int nval, i; 303 u32 bit; 304 unsigned long addr; 305 struct sdw_dpn_prop *dpn; 306 307 prop->scp_int1_mask = SDW_SCP_INT1_BUS_CLASH | SDW_SCP_INT1_PARITY; 308 309 /* BITMAP: 00001000 Dataport 3 is active */ 310 prop->source_ports = BIT(3); 311 /* BITMAP: 00000010 Dataport 1 is active */ 312 prop->sink_ports = BIT(1); 313 prop->paging_support = true; 314 prop->clk_stop_timeout = 20; 315 316 nval = hweight32(prop->source_ports); 317 prop->src_dpn_prop = devm_kcalloc(&slave->dev, nval, 318 sizeof(*prop->src_dpn_prop), 319 GFP_KERNEL); 320 if (!prop->src_dpn_prop) 321 return -ENOMEM; 322 323 i = 0; 324 dpn = prop->src_dpn_prop; 325 addr = prop->source_ports; 326 for_each_set_bit(bit, &addr, 32) { 327 dpn[i].num = bit; 328 dpn[i].type = SDW_DPN_FULL; 329 dpn[i].simple_ch_prep_sm = true; 330 dpn[i].ch_prep_timeout = 10; 331 i++; 332 } 333 334 /* do this again for sink now */ 335 nval = hweight32(prop->sink_ports); 336 prop->sink_dpn_prop = devm_kcalloc(&slave->dev, nval, 337 sizeof(*prop->sink_dpn_prop), 338 GFP_KERNEL); 339 if (!prop->sink_dpn_prop) 340 return -ENOMEM; 341 342 i = 0; 343 dpn = prop->sink_dpn_prop; 344 addr = prop->sink_ports; 345 for_each_set_bit(bit, &addr, 32) { 346 dpn[i].num = bit; 347 dpn[i].type = SDW_DPN_FULL; 348 dpn[i].simple_ch_prep_sm = true; 349 dpn[i].ch_prep_timeout = 10; 350 i++; 351 } 352 353 /* set the timeout values */ 354 prop->clk_stop_timeout = 20; 355 356 return 0; 357} 358 359static int max98373_io_init(struct sdw_slave *slave) 360{ 361 struct device *dev = &slave->dev; 362 struct max98373_priv *max98373 = dev_get_drvdata(dev); 363 364 regcache_cache_only(max98373->regmap, false); 365 if (max98373->first_hw_init) 366 regcache_cache_bypass(max98373->regmap, true); 367 368 /* 369 * PM runtime status is marked as 'active' only when a Slave reports as Attached 370 */ 371 if (!max98373->first_hw_init) 372 /* update count of parent 'active' children */ 373 pm_runtime_set_active(dev); 374 375 pm_runtime_get_noresume(dev); 376 377 /* Software Reset */ 378 max98373_reset(max98373, dev); 379 380 /* Set soundwire mode */ 381 regmap_write(max98373->regmap, MAX98373_R2025_AUDIO_IF_MODE, 3); 382 /* Enable ADC */ 383 regmap_write(max98373->regmap, MAX98373_R2047_IV_SENSE_ADC_EN, 3); 384 /* Set default Soundwire clock */ 385 regmap_write(max98373->regmap, MAX98373_R2036_SOUNDWIRE_CTRL, 5); 386 /* Set default sampling rate for speaker and IVDAC */ 387 regmap_write(max98373->regmap, MAX98373_R2028_PCM_SR_SETUP_2, 0x88); 388 /* IV default slot configuration */ 389 regmap_write(max98373->regmap, 390 MAX98373_R2020_PCM_TX_HIZ_EN_1, 391 0xFF); 392 regmap_write(max98373->regmap, 393 MAX98373_R2021_PCM_TX_HIZ_EN_2, 394 0xFF); 395 /* L/R mix configuration */ 396 regmap_write(max98373->regmap, 397 MAX98373_R2029_PCM_TO_SPK_MONO_MIX_1, 398 0x80); 399 regmap_write(max98373->regmap, 400 MAX98373_R202A_PCM_TO_SPK_MONO_MIX_2, 401 0x1); 402 /* Enable DC blocker */ 403 regmap_write(max98373->regmap, 404 MAX98373_R203F_AMP_DSP_CFG, 405 0x3); 406 /* Enable IMON VMON DC blocker */ 407 regmap_write(max98373->regmap, 408 MAX98373_R2046_IV_SENSE_ADC_DSP_CFG, 409 0x7); 410 /* voltage, current slot configuration */ 411 regmap_write(max98373->regmap, 412 MAX98373_R2022_PCM_TX_SRC_1, 413 (max98373->i_slot << MAX98373_PCM_TX_CH_SRC_A_I_SHIFT | 414 max98373->v_slot) & 0xFF); 415 if (max98373->v_slot < 8) 416 regmap_update_bits(max98373->regmap, 417 MAX98373_R2020_PCM_TX_HIZ_EN_1, 418 1 << max98373->v_slot, 0); 419 else 420 regmap_update_bits(max98373->regmap, 421 MAX98373_R2021_PCM_TX_HIZ_EN_2, 422 1 << (max98373->v_slot - 8), 0); 423 424 if (max98373->i_slot < 8) 425 regmap_update_bits(max98373->regmap, 426 MAX98373_R2020_PCM_TX_HIZ_EN_1, 427 1 << max98373->i_slot, 0); 428 else 429 regmap_update_bits(max98373->regmap, 430 MAX98373_R2021_PCM_TX_HIZ_EN_2, 431 1 << (max98373->i_slot - 8), 0); 432 433 /* speaker feedback slot configuration */ 434 regmap_write(max98373->regmap, 435 MAX98373_R2023_PCM_TX_SRC_2, 436 max98373->spkfb_slot & 0xFF); 437 438 /* Set interleave mode */ 439 if (max98373->interleave_mode) 440 regmap_update_bits(max98373->regmap, 441 MAX98373_R2024_PCM_DATA_FMT_CFG, 442 MAX98373_PCM_TX_CH_INTERLEAVE_MASK, 443 MAX98373_PCM_TX_CH_INTERLEAVE_MASK); 444 445 /* Speaker enable */ 446 regmap_update_bits(max98373->regmap, 447 MAX98373_R2043_AMP_EN, 448 MAX98373_SPK_EN_MASK, 1); 449 450 regmap_write(max98373->regmap, MAX98373_R20B5_BDE_EN, 1); 451 regmap_write(max98373->regmap, MAX98373_R20E2_LIMITER_EN, 1); 452 453 if (max98373->first_hw_init) { 454 regcache_cache_bypass(max98373->regmap, false); 455 regcache_mark_dirty(max98373->regmap); 456 } 457 458 max98373->first_hw_init = true; 459 max98373->hw_init = true; 460 461 pm_runtime_put_autosuspend(dev); 462 463 return 0; 464} 465 466static int max98373_clock_calculate(struct sdw_slave *slave, 467 unsigned int clk_freq) 468{ 469 int x, y; 470 static const int max98373_clk_family[] = { 471 7680000, 8400000, 9600000, 11289600, 472 12000000, 12288000, 13000000 473 }; 474 475 for (x = 0; x < 4; x++) 476 for (y = 0; y < ARRAY_SIZE(max98373_clk_family); y++) 477 if (clk_freq == (max98373_clk_family[y] >> x)) 478 return (x << 3) + y; 479 480 /* Set default clock (12.288 Mhz) if the value is not in the list */ 481 dev_err(&slave->dev, "Requested clock not found. (clk_freq = %d)\n", 482 clk_freq); 483 return 0x5; 484} 485 486static int max98373_clock_config(struct sdw_slave *slave, 487 struct sdw_bus_params *params) 488{ 489 struct device *dev = &slave->dev; 490 struct max98373_priv *max98373 = dev_get_drvdata(dev); 491 unsigned int clk_freq, value; 492 493 clk_freq = (params->curr_dr_freq >> 1); 494 495 /* 496 * Select the proper value for the register based on the 497 * requested clock. If the value is not in the list, 498 * use reasonable default - 12.288 Mhz 499 */ 500 value = max98373_clock_calculate(slave, clk_freq); 501 502 /* SWCLK */ 503 regmap_write(max98373->regmap, MAX98373_R2036_SOUNDWIRE_CTRL, value); 504 505 /* The default Sampling Rate value for IV is 48KHz*/ 506 regmap_write(max98373->regmap, MAX98373_R2028_PCM_SR_SETUP_2, 0x88); 507 508 return 0; 509} 510 511#define MAX98373_RATES SNDRV_PCM_RATE_8000_96000 512#define MAX98373_FORMATS (SNDRV_PCM_FMTBIT_S32_LE) 513 514static int max98373_sdw_dai_hw_params(struct snd_pcm_substream *substream, 515 struct snd_pcm_hw_params *params, 516 struct snd_soc_dai *dai) 517{ 518 struct snd_soc_component *component = dai->component; 519 struct max98373_priv *max98373 = 520 snd_soc_component_get_drvdata(component); 521 struct sdw_stream_config stream_config = {0}; 522 struct sdw_port_config port_config = {0}; 523 struct sdw_stream_runtime *sdw_stream; 524 int ret, chan_sz, sampling_rate; 525 526 sdw_stream = snd_soc_dai_get_dma_data(dai, substream); 527 528 if (!sdw_stream) 529 return -EINVAL; 530 531 if (!max98373->slave) 532 return -EINVAL; 533 534 snd_sdw_params_to_config(substream, params, &stream_config, &port_config); 535 536 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 537 port_config.num = 1; 538 539 if (max98373->slot) { 540 stream_config.ch_count = max98373->slot; 541 port_config.ch_mask = max98373->rx_mask; 542 } 543 } else { 544 port_config.num = 3; 545 546 /* only IV are supported by capture */ 547 stream_config.ch_count = 2; 548 port_config.ch_mask = GENMASK((int)stream_config.ch_count - 1, 0); 549 } 550 551 ret = sdw_stream_add_slave(max98373->slave, &stream_config, 552 &port_config, 1, sdw_stream); 553 if (ret) { 554 dev_err(dai->dev, "Unable to configure port\n"); 555 return ret; 556 } 557 558 if (params_channels(params) > 16) { 559 dev_err(component->dev, "Unsupported channels %d\n", 560 params_channels(params)); 561 return -EINVAL; 562 } 563 564 /* Channel size configuration */ 565 switch (snd_pcm_format_width(params_format(params))) { 566 case 16: 567 chan_sz = MAX98373_PCM_MODE_CFG_CHANSZ_16; 568 break; 569 case 24: 570 chan_sz = MAX98373_PCM_MODE_CFG_CHANSZ_24; 571 break; 572 case 32: 573 chan_sz = MAX98373_PCM_MODE_CFG_CHANSZ_32; 574 break; 575 default: 576 dev_err(component->dev, "Channel size unsupported %d\n", 577 params_format(params)); 578 return -EINVAL; 579 } 580 581 max98373->ch_size = snd_pcm_format_width(params_format(params)); 582 583 regmap_update_bits(max98373->regmap, 584 MAX98373_R2024_PCM_DATA_FMT_CFG, 585 MAX98373_PCM_MODE_CFG_CHANSZ_MASK, chan_sz); 586 587 dev_dbg(component->dev, "Format supported %d", params_format(params)); 588 589 /* Sampling rate configuration */ 590 switch (params_rate(params)) { 591 case 8000: 592 sampling_rate = MAX98373_PCM_SR_SET1_SR_8000; 593 break; 594 case 11025: 595 sampling_rate = MAX98373_PCM_SR_SET1_SR_11025; 596 break; 597 case 12000: 598 sampling_rate = MAX98373_PCM_SR_SET1_SR_12000; 599 break; 600 case 16000: 601 sampling_rate = MAX98373_PCM_SR_SET1_SR_16000; 602 break; 603 case 22050: 604 sampling_rate = MAX98373_PCM_SR_SET1_SR_22050; 605 break; 606 case 24000: 607 sampling_rate = MAX98373_PCM_SR_SET1_SR_24000; 608 break; 609 case 32000: 610 sampling_rate = MAX98373_PCM_SR_SET1_SR_32000; 611 break; 612 case 44100: 613 sampling_rate = MAX98373_PCM_SR_SET1_SR_44100; 614 break; 615 case 48000: 616 sampling_rate = MAX98373_PCM_SR_SET1_SR_48000; 617 break; 618 case 88200: 619 sampling_rate = MAX98373_PCM_SR_SET1_SR_88200; 620 break; 621 case 96000: 622 sampling_rate = MAX98373_PCM_SR_SET1_SR_96000; 623 break; 624 default: 625 dev_err(component->dev, "Rate %d is not supported\n", 626 params_rate(params)); 627 return -EINVAL; 628 } 629 630 /* set correct sampling frequency */ 631 regmap_update_bits(max98373->regmap, 632 MAX98373_R2028_PCM_SR_SETUP_2, 633 MAX98373_PCM_SR_SET2_SR_MASK, 634 sampling_rate << MAX98373_PCM_SR_SET2_SR_SHIFT); 635 636 /* set sampling rate of IV */ 637 regmap_update_bits(max98373->regmap, 638 MAX98373_R2028_PCM_SR_SETUP_2, 639 MAX98373_PCM_SR_SET2_IVADC_SR_MASK, 640 sampling_rate); 641 642 return 0; 643} 644 645static int max98373_pcm_hw_free(struct snd_pcm_substream *substream, 646 struct snd_soc_dai *dai) 647{ 648 struct snd_soc_component *component = dai->component; 649 struct max98373_priv *max98373 = 650 snd_soc_component_get_drvdata(component); 651 struct sdw_stream_runtime *sdw_stream = 652 snd_soc_dai_get_dma_data(dai, substream); 653 654 if (!max98373->slave) 655 return -EINVAL; 656 657 sdw_stream_remove_slave(max98373->slave, sdw_stream); 658 return 0; 659} 660 661static int max98373_set_sdw_stream(struct snd_soc_dai *dai, 662 void *sdw_stream, int direction) 663{ 664 snd_soc_dai_dma_data_set(dai, direction, sdw_stream); 665 666 return 0; 667} 668 669static void max98373_shutdown(struct snd_pcm_substream *substream, 670 struct snd_soc_dai *dai) 671{ 672 snd_soc_dai_set_dma_data(dai, substream, NULL); 673} 674 675static int max98373_sdw_set_tdm_slot(struct snd_soc_dai *dai, 676 unsigned int tx_mask, 677 unsigned int rx_mask, 678 int slots, int slot_width) 679{ 680 struct snd_soc_component *component = dai->component; 681 struct max98373_priv *max98373 = 682 snd_soc_component_get_drvdata(component); 683 684 /* tx_mask is unused since it's irrelevant for I/V feedback */ 685 if (tx_mask) 686 return -EINVAL; 687 688 if (!rx_mask && !slots && !slot_width) 689 max98373->tdm_mode = false; 690 else 691 max98373->tdm_mode = true; 692 693 max98373->rx_mask = rx_mask; 694 max98373->slot = slots; 695 696 return 0; 697} 698 699static const struct snd_soc_dai_ops max98373_dai_sdw_ops = { 700 .hw_params = max98373_sdw_dai_hw_params, 701 .hw_free = max98373_pcm_hw_free, 702 .set_stream = max98373_set_sdw_stream, 703 .shutdown = max98373_shutdown, 704 .set_tdm_slot = max98373_sdw_set_tdm_slot, 705}; 706 707static struct snd_soc_dai_driver max98373_sdw_dai[] = { 708 { 709 .name = "max98373-aif1", 710 .playback = { 711 .stream_name = "HiFi Playback", 712 .channels_min = 1, 713 .channels_max = 2, 714 .rates = MAX98373_RATES, 715 .formats = MAX98373_FORMATS, 716 }, 717 .capture = { 718 .stream_name = "HiFi Capture", 719 .channels_min = 1, 720 .channels_max = 2, 721 .rates = MAX98373_RATES, 722 .formats = MAX98373_FORMATS, 723 }, 724 .ops = &max98373_dai_sdw_ops, 725 } 726}; 727 728static int max98373_init(struct sdw_slave *slave, struct regmap *regmap) 729{ 730 struct max98373_priv *max98373; 731 int ret; 732 int i; 733 struct device *dev = &slave->dev; 734 735 /* Allocate and assign private driver data structure */ 736 max98373 = devm_kzalloc(dev, sizeof(*max98373), GFP_KERNEL); 737 if (!max98373) 738 return -ENOMEM; 739 740 dev_set_drvdata(dev, max98373); 741 max98373->regmap = regmap; 742 max98373->slave = slave; 743 744 regcache_cache_only(max98373->regmap, true); 745 746 max98373->cache_num = ARRAY_SIZE(max98373_sdw_cache_reg); 747 max98373->cache = devm_kcalloc(dev, max98373->cache_num, 748 sizeof(*max98373->cache), 749 GFP_KERNEL); 750 if (!max98373->cache) 751 return -ENOMEM; 752 753 for (i = 0; i < max98373->cache_num; i++) 754 max98373->cache[i].reg = max98373_sdw_cache_reg[i]; 755 756 /* Read voltage and slot configuration */ 757 max98373_slot_config(dev, max98373); 758 759 max98373->hw_init = false; 760 max98373->first_hw_init = false; 761 762 /* codec registration */ 763 ret = devm_snd_soc_register_component(dev, &soc_codec_dev_max98373_sdw, 764 max98373_sdw_dai, 765 ARRAY_SIZE(max98373_sdw_dai)); 766 if (ret < 0) { 767 dev_err(dev, "Failed to register codec: %d\n", ret); 768 return ret; 769 } 770 771 /* set autosuspend parameters */ 772 pm_runtime_set_autosuspend_delay(dev, 3000); 773 pm_runtime_use_autosuspend(dev); 774 775 /* make sure the device does not suspend immediately */ 776 pm_runtime_mark_last_busy(dev); 777 778 pm_runtime_enable(dev); 779 780 /* important note: the device is NOT tagged as 'active' and will remain 781 * 'suspended' until the hardware is enumerated/initialized. This is required 782 * to make sure the ASoC framework use of pm_runtime_get_sync() does not silently 783 * fail with -EACCESS because of race conditions between card creation and enumeration 784 */ 785 786 return 0; 787} 788 789static int max98373_update_status(struct sdw_slave *slave, 790 enum sdw_slave_status status) 791{ 792 struct max98373_priv *max98373 = dev_get_drvdata(&slave->dev); 793 794 if (status == SDW_SLAVE_UNATTACHED) 795 max98373->hw_init = false; 796 797 /* 798 * Perform initialization only if slave status is SDW_SLAVE_ATTACHED 799 */ 800 if (max98373->hw_init || status != SDW_SLAVE_ATTACHED) 801 return 0; 802 803 /* perform I/O transfers required for Slave initialization */ 804 return max98373_io_init(slave); 805} 806 807static int max98373_bus_config(struct sdw_slave *slave, 808 struct sdw_bus_params *params) 809{ 810 int ret; 811 812 ret = max98373_clock_config(slave, params); 813 if (ret < 0) 814 dev_err(&slave->dev, "Invalid clk config"); 815 816 return ret; 817} 818 819/* 820 * slave_ops: callbacks for get_clock_stop_mode, clock_stop and 821 * port_prep are not defined for now 822 */ 823static const struct sdw_slave_ops max98373_slave_ops = { 824 .read_prop = max98373_read_prop, 825 .update_status = max98373_update_status, 826 .bus_config = max98373_bus_config, 827}; 828 829static int max98373_sdw_probe(struct sdw_slave *slave, 830 const struct sdw_device_id *id) 831{ 832 struct regmap *regmap; 833 834 /* Regmap Initialization */ 835 regmap = devm_regmap_init_sdw(slave, &max98373_sdw_regmap); 836 if (IS_ERR(regmap)) 837 return PTR_ERR(regmap); 838 839 return max98373_init(slave, regmap); 840} 841 842static int max98373_sdw_remove(struct sdw_slave *slave) 843{ 844 pm_runtime_disable(&slave->dev); 845 846 return 0; 847} 848 849#if defined(CONFIG_OF) 850static const struct of_device_id max98373_of_match[] = { 851 { .compatible = "maxim,max98373", }, 852 {}, 853}; 854MODULE_DEVICE_TABLE(of, max98373_of_match); 855#endif 856 857#ifdef CONFIG_ACPI 858static const struct acpi_device_id max98373_acpi_match[] = { 859 { "MX98373", 0 }, 860 {}, 861}; 862MODULE_DEVICE_TABLE(acpi, max98373_acpi_match); 863#endif 864 865static const struct sdw_device_id max98373_id[] = { 866 SDW_SLAVE_ENTRY(0x019F, 0x8373, 0), 867 {}, 868}; 869MODULE_DEVICE_TABLE(sdw, max98373_id); 870 871static struct sdw_driver max98373_sdw_driver = { 872 .driver = { 873 .name = "max98373", 874 .of_match_table = of_match_ptr(max98373_of_match), 875 .acpi_match_table = ACPI_PTR(max98373_acpi_match), 876 .pm = pm_ptr(&max98373_pm), 877 }, 878 .probe = max98373_sdw_probe, 879 .remove = max98373_sdw_remove, 880 .ops = &max98373_slave_ops, 881 .id_table = max98373_id, 882}; 883 884module_sdw_driver(max98373_sdw_driver); 885 886MODULE_DESCRIPTION("ASoC MAX98373 driver SDW"); 887MODULE_AUTHOR("Oleg Sherbakov <oleg.sherbakov@maximintegrated.com>"); 888MODULE_LICENSE("GPL v2");
~/
Read-only file preview.