1320b8b0dSShuming Fan // SPDX-License-Identifier: GPL-2.0 2320b8b0dSShuming Fan // 3320b8b0dSShuming Fan // rt711-sdw.c -- rt711 ALSA SoC audio driver 4320b8b0dSShuming Fan // 5320b8b0dSShuming Fan // Copyright(c) 2019 Realtek Semiconductor Corp. 6320b8b0dSShuming Fan // 7320b8b0dSShuming Fan // 8320b8b0dSShuming Fan 9320b8b0dSShuming Fan #include <linux/delay.h> 10320b8b0dSShuming Fan #include <linux/device.h> 11320b8b0dSShuming Fan #include <linux/mod_devicetable.h> 12320b8b0dSShuming Fan #include <linux/soundwire/sdw.h> 13320b8b0dSShuming Fan #include <linux/soundwire/sdw_type.h> 142acd30b9SPierre-Louis Bossart #include <linux/soundwire/sdw_registers.h> 15320b8b0dSShuming Fan #include <linux/module.h> 16ac63716dSPierre-Louis Bossart #include <linux/pm_runtime.h> 17320b8b0dSShuming Fan #include <linux/regmap.h> 18320b8b0dSShuming Fan #include <sound/soc.h> 19320b8b0dSShuming Fan #include "rt711.h" 20320b8b0dSShuming Fan #include "rt711-sdw.h" 21320b8b0dSShuming Fan 22320b8b0dSShuming Fan static bool rt711_readable_register(struct device *dev, unsigned int reg) 23320b8b0dSShuming Fan { 24320b8b0dSShuming Fan switch (reg) { 25320b8b0dSShuming Fan case 0x00e0: 26320b8b0dSShuming Fan case 0x00f0: 27320b8b0dSShuming Fan case 0x2012 ... 0x2016: 28320b8b0dSShuming Fan case 0x201a ... 0x2027: 29320b8b0dSShuming Fan case 0x2029 ... 0x202a: 30320b8b0dSShuming Fan case 0x202d ... 0x2034: 31320b8b0dSShuming Fan case 0x2201 ... 0x2204: 32320b8b0dSShuming Fan case 0x2206 ... 0x2212: 33320b8b0dSShuming Fan case 0x2220 ... 0x2223: 34320b8b0dSShuming Fan case 0x2230 ... 0x2239: 35320b8b0dSShuming Fan case 0x2f01 ... 0x2f0f: 36320b8b0dSShuming Fan case 0x3000 ... 0x3fff: 37320b8b0dSShuming Fan case 0x7000 ... 0x7fff: 38320b8b0dSShuming Fan case 0x8300 ... 0x83ff: 39320b8b0dSShuming Fan case 0x9c00 ... 0x9cff: 40320b8b0dSShuming Fan case 0xb900 ... 0xb9ff: 41320b8b0dSShuming Fan case 0x752009: 42320b8b0dSShuming Fan case 0x752011: 43320b8b0dSShuming Fan case 0x75201a: 44320b8b0dSShuming Fan case 0x752045: 45320b8b0dSShuming Fan case 0x752046: 46320b8b0dSShuming Fan case 0x752048: 47320b8b0dSShuming Fan case 0x75204a: 48320b8b0dSShuming Fan case 0x75206b: 49320b8b0dSShuming Fan case 0x75206f: 50320b8b0dSShuming Fan case 0x752080: 51320b8b0dSShuming Fan case 0x752081: 52320b8b0dSShuming Fan case 0x752091: 53320b8b0dSShuming Fan case 0x755800: 54320b8b0dSShuming Fan return true; 55320b8b0dSShuming Fan default: 56320b8b0dSShuming Fan return false; 57320b8b0dSShuming Fan } 58320b8b0dSShuming Fan } 59320b8b0dSShuming Fan 60320b8b0dSShuming Fan static bool rt711_volatile_register(struct device *dev, unsigned int reg) 61320b8b0dSShuming Fan { 62320b8b0dSShuming Fan switch (reg) { 63320b8b0dSShuming Fan case 0x2016: 64320b8b0dSShuming Fan case 0x201b: 65320b8b0dSShuming Fan case 0x201c: 66320b8b0dSShuming Fan case 0x201d: 67320b8b0dSShuming Fan case 0x201f: 68320b8b0dSShuming Fan case 0x2021: 69320b8b0dSShuming Fan case 0x2023: 70320b8b0dSShuming Fan case 0x2230: 71320b8b0dSShuming Fan case 0x2012 ... 0x2015: /* HD-A read */ 72320b8b0dSShuming Fan case 0x202d ... 0x202f: /* BRA */ 73320b8b0dSShuming Fan case 0x2201 ... 0x2212: /* i2c debug */ 74320b8b0dSShuming Fan case 0x2220 ... 0x2223: /* decoded HD-A */ 75320b8b0dSShuming Fan case 0x9c00 ... 0x9cff: 76320b8b0dSShuming Fan case 0xb900 ... 0xb9ff: 77320b8b0dSShuming Fan case 0xff01: 78320b8b0dSShuming Fan case 0x75201a: 79320b8b0dSShuming Fan case 0x752046: 80320b8b0dSShuming Fan case 0x752080: 81320b8b0dSShuming Fan case 0x752081: 82320b8b0dSShuming Fan case 0x755800: 83320b8b0dSShuming Fan return true; 84320b8b0dSShuming Fan default: 85320b8b0dSShuming Fan return false; 86320b8b0dSShuming Fan } 87320b8b0dSShuming Fan } 88320b8b0dSShuming Fan 89320b8b0dSShuming Fan static int rt711_sdw_read(void *context, unsigned int reg, unsigned int *val) 90320b8b0dSShuming Fan { 91320b8b0dSShuming Fan struct device *dev = context; 92320b8b0dSShuming Fan struct rt711_priv *rt711 = dev_get_drvdata(dev); 93320b8b0dSShuming Fan unsigned int sdw_data_3, sdw_data_2, sdw_data_1, sdw_data_0; 94320b8b0dSShuming Fan unsigned int reg2 = 0, reg3 = 0, reg4 = 0, mask, nid, val2; 95320b8b0dSShuming Fan unsigned int is_hda_reg = 1, is_index_reg = 0; 96320b8b0dSShuming Fan int ret; 97320b8b0dSShuming Fan 98320b8b0dSShuming Fan if (reg > 0xffff) 99320b8b0dSShuming Fan is_index_reg = 1; 100320b8b0dSShuming Fan 101320b8b0dSShuming Fan mask = reg & 0xf000; 102320b8b0dSShuming Fan 103320b8b0dSShuming Fan if (is_index_reg) { /* index registers */ 104320b8b0dSShuming Fan val2 = reg & 0xff; 105320b8b0dSShuming Fan reg = reg >> 8; 106320b8b0dSShuming Fan nid = reg & 0xff; 107320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg, 0); 108320b8b0dSShuming Fan if (ret < 0) 109320b8b0dSShuming Fan return ret; 110320b8b0dSShuming Fan reg2 = reg + 0x1000; 111320b8b0dSShuming Fan reg2 |= 0x80; 112320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg2, val2); 113320b8b0dSShuming Fan if (ret < 0) 114320b8b0dSShuming Fan return ret; 115320b8b0dSShuming Fan 116320b8b0dSShuming Fan reg3 = RT711_PRIV_DATA_R_H | nid; 117320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, 118320b8b0dSShuming Fan reg3, ((*val >> 8) & 0xff)); 119320b8b0dSShuming Fan if (ret < 0) 120320b8b0dSShuming Fan return ret; 121320b8b0dSShuming Fan reg4 = reg3 + 0x1000; 122320b8b0dSShuming Fan reg4 |= 0x80; 123320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg4, (*val & 0xff)); 124320b8b0dSShuming Fan if (ret < 0) 125320b8b0dSShuming Fan return ret; 126320b8b0dSShuming Fan } else if (mask == 0x3000) { 127320b8b0dSShuming Fan reg += 0x8000; 128320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg, *val); 129320b8b0dSShuming Fan if (ret < 0) 130320b8b0dSShuming Fan return ret; 131320b8b0dSShuming Fan } else if (mask == 0x7000) { 132320b8b0dSShuming Fan reg += 0x2000; 133320b8b0dSShuming Fan reg |= 0x800; 134320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, 135320b8b0dSShuming Fan reg, ((*val >> 8) & 0xff)); 136320b8b0dSShuming Fan if (ret < 0) 137320b8b0dSShuming Fan return ret; 138320b8b0dSShuming Fan reg2 = reg + 0x1000; 139320b8b0dSShuming Fan reg2 |= 0x80; 140320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg2, (*val & 0xff)); 141320b8b0dSShuming Fan if (ret < 0) 142320b8b0dSShuming Fan return ret; 143320b8b0dSShuming Fan } else if ((reg & 0xff00) == 0x8300) { /* for R channel */ 144320b8b0dSShuming Fan reg2 = reg - 0x1000; 145320b8b0dSShuming Fan reg2 &= ~0x80; 146320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, 147320b8b0dSShuming Fan reg2, ((*val >> 8) & 0xff)); 148320b8b0dSShuming Fan if (ret < 0) 149320b8b0dSShuming Fan return ret; 150320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg, (*val & 0xff)); 151320b8b0dSShuming Fan if (ret < 0) 152320b8b0dSShuming Fan return ret; 153320b8b0dSShuming Fan } else if (mask == 0x9000) { 154320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, 155320b8b0dSShuming Fan reg, ((*val >> 8) & 0xff)); 156320b8b0dSShuming Fan if (ret < 0) 157320b8b0dSShuming Fan return ret; 158320b8b0dSShuming Fan reg2 = reg + 0x1000; 159320b8b0dSShuming Fan reg2 |= 0x80; 160320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg2, (*val & 0xff)); 161320b8b0dSShuming Fan if (ret < 0) 162320b8b0dSShuming Fan return ret; 163320b8b0dSShuming Fan } else if (mask == 0xb000) { 164320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg, *val); 165320b8b0dSShuming Fan if (ret < 0) 166320b8b0dSShuming Fan return ret; 167320b8b0dSShuming Fan } else { 168320b8b0dSShuming Fan ret = regmap_read(rt711->sdw_regmap, reg, val); 169320b8b0dSShuming Fan if (ret < 0) 170320b8b0dSShuming Fan return ret; 171320b8b0dSShuming Fan is_hda_reg = 0; 172320b8b0dSShuming Fan } 173320b8b0dSShuming Fan 174320b8b0dSShuming Fan if (is_hda_reg || is_index_reg) { 175320b8b0dSShuming Fan sdw_data_3 = 0; 176320b8b0dSShuming Fan sdw_data_2 = 0; 177320b8b0dSShuming Fan sdw_data_1 = 0; 178320b8b0dSShuming Fan sdw_data_0 = 0; 179320b8b0dSShuming Fan ret = regmap_read(rt711->sdw_regmap, 180320b8b0dSShuming Fan RT711_READ_HDA_3, &sdw_data_3); 181320b8b0dSShuming Fan if (ret < 0) 182320b8b0dSShuming Fan return ret; 183320b8b0dSShuming Fan ret = regmap_read(rt711->sdw_regmap, 184320b8b0dSShuming Fan RT711_READ_HDA_2, &sdw_data_2); 185320b8b0dSShuming Fan if (ret < 0) 186320b8b0dSShuming Fan return ret; 187320b8b0dSShuming Fan ret = regmap_read(rt711->sdw_regmap, 188320b8b0dSShuming Fan RT711_READ_HDA_1, &sdw_data_1); 189320b8b0dSShuming Fan if (ret < 0) 190320b8b0dSShuming Fan return ret; 191320b8b0dSShuming Fan ret = regmap_read(rt711->sdw_regmap, 192320b8b0dSShuming Fan RT711_READ_HDA_0, &sdw_data_0); 193320b8b0dSShuming Fan if (ret < 0) 194320b8b0dSShuming Fan return ret; 195320b8b0dSShuming Fan *val = ((sdw_data_3 & 0xff) << 24) | 196320b8b0dSShuming Fan ((sdw_data_2 & 0xff) << 16) | 197320b8b0dSShuming Fan ((sdw_data_1 & 0xff) << 8) | (sdw_data_0 & 0xff); 198320b8b0dSShuming Fan } 199320b8b0dSShuming Fan 200320b8b0dSShuming Fan if (is_hda_reg == 0) 201320b8b0dSShuming Fan dev_dbg(dev, "[%s] %04x => %08x\n", __func__, reg, *val); 202320b8b0dSShuming Fan else if (is_index_reg) 203320b8b0dSShuming Fan dev_dbg(dev, "[%s] %04x %04x %04x %04x => %08x\n", 204320b8b0dSShuming Fan __func__, reg, reg2, reg3, reg4, *val); 205320b8b0dSShuming Fan else 206320b8b0dSShuming Fan dev_dbg(dev, "[%s] %04x %04x => %08x\n", 207320b8b0dSShuming Fan __func__, reg, reg2, *val); 208320b8b0dSShuming Fan 209320b8b0dSShuming Fan return 0; 210320b8b0dSShuming Fan } 211320b8b0dSShuming Fan 212320b8b0dSShuming Fan static int rt711_sdw_write(void *context, unsigned int reg, unsigned int val) 213320b8b0dSShuming Fan { 214320b8b0dSShuming Fan struct device *dev = context; 215320b8b0dSShuming Fan struct rt711_priv *rt711 = dev_get_drvdata(dev); 216320b8b0dSShuming Fan unsigned int reg2 = 0, reg3, reg4, nid, mask, val2; 217320b8b0dSShuming Fan unsigned int is_index_reg = 0; 218320b8b0dSShuming Fan int ret; 219320b8b0dSShuming Fan 220320b8b0dSShuming Fan if (reg > 0xffff) 221320b8b0dSShuming Fan is_index_reg = 1; 222320b8b0dSShuming Fan 223320b8b0dSShuming Fan mask = reg & 0xf000; 224320b8b0dSShuming Fan 225320b8b0dSShuming Fan if (is_index_reg) { /* index registers */ 226320b8b0dSShuming Fan val2 = reg & 0xff; 227320b8b0dSShuming Fan reg = reg >> 8; 228320b8b0dSShuming Fan nid = reg & 0xff; 229320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg, 0); 230320b8b0dSShuming Fan if (ret < 0) 231320b8b0dSShuming Fan return ret; 232320b8b0dSShuming Fan reg2 = reg + 0x1000; 233320b8b0dSShuming Fan reg2 |= 0x80; 234320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg2, val2); 235320b8b0dSShuming Fan if (ret < 0) 236320b8b0dSShuming Fan return ret; 237320b8b0dSShuming Fan 238320b8b0dSShuming Fan reg3 = RT711_PRIV_DATA_W_H | nid; 239320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, 240320b8b0dSShuming Fan reg3, ((val >> 8) & 0xff)); 241320b8b0dSShuming Fan if (ret < 0) 242320b8b0dSShuming Fan return ret; 243320b8b0dSShuming Fan reg4 = reg3 + 0x1000; 244320b8b0dSShuming Fan reg4 |= 0x80; 245320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg4, (val & 0xff)); 246320b8b0dSShuming Fan if (ret < 0) 247320b8b0dSShuming Fan return ret; 248320b8b0dSShuming Fan is_index_reg = 1; 249320b8b0dSShuming Fan } else if (reg < 0x4fff) { 250320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg, val); 251320b8b0dSShuming Fan if (ret < 0) 252320b8b0dSShuming Fan return ret; 253320b8b0dSShuming Fan } else if (reg == RT711_FUNC_RESET) { 254320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg, val); 255320b8b0dSShuming Fan if (ret < 0) 256320b8b0dSShuming Fan return ret; 257320b8b0dSShuming Fan } else if (mask == 0x7000) { 258320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, 259320b8b0dSShuming Fan reg, ((val >> 8) & 0xff)); 260320b8b0dSShuming Fan if (ret < 0) 261320b8b0dSShuming Fan return ret; 262320b8b0dSShuming Fan reg2 = reg + 0x1000; 263320b8b0dSShuming Fan reg2 |= 0x80; 264320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg2, (val & 0xff)); 265320b8b0dSShuming Fan if (ret < 0) 266320b8b0dSShuming Fan return ret; 267320b8b0dSShuming Fan } else if ((reg & 0xff00) == 0x8300) { /* for R channel */ 268320b8b0dSShuming Fan reg2 = reg - 0x1000; 269320b8b0dSShuming Fan reg2 &= ~0x80; 270320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, 271320b8b0dSShuming Fan reg2, ((val >> 8) & 0xff)); 272320b8b0dSShuming Fan if (ret < 0) 273320b8b0dSShuming Fan return ret; 274320b8b0dSShuming Fan ret = regmap_write(rt711->sdw_regmap, reg, (val & 0xff)); 275320b8b0dSShuming Fan if (ret < 0) 276320b8b0dSShuming Fan return ret; 277320b8b0dSShuming Fan } 278320b8b0dSShuming Fan 279320b8b0dSShuming Fan if (reg2 == 0) 280320b8b0dSShuming Fan dev_dbg(dev, "[%s] %04x <= %04x\n", __func__, reg, val); 281320b8b0dSShuming Fan else if (is_index_reg) 282320b8b0dSShuming Fan dev_dbg(dev, "[%s] %04x %04x %04x %04x <= %04x %04x\n", 283320b8b0dSShuming Fan __func__, reg, reg2, reg3, reg4, val2, val); 284320b8b0dSShuming Fan else 285320b8b0dSShuming Fan dev_dbg(dev, "[%s] %04x %04x <= %04x\n", 286320b8b0dSShuming Fan __func__, reg, reg2, val); 287320b8b0dSShuming Fan 288320b8b0dSShuming Fan return 0; 289320b8b0dSShuming Fan } 290320b8b0dSShuming Fan 291320b8b0dSShuming Fan static const struct regmap_config rt711_regmap = { 292320b8b0dSShuming Fan .reg_bits = 24, 293320b8b0dSShuming Fan .val_bits = 32, 294320b8b0dSShuming Fan .readable_reg = rt711_readable_register, 295320b8b0dSShuming Fan .volatile_reg = rt711_volatile_register, 296320b8b0dSShuming Fan .max_register = 0x755800, 297320b8b0dSShuming Fan .reg_defaults = rt711_reg_defaults, 298320b8b0dSShuming Fan .num_reg_defaults = ARRAY_SIZE(rt711_reg_defaults), 2990a575729SMark Brown .cache_type = REGCACHE_MAPLE, 300320b8b0dSShuming Fan .use_single_read = true, 301320b8b0dSShuming Fan .use_single_write = true, 302320b8b0dSShuming Fan .reg_read = rt711_sdw_read, 303320b8b0dSShuming Fan .reg_write = rt711_sdw_write, 304320b8b0dSShuming Fan }; 305320b8b0dSShuming Fan 306320b8b0dSShuming Fan static const struct regmap_config rt711_sdw_regmap = { 307320b8b0dSShuming Fan .name = "sdw", 308320b8b0dSShuming Fan .reg_bits = 32, 309320b8b0dSShuming Fan .val_bits = 8, 310320b8b0dSShuming Fan .readable_reg = rt711_readable_register, 311320b8b0dSShuming Fan .max_register = 0xff01, 312320b8b0dSShuming Fan .cache_type = REGCACHE_NONE, 313320b8b0dSShuming Fan .use_single_read = true, 314320b8b0dSShuming Fan .use_single_write = true, 315320b8b0dSShuming Fan }; 316320b8b0dSShuming Fan 317320b8b0dSShuming Fan static int rt711_update_status(struct sdw_slave *slave, 318320b8b0dSShuming Fan enum sdw_slave_status status) 319320b8b0dSShuming Fan { 320320b8b0dSShuming Fan struct rt711_priv *rt711 = dev_get_drvdata(&slave->dev); 321320b8b0dSShuming Fan 322320b8b0dSShuming Fan if (status == SDW_SLAVE_UNATTACHED) 323320b8b0dSShuming Fan rt711->hw_init = false; 324320b8b0dSShuming Fan 325320b8b0dSShuming Fan /* 326320b8b0dSShuming Fan * Perform initialization only if slave status is present and 327320b8b0dSShuming Fan * hw_init flag is false 328320b8b0dSShuming Fan */ 32922e15c18SKrzysztof Kozlowski if (rt711->hw_init || status != SDW_SLAVE_ATTACHED) 330320b8b0dSShuming Fan return 0; 331320b8b0dSShuming Fan 332320b8b0dSShuming Fan /* perform I/O transfers required for Slave initialization */ 333320b8b0dSShuming Fan return rt711_io_init(&slave->dev, slave); 334320b8b0dSShuming Fan } 335320b8b0dSShuming Fan 336320b8b0dSShuming Fan static int rt711_read_prop(struct sdw_slave *slave) 337320b8b0dSShuming Fan { 338320b8b0dSShuming Fan struct sdw_slave_prop *prop = &slave->prop; 33917f64331SPierre-Louis Bossart int nval; 34017f64331SPierre-Louis Bossart int i, j; 341320b8b0dSShuming Fan u32 bit; 342320b8b0dSShuming Fan unsigned long addr; 343320b8b0dSShuming Fan struct sdw_dpn_prop *dpn; 344320b8b0dSShuming Fan 3452acd30b9SPierre-Louis Bossart prop->scp_int1_mask = SDW_SCP_INT1_IMPL_DEF | SDW_SCP_INT1_BUS_CLASH | 3462acd30b9SPierre-Louis Bossart SDW_SCP_INT1_PARITY; 34738edbfaeSPierre-Louis Bossart prop->quirks = SDW_SLAVE_QUIRKS_INVALID_INITIAL_PARITY; 3482acd30b9SPierre-Louis Bossart 349320b8b0dSShuming Fan prop->paging_support = false; 350320b8b0dSShuming Fan 351320b8b0dSShuming Fan /* first we need to allocate memory for set bits in port lists */ 352320b8b0dSShuming Fan prop->source_ports = 0x14; /* BITMAP: 00010100 */ 353320b8b0dSShuming Fan prop->sink_ports = 0x8; /* BITMAP: 00001000 */ 354320b8b0dSShuming Fan 355320b8b0dSShuming Fan nval = hweight32(prop->source_ports); 356320b8b0dSShuming Fan prop->src_dpn_prop = devm_kcalloc(&slave->dev, nval, 357320b8b0dSShuming Fan sizeof(*prop->src_dpn_prop), 358320b8b0dSShuming Fan GFP_KERNEL); 359320b8b0dSShuming Fan if (!prop->src_dpn_prop) 360320b8b0dSShuming Fan return -ENOMEM; 361320b8b0dSShuming Fan 362320b8b0dSShuming Fan i = 0; 363320b8b0dSShuming Fan dpn = prop->src_dpn_prop; 364320b8b0dSShuming Fan addr = prop->source_ports; 365320b8b0dSShuming Fan for_each_set_bit(bit, &addr, 32) { 366320b8b0dSShuming Fan dpn[i].num = bit; 367320b8b0dSShuming Fan dpn[i].type = SDW_DPN_FULL; 368320b8b0dSShuming Fan dpn[i].simple_ch_prep_sm = true; 369320b8b0dSShuming Fan dpn[i].ch_prep_timeout = 10; 370320b8b0dSShuming Fan i++; 371320b8b0dSShuming Fan } 372320b8b0dSShuming Fan 373320b8b0dSShuming Fan /* do this again for sink now */ 374320b8b0dSShuming Fan nval = hweight32(prop->sink_ports); 375320b8b0dSShuming Fan prop->sink_dpn_prop = devm_kcalloc(&slave->dev, nval, 376320b8b0dSShuming Fan sizeof(*prop->sink_dpn_prop), 377320b8b0dSShuming Fan GFP_KERNEL); 378320b8b0dSShuming Fan if (!prop->sink_dpn_prop) 379320b8b0dSShuming Fan return -ENOMEM; 380320b8b0dSShuming Fan 38117f64331SPierre-Louis Bossart j = 0; 382320b8b0dSShuming Fan dpn = prop->sink_dpn_prop; 383320b8b0dSShuming Fan addr = prop->sink_ports; 384320b8b0dSShuming Fan for_each_set_bit(bit, &addr, 32) { 38517f64331SPierre-Louis Bossart dpn[j].num = bit; 38617f64331SPierre-Louis Bossart dpn[j].type = SDW_DPN_FULL; 38717f64331SPierre-Louis Bossart dpn[j].simple_ch_prep_sm = true; 38817f64331SPierre-Louis Bossart dpn[j].ch_prep_timeout = 10; 38917f64331SPierre-Louis Bossart j++; 390320b8b0dSShuming Fan } 391320b8b0dSShuming Fan 392320b8b0dSShuming Fan /* set the timeout values */ 393320b8b0dSShuming Fan prop->clk_stop_timeout = 20; 394320b8b0dSShuming Fan 395320b8b0dSShuming Fan /* wake-up event */ 396320b8b0dSShuming Fan prop->wake_capable = 1; 397320b8b0dSShuming Fan 398320b8b0dSShuming Fan return 0; 399320b8b0dSShuming Fan } 400320b8b0dSShuming Fan 401320b8b0dSShuming Fan static int rt711_bus_config(struct sdw_slave *slave, 402320b8b0dSShuming Fan struct sdw_bus_params *params) 403320b8b0dSShuming Fan { 404320b8b0dSShuming Fan struct rt711_priv *rt711 = dev_get_drvdata(&slave->dev); 405320b8b0dSShuming Fan int ret; 406320b8b0dSShuming Fan 407320b8b0dSShuming Fan memcpy(&rt711->params, params, sizeof(*params)); 408320b8b0dSShuming Fan 409320b8b0dSShuming Fan ret = rt711_clock_config(&slave->dev); 410320b8b0dSShuming Fan if (ret < 0) 411320b8b0dSShuming Fan dev_err(&slave->dev, "Invalid clk config"); 412320b8b0dSShuming Fan 413320b8b0dSShuming Fan return ret; 414320b8b0dSShuming Fan } 415320b8b0dSShuming Fan 416320b8b0dSShuming Fan static int rt711_interrupt_callback(struct sdw_slave *slave, 417320b8b0dSShuming Fan struct sdw_slave_intr_status *status) 418320b8b0dSShuming Fan { 419320b8b0dSShuming Fan struct rt711_priv *rt711 = dev_get_drvdata(&slave->dev); 420320b8b0dSShuming Fan 421320b8b0dSShuming Fan dev_dbg(&slave->dev, 422320b8b0dSShuming Fan "%s control_port_stat=%x", __func__, status->control_port); 423320b8b0dSShuming Fan 42418236370SPierre-Louis Bossart mutex_lock(&rt711->disable_irq_lock); 42518236370SPierre-Louis Bossart if (status->control_port & 0x4 && !rt711->disable_irq) { 426320b8b0dSShuming Fan mod_delayed_work(system_power_efficient_wq, 427320b8b0dSShuming Fan &rt711->jack_detect_work, msecs_to_jiffies(250)); 428320b8b0dSShuming Fan } 42918236370SPierre-Louis Bossart mutex_unlock(&rt711->disable_irq_lock); 430320b8b0dSShuming Fan 431320b8b0dSShuming Fan return 0; 432320b8b0dSShuming Fan } 433320b8b0dSShuming Fan 434628fc9d9SRikard Falkeborn static const struct sdw_slave_ops rt711_slave_ops = { 435320b8b0dSShuming Fan .read_prop = rt711_read_prop, 436320b8b0dSShuming Fan .interrupt_callback = rt711_interrupt_callback, 437320b8b0dSShuming Fan .update_status = rt711_update_status, 438320b8b0dSShuming Fan .bus_config = rt711_bus_config, 439320b8b0dSShuming Fan }; 440320b8b0dSShuming Fan 441320b8b0dSShuming Fan static int rt711_sdw_probe(struct sdw_slave *slave, 442320b8b0dSShuming Fan const struct sdw_device_id *id) 443320b8b0dSShuming Fan { 444320b8b0dSShuming Fan struct regmap *sdw_regmap, *regmap; 445320b8b0dSShuming Fan 446320b8b0dSShuming Fan /* Regmap Initialization */ 447320b8b0dSShuming Fan sdw_regmap = devm_regmap_init_sdw(slave, &rt711_sdw_regmap); 448be1a4b2cSVinod Koul if (IS_ERR(sdw_regmap)) 449be1a4b2cSVinod Koul return PTR_ERR(sdw_regmap); 450320b8b0dSShuming Fan 451320b8b0dSShuming Fan regmap = devm_regmap_init(&slave->dev, NULL, 452320b8b0dSShuming Fan &slave->dev, &rt711_regmap); 453b03c29c1SWei Yongjun if (IS_ERR(regmap)) 454b03c29c1SWei Yongjun return PTR_ERR(regmap); 455320b8b0dSShuming Fan 456*3f3d66baSPierre-Louis Bossart return rt711_init(&slave->dev, sdw_regmap, regmap, slave); 457320b8b0dSShuming Fan } 458320b8b0dSShuming Fan 459320b8b0dSShuming Fan static int rt711_sdw_remove(struct sdw_slave *slave) 460320b8b0dSShuming Fan { 461320b8b0dSShuming Fan struct rt711_priv *rt711 = dev_get_drvdata(&slave->dev); 462320b8b0dSShuming Fan 463ac63716dSPierre-Louis Bossart if (rt711->hw_init) { 464121871a7SPierre-Louis Bossart cancel_delayed_work_sync(&rt711->jack_detect_work); 465121871a7SPierre-Louis Bossart cancel_delayed_work_sync(&rt711->jack_btn_check_work); 466320b8b0dSShuming Fan cancel_work_sync(&rt711->calibration_work); 467320b8b0dSShuming Fan } 468320b8b0dSShuming Fan 469ac63716dSPierre-Louis Bossart if (rt711->first_hw_init) 470ac63716dSPierre-Louis Bossart pm_runtime_disable(&slave->dev); 471ac63716dSPierre-Louis Bossart 47208bb5dc6SPierre-Louis Bossart mutex_destroy(&rt711->calibrate_mutex); 47308bb5dc6SPierre-Louis Bossart mutex_destroy(&rt711->disable_irq_lock); 47408bb5dc6SPierre-Louis Bossart 475320b8b0dSShuming Fan return 0; 476320b8b0dSShuming Fan } 477320b8b0dSShuming Fan 478320b8b0dSShuming Fan static const struct sdw_device_id rt711_id[] = { 4799e473058SPierre-Louis Bossart SDW_SLAVE_ENTRY_EXT(0x025d, 0x711, 0x2, 0, 0), 480320b8b0dSShuming Fan {}, 481320b8b0dSShuming Fan }; 482320b8b0dSShuming Fan MODULE_DEVICE_TABLE(sdw, rt711_id); 483320b8b0dSShuming Fan 484973649d3STakashi Iwai static int __maybe_unused rt711_dev_suspend(struct device *dev) 485320b8b0dSShuming Fan { 486320b8b0dSShuming Fan struct rt711_priv *rt711 = dev_get_drvdata(dev); 487320b8b0dSShuming Fan 488320b8b0dSShuming Fan if (!rt711->hw_init) 489320b8b0dSShuming Fan return 0; 490320b8b0dSShuming Fan 491501ef013SShuming Fan cancel_delayed_work_sync(&rt711->jack_detect_work); 492501ef013SShuming Fan cancel_delayed_work_sync(&rt711->jack_btn_check_work); 493501ef013SShuming Fan cancel_work_sync(&rt711->calibration_work); 494501ef013SShuming Fan 495320b8b0dSShuming Fan regcache_cache_only(rt711->regmap, true); 496320b8b0dSShuming Fan 497320b8b0dSShuming Fan return 0; 498320b8b0dSShuming Fan } 499320b8b0dSShuming Fan 50018236370SPierre-Louis Bossart static int __maybe_unused rt711_dev_system_suspend(struct device *dev) 50118236370SPierre-Louis Bossart { 50218236370SPierre-Louis Bossart struct rt711_priv *rt711 = dev_get_drvdata(dev); 50318236370SPierre-Louis Bossart struct sdw_slave *slave = dev_to_sdw_dev(dev); 50418236370SPierre-Louis Bossart int ret; 50518236370SPierre-Louis Bossart 50618236370SPierre-Louis Bossart if (!rt711->hw_init) 50718236370SPierre-Louis Bossart return 0; 50818236370SPierre-Louis Bossart 50918236370SPierre-Louis Bossart /* 51018236370SPierre-Louis Bossart * prevent new interrupts from being handled after the 51118236370SPierre-Louis Bossart * deferred work completes and before the parent disables 51218236370SPierre-Louis Bossart * interrupts on the link 51318236370SPierre-Louis Bossart */ 51418236370SPierre-Louis Bossart mutex_lock(&rt711->disable_irq_lock); 51518236370SPierre-Louis Bossart rt711->disable_irq = true; 51618236370SPierre-Louis Bossart ret = sdw_update_no_pm(slave, SDW_SCP_INTMASK1, 51718236370SPierre-Louis Bossart SDW_SCP_INT1_IMPL_DEF, 0); 51818236370SPierre-Louis Bossart mutex_unlock(&rt711->disable_irq_lock); 51918236370SPierre-Louis Bossart 52018236370SPierre-Louis Bossart if (ret < 0) { 52118236370SPierre-Louis Bossart /* log but don't prevent suspend from happening */ 52218236370SPierre-Louis Bossart dev_dbg(&slave->dev, "%s: could not disable imp-def interrupts\n:", __func__); 52318236370SPierre-Louis Bossart } 52418236370SPierre-Louis Bossart 52518236370SPierre-Louis Bossart return rt711_dev_suspend(dev); 52618236370SPierre-Louis Bossart } 52718236370SPierre-Louis Bossart 5287ef8c9edSPierre-Louis Bossart #define RT711_PROBE_TIMEOUT 5000 529320b8b0dSShuming Fan 530973649d3STakashi Iwai static int __maybe_unused rt711_dev_resume(struct device *dev) 531320b8b0dSShuming Fan { 532320b8b0dSShuming Fan struct sdw_slave *slave = dev_to_sdw_dev(dev); 533320b8b0dSShuming Fan struct rt711_priv *rt711 = dev_get_drvdata(dev); 534320b8b0dSShuming Fan unsigned long time; 535320b8b0dSShuming Fan 536a0897ebcSPierre-Louis Bossart if (!rt711->first_hw_init) 537320b8b0dSShuming Fan return 0; 538320b8b0dSShuming Fan 539b69de265SShuming Fan if (!slave->unattach_request) { 540b69de265SShuming Fan if (rt711->disable_irq == true) { 541b69de265SShuming Fan mutex_lock(&rt711->disable_irq_lock); 542b69de265SShuming Fan sdw_write_no_pm(slave, SDW_SCP_INTMASK1, SDW_SCP_INT1_IMPL_DEF); 543b69de265SShuming Fan rt711->disable_irq = false; 544b69de265SShuming Fan mutex_unlock(&rt711->disable_irq_lock); 545b69de265SShuming Fan } 546320b8b0dSShuming Fan goto regmap_sync; 547b69de265SShuming Fan } 548320b8b0dSShuming Fan 549320b8b0dSShuming Fan time = wait_for_completion_timeout(&slave->initialization_complete, 550320b8b0dSShuming Fan msecs_to_jiffies(RT711_PROBE_TIMEOUT)); 551320b8b0dSShuming Fan if (!time) { 552320b8b0dSShuming Fan dev_err(&slave->dev, "Initialization not complete, timed out\n"); 553320b8b0dSShuming Fan return -ETIMEDOUT; 554320b8b0dSShuming Fan } 555320b8b0dSShuming Fan 556320b8b0dSShuming Fan regmap_sync: 557320b8b0dSShuming Fan slave->unattach_request = 0; 558320b8b0dSShuming Fan regcache_cache_only(rt711->regmap, false); 559320b8b0dSShuming Fan regcache_sync_region(rt711->regmap, 0x3000, 0x8fff); 560320b8b0dSShuming Fan regcache_sync_region(rt711->regmap, 0x752009, 0x752091); 561320b8b0dSShuming Fan 562320b8b0dSShuming Fan return 0; 563320b8b0dSShuming Fan } 564320b8b0dSShuming Fan 565320b8b0dSShuming Fan static const struct dev_pm_ops rt711_pm = { 56618236370SPierre-Louis Bossart SET_SYSTEM_SLEEP_PM_OPS(rt711_dev_system_suspend, rt711_dev_resume) 567320b8b0dSShuming Fan SET_RUNTIME_PM_OPS(rt711_dev_suspend, rt711_dev_resume, NULL) 568320b8b0dSShuming Fan }; 569320b8b0dSShuming Fan 570320b8b0dSShuming Fan static struct sdw_driver rt711_sdw_driver = { 571320b8b0dSShuming Fan .driver = { 572320b8b0dSShuming Fan .name = "rt711", 573320b8b0dSShuming Fan .owner = THIS_MODULE, 574320b8b0dSShuming Fan .pm = &rt711_pm, 575320b8b0dSShuming Fan }, 576320b8b0dSShuming Fan .probe = rt711_sdw_probe, 577320b8b0dSShuming Fan .remove = rt711_sdw_remove, 578320b8b0dSShuming Fan .ops = &rt711_slave_ops, 579320b8b0dSShuming Fan .id_table = rt711_id, 580320b8b0dSShuming Fan }; 581320b8b0dSShuming Fan module_sdw_driver(rt711_sdw_driver); 582320b8b0dSShuming Fan 583320b8b0dSShuming Fan MODULE_DESCRIPTION("ASoC RT711 SDW driver"); 584320b8b0dSShuming Fan MODULE_AUTHOR("Shuming Fan <shumingf@realtek.com>"); 585320b8b0dSShuming Fan MODULE_LICENSE("GPL"); 586