Received: by 2002:a05:6a10:9848:0:0:0:0 with SMTP id x8csp1508795pxf; Fri, 9 Apr 2021 10:05:27 -0700 (PDT) X-Google-Smtp-Source: ABdhPJxfgUH1TqZEKvA4HY21cQSf9CDvWi6id0zY2oUJx6vadw7YZ9sjov7NWW3gkTBwKUDRmCg7 X-Received: by 2002:a17:906:8470:: with SMTP id hx16mr16966512ejc.153.1617987926851; Fri, 09 Apr 2021 10:05:26 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1617987926; cv=none; d=google.com; s=arc-20160816; b=Zmkrf2cbjXAi12DBiCyQgUNoAr60AHgjTBJZMjLrTWxLGP6okJ4XNFPtXdMzk4bvKS 4VMOa+E0/rPfdpfWG7G3HVgckDgrDeQ9eff+8LjK+JuFTPjDQJKnPQGYR5OVFHEzMJxj r/s5md6gn8pV0zFBO/qv1KHTVASHGkErbqauNdrguk4Prg1W4rA/CJCFdA8D/u8pKmZS bw7CRbt6QegcKhSlz1lQPBBeHBkeN92ePV0ni/VmEKhr7ffaZJQlEc8WTvK0OucfKXnE aYrod1ALvhdDvDSgLlllrm3e6ErlkM6+XpgMUSrtipGJVn4b1AE7/rNtKySJ3X3yagBK jL/w== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:cc:to:subject:message-id:date:from:in-reply-to :references:mime-version:dkim-signature; bh=AlcmUeHXPpsvej4Ys+csMJ9Vx7vt7TLl9vqazEWvbgI=; b=dnTmkKPGPjwgbh44x+64ZeJiDPTSEto8zErKdimKcjscPwNEwT+zjWD6GfDOWWXDKn 00bwsbUVqDsXByDFAmIEGfM2RvEd5xnA+/xN8t8mfox1CLkv28XpCkqux8I9SnoCApJr IEbe1s10nM6mNZjiDluDBDSouO87ZcTtqSfABAmvUyWMyu2cQPXRtcrDWV9kYbo1wJTY yuHqJpuvh4QQmSct0iDKSr9wzi/GSgD2NLmqYwYc3zI36xRKyXsVWy3/QaZ10VPxjJi8 Salie8/ONlK61uNht0Z5tBAkzkIaAnft8jIOTuodV8uuaJtikwY3G0aBLUFMBgXyw7f2 aDAw== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@gmail.com header.s=20161025 header.b=dP6LAYrT; spf=pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=linux-bluetooth-owner@vger.kernel.org; dmarc=pass (p=NONE sp=QUARANTINE dis=NONE) header.from=gmail.com Return-Path: Received: from vger.kernel.org (vger.kernel.org. [23.128.96.18]) by mx.google.com with ESMTP id m20si2162740ejc.530.2021.04.09.10.04.55; Fri, 09 Apr 2021 10:05:26 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) client-ip=23.128.96.18; Authentication-Results: mx.google.com; dkim=pass header.i=@gmail.com header.s=20161025 header.b=dP6LAYrT; spf=pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=linux-bluetooth-owner@vger.kernel.org; dmarc=pass (p=NONE sp=QUARANTINE dis=NONE) header.from=gmail.com Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S234067AbhDIRC3 (ORCPT + 99 others); Fri, 9 Apr 2021 13:02:29 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:33842 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S233332AbhDIRC2 (ORCPT ); Fri, 9 Apr 2021 13:02:28 -0400 Received: from mail-ot1-x334.google.com (mail-ot1-x334.google.com [IPv6:2607:f8b0:4864:20::334]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id F39E6C061760 for ; Fri, 9 Apr 2021 10:02:11 -0700 (PDT) Received: by mail-ot1-x334.google.com with SMTP id w21-20020a9d63950000b02901ce7b8c45b4so6332158otk.5 for ; Fri, 09 Apr 2021 10:02:11 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=mime-version:references:in-reply-to:from:date:message-id:subject:to :cc; bh=AlcmUeHXPpsvej4Ys+csMJ9Vx7vt7TLl9vqazEWvbgI=; b=dP6LAYrTKsr5VMtAJSbuZCwr7G8prXL/PO8nV4Q6JX0HzWzGoih74jlxyLOxCgaQyW 3q1sgd4PfaSvQeTyRrtt9thWA1v4FK98HdpuA0DW5OoV+qFk6E/VL4jXeMrBcrd8QI2k lK8RR2Ds0jCU24SBDZujDnVY3gPBL6cXrmsmGyBkLYRkAtlptQNyXGrW4t3HtMv5oz8u U5C1mWTYsTp5uDYQprGZ/cbMXqpbWhP2vgNBQuhIjT1MTOzXhhhRfgIi6P3Gc2aPmSpQ QwtnEDtiOv/jfZnMTO15UrtAvGhC902XTWteoX9MpRPJ3QOdVOlqlXDjL2dawN+MnYBu z40Q== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:mime-version:references:in-reply-to:from:date :message-id:subject:to:cc; bh=AlcmUeHXPpsvej4Ys+csMJ9Vx7vt7TLl9vqazEWvbgI=; b=LZKA6Q3ilOml7t40epKpTPqxh5jRtez6ZtIE9YaHkKTAt8GRGhR4+Q8NrumttZpyT9 CuCUt+ObpAYRbduUawmc4TBAjipLX/+SQy9xrVhOvUPnVLr1GY66JE14fo9+nnb2bZR4 U60LjdDT7TT2XdYFkpHxo6sl7nHrTiQm48hISoMnGLL/QH1Cd0fUJnnjVVED8SzYkrdC BfP0JcjlkNliN5h6qDa4h5FPMzyjjtEYoHLvNV/lV6XEXWSoHBZlhaDJdtllzBTdo50V AXnPwesogGADfjmh/7r9YWijViGjSWRux2GOfjp0jsc0gjD8xA1DZy7g0XMNYO2JEMG8 Xsiw== X-Gm-Message-State: AOAM531vxkSaYuX9o4mEoBm3tSFABJ35HDgrst0qQbSSDofgMbjpPQBl EAmplg+ci2coXnlXhLr70uTNF5xZ8FA6dyeBYeQ= X-Received: by 2002:a9d:7cd2:: with SMTP id r18mr13470730otn.240.1617987731252; Fri, 09 Apr 2021 10:02:11 -0700 (PDT) MIME-Version: 1.0 References: <20210409122405.29850-1-kiran.k@intel.com> <20210409122405.29850-2-kiran.k@intel.com> In-Reply-To: <20210409122405.29850-2-kiran.k@intel.com> From: Luiz Augusto von Dentz Date: Fri, 9 Apr 2021 10:02:00 -0700 Message-ID: Subject: Re: [PATCH v1 1/3] Bluetooth: add support to enumerate codec capabilities To: Kiran K Cc: "linux-bluetooth@vger.kernel.org" , "Srivatsa, Ravishankar" , Chethan T N , Luiz Augusto Von Dentz Content-Type: text/plain; charset="UTF-8" Precedence: bulk List-ID: X-Mailing-List: linux-bluetooth@vger.kernel.org Hi Kiran, On Fri, Apr 9, 2021 at 5:21 AM Kiran K wrote: > > add support to enumerate local supported codec capabilities > > < HCI Command: Read Local Suppor.. (0x04|0x000e) plen 7 > Codec: mSBC (0x05) > Logical Transport Type: 0x00 > Direction: Input (Host to Controller) (0x00) > > HCI Event: Command Complete (0x0e) plen 12 > Read Local Supported Codec Capabilities (0x04|0x000e) ncmd 1 > Status: Success (0x00) > Number of codec capabilities: 1 > Capabilities #0: > 00 00 11 15 02 33 > > Signed-off-by: Kiran K > Signed-off-by: Chethan T N > Signed-off-by: Srivatsa Ravishankar > --- > include/net/bluetooth/hci.h | 7 +++++ > net/bluetooth/hci_event.c | 56 +++++++++++++++++++++++++++++++++++++ > 2 files changed, 63 insertions(+) > > diff --git a/include/net/bluetooth/hci.h b/include/net/bluetooth/hci.h > index ea4ae551c426..e3f7771fe84f 100644 > --- a/include/net/bluetooth/hci.h > +++ b/include/net/bluetooth/hci.h > @@ -1314,6 +1314,13 @@ struct hci_rp_read_local_pairing_opts { > __u8 max_key_size; > } __packed; > > +#define HCI_OP_READ_LOCAL_CODEC_CAPS 0x100e > +struct hci_op_read_local_codec_caps { > + __u8 codec_id[5]; > + __u8 transport; > + __u8 direction; > +} __packed; > + > #define HCI_OP_READ_PAGE_SCAN_ACTIVITY 0x0c1b > struct hci_rp_read_page_scan_activity { > __u8 status; > diff --git a/net/bluetooth/hci_event.c b/net/bluetooth/hci_event.c > index 016b2999f219..ceed5a5d332b 100644 > --- a/net/bluetooth/hci_event.c > +++ b/net/bluetooth/hci_event.c > @@ -887,6 +887,58 @@ static void hci_cc_read_data_block_size(struct hci_dev *hdev, > hdev->block_cnt, hdev->block_len); > } > > +static void hci_cc_read_local_codecs(struct hci_dev *hdev, > + struct sk_buff *skb) > +{ > + __u8 num_codecs; > + __u8 *ptr; > + struct hci_op_read_local_codec_caps caps; > + > + bt_dev_dbg(hdev, "status 0x%2.2x", skb->data[0]); > + > + if (skb->data[0]) > + return; > + > + /* enumerate standard codecs */ > + skb_pull(skb, 1); After each skb_pull check the expected length against skb->len. > + num_codecs = skb->data[0]; > + > + bt_dev_dbg(hdev, "Number of standard codecs: %u", num_codecs); > + > + skb_pull(skb, 1); Ditto. > + ptr = (__u8 *)skb->data; > + > + skb_pull(skb, num_codecs); > + > + while (num_codecs--) { > + caps.codec_id[0] = *ptr++; Lets just use skb_pull to advance on the codecs ids, that way we can properly check the remaining length with use of skb->len. > + caps.transport = 0x00; > + caps.direction = 0x00; > + > + hci_send_cmd(hdev, HCI_OP_READ_LOCAL_CODEC_CAPS, sizeof(caps), > + &caps); > + } > + > + /* enumerate vendor specific codecs */ > + num_codecs = skb->data[0]; > + skb_pull(skb, 1); > + > + bt_dev_dbg(hdev, "Number of vendor specific codecs: %u", num_codecs); > + > + ptr = (__u8 *)skb->data; > + > + while (num_codecs--) { > + caps.codec_id[0] = 0xFF; > + memcpy(&caps.codec_id[1], ptr, 4); > + ptr += 4; > + caps.transport = 0x00; > + caps.direction = 0x00; > + > + hci_send_cmd(hdev, HCI_OP_READ_LOCAL_CODEC_CAPS, sizeof(caps), > + &caps); > + } > +} > + > static void hci_cc_read_clock(struct hci_dev *hdev, struct sk_buff *skb) > { > struct hci_rp_read_clock *rp = (void *) skb->data; > @@ -3437,6 +3489,10 @@ static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb, > hci_cc_read_data_block_size(hdev, skb); > break; > > + case HCI_OP_READ_LOCAL_CODECS: > + hci_cc_read_local_codecs(hdev, skb); > + break; > + > case HCI_OP_READ_FLOW_CONTROL_MODE: > hci_cc_read_flow_control_mode(hdev, skb); > break; > -- > 2.17.1 > -- Luiz Augusto von Dentz