103f6fc6dSOder Chiou // SPDX-License-Identifier: GPL-2.0-only 203f6fc6dSOder Chiou // 303f6fc6dSOder Chiou // rt5682-sdw.c -- RT5682 ALSA SoC audio component driver 403f6fc6dSOder Chiou // 503f6fc6dSOder Chiou // Copyright 2019 Realtek Semiconductor Corp. 603f6fc6dSOder Chiou // Author: Oder Chiou <oder_chiou@realtek.com> 703f6fc6dSOder Chiou // 803f6fc6dSOder Chiou 903f6fc6dSOder Chiou #include <linux/module.h> 1003f6fc6dSOder Chiou #include <linux/moduleparam.h> 1103f6fc6dSOder Chiou #include <linux/init.h> 1203f6fc6dSOder Chiou #include <linux/delay.h> 1303f6fc6dSOder Chiou #include <linux/pm.h> 1403f6fc6dSOder Chiou #include <linux/acpi.h> 1503f6fc6dSOder Chiou #include <linux/gpio.h> 1603f6fc6dSOder Chiou #include <linux/of_gpio.h> 17a50067d4SArnd Bergmann #include <linux/pm_runtime.h> 1803f6fc6dSOder Chiou #include <linux/regulator/consumer.h> 1903f6fc6dSOder Chiou #include <linux/mutex.h> 2003f6fc6dSOder Chiou #include <linux/soundwire/sdw.h> 2103f6fc6dSOder Chiou #include <linux/soundwire/sdw_type.h> 2203f6fc6dSOder Chiou #include <sound/core.h> 2303f6fc6dSOder Chiou #include <sound/pcm.h> 2403f6fc6dSOder Chiou #include <sound/pcm_params.h> 2503f6fc6dSOder Chiou #include <sound/jack.h> 2603f6fc6dSOder Chiou #include <sound/soc.h> 2703f6fc6dSOder Chiou #include <sound/soc-dapm.h> 2803f6fc6dSOder Chiou #include <sound/initval.h> 2903f6fc6dSOder Chiou #include <sound/tlv.h> 3003f6fc6dSOder Chiou 3103f6fc6dSOder Chiou #include "rt5682.h" 32a50067d4SArnd Bergmann 33a50067d4SArnd Bergmann #define RT5682_SDW_ADDR_L 0x3000 34a50067d4SArnd Bergmann #define RT5682_SDW_ADDR_H 0x3001 35a50067d4SArnd Bergmann #define RT5682_SDW_DATA_L 0x3004 36a50067d4SArnd Bergmann #define RT5682_SDW_DATA_H 0x3005 37a50067d4SArnd Bergmann #define RT5682_SDW_CMD 0x3008 38a50067d4SArnd Bergmann 39a50067d4SArnd Bergmann static int rt5682_sdw_read(void *context, unsigned int reg, unsigned int *val) 40a50067d4SArnd Bergmann { 41a50067d4SArnd Bergmann struct device *dev = context; 42a50067d4SArnd Bergmann struct rt5682_priv *rt5682 = dev_get_drvdata(dev); 43a50067d4SArnd Bergmann unsigned int data_l, data_h; 44a50067d4SArnd Bergmann 45a50067d4SArnd Bergmann regmap_write(rt5682->sdw_regmap, RT5682_SDW_CMD, 0); 46a50067d4SArnd Bergmann regmap_write(rt5682->sdw_regmap, RT5682_SDW_ADDR_H, (reg >> 8) & 0xff); 47a50067d4SArnd Bergmann regmap_write(rt5682->sdw_regmap, RT5682_SDW_ADDR_L, (reg & 0xff)); 48a50067d4SArnd Bergmann regmap_read(rt5682->sdw_regmap, RT5682_SDW_DATA_H, &data_h); 49a50067d4SArnd Bergmann regmap_read(rt5682->sdw_regmap, RT5682_SDW_DATA_L, &data_l); 50a50067d4SArnd Bergmann 51a50067d4SArnd Bergmann *val = (data_h << 8) | data_l; 52a50067d4SArnd Bergmann 53a50067d4SArnd Bergmann dev_vdbg(dev, "[%s] %04x => %04x\n", __func__, reg, *val); 54a50067d4SArnd Bergmann 55a50067d4SArnd Bergmann return 0; 56a50067d4SArnd Bergmann } 57a50067d4SArnd Bergmann 58a50067d4SArnd Bergmann static int rt5682_sdw_write(void *context, unsigned int reg, unsigned int val) 59a50067d4SArnd Bergmann { 60a50067d4SArnd Bergmann struct device *dev = context; 61a50067d4SArnd Bergmann struct rt5682_priv *rt5682 = dev_get_drvdata(dev); 62a50067d4SArnd Bergmann 63a50067d4SArnd Bergmann regmap_write(rt5682->sdw_regmap, RT5682_SDW_CMD, 1); 64a50067d4SArnd Bergmann regmap_write(rt5682->sdw_regmap, RT5682_SDW_ADDR_H, (reg >> 8) & 0xff); 65a50067d4SArnd Bergmann regmap_write(rt5682->sdw_regmap, RT5682_SDW_ADDR_L, (reg & 0xff)); 66a50067d4SArnd Bergmann regmap_write(rt5682->sdw_regmap, RT5682_SDW_DATA_H, (val >> 8) & 0xff); 67a50067d4SArnd Bergmann regmap_write(rt5682->sdw_regmap, RT5682_SDW_DATA_L, (val & 0xff)); 68a50067d4SArnd Bergmann 69a50067d4SArnd Bergmann dev_vdbg(dev, "[%s] %04x <= %04x\n", __func__, reg, val); 70a50067d4SArnd Bergmann 71a50067d4SArnd Bergmann return 0; 72a50067d4SArnd Bergmann } 73a50067d4SArnd Bergmann 74a50067d4SArnd Bergmann static const struct regmap_config rt5682_sdw_indirect_regmap = { 75a50067d4SArnd Bergmann .reg_bits = 16, 76a50067d4SArnd Bergmann .val_bits = 16, 77a50067d4SArnd Bergmann .max_register = RT5682_I2C_MODE, 78a50067d4SArnd Bergmann .volatile_reg = rt5682_volatile_register, 79a50067d4SArnd Bergmann .readable_reg = rt5682_readable_register, 80a50067d4SArnd Bergmann .cache_type = REGCACHE_RBTREE, 81a50067d4SArnd Bergmann .reg_defaults = rt5682_reg, 82a50067d4SArnd Bergmann .num_reg_defaults = RT5682_REG_NUM, 83a50067d4SArnd Bergmann .use_single_read = true, 84a50067d4SArnd Bergmann .use_single_write = true, 85a50067d4SArnd Bergmann .reg_read = rt5682_sdw_read, 86a50067d4SArnd Bergmann .reg_write = rt5682_sdw_write, 87a50067d4SArnd Bergmann }; 88a50067d4SArnd Bergmann 89a50067d4SArnd Bergmann struct sdw_stream_data { 90a50067d4SArnd Bergmann struct sdw_stream_runtime *sdw_stream; 91a50067d4SArnd Bergmann }; 92a50067d4SArnd Bergmann 93a50067d4SArnd Bergmann static int rt5682_set_sdw_stream(struct snd_soc_dai *dai, void *sdw_stream, 94a50067d4SArnd Bergmann int direction) 95a50067d4SArnd Bergmann { 96a50067d4SArnd Bergmann struct sdw_stream_data *stream; 97a50067d4SArnd Bergmann 98a50067d4SArnd Bergmann if (!sdw_stream) 99a50067d4SArnd Bergmann return 0; 100a50067d4SArnd Bergmann 101a50067d4SArnd Bergmann stream = kzalloc(sizeof(*stream), GFP_KERNEL); 102a50067d4SArnd Bergmann if (!stream) 103a50067d4SArnd Bergmann return -ENOMEM; 104a50067d4SArnd Bergmann 105a50067d4SArnd Bergmann stream->sdw_stream = (struct sdw_stream_runtime *)sdw_stream; 106a50067d4SArnd Bergmann 107a50067d4SArnd Bergmann /* Use tx_mask or rx_mask to configure stream tag and set dma_data */ 108a50067d4SArnd Bergmann if (direction == SNDRV_PCM_STREAM_PLAYBACK) 109a50067d4SArnd Bergmann dai->playback_dma_data = stream; 110a50067d4SArnd Bergmann else 111a50067d4SArnd Bergmann dai->capture_dma_data = stream; 112a50067d4SArnd Bergmann 113a50067d4SArnd Bergmann return 0; 114a50067d4SArnd Bergmann } 115a50067d4SArnd Bergmann 116a50067d4SArnd Bergmann static void rt5682_sdw_shutdown(struct snd_pcm_substream *substream, 117a50067d4SArnd Bergmann struct snd_soc_dai *dai) 118a50067d4SArnd Bergmann { 119a50067d4SArnd Bergmann struct sdw_stream_data *stream; 120a50067d4SArnd Bergmann 121a50067d4SArnd Bergmann stream = snd_soc_dai_get_dma_data(dai, substream); 122a50067d4SArnd Bergmann snd_soc_dai_set_dma_data(dai, substream, NULL); 123a50067d4SArnd Bergmann kfree(stream); 124a50067d4SArnd Bergmann } 125a50067d4SArnd Bergmann 126a50067d4SArnd Bergmann static int rt5682_sdw_hw_params(struct snd_pcm_substream *substream, 127a50067d4SArnd Bergmann struct snd_pcm_hw_params *params, 128a50067d4SArnd Bergmann struct snd_soc_dai *dai) 129a50067d4SArnd Bergmann { 130a50067d4SArnd Bergmann struct snd_soc_component *component = dai->component; 131a50067d4SArnd Bergmann struct rt5682_priv *rt5682 = snd_soc_component_get_drvdata(component); 132a50067d4SArnd Bergmann struct sdw_stream_config stream_config; 133a50067d4SArnd Bergmann struct sdw_port_config port_config; 134a50067d4SArnd Bergmann enum sdw_data_direction direction; 135a50067d4SArnd Bergmann struct sdw_stream_data *stream; 136a50067d4SArnd Bergmann int retval, port, num_channels; 137a50067d4SArnd Bergmann unsigned int val_p = 0, val_c = 0, osr_p = 0, osr_c = 0; 138a50067d4SArnd Bergmann 139a50067d4SArnd Bergmann dev_dbg(dai->dev, "%s %s", __func__, dai->name); 140a50067d4SArnd Bergmann 141a50067d4SArnd Bergmann stream = snd_soc_dai_get_dma_data(dai, substream); 142a50067d4SArnd Bergmann if (!stream) 143a50067d4SArnd Bergmann return -ENOMEM; 144a50067d4SArnd Bergmann 145a50067d4SArnd Bergmann if (!rt5682->slave) 146a50067d4SArnd Bergmann return -EINVAL; 147a50067d4SArnd Bergmann 148a50067d4SArnd Bergmann /* SoundWire specific configuration */ 149a50067d4SArnd Bergmann if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 150a50067d4SArnd Bergmann direction = SDW_DATA_DIR_RX; 151a50067d4SArnd Bergmann port = 1; 152a50067d4SArnd Bergmann } else { 153a50067d4SArnd Bergmann direction = SDW_DATA_DIR_TX; 154a50067d4SArnd Bergmann port = 2; 155a50067d4SArnd Bergmann } 156a50067d4SArnd Bergmann 157a50067d4SArnd Bergmann stream_config.frame_rate = params_rate(params); 158a50067d4SArnd Bergmann stream_config.ch_count = params_channels(params); 159a50067d4SArnd Bergmann stream_config.bps = snd_pcm_format_width(params_format(params)); 160a50067d4SArnd Bergmann stream_config.direction = direction; 161a50067d4SArnd Bergmann 162a50067d4SArnd Bergmann num_channels = params_channels(params); 163a50067d4SArnd Bergmann port_config.ch_mask = (1 << (num_channels)) - 1; 164a50067d4SArnd Bergmann port_config.num = port; 165a50067d4SArnd Bergmann 166a50067d4SArnd Bergmann retval = sdw_stream_add_slave(rt5682->slave, &stream_config, 167a50067d4SArnd Bergmann &port_config, 1, stream->sdw_stream); 168a50067d4SArnd Bergmann if (retval) { 169a50067d4SArnd Bergmann dev_err(dai->dev, "Unable to configure port\n"); 170a50067d4SArnd Bergmann return retval; 171a50067d4SArnd Bergmann } 172a50067d4SArnd Bergmann 173a50067d4SArnd Bergmann switch (params_rate(params)) { 174a50067d4SArnd Bergmann case 48000: 175a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_48K; 176a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_48K; 177a50067d4SArnd Bergmann break; 178a50067d4SArnd Bergmann case 96000: 179a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_96K; 180a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_96K; 181a50067d4SArnd Bergmann break; 182a50067d4SArnd Bergmann case 192000: 183a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_192K; 184a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_192K; 185a50067d4SArnd Bergmann break; 186a50067d4SArnd Bergmann case 32000: 187a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_32K; 188a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_32K; 189a50067d4SArnd Bergmann break; 190a50067d4SArnd Bergmann case 24000: 191a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_24K; 192a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_24K; 193a50067d4SArnd Bergmann break; 194a50067d4SArnd Bergmann case 16000: 195a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_16K; 196a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_16K; 197a50067d4SArnd Bergmann break; 198a50067d4SArnd Bergmann case 12000: 199a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_12K; 200a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_12K; 201a50067d4SArnd Bergmann break; 202a50067d4SArnd Bergmann case 8000: 203a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_8K; 204a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_8K; 205a50067d4SArnd Bergmann break; 206a50067d4SArnd Bergmann case 44100: 207a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_44K; 208a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_44K; 209a50067d4SArnd Bergmann break; 210a50067d4SArnd Bergmann case 88200: 211a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_88K; 212a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_88K; 213a50067d4SArnd Bergmann break; 214a50067d4SArnd Bergmann case 176400: 215a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_176K; 216a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_176K; 217a50067d4SArnd Bergmann break; 218a50067d4SArnd Bergmann case 22050: 219a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_22K; 220a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_22K; 221a50067d4SArnd Bergmann break; 222a50067d4SArnd Bergmann case 11025: 223a50067d4SArnd Bergmann val_p = RT5682_SDW_REF_1_11K; 224a50067d4SArnd Bergmann val_c = RT5682_SDW_REF_2_11K; 225a50067d4SArnd Bergmann break; 226a50067d4SArnd Bergmann default: 227a50067d4SArnd Bergmann return -EINVAL; 228a50067d4SArnd Bergmann } 229a50067d4SArnd Bergmann 230a50067d4SArnd Bergmann if (params_rate(params) <= 48000) { 231a50067d4SArnd Bergmann osr_p = RT5682_DAC_OSR_D_8; 232a50067d4SArnd Bergmann osr_c = RT5682_ADC_OSR_D_8; 233a50067d4SArnd Bergmann } else if (params_rate(params) <= 96000) { 234a50067d4SArnd Bergmann osr_p = RT5682_DAC_OSR_D_4; 235a50067d4SArnd Bergmann osr_c = RT5682_ADC_OSR_D_4; 236a50067d4SArnd Bergmann } else { 237a50067d4SArnd Bergmann osr_p = RT5682_DAC_OSR_D_2; 238a50067d4SArnd Bergmann osr_c = RT5682_ADC_OSR_D_2; 239a50067d4SArnd Bergmann } 240a50067d4SArnd Bergmann 241a50067d4SArnd Bergmann if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 242a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_SDW_REF_CLK, 243a50067d4SArnd Bergmann RT5682_SDW_REF_1_MASK, val_p); 244a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_ADDA_CLK_1, 245a50067d4SArnd Bergmann RT5682_DAC_OSR_MASK, osr_p); 246a50067d4SArnd Bergmann } else { 247a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_SDW_REF_CLK, 248a50067d4SArnd Bergmann RT5682_SDW_REF_2_MASK, val_c); 249a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_ADDA_CLK_1, 250a50067d4SArnd Bergmann RT5682_ADC_OSR_MASK, osr_c); 251a50067d4SArnd Bergmann } 252a50067d4SArnd Bergmann 253a50067d4SArnd Bergmann return retval; 254a50067d4SArnd Bergmann } 255a50067d4SArnd Bergmann 256a50067d4SArnd Bergmann static int rt5682_sdw_hw_free(struct snd_pcm_substream *substream, 257a50067d4SArnd Bergmann struct snd_soc_dai *dai) 258a50067d4SArnd Bergmann { 259a50067d4SArnd Bergmann struct snd_soc_component *component = dai->component; 260a50067d4SArnd Bergmann struct rt5682_priv *rt5682 = snd_soc_component_get_drvdata(component); 261a50067d4SArnd Bergmann struct sdw_stream_data *stream = 262a50067d4SArnd Bergmann snd_soc_dai_get_dma_data(dai, substream); 263a50067d4SArnd Bergmann 264a50067d4SArnd Bergmann if (!rt5682->slave) 265a50067d4SArnd Bergmann return -EINVAL; 266a50067d4SArnd Bergmann 267a50067d4SArnd Bergmann sdw_stream_remove_slave(rt5682->slave, stream->sdw_stream); 268a50067d4SArnd Bergmann return 0; 269a50067d4SArnd Bergmann } 270a50067d4SArnd Bergmann 271a50067d4SArnd Bergmann static struct snd_soc_dai_ops rt5682_sdw_ops = { 272a50067d4SArnd Bergmann .hw_params = rt5682_sdw_hw_params, 273a50067d4SArnd Bergmann .hw_free = rt5682_sdw_hw_free, 274a50067d4SArnd Bergmann .set_sdw_stream = rt5682_set_sdw_stream, 275a50067d4SArnd Bergmann .shutdown = rt5682_sdw_shutdown, 276a50067d4SArnd Bergmann }; 277a50067d4SArnd Bergmann 278a50067d4SArnd Bergmann static struct snd_soc_dai_driver rt5682_dai[] = { 279a50067d4SArnd Bergmann { 280a50067d4SArnd Bergmann .name = "rt5682-aif1", 281a50067d4SArnd Bergmann .id = RT5682_AIF1, 282a50067d4SArnd Bergmann .playback = { 283a50067d4SArnd Bergmann .stream_name = "AIF1 Playback", 284a50067d4SArnd Bergmann .channels_min = 1, 285a50067d4SArnd Bergmann .channels_max = 2, 286a50067d4SArnd Bergmann .rates = RT5682_STEREO_RATES, 287a50067d4SArnd Bergmann .formats = RT5682_FORMATS, 288a50067d4SArnd Bergmann }, 289a50067d4SArnd Bergmann .capture = { 290a50067d4SArnd Bergmann .stream_name = "AIF1 Capture", 291a50067d4SArnd Bergmann .channels_min = 1, 292a50067d4SArnd Bergmann .channels_max = 2, 293a50067d4SArnd Bergmann .rates = RT5682_STEREO_RATES, 294a50067d4SArnd Bergmann .formats = RT5682_FORMATS, 295a50067d4SArnd Bergmann }, 296a50067d4SArnd Bergmann .ops = &rt5682_aif1_dai_ops, 297a50067d4SArnd Bergmann }, 298a50067d4SArnd Bergmann { 299a50067d4SArnd Bergmann .name = "rt5682-aif2", 300a50067d4SArnd Bergmann .id = RT5682_AIF2, 301a50067d4SArnd Bergmann .capture = { 302a50067d4SArnd Bergmann .stream_name = "AIF2 Capture", 303a50067d4SArnd Bergmann .channels_min = 1, 304a50067d4SArnd Bergmann .channels_max = 2, 305a50067d4SArnd Bergmann .rates = RT5682_STEREO_RATES, 306a50067d4SArnd Bergmann .formats = RT5682_FORMATS, 307a50067d4SArnd Bergmann }, 308a50067d4SArnd Bergmann .ops = &rt5682_aif2_dai_ops, 309a50067d4SArnd Bergmann }, 310a50067d4SArnd Bergmann { 311a50067d4SArnd Bergmann .name = "rt5682-sdw", 312a50067d4SArnd Bergmann .id = RT5682_SDW, 313a50067d4SArnd Bergmann .playback = { 314a50067d4SArnd Bergmann .stream_name = "SDW Playback", 315a50067d4SArnd Bergmann .channels_min = 1, 316a50067d4SArnd Bergmann .channels_max = 2, 317a50067d4SArnd Bergmann .rates = RT5682_STEREO_RATES, 318a50067d4SArnd Bergmann .formats = RT5682_FORMATS, 319a50067d4SArnd Bergmann }, 320a50067d4SArnd Bergmann .capture = { 321a50067d4SArnd Bergmann .stream_name = "SDW Capture", 322a50067d4SArnd Bergmann .channels_min = 1, 323a50067d4SArnd Bergmann .channels_max = 2, 324a50067d4SArnd Bergmann .rates = RT5682_STEREO_RATES, 325a50067d4SArnd Bergmann .formats = RT5682_FORMATS, 326a50067d4SArnd Bergmann }, 327a50067d4SArnd Bergmann .ops = &rt5682_sdw_ops, 328a50067d4SArnd Bergmann }, 329a50067d4SArnd Bergmann }; 330a50067d4SArnd Bergmann 331a50067d4SArnd Bergmann static int rt5682_sdw_init(struct device *dev, struct regmap *regmap, 332a50067d4SArnd Bergmann struct sdw_slave *slave) 333a50067d4SArnd Bergmann { 334a50067d4SArnd Bergmann struct rt5682_priv *rt5682; 335a50067d4SArnd Bergmann int ret; 336a50067d4SArnd Bergmann 337a50067d4SArnd Bergmann rt5682 = devm_kzalloc(dev, sizeof(*rt5682), GFP_KERNEL); 338a50067d4SArnd Bergmann if (!rt5682) 339a50067d4SArnd Bergmann return -ENOMEM; 340a50067d4SArnd Bergmann 341a50067d4SArnd Bergmann dev_set_drvdata(dev, rt5682); 342a50067d4SArnd Bergmann rt5682->slave = slave; 343a50067d4SArnd Bergmann rt5682->sdw_regmap = regmap; 344a50067d4SArnd Bergmann rt5682->is_sdw = true; 345a50067d4SArnd Bergmann 346a50067d4SArnd Bergmann rt5682->regmap = devm_regmap_init(dev, NULL, dev, 347a50067d4SArnd Bergmann &rt5682_sdw_indirect_regmap); 348a50067d4SArnd Bergmann if (IS_ERR(rt5682->regmap)) { 349a50067d4SArnd Bergmann ret = PTR_ERR(rt5682->regmap); 350a50067d4SArnd Bergmann dev_err(dev, "Failed to allocate register map: %d\n", 351a50067d4SArnd Bergmann ret); 352a50067d4SArnd Bergmann return ret; 353a50067d4SArnd Bergmann } 354a50067d4SArnd Bergmann 355a50067d4SArnd Bergmann /* 356a50067d4SArnd Bergmann * Mark hw_init to false 357a50067d4SArnd Bergmann * HW init will be performed when device reports present 358a50067d4SArnd Bergmann */ 359a50067d4SArnd Bergmann rt5682->hw_init = false; 360a50067d4SArnd Bergmann rt5682->first_hw_init = false; 361a50067d4SArnd Bergmann 362a50067d4SArnd Bergmann mutex_init(&rt5682->calibrate_mutex); 363a50067d4SArnd Bergmann INIT_DELAYED_WORK(&rt5682->jack_detect_work, 364a50067d4SArnd Bergmann rt5682_jack_detect_handler); 365a50067d4SArnd Bergmann 366a50067d4SArnd Bergmann ret = devm_snd_soc_register_component(dev, 367a50067d4SArnd Bergmann &rt5682_soc_component_dev, 368a50067d4SArnd Bergmann rt5682_dai, ARRAY_SIZE(rt5682_dai)); 369a50067d4SArnd Bergmann dev_dbg(&slave->dev, "%s\n", __func__); 370a50067d4SArnd Bergmann 371a50067d4SArnd Bergmann return ret; 372a50067d4SArnd Bergmann } 373a50067d4SArnd Bergmann 374a50067d4SArnd Bergmann static int rt5682_io_init(struct device *dev, struct sdw_slave *slave) 375a50067d4SArnd Bergmann { 376a50067d4SArnd Bergmann struct rt5682_priv *rt5682 = dev_get_drvdata(dev); 377a50067d4SArnd Bergmann int ret = 0; 378a50067d4SArnd Bergmann unsigned int val; 379a50067d4SArnd Bergmann 380a50067d4SArnd Bergmann if (rt5682->hw_init) 381a50067d4SArnd Bergmann return 0; 382a50067d4SArnd Bergmann 383a50067d4SArnd Bergmann regmap_read(rt5682->regmap, RT5682_DEVICE_ID, &val); 384a50067d4SArnd Bergmann if (val != DEVICE_ID) { 385a50067d4SArnd Bergmann dev_err(dev, "Device with ID register %x is not rt5682\n", val); 386a50067d4SArnd Bergmann return -ENODEV; 387a50067d4SArnd Bergmann } 388a50067d4SArnd Bergmann 389a50067d4SArnd Bergmann /* 390a50067d4SArnd Bergmann * PM runtime is only enabled when a Slave reports as Attached 391a50067d4SArnd Bergmann */ 392a50067d4SArnd Bergmann if (!rt5682->first_hw_init) { 393a50067d4SArnd Bergmann /* set autosuspend parameters */ 394a50067d4SArnd Bergmann pm_runtime_set_autosuspend_delay(&slave->dev, 3000); 395a50067d4SArnd Bergmann pm_runtime_use_autosuspend(&slave->dev); 396a50067d4SArnd Bergmann 397a50067d4SArnd Bergmann /* update count of parent 'active' children */ 398a50067d4SArnd Bergmann pm_runtime_set_active(&slave->dev); 399a50067d4SArnd Bergmann 400a50067d4SArnd Bergmann /* make sure the device does not suspend immediately */ 401a50067d4SArnd Bergmann pm_runtime_mark_last_busy(&slave->dev); 402a50067d4SArnd Bergmann 403a50067d4SArnd Bergmann pm_runtime_enable(&slave->dev); 404a50067d4SArnd Bergmann } 405a50067d4SArnd Bergmann 406a50067d4SArnd Bergmann pm_runtime_get_noresume(&slave->dev); 407a50067d4SArnd Bergmann 408a50067d4SArnd Bergmann if (rt5682->first_hw_init) { 409a50067d4SArnd Bergmann regcache_cache_only(rt5682->regmap, false); 410a50067d4SArnd Bergmann regcache_cache_bypass(rt5682->regmap, true); 411a50067d4SArnd Bergmann } 412a50067d4SArnd Bergmann 413a50067d4SArnd Bergmann rt5682_calibrate(rt5682); 414a50067d4SArnd Bergmann 415a50067d4SArnd Bergmann if (rt5682->first_hw_init) { 416a50067d4SArnd Bergmann regcache_cache_bypass(rt5682->regmap, false); 417a50067d4SArnd Bergmann regcache_mark_dirty(rt5682->regmap); 418a50067d4SArnd Bergmann regcache_sync(rt5682->regmap); 419a50067d4SArnd Bergmann 420a50067d4SArnd Bergmann /* volatile registers */ 421a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_CBJ_CTRL_2, 422a50067d4SArnd Bergmann RT5682_EXT_JD_SRC, RT5682_EXT_JD_SRC_MANUAL); 423a50067d4SArnd Bergmann 424a50067d4SArnd Bergmann goto reinit; 425a50067d4SArnd Bergmann } 426a50067d4SArnd Bergmann 427a50067d4SArnd Bergmann rt5682_apply_patch_list(rt5682, dev); 428a50067d4SArnd Bergmann 429a50067d4SArnd Bergmann regmap_write(rt5682->regmap, RT5682_DEPOP_1, 0x0000); 430a50067d4SArnd Bergmann 431a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_PWR_ANLG_1, 432a50067d4SArnd Bergmann RT5682_LDO1_DVO_MASK | RT5682_HP_DRIVER_MASK, 433a50067d4SArnd Bergmann RT5682_LDO1_DVO_12 | RT5682_HP_DRIVER_5X); 434*6301adf9SShuming Fan regmap_write(rt5682->regmap, RT5682_MICBIAS_2, 0x0080); 435a50067d4SArnd Bergmann regmap_write(rt5682->regmap, RT5682_TEST_MODE_CTRL_1, 0x0000); 436a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_BIAS_CUR_CTRL_8, 437a50067d4SArnd Bergmann RT5682_HPA_CP_BIAS_CTRL_MASK, RT5682_HPA_CP_BIAS_3UA); 438a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_CHARGE_PUMP_1, 439a50067d4SArnd Bergmann RT5682_CP_CLK_HP_MASK, RT5682_CP_CLK_HP_300KHZ); 440a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_HP_CHARGE_PUMP_1, 441a50067d4SArnd Bergmann RT5682_PM_HP_MASK, RT5682_PM_HP_HV); 442a50067d4SArnd Bergmann 443a50067d4SArnd Bergmann /* Soundwire */ 444a50067d4SArnd Bergmann regmap_write(rt5682->regmap, RT5682_PLL2_INTERNAL, 0xa266); 445a50067d4SArnd Bergmann regmap_write(rt5682->regmap, RT5682_PLL2_CTRL_1, 0x1700); 446a50067d4SArnd Bergmann regmap_write(rt5682->regmap, RT5682_PLL2_CTRL_2, 0x0006); 447a50067d4SArnd Bergmann regmap_write(rt5682->regmap, RT5682_PLL2_CTRL_3, 0x2600); 448a50067d4SArnd Bergmann regmap_write(rt5682->regmap, RT5682_PLL2_CTRL_4, 0x0c8f); 449a50067d4SArnd Bergmann regmap_write(rt5682->regmap, RT5682_PLL_TRACK_2, 0x3000); 450a50067d4SArnd Bergmann regmap_write(rt5682->regmap, RT5682_PLL_TRACK_3, 0x4000); 451a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_GLB_CLK, 452a50067d4SArnd Bergmann RT5682_SCLK_SRC_MASK | RT5682_PLL2_SRC_MASK, 453a50067d4SArnd Bergmann RT5682_SCLK_SRC_PLL2 | RT5682_PLL2_SRC_SDW); 454a50067d4SArnd Bergmann 455a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_CBJ_CTRL_2, 456a50067d4SArnd Bergmann RT5682_EXT_JD_SRC, RT5682_EXT_JD_SRC_MANUAL); 457a50067d4SArnd Bergmann regmap_write(rt5682->regmap, RT5682_CBJ_CTRL_1, 0xd042); 458a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_CBJ_CTRL_3, 459a50067d4SArnd Bergmann RT5682_CBJ_IN_BUF_EN, RT5682_CBJ_IN_BUF_EN); 460a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_SAR_IL_CMD_1, 461a50067d4SArnd Bergmann RT5682_SAR_POW_MASK, RT5682_SAR_POW_EN); 462a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_RC_CLK_CTRL, 463a50067d4SArnd Bergmann RT5682_POW_IRQ | RT5682_POW_JDH | 464a50067d4SArnd Bergmann RT5682_POW_ANA, RT5682_POW_IRQ | 465a50067d4SArnd Bergmann RT5682_POW_JDH | RT5682_POW_ANA); 466a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_PWR_ANLG_2, 467a50067d4SArnd Bergmann RT5682_PWR_JDH, RT5682_PWR_JDH); 468a50067d4SArnd Bergmann regmap_update_bits(rt5682->regmap, RT5682_IRQ_CTRL_2, 469a50067d4SArnd Bergmann RT5682_JD1_EN_MASK | RT5682_JD1_IRQ_MASK, 470a50067d4SArnd Bergmann RT5682_JD1_EN | RT5682_JD1_IRQ_PUL); 471a50067d4SArnd Bergmann 472a50067d4SArnd Bergmann reinit: 473a50067d4SArnd Bergmann mod_delayed_work(system_power_efficient_wq, 474a50067d4SArnd Bergmann &rt5682->jack_detect_work, msecs_to_jiffies(250)); 475a50067d4SArnd Bergmann 476a50067d4SArnd Bergmann /* Mark Slave initialization complete */ 477a50067d4SArnd Bergmann rt5682->hw_init = true; 478a50067d4SArnd Bergmann rt5682->first_hw_init = true; 479a50067d4SArnd Bergmann 480a50067d4SArnd Bergmann pm_runtime_mark_last_busy(&slave->dev); 481a50067d4SArnd Bergmann pm_runtime_put_autosuspend(&slave->dev); 482a50067d4SArnd Bergmann 483a50067d4SArnd Bergmann dev_dbg(&slave->dev, "%s hw_init complete\n", __func__); 484a50067d4SArnd Bergmann 485a50067d4SArnd Bergmann return ret; 486a50067d4SArnd Bergmann } 48703f6fc6dSOder Chiou 48803f6fc6dSOder Chiou static bool rt5682_sdw_readable_register(struct device *dev, unsigned int reg) 48903f6fc6dSOder Chiou { 49003f6fc6dSOder Chiou switch (reg) { 49103f6fc6dSOder Chiou case 0x00e0: 49203f6fc6dSOder Chiou case 0x00f0: 49303f6fc6dSOder Chiou case 0x3000: 49403f6fc6dSOder Chiou case 0x3001: 49503f6fc6dSOder Chiou case 0x3004: 49603f6fc6dSOder Chiou case 0x3005: 49703f6fc6dSOder Chiou case 0x3008: 49803f6fc6dSOder Chiou return true; 49903f6fc6dSOder Chiou default: 50003f6fc6dSOder Chiou return false; 50103f6fc6dSOder Chiou } 50203f6fc6dSOder Chiou } 50303f6fc6dSOder Chiou 504a50067d4SArnd Bergmann static const struct regmap_config rt5682_sdw_regmap = { 50503f6fc6dSOder Chiou .name = "sdw", 50603f6fc6dSOder Chiou .reg_bits = 32, 50703f6fc6dSOder Chiou .val_bits = 8, 50803f6fc6dSOder Chiou .max_register = RT5682_I2C_MODE, 50903f6fc6dSOder Chiou .readable_reg = rt5682_sdw_readable_register, 51003f6fc6dSOder Chiou .cache_type = REGCACHE_NONE, 51103f6fc6dSOder Chiou .use_single_read = true, 51203f6fc6dSOder Chiou .use_single_write = true, 51303f6fc6dSOder Chiou }; 51403f6fc6dSOder Chiou 51503f6fc6dSOder Chiou static int rt5682_update_status(struct sdw_slave *slave, 51603f6fc6dSOder Chiou enum sdw_slave_status status) 51703f6fc6dSOder Chiou { 51803f6fc6dSOder Chiou struct rt5682_priv *rt5682 = dev_get_drvdata(&slave->dev); 51903f6fc6dSOder Chiou 52003f6fc6dSOder Chiou /* Update the status */ 52103f6fc6dSOder Chiou rt5682->status = status; 52203f6fc6dSOder Chiou 52303f6fc6dSOder Chiou if (status == SDW_SLAVE_UNATTACHED) 52403f6fc6dSOder Chiou rt5682->hw_init = false; 52503f6fc6dSOder Chiou 52603f6fc6dSOder Chiou /* 52703f6fc6dSOder Chiou * Perform initialization only if slave status is present and 52803f6fc6dSOder Chiou * hw_init flag is false 52903f6fc6dSOder Chiou */ 53003f6fc6dSOder Chiou if (rt5682->hw_init || rt5682->status != SDW_SLAVE_ATTACHED) 53103f6fc6dSOder Chiou return 0; 53203f6fc6dSOder Chiou 53303f6fc6dSOder Chiou /* perform I/O transfers required for Slave initialization */ 53403f6fc6dSOder Chiou return rt5682_io_init(&slave->dev, slave); 53503f6fc6dSOder Chiou } 53603f6fc6dSOder Chiou 53703f6fc6dSOder Chiou static int rt5682_read_prop(struct sdw_slave *slave) 53803f6fc6dSOder Chiou { 53903f6fc6dSOder Chiou struct sdw_slave_prop *prop = &slave->prop; 54003f6fc6dSOder Chiou int nval, i, num_of_ports = 1; 54103f6fc6dSOder Chiou u32 bit; 54203f6fc6dSOder Chiou unsigned long addr; 54303f6fc6dSOder Chiou struct sdw_dpn_prop *dpn; 54403f6fc6dSOder Chiou 54503f6fc6dSOder Chiou prop->paging_support = false; 54603f6fc6dSOder Chiou 54703f6fc6dSOder Chiou /* first we need to allocate memory for set bits in port lists */ 54803f6fc6dSOder Chiou prop->source_ports = 0x4; /* BITMAP: 00000100 */ 54903f6fc6dSOder Chiou prop->sink_ports = 0x2; /* BITMAP: 00000010 */ 55003f6fc6dSOder Chiou 55103f6fc6dSOder Chiou nval = hweight32(prop->source_ports); 55203f6fc6dSOder Chiou num_of_ports += nval; 55303f6fc6dSOder Chiou prop->src_dpn_prop = devm_kcalloc(&slave->dev, nval, 55403f6fc6dSOder Chiou sizeof(*prop->src_dpn_prop), 55503f6fc6dSOder Chiou GFP_KERNEL); 55603f6fc6dSOder Chiou if (!prop->src_dpn_prop) 55703f6fc6dSOder Chiou return -ENOMEM; 55803f6fc6dSOder Chiou 55903f6fc6dSOder Chiou i = 0; 56003f6fc6dSOder Chiou dpn = prop->src_dpn_prop; 56103f6fc6dSOder Chiou addr = prop->source_ports; 56203f6fc6dSOder Chiou for_each_set_bit(bit, &addr, 32) { 56303f6fc6dSOder Chiou dpn[i].num = bit; 56403f6fc6dSOder Chiou dpn[i].type = SDW_DPN_FULL; 56503f6fc6dSOder Chiou dpn[i].simple_ch_prep_sm = true; 56603f6fc6dSOder Chiou dpn[i].ch_prep_timeout = 10; 56703f6fc6dSOder Chiou i++; 56803f6fc6dSOder Chiou } 56903f6fc6dSOder Chiou 57003f6fc6dSOder Chiou /* do this again for sink now */ 57103f6fc6dSOder Chiou nval = hweight32(prop->sink_ports); 57203f6fc6dSOder Chiou num_of_ports += nval; 57303f6fc6dSOder Chiou prop->sink_dpn_prop = devm_kcalloc(&slave->dev, nval, 57403f6fc6dSOder Chiou sizeof(*prop->sink_dpn_prop), 57503f6fc6dSOder Chiou GFP_KERNEL); 57603f6fc6dSOder Chiou if (!prop->sink_dpn_prop) 57703f6fc6dSOder Chiou return -ENOMEM; 57803f6fc6dSOder Chiou 57903f6fc6dSOder Chiou i = 0; 58003f6fc6dSOder Chiou dpn = prop->sink_dpn_prop; 58103f6fc6dSOder Chiou addr = prop->sink_ports; 58203f6fc6dSOder Chiou for_each_set_bit(bit, &addr, 32) { 58303f6fc6dSOder Chiou dpn[i].num = bit; 58403f6fc6dSOder Chiou dpn[i].type = SDW_DPN_FULL; 58503f6fc6dSOder Chiou dpn[i].simple_ch_prep_sm = true; 58603f6fc6dSOder Chiou dpn[i].ch_prep_timeout = 10; 58703f6fc6dSOder Chiou i++; 58803f6fc6dSOder Chiou } 58903f6fc6dSOder Chiou 59003f6fc6dSOder Chiou /* Allocate port_ready based on num_of_ports */ 59103f6fc6dSOder Chiou slave->port_ready = devm_kcalloc(&slave->dev, num_of_ports, 59203f6fc6dSOder Chiou sizeof(*slave->port_ready), 59303f6fc6dSOder Chiou GFP_KERNEL); 59403f6fc6dSOder Chiou if (!slave->port_ready) 59503f6fc6dSOder Chiou return -ENOMEM; 59603f6fc6dSOder Chiou 59703f6fc6dSOder Chiou /* Initialize completion */ 59803f6fc6dSOder Chiou for (i = 0; i < num_of_ports; i++) 59903f6fc6dSOder Chiou init_completion(&slave->port_ready[i]); 60003f6fc6dSOder Chiou 60103f6fc6dSOder Chiou /* set the timeout values */ 60203f6fc6dSOder Chiou prop->clk_stop_timeout = 20; 60303f6fc6dSOder Chiou 60403f6fc6dSOder Chiou /* wake-up event */ 60503f6fc6dSOder Chiou prop->wake_capable = 1; 60603f6fc6dSOder Chiou 60703f6fc6dSOder Chiou return 0; 60803f6fc6dSOder Chiou } 60903f6fc6dSOder Chiou 61003f6fc6dSOder Chiou /* Bus clock frequency */ 61103f6fc6dSOder Chiou #define RT5682_CLK_FREQ_9600000HZ 9600000 61203f6fc6dSOder Chiou #define RT5682_CLK_FREQ_12000000HZ 12000000 61303f6fc6dSOder Chiou #define RT5682_CLK_FREQ_6000000HZ 6000000 61403f6fc6dSOder Chiou #define RT5682_CLK_FREQ_4800000HZ 4800000 61503f6fc6dSOder Chiou #define RT5682_CLK_FREQ_2400000HZ 2400000 61603f6fc6dSOder Chiou #define RT5682_CLK_FREQ_12288000HZ 12288000 61703f6fc6dSOder Chiou 618a3c2e894SYueHaibing static int rt5682_clock_config(struct device *dev) 61903f6fc6dSOder Chiou { 62003f6fc6dSOder Chiou struct rt5682_priv *rt5682 = dev_get_drvdata(dev); 62103f6fc6dSOder Chiou unsigned int clk_freq, value; 62203f6fc6dSOder Chiou 62303f6fc6dSOder Chiou clk_freq = (rt5682->params.curr_dr_freq >> 1); 62403f6fc6dSOder Chiou 62503f6fc6dSOder Chiou switch (clk_freq) { 62603f6fc6dSOder Chiou case RT5682_CLK_FREQ_12000000HZ: 62703f6fc6dSOder Chiou value = 0x0; 62803f6fc6dSOder Chiou break; 62903f6fc6dSOder Chiou case RT5682_CLK_FREQ_6000000HZ: 63003f6fc6dSOder Chiou value = 0x1; 63103f6fc6dSOder Chiou break; 63203f6fc6dSOder Chiou case RT5682_CLK_FREQ_9600000HZ: 63303f6fc6dSOder Chiou value = 0x2; 63403f6fc6dSOder Chiou break; 63503f6fc6dSOder Chiou case RT5682_CLK_FREQ_4800000HZ: 63603f6fc6dSOder Chiou value = 0x3; 63703f6fc6dSOder Chiou break; 63803f6fc6dSOder Chiou case RT5682_CLK_FREQ_2400000HZ: 63903f6fc6dSOder Chiou value = 0x4; 64003f6fc6dSOder Chiou break; 64103f6fc6dSOder Chiou case RT5682_CLK_FREQ_12288000HZ: 64203f6fc6dSOder Chiou value = 0x5; 64303f6fc6dSOder Chiou break; 64403f6fc6dSOder Chiou default: 64503f6fc6dSOder Chiou return -EINVAL; 64603f6fc6dSOder Chiou } 64703f6fc6dSOder Chiou 64803f6fc6dSOder Chiou regmap_write(rt5682->sdw_regmap, 0xe0, value); 64903f6fc6dSOder Chiou regmap_write(rt5682->sdw_regmap, 0xf0, value); 65003f6fc6dSOder Chiou 65103f6fc6dSOder Chiou dev_dbg(dev, "%s complete, clk_freq=%d\n", __func__, clk_freq); 65203f6fc6dSOder Chiou 65303f6fc6dSOder Chiou return 0; 65403f6fc6dSOder Chiou } 65503f6fc6dSOder Chiou 65603f6fc6dSOder Chiou static int rt5682_bus_config(struct sdw_slave *slave, 65703f6fc6dSOder Chiou struct sdw_bus_params *params) 65803f6fc6dSOder Chiou { 65903f6fc6dSOder Chiou struct rt5682_priv *rt5682 = dev_get_drvdata(&slave->dev); 66003f6fc6dSOder Chiou int ret; 66103f6fc6dSOder Chiou 66203f6fc6dSOder Chiou memcpy(&rt5682->params, params, sizeof(*params)); 66303f6fc6dSOder Chiou 66403f6fc6dSOder Chiou ret = rt5682_clock_config(&slave->dev); 66503f6fc6dSOder Chiou if (ret < 0) 66603f6fc6dSOder Chiou dev_err(&slave->dev, "Invalid clk config"); 66703f6fc6dSOder Chiou 66803f6fc6dSOder Chiou return ret; 66903f6fc6dSOder Chiou } 67003f6fc6dSOder Chiou 67103f6fc6dSOder Chiou static int rt5682_interrupt_callback(struct sdw_slave *slave, 67203f6fc6dSOder Chiou struct sdw_slave_intr_status *status) 67303f6fc6dSOder Chiou { 67403f6fc6dSOder Chiou struct rt5682_priv *rt5682 = dev_get_drvdata(&slave->dev); 67503f6fc6dSOder Chiou 67603f6fc6dSOder Chiou dev_dbg(&slave->dev, 67703f6fc6dSOder Chiou "%s control_port_stat=%x", __func__, status->control_port); 67803f6fc6dSOder Chiou 67903f6fc6dSOder Chiou if (status->control_port & 0x4) { 68003f6fc6dSOder Chiou mod_delayed_work(system_power_efficient_wq, 68103f6fc6dSOder Chiou &rt5682->jack_detect_work, msecs_to_jiffies(250)); 68203f6fc6dSOder Chiou } 68303f6fc6dSOder Chiou 68403f6fc6dSOder Chiou return 0; 68503f6fc6dSOder Chiou } 68603f6fc6dSOder Chiou 68703f6fc6dSOder Chiou static struct sdw_slave_ops rt5682_slave_ops = { 68803f6fc6dSOder Chiou .read_prop = rt5682_read_prop, 68903f6fc6dSOder Chiou .interrupt_callback = rt5682_interrupt_callback, 69003f6fc6dSOder Chiou .update_status = rt5682_update_status, 69103f6fc6dSOder Chiou .bus_config = rt5682_bus_config, 69203f6fc6dSOder Chiou }; 69303f6fc6dSOder Chiou 69403f6fc6dSOder Chiou static int rt5682_sdw_probe(struct sdw_slave *slave, 69503f6fc6dSOder Chiou const struct sdw_device_id *id) 69603f6fc6dSOder Chiou { 69703f6fc6dSOder Chiou struct regmap *regmap; 69803f6fc6dSOder Chiou 69903f6fc6dSOder Chiou /* Regmap Initialization */ 70003f6fc6dSOder Chiou regmap = devm_regmap_init_sdw(slave, &rt5682_sdw_regmap); 70103f6fc6dSOder Chiou if (IS_ERR(regmap)) 70203f6fc6dSOder Chiou return -EINVAL; 70303f6fc6dSOder Chiou 70403f6fc6dSOder Chiou rt5682_sdw_init(&slave->dev, regmap, slave); 70503f6fc6dSOder Chiou 70603f6fc6dSOder Chiou return 0; 70703f6fc6dSOder Chiou } 70803f6fc6dSOder Chiou 70903f6fc6dSOder Chiou static int rt5682_sdw_remove(struct sdw_slave *slave) 71003f6fc6dSOder Chiou { 71103f6fc6dSOder Chiou struct rt5682_priv *rt5682 = dev_get_drvdata(&slave->dev); 71203f6fc6dSOder Chiou 71303f6fc6dSOder Chiou if (rt5682 && rt5682->hw_init) 71403f6fc6dSOder Chiou cancel_delayed_work(&rt5682->jack_detect_work); 71503f6fc6dSOder Chiou 71603f6fc6dSOder Chiou return 0; 71703f6fc6dSOder Chiou } 71803f6fc6dSOder Chiou 71903f6fc6dSOder Chiou static const struct sdw_device_id rt5682_id[] = { 72003f6fc6dSOder Chiou SDW_SLAVE_ENTRY(0x025d, 0x5682, 0), 72103f6fc6dSOder Chiou {}, 72203f6fc6dSOder Chiou }; 72303f6fc6dSOder Chiou MODULE_DEVICE_TABLE(sdw, rt5682_id); 72403f6fc6dSOder Chiou 725724cc62fSPierre-Louis Bossart static int __maybe_unused rt5682_dev_suspend(struct device *dev) 72603f6fc6dSOder Chiou { 72703f6fc6dSOder Chiou struct rt5682_priv *rt5682 = dev_get_drvdata(dev); 72803f6fc6dSOder Chiou 72903f6fc6dSOder Chiou if (!rt5682->hw_init) 73003f6fc6dSOder Chiou return 0; 73103f6fc6dSOder Chiou 73203f6fc6dSOder Chiou regcache_cache_only(rt5682->regmap, true); 73303f6fc6dSOder Chiou regcache_mark_dirty(rt5682->regmap); 73403f6fc6dSOder Chiou 73503f6fc6dSOder Chiou return 0; 73603f6fc6dSOder Chiou } 73703f6fc6dSOder Chiou 738724cc62fSPierre-Louis Bossart static int __maybe_unused rt5682_dev_resume(struct device *dev) 73903f6fc6dSOder Chiou { 74003f6fc6dSOder Chiou struct sdw_slave *slave = dev_to_sdw_dev(dev); 74103f6fc6dSOder Chiou struct rt5682_priv *rt5682 = dev_get_drvdata(dev); 74203f6fc6dSOder Chiou unsigned long time; 74303f6fc6dSOder Chiou 74403f6fc6dSOder Chiou if (!rt5682->hw_init) 74503f6fc6dSOder Chiou return 0; 74603f6fc6dSOder Chiou 74703f6fc6dSOder Chiou if (!slave->unattach_request) 74803f6fc6dSOder Chiou goto regmap_sync; 74903f6fc6dSOder Chiou 75003f6fc6dSOder Chiou time = wait_for_completion_timeout(&slave->initialization_complete, 75103f6fc6dSOder Chiou msecs_to_jiffies(RT5682_PROBE_TIMEOUT)); 75203f6fc6dSOder Chiou if (!time) { 75303f6fc6dSOder Chiou dev_err(&slave->dev, "Initialization not complete, timed out\n"); 75403f6fc6dSOder Chiou return -ETIMEDOUT; 75503f6fc6dSOder Chiou } 75603f6fc6dSOder Chiou 75703f6fc6dSOder Chiou regmap_sync: 75803f6fc6dSOder Chiou slave->unattach_request = 0; 75903f6fc6dSOder Chiou regcache_cache_only(rt5682->regmap, false); 76003f6fc6dSOder Chiou regcache_sync(rt5682->regmap); 76103f6fc6dSOder Chiou 76203f6fc6dSOder Chiou return 0; 76303f6fc6dSOder Chiou } 76403f6fc6dSOder Chiou 76503f6fc6dSOder Chiou static const struct dev_pm_ops rt5682_pm = { 76603f6fc6dSOder Chiou SET_SYSTEM_SLEEP_PM_OPS(rt5682_dev_suspend, rt5682_dev_resume) 76703f6fc6dSOder Chiou SET_RUNTIME_PM_OPS(rt5682_dev_suspend, rt5682_dev_resume, NULL) 76803f6fc6dSOder Chiou }; 76903f6fc6dSOder Chiou 77003f6fc6dSOder Chiou static struct sdw_driver rt5682_sdw_driver = { 77103f6fc6dSOder Chiou .driver = { 77203f6fc6dSOder Chiou .name = "rt5682", 77303f6fc6dSOder Chiou .owner = THIS_MODULE, 77403f6fc6dSOder Chiou .pm = &rt5682_pm, 77503f6fc6dSOder Chiou }, 77603f6fc6dSOder Chiou .probe = rt5682_sdw_probe, 77703f6fc6dSOder Chiou .remove = rt5682_sdw_remove, 77803f6fc6dSOder Chiou .ops = &rt5682_slave_ops, 77903f6fc6dSOder Chiou .id_table = rt5682_id, 78003f6fc6dSOder Chiou }; 78103f6fc6dSOder Chiou module_sdw_driver(rt5682_sdw_driver); 78203f6fc6dSOder Chiou 78303f6fc6dSOder Chiou MODULE_DESCRIPTION("ASoC RT5682 driver SDW"); 78403f6fc6dSOder Chiou MODULE_AUTHOR("Oder Chiou <oder_chiou@realtek.com>"); 78503f6fc6dSOder Chiou MODULE_LICENSE("GPL v2"); 786