Bluetooth: btintel: Read supported offload use cases

Read offload use cases supported by controller.

Signed-off-by: Kiran K <kiran.k@intel.com>
Reviewed-by: Chethan T N <chethan.tumkur.narayan@intel.com>
Reviewed-by: Srivatsa Ravishankar <ravishankar.srivatsa@intel.com>
Signed-off-by: Luiz Augusto von Dentz <luiz.von.dentz@intel.com>

diff --git a/drivers/bluetooth/btintel.c b/drivers/bluetooth/btintel.c
index 7236f40b7a9c1b97670ad6648117fd0f15d3b5e4..60f9866c6792eda5f141b8ef57aaa40043e579fb 100644 (file)
--- a/drivers/bluetooth/btintel.c
+++ b/drivers/bluetooth/btintel.c
@@ -2158,6 +2158,35 @@ done:
        return err;
 }
 
+static int btintel_configure_offload(struct hci_dev *hdev)
+{
+       struct sk_buff *skb;
+       int err = 0;
+       struct intel_offload_use_cases *use_cases;
+
+       skb = __hci_cmd_sync(hdev, 0xfc86, 0, NULL, HCI_INIT_TIMEOUT);
+       if (IS_ERR(skb)) {
+               bt_dev_err(hdev, "Reading offload use cases failed (%ld)",
+                          PTR_ERR(skb));
+               return PTR_ERR(skb);
+       }
+
+       if (skb->len < sizeof(*use_cases)) {
+               err = -EIO;
+               goto error;
+       }
+
+       use_cases = (void *)skb->data;
+
+       if (use_cases->status) {
+               err = -bt_to_errno(skb->data[0]);
+               goto error;
+       }
+error:
+       kfree_skb(skb);
+       return err;
+}
+
 static int btintel_bootloader_setup_tlv(struct hci_dev *hdev,
                                        struct intel_version_tlv *ver)
 {
@@ -2199,6 +2228,9 @@ static int btintel_bootloader_setup_tlv(struct hci_dev *hdev,
         */
        btintel_load_ddc_config(hdev, ddcname);
 
+       /* Read supported use cases and set callbacks to fetch datapath id */
+       btintel_configure_offload(hdev);
+
        hci_dev_clear_flag(hdev, HCI_QUALITY_REPORT);
 
        /* Read the Intel version information after loading the FW  */

diff --git a/drivers/bluetooth/btintel.h b/drivers/bluetooth/btintel.h
index fe02cb9ac96c0d542a3f25027a8945b1e022038e..e500c0d7a7298484b04314cec6103714f2b94c1d 100644 (file)
--- a/drivers/bluetooth/btintel.h
+++ b/drivers/bluetooth/btintel.h
@@ -132,6 +132,11 @@ struct intel_debug_features {
        __u8    page1[16];
 } __packed;
 
+struct intel_offload_use_cases {
+       __u8    status;
+       __u8    preset[8];
+} __packed;
+
 #define INTEL_HW_PLATFORM(cnvx_bt)     ((u8)(((cnvx_bt) & 0x0000ff00) >> 8))
 #define INTEL_HW_VARIANT(cnvx_bt)      ((u8)(((cnvx_bt) & 0x003f0000) >> 16))
 #define INTEL_CNVX_TOP_TYPE(cnvx_top)  ((cnvx_top) & 0x00000fff)