Received-SPF: pass (google.com: domain of linux-bluetooth+bounces-3073-linux.lists.archive=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) client-ip=2604:1380:45d1:ec00::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 BlueZ 2/3] bthost: Add support for Set PA data
Date: Tue,  2 Apr 2024 14:43:25 +0300
Message-Id: <20240402114326.3330-3-iulia.tanasescu@nxp.com>
In-Reply-To: <20240402114326.3330-1-iulia.tanasescu@nxp.com>
References: <20240402114326.3330-1-iulia.tanasescu@nxp.com>
Content-Transfer-Encoding: 8bit
Content-Type: text/plain
Precedence: bulk
MIME-Version: 1.0
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0:
	=?us-ascii?Q?5kvHWofzMbh79cFcqL9l5/0PfGGvHOizga4Cfc7pUK/WP7yWdTFoA8ODqp1v?=
 =?us-ascii?Q?vfj17dUF/wfYKguITd+zab5F8VRdtGpqYl8ByZ8FOFe6jb1bB9E3iRIOQKRU?=
 =?us-ascii?Q?lRIMlCu9tzsWsLIjg2G6SNS+03nAX+69emJRKONOri75on86pYSZ5HyngA0w?=
 =?us-ascii?Q?zp2sB2oAaLDnDciESfkvNw5jUMFw4hLZ/rYahwy01PMhRucwfUPXFuxHP+3L?=
 =?us-ascii?Q?rq++OrlZThO5LWqUiNgjpFz6SRqoXtqVRfVd31bNNuw8Z9inVZv7dgClKhhI?=
 =?us-ascii?Q?0WncbsqxdPBPnuS0Rxm2bJ3aT0pq9ZrfYvQaLzf8R3cYgtGZ4uUvjku9f4DE?=
 =?us-ascii?Q?Lx0qOSkJ+1P847WiFdR5OJVcc5hQzvGYeZ8JQ+Veo8dOLYewpVAPoopy27+r?=
 =?us-ascii?Q?Wa71THlNK5LPonG+x1B40JN4QkUklHlDYcdTZji41MXLwi86hWo0ShJXOYN7?=
 =?us-ascii?Q?9ebbh6OtJPIByQ7qrHa4moY/11invdRMXW6cSKLFk6TyFO+4zhFe1QYXOINI?=
 =?us-ascii?Q?MQWdw4vBsDkujhoVlOA4icYBDO6YLSnBWt092jL+ugRk27w06q4DAHZ9WvLK?=
 =?us-ascii?Q?yOkh9uwuO0e2WqfFRPpwT2dzORcJkDLdhgytRJ6KxH02wA6O716y+SgLr3af?=
 =?us-ascii?Q?fGchgAOnz+GvT6ysPZnnrHcQg/6xnaaHmYcF9T/l4hQ5cs27Yp9zFlsLSO5z?=
 =?us-ascii?Q?CtJMICAj0E733Gv/mhqGZh6Yq5sgi0RobDdXTdnWGgQQRKzTmu7jmmwT+J/b?=
 =?us-ascii?Q?VfuVjF/GaXEn/uCrBQuMquJVwIaL4kkCZrrIDuC88nOjtvvcke4lD7t+B23M?=
 =?us-ascii?Q?QSG5LVnJQgskJwJicxP7bn9vd8NK5x6RrbftuUc/nzZ0CdNkVioHD5/OBrxf?=
 =?us-ascii?Q?Drs4Pda6sL1DT9Q71JLx1J8XAoKqcVqK68Dhz12nxZ8zNRMumkeFbfbMRHKh?=
 =?us-ascii?Q?N9U0NoI9lYDTgNDObwcRs6OOm34+H7Ps2uLCqIkvszQBvCM9KTc4A4zDbL02?=
 =?us-ascii?Q?NZrn0FogWz+Y8UD0AfYivbO/JNQ4xLEF4e6U5fbfutqz9voeKYpCZdMJIB+Y?=
 =?us-ascii?Q?50QhCFYgflTLfEZv7FEviSudFFLroaRsJ255yOWF1xO6EWhS7wGlJeVXGVjt?=
 =?us-ascii?Q?0VQW5XpdAFgtHHxWVfdwyywTIb19b0x6BGgBIERYWu6zAJNsbIRf5fhKFRDA?=
 =?us-ascii?Q?6JU6XNewydCqv3xdo4dHxva/5xIx/NRmRIHPAtZ8ZarD820cB9h8SLNf4iVX?=
 =?us-ascii?Q?3TP2fhuAkgc1xfnyjzlJuZmXUx7HiNZESModvr5w7vxO0mnAvjvtXwDYzJ8F?=
 =?us-ascii?Q?DaxaIXkLmZ728asu6Ow+2xj1rdpnkA21yCptLAdSWKw+PHpKJJMFZadep35G?=
 =?us-ascii?Q?y/sXuh1ENyFJFUFRucTYCgJIlOz3ZSr40eILYpmciig5kTBrzGkqajTdJzxh?=
 =?us-ascii?Q?KLM29FG92JJid0/jmbNUU4FByTzlx0elRpdhn/TxnMWuaaUsbEfP+bzISgAj?=
 =?us-ascii?Q?/yl135NKA/ECClYpIiK4sQvqkTvP9njOwCKP7h2KYl6JVRSzspErF2v8LOR+?=
 =?us-ascii?Q?gpv6DLi09PJYMSDwJU/4gAewSJtF92XzWG3TNo2udnen7b/qiF06QU0nODmY?=
 =?us-ascii?Q?Nw=3D=3D?=
X-OriginatorOrg: nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: 9fe044f5-141f-4b06-0ebb-08dc530a2361
X-MS-Exchange-CrossTenant-AuthSource: AS8PR04MB8898.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 02 Apr 2024 11:43:38.9903
 (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: AANPqXA3dyPekJ2VDHWb5CEODbr8vwetntlpna2yc7Vbu8RA8MPHWeXGFYPx9SFA9Q9AIBNIwaGf1vg+ffdSRA==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: DB9PR04MB9498

This adds bthost_set_pa_data.
---
 emulator/bthost.c | 48 ++++++++++++++++++++++++++++++++++++++++++++++-
 emulator/bthost.h |  4 +++-
 2 files changed, 50 insertions(+), 2 deletions(-)

diff --git a/emulator/bthost.c b/emulator/bthost.c
index 8c40fce90..d710f4982 100644
--- a/emulator/bthost.c
+++ b/emulator/bthost.c
@@ -5,7 +5,7 @@
  *
  *  Copyright (C) 2011-2012  Intel Corporation
  *  Copyright (C) 2004-2010  Marcel Holtmann <marcel@holtmann.org>
- *  Copyright 2023 NXP
+ *  Copyright 2023-2024 NXP
  *
  *
  */
@@ -3127,6 +3127,52 @@ void bthost_set_pa_params(struct bthost *bthost)
 	send_command(bthost, BT_HCI_CMD_LE_SET_PA_PARAMS, &cp, sizeof(cp));
 }
 
+static void set_pa_data(struct bthost *bthost, const uint8_t *data,
+				uint8_t len, uint8_t offset)
+{
+	struct bt_hci_cmd_le_set_pa_data *cp;
+	uint8_t buf[sizeof(*cp) + HCI_MAX_PER_AD_LENGTH];
+
+	cp = (void *)buf;
+
+	memset(cp, 0, sizeof(*cp));
+	memset(cp->data, 0, HCI_MAX_PER_AD_LENGTH);
+
+	cp->handle = 1;
+
+	if (len - offset > HCI_MAX_PER_AD_LENGTH) {
+		cp->data_len = HCI_MAX_PER_AD_LENGTH;
+
+		if (!offset)
+			cp->operation = 0x01;
+		else
+			cp->operation = 0x00;
+	} else {
+		cp->data_len = len - offset;
+
+		if (!offset)
+			cp->operation = 0x03;
+		else
+			cp->operation = 0x02;
+	}
+
+	memcpy(cp->data, data + offset, cp->data_len);
+
+	send_command(bthost, BT_HCI_CMD_LE_SET_PA_DATA, buf,
+					sizeof(*cp) + cp->data_len);
+
+	if (cp->operation == 0x01 || cp->operation == 0x00) {
+		offset += cp->data_len;
+		set_pa_data(bthost, data, len, offset);
+	}
+}
+
+void bthost_set_pa_data(struct bthost *bthost, const uint8_t *data,
+							uint8_t len)
+{
+	set_pa_data(bthost, data, len, 0);
+}
+
 void bthost_set_pa_enable(struct bthost *bthost, uint8_t enable)
 {
 	struct bt_hci_cmd_le_set_pa_enable cp;
diff --git a/emulator/bthost.h b/emulator/bthost.h
index 46781365b..f03262d46 100644
--- a/emulator/bthost.h
+++ b/emulator/bthost.h
@@ -5,7 +5,7 @@
  *
  *  Copyright (C) 2011-2012  Intel Corporation
  *  Copyright (C) 2004-2010  Marcel Holtmann <marcel@holtmann.org>
- *  Copyright 2023 NXP
+ *  Copyright 2023-2024 NXP
  *
  *
  */
@@ -102,6 +102,8 @@ void bthost_set_ext_adv_data(struct bthost *bthost, const uint8_t *data,
 void bthost_set_ext_adv_params(struct bthost *bthost);
 void bthost_set_ext_adv_enable(struct bthost *bthost, uint8_t enable);
 void bthost_set_pa_params(struct bthost *bthost);
+void bthost_set_pa_data(struct bthost *bthost, const uint8_t *data,
+								uint8_t len);
 void bthost_set_pa_enable(struct bthost *bthost, uint8_t enable);
 void bthost_create_big(struct bthost *bthost, uint8_t num_bis, uint8_t enc,
 				const uint8_t *bcode);
-- 
2.39.2