// SPDX-License-Identifier: ISC /* Copyright (C) 2021 MediaTek Inc. * */ #include #include #include #include #include "btmtk.h" #define VERSION "0.1" /* It is for mt79xx download rom patch*/ #define MTK_FW_ROM_PATCH_HEADER_SIZE 32 #define MTK_FW_ROM_PATCH_GD_SIZE 64 #define MTK_FW_ROM_PATCH_SEC_MAP_SIZE 64 #define MTK_SEC_MAP_COMMON_SIZE 12 #define MTK_SEC_MAP_NEED_SEND_SIZE 52 struct btmtk_patch_header { u8 datetime[16]; u8 platform[4]; __le16 hwver; __le16 swver; __le32 magicnum; } __packed; struct btmtk_global_desc { __le32 patch_ver; __le32 sub_sys; __le32 feature_opt; __le32 section_num; } __packed; struct btmtk_section_map { __le32 sectype; __le32 secoffset; __le32 secsize; union { __le32 u4SecSpec[13]; struct { __le32 dlAddr; __le32 dlsize; __le32 seckeyidx; __le32 alignlen; __le32 sectype; __le32 dlmodecrctype; __le32 crc; __le32 reserved[6]; } bin_info_spec; }; } __packed; int btmtk_setup_firmware_79xx(struct hci_dev *hdev, const char *fwname, wmt_cmd_sync_func_t wmt_cmd_sync) { struct btmtk_hci_wmt_params wmt_params; struct btmtk_global_desc *globaldesc = NULL; struct btmtk_section_map *sectionmap; const struct firmware *fw; const u8 *fw_ptr; const u8 *fw_bin_ptr; int err, dlen, i, status; u8 flag, first_block, retry; u32 section_num, dl_size, section_offset; u8 cmd[64]; err = request_firmware(&fw, fwname, &hdev->dev); if (err < 0) { bt_dev_err(hdev, "Failed to load firmware file (%d)", err); return err; } fw_ptr = fw->data; fw_bin_ptr = fw_ptr; globaldesc = (struct btmtk_global_desc *)(fw_ptr + MTK_FW_ROM_PATCH_HEADER_SIZE); section_num = le32_to_cpu(globaldesc->section_num); for (i = 0; i < section_num; i++) { first_block = 1; fw_ptr = fw_bin_ptr; sectionmap = (struct btmtk_section_map *)(fw_ptr + MTK_FW_ROM_PATCH_HEADER_SIZE + MTK_FW_ROM_PATCH_GD_SIZE + MTK_FW_ROM_PATCH_SEC_MAP_SIZE * i); section_offset = le32_to_cpu(sectionmap->secoffset); dl_size = le32_to_cpu(sectionmap->bin_info_spec.dlsize); if (dl_size > 0) { retry = 20; while (retry > 0) { cmd[0] = 0; /* 0 means legacy dl mode. */ memcpy(cmd + 1, fw_ptr + MTK_FW_ROM_PATCH_HEADER_SIZE + MTK_FW_ROM_PATCH_GD_SIZE + MTK_FW_ROM_PATCH_SEC_MAP_SIZE * i + MTK_SEC_MAP_COMMON_SIZE, MTK_SEC_MAP_NEED_SEND_SIZE + 1); wmt_params.op = BTMTK_WMT_PATCH_DWNLD; wmt_params.status = &status; wmt_params.flag = 0; wmt_params.dlen = MTK_SEC_MAP_NEED_SEND_SIZE + 1; wmt_params.data = &cmd; err = wmt_cmd_sync(hdev, &wmt_params); if (err < 0) { bt_dev_err(hdev, "Failed to send wmt patch dwnld (%d)", err); goto err_release_fw; } if (status == BTMTK_WMT_PATCH_UNDONE) { break; } else if (status == BTMTK_WMT_PATCH_PROGRESS) { msleep(100); retry--; } else if (status == BTMTK_WMT_PATCH_DONE) { goto next_section; } else { bt_dev_err(hdev, "Failed wmt patch dwnld status (%d)", status); err = -EIO; goto err_release_fw; } } fw_ptr += section_offset; wmt_params.op = BTMTK_WMT_PATCH_DWNLD; wmt_params.status = NULL; while (dl_size > 0) { dlen = min_t(int, 250, dl_size); if (first_block == 1) { flag = 1; first_block = 0; } else if (dl_size - dlen <= 0) { flag = 3; } else { flag = 2; } wmt_params.flag = flag; wmt_params.dlen = dlen; wmt_params.data = fw_ptr; err = wmt_cmd_sync(hdev, &wmt_params); if (err < 0) { bt_dev_err(hdev, "Failed to send wmt patch dwnld (%d)", err); goto err_release_fw; } dl_size -= dlen; fw_ptr += dlen; } } next_section: continue; } /* Wait a few moments for firmware activation done */ usleep_range(100000, 120000); err_release_fw: release_firmware(fw); return err; } EXPORT_SYMBOL_GPL(btmtk_setup_firmware_79xx); int btmtk_setup_firmware(struct hci_dev *hdev, const char *fwname, wmt_cmd_sync_func_t wmt_cmd_sync) { struct btmtk_hci_wmt_params wmt_params; const struct firmware *fw; const u8 *fw_ptr; size_t fw_size; int err, dlen; u8 flag, param; err = request_firmware(&fw, fwname, &hdev->dev); if (err < 0) { bt_dev_err(hdev, "Failed to load firmware file (%d)", err); return err; } /* Power on data RAM the firmware relies on. */ param = 1; wmt_params.op = BTMTK_WMT_FUNC_CTRL; wmt_params.flag = 3; wmt_params.dlen = sizeof(param); wmt_params.data = ¶m; wmt_params.status = NULL; err = wmt_cmd_sync(hdev, &wmt_params); if (err < 0) { bt_dev_err(hdev, "Failed to power on data RAM (%d)", err); goto err_release_fw; } fw_ptr = fw->data; fw_size = fw->size; /* The size of patch header is 30 bytes, should be skip */ if (fw_size < 30) { err = -EINVAL; goto err_release_fw; } fw_size -= 30; fw_ptr += 30; flag = 1; wmt_params.op = BTMTK_WMT_PATCH_DWNLD; wmt_params.status = NULL; while (fw_size > 0) { dlen = min_t(int, 250, fw_size); /* Tell device the position in sequence */ if (fw_size - dlen <= 0) flag = 3; else if (fw_size < fw->size - 30) flag = 2; wmt_params.flag = flag; wmt_params.dlen = dlen; wmt_params.data = fw_ptr; err = wmt_cmd_sync(hdev, &wmt_params); if (err < 0) { bt_dev_err(hdev, "Failed to send wmt patch dwnld (%d)", err); goto err_release_fw; } fw_size -= dlen; fw_ptr += dlen; } wmt_params.op = BTMTK_WMT_RST; wmt_params.flag = 4; wmt_params.dlen = 0; wmt_params.data = NULL; wmt_params.status = NULL; /* Activate funciton the firmware providing to */ err = wmt_cmd_sync(hdev, &wmt_params); if (err < 0) { bt_dev_err(hdev, "Failed to send wmt rst (%d)", err); goto err_release_fw; } /* Wait a few moments for firmware activation done */ usleep_range(10000, 12000); err_release_fw: release_firmware(fw); return err; } EXPORT_SYMBOL_GPL(btmtk_setup_firmware); int btmtk_set_bdaddr(struct hci_dev *hdev, const bdaddr_t *bdaddr) { struct sk_buff *skb; long ret; skb = __hci_cmd_sync(hdev, 0xfc1a, 6, bdaddr, HCI_INIT_TIMEOUT); if (IS_ERR(skb)) { ret = PTR_ERR(skb); bt_dev_err(hdev, "changing Mediatek device address failed (%ld)", ret); return ret; } kfree_skb(skb); return 0; } EXPORT_SYMBOL_GPL(btmtk_set_bdaddr); MODULE_AUTHOR("Sean Wang "); MODULE_AUTHOR("Mark Chen "); MODULE_DESCRIPTION("Bluetooth support for MediaTek devices ver " VERSION); MODULE_VERSION(VERSION); MODULE_LICENSE("GPL"); MODULE_FIRMWARE(FIRMWARE_MT7663); MODULE_FIRMWARE(FIRMWARE_MT7668); MODULE_FIRMWARE(FIRMWARE_MT7961);