soundwire: intel: add helper to stop bus

We have three nearly identical sequences to stop the clock, let's
introduce a helper to reuse the same code.
Signed-off-by: Pierre-Louis Bossart <pierre-louis.bossart@linux.intel.com>

Author: plbossart

drivers/soundwire/intel.c

@@ -1391,6 +1391,38 @@ static int intel_start_bus_after_clock_stop(struct sdw_intel *sdw)
 return0;
 }
 
+staticintintel_stop_bus(structsdw_intel*sdw, boolclock_stop)
+{
+structdevice*dev=sdw->cdns.dev;
+structsdw_cdns*cdns=&sdw->cdns;
+boolwake_enable= false;
+intret;
+
+if (clock_stop) {
+ret=sdw_cdns_clock_stop(cdns, true);
+if (ret<0)
+dev_err(dev, "%s: cannot stop clock: %d\n", __func__, ret);
+else
+wake_enable= true;
+	}
+
+ret=sdw_cdns_enable_interrupt(cdns, false);
+if (ret<0) {
+dev_err(dev, "%s: cannot disable interrupts: %d\n", __func__, ret);
+returnret;
+	}
+
+ret=intel_link_power_down(sdw);
+if (ret) {
+dev_err(dev, "%s: Link power down failed: %d\n", __func__, ret);
+returnret;
+	}
+
+intel_shim_wake(sdw, wake_enable);
+
+return0;
+}
+
 staticintsdw_master_read_intel_prop(structsdw_bus*bus)
 {
 structsdw_master_prop*prop=&bus->prop;
@@ -1792,20 +1824,12 @@ static int __maybe_unused intel_suspend(struct device *dev)
 return0;
 	}
 
-ret=sdw_cdns_enable_interrupt(cdns, false);
+ret=intel_stop_bus(sdw, false);
 if (ret<0) {
-dev_err(dev, "cannot disable interrupts on suspend\n");
+dev_err(dev, "%s: cannot stop bus: %d\n", __func__, ret);
 returnret;
 	}
 
-ret=intel_link_power_down(sdw);
-if (ret) {
-dev_err(dev, "Link power down failed: %d\n", ret);
-returnret;
-	}
-
-intel_shim_wake(sdw, false);
-
 return0;
 }
 
@@ -1826,44 +1850,19 @@ static int __maybe_unused intel_suspend_runtime(struct device *dev)
 clock_stop_quirks=sdw->link_res->clock_stop_quirks;
 
 if (clock_stop_quirks&SDW_INTEL_CLK_STOP_TEARDOWN) {
-
-ret=sdw_cdns_enable_interrupt(cdns, false);
+ret=intel_stop_bus(sdw, false);
 if (ret<0) {
-dev_err(dev, "cannot disable interrupts on suspend\n");
-returnret;
- }
-
-ret=intel_link_power_down(sdw);
-if (ret) {
-dev_err(dev, "Link power down failed: %d\n", ret);
+dev_err(dev, "%s: cannot stop bus during teardown: %d\n",
+__func__, ret);
 returnret;
  }
-
-intel_shim_wake(sdw, false);
-
-	} elseif (clock_stop_quirks&SDW_INTEL_CLK_STOP_BUS_RESET||
- !clock_stop_quirks) {
-boolwake_enable= true;
-
-ret=sdw_cdns_clock_stop(cdns, true);
-if (ret<0) {
-dev_err(dev, "cannot enable clock stop on suspend\n");
-wake_enable= false;
- }
-
-ret=sdw_cdns_enable_interrupt(cdns, false);
+	} elseif (clock_stop_quirks&SDW_INTEL_CLK_STOP_BUS_RESET|| !clock_stop_quirks) {
+ret=intel_stop_bus(sdw, true);
 if (ret<0) {
-dev_err(dev, "cannot disable interrupts on suspend\n");
-returnret;
- }
-
-ret=intel_link_power_down(sdw);
-if (ret) {
-dev_err(dev, "Link power down failed: %d\n", ret);
+dev_err(dev, "%s: cannot stop bus during clock_stop: %d\n",
+__func__, ret);
 returnret;
  }
-
-intel_shim_wake(sdw, wake_enable);
 	} else {
 dev_err(dev, "%s clock_stop_quirks %x unsupported\n",
 __func__, clock_stop_quirks);