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 3/5] shared/util: Add iovec helpers for pulling/pushing le32 and le24 values
Date:   Fri,  5 May 2023 11:29:41 +0300
Message-Id: <20230505082943.92033-4-iulia.tanasescu@nxp.com>
In-Reply-To: <20230505082943.92033-1-iulia.tanasescu@nxp.com>
References: <20230505082943.92033-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?ge13dI7c73lYaQofkhutVWKoz1mcmtLu8JLKDEOfKDoGWSGpub7E4lohdfjI?=
 =?us-ascii?Q?6dMNwC17j1OQeXFftddzFV7NUsP4SSSsl8wl0/8PZw0AR1AUPE3RMygLvY5N?=
 =?us-ascii?Q?/+UP6Xblg+kqeaTNNlNufv0cENJses9qJhFg3QrthvPq6NR63QJOJ+tZ8o0h?=
 =?us-ascii?Q?YmVRe7W7791JHH40ET1H2tBR75SI5wkG+3OrC8J9drkVpOkMBvdQHn3D+kUc?=
 =?us-ascii?Q?NT96sLTKfqbBrVOw7t+6d1eRc2+A6bKOjBK2lTbykQuZkZZqxkykLlJXmet1?=
 =?us-ascii?Q?lfaFUjk+X8ktgvF1yoTitJX9fp7wBSrzR/7ehQLnTY8YAiGhGJ2CC/vKEYnd?=
 =?us-ascii?Q?WDRkQSJeSWv8yYFO67vY/JHhfB8WiFlzVdkx+hyoXD3uoVitk5jkvaWLwlyN?=
 =?us-ascii?Q?jJOD7p0lXnMfjDeAY4FHcnJ1W/H1lo1cl84ROPSNxCtu9D4TUjtZQ4h7USry?=
 =?us-ascii?Q?rF3XqRmDRccPyPOv2cf+WGGk0W0eOK+uRv27pcOxO4XKn6oK0kh88pkQy9Ht?=
 =?us-ascii?Q?yQ7eeiKa8X415GXuvV05khcD3k4k3bPwjVk6b/dfOjh4m7E2bpkHs9pxyqo2?=
 =?us-ascii?Q?7L5pRfhAR1yRR7DGQIlTdvKHzQDzViEuZDJc5W6XAS38qtPVodULqk6cr/q4?=
 =?us-ascii?Q?yuhiSrFF5XdtIXvBJjG3S60qnt7Ekh8Om3rG5/VeMAwLHF/prmTXMRXEULV5?=
 =?us-ascii?Q?DjObXb+xwk9ov/TiALr+UD+S9BFaWVWlDaae8R77o/niRzakEEC+W9kSEKDF?=
 =?us-ascii?Q?ow76pRKEPvdskRXHBluUYXiD0LkEUaSU8QQRfGa3BfiwtBlAc7yd74RLyRl2?=
 =?us-ascii?Q?63hqcUuZnYUPM8moUCSSWfZX4dXgPLmSMPKD4JqwekPdoG/y9h0YPxEnJ00L?=
 =?us-ascii?Q?O5xGb5XDr3H+tuhnB3WSlNk6jeYM/g1X0Uy7SWzGn4VzQq6lhsrNEsOyQhHt?=
 =?us-ascii?Q?iEM0uTnwsLcyGDZs82l/atbJ/1h8joE1mH4CK3hPO3Yuf5HB7dWomN2XnTW+?=
 =?us-ascii?Q?lX68WrowuReNHYJmgq5wJXtltcmajDujAtOBABf5WA0aVv5edj7+oQFiQyjk?=
 =?us-ascii?Q?tAAEL8AYEaylbrhrp9F25g1AiCKWX3DN52bbbGOay7WZXfOHSrLKWTSEB1/s?=
 =?us-ascii?Q?hzsG4dpsjH56KBQXESjbknzW+oc1pKUhlcHqnz9G1Enz1ndWwB2M18VDONn7?=
 =?us-ascii?Q?y7bOQy+KvUonCHWVcjbzKWMB2+QUG2/74wECEhFziIiaCBFlEysKtAeeZyzC?=
 =?us-ascii?Q?0YmB0I/0bSig58T8rSAdZFgM5ISvRyVNeU5oymxeiAnvRA7APjK9kHxmDGs7?=
 =?us-ascii?Q?pDbwfS0rgGtPDy7mL5xyf3JE99iEnMRrV8g0jNorHcRoVK9eDDDGs+uAY7l0?=
 =?us-ascii?Q?ZAlmwKaVmjF3cm5DcsLXBqPVSukkpaiu5MIhbXlPmwRw5t0efiDwNzyayx8o?=
 =?us-ascii?Q?C/tr+2PX9I51rnJbdg494aF5x8NfcPVDA4oZQSAgDdZxprnbkz9CZBo5f5C2?=
 =?us-ascii?Q?Z3esHpKm0q9HLYBVLNzEZY9VUWFkts/JWgXeJAqcdYtAMVVoR1S1hj2jczGL?=
 =?us-ascii?Q?QLr6ADYeNyTo4r9YtR9ri5COyAZ//DYGfoVE2ybxsEcVDNwHMSMf1/LGj+Xz?=
 =?us-ascii?Q?Kw=3D=3D?=
X-OriginatorOrg: nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: 7ba2263e-5044-4382-5e3c-08db4d42fd48
X-MS-Exchange-CrossTenant-AuthSource: AS8PR04MB8898.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 05 May 2023 08:30:32.6367
 (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: 77UAGm7EIQo6tjZ4RFItWNg5FlK2PXuDXEDanjoGHeGxruQprxuAa3WpZHYrcJQuT4y0xI9P/CqQEC428joHbg==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: AS8PR04MB8101
X-Spam-Status: No, score=-1.1 required=5.0 tests=BAYES_00,DKIM_SIGNED,
        DKIM_VALID,DKIM_VALID_AU,DKIM_VALID_EF,FORGED_SPF_HELO,SPF_HELO_PASS,
        T_SCC_BODY_TEXT_LINE,T_SPF_PERMERROR autolearn=no 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 iovec helper functions for handling le32 and le24 values.

---
 src/shared/util.c | 53 +++++++++++++++++++++++++++++++++++++++++++++++
 src/shared/util.h |  5 +++++
 2 files changed, 58 insertions(+)

diff --git a/src/shared/util.c b/src/shared/util.c
index 9a4a8d77a..f9d8ecbaa 100644
--- a/src/shared/util.c
+++ b/src/shared/util.c
@@ -4,6 +4,7 @@
  *  BlueZ - Bluetooth protocol stack for Linux
  *
  *  Copyright (C) 2012-2014  Intel Corporation. All rights reserved.
+ *  Copyright 2023 NXP
  *
  *
  */
@@ -28,6 +29,8 @@
 #include <sys/random.h>
 #endif
 
+#include <lib/bluetooth.h>
+
 /* define MAX_INPUT for musl */
 #ifndef MAX_INPUT
 #define MAX_INPUT _POSIX_MAX_INPUT
@@ -274,6 +277,32 @@ void *util_iov_push_mem(struct iovec *iov, size_t len, const void *data)
 	return p;
 }
 
+void *util_iov_push_le32(struct iovec *iov, uint32_t val)
+{
+	void *p;
+
+	p = util_iov_push(iov, sizeof(uint32_t));
+	if (!p)
+		return NULL;
+
+	put_le32(val, p);
+
+	return p;
+}
+
+void *util_iov_push_le24(struct iovec *iov, uint32_t val)
+{
+	void *p;
+
+	p = util_iov_push(iov, sizeof(uint24_t));
+	if (!p)
+		return NULL;
+
+	put_le24(val, p);
+
+	return p;
+}
+
 void *util_iov_pull(struct iovec *iov, size_t len)
 {
 	if (!iov)
@@ -298,6 +327,30 @@ void *util_iov_pull_mem(struct iovec *iov, size_t len)
 	return NULL;
 }
 
+void *util_iov_pull_le32(struct iovec *iov, uint32_t *val)
+{
+	void *data = iov->iov_base;
+
+	if (util_iov_pull(iov, sizeof(uint32_t))) {
+		*val = get_le32(data);
+		return data;
+	}
+
+	return NULL;
+}
+
+void *util_iov_pull_le24(struct iovec *iov, uint32_t *val)
+{
+	void *data = iov->iov_base;
+
+	if (util_iov_pull(iov, sizeof(uint24_t))) {
+		*val = get_le24(data);
+		return data;
+	}
+
+	return NULL;
+}
+
 static const struct {
 	uint16_t uuid;
 	const char *str;
diff --git a/src/shared/util.h b/src/shared/util.h
index dc84f9635..b99a959b8 100644
--- a/src/shared/util.h
+++ b/src/shared/util.h
@@ -4,6 +4,7 @@
  *  BlueZ - Bluetooth protocol stack for Linux
  *
  *  Copyright (C) 2012-2014  Intel Corporation. All rights reserved.
+ *  Copyright 2023 NXP
  *
  *
  */
@@ -115,8 +116,12 @@ int util_iov_memcmp(const struct iovec *iov1, const struct iovec *iov2);
 void util_iov_memcpy(struct iovec *iov, void *src, size_t len);
 void *util_iov_push(struct iovec *iov, size_t len);
 void *util_iov_push_mem(struct iovec *iov, size_t len, const void *data);
+void *util_iov_push_le32(struct iovec *iov, uint32_t val);
+void *util_iov_push_le24(struct iovec *iov, uint32_t val);
 void *util_iov_pull(struct iovec *iov, size_t len);
 void *util_iov_pull_mem(struct iovec *iov, size_t len);
+void *util_iov_pull_le32(struct iovec *iov, uint32_t *val);
+void *util_iov_pull_le24(struct iovec *iov, uint32_t *val);
 void util_iov_free(struct iovec *iov, size_t cnt);
 
 const char *bt_uuid16_to_str(uint16_t uuid);
-- 
2.34.1