soundwire: generic_bandwidth_allocation: update bpt_hstop

Update bus->bpt_hstop to record the hstop of the BPT stream.
And return -EAGAIN when there is no bandwidth for the BPT stream.

Signed-off-by: Bard Liao <yung-chuan.liao@linux.intel.com>

Author: bardliao

drivers/soundwire/generic_bandwidth_allocation.c

@@ -190,8 +190,8 @@ static void sdw_compute_master_ports(struct sdw_master_runtime *m_rt,
 	sdw_compute_slave_ports(m_rt, &t_data);
 }
 
-static void _sdw_compute_port_params(struct sdw_bus *bus,
-				     struct sdw_group_params *params, int count)
+static void _sdw_compute_port_params(struct sdw_bus *bus, struct sdw_group_params *params,
+				     int count, bool update_bpt_hstop)
 {
 	struct sdw_master_runtime *m_rt;
 	int port_bo, i, l;
@@ -223,6 +223,16 @@ static void _sdw_compute_port_params(struct sdw_bus *bus,
 			}
 
 			hstop = hstop - params[i].hwidth;
+			if (l == 0 && update_bpt_hstop && bus->bpt_hstop > hstop) {
+				/* Assume BPT stream uses lane 0 */
+				/*
+				 * hstart = hstop - params->hwidth + 1.
+				 * At this point after hstop = hstop - params[i].hwidth above,
+				 * the hstart is equal to hstop + 1, and bus->bpt_hstop should
+				 * be hstart - 1. so we can set bpt_hstop to hstop directly.
+				 */
+				bus->bpt_hstop = hstop;
+			}
 		}
 	}
 }
@@ -421,7 +431,7 @@ static int sdw_compute_port_params(struct sdw_bus *bus, struct sdw_stream_runtim
 	if (ret < 0)
 		goto free_params;
 
-	_sdw_compute_port_params(bus, params, group.count);
+	_sdw_compute_port_params(bus, params, group.count, stream->type == SDW_STREAM_BPT);
 
 free_params:
 	kfree(params);
@@ -695,11 +705,16 @@ int sdw_compute_params(struct sdw_bus *bus, struct sdw_stream_runtime *stream)
 	if (ret < 0)
 		return ret;
 
-	bus->bpt_hstop = bus->params.col - 1;
-	if (stream->type == SDW_STREAM_BPT) {
-		sdw_compute_dp0_port_params(bus);
-		return 0;
-	}
+	/*
+	 * Set the initial bpt_hstop and reserve 2 columns for future audio stream if there
+	 * are equal or more than 6 columns in the frame shape. We don't reserve columns for
+	 * future audio stream if there are no enough columns available, but BPT stream can
+	 * still use the available columns along with the existing audio streams.
+	 * bpt_hstop will be updated in sdw_compute_port_params() below.
+	 */
+	if (stream->type == SDW_STREAM_BPT && stream->state != SDW_STREAM_DEPREPARED &&
+	    bus->params.col >= 6)
+		bus->bpt_hstop = bus->params.col - 3;
 
 	/* Compute transport and port params */
 	ret = sdw_compute_port_params(bus, stream);
@@ -708,6 +723,15 @@ int sdw_compute_params(struct sdw_bus *bus, struct sdw_stream_runtime *stream)
 		return ret;
 	}
 
+	if (stream->type == SDW_STREAM_BPT) {
+		if (bus->bpt_hstop < 1) {
+			dev_err(bus->dev, "%s: No bandwidth for BPT stream\n",
+				__func__);
+			return -EAGAIN;
+		}
+		sdw_compute_dp0_port_params(bus);
+	}
+
 	return 0;
 }
 EXPORT_SYMBOL(sdw_compute_params);