Received-SPF: pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 2620:137:e000::3:7 as permitted sender) client-ip=2620:137:e000::3:7;
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 v2 1/1] Bluetooth: ISO: Allow binding a PA sync socket
Date:   Wed, 18 Oct 2023 17:34:35 +0300
Message-Id: <20231018143435.3388-2-iulia.tanasescu@nxp.com>
In-Reply-To: <20231018143435.3388-1-iulia.tanasescu@nxp.com>
References: <20231018143435.3388-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?yVeNaB0gSIGaaVzp1yPMYLSohPKnBnpuavxxIGk7g5AIOXQ2W/4pYv5C1/WJ?=
 =?us-ascii?Q?ujWlgngSrfBy5ZG7HLEOkBLBTxfHcV+KO/V0qy4iOYBeXZj6Ct2SZGVGJV/b?=
 =?us-ascii?Q?okibM5J8n+9NdZnyppplShr6He5MgGibMNV/ah412knkI5/do/CeNF0XRIrx?=
 =?us-ascii?Q?qLAjX3TrkI8q37Au43ZlhPsCsx38bdNfnY1SrRf+wCWtRGErqh/7pYurwc34?=
 =?us-ascii?Q?NzsyX5RAC3voVxzA+QBQOympqbza3oJ9HmWGXEe7lRwi2jpgVQwl3VZEzBXu?=
 =?us-ascii?Q?koPQ2OX9wDENw4NuSYxhusaciY6PMQydnQMexKsvRb2b+G1KgOZLJnetbGS3?=
 =?us-ascii?Q?oLjYnaKAWvfSoC1HSgVf50LFkbpf7nknbiLiHFxdRNWr9cOH2xlTGyGOYzX5?=
 =?us-ascii?Q?txd3vD/r6wM82AneyK2I1mfb6LZEC0CvGDfn4cPPx1I2+qRYZ2ZSI1PBqh9Y?=
 =?us-ascii?Q?v8zh/0pjQW4dugleVqa8AsurdGdYav4APo0dpL+JDJ5oGiXAU02DxMiXMz/g?=
 =?us-ascii?Q?/0KZ97vl5Oq+lzKb7++QsgdmcCLTgMk7g8RSh1a5X/h26HvhLm1pip3x9EtF?=
 =?us-ascii?Q?p8kQnbZGvZxxRTfV5UtcGChctE7rtf21rw2qSkjna2n421XsUs6ccZDGgZNg?=
 =?us-ascii?Q?xyeXD+76KY73pNKnxk6IQ08j5ybj0z7gk5avXKbbT7VutFvGSZn24MKsrzsv?=
 =?us-ascii?Q?71ffYAa0lYhmKWVMYhbm7SnG7vumPXUHghqazRG4SK0v3c+H6zfy05J0Co3G?=
 =?us-ascii?Q?a4Ipyu+feb8rL7esNVKKLxd0iv3yG+OL91BD05bvi3v//m7yGBFvKtLfp7rH?=
 =?us-ascii?Q?JZMNvBkoR6bUA5D80vDxqmURef5Gt8/Zyw8/1/drmLCjtlI0pwWVoin/6dnX?=
 =?us-ascii?Q?aUQgjvvyWIBdakkyFaPdtHVluFcP6DxG6QB1fLB42t5KtP2pG9uk6D+AHgkc?=
 =?us-ascii?Q?w+oTjJp1rg/y4YqRQRGJiWPlvPEG9QU8ymfGLfo6GjVvy8SuvhYQ9Q2kUlPX?=
 =?us-ascii?Q?X6AtAlf5Xn+mwrhl+ocSm0iAv3zxmqOFLH5fewZ5Cu19M+5nskPXs8zAl+UQ?=
 =?us-ascii?Q?JBSOU5oEtk4ZsBBYWKFaQfsGO4NSYLQzY/x3Otg+HA9zxCKZsx5rpeLfs3L0?=
 =?us-ascii?Q?9rUOUwbw5PLlAO/mmVlmxBV0cycVyWcNxZEkMRhxNMrxvozDXAuLE3FcosTb?=
 =?us-ascii?Q?HQYKcFdaXpU3VVgbv8AynIemA1hGyWwfH0skhILWcmYtGiqr0YrlIY/pUqrf?=
 =?us-ascii?Q?cLkRI7D83ntM0lLc1McRz0BMhhzyrYaGnVSH7G6eV9mE1oR0bz+E/3rgIv/e?=
 =?us-ascii?Q?QLiEENxq1QvQoKBJHJ0Bc+NQmi/o8gLV1fHWc0fcxSIc9RHlhYzUQm1LOyeS?=
 =?us-ascii?Q?CQYehOy0sJWeERpLlFrfLQ2r73wwLbtjVHT/PQ+JeHqxEg9OTPJFZ+C0x6sD?=
 =?us-ascii?Q?GzXC2Geq8fQkIMd/t+h+ofplYhfqBvcPXi3wYZ9yws5EjdEkjU8u+uDh6rtx?=
 =?us-ascii?Q?2QniR1PRaD2Xnjn36fP4pDASa6kKGwBeeQ9hDFZdAUSm5S3WLdjQxhuw9+22?=
 =?us-ascii?Q?QPRyGrG/8ZTwhCI/WA0UuHIPX1zogTfVWMF9V0ZX71kM83Hfa/M1hps7i67/?=
 =?us-ascii?Q?bQ=3D=3D?=
X-OriginatorOrg: nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: cc18ddc8-a66c-432b-816b-08dbcfe760dc
X-MS-Exchange-CrossTenant-AuthSource: AS8PR04MB8898.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 18 Oct 2023 14:34:47.3733
 (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: XBS5tIesXzKIT0/RZp5TvXHLaFuYNkus+bRe5hjbx+8o6+Y+IEoLP47VdnGa6/A3QKOtjYWgh+XT9Qzjc+DBTw==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: DBAPR04MB7270
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_BLOCKED,
        RCVD_IN_MSPIKE_H2,SPF_HELO_PASS,SPF_PASS 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
X-Greylist: Sender passed SPF test, not delayed by milter-greylist-4.6.4 (snail.vger.email [0.0.0.0]); Wed, 18 Oct 2023 07:36:56 -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 | 40 ++++++++++++++++++++++++++++++++++++++++
 1 file changed, 40 insertions(+)

diff --git a/net/bluetooth/iso.c b/net/bluetooth/iso.c
index 07b80e97aead..f20238c4702f 100644
--- a/net/bluetooth/iso.c
+++ b/net/bluetooth/iso.c
@@ -813,6 +813,37 @@ 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;
+
+	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:
+	return err;
+}
+
 static int iso_sock_bind(struct socket *sock, struct sockaddr *addr,
 			 int addr_len)
 {
@@ -828,6 +859,15 @@ static int iso_sock_bind(struct socket *sock, struct sockaddr *addr,
 
 	lock_sock(sk);
 
+	/* 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)) {
+		err = iso_sock_bind_pa_sk(sk, sa, addr_len);
+		goto done;
+	}
+
 	if (sk->sk_state != BT_OPEN) {
 		err = -EBADFD;
 		goto done;
-- 
2.39.2