Received-SPF: pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20;
From:   Iulia Tanasescu <iulia.tanasescu@nxp.com>
To:     linux-bluetooth@vger.kernel.org
Cc:     Iulia Tanasescu <iulia.tanasescu@nxp.com>
Subject: [PATCH BlueZ 1/2] btdev: Support multiple BIS
Date:   Mon, 29 May 2023 09:24:57 +0300
Message-Id: <20230529062458.3632-2-iulia.tanasescu@nxp.com>
In-Reply-To: <20230529062458.3632-1-iulia.tanasescu@nxp.com>
References: <20230529062458.3632-1-iulia.tanasescu@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?JpFyMgU21ag5g4t4mXWepRXHXMvTxcHcpkhZxKHXsZraGZdTd/V0po1GGerq?=
 =?us-ascii?Q?qC7st6EHynxyGjW/T/pyJTo2OrVTA2tKmv+nGhbe8kYLsIs4BtxA9Ru+2x7O?=
 =?us-ascii?Q?IGZ6Jij4Zz+BAnaK4/jSqyX6i32aXJ7sJZvmPassuamX12s8RbZK7CV3BFzf?=
 =?us-ascii?Q?jFeMTXl73MdFMX0QEj322m8lq/6/bHXEJ+1m0ccYnqc3XYIyp6U6GixYwNqO?=
 =?us-ascii?Q?Nh5boBHz2PX+XsiBMC+RX7v+sRcpiHDcl3fooyfOFH6ufgsOIAUUrcSMB31m?=
 =?us-ascii?Q?PEVjvsaWSQ5rN8e6HN77AcmIoAjWDvEN1B34sLh80HlImCue/LD78Sv1Sitt?=
 =?us-ascii?Q?QJPV8utaiBXPY92VFvAcziY+IbCSwbil39GMqaf9XtU/j5fZOdUaw7VlHSv+?=
 =?us-ascii?Q?sAG0Sc3REqb97UV8hq9Lh+Iw0xpvi8cuTlUOcskb0KC9BCN5AmB8jHwFZCf9?=
 =?us-ascii?Q?yPB54z2PjKrmYIYwgq+63K4ZRM44khH40JklmAuOnMHNpOvuQbQ1zTlimSzy?=
 =?us-ascii?Q?PtC9P5H1fjBp37UPsBs5CEbyH4VYRUhndhoG/uG2y3Zof7P2eCSqQLhNx6OU?=
 =?us-ascii?Q?3RHBRmW/HUskt1AGq6UQwSUjSPI97ncUYI+QWJkrSpwR63CBO3FItMe7yDdy?=
 =?us-ascii?Q?zyI2DXD/JJJ2tLBFIwJLQexuzVdPakvEe6tfqi7bGCY6Llrkz2nDPEE8ZeRx?=
 =?us-ascii?Q?OKv2F/4ZYoQEvxh/20gv/sruEuhEytiEmJdP0EpDm+y+ok7f44BtdcTaCo1a?=
 =?us-ascii?Q?LsVDjoiHQi5shMXsf3RBXGVUMDXVE4DfZ4gHHJTPo+iszz4ucUAQujvOuWBd?=
 =?us-ascii?Q?gyEby7mBXT4ENkfTkEj1F+AOiAJr7nKYIZfHV/GICQ8RE2JiC1NKSNPjrfCz?=
 =?us-ascii?Q?nupo3OayFSww118X6FDFWjVjBwDZdDRFSx0ejmRKKy8k1OYlvo3KhUbB+ZDq?=
 =?us-ascii?Q?1uVufhKCja+MMV493Meu+V3U0BGvU3vMzVxQW/nVNhS5V7H5meU2fiROg+vo?=
 =?us-ascii?Q?2C0ljN2FUVQ+yuA7qnXeMBKj1XHfdApQXFZcfjQLjAQibWNqugtFYbp75GgV?=
 =?us-ascii?Q?zqLji6rMhXVOmbcOPQhzA5OQQmP5PxfdIaiWzWXZyz7KU8wXFmt+Q57JK+sU?=
 =?us-ascii?Q?QxbyFa4qQnXOapQVQFXbbKEBudeoZrYIiKsKKwWAdwuAXTo2LeLXnYybAbdS?=
 =?us-ascii?Q?JlvV8mOWGL5ilBmZrHRNHcxPVJs1Gf7KkQX+YN2Xl6PaAujMGKzSywhuXkWU?=
 =?us-ascii?Q?mz/IpGqaWbHUwWpemdImsXtPwcryd0v69P25VVXQ5bZU10eUZabsdp4U2xYs?=
 =?us-ascii?Q?CCgBLtXsF1oMc4XrDMddvau7pLEDathKDtli5YP1Avwdrx+UBXNlTuQKe7qt?=
 =?us-ascii?Q?+7z9yslCQQzhab9T7JttaBN/+gfQuZ2rlEN+PcK0gRL6E00ChNBFcVZvNK7X?=
 =?us-ascii?Q?9S004cd0fMn6M+EgHJPLPdA+DTQL++BPpQc4Elw3xdYYggrgtA23lIgka8M6?=
 =?us-ascii?Q?F9RCQkzjU0PN8YZ+omKGXYTbKBu+z1SPvxqTvXCjWPNLEiCcfCb1rriyD/3L?=
 =?us-ascii?Q?zFEDhaZtiyYpBjXrUXNlmQ79q2HQLsUxroLsPX1Hv8bZE4ejn+Ogqn8nUGPv?=
 =?us-ascii?Q?0Q=3D=3D?=
X-OriginatorOrg: nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: f22b87dc-de83-47a9-6a3f-08db600d7727
X-MS-Exchange-CrossTenant-AuthSource: AS8PR04MB8898.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 29 May 2023 06:25:15.4156
 (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: cNIBckFdhptrd4ZkywPmHsHxKg7ZI9OHPekozbCks8eh/ptgecbOPqYtbQWf/z+X1Whgp1Z7SuF3m8QDhmMAHw==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: DB8PR04MB7177
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,T_SCC_BODY_TEXT_LINE
        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

This adds support for creating a BIG with multiple BISes.

---
 emulator/btdev.c | 52 ++++++++++++++++++++++++++++++------------------
 1 file changed, 33 insertions(+), 19 deletions(-)

diff --git a/emulator/btdev.c b/emulator/btdev.c
index f9260511a..2e15d5af2 100644
--- a/emulator/btdev.c
+++ b/emulator/btdev.c
@@ -6101,35 +6101,49 @@ static int cmd_create_big_complete(struct btdev *dev, const void *data,
 	const struct bt_hci_cmd_le_create_big *cmd = data;
 	const struct bt_hci_bis *bis = &cmd->bis;
 	int i;
+	struct bt_hci_evt_le_big_complete evt;
+	uint16_t *bis_handle;
+	uint8_t *pdu;
+	uint8_t pdu_len;
+
+	pdu_len = sizeof(evt) + cmd->num_bis * sizeof(*bis_handle);
+
+	pdu = malloc(pdu_len);
+	if (!pdu)
+		return -ENOMEM;
+
+	bis_handle = (uint16_t *)(pdu + sizeof(evt));
+
+	memset(&evt, 0, sizeof(evt));
 
 	for (i = 0; i < cmd->num_bis; i++) {
 		struct btdev_conn *conn;
-		struct {
-			struct bt_hci_evt_le_big_complete evt;
-			uint16_t handle;
-		} pdu;
-
-		memset(&pdu, 0, sizeof(pdu));
 
-		conn = conn_add_bis(dev, ISO_HANDLE, bis);
+		conn = conn_add_bis(dev, ISO_HANDLE + i, bis);
 		if (!conn) {
-			pdu.evt.status = BT_HCI_ERR_MEM_CAPACITY_EXCEEDED;
+			evt.status = BT_HCI_ERR_MEM_CAPACITY_EXCEEDED;
 			goto done;
 		}
 
-		pdu.evt.handle = cmd->handle;
-		pdu.evt.num_bis++;
-		pdu.evt.phy = bis->phy;
-		pdu.evt.max_pdu = bis->sdu;
-		memcpy(pdu.evt.sync_delay, bis->sdu_interval, 3);
-		memcpy(pdu.evt.latency, bis->sdu_interval, 3);
-		pdu.evt.interval = bis->latency / 1.25;
-		pdu.handle = cpu_to_le16(conn->handle);
+		*bis_handle = cpu_to_le16(conn->handle);
+		bis_handle++;
+	}
+
+	evt.handle = cmd->handle;
+	evt.phy = bis->phy;
+	evt.max_pdu = bis->sdu;
+	memcpy(evt.sync_delay, bis->sdu_interval, 3);
+	memcpy(evt.latency, bis->sdu_interval, 3);
+	evt.interval = bis->latency / 1.25;
+	evt.num_bis = cmd->num_bis;
 
 done:
-		le_meta_event(dev, BT_HCI_EVT_LE_BIG_COMPLETE, &pdu,
-					sizeof(pdu));
-	}
+	memcpy(pdu, &evt, sizeof(evt));
+
+	le_meta_event(dev, BT_HCI_EVT_LE_BIG_COMPLETE, pdu,
+						pdu_len);
+
+	free(pdu);
 
 	return 0;
 }
-- 
2.34.1