|  | // SPDX-License-Identifier: GPL-2.0-only | 
|  | /* | 
|  | *  Bluetooth supports for Qualcomm Atheros chips | 
|  | * | 
|  | *  Copyright (c) 2015 The Linux Foundation. All rights reserved. | 
|  | */ | 
|  | #include <linux/module.h> | 
|  | #include <linux/firmware.h> | 
|  | #include <linux/vmalloc.h> | 
|  |  | 
|  | #include <net/bluetooth/bluetooth.h> | 
|  | #include <net/bluetooth/hci_core.h> | 
|  |  | 
|  | #include "btqca.h" | 
|  |  | 
|  | int qca_read_soc_version(struct hci_dev *hdev, struct qca_btsoc_version *ver, | 
|  | enum qca_btsoc_type soc_type) | 
|  | { | 
|  | struct sk_buff *skb; | 
|  | struct edl_event_hdr *edl; | 
|  | char cmd; | 
|  | int err = 0; | 
|  | u8 event_type = HCI_EV_VENDOR; | 
|  | u8 rlen = sizeof(*edl) + sizeof(*ver); | 
|  | u8 rtype = EDL_APP_VER_RES_EVT; | 
|  |  | 
|  | bt_dev_dbg(hdev, "QCA Version Request"); | 
|  |  | 
|  | /* Unlike other SoC's sending version command response as payload to | 
|  | * VSE event. WCN3991 sends version command response as a payload to | 
|  | * command complete event. | 
|  | */ | 
|  | if (soc_type >= QCA_WCN3991) { | 
|  | event_type = 0; | 
|  | rlen += 1; | 
|  | rtype = EDL_PATCH_VER_REQ_CMD; | 
|  | } | 
|  |  | 
|  | cmd = EDL_PATCH_VER_REQ_CMD; | 
|  | skb = __hci_cmd_sync_ev(hdev, EDL_PATCH_CMD_OPCODE, EDL_PATCH_CMD_LEN, | 
|  | &cmd, event_type, HCI_INIT_TIMEOUT); | 
|  | if (IS_ERR(skb)) { | 
|  | err = PTR_ERR(skb); | 
|  | bt_dev_err(hdev, "Reading QCA version information failed (%d)", | 
|  | err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | if (skb->len != rlen) { | 
|  | bt_dev_err(hdev, "QCA Version size mismatch len %d", skb->len); | 
|  | err = -EILSEQ; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | edl = (struct edl_event_hdr *)(skb->data); | 
|  |  | 
|  | if (edl->cresp != EDL_CMD_REQ_RES_EVT || | 
|  | edl->rtype != rtype) { | 
|  | bt_dev_err(hdev, "QCA Wrong packet received %d %d", edl->cresp, | 
|  | edl->rtype); | 
|  | err = -EIO; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | if (soc_type >= QCA_WCN3991) | 
|  | memcpy(ver, edl->data + 1, sizeof(*ver)); | 
|  | else | 
|  | memcpy(ver, &edl->data, sizeof(*ver)); | 
|  |  | 
|  | bt_dev_info(hdev, "QCA Product ID   :0x%08x", | 
|  | le32_to_cpu(ver->product_id)); | 
|  | bt_dev_info(hdev, "QCA SOC Version  :0x%08x", | 
|  | le32_to_cpu(ver->soc_id)); | 
|  | bt_dev_info(hdev, "QCA ROM Version  :0x%08x", | 
|  | le16_to_cpu(ver->rom_ver)); | 
|  | bt_dev_info(hdev, "QCA Patch Version:0x%08x", | 
|  | le16_to_cpu(ver->patch_ver)); | 
|  |  | 
|  | if (ver->soc_id == 0 || ver->rom_ver == 0) | 
|  | err = -EILSEQ; | 
|  |  | 
|  | out: | 
|  | kfree_skb(skb); | 
|  | if (err) | 
|  | bt_dev_err(hdev, "QCA Failed to get version (%d)", err); | 
|  |  | 
|  | return err; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(qca_read_soc_version); | 
|  |  | 
|  | static int qca_read_fw_build_info(struct hci_dev *hdev) | 
|  | { | 
|  | struct sk_buff *skb; | 
|  | struct edl_event_hdr *edl; | 
|  | char *build_label; | 
|  | char cmd; | 
|  | int build_lbl_len, err = 0; | 
|  |  | 
|  | bt_dev_dbg(hdev, "QCA read fw build info"); | 
|  |  | 
|  | cmd = EDL_GET_BUILD_INFO_CMD; | 
|  | skb = __hci_cmd_sync_ev(hdev, EDL_PATCH_CMD_OPCODE, EDL_PATCH_CMD_LEN, | 
|  | &cmd, 0, HCI_INIT_TIMEOUT); | 
|  | if (IS_ERR(skb)) { | 
|  | err = PTR_ERR(skb); | 
|  | bt_dev_err(hdev, "Reading QCA fw build info failed (%d)", | 
|  | err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | if (skb->len < sizeof(*edl)) { | 
|  | err = -EILSEQ; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | edl = (struct edl_event_hdr *)(skb->data); | 
|  |  | 
|  | if (edl->cresp != EDL_CMD_REQ_RES_EVT || | 
|  | edl->rtype != EDL_GET_BUILD_INFO_CMD) { | 
|  | bt_dev_err(hdev, "QCA Wrong packet received %d %d", edl->cresp, | 
|  | edl->rtype); | 
|  | err = -EIO; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | if (skb->len < sizeof(*edl) + 1) { | 
|  | err = -EILSEQ; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | build_lbl_len = edl->data[0]; | 
|  |  | 
|  | if (skb->len < sizeof(*edl) + 1 + build_lbl_len) { | 
|  | err = -EILSEQ; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | build_label = kstrndup(&edl->data[1], build_lbl_len, GFP_KERNEL); | 
|  | if (!build_label) { | 
|  | err = -ENOMEM; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | hci_set_fw_info(hdev, "%s", build_label); | 
|  |  | 
|  | kfree(build_label); | 
|  | out: | 
|  | kfree_skb(skb); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | static int qca_send_patch_config_cmd(struct hci_dev *hdev) | 
|  | { | 
|  | const u8 cmd[] = { EDL_PATCH_CONFIG_CMD, 0x01, 0, 0, 0 }; | 
|  | struct sk_buff *skb; | 
|  | struct edl_event_hdr *edl; | 
|  | int err; | 
|  |  | 
|  | bt_dev_dbg(hdev, "QCA Patch config"); | 
|  |  | 
|  | skb = __hci_cmd_sync_ev(hdev, EDL_PATCH_CMD_OPCODE, sizeof(cmd), | 
|  | cmd, 0, HCI_INIT_TIMEOUT); | 
|  | if (IS_ERR(skb)) { | 
|  | err = PTR_ERR(skb); | 
|  | bt_dev_err(hdev, "Sending QCA Patch config failed (%d)", err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | if (skb->len != 2) { | 
|  | bt_dev_err(hdev, "QCA Patch config cmd size mismatch len %d", skb->len); | 
|  | err = -EILSEQ; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | edl = (struct edl_event_hdr *)(skb->data); | 
|  |  | 
|  | if (edl->cresp != EDL_PATCH_CONFIG_RES_EVT || edl->rtype != EDL_PATCH_CONFIG_CMD) { | 
|  | bt_dev_err(hdev, "QCA Wrong packet received %d %d", edl->cresp, | 
|  | edl->rtype); | 
|  | err = -EIO; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | err = 0; | 
|  |  | 
|  | out: | 
|  | kfree_skb(skb); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | static int qca_send_reset(struct hci_dev *hdev) | 
|  | { | 
|  | struct sk_buff *skb; | 
|  | int err; | 
|  |  | 
|  | bt_dev_dbg(hdev, "QCA HCI_RESET"); | 
|  |  | 
|  | skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT); | 
|  | if (IS_ERR(skb)) { | 
|  | err = PTR_ERR(skb); | 
|  | bt_dev_err(hdev, "QCA Reset failed (%d)", err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | kfree_skb(skb); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int qca_read_fw_board_id(struct hci_dev *hdev, u16 *bid) | 
|  | { | 
|  | u8 cmd; | 
|  | struct sk_buff *skb; | 
|  | struct edl_event_hdr *edl; | 
|  | int err = 0; | 
|  |  | 
|  | cmd = EDL_GET_BID_REQ_CMD; | 
|  | skb = __hci_cmd_sync_ev(hdev, EDL_PATCH_CMD_OPCODE, EDL_PATCH_CMD_LEN, | 
|  | &cmd, 0, HCI_INIT_TIMEOUT); | 
|  | if (IS_ERR(skb)) { | 
|  | err = PTR_ERR(skb); | 
|  | bt_dev_err(hdev, "Reading QCA board ID failed (%d)", err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | edl = skb_pull_data(skb, sizeof(*edl)); | 
|  | if (!edl) { | 
|  | bt_dev_err(hdev, "QCA read board ID with no header"); | 
|  | err = -EILSEQ; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | if (edl->cresp != EDL_CMD_REQ_RES_EVT || | 
|  | edl->rtype != EDL_GET_BID_REQ_CMD) { | 
|  | bt_dev_err(hdev, "QCA Wrong packet: %d %d", edl->cresp, edl->rtype); | 
|  | err = -EIO; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | if (skb->len < 3) { | 
|  | err = -EILSEQ; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | *bid = (edl->data[1] << 8) + edl->data[2]; | 
|  | bt_dev_dbg(hdev, "%s: bid = %x", __func__, *bid); | 
|  |  | 
|  | out: | 
|  | kfree_skb(skb); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | int qca_send_pre_shutdown_cmd(struct hci_dev *hdev) | 
|  | { | 
|  | struct sk_buff *skb; | 
|  | int err; | 
|  |  | 
|  | bt_dev_dbg(hdev, "QCA pre shutdown cmd"); | 
|  |  | 
|  | skb = __hci_cmd_sync_ev(hdev, QCA_PRE_SHUTDOWN_CMD, 0, | 
|  | NULL, HCI_EV_CMD_COMPLETE, HCI_INIT_TIMEOUT); | 
|  |  | 
|  | if (IS_ERR(skb)) { | 
|  | err = PTR_ERR(skb); | 
|  | bt_dev_err(hdev, "QCA preshutdown_cmd failed (%d)", err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | kfree_skb(skb); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(qca_send_pre_shutdown_cmd); | 
|  |  | 
|  | static bool qca_filename_has_extension(const char *filename) | 
|  | { | 
|  | const char *suffix = strrchr(filename, '.'); | 
|  |  | 
|  | /* File extensions require a dot, but not as the first or last character */ | 
|  | if (!suffix || suffix == filename || *(suffix + 1) == '\0') | 
|  | return 0; | 
|  |  | 
|  | /* Avoid matching directories with names that look like files with extensions */ | 
|  | return !strchr(suffix, '/'); | 
|  | } | 
|  |  | 
|  | static bool qca_get_alt_nvm_file(char *filename, size_t max_size) | 
|  | { | 
|  | char fwname[64]; | 
|  | const char *suffix; | 
|  |  | 
|  | /* nvm file name has an extension, replace with .bin */ | 
|  | if (qca_filename_has_extension(filename)) { | 
|  | suffix = strrchr(filename, '.'); | 
|  | strscpy(fwname, filename, suffix - filename + 1); | 
|  | snprintf(fwname + (suffix - filename), | 
|  | sizeof(fwname) - (suffix - filename), ".bin"); | 
|  | /* If nvm file is already the default one, return false to skip the retry. */ | 
|  | if (strcmp(fwname, filename) == 0) | 
|  | return false; | 
|  |  | 
|  | snprintf(filename, max_size, "%s", fwname); | 
|  | return true; | 
|  | } | 
|  | return false; | 
|  | } | 
|  |  | 
|  | static int qca_tlv_check_data(struct hci_dev *hdev, | 
|  | struct qca_fw_config *config, | 
|  | u8 *fw_data, size_t fw_size, | 
|  | enum qca_btsoc_type soc_type) | 
|  | { | 
|  | const u8 *data; | 
|  | u32 type_len; | 
|  | u16 tag_id, tag_len; | 
|  | int idx, length; | 
|  | struct tlv_type_hdr *tlv; | 
|  | struct tlv_type_patch *tlv_patch; | 
|  | struct tlv_type_nvm *tlv_nvm; | 
|  | uint8_t nvm_baud_rate = config->user_baud_rate; | 
|  | u8 type; | 
|  |  | 
|  | config->dnld_mode = QCA_SKIP_EVT_NONE; | 
|  | config->dnld_type = QCA_SKIP_EVT_NONE; | 
|  |  | 
|  | switch (config->type) { | 
|  | case ELF_TYPE_PATCH: | 
|  | if (fw_size < 7) | 
|  | return -EINVAL; | 
|  |  | 
|  | config->dnld_mode = QCA_SKIP_EVT_VSE_CC; | 
|  | config->dnld_type = QCA_SKIP_EVT_VSE_CC; | 
|  |  | 
|  | bt_dev_dbg(hdev, "File Class        : 0x%x", fw_data[4]); | 
|  | bt_dev_dbg(hdev, "Data Encoding     : 0x%x", fw_data[5]); | 
|  | bt_dev_dbg(hdev, "File version      : 0x%x", fw_data[6]); | 
|  | break; | 
|  | case TLV_TYPE_PATCH: | 
|  | if (fw_size < sizeof(struct tlv_type_hdr) + sizeof(struct tlv_type_patch)) | 
|  | return -EINVAL; | 
|  |  | 
|  | tlv = (struct tlv_type_hdr *)fw_data; | 
|  | type_len = le32_to_cpu(tlv->type_len); | 
|  | tlv_patch = (struct tlv_type_patch *)tlv->data; | 
|  |  | 
|  | /* For Rome version 1.1 to 3.1, all segment commands | 
|  | * are acked by a vendor specific event (VSE). | 
|  | * For Rome >= 3.2, the download mode field indicates | 
|  | * if VSE is skipped by the controller. | 
|  | * In case VSE is skipped, only the last segment is acked. | 
|  | */ | 
|  | config->dnld_mode = tlv_patch->download_mode; | 
|  | config->dnld_type = config->dnld_mode; | 
|  |  | 
|  | BT_DBG("TLV Type\t\t : 0x%x", type_len & 0x000000ff); | 
|  | BT_DBG("Total Length           : %d bytes", | 
|  | le32_to_cpu(tlv_patch->total_size)); | 
|  | BT_DBG("Patch Data Length      : %d bytes", | 
|  | le32_to_cpu(tlv_patch->data_length)); | 
|  | BT_DBG("Signing Format Version : 0x%x", | 
|  | tlv_patch->format_version); | 
|  | BT_DBG("Signature Algorithm    : 0x%x", | 
|  | tlv_patch->signature); | 
|  | BT_DBG("Download mode          : 0x%x", | 
|  | tlv_patch->download_mode); | 
|  | BT_DBG("Reserved               : 0x%x", | 
|  | tlv_patch->reserved1); | 
|  | BT_DBG("Product ID             : 0x%04x", | 
|  | le16_to_cpu(tlv_patch->product_id)); | 
|  | BT_DBG("Rom Build Version      : 0x%04x", | 
|  | le16_to_cpu(tlv_patch->rom_build)); | 
|  | BT_DBG("Patch Version          : 0x%04x", | 
|  | le16_to_cpu(tlv_patch->patch_version)); | 
|  | BT_DBG("Reserved               : 0x%x", | 
|  | le16_to_cpu(tlv_patch->reserved2)); | 
|  | BT_DBG("Patch Entry Address    : 0x%x", | 
|  | le32_to_cpu(tlv_patch->entry)); | 
|  | break; | 
|  |  | 
|  | case TLV_TYPE_NVM: | 
|  | if (fw_size < sizeof(struct tlv_type_hdr)) | 
|  | return -EINVAL; | 
|  |  | 
|  | tlv = (struct tlv_type_hdr *)fw_data; | 
|  |  | 
|  | type_len = le32_to_cpu(tlv->type_len); | 
|  | length = type_len >> 8; | 
|  | type = type_len & 0xff; | 
|  |  | 
|  | /* Some NVM files have more than one set of tags, only parse | 
|  | * the first set when it has type 2 for now. When there is | 
|  | * more than one set there is an enclosing header of type 4. | 
|  | */ | 
|  | if (type == 4) { | 
|  | if (fw_size < 2 * sizeof(struct tlv_type_hdr)) | 
|  | return -EINVAL; | 
|  |  | 
|  | tlv++; | 
|  |  | 
|  | type_len = le32_to_cpu(tlv->type_len); | 
|  | length = type_len >> 8; | 
|  | type = type_len & 0xff; | 
|  | } | 
|  |  | 
|  | BT_DBG("TLV Type\t\t : 0x%x", type); | 
|  | BT_DBG("Length\t\t : %d bytes", length); | 
|  |  | 
|  | if (type != 2) | 
|  | break; | 
|  |  | 
|  | if (fw_size < length + (tlv->data - fw_data)) | 
|  | return -EINVAL; | 
|  |  | 
|  | idx = 0; | 
|  | data = tlv->data; | 
|  | while (idx < length - sizeof(struct tlv_type_nvm)) { | 
|  | tlv_nvm = (struct tlv_type_nvm *)(data + idx); | 
|  |  | 
|  | tag_id = le16_to_cpu(tlv_nvm->tag_id); | 
|  | tag_len = le16_to_cpu(tlv_nvm->tag_len); | 
|  |  | 
|  | if (length < idx + sizeof(struct tlv_type_nvm) + tag_len) | 
|  | return -EINVAL; | 
|  |  | 
|  | /* Update NVM tags as needed */ | 
|  | switch (tag_id) { | 
|  | case EDL_TAG_ID_BD_ADDR: | 
|  | if (tag_len != sizeof(bdaddr_t)) | 
|  | return -EINVAL; | 
|  |  | 
|  | memcpy(&config->bdaddr, tlv_nvm->data, sizeof(bdaddr_t)); | 
|  |  | 
|  | break; | 
|  |  | 
|  | case EDL_TAG_ID_HCI: | 
|  | if (tag_len < 3) | 
|  | return -EINVAL; | 
|  |  | 
|  | /* HCI transport layer parameters | 
|  | * enabling software inband sleep | 
|  | * onto controller side. | 
|  | */ | 
|  | tlv_nvm->data[0] |= 0x80; | 
|  |  | 
|  | /* UART Baud Rate */ | 
|  | if (soc_type >= QCA_WCN3991) | 
|  | tlv_nvm->data[1] = nvm_baud_rate; | 
|  | else | 
|  | tlv_nvm->data[2] = nvm_baud_rate; | 
|  |  | 
|  | break; | 
|  |  | 
|  | case EDL_TAG_ID_DEEP_SLEEP: | 
|  | if (tag_len < 1) | 
|  | return -EINVAL; | 
|  |  | 
|  | /* Sleep enable mask | 
|  | * enabling deep sleep feature on controller. | 
|  | */ | 
|  | tlv_nvm->data[0] |= 0x01; | 
|  |  | 
|  | break; | 
|  | } | 
|  |  | 
|  | idx += sizeof(struct tlv_type_nvm) + tag_len; | 
|  | } | 
|  | break; | 
|  |  | 
|  | default: | 
|  | BT_ERR("Unknown TLV type %d", config->type); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int qca_tlv_send_segment(struct hci_dev *hdev, int seg_size, | 
|  | const u8 *data, enum qca_tlv_dnld_mode mode, | 
|  | enum qca_btsoc_type soc_type) | 
|  | { | 
|  | struct sk_buff *skb; | 
|  | struct edl_event_hdr *edl; | 
|  | struct tlv_seg_resp *tlv_resp; | 
|  | u8 cmd[MAX_SIZE_PER_TLV_SEGMENT + 2]; | 
|  | int err = 0; | 
|  | u8 event_type = HCI_EV_VENDOR; | 
|  | u8 rlen = (sizeof(*edl) + sizeof(*tlv_resp)); | 
|  | u8 rtype = EDL_TVL_DNLD_RES_EVT; | 
|  |  | 
|  | cmd[0] = EDL_PATCH_TLV_REQ_CMD; | 
|  | cmd[1] = seg_size; | 
|  | memcpy(cmd + 2, data, seg_size); | 
|  |  | 
|  | if (mode == QCA_SKIP_EVT_VSE_CC || mode == QCA_SKIP_EVT_VSE) | 
|  | return __hci_cmd_send(hdev, EDL_PATCH_CMD_OPCODE, seg_size + 2, | 
|  | cmd); | 
|  |  | 
|  | /* Unlike other SoC's sending version command response as payload to | 
|  | * VSE event. WCN3991 sends version command response as a payload to | 
|  | * command complete event. | 
|  | */ | 
|  | if (soc_type >= QCA_WCN3991) { | 
|  | event_type = 0; | 
|  | rlen = sizeof(*edl); | 
|  | rtype = EDL_PATCH_TLV_REQ_CMD; | 
|  | } | 
|  |  | 
|  | skb = __hci_cmd_sync_ev(hdev, EDL_PATCH_CMD_OPCODE, seg_size + 2, cmd, | 
|  | event_type, HCI_INIT_TIMEOUT); | 
|  | if (IS_ERR(skb)) { | 
|  | err = PTR_ERR(skb); | 
|  | bt_dev_err(hdev, "QCA Failed to send TLV segment (%d)", err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | if (skb->len != rlen) { | 
|  | bt_dev_err(hdev, "QCA TLV response size mismatch"); | 
|  | err = -EILSEQ; | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | edl = (struct edl_event_hdr *)(skb->data); | 
|  |  | 
|  | if (edl->cresp != EDL_CMD_REQ_RES_EVT || edl->rtype != rtype) { | 
|  | bt_dev_err(hdev, "QCA TLV with error stat 0x%x rtype 0x%x", | 
|  | edl->cresp, edl->rtype); | 
|  | err = -EIO; | 
|  | } | 
|  |  | 
|  | if (soc_type >= QCA_WCN3991) | 
|  | goto out; | 
|  |  | 
|  | tlv_resp = (struct tlv_seg_resp *)(edl->data); | 
|  | if (tlv_resp->result) { | 
|  | bt_dev_err(hdev, "QCA TLV with error stat 0x%x rtype 0x%x (0x%x)", | 
|  | edl->cresp, edl->rtype, tlv_resp->result); | 
|  | } | 
|  |  | 
|  | out: | 
|  | kfree_skb(skb); | 
|  |  | 
|  | return err; | 
|  | } | 
|  |  | 
|  | static int qca_inject_cmd_complete_event(struct hci_dev *hdev) | 
|  | { | 
|  | struct hci_event_hdr *hdr; | 
|  | struct hci_ev_cmd_complete *evt; | 
|  | struct sk_buff *skb; | 
|  |  | 
|  | skb = bt_skb_alloc(sizeof(*hdr) + sizeof(*evt) + 1, GFP_KERNEL); | 
|  | if (!skb) | 
|  | return -ENOMEM; | 
|  |  | 
|  | hdr = skb_put(skb, sizeof(*hdr)); | 
|  | hdr->evt = HCI_EV_CMD_COMPLETE; | 
|  | hdr->plen = sizeof(*evt) + 1; | 
|  |  | 
|  | evt = skb_put(skb, sizeof(*evt)); | 
|  | evt->ncmd = 1; | 
|  | evt->opcode = cpu_to_le16(QCA_HCI_CC_OPCODE); | 
|  |  | 
|  | skb_put_u8(skb, QCA_HCI_CC_SUCCESS); | 
|  |  | 
|  | hci_skb_pkt_type(skb) = HCI_EVENT_PKT; | 
|  |  | 
|  | return hci_recv_frame(hdev, skb); | 
|  | } | 
|  |  | 
|  | static int qca_download_firmware(struct hci_dev *hdev, | 
|  | struct qca_fw_config *config, | 
|  | enum qca_btsoc_type soc_type, | 
|  | u8 rom_ver) | 
|  | { | 
|  | const struct firmware *fw; | 
|  | u8 *data; | 
|  | const u8 *segment; | 
|  | int ret, size, remain, i = 0; | 
|  |  | 
|  | bt_dev_info(hdev, "QCA Downloading %s", config->fwname); | 
|  |  | 
|  | ret = request_firmware(&fw, config->fwname, &hdev->dev); | 
|  | if (ret) { | 
|  | /* For WCN6750, if mbn file is not present then check for | 
|  | * tlv file. | 
|  | */ | 
|  | if (soc_type == QCA_WCN6750 && config->type == ELF_TYPE_PATCH) { | 
|  | bt_dev_dbg(hdev, "QCA Failed to request file: %s (%d)", | 
|  | config->fwname, ret); | 
|  | config->type = TLV_TYPE_PATCH; | 
|  | snprintf(config->fwname, sizeof(config->fwname), | 
|  | "qca/msbtfw%02x.tlv", rom_ver); | 
|  | bt_dev_info(hdev, "QCA Downloading %s", config->fwname); | 
|  | ret = request_firmware(&fw, config->fwname, &hdev->dev); | 
|  | if (ret) { | 
|  | bt_dev_err(hdev, "QCA Failed to request file: %s (%d)", | 
|  | config->fwname, ret); | 
|  | return ret; | 
|  | } | 
|  | } | 
|  | /* If the board-specific file is missing, try loading the default | 
|  | * one, unless that was attempted already. | 
|  | */ | 
|  | else if (config->type == TLV_TYPE_NVM && | 
|  | qca_get_alt_nvm_file(config->fwname, sizeof(config->fwname))) { | 
|  | bt_dev_info(hdev, "QCA Downloading %s", config->fwname); | 
|  | ret = request_firmware(&fw, config->fwname, &hdev->dev); | 
|  | if (ret) { | 
|  | bt_dev_err(hdev, "QCA Failed to request file: %s (%d)", | 
|  | config->fwname, ret); | 
|  | return ret; | 
|  | } | 
|  | } else { | 
|  | bt_dev_err(hdev, "QCA Failed to request file: %s (%d)", | 
|  | config->fwname, ret); | 
|  | return ret; | 
|  | } | 
|  | } | 
|  |  | 
|  | size = fw->size; | 
|  | data = vmalloc(fw->size); | 
|  | if (!data) { | 
|  | bt_dev_err(hdev, "QCA Failed to allocate memory for file: %s", | 
|  | config->fwname); | 
|  | release_firmware(fw); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | memcpy(data, fw->data, size); | 
|  | release_firmware(fw); | 
|  |  | 
|  | ret = qca_tlv_check_data(hdev, config, data, size, soc_type); | 
|  | if (ret) | 
|  | goto out; | 
|  |  | 
|  | segment = data; | 
|  | remain = size; | 
|  | while (remain > 0) { | 
|  | int segsize = min(MAX_SIZE_PER_TLV_SEGMENT, remain); | 
|  |  | 
|  | bt_dev_dbg(hdev, "Send segment %d, size %d", i++, segsize); | 
|  |  | 
|  | remain -= segsize; | 
|  | /* The last segment is always acked regardless download mode */ | 
|  | if (!remain || segsize < MAX_SIZE_PER_TLV_SEGMENT) | 
|  | config->dnld_mode = QCA_SKIP_EVT_NONE; | 
|  |  | 
|  | ret = qca_tlv_send_segment(hdev, segsize, segment, | 
|  | config->dnld_mode, soc_type); | 
|  | if (ret) | 
|  | goto out; | 
|  |  | 
|  | segment += segsize; | 
|  | } | 
|  |  | 
|  | /* Latest qualcomm chipsets are not sending a command complete event | 
|  | * for every fw packet sent. They only respond with a vendor specific | 
|  | * event for the last packet. This optimization in the chip will | 
|  | * decrease the BT in initialization time. Here we will inject a command | 
|  | * complete event to avoid a command timeout error message. | 
|  | */ | 
|  | if (config->dnld_type == QCA_SKIP_EVT_VSE_CC || | 
|  | config->dnld_type == QCA_SKIP_EVT_VSE) | 
|  | ret = qca_inject_cmd_complete_event(hdev); | 
|  |  | 
|  | out: | 
|  | vfree(data); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int qca_disable_soc_logging(struct hci_dev *hdev) | 
|  | { | 
|  | struct sk_buff *skb; | 
|  | u8 cmd[2]; | 
|  | int err; | 
|  |  | 
|  | cmd[0] = QCA_DISABLE_LOGGING_SUB_OP; | 
|  | cmd[1] = 0x00; | 
|  | skb = __hci_cmd_sync_ev(hdev, QCA_DISABLE_LOGGING, sizeof(cmd), cmd, | 
|  | HCI_EV_CMD_COMPLETE, HCI_INIT_TIMEOUT); | 
|  | if (IS_ERR(skb)) { | 
|  | err = PTR_ERR(skb); | 
|  | bt_dev_err(hdev, "QCA Failed to disable soc logging(%d)", err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | kfree_skb(skb); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int qca_set_bdaddr_rome(struct hci_dev *hdev, const bdaddr_t *bdaddr) | 
|  | { | 
|  | struct sk_buff *skb; | 
|  | u8 cmd[9]; | 
|  | int err; | 
|  |  | 
|  | cmd[0] = EDL_NVM_ACCESS_SET_REQ_CMD; | 
|  | cmd[1] = 0x02; 			/* TAG ID */ | 
|  | cmd[2] = sizeof(bdaddr_t);	/* size */ | 
|  | memcpy(cmd + 3, bdaddr, sizeof(bdaddr_t)); | 
|  | skb = __hci_cmd_sync_ev(hdev, EDL_NVM_ACCESS_OPCODE, sizeof(cmd), cmd, | 
|  | HCI_EV_VENDOR, HCI_INIT_TIMEOUT); | 
|  | if (IS_ERR(skb)) { | 
|  | err = PTR_ERR(skb); | 
|  | bt_dev_err(hdev, "QCA Change address command failed (%d)", err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | kfree_skb(skb); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(qca_set_bdaddr_rome); | 
|  |  | 
|  | static int qca_check_bdaddr(struct hci_dev *hdev, const struct qca_fw_config *config) | 
|  | { | 
|  | struct hci_rp_read_bd_addr *bda; | 
|  | struct sk_buff *skb; | 
|  | int err; | 
|  |  | 
|  | if (bacmp(&hdev->public_addr, BDADDR_ANY)) | 
|  | return 0; | 
|  |  | 
|  | skb = __hci_cmd_sync(hdev, HCI_OP_READ_BD_ADDR, 0, NULL, | 
|  | HCI_INIT_TIMEOUT); | 
|  | if (IS_ERR(skb)) { | 
|  | err = PTR_ERR(skb); | 
|  | bt_dev_err(hdev, "Failed to read device address (%d)", err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | if (skb->len != sizeof(*bda)) { | 
|  | bt_dev_err(hdev, "Device address length mismatch"); | 
|  | kfree_skb(skb); | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | bda = (struct hci_rp_read_bd_addr *)skb->data; | 
|  | if (!bacmp(&bda->bdaddr, &config->bdaddr)) | 
|  | hci_set_quirk(hdev, HCI_QUIRK_USE_BDADDR_PROPERTY); | 
|  |  | 
|  | kfree_skb(skb); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void qca_get_nvm_name_by_board(char *fwname, size_t max_size, | 
|  | const char *stem, enum qca_btsoc_type soc_type, | 
|  | struct qca_btsoc_version ver, u8 rom_ver, u16 bid) | 
|  | { | 
|  | const char *variant; | 
|  | const char *prefix; | 
|  |  | 
|  | /* Set the default value to variant and prefix */ | 
|  | variant = ""; | 
|  | prefix = "b"; | 
|  |  | 
|  | if (soc_type == QCA_QCA2066) | 
|  | prefix = ""; | 
|  |  | 
|  | if (soc_type == QCA_WCN6855 || soc_type == QCA_QCA2066) { | 
|  | /* If the chip is manufactured by GlobalFoundries */ | 
|  | if ((le32_to_cpu(ver.soc_id) & QCA_HSP_GF_SOC_MASK) == QCA_HSP_GF_SOC_ID) | 
|  | variant = "g"; | 
|  | } | 
|  |  | 
|  | if (rom_ver != 0) { | 
|  | if (bid == 0x0 || bid == 0xffff) | 
|  | snprintf(fwname, max_size, "qca/%s%02x%s.bin", stem, rom_ver, variant); | 
|  | else | 
|  | snprintf(fwname, max_size, "qca/%s%02x%s.%s%02x", stem, rom_ver, | 
|  | variant, prefix, bid); | 
|  | } else { | 
|  | if (bid == 0x0 || bid == 0xffff) | 
|  | snprintf(fwname, max_size, "qca/%s%s.bin", stem, variant); | 
|  | else | 
|  | snprintf(fwname, max_size, "qca/%s%s.%s%02x", stem, variant, prefix, bid); | 
|  | } | 
|  | } | 
|  |  | 
|  | int qca_uart_setup(struct hci_dev *hdev, uint8_t baudrate, | 
|  | enum qca_btsoc_type soc_type, struct qca_btsoc_version ver, | 
|  | const char *firmware_name, const char *rampatch_name) | 
|  | { | 
|  | struct qca_fw_config config = {}; | 
|  | const char *variant = ""; | 
|  | int err; | 
|  | u8 rom_ver = 0; | 
|  | u32 soc_ver; | 
|  | u16 boardid = 0; | 
|  |  | 
|  | bt_dev_dbg(hdev, "QCA setup on UART"); | 
|  |  | 
|  | soc_ver = get_soc_ver(ver.soc_id, ver.rom_ver); | 
|  |  | 
|  | bt_dev_info(hdev, "QCA controller version 0x%08x", soc_ver); | 
|  |  | 
|  | config.user_baud_rate = baudrate; | 
|  |  | 
|  | /* Firmware files to download are based on ROM version. | 
|  | * ROM version is derived from last two bytes of soc_ver. | 
|  | */ | 
|  | if (soc_type == QCA_WCN3988) | 
|  | rom_ver = ((soc_ver & 0x00000f00) >> 0x05) | (soc_ver & 0x0000000f); | 
|  | else | 
|  | rom_ver = ((soc_ver & 0x00000f00) >> 0x04) | (soc_ver & 0x0000000f); | 
|  |  | 
|  | if (soc_type == QCA_WCN6750) | 
|  | qca_send_patch_config_cmd(hdev); | 
|  |  | 
|  | /* Download rampatch file */ | 
|  | config.type = TLV_TYPE_PATCH; | 
|  | if (rampatch_name) { | 
|  | snprintf(config.fwname, sizeof(config.fwname), "qca/%s", rampatch_name); | 
|  | } else { | 
|  | switch (soc_type) { | 
|  | case QCA_WCN3950: | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/cmbtfw%02x.tlv", rom_ver); | 
|  | break; | 
|  | case QCA_WCN3990: | 
|  | case QCA_WCN3991: | 
|  | case QCA_WCN3998: | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/crbtfw%02x.tlv", rom_ver); | 
|  | break; | 
|  | case QCA_WCN3988: | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/apbtfw%02x.tlv", rom_ver); | 
|  | break; | 
|  | case QCA_QCA2066: | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/hpbtfw%02x.tlv", rom_ver); | 
|  | break; | 
|  | case QCA_QCA6390: | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/htbtfw%02x.tlv", rom_ver); | 
|  | break; | 
|  | case QCA_WCN6750: | 
|  | /* Choose mbn file by default.If mbn file is not found | 
|  | * then choose tlv file | 
|  | */ | 
|  | config.type = ELF_TYPE_PATCH; | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/msbtfw%02x.mbn", rom_ver); | 
|  | break; | 
|  | case QCA_WCN6855: | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/hpbtfw%02x.tlv", rom_ver); | 
|  | break; | 
|  | case QCA_WCN7850: | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/hmtbtfw%02x.tlv", rom_ver); | 
|  | break; | 
|  | default: | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/rampatch_%08x.bin", soc_ver); | 
|  | } | 
|  | } | 
|  |  | 
|  | err = qca_download_firmware(hdev, &config, soc_type, rom_ver); | 
|  | if (err < 0) { | 
|  | bt_dev_err(hdev, "QCA Failed to download patch (%d)", err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | /* Give the controller some time to get ready to receive the NVM */ | 
|  | msleep(10); | 
|  |  | 
|  | if (soc_type == QCA_QCA2066 || soc_type == QCA_WCN7850) | 
|  | qca_read_fw_board_id(hdev, &boardid); | 
|  |  | 
|  | /* Download NVM configuration */ | 
|  | config.type = TLV_TYPE_NVM; | 
|  | if (firmware_name) { | 
|  | /* The firmware name has an extension, use it directly */ | 
|  | if (qca_filename_has_extension(firmware_name)) { | 
|  | snprintf(config.fwname, sizeof(config.fwname), "qca/%s", firmware_name); | 
|  | } else { | 
|  | qca_read_fw_board_id(hdev, &boardid); | 
|  | qca_get_nvm_name_by_board(config.fwname, sizeof(config.fwname), | 
|  | firmware_name, soc_type, ver, 0, boardid); | 
|  | } | 
|  | } else { | 
|  | switch (soc_type) { | 
|  | case QCA_WCN3950: | 
|  | if (le32_to_cpu(ver.soc_id) == QCA_WCN3950_SOC_ID_T) | 
|  | variant = "t"; | 
|  | else if (le32_to_cpu(ver.soc_id) == QCA_WCN3950_SOC_ID_S) | 
|  | variant = "s"; | 
|  |  | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/cmnv%02x%s.bin", rom_ver, variant); | 
|  | break; | 
|  | case QCA_WCN3990: | 
|  | case QCA_WCN3991: | 
|  | case QCA_WCN3998: | 
|  | if (le32_to_cpu(ver.soc_id) == QCA_WCN3991_SOC_ID) | 
|  | variant = "u"; | 
|  |  | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/crnv%02x%s.bin", rom_ver, variant); | 
|  | break; | 
|  | case QCA_WCN3988: | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/apnv%02x.bin", rom_ver); | 
|  | break; | 
|  | case QCA_QCA2066: | 
|  | qca_get_nvm_name_by_board(config.fwname, | 
|  | sizeof(config.fwname), "hpnv", soc_type, ver, | 
|  | rom_ver, boardid); | 
|  | break; | 
|  | case QCA_QCA6390: | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/htnv%02x.bin", rom_ver); | 
|  | break; | 
|  | case QCA_WCN6750: | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/msnv%02x.bin", rom_ver); | 
|  | break; | 
|  | case QCA_WCN6855: | 
|  | qca_read_fw_board_id(hdev, &boardid); | 
|  | qca_get_nvm_name_by_board(config.fwname, sizeof(config.fwname), | 
|  | "hpnv", soc_type, ver, rom_ver, boardid); | 
|  | break; | 
|  | case QCA_WCN7850: | 
|  | qca_get_nvm_name_by_board(config.fwname, sizeof(config.fwname), | 
|  | "hmtnv", soc_type, ver, rom_ver, boardid); | 
|  | break; | 
|  | default: | 
|  | snprintf(config.fwname, sizeof(config.fwname), | 
|  | "qca/nvm_%08x.bin", soc_ver); | 
|  | } | 
|  | } | 
|  |  | 
|  | err = qca_download_firmware(hdev, &config, soc_type, rom_ver); | 
|  | if (err < 0) { | 
|  | bt_dev_err(hdev, "QCA Failed to download NVM (%d)", err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | switch (soc_type) { | 
|  | case QCA_WCN3991: | 
|  | case QCA_QCA2066: | 
|  | case QCA_QCA6390: | 
|  | case QCA_WCN6750: | 
|  | case QCA_WCN6855: | 
|  | case QCA_WCN7850: | 
|  | err = qca_disable_soc_logging(hdev); | 
|  | if (err < 0) | 
|  | return err; | 
|  | break; | 
|  | default: | 
|  | break; | 
|  | } | 
|  |  | 
|  | /* WCN399x and WCN6750 supports the Microsoft vendor extension with 0xFD70 as the | 
|  | * VsMsftOpCode. | 
|  | */ | 
|  | switch (soc_type) { | 
|  | case QCA_WCN3950: | 
|  | case QCA_WCN3988: | 
|  | case QCA_WCN3990: | 
|  | case QCA_WCN3991: | 
|  | case QCA_WCN3998: | 
|  | case QCA_WCN6750: | 
|  | hci_set_msft_opcode(hdev, 0xFD70); | 
|  | break; | 
|  | default: | 
|  | break; | 
|  | } | 
|  |  | 
|  | /* Perform HCI reset */ | 
|  | err = qca_send_reset(hdev); | 
|  | if (err < 0) { | 
|  | bt_dev_err(hdev, "QCA Failed to run HCI_RESET (%d)", err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | switch (soc_type) { | 
|  | case QCA_WCN3991: | 
|  | case QCA_WCN6750: | 
|  | case QCA_WCN6855: | 
|  | case QCA_WCN7850: | 
|  | /* get fw build info */ | 
|  | err = qca_read_fw_build_info(hdev); | 
|  | if (err < 0) | 
|  | return err; | 
|  | break; | 
|  | default: | 
|  | break; | 
|  | } | 
|  |  | 
|  | err = qca_check_bdaddr(hdev, &config); | 
|  | if (err) | 
|  | return err; | 
|  |  | 
|  | bt_dev_info(hdev, "QCA setup on UART is completed"); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(qca_uart_setup); | 
|  |  | 
|  | int qca_set_bdaddr(struct hci_dev *hdev, const bdaddr_t *bdaddr) | 
|  | { | 
|  | bdaddr_t bdaddr_swapped; | 
|  | struct sk_buff *skb; | 
|  | int err; | 
|  |  | 
|  | baswap(&bdaddr_swapped, bdaddr); | 
|  |  | 
|  | skb = __hci_cmd_sync_ev(hdev, EDL_WRITE_BD_ADDR_OPCODE, 6, | 
|  | &bdaddr_swapped, HCI_EV_VENDOR, | 
|  | HCI_INIT_TIMEOUT); | 
|  | if (IS_ERR(skb)) { | 
|  | err = PTR_ERR(skb); | 
|  | bt_dev_err(hdev, "QCA Change address cmd failed (%d)", err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | kfree_skb(skb); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(qca_set_bdaddr); | 
|  |  | 
|  |  | 
|  | MODULE_AUTHOR("Ben Young Tae Kim <ytkim@qca.qualcomm.com>"); | 
|  | MODULE_DESCRIPTION("Bluetooth support for Qualcomm Atheros family"); | 
|  | MODULE_LICENSE("GPL"); |