Received-SPF: pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 2620:137:e000::1:18 as permitted sender) client-ip=2620:137:e000::1:18;
From:   Silviu Florian Barbulescu <silviu.barbulescu@nxp.com>
To:     linux-bluetooth@vger.kernel.org
Cc:     claudia.rosu@nxp.com, mihai-octavian.urzica@nxp.com,
        silviu.barbulescu@nxp.com, vlad.pruteanu@nxp.com,
        andrei.istodorescu@nxp.com, iulia.tanasescu@nxp.com
Subject: [PATCH v3 2/3] bap: For broadcast ep extract capabilities from BASE
Date:   Fri, 18 Aug 2023 16:35:51 +0300
Message-Id: <20230818133552.20673-3-silviu.barbulescu@nxp.com>
In-Reply-To: <20230818133552.20673-1-silviu.barbulescu@nxp.com>
References: <20230818133552.20673-1-silviu.barbulescu@nxp.com>
Content-Transfer-Encoding: 8bit
Content-Type: text/plain
MIME-Version: 1.0
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0: =?us-ascii?Q?WOQT2dUdGdJY+8fpViVCl0SK+blaZ7i7AopO34zyIt0UgZLz6zLm37OhH/Pw?=
 =?us-ascii?Q?LWsxQyBW6cwGRXBLzfphxP/v9Q6RjLXGxRk13c+QOptDz7picmgSJNNZ+ccs?=
 =?us-ascii?Q?+6r07v7fs76sPi4b59Yu7u7/pTWeC6L2k3zLfLXn1KQT+ePiRsd6Yyt52ngR?=
 =?us-ascii?Q?ZbVjqCyyT2kWlYCLIAiw2TBs4U/wBSUYYgz1CXDXNKiMJt3QmH5ZtaMcpdBv?=
 =?us-ascii?Q?6JgTEnOOTBWDeRqOChaogHM8l3Cp5+7V6IWIedSShxB6ztBmF0e7MccfXdZS?=
 =?us-ascii?Q?u1/u/7nrXUD+cnkp3nQoAsuF2ETkkenoHLY4m1kwKlKP1ExImYXPkRMp+/WI?=
 =?us-ascii?Q?Jt9x3S/KO9qUbo//Yn8rAE51XO+91DUcwuNAvTonLGO0+ih5XVEQz49wdqnu?=
 =?us-ascii?Q?LjJSqALUMUsn2RNjG8S7qBZKPGcw1jYWWKWFN+2SbLU1vHEi3eWjhxI8MpJM?=
 =?us-ascii?Q?u5AI5bsB3MvpLb0MuzUw5P4xN711kOJY7mHj2G8SaD8xshh79Dy5Di8I/2RE?=
 =?us-ascii?Q?jX7aKAhwpqId5p2O3HcHEk610mNTUHCB3p7xIxXzrVofwpf9ZLIDgs4lXWWo?=
 =?us-ascii?Q?VEFHpZVd5cGg/5j/v02ODnKGNvgXYu64ySl3pIiyO8vOtXTu80xFAukXuvGS?=
 =?us-ascii?Q?ZzlLRy8gFpuU2D3GzFwlMWSlILpeJF8IMTWf+G8PgpIyFOA5LZ+CDq+T81Bi?=
 =?us-ascii?Q?u3YBfQMXv/3HsOv2DeLp897G8GDEUd4AnqORIrSlB8XoMMLaMM4kPp95kmfN?=
 =?us-ascii?Q?aiHaI1M8f4B4gKptkN2i14ULp+19C9p+hSSGoJnv8isCXC491RuLYOU/5RBE?=
 =?us-ascii?Q?C+YYo7ZWD9zvgJbsc5Uvgz32zcdJgHn239PXt9mvIBZ6VmaROEv8MqV8ZYxr?=
 =?us-ascii?Q?jS51Kz0CkyUAAKRqDjsNt/tP+/Y/haZW8oIvgAC6A6ihoUFHhgGUptxfLdjI?=
 =?us-ascii?Q?97GYJX9deS9o8EbzOEvcn42GI2ZRUvXdZnqEmPavGY0TxHAcT5E5zY2Btkv5?=
 =?us-ascii?Q?gNIE3B9+zWUsPeWtxSIlPcbZR3K4uiaUbnO5+DUDItCtnvOzNPbxGbp+RP48?=
 =?us-ascii?Q?AwxoeJgKoLLrj9tgLR8HdEHd49eVOZ7Ooxu1VvjdRizxov6nmp/bNtxJaUgv?=
 =?us-ascii?Q?DA0fLZvwMq+iXamRKiJrlaCb6moh5sDrtWN+RKKPyAopJREhhU2iOIYXKhEN?=
 =?us-ascii?Q?dDvI0y67qZ1zyQqWrXXCVzNIp02mQ4o57W80o7ERe9Va6+e15J9cb5X1sndz?=
 =?us-ascii?Q?ltdEpArf7GsgEWr2lPUMHr0fqAOnPkzZSTd2KzPgBels7Z8qzCuIZ3DFhLZz?=
 =?us-ascii?Q?j+wrBNbNPD839vovBo4RJGVeket9T6BF7GSNHYwvEWk0JNzTWxFJk7253CvG?=
 =?us-ascii?Q?RrejutkprdPHtaY+mIjWjxoP5OjSg/5lTZ3HXDB60w8/0+5GjS+SJv7gEo7N?=
 =?us-ascii?Q?GWCkVvRuEppaV/bPOUNeRDatDgMOHoAD91gB/POwUAAU1W2TmIv9aAKL5WqD?=
 =?us-ascii?Q?gP1NEHgVr3GVW38Z2OUF6xj53g6QEWgo3D7dL5+SwiXkKJk+GT1Yf65jIe+S?=
 =?us-ascii?Q?Ra9JpogKMfh5ppAxWthY/279xVj7TOn6TRx9DPyL0Axa/xWcxCtBsRXV7gAP?=
 =?us-ascii?Q?0A=3D=3D?=
X-OriginatorOrg: nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: 980c9928-a896-49c4-2a15-08db9ff01878
X-MS-Exchange-CrossTenant-AuthSource: VI1PR04MB5344.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 18 Aug 2023 13:36:15.6036
 (UTC)
X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted
X-MS-Exchange-CrossTenant-Id: 686ea1d3-bc2b-4c6f-a92c-d99c5c301635
X-MS-Exchange-CrossTenant-MailboxType: HOSTED
X-MS-Exchange-CrossTenant-UserPrincipalName: bcMZDTzSbPUP8/ob6YdKSLoCbVPiPHlcZJ9uMq2D3RPJFfHAP4r3yf6cywDNvHkrZyQJrztdXo7LNxDeoAkILsZhy8pPXN/SErr/tXOw6PY=
X-MS-Exchange-Transport-CrossTenantHeadersStamped: AS8PR04MB8263
X-Spam-Status: No, score=-2.1 required=5.0 tests=BAYES_00,DKIM_SIGNED,
        DKIM_VALID,DKIM_VALID_AU,DKIM_VALID_EF,RCVD_IN_DNSWL_NONE,
        RCVD_IN_MSPIKE_H2,SPF_HELO_PASS,SPF_PASS,URIBL_BLOCKED autolearn=ham
        autolearn_force=no version=3.4.6
X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on
        lindbergh.monkeyblade.net
Precedence: bulk
List-ID: <linux-bluetooth.vger.kernel.org>
X-Mailing-List: linux-bluetooth@vger.kernel.org

From: Claudia Draghicescu <claudia.rosu@nxp.com>

bap: For broadcast ep parse BASE to extract capabilities

---
 profiles/audio/bap.c | 24 +++++++++++++++++++-----
 1 file changed, 19 insertions(+), 5 deletions(-)

diff --git a/profiles/audio/bap.c b/profiles/audio/bap.c
index 8cbb238ef..de19023a9 100644
--- a/profiles/audio/bap.c
+++ b/profiles/audio/bap.c
@@ -74,6 +74,7 @@ struct bap_ep {
 	struct bt_bap_qos qos;
 	unsigned int id;
 	DBusMessage *msg;
+	struct iovec *base;
 };
 
 struct bap_data {
@@ -272,7 +273,8 @@ static int parse_array(DBusMessageIter *iter, struct iovec **iov)
 }
 
 static int parse_properties(DBusMessageIter *props, struct iovec **caps,
-				struct iovec **metadata, struct bt_bap_qos *qos)
+				struct iovec **metadata, struct iovec **base,
+				struct bt_bap_qos *qos)
 {
 	const char *key;
 	struct bt_bap_io_qos io_qos;
@@ -438,9 +440,20 @@ static int parse_properties(DBusMessageIter *props, struct iovec **caps,
 	}
 
 	if (broadcast) {
+		uint32_t presDelay;
+		uint8_t numSubgroups, numBis;
+		struct bt_bap_codec codec;
+
 		memcpy(&qos->bcast.io_qos, &io_qos, sizeof(io_qos));
 		qos->bcast.framing = framing;
-
+		if (!base)
+			return 0;
+		if (!(*base))
+			*base = new0(struct iovec, 1);
+		util_iov_memcpy(*base, (*caps)->iov_base, (*caps)->iov_len);
+		bap_parse_base((*caps)->iov_base, (*caps)->iov_len, bap_debug,
+			&presDelay, &numSubgroups, &numBis, &codec,
+			caps, NULL);
 	} else {
 		memcpy(&qos->ucast.io_qos, &io_qos, sizeof(io_qos));
 		qos->ucast.framing = framing;
@@ -565,7 +578,8 @@ static DBusMessage *set_configuration(DBusConnection *conn, DBusMessage *msg,
 		ep->qos.ucast.cis_id = BT_ISO_QOS_CIS_UNSET;
 	}
 
-	if (parse_properties(&props, &ep->caps, &ep->metadata, &ep->qos) < 0) {
+	if (parse_properties(&props, &ep->caps, &ep->metadata,
+				&ep->base, &ep->qos) < 0) {
 		DBG("Unable to parse properties");
 		return btd_error_invalid_args(msg);
 	}
@@ -1244,10 +1258,10 @@ static void bap_connect_io_broadcast(struct bap_data *data, struct bap_ep *ep,
 		g_source_remove(ep->io_id);
 		ep->io_id = 0;
 	}
-	base.base_len = ep->caps->iov_len;
+	base.base_len = ep->base->iov_len;
 
 	memset(base.base, 0, 248);
-	memcpy(base.base, ep->caps->iov_base, base.base_len);
+	memcpy(base.base, ep->base->iov_base, ep->base->iov_len);
 	DBG("ep %p stream %p ", ep, stream);
 	ba2str(btd_adapter_get_address(adapter), addr);
 
-- 
2.34.1