soundwire: intel_ace2x: configure link PHY

Unlike previous hardware generations, the glue-to-master transition is
not managed by software, instead the transitions are managed as part
of the power-up/down sequences controlled by SPA/CPA bits.

The only thing that's required is to configure the link PHY for
'normal' operation instead of the PHY test mode.

Signed-off-by: Pierre-Louis Bossart <pierre-louis.bossart@linux.intel.com>
Reviewed-by: Rander Wang <rander.wang@intel.com>
Reviewed-by: Péter Ujfalusi <peter.ujfalusi@linux.intel.com>
Reviewed-by: Ranjani Sridharan <ranjani.sridharan@linux.intel.com>
Signed-off-by: Bard Liao <yung-chuan.liao@linux.intel.com>
Link: https://lore.kernel.org/r/20230515071042.2038-14-yung-chuan.liao@linux.intel.com
Signed-off-by: Vinod Koul <vkoul@kernel.org>

diff --git a/drivers/soundwire/intel_ace2x.c b/drivers/soundwire/intel_ace2x.c
index 01668246b7ba6b16fd18e1bf5486733f28cbc9f0..5deff32976f1324237842bdb0a913a365f4c36ef 100644 (file)
--- a/drivers/soundwire/intel_ace2x.c
+++ b/drivers/soundwire/intel_ace2x.c
@@ -15,6 +15,22 @@
 #include "bus.h"
 #include "intel.h"
 
+/*
+ * shim vendor-specific (vs) ops
+ */
+
+static void intel_shim_vs_init(struct sdw_intel *sdw)
+{
+       void __iomem *shim_vs = sdw->link_res->shim_vs;
+       u16 act = 0;
+
+       u16p_replace_bits(&act, 0x1, SDW_SHIM2_INTEL_VS_ACTMCTL_DOAIS);
+       act |= SDW_SHIM2_INTEL_VS_ACTMCTL_DACTQE;
+       act |=  SDW_SHIM2_INTEL_VS_ACTMCTL_DODS;
+       intel_writew(shim_vs, SDW_SHIM2_INTEL_VS_ACTMCTL, act);
+       usleep_range(10, 15);
+}
+
 static int intel_link_power_up(struct sdw_intel *sdw)
 {
        struct sdw_bus *bus = &sdw->cdns.bus;
@@ -63,6 +79,9 @@ static int intel_link_power_up(struct sdw_intel *sdw)
        *shim_mask |= BIT(link_id);
 
        sdw->cdns.link_up = true;
+
+       intel_shim_vs_init(sdw);
+
 out:
        mutex_unlock(sdw->link_res->shim_lock);