17d2a5f9aSShuming Fan // SPDX-License-Identifier: GPL-2.0
27d2a5f9aSShuming Fan //
37d2a5f9aSShuming Fan // rt700-sdw.c -- rt700 ALSA SoC audio driver
47d2a5f9aSShuming Fan //
57d2a5f9aSShuming Fan // Copyright(c) 2019 Realtek Semiconductor Corp.
67d2a5f9aSShuming Fan //
77d2a5f9aSShuming Fan //
87d2a5f9aSShuming Fan
97d2a5f9aSShuming Fan #include <linux/delay.h>
107d2a5f9aSShuming Fan #include <linux/device.h>
117d2a5f9aSShuming Fan #include <linux/mod_devicetable.h>
127d2a5f9aSShuming Fan #include <linux/soundwire/sdw.h>
137d2a5f9aSShuming Fan #include <linux/soundwire/sdw_type.h>
142acd30b9SPierre-Louis Bossart #include <linux/soundwire/sdw_registers.h>
157d2a5f9aSShuming Fan #include <linux/module.h>
16ac63716dSPierre-Louis Bossart #include <linux/pm_runtime.h>
177d2a5f9aSShuming Fan #include <linux/regmap.h>
187d2a5f9aSShuming Fan #include <sound/soc.h>
197d2a5f9aSShuming Fan #include "rt700.h"
207d2a5f9aSShuming Fan #include "rt700-sdw.h"
217d2a5f9aSShuming Fan
rt700_readable_register(struct device * dev,unsigned int reg)227d2a5f9aSShuming Fan static bool rt700_readable_register(struct device *dev, unsigned int reg)
237d2a5f9aSShuming Fan {
247d2a5f9aSShuming Fan switch (reg) {
257d2a5f9aSShuming Fan case 0x00e0:
267d2a5f9aSShuming Fan case 0x00f0:
277d2a5f9aSShuming Fan case 0x2000 ... 0x200e:
287d2a5f9aSShuming Fan case 0x2012 ... 0x2016:
297d2a5f9aSShuming Fan case 0x201a ... 0x2027:
307d2a5f9aSShuming Fan case 0x2029 ... 0x202a:
317d2a5f9aSShuming Fan case 0x202d ... 0x2034:
327d2a5f9aSShuming Fan case 0x2200 ... 0x2204:
337d2a5f9aSShuming Fan case 0x2206 ... 0x2212:
347d2a5f9aSShuming Fan case 0x2220 ... 0x2223:
357d2a5f9aSShuming Fan case 0x2230 ... 0x2231:
367d2a5f9aSShuming Fan case 0x3000 ... 0x3fff:
377d2a5f9aSShuming Fan case 0x7000 ... 0x7fff:
387d2a5f9aSShuming Fan case 0x8300 ... 0x83ff:
397d2a5f9aSShuming Fan case 0x9c00 ... 0x9cff:
407d2a5f9aSShuming Fan case 0xb900 ... 0xb9ff:
417d2a5f9aSShuming Fan case 0x75201a:
427d2a5f9aSShuming Fan case 0x752045:
437d2a5f9aSShuming Fan case 0x752046:
447d2a5f9aSShuming Fan case 0x752048:
457d2a5f9aSShuming Fan case 0x75204a:
467d2a5f9aSShuming Fan case 0x75206b:
477d2a5f9aSShuming Fan case 0x752080:
487d2a5f9aSShuming Fan case 0x752081:
497d2a5f9aSShuming Fan return true;
507d2a5f9aSShuming Fan default:
517d2a5f9aSShuming Fan return false;
527d2a5f9aSShuming Fan }
537d2a5f9aSShuming Fan }
547d2a5f9aSShuming Fan
rt700_volatile_register(struct device * dev,unsigned int reg)557d2a5f9aSShuming Fan static bool rt700_volatile_register(struct device *dev, unsigned int reg)
567d2a5f9aSShuming Fan {
577d2a5f9aSShuming Fan switch (reg) {
587d2a5f9aSShuming Fan case 0x2009:
597d2a5f9aSShuming Fan case 0x2016:
607d2a5f9aSShuming Fan case 0x201b:
617d2a5f9aSShuming Fan case 0x201c:
627d2a5f9aSShuming Fan case 0x201d:
637d2a5f9aSShuming Fan case 0x201f:
647d2a5f9aSShuming Fan case 0x2021:
657d2a5f9aSShuming Fan case 0x2023:
667d2a5f9aSShuming Fan case 0x2230:
677d2a5f9aSShuming Fan case 0x200b ... 0x200e: /* i2c read */
687d2a5f9aSShuming Fan case 0x2012 ... 0x2015: /* HD-A read */
697d2a5f9aSShuming Fan case 0x202d ... 0x202f: /* BRA */
707d2a5f9aSShuming Fan case 0x2201 ... 0x2212: /* i2c debug */
717d2a5f9aSShuming Fan case 0x2220 ... 0x2223: /* decoded HD-A */
727d2a5f9aSShuming Fan case 0x9c00 ... 0x9cff:
737d2a5f9aSShuming Fan case 0xb900 ... 0xb9ff:
747d2a5f9aSShuming Fan case 0xff01:
757d2a5f9aSShuming Fan case 0x75201a:
767d2a5f9aSShuming Fan case 0x752046:
777d2a5f9aSShuming Fan case 0x752080:
787d2a5f9aSShuming Fan case 0x752081:
797d2a5f9aSShuming Fan return true;
807d2a5f9aSShuming Fan default:
817d2a5f9aSShuming Fan return false;
827d2a5f9aSShuming Fan }
837d2a5f9aSShuming Fan }
847d2a5f9aSShuming Fan
rt700_sdw_read(void * context,unsigned int reg,unsigned int * val)857d2a5f9aSShuming Fan static int rt700_sdw_read(void *context, unsigned int reg, unsigned int *val)
867d2a5f9aSShuming Fan {
877d2a5f9aSShuming Fan struct device *dev = context;
887d2a5f9aSShuming Fan struct rt700_priv *rt700 = dev_get_drvdata(dev);
897d2a5f9aSShuming Fan unsigned int sdw_data_3, sdw_data_2, sdw_data_1, sdw_data_0;
907d2a5f9aSShuming Fan unsigned int reg2 = 0, reg3 = 0, reg4 = 0, mask, nid, val2;
917d2a5f9aSShuming Fan unsigned int is_hda_reg = 1, is_index_reg = 0;
927d2a5f9aSShuming Fan int ret;
937d2a5f9aSShuming Fan
947d2a5f9aSShuming Fan if (reg > 0xffff)
957d2a5f9aSShuming Fan is_index_reg = 1;
967d2a5f9aSShuming Fan
977d2a5f9aSShuming Fan mask = reg & 0xf000;
987d2a5f9aSShuming Fan
997d2a5f9aSShuming Fan if (is_index_reg) { /* index registers */
1007d2a5f9aSShuming Fan val2 = reg & 0xff;
1017d2a5f9aSShuming Fan reg = reg >> 8;
1027d2a5f9aSShuming Fan nid = reg & 0xff;
1037d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg, 0);
1047d2a5f9aSShuming Fan if (ret < 0)
1057d2a5f9aSShuming Fan return ret;
1067d2a5f9aSShuming Fan reg2 = reg + 0x1000;
1077d2a5f9aSShuming Fan reg2 |= 0x80;
1087d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg2, val2);
1097d2a5f9aSShuming Fan if (ret < 0)
1107d2a5f9aSShuming Fan return ret;
1117d2a5f9aSShuming Fan
1127d2a5f9aSShuming Fan reg3 = RT700_PRIV_DATA_R_H | nid;
1137d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap,
1147d2a5f9aSShuming Fan reg3, ((*val >> 8) & 0xff));
1157d2a5f9aSShuming Fan if (ret < 0)
1167d2a5f9aSShuming Fan return ret;
1177d2a5f9aSShuming Fan reg4 = reg3 + 0x1000;
1187d2a5f9aSShuming Fan reg4 |= 0x80;
1197d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg4, (*val & 0xff));
1207d2a5f9aSShuming Fan if (ret < 0)
1217d2a5f9aSShuming Fan return ret;
1227d2a5f9aSShuming Fan } else if (mask == 0x3000) {
1237d2a5f9aSShuming Fan reg += 0x8000;
1247d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg, *val);
1257d2a5f9aSShuming Fan if (ret < 0)
1267d2a5f9aSShuming Fan return ret;
1277d2a5f9aSShuming Fan } else if (mask == 0x7000) {
1287d2a5f9aSShuming Fan reg += 0x2000;
1297d2a5f9aSShuming Fan reg |= 0x800;
1307d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap,
1317d2a5f9aSShuming Fan reg, ((*val >> 8) & 0xff));
1327d2a5f9aSShuming Fan if (ret < 0)
1337d2a5f9aSShuming Fan return ret;
1347d2a5f9aSShuming Fan reg2 = reg + 0x1000;
1357d2a5f9aSShuming Fan reg2 |= 0x80;
1367d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg2, (*val & 0xff));
1377d2a5f9aSShuming Fan if (ret < 0)
1387d2a5f9aSShuming Fan return ret;
1397d2a5f9aSShuming Fan } else if ((reg & 0xff00) == 0x8300) { /* for R channel */
1407d2a5f9aSShuming Fan reg2 = reg - 0x1000;
1417d2a5f9aSShuming Fan reg2 &= ~0x80;
1427d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap,
1437d2a5f9aSShuming Fan reg2, ((*val >> 8) & 0xff));
1447d2a5f9aSShuming Fan if (ret < 0)
1457d2a5f9aSShuming Fan return ret;
1467d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg, (*val & 0xff));
1477d2a5f9aSShuming Fan if (ret < 0)
1487d2a5f9aSShuming Fan return ret;
1497d2a5f9aSShuming Fan } else if (mask == 0x9000) {
1507d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap,
1517d2a5f9aSShuming Fan reg, ((*val >> 8) & 0xff));
1527d2a5f9aSShuming Fan if (ret < 0)
1537d2a5f9aSShuming Fan return ret;
1547d2a5f9aSShuming Fan reg2 = reg + 0x1000;
1557d2a5f9aSShuming Fan reg2 |= 0x80;
1567d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg2, (*val & 0xff));
1577d2a5f9aSShuming Fan if (ret < 0)
1587d2a5f9aSShuming Fan return ret;
1597d2a5f9aSShuming Fan } else if (mask == 0xb000) {
1607d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg, *val);
1617d2a5f9aSShuming Fan if (ret < 0)
1627d2a5f9aSShuming Fan return ret;
1637d2a5f9aSShuming Fan } else {
1647d2a5f9aSShuming Fan ret = regmap_read(rt700->sdw_regmap, reg, val);
1657d2a5f9aSShuming Fan if (ret < 0)
1667d2a5f9aSShuming Fan return ret;
1677d2a5f9aSShuming Fan is_hda_reg = 0;
1687d2a5f9aSShuming Fan }
1697d2a5f9aSShuming Fan
1707d2a5f9aSShuming Fan if (is_hda_reg || is_index_reg) {
1717d2a5f9aSShuming Fan sdw_data_3 = 0;
1727d2a5f9aSShuming Fan sdw_data_2 = 0;
1737d2a5f9aSShuming Fan sdw_data_1 = 0;
1747d2a5f9aSShuming Fan sdw_data_0 = 0;
1757d2a5f9aSShuming Fan ret = regmap_read(rt700->sdw_regmap,
1767d2a5f9aSShuming Fan RT700_READ_HDA_3, &sdw_data_3);
1777d2a5f9aSShuming Fan if (ret < 0)
1787d2a5f9aSShuming Fan return ret;
1797d2a5f9aSShuming Fan ret = regmap_read(rt700->sdw_regmap,
1807d2a5f9aSShuming Fan RT700_READ_HDA_2, &sdw_data_2);
1817d2a5f9aSShuming Fan if (ret < 0)
1827d2a5f9aSShuming Fan return ret;
1837d2a5f9aSShuming Fan ret = regmap_read(rt700->sdw_regmap,
1847d2a5f9aSShuming Fan RT700_READ_HDA_1, &sdw_data_1);
1857d2a5f9aSShuming Fan if (ret < 0)
1867d2a5f9aSShuming Fan return ret;
1877d2a5f9aSShuming Fan ret = regmap_read(rt700->sdw_regmap,
1887d2a5f9aSShuming Fan RT700_READ_HDA_0, &sdw_data_0);
1897d2a5f9aSShuming Fan if (ret < 0)
1907d2a5f9aSShuming Fan return ret;
1917d2a5f9aSShuming Fan *val = ((sdw_data_3 & 0xff) << 24) |
1927d2a5f9aSShuming Fan ((sdw_data_2 & 0xff) << 16) |
1937d2a5f9aSShuming Fan ((sdw_data_1 & 0xff) << 8) | (sdw_data_0 & 0xff);
1947d2a5f9aSShuming Fan }
1957d2a5f9aSShuming Fan
1967d2a5f9aSShuming Fan if (is_hda_reg == 0)
1977d2a5f9aSShuming Fan dev_dbg(dev, "[%s] %04x => %08x\n", __func__, reg, *val);
1987d2a5f9aSShuming Fan else if (is_index_reg)
1997d2a5f9aSShuming Fan dev_dbg(dev, "[%s] %04x %04x %04x %04x => %08x\n",
2007d2a5f9aSShuming Fan __func__, reg, reg2, reg3, reg4, *val);
2017d2a5f9aSShuming Fan else
2027d2a5f9aSShuming Fan dev_dbg(dev, "[%s] %04x %04x => %08x\n",
2037d2a5f9aSShuming Fan __func__, reg, reg2, *val);
2047d2a5f9aSShuming Fan
2057d2a5f9aSShuming Fan return 0;
2067d2a5f9aSShuming Fan }
2077d2a5f9aSShuming Fan
rt700_sdw_write(void * context,unsigned int reg,unsigned int val)2087d2a5f9aSShuming Fan static int rt700_sdw_write(void *context, unsigned int reg, unsigned int val)
2097d2a5f9aSShuming Fan {
2107d2a5f9aSShuming Fan struct device *dev = context;
2117d2a5f9aSShuming Fan struct rt700_priv *rt700 = dev_get_drvdata(dev);
2127d2a5f9aSShuming Fan unsigned int reg2 = 0, reg3, reg4, nid, mask, val2;
2137d2a5f9aSShuming Fan unsigned int is_index_reg = 0;
2147d2a5f9aSShuming Fan int ret;
2157d2a5f9aSShuming Fan
2167d2a5f9aSShuming Fan if (reg > 0xffff)
2177d2a5f9aSShuming Fan is_index_reg = 1;
2187d2a5f9aSShuming Fan
2197d2a5f9aSShuming Fan mask = reg & 0xf000;
2207d2a5f9aSShuming Fan
2217d2a5f9aSShuming Fan if (is_index_reg) { /* index registers */
2227d2a5f9aSShuming Fan val2 = reg & 0xff;
2237d2a5f9aSShuming Fan reg = reg >> 8;
2247d2a5f9aSShuming Fan nid = reg & 0xff;
2257d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg, 0);
2267d2a5f9aSShuming Fan if (ret < 0)
2277d2a5f9aSShuming Fan return ret;
2287d2a5f9aSShuming Fan reg2 = reg + 0x1000;
2297d2a5f9aSShuming Fan reg2 |= 0x80;
2307d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg2, val2);
2317d2a5f9aSShuming Fan if (ret < 0)
2327d2a5f9aSShuming Fan return ret;
2337d2a5f9aSShuming Fan
2347d2a5f9aSShuming Fan reg3 = RT700_PRIV_DATA_W_H | nid;
2357d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap,
2367d2a5f9aSShuming Fan reg3, ((val >> 8) & 0xff));
2377d2a5f9aSShuming Fan if (ret < 0)
2387d2a5f9aSShuming Fan return ret;
2397d2a5f9aSShuming Fan reg4 = reg3 + 0x1000;
2407d2a5f9aSShuming Fan reg4 |= 0x80;
2417d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg4, (val & 0xff));
2427d2a5f9aSShuming Fan if (ret < 0)
2437d2a5f9aSShuming Fan return ret;
2447d2a5f9aSShuming Fan is_index_reg = 1;
2457d2a5f9aSShuming Fan } else if (reg < 0x4fff) {
2467d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg, val);
2477d2a5f9aSShuming Fan if (ret < 0)
2487d2a5f9aSShuming Fan return ret;
2497d2a5f9aSShuming Fan } else if (reg == 0xff01) {
2507d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg, val);
2517d2a5f9aSShuming Fan if (ret < 0)
2527d2a5f9aSShuming Fan return ret;
2537d2a5f9aSShuming Fan } else if (mask == 0x7000) {
2547d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap,
2557d2a5f9aSShuming Fan reg, ((val >> 8) & 0xff));
2567d2a5f9aSShuming Fan if (ret < 0)
2577d2a5f9aSShuming Fan return ret;
2587d2a5f9aSShuming Fan reg2 = reg + 0x1000;
2597d2a5f9aSShuming Fan reg2 |= 0x80;
2607d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg2, (val & 0xff));
2617d2a5f9aSShuming Fan if (ret < 0)
2627d2a5f9aSShuming Fan return ret;
2637d2a5f9aSShuming Fan } else if ((reg & 0xff00) == 0x8300) { /* for R channel */
2647d2a5f9aSShuming Fan reg2 = reg - 0x1000;
2657d2a5f9aSShuming Fan reg2 &= ~0x80;
2667d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap,
2677d2a5f9aSShuming Fan reg2, ((val >> 8) & 0xff));
2687d2a5f9aSShuming Fan if (ret < 0)
2697d2a5f9aSShuming Fan return ret;
2707d2a5f9aSShuming Fan ret = regmap_write(rt700->sdw_regmap, reg, (val & 0xff));
2717d2a5f9aSShuming Fan if (ret < 0)
2727d2a5f9aSShuming Fan return ret;
2737d2a5f9aSShuming Fan }
2747d2a5f9aSShuming Fan
2757d2a5f9aSShuming Fan if (reg2 == 0)
2767d2a5f9aSShuming Fan dev_dbg(dev, "[%s] %04x <= %04x\n", __func__, reg, val);
2777d2a5f9aSShuming Fan else if (is_index_reg)
2787d2a5f9aSShuming Fan dev_dbg(dev, "[%s] %04x %04x %04x %04x <= %04x %04x\n",
2797d2a5f9aSShuming Fan __func__, reg, reg2, reg3, reg4, val2, val);
2807d2a5f9aSShuming Fan else
2817d2a5f9aSShuming Fan dev_dbg(dev, "[%s] %04x %04x <= %04x\n",
2827d2a5f9aSShuming Fan __func__, reg, reg2, val);
2837d2a5f9aSShuming Fan
2847d2a5f9aSShuming Fan return 0;
2857d2a5f9aSShuming Fan }
2867d2a5f9aSShuming Fan
2877d2a5f9aSShuming Fan static const struct regmap_config rt700_regmap = {
2887d2a5f9aSShuming Fan .reg_bits = 24,
2897d2a5f9aSShuming Fan .val_bits = 32,
2907d2a5f9aSShuming Fan .readable_reg = rt700_readable_register,
2917d2a5f9aSShuming Fan .volatile_reg = rt700_volatile_register,
2927d2a5f9aSShuming Fan .max_register = 0x755800,
2937d2a5f9aSShuming Fan .reg_defaults = rt700_reg_defaults,
2947d2a5f9aSShuming Fan .num_reg_defaults = ARRAY_SIZE(rt700_reg_defaults),
295049a7804SMark Brown .cache_type = REGCACHE_MAPLE,
2967d2a5f9aSShuming Fan .use_single_read = true,
2977d2a5f9aSShuming Fan .use_single_write = true,
2987d2a5f9aSShuming Fan .reg_read = rt700_sdw_read,
2997d2a5f9aSShuming Fan .reg_write = rt700_sdw_write,
3007d2a5f9aSShuming Fan };
3017d2a5f9aSShuming Fan
3027d2a5f9aSShuming Fan static const struct regmap_config rt700_sdw_regmap = {
3037d2a5f9aSShuming Fan .name = "sdw",
3047d2a5f9aSShuming Fan .reg_bits = 32,
3057d2a5f9aSShuming Fan .val_bits = 8,
3067d2a5f9aSShuming Fan .readable_reg = rt700_readable_register,
3077d2a5f9aSShuming Fan .max_register = 0xff01,
3087d2a5f9aSShuming Fan .cache_type = REGCACHE_NONE,
3097d2a5f9aSShuming Fan .use_single_read = true,
3107d2a5f9aSShuming Fan .use_single_write = true,
3117d2a5f9aSShuming Fan };
3127d2a5f9aSShuming Fan
rt700_update_status(struct sdw_slave * slave,enum sdw_slave_status status)3137d2a5f9aSShuming Fan static int rt700_update_status(struct sdw_slave *slave,
3147d2a5f9aSShuming Fan enum sdw_slave_status status)
3157d2a5f9aSShuming Fan {
3167d2a5f9aSShuming Fan struct rt700_priv *rt700 = dev_get_drvdata(&slave->dev);
3177d2a5f9aSShuming Fan
3187d2a5f9aSShuming Fan if (status == SDW_SLAVE_UNATTACHED)
3197d2a5f9aSShuming Fan rt700->hw_init = false;
3207d2a5f9aSShuming Fan
3217d2a5f9aSShuming Fan /*
3227d2a5f9aSShuming Fan * Perform initialization only if slave status is present and
3237d2a5f9aSShuming Fan * hw_init flag is false
3247d2a5f9aSShuming Fan */
3259564c9f6SKrzysztof Kozlowski if (rt700->hw_init || status != SDW_SLAVE_ATTACHED)
3267d2a5f9aSShuming Fan return 0;
3277d2a5f9aSShuming Fan
3287d2a5f9aSShuming Fan /* perform I/O transfers required for Slave initialization */
3297d2a5f9aSShuming Fan return rt700_io_init(&slave->dev, slave);
3307d2a5f9aSShuming Fan }
3317d2a5f9aSShuming Fan
rt700_read_prop(struct sdw_slave * slave)3327d2a5f9aSShuming Fan static int rt700_read_prop(struct sdw_slave *slave)
3337d2a5f9aSShuming Fan {
3347d2a5f9aSShuming Fan struct sdw_slave_prop *prop = &slave->prop;
335d0bbcb4eSPierre-Louis Bossart int nval, i;
3367d2a5f9aSShuming Fan u32 bit;
3377d2a5f9aSShuming Fan unsigned long addr;
3387d2a5f9aSShuming Fan struct sdw_dpn_prop *dpn;
3397d2a5f9aSShuming Fan
3402acd30b9SPierre-Louis Bossart prop->scp_int1_mask = SDW_SCP_INT1_IMPL_DEF | SDW_SCP_INT1_BUS_CLASH |
3412acd30b9SPierre-Louis Bossart SDW_SCP_INT1_PARITY;
34238edbfaeSPierre-Louis Bossart prop->quirks = SDW_SLAVE_QUIRKS_INVALID_INITIAL_PARITY;
3432acd30b9SPierre-Louis Bossart
3447d2a5f9aSShuming Fan prop->paging_support = false;
3457d2a5f9aSShuming Fan
3467d2a5f9aSShuming Fan /* first we need to allocate memory for set bits in port lists */
3477d2a5f9aSShuming Fan prop->source_ports = 0x14; /* BITMAP: 00010100 */
3487d2a5f9aSShuming Fan prop->sink_ports = 0xA; /* BITMAP: 00001010 */
3497d2a5f9aSShuming Fan
3507d2a5f9aSShuming Fan nval = hweight32(prop->source_ports);
3517d2a5f9aSShuming Fan prop->src_dpn_prop = devm_kcalloc(&slave->dev, nval,
3527d2a5f9aSShuming Fan sizeof(*prop->src_dpn_prop),
3537d2a5f9aSShuming Fan GFP_KERNEL);
3547d2a5f9aSShuming Fan if (!prop->src_dpn_prop)
3557d2a5f9aSShuming Fan return -ENOMEM;
3567d2a5f9aSShuming Fan
3577d2a5f9aSShuming Fan i = 0;
3587d2a5f9aSShuming Fan dpn = prop->src_dpn_prop;
3597d2a5f9aSShuming Fan addr = prop->source_ports;
3607d2a5f9aSShuming Fan for_each_set_bit(bit, &addr, 32) {
3617d2a5f9aSShuming Fan dpn[i].num = bit;
3627d2a5f9aSShuming Fan dpn[i].type = SDW_DPN_FULL;
3637d2a5f9aSShuming Fan dpn[i].simple_ch_prep_sm = true;
3647d2a5f9aSShuming Fan dpn[i].ch_prep_timeout = 10;
3657d2a5f9aSShuming Fan i++;
3667d2a5f9aSShuming Fan }
3677d2a5f9aSShuming Fan
3687d2a5f9aSShuming Fan /* do this again for sink now */
3697d2a5f9aSShuming Fan nval = hweight32(prop->sink_ports);
3707d2a5f9aSShuming Fan prop->sink_dpn_prop = devm_kcalloc(&slave->dev, nval,
3717d2a5f9aSShuming Fan sizeof(*prop->sink_dpn_prop),
3727d2a5f9aSShuming Fan GFP_KERNEL);
3737d2a5f9aSShuming Fan if (!prop->sink_dpn_prop)
3747d2a5f9aSShuming Fan return -ENOMEM;
3757d2a5f9aSShuming Fan
3767d2a5f9aSShuming Fan i = 0;
3777d2a5f9aSShuming Fan dpn = prop->sink_dpn_prop;
3787d2a5f9aSShuming Fan addr = prop->sink_ports;
3797d2a5f9aSShuming Fan for_each_set_bit(bit, &addr, 32) {
3807d2a5f9aSShuming Fan dpn[i].num = bit;
3817d2a5f9aSShuming Fan dpn[i].type = SDW_DPN_FULL;
3827d2a5f9aSShuming Fan dpn[i].simple_ch_prep_sm = true;
3837d2a5f9aSShuming Fan dpn[i].ch_prep_timeout = 10;
3847d2a5f9aSShuming Fan i++;
3857d2a5f9aSShuming Fan }
3867d2a5f9aSShuming Fan
3877d2a5f9aSShuming Fan /* set the timeout values */
3887d2a5f9aSShuming Fan prop->clk_stop_timeout = 20;
3897d2a5f9aSShuming Fan
3907d2a5f9aSShuming Fan /* wake-up event */
3917d2a5f9aSShuming Fan prop->wake_capable = 1;
3927d2a5f9aSShuming Fan
3937d2a5f9aSShuming Fan return 0;
3947d2a5f9aSShuming Fan }
3957d2a5f9aSShuming Fan
rt700_bus_config(struct sdw_slave * slave,struct sdw_bus_params * params)3967d2a5f9aSShuming Fan static int rt700_bus_config(struct sdw_slave *slave,
3977d2a5f9aSShuming Fan struct sdw_bus_params *params)
3987d2a5f9aSShuming Fan {
3997d2a5f9aSShuming Fan struct rt700_priv *rt700 = dev_get_drvdata(&slave->dev);
4007d2a5f9aSShuming Fan int ret;
4017d2a5f9aSShuming Fan
4027d2a5f9aSShuming Fan memcpy(&rt700->params, params, sizeof(*params));
4037d2a5f9aSShuming Fan
4047d2a5f9aSShuming Fan ret = rt700_clock_config(&slave->dev);
4057d2a5f9aSShuming Fan if (ret < 0)
4067d2a5f9aSShuming Fan dev_err(&slave->dev, "Invalid clk config");
4077d2a5f9aSShuming Fan
4087d2a5f9aSShuming Fan return ret;
4097d2a5f9aSShuming Fan }
4107d2a5f9aSShuming Fan
rt700_interrupt_callback(struct sdw_slave * slave,struct sdw_slave_intr_status * status)4117d2a5f9aSShuming Fan static int rt700_interrupt_callback(struct sdw_slave *slave,
4127d2a5f9aSShuming Fan struct sdw_slave_intr_status *status)
4137d2a5f9aSShuming Fan {
4147d2a5f9aSShuming Fan struct rt700_priv *rt700 = dev_get_drvdata(&slave->dev);
4157d2a5f9aSShuming Fan
4167d2a5f9aSShuming Fan dev_dbg(&slave->dev,
4177d2a5f9aSShuming Fan "%s control_port_stat=%x", __func__, status->control_port);
4187d2a5f9aSShuming Fan
41960888ef8SPierre-Louis Bossart mutex_lock(&rt700->disable_irq_lock);
42060888ef8SPierre-Louis Bossart if (status->control_port & 0x4 && !rt700->disable_irq) {
4217d2a5f9aSShuming Fan mod_delayed_work(system_power_efficient_wq,
4227d2a5f9aSShuming Fan &rt700->jack_detect_work, msecs_to_jiffies(250));
4237d2a5f9aSShuming Fan }
42460888ef8SPierre-Louis Bossart mutex_unlock(&rt700->disable_irq_lock);
4257d2a5f9aSShuming Fan
4267d2a5f9aSShuming Fan return 0;
4277d2a5f9aSShuming Fan }
4287d2a5f9aSShuming Fan
4297d2a5f9aSShuming Fan /*
4307d2a5f9aSShuming Fan * slave_ops: callbacks for get_clock_stop_mode, clock_stop and
4317d2a5f9aSShuming Fan * port_prep are not defined for now
4327d2a5f9aSShuming Fan */
433628fc9d9SRikard Falkeborn static const struct sdw_slave_ops rt700_slave_ops = {
4347d2a5f9aSShuming Fan .read_prop = rt700_read_prop,
4357d2a5f9aSShuming Fan .interrupt_callback = rt700_interrupt_callback,
4367d2a5f9aSShuming Fan .update_status = rt700_update_status,
4377d2a5f9aSShuming Fan .bus_config = rt700_bus_config,
4387d2a5f9aSShuming Fan };
4397d2a5f9aSShuming Fan
rt700_sdw_probe(struct sdw_slave * slave,const struct sdw_device_id * id)4407d2a5f9aSShuming Fan static int rt700_sdw_probe(struct sdw_slave *slave,
4417d2a5f9aSShuming Fan const struct sdw_device_id *id)
4427d2a5f9aSShuming Fan {
4437d2a5f9aSShuming Fan struct regmap *sdw_regmap, *regmap;
4447d2a5f9aSShuming Fan
4457d2a5f9aSShuming Fan /* Regmap Initialization */
4467d2a5f9aSShuming Fan sdw_regmap = devm_regmap_init_sdw(slave, &rt700_sdw_regmap);
447db1a4250SVinod Koul if (IS_ERR(sdw_regmap))
448db1a4250SVinod Koul return PTR_ERR(sdw_regmap);
4497d2a5f9aSShuming Fan
4507d2a5f9aSShuming Fan regmap = devm_regmap_init(&slave->dev, NULL,
4517d2a5f9aSShuming Fan &slave->dev, &rt700_regmap);
45220435df1SWei Yongjun if (IS_ERR(regmap))
45320435df1SWei Yongjun return PTR_ERR(regmap);
4547d2a5f9aSShuming Fan
455*3f3d66baSPierre-Louis Bossart return rt700_init(&slave->dev, sdw_regmap, regmap, slave);
4567d2a5f9aSShuming Fan }
4577d2a5f9aSShuming Fan
rt700_sdw_remove(struct sdw_slave * slave)4587d2a5f9aSShuming Fan static int rt700_sdw_remove(struct sdw_slave *slave)
4597d2a5f9aSShuming Fan {
4607d2a5f9aSShuming Fan struct rt700_priv *rt700 = dev_get_drvdata(&slave->dev);
4617d2a5f9aSShuming Fan
462ac63716dSPierre-Louis Bossart if (rt700->hw_init) {
463737ee8bdSPierre-Louis Bossart cancel_delayed_work_sync(&rt700->jack_detect_work);
464737ee8bdSPierre-Louis Bossart cancel_delayed_work_sync(&rt700->jack_btn_check_work);
4657d2a5f9aSShuming Fan }
4667d2a5f9aSShuming Fan
467ac63716dSPierre-Louis Bossart pm_runtime_disable(&slave->dev);
468ac63716dSPierre-Louis Bossart
4697d2a5f9aSShuming Fan return 0;
4707d2a5f9aSShuming Fan }
4717d2a5f9aSShuming Fan
4727d2a5f9aSShuming Fan static const struct sdw_device_id rt700_id[] = {
4739e473058SPierre-Louis Bossart SDW_SLAVE_ENTRY_EXT(0x025d, 0x700, 0x1, 0, 0),
4747d2a5f9aSShuming Fan {},
4757d2a5f9aSShuming Fan };
4767d2a5f9aSShuming Fan MODULE_DEVICE_TABLE(sdw, rt700_id);
4777d2a5f9aSShuming Fan
rt700_dev_suspend(struct device * dev)478809a9b63STakashi Iwai static int __maybe_unused rt700_dev_suspend(struct device *dev)
4797d2a5f9aSShuming Fan {
4807d2a5f9aSShuming Fan struct rt700_priv *rt700 = dev_get_drvdata(dev);
4817d2a5f9aSShuming Fan
4827d2a5f9aSShuming Fan if (!rt700->hw_init)
4837d2a5f9aSShuming Fan return 0;
4847d2a5f9aSShuming Fan
4855f2df2a4SShuming Fan cancel_delayed_work_sync(&rt700->jack_detect_work);
4865f2df2a4SShuming Fan cancel_delayed_work_sync(&rt700->jack_btn_check_work);
4875f2df2a4SShuming Fan
4887d2a5f9aSShuming Fan regcache_cache_only(rt700->regmap, true);
4897d2a5f9aSShuming Fan
4907d2a5f9aSShuming Fan return 0;
4917d2a5f9aSShuming Fan }
4927d2a5f9aSShuming Fan
rt700_dev_system_suspend(struct device * dev)49360888ef8SPierre-Louis Bossart static int __maybe_unused rt700_dev_system_suspend(struct device *dev)
49460888ef8SPierre-Louis Bossart {
49560888ef8SPierre-Louis Bossart struct sdw_slave *slave = dev_to_sdw_dev(dev);
49660888ef8SPierre-Louis Bossart struct rt700_priv *rt700 = dev_get_drvdata(dev);
49760888ef8SPierre-Louis Bossart int ret;
49860888ef8SPierre-Louis Bossart
49960888ef8SPierre-Louis Bossart if (!rt700->hw_init)
50060888ef8SPierre-Louis Bossart return 0;
50160888ef8SPierre-Louis Bossart
50260888ef8SPierre-Louis Bossart /*
50360888ef8SPierre-Louis Bossart * prevent new interrupts from being handled after the
50460888ef8SPierre-Louis Bossart * deferred work completes and before the parent disables
50560888ef8SPierre-Louis Bossart * interrupts on the link
50660888ef8SPierre-Louis Bossart */
50760888ef8SPierre-Louis Bossart mutex_lock(&rt700->disable_irq_lock);
50860888ef8SPierre-Louis Bossart rt700->disable_irq = true;
50960888ef8SPierre-Louis Bossart ret = sdw_update_no_pm(slave, SDW_SCP_INTMASK1,
51060888ef8SPierre-Louis Bossart SDW_SCP_INT1_IMPL_DEF, 0);
51160888ef8SPierre-Louis Bossart mutex_unlock(&rt700->disable_irq_lock);
51260888ef8SPierre-Louis Bossart
51360888ef8SPierre-Louis Bossart if (ret < 0) {
51460888ef8SPierre-Louis Bossart /* log but don't prevent suspend from happening */
51560888ef8SPierre-Louis Bossart dev_dbg(&slave->dev, "%s: could not disable imp-def interrupts\n:", __func__);
51660888ef8SPierre-Louis Bossart }
51760888ef8SPierre-Louis Bossart
51860888ef8SPierre-Louis Bossart return rt700_dev_suspend(dev);
51960888ef8SPierre-Louis Bossart }
52060888ef8SPierre-Louis Bossart
5217ef8c9edSPierre-Louis Bossart #define RT700_PROBE_TIMEOUT 5000
5227d2a5f9aSShuming Fan
rt700_dev_resume(struct device * dev)523809a9b63STakashi Iwai static int __maybe_unused rt700_dev_resume(struct device *dev)
5247d2a5f9aSShuming Fan {
5257d2a5f9aSShuming Fan struct sdw_slave *slave = dev_to_sdw_dev(dev);
5267d2a5f9aSShuming Fan struct rt700_priv *rt700 = dev_get_drvdata(dev);
5277d2a5f9aSShuming Fan unsigned long time;
5287d2a5f9aSShuming Fan
529a9e54e5fSPierre-Louis Bossart if (!rt700->first_hw_init)
5307d2a5f9aSShuming Fan return 0;
5317d2a5f9aSShuming Fan
5327d2a5f9aSShuming Fan if (!slave->unattach_request)
5337d2a5f9aSShuming Fan goto regmap_sync;
5347d2a5f9aSShuming Fan
5357d2a5f9aSShuming Fan time = wait_for_completion_timeout(&slave->initialization_complete,
5367d2a5f9aSShuming Fan msecs_to_jiffies(RT700_PROBE_TIMEOUT));
5377d2a5f9aSShuming Fan if (!time) {
5387d2a5f9aSShuming Fan dev_err(&slave->dev, "Initialization not complete, timed out\n");
539917df025SPierre-Louis Bossart sdw_show_ping_status(slave->bus, true);
540917df025SPierre-Louis Bossart
5417d2a5f9aSShuming Fan return -ETIMEDOUT;
5427d2a5f9aSShuming Fan }
5437d2a5f9aSShuming Fan
5447d2a5f9aSShuming Fan regmap_sync:
5457d2a5f9aSShuming Fan slave->unattach_request = 0;
5467d2a5f9aSShuming Fan regcache_cache_only(rt700->regmap, false);
5477d2a5f9aSShuming Fan regcache_sync_region(rt700->regmap, 0x3000, 0x8fff);
5487d2a5f9aSShuming Fan regcache_sync_region(rt700->regmap, 0x752010, 0x75206b);
5497d2a5f9aSShuming Fan
5507d2a5f9aSShuming Fan return 0;
5517d2a5f9aSShuming Fan }
5527d2a5f9aSShuming Fan
5537d2a5f9aSShuming Fan static const struct dev_pm_ops rt700_pm = {
55460888ef8SPierre-Louis Bossart SET_SYSTEM_SLEEP_PM_OPS(rt700_dev_system_suspend, rt700_dev_resume)
5557d2a5f9aSShuming Fan SET_RUNTIME_PM_OPS(rt700_dev_suspend, rt700_dev_resume, NULL)
5567d2a5f9aSShuming Fan };
5577d2a5f9aSShuming Fan
5587d2a5f9aSShuming Fan static struct sdw_driver rt700_sdw_driver = {
5597d2a5f9aSShuming Fan .driver = {
5607d2a5f9aSShuming Fan .name = "rt700",
5617d2a5f9aSShuming Fan .owner = THIS_MODULE,
5627d2a5f9aSShuming Fan .pm = &rt700_pm,
5637d2a5f9aSShuming Fan },
5647d2a5f9aSShuming Fan .probe = rt700_sdw_probe,
5657d2a5f9aSShuming Fan .remove = rt700_sdw_remove,
5667d2a5f9aSShuming Fan .ops = &rt700_slave_ops,
5677d2a5f9aSShuming Fan .id_table = rt700_id,
5687d2a5f9aSShuming Fan };
5697d2a5f9aSShuming Fan module_sdw_driver(rt700_sdw_driver);
5707d2a5f9aSShuming Fan
5717d2a5f9aSShuming Fan MODULE_DESCRIPTION("ASoC RT700 driver SDW");
5727d2a5f9aSShuming Fan MODULE_AUTHOR("Shuming Fan <shumingf@realtek.com>");
5737d2a5f9aSShuming Fan MODULE_LICENSE("GPL v2");
574