| // 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 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; |
| } |
| } 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)) |
| set_bit(HCI_QUIRK_USE_BDADDR_PROPERTY, &hdev->quirks); |
| |
| kfree_skb(skb); |
| |
| return 0; |
| } |
| |
| static void qca_generate_hsp_nvm_name(char *fwname, size_t max_size, |
| struct qca_btsoc_version ver, u8 rom_ver, u16 bid) |
| { |
| const char *variant; |
| |
| /* hsp gf chip */ |
| if ((le32_to_cpu(ver.soc_id) & QCA_HSP_GF_SOC_MASK) == QCA_HSP_GF_SOC_ID) |
| variant = "g"; |
| else |
| variant = ""; |
| |
| if (bid == 0x0) |
| snprintf(fwname, max_size, "qca/hpnv%02x%s.bin", rom_ver, variant); |
| else |
| snprintf(fwname, max_size, "qca/hpnv%02x%s.%x", rom_ver, variant, bid); |
| } |
| |
| static inline void qca_get_nvm_name_generic(struct qca_fw_config *cfg, |
| const char *stem, u8 rom_ver, u16 bid) |
| { |
| if (bid == 0x0) |
| snprintf(cfg->fwname, sizeof(cfg->fwname), "qca/%snv%02x.bin", stem, rom_ver); |
| else if (bid & 0xff00) |
| snprintf(cfg->fwname, sizeof(cfg->fwname), |
| "qca/%snv%02x.b%x", stem, rom_ver, bid); |
| else |
| snprintf(cfg->fwname, sizeof(cfg->fwname), |
| "qca/%snv%02x.b%02x", stem, rom_ver, 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) |
| { |
| struct qca_fw_config config = {}; |
| 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; |
| switch (soc_type) { |
| 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) { |
| snprintf(config.fwname, sizeof(config.fwname), |
| "qca/%s", firmware_name); |
| } else { |
| switch (soc_type) { |
| case QCA_WCN3990: |
| case QCA_WCN3991: |
| case QCA_WCN3998: |
| if (le32_to_cpu(ver.soc_id) == QCA_WCN3991_SOC_ID) { |
| snprintf(config.fwname, sizeof(config.fwname), |
| "qca/crnv%02xu.bin", rom_ver); |
| } else { |
| snprintf(config.fwname, sizeof(config.fwname), |
| "qca/crnv%02x.bin", rom_ver); |
| } |
| break; |
| case QCA_WCN3988: |
| snprintf(config.fwname, sizeof(config.fwname), |
| "qca/apnv%02x.bin", rom_ver); |
| break; |
| case QCA_QCA2066: |
| qca_generate_hsp_nvm_name(config.fwname, |
| sizeof(config.fwname), 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: |
| snprintf(config.fwname, sizeof(config.fwname), |
| "qca/hpnv%02x.bin", rom_ver); |
| break; |
| case QCA_WCN7850: |
| qca_get_nvm_name_generic(&config, "hmt", 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_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"); |