Received-SPF: pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 2620:137:e000::3:1 as permitted sender) client-ip=2620:137:e000::3:1;
From:   Iulia Tanasescu <iulia.tanasescu@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, luiz.dentz@gmail.com,
        Iulia Tanasescu <iulia.tanasescu@nxp.com>
Subject: [PATCH 1/1] Bluetooth: ISO: Allow binding a PA sync socket
Date:   Mon, 16 Oct 2023 18:45:45 +0300
Message-Id: <20231016154545.2883-2-iulia.tanasescu@nxp.com>
In-Reply-To: <20231016154545.2883-1-iulia.tanasescu@nxp.com>
References: <20231016154545.2883-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?APVzS94YDOIGFhYwb6BlfIYslJb5c8D2gpM0Y3r2Dou1uUwK/HMYXANUlm4s?=
 =?us-ascii?Q?kU/YuzwAuXGIKBOl6k9Q2dTkNJTMpa+Wy8pV/o9a6YN5VmdkB6/BewgX2Bc1?=
 =?us-ascii?Q?7cC/zBUG+brgq8hbo11kl1tz2L3PSGLcwLuitEg9PUwxCaB1quR+GaWMxE+a?=
 =?us-ascii?Q?9WxY1wbajgzxfEcW4O8EhZIP65jbgwIdIFgT4z8sw2pzONXvLS7rCpsJ9zD5?=
 =?us-ascii?Q?7LbhTI/FX67wMLzqBizfFsPBprMpH4vIbYUixvl5DGfsR6NULvf84NlVdP3w?=
 =?us-ascii?Q?IZdBsVac/lDICUrd/BGcKE7DEn72ROQUlBT2avFcvqQ+QV7Li6cjutxckiXw?=
 =?us-ascii?Q?AJ1UspbRiZ7alF00x+ZHa5LLyZo4+ppZuv8O12yduu4Md6FxarlWxBHHnKmc?=
 =?us-ascii?Q?Ll1oq+kzvOpVL6lVJ8ULPRsPmuN4ahXPuCxPbMnlJ1SUwmomnHxtvzo/x3eJ?=
 =?us-ascii?Q?i/klZJxO1wPsRAcsPt61CrKRwDlnpUz4e6nR8GUhWOuhNa9OJbyseV/pQLow?=
 =?us-ascii?Q?xhluXqqCjaMwbdq1pVFU1hzKLwx5Hp/hdG/1yMkZ5FAU1He6RQeUObL8rKt6?=
 =?us-ascii?Q?TtDJYJhKbLYd2sT2e6AWmAlcquW1Bj/eANQ1XE2uC6sMX1VceOPOo0a49FuG?=
 =?us-ascii?Q?HSO47bpGvWzrRLr3icMZ2QdQi7CahLM4mKmibtTxg+I/7XIksbksdwBm+5VJ?=
 =?us-ascii?Q?q9LFVPqbEJ3lZqU+a87/tYBPpJWjZVyYZz0Stxt7MjS8OIf0jgw8SCvW5E2b?=
 =?us-ascii?Q?PZjWl7Sah3e+cqL9ZaGCNfGwk3y9Cohdn/A+auLx+yi5O46NkCGPGyKqcNyP?=
 =?us-ascii?Q?Msa/0Q7Fbt9uPR3V+dWVbwFBNmUr8cZgL3i6YwlOKtz9W6NjjjBZzuCfODqF?=
 =?us-ascii?Q?ZWEzS0XyF86Y0DyAyICmocJoLsYtzeeMDx7LYz7602hQOmEUJCFU9aNkS9k9?=
 =?us-ascii?Q?CL3RG/KCKONRrGFiebOtO+UxbRkt9N3rWxiAcZt0KgLZJ/U420Oiqf6a+P2I?=
 =?us-ascii?Q?3q7f2acDrmCfcZut0UW59n//hOT3ICVg17ISM41v9bAkU2/Ubl7qrAIb5guV?=
 =?us-ascii?Q?BkYb4o/W3ghxhKvD2FjzDS546wbdlWCdYr+g64eE74FVYhcewW4Xgwfmg/4g?=
 =?us-ascii?Q?6Fv9w1LLjAP5Z5krCNcNTD/Q2C8maPvdLKl4H9RXH3sK0uv4cbE6px5mHB8j?=
 =?us-ascii?Q?8Y1tBwsAI7mJ9exd4JA4thdZEgqU77N5jExglHzwm0pp5RwBgBE596A4z22J?=
 =?us-ascii?Q?5MAe5WmGI4zlLkcsLi9lPCqCrfx5OOA/UkPn8lI3C+D1/ffJRoO7H+5URUbd?=
 =?us-ascii?Q?zBRcQzkvgtVZ0sNHkEylQ1PBYp/oqoEpyRblxsiOu9w+uTKYVSr7RXD1/nit?=
 =?us-ascii?Q?F46wa2d5HGUH7tJFQdOYmPEu1UFodVicIEK1Oin4SF2oKBndCRT/nJYU2fRm?=
 =?us-ascii?Q?jtSsdkb4sp5mg/+DRfpwRskGUGWpBZ2JiGmsypbgQXBYG/PnJioau3y+XsvO?=
 =?us-ascii?Q?6sY7CrVyiU/ObUjSo1+lrSNhPz3lV2fZwKABYjagmD/t4RB3DDvqJJVKGzTY?=
 =?us-ascii?Q?pG4OKBV81RzwgR4Z3AkO+oBHjsdhR+iQhndg9SExAzqTUd8FIKZLOsyL4eRO?=
 =?us-ascii?Q?CQ=3D=3D?=
X-OriginatorOrg: nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: 2bea6aca-0328-41e6-07d4-08dbce5efd98
X-MS-Exchange-CrossTenant-AuthSource: AS8PR04MB8898.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 16 Oct 2023 15:45:58.1013
 (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: hHbwac0wdusjt+vwBuP0mVu5I//nYgE41d32G+3tw2AeH/qiUesVXsYazsHuMXq+uTWMfIuohY5nnOz38nvcfQ==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: VE1PR04MB7423
X-Spam-Status: No, score=-0.8 required=5.0 tests=DKIM_SIGNED,DKIM_VALID,
	DKIM_VALID_AU,HEADER_FROM_DIFFERENT_DOMAINS,MAILING_LIST_MULTI,
	SPF_HELO_NONE,SPF_PASS autolearn=unavailable autolearn_force=no
	version=3.4.6
X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on morse.vger.email
Precedence: bulk
List-ID: <linux-bluetooth.vger.kernel.org>
X-Mailing-List: linux-bluetooth@vger.kernel.org
X-Greylist: Sender passed SPF test, not delayed by milter-greylist-4.6.4 (morse.vger.email [0.0.0.0]); Mon, 16 Oct 2023 08:46:04 -0700 (PDT)

This makes it possible to bind a PA sync socket to a number of BISes
before issuing the BIG Create Sync command.

Signed-off-by: Iulia Tanasescu <iulia.tanasescu@nxp.com>
---
 net/bluetooth/iso.c | 41 +++++++++++++++++++++++++++++++++++++++++
 1 file changed, 41 insertions(+)

diff --git a/net/bluetooth/iso.c b/net/bluetooth/iso.c
index 07b80e97aead..6938ff4accb3 100644
--- a/net/bluetooth/iso.c
+++ b/net/bluetooth/iso.c
@@ -813,6 +813,40 @@ static int iso_sock_bind_bc(struct socket *sock, struct sockaddr *addr,
 	return 0;
 }
 
+static int iso_sock_bind_pa_sk(struct sock *sk, struct sockaddr_iso *sa,
+			       int addr_len)
+{
+	int err = 0;
+
+	lock_sock(sk);
+
+	if (sk->sk_type != SOCK_SEQPACKET) {
+		err = -EINVAL;
+		goto done;
+	}
+
+	if (addr_len <= sizeof(*sa)) {
+		err = -EINVAL;
+		goto done;
+	}
+
+	iso_pi(sk)->bc_num_bis = sa->iso_bc->bc_num_bis;
+
+	for (int i = 0; i < iso_pi(sk)->bc_num_bis; i++)
+		if (sa->iso_bc->bc_bis[i] < 0x01 ||
+		    sa->iso_bc->bc_bis[i] > 0x1f) {
+			err = -EINVAL;
+			goto done;
+		}
+
+	memcpy(iso_pi(sk)->bc_bis, sa->iso_bc->bc_bis,
+	       iso_pi(sk)->bc_num_bis);
+
+done:
+	release_sock(sk);
+	return err;
+}
+
 static int iso_sock_bind(struct socket *sock, struct sockaddr *addr,
 			 int addr_len)
 {
@@ -826,6 +860,13 @@ static int iso_sock_bind(struct socket *sock, struct sockaddr *addr,
 	    addr->sa_family != AF_BLUETOOTH)
 		return -EINVAL;
 
+	/* Allow the user to bind a PA sync socket to a number
+	 * of BISes to sync to.
+	 */
+	if (sk->sk_state == BT_CONNECT2 &&
+	    test_bit(BT_SK_PA_SYNC, &iso_pi(sk)->flags))
+		return iso_sock_bind_pa_sk(sk, sa, addr_len);
+
 	lock_sock(sk);
 
 	if (sk->sk_state != BT_OPEN) {
-- 
2.39.2