Bluetooth: PNP: add pnp vendor id interface and tool

add pnp vendor id interface for hid feature.

Signed-off-by: Kai Cheng <[email protected]>

Author: chengkai15

include/zephyr/bluetooth/classic/sdp.h

@@ -703,6 +703,19 @@ int bt_sdp_get_profile_version(const struct net_buf *buf, uint16_t profile,
  */
 int bt_sdp_get_features(const struct net_buf *buf, uint16_t *features);
 
+/** @brief Get Vendor ID
+ *
+ *  Helper API extracting remote Vendor ID. To get it proper
+ *  generic profile parameter needs to be selected usually listed in SDP
+ *  Interoperability Requirements section for given profile specification.
+ *
+ *  @param buf Buffer holding original raw record data from remote.
+ *  @param vendor_id On success populated by found Vendor ID.
+ *
+ *  @return 0 on success if vendor_id found and valid, negative in case any error
+ */
+int bt_sdp_get_vendor_id(const struct net_buf *buf, uint16_t *vendor_id);
+
 #ifdef __cplusplus
 }
 #endif

subsys/bluetooth/host/classic/sdp.c

@@ -3096,3 +3096,17 @@ int bt_sdp_get_features(const struct net_buf *buf, uint16_t *features)
 
 	return sdp_get_u16_data(&attr, features);
 }
+
+int bt_sdp_get_vendor_id(const struct net_buf *buf, uint16_t *vendor_id)
+{
+	struct bt_sdp_attr_item attr;
+	int err;
+
+	err = bt_sdp_get_attr(buf, &attr, BT_SDP_ATTR_VENDOR_ID);
+	if (err < 0) {
+		LOG_WRN("Attribute 0x%04x not found, err %d", BT_SDP_ATTR_VENDOR_ID, err);
+		return err;
+	}
+
+	return sdp_get_u16_data(&attr, vendor_id);
+}

subsys/bluetooth/host/classic/shell/bredr.c

@@ -996,6 +996,33 @@ static uint8_t sdp_a2src_user(struct bt_conn *conn, struct bt_sdp_client_result
 	return BT_SDP_DISCOVER_UUID_CONTINUE;
 }
 
+static uint8_t sdp_pnp_user(struct bt_conn *conn, struct bt_sdp_client_result *result,
+			    const struct bt_sdp_discover_params *params)
+{
+	char addr[BT_ADDR_STR_LEN];
+	uint16_t vendor_id;
+	int err;
+
+	conn_addr_str(conn, addr, sizeof(addr));
+
+	if ((result != NULL) && (result->resp_buf != NULL)) {
+		bt_shell_print("SDP PNP data@%p (len %u) hint %u from remote %s", result->resp_buf,
+			       result->resp_buf->len, result->next_record_hint, addr);
+
+		err = bt_sdp_get_vendor_id(result->resp_buf, &vendor_id);
+		if (err < 0) {
+			bt_shell_error("PNP vendor id not found, err %d", err);
+			goto done;
+		}
+
+		bt_shell_print("PNP vendor id param 0x%04x", vendor_id);
+	} else {
+		bt_shell_print("No SDP PNP data from remote %s", addr);
+	}
+done:
+	return BT_SDP_DISCOVER_UUID_CONTINUE;
+}
+
 static struct bt_sdp_discover_params discov_hfpag = {
 	.type = BT_SDP_DISCOVER_SERVICE_SEARCH_ATTR,
 	.uuid = BT_UUID_DECLARE_16(BT_SDP_HANDSFREE_AGW_SVCLASS),
@@ -1017,6 +1044,13 @@ static struct bt_sdp_discover_params discov_a2src = {
 	.pool = &sdp_client_pool,
 };
 
+static struct bt_sdp_discover_params discov_pnp = {
+	.type = BT_SDP_DISCOVER_SERVICE_SEARCH_ATTR,
+	.uuid = BT_UUID_DECLARE_16(BT_SDP_PNP_INFO_SVCLASS),
+	.func = sdp_pnp_user,
+	.pool = &sdp_client_pool,
+};
+
 static struct bt_sdp_discover_params discov;
 
 static int cmd_sdp_find_record(const struct shell *sh, size_t argc, char *argv[])
@@ -1037,6 +1071,8 @@ static int cmd_sdp_find_record(const struct shell *sh, size_t argc, char *argv[]
 		discov = discov_hfphf;
 	} else if (!strcmp(action, "A2SRC")) {
 		discov = discov_a2src;
+	} else if (!strcmp(action, "PNP")) {
+		discov = discov_pnp;
 	} else {
 		shell_help(sh);
 		return SHELL_CMD_HELP_PRINTED;
@@ -1446,7 +1482,7 @@ SHELL_STATIC_SUBCMD_SET_CREATE(br_cmds,
 	SHELL_CMD(l2cap, &l2cap_cmds, HELP_NONE, cmd_default_handler),
 	SHELL_CMD_ARG(oob, NULL, NULL, cmd_oob, 1, 0),
 	SHELL_CMD_ARG(pscan, NULL, "<value: on, off>", cmd_connectable, 2, 0),
-	SHELL_CMD_ARG(sdp-find, NULL, "<HFPAG, HFPHF>", cmd_sdp_find_record, 2, 0),
+	SHELL_CMD_ARG(sdp-find, NULL, "<HFPAG, HFPHF, PNP>", cmd_sdp_find_record, 2, 0),
 	SHELL_CMD_ARG(switch-role, NULL, "<value: central, peripheral>", cmd_switch_role, 2, 0),
 	SHELL_CMD_ARG(set-role-switchable, NULL, "<value: enable, disable>",
 		      cmd_set_role_switchable, 2, 0),