162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Bluetooth support for Realtek devices 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (C) 2015 Endless Mobile, Inc. 662306a36Sopenharmony_ci */ 762306a36Sopenharmony_ci 862306a36Sopenharmony_ci#include <linux/module.h> 962306a36Sopenharmony_ci#include <linux/firmware.h> 1062306a36Sopenharmony_ci#include <asm/unaligned.h> 1162306a36Sopenharmony_ci#include <linux/usb.h> 1262306a36Sopenharmony_ci 1362306a36Sopenharmony_ci#include <net/bluetooth/bluetooth.h> 1462306a36Sopenharmony_ci#include <net/bluetooth/hci_core.h> 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_ci#include "btrtl.h" 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_ci#define VERSION "0.1" 1962306a36Sopenharmony_ci 2062306a36Sopenharmony_ci#define RTL_CHIP_8723CS_CG 3 2162306a36Sopenharmony_ci#define RTL_CHIP_8723CS_VF 4 2262306a36Sopenharmony_ci#define RTL_CHIP_8723CS_XX 5 2362306a36Sopenharmony_ci#define RTL_EPATCH_SIGNATURE "Realtech" 2462306a36Sopenharmony_ci#define RTL_EPATCH_SIGNATURE_V2 "RTBTCore" 2562306a36Sopenharmony_ci#define RTL_ROM_LMP_8703B 0x8703 2662306a36Sopenharmony_ci#define RTL_ROM_LMP_8723A 0x1200 2762306a36Sopenharmony_ci#define RTL_ROM_LMP_8723B 0x8723 2862306a36Sopenharmony_ci#define RTL_ROM_LMP_8821A 0x8821 2962306a36Sopenharmony_ci#define RTL_ROM_LMP_8761A 0x8761 3062306a36Sopenharmony_ci#define RTL_ROM_LMP_8822B 0x8822 3162306a36Sopenharmony_ci#define RTL_ROM_LMP_8852A 0x8852 3262306a36Sopenharmony_ci#define RTL_ROM_LMP_8851B 0x8851 3362306a36Sopenharmony_ci#define RTL_CONFIG_MAGIC 0x8723ab55 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_ci#define RTL_VSC_OP_COREDUMP 0xfcff 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_ci#define IC_MATCH_FL_LMPSUBV (1 << 0) 3862306a36Sopenharmony_ci#define IC_MATCH_FL_HCIREV (1 << 1) 3962306a36Sopenharmony_ci#define IC_MATCH_FL_HCIVER (1 << 2) 4062306a36Sopenharmony_ci#define IC_MATCH_FL_HCIBUS (1 << 3) 4162306a36Sopenharmony_ci#define IC_MATCH_FL_CHIP_TYPE (1 << 4) 4262306a36Sopenharmony_ci#define IC_INFO(lmps, hcir, hciv, bus) \ 4362306a36Sopenharmony_ci .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_HCIREV | \ 4462306a36Sopenharmony_ci IC_MATCH_FL_HCIVER | IC_MATCH_FL_HCIBUS, \ 4562306a36Sopenharmony_ci .lmp_subver = (lmps), \ 4662306a36Sopenharmony_ci .hci_rev = (hcir), \ 4762306a36Sopenharmony_ci .hci_ver = (hciv), \ 4862306a36Sopenharmony_ci .hci_bus = (bus) 4962306a36Sopenharmony_ci 5062306a36Sopenharmony_ci#define RTL_CHIP_SUBVER (&(struct rtl_vendor_cmd) {{0x10, 0x38, 0x04, 0x28, 0x80}}) 5162306a36Sopenharmony_ci#define RTL_CHIP_REV (&(struct rtl_vendor_cmd) {{0x10, 0x3A, 0x04, 0x28, 0x80}}) 5262306a36Sopenharmony_ci#define RTL_SEC_PROJ (&(struct rtl_vendor_cmd) {{0x10, 0xA4, 0x0D, 0x00, 0xb0}}) 5362306a36Sopenharmony_ci 5462306a36Sopenharmony_ci#define RTL_PATCH_SNIPPETS 0x01 5562306a36Sopenharmony_ci#define RTL_PATCH_DUMMY_HEADER 0x02 5662306a36Sopenharmony_ci#define RTL_PATCH_SECURITY_HEADER 0x03 5762306a36Sopenharmony_ci 5862306a36Sopenharmony_cienum btrtl_chip_id { 5962306a36Sopenharmony_ci CHIP_ID_8723A, 6062306a36Sopenharmony_ci CHIP_ID_8723B, 6162306a36Sopenharmony_ci CHIP_ID_8821A, 6262306a36Sopenharmony_ci CHIP_ID_8761A, 6362306a36Sopenharmony_ci CHIP_ID_8822B = 8, 6462306a36Sopenharmony_ci CHIP_ID_8723D, 6562306a36Sopenharmony_ci CHIP_ID_8821C, 6662306a36Sopenharmony_ci CHIP_ID_8822C = 13, 6762306a36Sopenharmony_ci CHIP_ID_8761B, 6862306a36Sopenharmony_ci CHIP_ID_8852A = 18, 6962306a36Sopenharmony_ci CHIP_ID_8852B = 20, 7062306a36Sopenharmony_ci CHIP_ID_8852C = 25, 7162306a36Sopenharmony_ci CHIP_ID_8851B = 36, 7262306a36Sopenharmony_ci}; 7362306a36Sopenharmony_ci 7462306a36Sopenharmony_cistruct id_table { 7562306a36Sopenharmony_ci __u16 match_flags; 7662306a36Sopenharmony_ci __u16 lmp_subver; 7762306a36Sopenharmony_ci __u16 hci_rev; 7862306a36Sopenharmony_ci __u8 hci_ver; 7962306a36Sopenharmony_ci __u8 hci_bus; 8062306a36Sopenharmony_ci __u8 chip_type; 8162306a36Sopenharmony_ci bool config_needed; 8262306a36Sopenharmony_ci bool has_rom_version; 8362306a36Sopenharmony_ci bool has_msft_ext; 8462306a36Sopenharmony_ci char *fw_name; 8562306a36Sopenharmony_ci char *cfg_name; 8662306a36Sopenharmony_ci char *hw_info; 8762306a36Sopenharmony_ci}; 8862306a36Sopenharmony_ci 8962306a36Sopenharmony_cistruct btrtl_device_info { 9062306a36Sopenharmony_ci const struct id_table *ic_info; 9162306a36Sopenharmony_ci u8 rom_version; 9262306a36Sopenharmony_ci u8 *fw_data; 9362306a36Sopenharmony_ci int fw_len; 9462306a36Sopenharmony_ci u8 *cfg_data; 9562306a36Sopenharmony_ci int cfg_len; 9662306a36Sopenharmony_ci bool drop_fw; 9762306a36Sopenharmony_ci int project_id; 9862306a36Sopenharmony_ci u8 key_id; 9962306a36Sopenharmony_ci struct list_head patch_subsecs; 10062306a36Sopenharmony_ci}; 10162306a36Sopenharmony_ci 10262306a36Sopenharmony_cistatic const struct id_table ic_id_table[] = { 10362306a36Sopenharmony_ci /* 8723A */ 10462306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8723A, 0xb, 0x6, HCI_USB), 10562306a36Sopenharmony_ci .config_needed = false, 10662306a36Sopenharmony_ci .has_rom_version = false, 10762306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8723a_fw", 10862306a36Sopenharmony_ci .cfg_name = NULL, 10962306a36Sopenharmony_ci .hw_info = "rtl8723au" }, 11062306a36Sopenharmony_ci 11162306a36Sopenharmony_ci /* 8723BS */ 11262306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8723B, 0xb, 0x6, HCI_UART), 11362306a36Sopenharmony_ci .config_needed = true, 11462306a36Sopenharmony_ci .has_rom_version = true, 11562306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8723bs_fw", 11662306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8723bs_config", 11762306a36Sopenharmony_ci .hw_info = "rtl8723bs" }, 11862306a36Sopenharmony_ci 11962306a36Sopenharmony_ci /* 8723B */ 12062306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8723B, 0xb, 0x6, HCI_USB), 12162306a36Sopenharmony_ci .config_needed = false, 12262306a36Sopenharmony_ci .has_rom_version = true, 12362306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8723b_fw", 12462306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8723b_config", 12562306a36Sopenharmony_ci .hw_info = "rtl8723bu" }, 12662306a36Sopenharmony_ci 12762306a36Sopenharmony_ci /* 8723CS-CG */ 12862306a36Sopenharmony_ci { .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_CHIP_TYPE | 12962306a36Sopenharmony_ci IC_MATCH_FL_HCIBUS, 13062306a36Sopenharmony_ci .lmp_subver = RTL_ROM_LMP_8703B, 13162306a36Sopenharmony_ci .chip_type = RTL_CHIP_8723CS_CG, 13262306a36Sopenharmony_ci .hci_bus = HCI_UART, 13362306a36Sopenharmony_ci .config_needed = true, 13462306a36Sopenharmony_ci .has_rom_version = true, 13562306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8723cs_cg_fw", 13662306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8723cs_cg_config", 13762306a36Sopenharmony_ci .hw_info = "rtl8723cs-cg" }, 13862306a36Sopenharmony_ci 13962306a36Sopenharmony_ci /* 8723CS-VF */ 14062306a36Sopenharmony_ci { .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_CHIP_TYPE | 14162306a36Sopenharmony_ci IC_MATCH_FL_HCIBUS, 14262306a36Sopenharmony_ci .lmp_subver = RTL_ROM_LMP_8703B, 14362306a36Sopenharmony_ci .chip_type = RTL_CHIP_8723CS_VF, 14462306a36Sopenharmony_ci .hci_bus = HCI_UART, 14562306a36Sopenharmony_ci .config_needed = true, 14662306a36Sopenharmony_ci .has_rom_version = true, 14762306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8723cs_vf_fw", 14862306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8723cs_vf_config", 14962306a36Sopenharmony_ci .hw_info = "rtl8723cs-vf" }, 15062306a36Sopenharmony_ci 15162306a36Sopenharmony_ci /* 8723CS-XX */ 15262306a36Sopenharmony_ci { .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_CHIP_TYPE | 15362306a36Sopenharmony_ci IC_MATCH_FL_HCIBUS, 15462306a36Sopenharmony_ci .lmp_subver = RTL_ROM_LMP_8703B, 15562306a36Sopenharmony_ci .chip_type = RTL_CHIP_8723CS_XX, 15662306a36Sopenharmony_ci .hci_bus = HCI_UART, 15762306a36Sopenharmony_ci .config_needed = true, 15862306a36Sopenharmony_ci .has_rom_version = true, 15962306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8723cs_xx_fw", 16062306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8723cs_xx_config", 16162306a36Sopenharmony_ci .hw_info = "rtl8723cs" }, 16262306a36Sopenharmony_ci 16362306a36Sopenharmony_ci /* 8723D */ 16462306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8723B, 0xd, 0x8, HCI_USB), 16562306a36Sopenharmony_ci .config_needed = true, 16662306a36Sopenharmony_ci .has_rom_version = true, 16762306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8723d_fw", 16862306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8723d_config", 16962306a36Sopenharmony_ci .hw_info = "rtl8723du" }, 17062306a36Sopenharmony_ci 17162306a36Sopenharmony_ci /* 8723DS */ 17262306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8723B, 0xd, 0x8, HCI_UART), 17362306a36Sopenharmony_ci .config_needed = true, 17462306a36Sopenharmony_ci .has_rom_version = true, 17562306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8723ds_fw", 17662306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8723ds_config", 17762306a36Sopenharmony_ci .hw_info = "rtl8723ds" }, 17862306a36Sopenharmony_ci 17962306a36Sopenharmony_ci /* 8821A */ 18062306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8821A, 0xa, 0x6, HCI_USB), 18162306a36Sopenharmony_ci .config_needed = false, 18262306a36Sopenharmony_ci .has_rom_version = true, 18362306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8821a_fw", 18462306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8821a_config", 18562306a36Sopenharmony_ci .hw_info = "rtl8821au" }, 18662306a36Sopenharmony_ci 18762306a36Sopenharmony_ci /* 8821C */ 18862306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8821A, 0xc, 0x8, HCI_USB), 18962306a36Sopenharmony_ci .config_needed = false, 19062306a36Sopenharmony_ci .has_rom_version = true, 19162306a36Sopenharmony_ci .has_msft_ext = true, 19262306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8821c_fw", 19362306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8821c_config", 19462306a36Sopenharmony_ci .hw_info = "rtl8821cu" }, 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_ci /* 8821CS */ 19762306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8821A, 0xc, 0x8, HCI_UART), 19862306a36Sopenharmony_ci .config_needed = true, 19962306a36Sopenharmony_ci .has_rom_version = true, 20062306a36Sopenharmony_ci .has_msft_ext = true, 20162306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8821cs_fw", 20262306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8821cs_config", 20362306a36Sopenharmony_ci .hw_info = "rtl8821cs" }, 20462306a36Sopenharmony_ci 20562306a36Sopenharmony_ci /* 8761A */ 20662306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8761A, 0xa, 0x6, HCI_USB), 20762306a36Sopenharmony_ci .config_needed = false, 20862306a36Sopenharmony_ci .has_rom_version = true, 20962306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8761a_fw", 21062306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8761a_config", 21162306a36Sopenharmony_ci .hw_info = "rtl8761au" }, 21262306a36Sopenharmony_ci 21362306a36Sopenharmony_ci /* 8761B */ 21462306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8761A, 0xb, 0xa, HCI_UART), 21562306a36Sopenharmony_ci .config_needed = false, 21662306a36Sopenharmony_ci .has_rom_version = true, 21762306a36Sopenharmony_ci .has_msft_ext = true, 21862306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8761b_fw", 21962306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8761b_config", 22062306a36Sopenharmony_ci .hw_info = "rtl8761btv" }, 22162306a36Sopenharmony_ci 22262306a36Sopenharmony_ci /* 8761BU */ 22362306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8761A, 0xb, 0xa, HCI_USB), 22462306a36Sopenharmony_ci .config_needed = false, 22562306a36Sopenharmony_ci .has_rom_version = true, 22662306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8761bu_fw", 22762306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8761bu_config", 22862306a36Sopenharmony_ci .hw_info = "rtl8761bu" }, 22962306a36Sopenharmony_ci 23062306a36Sopenharmony_ci /* 8822C with UART interface */ 23162306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8822B, 0xc, 0x8, HCI_UART), 23262306a36Sopenharmony_ci .config_needed = true, 23362306a36Sopenharmony_ci .has_rom_version = true, 23462306a36Sopenharmony_ci .has_msft_ext = true, 23562306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8822cs_fw", 23662306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8822cs_config", 23762306a36Sopenharmony_ci .hw_info = "rtl8822cs" }, 23862306a36Sopenharmony_ci 23962306a36Sopenharmony_ci /* 8822C with UART interface */ 24062306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8822B, 0xc, 0xa, HCI_UART), 24162306a36Sopenharmony_ci .config_needed = true, 24262306a36Sopenharmony_ci .has_rom_version = true, 24362306a36Sopenharmony_ci .has_msft_ext = true, 24462306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8822cs_fw", 24562306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8822cs_config", 24662306a36Sopenharmony_ci .hw_info = "rtl8822cs" }, 24762306a36Sopenharmony_ci 24862306a36Sopenharmony_ci /* 8822C with USB interface */ 24962306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8822B, 0xc, 0xa, HCI_USB), 25062306a36Sopenharmony_ci .config_needed = false, 25162306a36Sopenharmony_ci .has_rom_version = true, 25262306a36Sopenharmony_ci .has_msft_ext = true, 25362306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8822cu_fw", 25462306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8822cu_config", 25562306a36Sopenharmony_ci .hw_info = "rtl8822cu" }, 25662306a36Sopenharmony_ci 25762306a36Sopenharmony_ci /* 8822B */ 25862306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8822B, 0xb, 0x7, HCI_USB), 25962306a36Sopenharmony_ci .config_needed = true, 26062306a36Sopenharmony_ci .has_rom_version = true, 26162306a36Sopenharmony_ci .has_msft_ext = true, 26262306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8822b_fw", 26362306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8822b_config", 26462306a36Sopenharmony_ci .hw_info = "rtl8822bu" }, 26562306a36Sopenharmony_ci 26662306a36Sopenharmony_ci /* 8852A */ 26762306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8852A, 0xa, 0xb, HCI_USB), 26862306a36Sopenharmony_ci .config_needed = false, 26962306a36Sopenharmony_ci .has_rom_version = true, 27062306a36Sopenharmony_ci .has_msft_ext = true, 27162306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8852au_fw", 27262306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8852au_config", 27362306a36Sopenharmony_ci .hw_info = "rtl8852au" }, 27462306a36Sopenharmony_ci 27562306a36Sopenharmony_ci /* 8852B with UART interface */ 27662306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8852A, 0xb, 0xb, HCI_UART), 27762306a36Sopenharmony_ci .config_needed = true, 27862306a36Sopenharmony_ci .has_rom_version = true, 27962306a36Sopenharmony_ci .has_msft_ext = true, 28062306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8852bs_fw", 28162306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8852bs_config", 28262306a36Sopenharmony_ci .hw_info = "rtl8852bs" }, 28362306a36Sopenharmony_ci 28462306a36Sopenharmony_ci /* 8852B */ 28562306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8852A, 0xb, 0xb, HCI_USB), 28662306a36Sopenharmony_ci .config_needed = false, 28762306a36Sopenharmony_ci .has_rom_version = true, 28862306a36Sopenharmony_ci .has_msft_ext = true, 28962306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8852bu_fw", 29062306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8852bu_config", 29162306a36Sopenharmony_ci .hw_info = "rtl8852bu" }, 29262306a36Sopenharmony_ci 29362306a36Sopenharmony_ci /* 8852C */ 29462306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8852A, 0xc, 0xc, HCI_USB), 29562306a36Sopenharmony_ci .config_needed = false, 29662306a36Sopenharmony_ci .has_rom_version = true, 29762306a36Sopenharmony_ci .has_msft_ext = true, 29862306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8852cu_fw", 29962306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8852cu_config", 30062306a36Sopenharmony_ci .hw_info = "rtl8852cu" }, 30162306a36Sopenharmony_ci 30262306a36Sopenharmony_ci /* 8851B */ 30362306a36Sopenharmony_ci { IC_INFO(RTL_ROM_LMP_8851B, 0xb, 0xc, HCI_USB), 30462306a36Sopenharmony_ci .config_needed = false, 30562306a36Sopenharmony_ci .has_rom_version = true, 30662306a36Sopenharmony_ci .has_msft_ext = false, 30762306a36Sopenharmony_ci .fw_name = "rtl_bt/rtl8851bu_fw", 30862306a36Sopenharmony_ci .cfg_name = "rtl_bt/rtl8851bu_config", 30962306a36Sopenharmony_ci .hw_info = "rtl8851bu" }, 31062306a36Sopenharmony_ci }; 31162306a36Sopenharmony_ci 31262306a36Sopenharmony_cistatic const struct id_table *btrtl_match_ic(u16 lmp_subver, u16 hci_rev, 31362306a36Sopenharmony_ci u8 hci_ver, u8 hci_bus, 31462306a36Sopenharmony_ci u8 chip_type) 31562306a36Sopenharmony_ci{ 31662306a36Sopenharmony_ci int i; 31762306a36Sopenharmony_ci 31862306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(ic_id_table); i++) { 31962306a36Sopenharmony_ci if ((ic_id_table[i].match_flags & IC_MATCH_FL_LMPSUBV) && 32062306a36Sopenharmony_ci (ic_id_table[i].lmp_subver != lmp_subver)) 32162306a36Sopenharmony_ci continue; 32262306a36Sopenharmony_ci if ((ic_id_table[i].match_flags & IC_MATCH_FL_HCIREV) && 32362306a36Sopenharmony_ci (ic_id_table[i].hci_rev != hci_rev)) 32462306a36Sopenharmony_ci continue; 32562306a36Sopenharmony_ci if ((ic_id_table[i].match_flags & IC_MATCH_FL_HCIVER) && 32662306a36Sopenharmony_ci (ic_id_table[i].hci_ver != hci_ver)) 32762306a36Sopenharmony_ci continue; 32862306a36Sopenharmony_ci if ((ic_id_table[i].match_flags & IC_MATCH_FL_HCIBUS) && 32962306a36Sopenharmony_ci (ic_id_table[i].hci_bus != hci_bus)) 33062306a36Sopenharmony_ci continue; 33162306a36Sopenharmony_ci if ((ic_id_table[i].match_flags & IC_MATCH_FL_CHIP_TYPE) && 33262306a36Sopenharmony_ci (ic_id_table[i].chip_type != chip_type)) 33362306a36Sopenharmony_ci continue; 33462306a36Sopenharmony_ci 33562306a36Sopenharmony_ci break; 33662306a36Sopenharmony_ci } 33762306a36Sopenharmony_ci if (i >= ARRAY_SIZE(ic_id_table)) 33862306a36Sopenharmony_ci return NULL; 33962306a36Sopenharmony_ci 34062306a36Sopenharmony_ci return &ic_id_table[i]; 34162306a36Sopenharmony_ci} 34262306a36Sopenharmony_ci 34362306a36Sopenharmony_cistatic struct sk_buff *btrtl_read_local_version(struct hci_dev *hdev) 34462306a36Sopenharmony_ci{ 34562306a36Sopenharmony_ci struct sk_buff *skb; 34662306a36Sopenharmony_ci 34762306a36Sopenharmony_ci skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL, 34862306a36Sopenharmony_ci HCI_INIT_TIMEOUT); 34962306a36Sopenharmony_ci if (IS_ERR(skb)) { 35062306a36Sopenharmony_ci rtl_dev_err(hdev, "HCI_OP_READ_LOCAL_VERSION failed (%ld)", 35162306a36Sopenharmony_ci PTR_ERR(skb)); 35262306a36Sopenharmony_ci return skb; 35362306a36Sopenharmony_ci } 35462306a36Sopenharmony_ci 35562306a36Sopenharmony_ci if (skb->len != sizeof(struct hci_rp_read_local_version)) { 35662306a36Sopenharmony_ci rtl_dev_err(hdev, "HCI_OP_READ_LOCAL_VERSION event length mismatch"); 35762306a36Sopenharmony_ci kfree_skb(skb); 35862306a36Sopenharmony_ci return ERR_PTR(-EIO); 35962306a36Sopenharmony_ci } 36062306a36Sopenharmony_ci 36162306a36Sopenharmony_ci return skb; 36262306a36Sopenharmony_ci} 36362306a36Sopenharmony_ci 36462306a36Sopenharmony_cistatic int rtl_read_rom_version(struct hci_dev *hdev, u8 *version) 36562306a36Sopenharmony_ci{ 36662306a36Sopenharmony_ci struct rtl_rom_version_evt *rom_version; 36762306a36Sopenharmony_ci struct sk_buff *skb; 36862306a36Sopenharmony_ci 36962306a36Sopenharmony_ci /* Read RTL ROM version command */ 37062306a36Sopenharmony_ci skb = __hci_cmd_sync(hdev, 0xfc6d, 0, NULL, HCI_INIT_TIMEOUT); 37162306a36Sopenharmony_ci if (IS_ERR(skb)) { 37262306a36Sopenharmony_ci rtl_dev_err(hdev, "Read ROM version failed (%ld)", 37362306a36Sopenharmony_ci PTR_ERR(skb)); 37462306a36Sopenharmony_ci return PTR_ERR(skb); 37562306a36Sopenharmony_ci } 37662306a36Sopenharmony_ci 37762306a36Sopenharmony_ci if (skb->len != sizeof(*rom_version)) { 37862306a36Sopenharmony_ci rtl_dev_err(hdev, "version event length mismatch"); 37962306a36Sopenharmony_ci kfree_skb(skb); 38062306a36Sopenharmony_ci return -EIO; 38162306a36Sopenharmony_ci } 38262306a36Sopenharmony_ci 38362306a36Sopenharmony_ci rom_version = (struct rtl_rom_version_evt *)skb->data; 38462306a36Sopenharmony_ci rtl_dev_info(hdev, "rom_version status=%x version=%x", 38562306a36Sopenharmony_ci rom_version->status, rom_version->version); 38662306a36Sopenharmony_ci 38762306a36Sopenharmony_ci *version = rom_version->version; 38862306a36Sopenharmony_ci 38962306a36Sopenharmony_ci kfree_skb(skb); 39062306a36Sopenharmony_ci return 0; 39162306a36Sopenharmony_ci} 39262306a36Sopenharmony_ci 39362306a36Sopenharmony_cistatic int btrtl_vendor_read_reg16(struct hci_dev *hdev, 39462306a36Sopenharmony_ci struct rtl_vendor_cmd *cmd, u8 *rp) 39562306a36Sopenharmony_ci{ 39662306a36Sopenharmony_ci struct sk_buff *skb; 39762306a36Sopenharmony_ci int err = 0; 39862306a36Sopenharmony_ci 39962306a36Sopenharmony_ci skb = __hci_cmd_sync(hdev, 0xfc61, sizeof(*cmd), cmd, 40062306a36Sopenharmony_ci HCI_INIT_TIMEOUT); 40162306a36Sopenharmony_ci if (IS_ERR(skb)) { 40262306a36Sopenharmony_ci err = PTR_ERR(skb); 40362306a36Sopenharmony_ci rtl_dev_err(hdev, "RTL: Read reg16 failed (%d)", err); 40462306a36Sopenharmony_ci return err; 40562306a36Sopenharmony_ci } 40662306a36Sopenharmony_ci 40762306a36Sopenharmony_ci if (skb->len != 3 || skb->data[0]) { 40862306a36Sopenharmony_ci bt_dev_err(hdev, "RTL: Read reg16 length mismatch"); 40962306a36Sopenharmony_ci kfree_skb(skb); 41062306a36Sopenharmony_ci return -EIO; 41162306a36Sopenharmony_ci } 41262306a36Sopenharmony_ci 41362306a36Sopenharmony_ci if (rp) 41462306a36Sopenharmony_ci memcpy(rp, skb->data + 1, 2); 41562306a36Sopenharmony_ci 41662306a36Sopenharmony_ci kfree_skb(skb); 41762306a36Sopenharmony_ci 41862306a36Sopenharmony_ci return 0; 41962306a36Sopenharmony_ci} 42062306a36Sopenharmony_ci 42162306a36Sopenharmony_cistatic void *rtl_iov_pull_data(struct rtl_iovec *iov, u32 len) 42262306a36Sopenharmony_ci{ 42362306a36Sopenharmony_ci void *data = iov->data; 42462306a36Sopenharmony_ci 42562306a36Sopenharmony_ci if (iov->len < len) 42662306a36Sopenharmony_ci return NULL; 42762306a36Sopenharmony_ci 42862306a36Sopenharmony_ci iov->data += len; 42962306a36Sopenharmony_ci iov->len -= len; 43062306a36Sopenharmony_ci 43162306a36Sopenharmony_ci return data; 43262306a36Sopenharmony_ci} 43362306a36Sopenharmony_ci 43462306a36Sopenharmony_cistatic void btrtl_insert_ordered_subsec(struct rtl_subsection *node, 43562306a36Sopenharmony_ci struct btrtl_device_info *btrtl_dev) 43662306a36Sopenharmony_ci{ 43762306a36Sopenharmony_ci struct list_head *pos; 43862306a36Sopenharmony_ci struct list_head *next; 43962306a36Sopenharmony_ci struct rtl_subsection *subsec; 44062306a36Sopenharmony_ci 44162306a36Sopenharmony_ci list_for_each_safe(pos, next, &btrtl_dev->patch_subsecs) { 44262306a36Sopenharmony_ci subsec = list_entry(pos, struct rtl_subsection, list); 44362306a36Sopenharmony_ci if (subsec->prio >= node->prio) 44462306a36Sopenharmony_ci break; 44562306a36Sopenharmony_ci } 44662306a36Sopenharmony_ci __list_add(&node->list, pos->prev, pos); 44762306a36Sopenharmony_ci} 44862306a36Sopenharmony_ci 44962306a36Sopenharmony_cistatic int btrtl_parse_section(struct hci_dev *hdev, 45062306a36Sopenharmony_ci struct btrtl_device_info *btrtl_dev, u32 opcode, 45162306a36Sopenharmony_ci u8 *data, u32 len) 45262306a36Sopenharmony_ci{ 45362306a36Sopenharmony_ci struct rtl_section_hdr *hdr; 45462306a36Sopenharmony_ci struct rtl_subsection *subsec; 45562306a36Sopenharmony_ci struct rtl_common_subsec *common_subsec; 45662306a36Sopenharmony_ci struct rtl_sec_hdr *sec_hdr; 45762306a36Sopenharmony_ci int i; 45862306a36Sopenharmony_ci u8 *ptr; 45962306a36Sopenharmony_ci u16 num_subsecs; 46062306a36Sopenharmony_ci u32 subsec_len; 46162306a36Sopenharmony_ci int rc = 0; 46262306a36Sopenharmony_ci struct rtl_iovec iov = { 46362306a36Sopenharmony_ci .data = data, 46462306a36Sopenharmony_ci .len = len, 46562306a36Sopenharmony_ci }; 46662306a36Sopenharmony_ci 46762306a36Sopenharmony_ci hdr = rtl_iov_pull_data(&iov, sizeof(*hdr)); 46862306a36Sopenharmony_ci if (!hdr) 46962306a36Sopenharmony_ci return -EINVAL; 47062306a36Sopenharmony_ci num_subsecs = le16_to_cpu(hdr->num); 47162306a36Sopenharmony_ci 47262306a36Sopenharmony_ci for (i = 0; i < num_subsecs; i++) { 47362306a36Sopenharmony_ci common_subsec = rtl_iov_pull_data(&iov, sizeof(*common_subsec)); 47462306a36Sopenharmony_ci if (!common_subsec) 47562306a36Sopenharmony_ci break; 47662306a36Sopenharmony_ci subsec_len = le32_to_cpu(common_subsec->len); 47762306a36Sopenharmony_ci 47862306a36Sopenharmony_ci rtl_dev_dbg(hdev, "subsec, eco 0x%02x, len %08x", 47962306a36Sopenharmony_ci common_subsec->eco, subsec_len); 48062306a36Sopenharmony_ci 48162306a36Sopenharmony_ci ptr = rtl_iov_pull_data(&iov, subsec_len); 48262306a36Sopenharmony_ci if (!ptr) 48362306a36Sopenharmony_ci break; 48462306a36Sopenharmony_ci 48562306a36Sopenharmony_ci if (common_subsec->eco != btrtl_dev->rom_version + 1) 48662306a36Sopenharmony_ci continue; 48762306a36Sopenharmony_ci 48862306a36Sopenharmony_ci switch (opcode) { 48962306a36Sopenharmony_ci case RTL_PATCH_SECURITY_HEADER: 49062306a36Sopenharmony_ci sec_hdr = (void *)common_subsec; 49162306a36Sopenharmony_ci if (sec_hdr->key_id != btrtl_dev->key_id) 49262306a36Sopenharmony_ci continue; 49362306a36Sopenharmony_ci break; 49462306a36Sopenharmony_ci } 49562306a36Sopenharmony_ci 49662306a36Sopenharmony_ci subsec = kzalloc(sizeof(*subsec), GFP_KERNEL); 49762306a36Sopenharmony_ci if (!subsec) 49862306a36Sopenharmony_ci return -ENOMEM; 49962306a36Sopenharmony_ci subsec->opcode = opcode; 50062306a36Sopenharmony_ci subsec->prio = common_subsec->prio; 50162306a36Sopenharmony_ci subsec->len = subsec_len; 50262306a36Sopenharmony_ci subsec->data = ptr; 50362306a36Sopenharmony_ci btrtl_insert_ordered_subsec(subsec, btrtl_dev); 50462306a36Sopenharmony_ci rc += subsec_len; 50562306a36Sopenharmony_ci } 50662306a36Sopenharmony_ci 50762306a36Sopenharmony_ci return rc; 50862306a36Sopenharmony_ci} 50962306a36Sopenharmony_ci 51062306a36Sopenharmony_cistatic int rtlbt_parse_firmware_v2(struct hci_dev *hdev, 51162306a36Sopenharmony_ci struct btrtl_device_info *btrtl_dev, 51262306a36Sopenharmony_ci unsigned char **_buf) 51362306a36Sopenharmony_ci{ 51462306a36Sopenharmony_ci struct rtl_epatch_header_v2 *hdr; 51562306a36Sopenharmony_ci int rc; 51662306a36Sopenharmony_ci u8 reg_val[2]; 51762306a36Sopenharmony_ci u8 key_id; 51862306a36Sopenharmony_ci u32 num_sections; 51962306a36Sopenharmony_ci struct rtl_section *section; 52062306a36Sopenharmony_ci struct rtl_subsection *entry, *tmp; 52162306a36Sopenharmony_ci u32 section_len; 52262306a36Sopenharmony_ci u32 opcode; 52362306a36Sopenharmony_ci int len = 0; 52462306a36Sopenharmony_ci int i; 52562306a36Sopenharmony_ci u8 *ptr; 52662306a36Sopenharmony_ci struct rtl_iovec iov = { 52762306a36Sopenharmony_ci .data = btrtl_dev->fw_data, 52862306a36Sopenharmony_ci .len = btrtl_dev->fw_len - 7, /* Cut the tail */ 52962306a36Sopenharmony_ci }; 53062306a36Sopenharmony_ci 53162306a36Sopenharmony_ci rc = btrtl_vendor_read_reg16(hdev, RTL_SEC_PROJ, reg_val); 53262306a36Sopenharmony_ci if (rc < 0) 53362306a36Sopenharmony_ci return -EIO; 53462306a36Sopenharmony_ci key_id = reg_val[0]; 53562306a36Sopenharmony_ci 53662306a36Sopenharmony_ci rtl_dev_dbg(hdev, "%s: key id %u", __func__, key_id); 53762306a36Sopenharmony_ci 53862306a36Sopenharmony_ci btrtl_dev->key_id = key_id; 53962306a36Sopenharmony_ci 54062306a36Sopenharmony_ci hdr = rtl_iov_pull_data(&iov, sizeof(*hdr)); 54162306a36Sopenharmony_ci if (!hdr) 54262306a36Sopenharmony_ci return -EINVAL; 54362306a36Sopenharmony_ci num_sections = le32_to_cpu(hdr->num_sections); 54462306a36Sopenharmony_ci 54562306a36Sopenharmony_ci rtl_dev_dbg(hdev, "FW version %08x-%08x", *((u32 *)hdr->fw_version), 54662306a36Sopenharmony_ci *((u32 *)(hdr->fw_version + 4))); 54762306a36Sopenharmony_ci 54862306a36Sopenharmony_ci for (i = 0; i < num_sections; i++) { 54962306a36Sopenharmony_ci section = rtl_iov_pull_data(&iov, sizeof(*section)); 55062306a36Sopenharmony_ci if (!section) 55162306a36Sopenharmony_ci break; 55262306a36Sopenharmony_ci section_len = le32_to_cpu(section->len); 55362306a36Sopenharmony_ci opcode = le32_to_cpu(section->opcode); 55462306a36Sopenharmony_ci 55562306a36Sopenharmony_ci rtl_dev_dbg(hdev, "opcode 0x%04x", section->opcode); 55662306a36Sopenharmony_ci 55762306a36Sopenharmony_ci ptr = rtl_iov_pull_data(&iov, section_len); 55862306a36Sopenharmony_ci if (!ptr) 55962306a36Sopenharmony_ci break; 56062306a36Sopenharmony_ci 56162306a36Sopenharmony_ci switch (opcode) { 56262306a36Sopenharmony_ci case RTL_PATCH_SNIPPETS: 56362306a36Sopenharmony_ci rc = btrtl_parse_section(hdev, btrtl_dev, opcode, 56462306a36Sopenharmony_ci ptr, section_len); 56562306a36Sopenharmony_ci break; 56662306a36Sopenharmony_ci case RTL_PATCH_SECURITY_HEADER: 56762306a36Sopenharmony_ci /* If key_id from chip is zero, ignore all security 56862306a36Sopenharmony_ci * headers. 56962306a36Sopenharmony_ci */ 57062306a36Sopenharmony_ci if (!key_id) 57162306a36Sopenharmony_ci break; 57262306a36Sopenharmony_ci rc = btrtl_parse_section(hdev, btrtl_dev, opcode, 57362306a36Sopenharmony_ci ptr, section_len); 57462306a36Sopenharmony_ci break; 57562306a36Sopenharmony_ci case RTL_PATCH_DUMMY_HEADER: 57662306a36Sopenharmony_ci rc = btrtl_parse_section(hdev, btrtl_dev, opcode, 57762306a36Sopenharmony_ci ptr, section_len); 57862306a36Sopenharmony_ci break; 57962306a36Sopenharmony_ci default: 58062306a36Sopenharmony_ci rc = 0; 58162306a36Sopenharmony_ci break; 58262306a36Sopenharmony_ci } 58362306a36Sopenharmony_ci if (rc < 0) { 58462306a36Sopenharmony_ci rtl_dev_err(hdev, "RTL: Parse section (%u) err %d", 58562306a36Sopenharmony_ci opcode, rc); 58662306a36Sopenharmony_ci return rc; 58762306a36Sopenharmony_ci } 58862306a36Sopenharmony_ci len += rc; 58962306a36Sopenharmony_ci } 59062306a36Sopenharmony_ci 59162306a36Sopenharmony_ci if (!len) 59262306a36Sopenharmony_ci return -ENODATA; 59362306a36Sopenharmony_ci 59462306a36Sopenharmony_ci /* Allocate mem and copy all found subsecs. */ 59562306a36Sopenharmony_ci ptr = kvmalloc(len, GFP_KERNEL); 59662306a36Sopenharmony_ci if (!ptr) 59762306a36Sopenharmony_ci return -ENOMEM; 59862306a36Sopenharmony_ci 59962306a36Sopenharmony_ci len = 0; 60062306a36Sopenharmony_ci list_for_each_entry_safe(entry, tmp, &btrtl_dev->patch_subsecs, list) { 60162306a36Sopenharmony_ci rtl_dev_dbg(hdev, "RTL: opcode %08x, addr %p, len 0x%x", 60262306a36Sopenharmony_ci entry->opcode, entry->data, entry->len); 60362306a36Sopenharmony_ci memcpy(ptr + len, entry->data, entry->len); 60462306a36Sopenharmony_ci len += entry->len; 60562306a36Sopenharmony_ci } 60662306a36Sopenharmony_ci 60762306a36Sopenharmony_ci if (!len) 60862306a36Sopenharmony_ci return -EPERM; 60962306a36Sopenharmony_ci 61062306a36Sopenharmony_ci *_buf = ptr; 61162306a36Sopenharmony_ci return len; 61262306a36Sopenharmony_ci} 61362306a36Sopenharmony_ci 61462306a36Sopenharmony_cistatic int rtlbt_parse_firmware(struct hci_dev *hdev, 61562306a36Sopenharmony_ci struct btrtl_device_info *btrtl_dev, 61662306a36Sopenharmony_ci unsigned char **_buf) 61762306a36Sopenharmony_ci{ 61862306a36Sopenharmony_ci static const u8 extension_sig[] = { 0x51, 0x04, 0xfd, 0x77 }; 61962306a36Sopenharmony_ci struct btrealtek_data *coredump_info = hci_get_priv(hdev); 62062306a36Sopenharmony_ci struct rtl_epatch_header *epatch_info; 62162306a36Sopenharmony_ci unsigned char *buf; 62262306a36Sopenharmony_ci int i, len; 62362306a36Sopenharmony_ci size_t min_size; 62462306a36Sopenharmony_ci u8 opcode, length, data; 62562306a36Sopenharmony_ci int project_id = -1; 62662306a36Sopenharmony_ci const unsigned char *fwptr, *chip_id_base; 62762306a36Sopenharmony_ci const unsigned char *patch_length_base, *patch_offset_base; 62862306a36Sopenharmony_ci u32 patch_offset = 0; 62962306a36Sopenharmony_ci u16 patch_length, num_patches; 63062306a36Sopenharmony_ci static const struct { 63162306a36Sopenharmony_ci __u16 lmp_subver; 63262306a36Sopenharmony_ci __u8 id; 63362306a36Sopenharmony_ci } project_id_to_lmp_subver[] = { 63462306a36Sopenharmony_ci { RTL_ROM_LMP_8723A, 0 }, 63562306a36Sopenharmony_ci { RTL_ROM_LMP_8723B, 1 }, 63662306a36Sopenharmony_ci { RTL_ROM_LMP_8821A, 2 }, 63762306a36Sopenharmony_ci { RTL_ROM_LMP_8761A, 3 }, 63862306a36Sopenharmony_ci { RTL_ROM_LMP_8703B, 7 }, 63962306a36Sopenharmony_ci { RTL_ROM_LMP_8822B, 8 }, 64062306a36Sopenharmony_ci { RTL_ROM_LMP_8723B, 9 }, /* 8723D */ 64162306a36Sopenharmony_ci { RTL_ROM_LMP_8821A, 10 }, /* 8821C */ 64262306a36Sopenharmony_ci { RTL_ROM_LMP_8822B, 13 }, /* 8822C */ 64362306a36Sopenharmony_ci { RTL_ROM_LMP_8761A, 14 }, /* 8761B */ 64462306a36Sopenharmony_ci { RTL_ROM_LMP_8852A, 18 }, /* 8852A */ 64562306a36Sopenharmony_ci { RTL_ROM_LMP_8852A, 20 }, /* 8852B */ 64662306a36Sopenharmony_ci { RTL_ROM_LMP_8852A, 25 }, /* 8852C */ 64762306a36Sopenharmony_ci { RTL_ROM_LMP_8851B, 36 }, /* 8851B */ 64862306a36Sopenharmony_ci }; 64962306a36Sopenharmony_ci 65062306a36Sopenharmony_ci if (btrtl_dev->fw_len <= 8) 65162306a36Sopenharmony_ci return -EINVAL; 65262306a36Sopenharmony_ci 65362306a36Sopenharmony_ci if (!memcmp(btrtl_dev->fw_data, RTL_EPATCH_SIGNATURE, 8)) 65462306a36Sopenharmony_ci min_size = sizeof(struct rtl_epatch_header) + 65562306a36Sopenharmony_ci sizeof(extension_sig) + 3; 65662306a36Sopenharmony_ci else if (!memcmp(btrtl_dev->fw_data, RTL_EPATCH_SIGNATURE_V2, 8)) 65762306a36Sopenharmony_ci min_size = sizeof(struct rtl_epatch_header_v2) + 65862306a36Sopenharmony_ci sizeof(extension_sig) + 3; 65962306a36Sopenharmony_ci else 66062306a36Sopenharmony_ci return -EINVAL; 66162306a36Sopenharmony_ci 66262306a36Sopenharmony_ci if (btrtl_dev->fw_len < min_size) 66362306a36Sopenharmony_ci return -EINVAL; 66462306a36Sopenharmony_ci 66562306a36Sopenharmony_ci fwptr = btrtl_dev->fw_data + btrtl_dev->fw_len - sizeof(extension_sig); 66662306a36Sopenharmony_ci if (memcmp(fwptr, extension_sig, sizeof(extension_sig)) != 0) { 66762306a36Sopenharmony_ci rtl_dev_err(hdev, "extension section signature mismatch"); 66862306a36Sopenharmony_ci return -EINVAL; 66962306a36Sopenharmony_ci } 67062306a36Sopenharmony_ci 67162306a36Sopenharmony_ci /* Loop from the end of the firmware parsing instructions, until 67262306a36Sopenharmony_ci * we find an instruction that identifies the "project ID" for the 67362306a36Sopenharmony_ci * hardware supported by this firwmare file. 67462306a36Sopenharmony_ci * Once we have that, we double-check that project_id is suitable 67562306a36Sopenharmony_ci * for the hardware we are working with. 67662306a36Sopenharmony_ci */ 67762306a36Sopenharmony_ci while (fwptr >= btrtl_dev->fw_data + (sizeof(*epatch_info) + 3)) { 67862306a36Sopenharmony_ci opcode = *--fwptr; 67962306a36Sopenharmony_ci length = *--fwptr; 68062306a36Sopenharmony_ci data = *--fwptr; 68162306a36Sopenharmony_ci 68262306a36Sopenharmony_ci BT_DBG("check op=%x len=%x data=%x", opcode, length, data); 68362306a36Sopenharmony_ci 68462306a36Sopenharmony_ci if (opcode == 0xff) /* EOF */ 68562306a36Sopenharmony_ci break; 68662306a36Sopenharmony_ci 68762306a36Sopenharmony_ci if (length == 0) { 68862306a36Sopenharmony_ci rtl_dev_err(hdev, "found instruction with length 0"); 68962306a36Sopenharmony_ci return -EINVAL; 69062306a36Sopenharmony_ci } 69162306a36Sopenharmony_ci 69262306a36Sopenharmony_ci if (opcode == 0 && length == 1) { 69362306a36Sopenharmony_ci project_id = data; 69462306a36Sopenharmony_ci break; 69562306a36Sopenharmony_ci } 69662306a36Sopenharmony_ci 69762306a36Sopenharmony_ci fwptr -= length; 69862306a36Sopenharmony_ci } 69962306a36Sopenharmony_ci 70062306a36Sopenharmony_ci if (project_id < 0) { 70162306a36Sopenharmony_ci rtl_dev_err(hdev, "failed to find version instruction"); 70262306a36Sopenharmony_ci return -EINVAL; 70362306a36Sopenharmony_ci } 70462306a36Sopenharmony_ci 70562306a36Sopenharmony_ci /* Find project_id in table */ 70662306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(project_id_to_lmp_subver); i++) { 70762306a36Sopenharmony_ci if (project_id == project_id_to_lmp_subver[i].id) { 70862306a36Sopenharmony_ci btrtl_dev->project_id = project_id; 70962306a36Sopenharmony_ci break; 71062306a36Sopenharmony_ci } 71162306a36Sopenharmony_ci } 71262306a36Sopenharmony_ci 71362306a36Sopenharmony_ci if (i >= ARRAY_SIZE(project_id_to_lmp_subver)) { 71462306a36Sopenharmony_ci rtl_dev_err(hdev, "unknown project id %d", project_id); 71562306a36Sopenharmony_ci return -EINVAL; 71662306a36Sopenharmony_ci } 71762306a36Sopenharmony_ci 71862306a36Sopenharmony_ci if (btrtl_dev->ic_info->lmp_subver != 71962306a36Sopenharmony_ci project_id_to_lmp_subver[i].lmp_subver) { 72062306a36Sopenharmony_ci rtl_dev_err(hdev, "firmware is for %x but this is a %x", 72162306a36Sopenharmony_ci project_id_to_lmp_subver[i].lmp_subver, 72262306a36Sopenharmony_ci btrtl_dev->ic_info->lmp_subver); 72362306a36Sopenharmony_ci return -EINVAL; 72462306a36Sopenharmony_ci } 72562306a36Sopenharmony_ci 72662306a36Sopenharmony_ci if (memcmp(btrtl_dev->fw_data, RTL_EPATCH_SIGNATURE, 8) != 0) { 72762306a36Sopenharmony_ci if (!memcmp(btrtl_dev->fw_data, RTL_EPATCH_SIGNATURE_V2, 8)) 72862306a36Sopenharmony_ci return rtlbt_parse_firmware_v2(hdev, btrtl_dev, _buf); 72962306a36Sopenharmony_ci rtl_dev_err(hdev, "bad EPATCH signature"); 73062306a36Sopenharmony_ci return -EINVAL; 73162306a36Sopenharmony_ci } 73262306a36Sopenharmony_ci 73362306a36Sopenharmony_ci epatch_info = (struct rtl_epatch_header *)btrtl_dev->fw_data; 73462306a36Sopenharmony_ci num_patches = le16_to_cpu(epatch_info->num_patches); 73562306a36Sopenharmony_ci 73662306a36Sopenharmony_ci BT_DBG("fw_version=%x, num_patches=%d", 73762306a36Sopenharmony_ci le32_to_cpu(epatch_info->fw_version), num_patches); 73862306a36Sopenharmony_ci coredump_info->rtl_dump.fw_version = le32_to_cpu(epatch_info->fw_version); 73962306a36Sopenharmony_ci 74062306a36Sopenharmony_ci /* After the rtl_epatch_header there is a funky patch metadata section. 74162306a36Sopenharmony_ci * Assuming 2 patches, the layout is: 74262306a36Sopenharmony_ci * ChipID1 ChipID2 PatchLength1 PatchLength2 PatchOffset1 PatchOffset2 74362306a36Sopenharmony_ci * 74462306a36Sopenharmony_ci * Find the right patch for this chip. 74562306a36Sopenharmony_ci */ 74662306a36Sopenharmony_ci min_size += 8 * num_patches; 74762306a36Sopenharmony_ci if (btrtl_dev->fw_len < min_size) 74862306a36Sopenharmony_ci return -EINVAL; 74962306a36Sopenharmony_ci 75062306a36Sopenharmony_ci chip_id_base = btrtl_dev->fw_data + sizeof(struct rtl_epatch_header); 75162306a36Sopenharmony_ci patch_length_base = chip_id_base + (sizeof(u16) * num_patches); 75262306a36Sopenharmony_ci patch_offset_base = patch_length_base + (sizeof(u16) * num_patches); 75362306a36Sopenharmony_ci for (i = 0; i < num_patches; i++) { 75462306a36Sopenharmony_ci u16 chip_id = get_unaligned_le16(chip_id_base + 75562306a36Sopenharmony_ci (i * sizeof(u16))); 75662306a36Sopenharmony_ci if (chip_id == btrtl_dev->rom_version + 1) { 75762306a36Sopenharmony_ci patch_length = get_unaligned_le16(patch_length_base + 75862306a36Sopenharmony_ci (i * sizeof(u16))); 75962306a36Sopenharmony_ci patch_offset = get_unaligned_le32(patch_offset_base + 76062306a36Sopenharmony_ci (i * sizeof(u32))); 76162306a36Sopenharmony_ci break; 76262306a36Sopenharmony_ci } 76362306a36Sopenharmony_ci } 76462306a36Sopenharmony_ci 76562306a36Sopenharmony_ci if (!patch_offset) { 76662306a36Sopenharmony_ci rtl_dev_err(hdev, "didn't find patch for chip id %d", 76762306a36Sopenharmony_ci btrtl_dev->rom_version); 76862306a36Sopenharmony_ci return -EINVAL; 76962306a36Sopenharmony_ci } 77062306a36Sopenharmony_ci 77162306a36Sopenharmony_ci BT_DBG("length=%x offset=%x index %d", patch_length, patch_offset, i); 77262306a36Sopenharmony_ci min_size = patch_offset + patch_length; 77362306a36Sopenharmony_ci if (btrtl_dev->fw_len < min_size) 77462306a36Sopenharmony_ci return -EINVAL; 77562306a36Sopenharmony_ci 77662306a36Sopenharmony_ci /* Copy the firmware into a new buffer and write the version at 77762306a36Sopenharmony_ci * the end. 77862306a36Sopenharmony_ci */ 77962306a36Sopenharmony_ci len = patch_length; 78062306a36Sopenharmony_ci buf = kvmalloc(patch_length, GFP_KERNEL); 78162306a36Sopenharmony_ci if (!buf) 78262306a36Sopenharmony_ci return -ENOMEM; 78362306a36Sopenharmony_ci 78462306a36Sopenharmony_ci memcpy(buf, btrtl_dev->fw_data + patch_offset, patch_length - 4); 78562306a36Sopenharmony_ci memcpy(buf + patch_length - 4, &epatch_info->fw_version, 4); 78662306a36Sopenharmony_ci 78762306a36Sopenharmony_ci *_buf = buf; 78862306a36Sopenharmony_ci return len; 78962306a36Sopenharmony_ci} 79062306a36Sopenharmony_ci 79162306a36Sopenharmony_cistatic int rtl_download_firmware(struct hci_dev *hdev, 79262306a36Sopenharmony_ci const unsigned char *data, int fw_len) 79362306a36Sopenharmony_ci{ 79462306a36Sopenharmony_ci struct rtl_download_cmd *dl_cmd; 79562306a36Sopenharmony_ci int frag_num = fw_len / RTL_FRAG_LEN + 1; 79662306a36Sopenharmony_ci int frag_len = RTL_FRAG_LEN; 79762306a36Sopenharmony_ci int ret = 0; 79862306a36Sopenharmony_ci int i; 79962306a36Sopenharmony_ci int j = 0; 80062306a36Sopenharmony_ci struct sk_buff *skb; 80162306a36Sopenharmony_ci struct hci_rp_read_local_version *rp; 80262306a36Sopenharmony_ci 80362306a36Sopenharmony_ci dl_cmd = kmalloc(sizeof(struct rtl_download_cmd), GFP_KERNEL); 80462306a36Sopenharmony_ci if (!dl_cmd) 80562306a36Sopenharmony_ci return -ENOMEM; 80662306a36Sopenharmony_ci 80762306a36Sopenharmony_ci for (i = 0; i < frag_num; i++) { 80862306a36Sopenharmony_ci struct sk_buff *skb; 80962306a36Sopenharmony_ci 81062306a36Sopenharmony_ci dl_cmd->index = j++; 81162306a36Sopenharmony_ci if (dl_cmd->index == 0x7f) 81262306a36Sopenharmony_ci j = 1; 81362306a36Sopenharmony_ci 81462306a36Sopenharmony_ci if (i == (frag_num - 1)) { 81562306a36Sopenharmony_ci dl_cmd->index |= 0x80; /* data end */ 81662306a36Sopenharmony_ci frag_len = fw_len % RTL_FRAG_LEN; 81762306a36Sopenharmony_ci } 81862306a36Sopenharmony_ci rtl_dev_dbg(hdev, "download fw (%d/%d). index = %d", i, 81962306a36Sopenharmony_ci frag_num, dl_cmd->index); 82062306a36Sopenharmony_ci memcpy(dl_cmd->data, data, frag_len); 82162306a36Sopenharmony_ci 82262306a36Sopenharmony_ci /* Send download command */ 82362306a36Sopenharmony_ci skb = __hci_cmd_sync(hdev, 0xfc20, frag_len + 1, dl_cmd, 82462306a36Sopenharmony_ci HCI_INIT_TIMEOUT); 82562306a36Sopenharmony_ci if (IS_ERR(skb)) { 82662306a36Sopenharmony_ci rtl_dev_err(hdev, "download fw command failed (%ld)", 82762306a36Sopenharmony_ci PTR_ERR(skb)); 82862306a36Sopenharmony_ci ret = PTR_ERR(skb); 82962306a36Sopenharmony_ci goto out; 83062306a36Sopenharmony_ci } 83162306a36Sopenharmony_ci 83262306a36Sopenharmony_ci if (skb->len != sizeof(struct rtl_download_response)) { 83362306a36Sopenharmony_ci rtl_dev_err(hdev, "download fw event length mismatch"); 83462306a36Sopenharmony_ci kfree_skb(skb); 83562306a36Sopenharmony_ci ret = -EIO; 83662306a36Sopenharmony_ci goto out; 83762306a36Sopenharmony_ci } 83862306a36Sopenharmony_ci 83962306a36Sopenharmony_ci kfree_skb(skb); 84062306a36Sopenharmony_ci data += RTL_FRAG_LEN; 84162306a36Sopenharmony_ci } 84262306a36Sopenharmony_ci 84362306a36Sopenharmony_ci skb = btrtl_read_local_version(hdev); 84462306a36Sopenharmony_ci if (IS_ERR(skb)) { 84562306a36Sopenharmony_ci ret = PTR_ERR(skb); 84662306a36Sopenharmony_ci rtl_dev_err(hdev, "read local version failed"); 84762306a36Sopenharmony_ci goto out; 84862306a36Sopenharmony_ci } 84962306a36Sopenharmony_ci 85062306a36Sopenharmony_ci rp = (struct hci_rp_read_local_version *)skb->data; 85162306a36Sopenharmony_ci rtl_dev_info(hdev, "fw version 0x%04x%04x", 85262306a36Sopenharmony_ci __le16_to_cpu(rp->hci_rev), __le16_to_cpu(rp->lmp_subver)); 85362306a36Sopenharmony_ci kfree_skb(skb); 85462306a36Sopenharmony_ci 85562306a36Sopenharmony_ciout: 85662306a36Sopenharmony_ci kfree(dl_cmd); 85762306a36Sopenharmony_ci return ret; 85862306a36Sopenharmony_ci} 85962306a36Sopenharmony_ci 86062306a36Sopenharmony_cistatic int rtl_load_file(struct hci_dev *hdev, const char *name, u8 **buff) 86162306a36Sopenharmony_ci{ 86262306a36Sopenharmony_ci const struct firmware *fw; 86362306a36Sopenharmony_ci int ret; 86462306a36Sopenharmony_ci 86562306a36Sopenharmony_ci rtl_dev_info(hdev, "loading %s", name); 86662306a36Sopenharmony_ci ret = request_firmware(&fw, name, &hdev->dev); 86762306a36Sopenharmony_ci if (ret < 0) 86862306a36Sopenharmony_ci return ret; 86962306a36Sopenharmony_ci ret = fw->size; 87062306a36Sopenharmony_ci *buff = kvmalloc(fw->size, GFP_KERNEL); 87162306a36Sopenharmony_ci if (*buff) 87262306a36Sopenharmony_ci memcpy(*buff, fw->data, ret); 87362306a36Sopenharmony_ci else 87462306a36Sopenharmony_ci ret = -ENOMEM; 87562306a36Sopenharmony_ci 87662306a36Sopenharmony_ci release_firmware(fw); 87762306a36Sopenharmony_ci 87862306a36Sopenharmony_ci return ret; 87962306a36Sopenharmony_ci} 88062306a36Sopenharmony_ci 88162306a36Sopenharmony_cistatic int btrtl_setup_rtl8723a(struct hci_dev *hdev, 88262306a36Sopenharmony_ci struct btrtl_device_info *btrtl_dev) 88362306a36Sopenharmony_ci{ 88462306a36Sopenharmony_ci if (btrtl_dev->fw_len < 8) 88562306a36Sopenharmony_ci return -EINVAL; 88662306a36Sopenharmony_ci 88762306a36Sopenharmony_ci /* Check that the firmware doesn't have the epatch signature 88862306a36Sopenharmony_ci * (which is only for RTL8723B and newer). 88962306a36Sopenharmony_ci */ 89062306a36Sopenharmony_ci if (!memcmp(btrtl_dev->fw_data, RTL_EPATCH_SIGNATURE, 8)) { 89162306a36Sopenharmony_ci rtl_dev_err(hdev, "unexpected EPATCH signature!"); 89262306a36Sopenharmony_ci return -EINVAL; 89362306a36Sopenharmony_ci } 89462306a36Sopenharmony_ci 89562306a36Sopenharmony_ci return rtl_download_firmware(hdev, btrtl_dev->fw_data, 89662306a36Sopenharmony_ci btrtl_dev->fw_len); 89762306a36Sopenharmony_ci} 89862306a36Sopenharmony_ci 89962306a36Sopenharmony_cistatic int btrtl_setup_rtl8723b(struct hci_dev *hdev, 90062306a36Sopenharmony_ci struct btrtl_device_info *btrtl_dev) 90162306a36Sopenharmony_ci{ 90262306a36Sopenharmony_ci unsigned char *fw_data = NULL; 90362306a36Sopenharmony_ci int ret; 90462306a36Sopenharmony_ci u8 *tbuff; 90562306a36Sopenharmony_ci 90662306a36Sopenharmony_ci ret = rtlbt_parse_firmware(hdev, btrtl_dev, &fw_data); 90762306a36Sopenharmony_ci if (ret < 0) 90862306a36Sopenharmony_ci goto out; 90962306a36Sopenharmony_ci 91062306a36Sopenharmony_ci if (btrtl_dev->cfg_len > 0) { 91162306a36Sopenharmony_ci tbuff = kvzalloc(ret + btrtl_dev->cfg_len, GFP_KERNEL); 91262306a36Sopenharmony_ci if (!tbuff) { 91362306a36Sopenharmony_ci ret = -ENOMEM; 91462306a36Sopenharmony_ci goto out; 91562306a36Sopenharmony_ci } 91662306a36Sopenharmony_ci 91762306a36Sopenharmony_ci memcpy(tbuff, fw_data, ret); 91862306a36Sopenharmony_ci kvfree(fw_data); 91962306a36Sopenharmony_ci 92062306a36Sopenharmony_ci memcpy(tbuff + ret, btrtl_dev->cfg_data, btrtl_dev->cfg_len); 92162306a36Sopenharmony_ci ret += btrtl_dev->cfg_len; 92262306a36Sopenharmony_ci 92362306a36Sopenharmony_ci fw_data = tbuff; 92462306a36Sopenharmony_ci } 92562306a36Sopenharmony_ci 92662306a36Sopenharmony_ci rtl_dev_info(hdev, "cfg_sz %d, total sz %d", btrtl_dev->cfg_len, ret); 92762306a36Sopenharmony_ci 92862306a36Sopenharmony_ci ret = rtl_download_firmware(hdev, fw_data, ret); 92962306a36Sopenharmony_ci 93062306a36Sopenharmony_ciout: 93162306a36Sopenharmony_ci kvfree(fw_data); 93262306a36Sopenharmony_ci return ret; 93362306a36Sopenharmony_ci} 93462306a36Sopenharmony_ci 93562306a36Sopenharmony_cistatic void btrtl_coredump(struct hci_dev *hdev) 93662306a36Sopenharmony_ci{ 93762306a36Sopenharmony_ci static const u8 param[] = { 0x00, 0x00 }; 93862306a36Sopenharmony_ci 93962306a36Sopenharmony_ci __hci_cmd_send(hdev, RTL_VSC_OP_COREDUMP, sizeof(param), param); 94062306a36Sopenharmony_ci} 94162306a36Sopenharmony_ci 94262306a36Sopenharmony_cistatic void btrtl_dmp_hdr(struct hci_dev *hdev, struct sk_buff *skb) 94362306a36Sopenharmony_ci{ 94462306a36Sopenharmony_ci struct btrealtek_data *coredump_info = hci_get_priv(hdev); 94562306a36Sopenharmony_ci char buf[80]; 94662306a36Sopenharmony_ci 94762306a36Sopenharmony_ci if (coredump_info->rtl_dump.controller) 94862306a36Sopenharmony_ci snprintf(buf, sizeof(buf), "Controller Name: %s\n", 94962306a36Sopenharmony_ci coredump_info->rtl_dump.controller); 95062306a36Sopenharmony_ci else 95162306a36Sopenharmony_ci snprintf(buf, sizeof(buf), "Controller Name: Unknown\n"); 95262306a36Sopenharmony_ci skb_put_data(skb, buf, strlen(buf)); 95362306a36Sopenharmony_ci 95462306a36Sopenharmony_ci snprintf(buf, sizeof(buf), "Firmware Version: 0x%X\n", 95562306a36Sopenharmony_ci coredump_info->rtl_dump.fw_version); 95662306a36Sopenharmony_ci skb_put_data(skb, buf, strlen(buf)); 95762306a36Sopenharmony_ci 95862306a36Sopenharmony_ci snprintf(buf, sizeof(buf), "Driver: %s\n", coredump_info->rtl_dump.driver_name); 95962306a36Sopenharmony_ci skb_put_data(skb, buf, strlen(buf)); 96062306a36Sopenharmony_ci 96162306a36Sopenharmony_ci snprintf(buf, sizeof(buf), "Vendor: Realtek\n"); 96262306a36Sopenharmony_ci skb_put_data(skb, buf, strlen(buf)); 96362306a36Sopenharmony_ci} 96462306a36Sopenharmony_ci 96562306a36Sopenharmony_cistatic void btrtl_register_devcoredump_support(struct hci_dev *hdev) 96662306a36Sopenharmony_ci{ 96762306a36Sopenharmony_ci hci_devcd_register(hdev, btrtl_coredump, btrtl_dmp_hdr, NULL); 96862306a36Sopenharmony_ci 96962306a36Sopenharmony_ci} 97062306a36Sopenharmony_ci 97162306a36Sopenharmony_civoid btrtl_set_driver_name(struct hci_dev *hdev, const char *driver_name) 97262306a36Sopenharmony_ci{ 97362306a36Sopenharmony_ci struct btrealtek_data *coredump_info = hci_get_priv(hdev); 97462306a36Sopenharmony_ci 97562306a36Sopenharmony_ci coredump_info->rtl_dump.driver_name = driver_name; 97662306a36Sopenharmony_ci} 97762306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(btrtl_set_driver_name); 97862306a36Sopenharmony_ci 97962306a36Sopenharmony_cistatic bool rtl_has_chip_type(u16 lmp_subver) 98062306a36Sopenharmony_ci{ 98162306a36Sopenharmony_ci switch (lmp_subver) { 98262306a36Sopenharmony_ci case RTL_ROM_LMP_8703B: 98362306a36Sopenharmony_ci return true; 98462306a36Sopenharmony_ci default: 98562306a36Sopenharmony_ci break; 98662306a36Sopenharmony_ci } 98762306a36Sopenharmony_ci 98862306a36Sopenharmony_ci return false; 98962306a36Sopenharmony_ci} 99062306a36Sopenharmony_ci 99162306a36Sopenharmony_cistatic int rtl_read_chip_type(struct hci_dev *hdev, u8 *type) 99262306a36Sopenharmony_ci{ 99362306a36Sopenharmony_ci struct rtl_chip_type_evt *chip_type; 99462306a36Sopenharmony_ci struct sk_buff *skb; 99562306a36Sopenharmony_ci const unsigned char cmd_buf[] = {0x00, 0x94, 0xa0, 0x00, 0xb0}; 99662306a36Sopenharmony_ci 99762306a36Sopenharmony_ci /* Read RTL chip type command */ 99862306a36Sopenharmony_ci skb = __hci_cmd_sync(hdev, 0xfc61, 5, cmd_buf, HCI_INIT_TIMEOUT); 99962306a36Sopenharmony_ci if (IS_ERR(skb)) { 100062306a36Sopenharmony_ci rtl_dev_err(hdev, "Read chip type failed (%ld)", 100162306a36Sopenharmony_ci PTR_ERR(skb)); 100262306a36Sopenharmony_ci return PTR_ERR(skb); 100362306a36Sopenharmony_ci } 100462306a36Sopenharmony_ci 100562306a36Sopenharmony_ci chip_type = skb_pull_data(skb, sizeof(*chip_type)); 100662306a36Sopenharmony_ci if (!chip_type) { 100762306a36Sopenharmony_ci rtl_dev_err(hdev, "RTL chip type event length mismatch"); 100862306a36Sopenharmony_ci kfree_skb(skb); 100962306a36Sopenharmony_ci return -EIO; 101062306a36Sopenharmony_ci } 101162306a36Sopenharmony_ci 101262306a36Sopenharmony_ci rtl_dev_info(hdev, "chip_type status=%x type=%x", 101362306a36Sopenharmony_ci chip_type->status, chip_type->type); 101462306a36Sopenharmony_ci 101562306a36Sopenharmony_ci *type = chip_type->type & 0x0f; 101662306a36Sopenharmony_ci 101762306a36Sopenharmony_ci kfree_skb(skb); 101862306a36Sopenharmony_ci return 0; 101962306a36Sopenharmony_ci} 102062306a36Sopenharmony_ci 102162306a36Sopenharmony_civoid btrtl_free(struct btrtl_device_info *btrtl_dev) 102262306a36Sopenharmony_ci{ 102362306a36Sopenharmony_ci struct rtl_subsection *entry, *tmp; 102462306a36Sopenharmony_ci 102562306a36Sopenharmony_ci kvfree(btrtl_dev->fw_data); 102662306a36Sopenharmony_ci kvfree(btrtl_dev->cfg_data); 102762306a36Sopenharmony_ci 102862306a36Sopenharmony_ci list_for_each_entry_safe(entry, tmp, &btrtl_dev->patch_subsecs, list) { 102962306a36Sopenharmony_ci list_del(&entry->list); 103062306a36Sopenharmony_ci kfree(entry); 103162306a36Sopenharmony_ci } 103262306a36Sopenharmony_ci 103362306a36Sopenharmony_ci kfree(btrtl_dev); 103462306a36Sopenharmony_ci} 103562306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(btrtl_free); 103662306a36Sopenharmony_ci 103762306a36Sopenharmony_cistruct btrtl_device_info *btrtl_initialize(struct hci_dev *hdev, 103862306a36Sopenharmony_ci const char *postfix) 103962306a36Sopenharmony_ci{ 104062306a36Sopenharmony_ci struct btrealtek_data *coredump_info = hci_get_priv(hdev); 104162306a36Sopenharmony_ci struct btrtl_device_info *btrtl_dev; 104262306a36Sopenharmony_ci struct sk_buff *skb; 104362306a36Sopenharmony_ci struct hci_rp_read_local_version *resp; 104462306a36Sopenharmony_ci struct hci_command_hdr *cmd; 104562306a36Sopenharmony_ci char fw_name[40]; 104662306a36Sopenharmony_ci char cfg_name[40]; 104762306a36Sopenharmony_ci u16 hci_rev, lmp_subver; 104862306a36Sopenharmony_ci u8 hci_ver, lmp_ver, chip_type = 0; 104962306a36Sopenharmony_ci int ret; 105062306a36Sopenharmony_ci u8 reg_val[2]; 105162306a36Sopenharmony_ci 105262306a36Sopenharmony_ci btrtl_dev = kzalloc(sizeof(*btrtl_dev), GFP_KERNEL); 105362306a36Sopenharmony_ci if (!btrtl_dev) { 105462306a36Sopenharmony_ci ret = -ENOMEM; 105562306a36Sopenharmony_ci goto err_alloc; 105662306a36Sopenharmony_ci } 105762306a36Sopenharmony_ci 105862306a36Sopenharmony_ci INIT_LIST_HEAD(&btrtl_dev->patch_subsecs); 105962306a36Sopenharmony_ci 106062306a36Sopenharmony_cicheck_version: 106162306a36Sopenharmony_ci ret = btrtl_vendor_read_reg16(hdev, RTL_CHIP_SUBVER, reg_val); 106262306a36Sopenharmony_ci if (ret < 0) 106362306a36Sopenharmony_ci goto err_free; 106462306a36Sopenharmony_ci lmp_subver = get_unaligned_le16(reg_val); 106562306a36Sopenharmony_ci 106662306a36Sopenharmony_ci if (lmp_subver == RTL_ROM_LMP_8822B) { 106762306a36Sopenharmony_ci ret = btrtl_vendor_read_reg16(hdev, RTL_CHIP_REV, reg_val); 106862306a36Sopenharmony_ci if (ret < 0) 106962306a36Sopenharmony_ci goto err_free; 107062306a36Sopenharmony_ci hci_rev = get_unaligned_le16(reg_val); 107162306a36Sopenharmony_ci 107262306a36Sopenharmony_ci /* 8822E */ 107362306a36Sopenharmony_ci if (hci_rev == 0x000e) { 107462306a36Sopenharmony_ci hci_ver = 0x0c; 107562306a36Sopenharmony_ci lmp_ver = 0x0c; 107662306a36Sopenharmony_ci btrtl_dev->ic_info = btrtl_match_ic(lmp_subver, hci_rev, 107762306a36Sopenharmony_ci hci_ver, hdev->bus, 107862306a36Sopenharmony_ci chip_type); 107962306a36Sopenharmony_ci goto next; 108062306a36Sopenharmony_ci } 108162306a36Sopenharmony_ci } 108262306a36Sopenharmony_ci 108362306a36Sopenharmony_ci skb = btrtl_read_local_version(hdev); 108462306a36Sopenharmony_ci if (IS_ERR(skb)) { 108562306a36Sopenharmony_ci ret = PTR_ERR(skb); 108662306a36Sopenharmony_ci goto err_free; 108762306a36Sopenharmony_ci } 108862306a36Sopenharmony_ci 108962306a36Sopenharmony_ci resp = (struct hci_rp_read_local_version *)skb->data; 109062306a36Sopenharmony_ci 109162306a36Sopenharmony_ci hci_ver = resp->hci_ver; 109262306a36Sopenharmony_ci hci_rev = le16_to_cpu(resp->hci_rev); 109362306a36Sopenharmony_ci lmp_ver = resp->lmp_ver; 109462306a36Sopenharmony_ci lmp_subver = le16_to_cpu(resp->lmp_subver); 109562306a36Sopenharmony_ci 109662306a36Sopenharmony_ci kfree_skb(skb); 109762306a36Sopenharmony_ci 109862306a36Sopenharmony_ci if (rtl_has_chip_type(lmp_subver)) { 109962306a36Sopenharmony_ci ret = rtl_read_chip_type(hdev, &chip_type); 110062306a36Sopenharmony_ci if (ret) 110162306a36Sopenharmony_ci goto err_free; 110262306a36Sopenharmony_ci } 110362306a36Sopenharmony_ci 110462306a36Sopenharmony_ci btrtl_dev->ic_info = btrtl_match_ic(lmp_subver, hci_rev, hci_ver, 110562306a36Sopenharmony_ci hdev->bus, chip_type); 110662306a36Sopenharmony_ci 110762306a36Sopenharmony_cinext: 110862306a36Sopenharmony_ci rtl_dev_info(hdev, "examining hci_ver=%02x hci_rev=%04x lmp_ver=%02x lmp_subver=%04x", 110962306a36Sopenharmony_ci hci_ver, hci_rev, 111062306a36Sopenharmony_ci lmp_ver, lmp_subver); 111162306a36Sopenharmony_ci 111262306a36Sopenharmony_ci if (!btrtl_dev->ic_info && !btrtl_dev->drop_fw) 111362306a36Sopenharmony_ci btrtl_dev->drop_fw = true; 111462306a36Sopenharmony_ci else 111562306a36Sopenharmony_ci btrtl_dev->drop_fw = false; 111662306a36Sopenharmony_ci 111762306a36Sopenharmony_ci if (btrtl_dev->drop_fw) { 111862306a36Sopenharmony_ci skb = bt_skb_alloc(sizeof(*cmd), GFP_KERNEL); 111962306a36Sopenharmony_ci if (!skb) 112062306a36Sopenharmony_ci goto err_free; 112162306a36Sopenharmony_ci 112262306a36Sopenharmony_ci cmd = skb_put(skb, HCI_COMMAND_HDR_SIZE); 112362306a36Sopenharmony_ci cmd->opcode = cpu_to_le16(0xfc66); 112462306a36Sopenharmony_ci cmd->plen = 0; 112562306a36Sopenharmony_ci 112662306a36Sopenharmony_ci hci_skb_pkt_type(skb) = HCI_COMMAND_PKT; 112762306a36Sopenharmony_ci 112862306a36Sopenharmony_ci ret = hdev->send(hdev, skb); 112962306a36Sopenharmony_ci if (ret < 0) { 113062306a36Sopenharmony_ci bt_dev_err(hdev, "sending frame failed (%d)", ret); 113162306a36Sopenharmony_ci kfree_skb(skb); 113262306a36Sopenharmony_ci goto err_free; 113362306a36Sopenharmony_ci } 113462306a36Sopenharmony_ci 113562306a36Sopenharmony_ci /* Ensure the above vendor command is sent to controller and 113662306a36Sopenharmony_ci * process has done. 113762306a36Sopenharmony_ci */ 113862306a36Sopenharmony_ci msleep(200); 113962306a36Sopenharmony_ci 114062306a36Sopenharmony_ci goto check_version; 114162306a36Sopenharmony_ci } 114262306a36Sopenharmony_ci 114362306a36Sopenharmony_ci if (!btrtl_dev->ic_info) { 114462306a36Sopenharmony_ci rtl_dev_info(hdev, "unknown IC info, lmp subver %04x, hci rev %04x, hci ver %04x", 114562306a36Sopenharmony_ci lmp_subver, hci_rev, hci_ver); 114662306a36Sopenharmony_ci return btrtl_dev; 114762306a36Sopenharmony_ci } 114862306a36Sopenharmony_ci 114962306a36Sopenharmony_ci if (btrtl_dev->ic_info->has_rom_version) { 115062306a36Sopenharmony_ci ret = rtl_read_rom_version(hdev, &btrtl_dev->rom_version); 115162306a36Sopenharmony_ci if (ret) 115262306a36Sopenharmony_ci goto err_free; 115362306a36Sopenharmony_ci } 115462306a36Sopenharmony_ci 115562306a36Sopenharmony_ci if (!btrtl_dev->ic_info->fw_name) { 115662306a36Sopenharmony_ci ret = -ENOMEM; 115762306a36Sopenharmony_ci goto err_free; 115862306a36Sopenharmony_ci } 115962306a36Sopenharmony_ci 116062306a36Sopenharmony_ci btrtl_dev->fw_len = -EIO; 116162306a36Sopenharmony_ci if (lmp_subver == RTL_ROM_LMP_8852A && hci_rev == 0x000c) { 116262306a36Sopenharmony_ci snprintf(fw_name, sizeof(fw_name), "%s_v2.bin", 116362306a36Sopenharmony_ci btrtl_dev->ic_info->fw_name); 116462306a36Sopenharmony_ci btrtl_dev->fw_len = rtl_load_file(hdev, fw_name, 116562306a36Sopenharmony_ci &btrtl_dev->fw_data); 116662306a36Sopenharmony_ci } 116762306a36Sopenharmony_ci 116862306a36Sopenharmony_ci if (btrtl_dev->fw_len < 0) { 116962306a36Sopenharmony_ci snprintf(fw_name, sizeof(fw_name), "%s.bin", 117062306a36Sopenharmony_ci btrtl_dev->ic_info->fw_name); 117162306a36Sopenharmony_ci btrtl_dev->fw_len = rtl_load_file(hdev, fw_name, 117262306a36Sopenharmony_ci &btrtl_dev->fw_data); 117362306a36Sopenharmony_ci } 117462306a36Sopenharmony_ci 117562306a36Sopenharmony_ci if (btrtl_dev->fw_len < 0) { 117662306a36Sopenharmony_ci rtl_dev_err(hdev, "firmware file %s not found", 117762306a36Sopenharmony_ci btrtl_dev->ic_info->fw_name); 117862306a36Sopenharmony_ci ret = btrtl_dev->fw_len; 117962306a36Sopenharmony_ci goto err_free; 118062306a36Sopenharmony_ci } 118162306a36Sopenharmony_ci 118262306a36Sopenharmony_ci if (btrtl_dev->ic_info->cfg_name) { 118362306a36Sopenharmony_ci if (postfix) { 118462306a36Sopenharmony_ci snprintf(cfg_name, sizeof(cfg_name), "%s-%s.bin", 118562306a36Sopenharmony_ci btrtl_dev->ic_info->cfg_name, postfix); 118662306a36Sopenharmony_ci } else { 118762306a36Sopenharmony_ci snprintf(cfg_name, sizeof(cfg_name), "%s.bin", 118862306a36Sopenharmony_ci btrtl_dev->ic_info->cfg_name); 118962306a36Sopenharmony_ci } 119062306a36Sopenharmony_ci btrtl_dev->cfg_len = rtl_load_file(hdev, cfg_name, 119162306a36Sopenharmony_ci &btrtl_dev->cfg_data); 119262306a36Sopenharmony_ci if (btrtl_dev->ic_info->config_needed && 119362306a36Sopenharmony_ci btrtl_dev->cfg_len <= 0) { 119462306a36Sopenharmony_ci rtl_dev_err(hdev, "mandatory config file %s not found", 119562306a36Sopenharmony_ci btrtl_dev->ic_info->cfg_name); 119662306a36Sopenharmony_ci ret = btrtl_dev->cfg_len; 119762306a36Sopenharmony_ci goto err_free; 119862306a36Sopenharmony_ci } 119962306a36Sopenharmony_ci } 120062306a36Sopenharmony_ci 120162306a36Sopenharmony_ci /* The following chips supports the Microsoft vendor extension, 120262306a36Sopenharmony_ci * therefore set the corresponding VsMsftOpCode. 120362306a36Sopenharmony_ci */ 120462306a36Sopenharmony_ci if (btrtl_dev->ic_info->has_msft_ext) 120562306a36Sopenharmony_ci hci_set_msft_opcode(hdev, 0xFCF0); 120662306a36Sopenharmony_ci 120762306a36Sopenharmony_ci if (btrtl_dev->ic_info) 120862306a36Sopenharmony_ci coredump_info->rtl_dump.controller = btrtl_dev->ic_info->hw_info; 120962306a36Sopenharmony_ci 121062306a36Sopenharmony_ci return btrtl_dev; 121162306a36Sopenharmony_ci 121262306a36Sopenharmony_cierr_free: 121362306a36Sopenharmony_ci btrtl_free(btrtl_dev); 121462306a36Sopenharmony_cierr_alloc: 121562306a36Sopenharmony_ci return ERR_PTR(ret); 121662306a36Sopenharmony_ci} 121762306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(btrtl_initialize); 121862306a36Sopenharmony_ci 121962306a36Sopenharmony_ciint btrtl_download_firmware(struct hci_dev *hdev, 122062306a36Sopenharmony_ci struct btrtl_device_info *btrtl_dev) 122162306a36Sopenharmony_ci{ 122262306a36Sopenharmony_ci int err = 0; 122362306a36Sopenharmony_ci 122462306a36Sopenharmony_ci /* Match a set of subver values that correspond to stock firmware, 122562306a36Sopenharmony_ci * which is not compatible with standard btusb. 122662306a36Sopenharmony_ci * If matched, upload an alternative firmware that does conform to 122762306a36Sopenharmony_ci * standard btusb. Once that firmware is uploaded, the subver changes 122862306a36Sopenharmony_ci * to a different value. 122962306a36Sopenharmony_ci */ 123062306a36Sopenharmony_ci if (!btrtl_dev->ic_info) { 123162306a36Sopenharmony_ci rtl_dev_info(hdev, "assuming no firmware upload needed"); 123262306a36Sopenharmony_ci err = 0; 123362306a36Sopenharmony_ci goto done; 123462306a36Sopenharmony_ci } 123562306a36Sopenharmony_ci 123662306a36Sopenharmony_ci switch (btrtl_dev->ic_info->lmp_subver) { 123762306a36Sopenharmony_ci case RTL_ROM_LMP_8723A: 123862306a36Sopenharmony_ci err = btrtl_setup_rtl8723a(hdev, btrtl_dev); 123962306a36Sopenharmony_ci break; 124062306a36Sopenharmony_ci case RTL_ROM_LMP_8723B: 124162306a36Sopenharmony_ci case RTL_ROM_LMP_8821A: 124262306a36Sopenharmony_ci case RTL_ROM_LMP_8761A: 124362306a36Sopenharmony_ci case RTL_ROM_LMP_8822B: 124462306a36Sopenharmony_ci case RTL_ROM_LMP_8852A: 124562306a36Sopenharmony_ci case RTL_ROM_LMP_8703B: 124662306a36Sopenharmony_ci case RTL_ROM_LMP_8851B: 124762306a36Sopenharmony_ci err = btrtl_setup_rtl8723b(hdev, btrtl_dev); 124862306a36Sopenharmony_ci break; 124962306a36Sopenharmony_ci default: 125062306a36Sopenharmony_ci rtl_dev_info(hdev, "assuming no firmware upload needed"); 125162306a36Sopenharmony_ci break; 125262306a36Sopenharmony_ci } 125362306a36Sopenharmony_ci 125462306a36Sopenharmony_cidone: 125562306a36Sopenharmony_ci btrtl_register_devcoredump_support(hdev); 125662306a36Sopenharmony_ci 125762306a36Sopenharmony_ci return err; 125862306a36Sopenharmony_ci} 125962306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(btrtl_download_firmware); 126062306a36Sopenharmony_ci 126162306a36Sopenharmony_civoid btrtl_set_quirks(struct hci_dev *hdev, struct btrtl_device_info *btrtl_dev) 126262306a36Sopenharmony_ci{ 126362306a36Sopenharmony_ci /* Enable controller to do both LE scan and BR/EDR inquiry 126462306a36Sopenharmony_ci * simultaneously. 126562306a36Sopenharmony_ci */ 126662306a36Sopenharmony_ci set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks); 126762306a36Sopenharmony_ci 126862306a36Sopenharmony_ci /* Enable central-peripheral role (able to create new connections with 126962306a36Sopenharmony_ci * an existing connection in slave role). 127062306a36Sopenharmony_ci */ 127162306a36Sopenharmony_ci /* Enable WBS supported for the specific Realtek devices. */ 127262306a36Sopenharmony_ci switch (btrtl_dev->project_id) { 127362306a36Sopenharmony_ci case CHIP_ID_8822C: 127462306a36Sopenharmony_ci case CHIP_ID_8852A: 127562306a36Sopenharmony_ci case CHIP_ID_8852B: 127662306a36Sopenharmony_ci case CHIP_ID_8852C: 127762306a36Sopenharmony_ci case CHIP_ID_8851B: 127862306a36Sopenharmony_ci set_bit(HCI_QUIRK_VALID_LE_STATES, &hdev->quirks); 127962306a36Sopenharmony_ci set_bit(HCI_QUIRK_WIDEBAND_SPEECH_SUPPORTED, &hdev->quirks); 128062306a36Sopenharmony_ci 128162306a36Sopenharmony_ci /* RTL8852C needs to transmit mSBC data continuously without 128262306a36Sopenharmony_ci * the zero length of USB packets for the ALT 6 supported chips 128362306a36Sopenharmony_ci */ 128462306a36Sopenharmony_ci if (btrtl_dev->project_id == CHIP_ID_8852C) 128562306a36Sopenharmony_ci btrealtek_set_flag(hdev, REALTEK_ALT6_CONTINUOUS_TX_CHIP); 128662306a36Sopenharmony_ci 128762306a36Sopenharmony_ci if (btrtl_dev->project_id == CHIP_ID_8852A || 128862306a36Sopenharmony_ci btrtl_dev->project_id == CHIP_ID_8852C) 128962306a36Sopenharmony_ci set_bit(HCI_QUIRK_USE_MSFT_EXT_ADDRESS_FILTER, &hdev->quirks); 129062306a36Sopenharmony_ci 129162306a36Sopenharmony_ci hci_set_aosp_capable(hdev); 129262306a36Sopenharmony_ci break; 129362306a36Sopenharmony_ci default: 129462306a36Sopenharmony_ci rtl_dev_dbg(hdev, "Central-peripheral role not enabled."); 129562306a36Sopenharmony_ci rtl_dev_dbg(hdev, "WBS supported not enabled."); 129662306a36Sopenharmony_ci break; 129762306a36Sopenharmony_ci } 129862306a36Sopenharmony_ci 129962306a36Sopenharmony_ci if (!btrtl_dev->ic_info) 130062306a36Sopenharmony_ci return; 130162306a36Sopenharmony_ci 130262306a36Sopenharmony_ci switch (btrtl_dev->ic_info->lmp_subver) { 130362306a36Sopenharmony_ci case RTL_ROM_LMP_8703B: 130462306a36Sopenharmony_ci /* 8723CS reports two pages for local ext features, 130562306a36Sopenharmony_ci * but it doesn't support any features from page 2 - 130662306a36Sopenharmony_ci * it either responds with garbage or with error status 130762306a36Sopenharmony_ci */ 130862306a36Sopenharmony_ci set_bit(HCI_QUIRK_BROKEN_LOCAL_EXT_FEATURES_PAGE_2, 130962306a36Sopenharmony_ci &hdev->quirks); 131062306a36Sopenharmony_ci break; 131162306a36Sopenharmony_ci default: 131262306a36Sopenharmony_ci break; 131362306a36Sopenharmony_ci } 131462306a36Sopenharmony_ci} 131562306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(btrtl_set_quirks); 131662306a36Sopenharmony_ci 131762306a36Sopenharmony_ciint btrtl_setup_realtek(struct hci_dev *hdev) 131862306a36Sopenharmony_ci{ 131962306a36Sopenharmony_ci struct btrtl_device_info *btrtl_dev; 132062306a36Sopenharmony_ci int ret; 132162306a36Sopenharmony_ci 132262306a36Sopenharmony_ci btrtl_dev = btrtl_initialize(hdev, NULL); 132362306a36Sopenharmony_ci if (IS_ERR(btrtl_dev)) 132462306a36Sopenharmony_ci return PTR_ERR(btrtl_dev); 132562306a36Sopenharmony_ci 132662306a36Sopenharmony_ci ret = btrtl_download_firmware(hdev, btrtl_dev); 132762306a36Sopenharmony_ci 132862306a36Sopenharmony_ci btrtl_set_quirks(hdev, btrtl_dev); 132962306a36Sopenharmony_ci 133062306a36Sopenharmony_ci btrtl_free(btrtl_dev); 133162306a36Sopenharmony_ci return ret; 133262306a36Sopenharmony_ci} 133362306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(btrtl_setup_realtek); 133462306a36Sopenharmony_ci 133562306a36Sopenharmony_ciint btrtl_shutdown_realtek(struct hci_dev *hdev) 133662306a36Sopenharmony_ci{ 133762306a36Sopenharmony_ci struct sk_buff *skb; 133862306a36Sopenharmony_ci int ret; 133962306a36Sopenharmony_ci 134062306a36Sopenharmony_ci /* According to the vendor driver, BT must be reset on close to avoid 134162306a36Sopenharmony_ci * firmware crash. 134262306a36Sopenharmony_ci */ 134362306a36Sopenharmony_ci skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT); 134462306a36Sopenharmony_ci if (IS_ERR(skb)) { 134562306a36Sopenharmony_ci ret = PTR_ERR(skb); 134662306a36Sopenharmony_ci bt_dev_err(hdev, "HCI reset during shutdown failed"); 134762306a36Sopenharmony_ci return ret; 134862306a36Sopenharmony_ci } 134962306a36Sopenharmony_ci kfree_skb(skb); 135062306a36Sopenharmony_ci 135162306a36Sopenharmony_ci return 0; 135262306a36Sopenharmony_ci} 135362306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(btrtl_shutdown_realtek); 135462306a36Sopenharmony_ci 135562306a36Sopenharmony_cistatic unsigned int btrtl_convert_baudrate(u32 device_baudrate) 135662306a36Sopenharmony_ci{ 135762306a36Sopenharmony_ci switch (device_baudrate) { 135862306a36Sopenharmony_ci case 0x0252a00a: 135962306a36Sopenharmony_ci return 230400; 136062306a36Sopenharmony_ci 136162306a36Sopenharmony_ci case 0x05f75004: 136262306a36Sopenharmony_ci return 921600; 136362306a36Sopenharmony_ci 136462306a36Sopenharmony_ci case 0x00005004: 136562306a36Sopenharmony_ci return 1000000; 136662306a36Sopenharmony_ci 136762306a36Sopenharmony_ci case 0x04928002: 136862306a36Sopenharmony_ci case 0x01128002: 136962306a36Sopenharmony_ci return 1500000; 137062306a36Sopenharmony_ci 137162306a36Sopenharmony_ci case 0x00005002: 137262306a36Sopenharmony_ci return 2000000; 137362306a36Sopenharmony_ci 137462306a36Sopenharmony_ci case 0x0000b001: 137562306a36Sopenharmony_ci return 2500000; 137662306a36Sopenharmony_ci 137762306a36Sopenharmony_ci case 0x04928001: 137862306a36Sopenharmony_ci return 3000000; 137962306a36Sopenharmony_ci 138062306a36Sopenharmony_ci case 0x052a6001: 138162306a36Sopenharmony_ci return 3500000; 138262306a36Sopenharmony_ci 138362306a36Sopenharmony_ci case 0x00005001: 138462306a36Sopenharmony_ci return 4000000; 138562306a36Sopenharmony_ci 138662306a36Sopenharmony_ci case 0x0252c014: 138762306a36Sopenharmony_ci default: 138862306a36Sopenharmony_ci return 115200; 138962306a36Sopenharmony_ci } 139062306a36Sopenharmony_ci} 139162306a36Sopenharmony_ci 139262306a36Sopenharmony_ciint btrtl_get_uart_settings(struct hci_dev *hdev, 139362306a36Sopenharmony_ci struct btrtl_device_info *btrtl_dev, 139462306a36Sopenharmony_ci unsigned int *controller_baudrate, 139562306a36Sopenharmony_ci u32 *device_baudrate, bool *flow_control) 139662306a36Sopenharmony_ci{ 139762306a36Sopenharmony_ci struct rtl_vendor_config *config; 139862306a36Sopenharmony_ci struct rtl_vendor_config_entry *entry; 139962306a36Sopenharmony_ci int i, total_data_len; 140062306a36Sopenharmony_ci bool found = false; 140162306a36Sopenharmony_ci 140262306a36Sopenharmony_ci total_data_len = btrtl_dev->cfg_len - sizeof(*config); 140362306a36Sopenharmony_ci if (total_data_len <= 0) { 140462306a36Sopenharmony_ci rtl_dev_warn(hdev, "no config loaded"); 140562306a36Sopenharmony_ci return -EINVAL; 140662306a36Sopenharmony_ci } 140762306a36Sopenharmony_ci 140862306a36Sopenharmony_ci config = (struct rtl_vendor_config *)btrtl_dev->cfg_data; 140962306a36Sopenharmony_ci if (le32_to_cpu(config->signature) != RTL_CONFIG_MAGIC) { 141062306a36Sopenharmony_ci rtl_dev_err(hdev, "invalid config magic"); 141162306a36Sopenharmony_ci return -EINVAL; 141262306a36Sopenharmony_ci } 141362306a36Sopenharmony_ci 141462306a36Sopenharmony_ci if (total_data_len < le16_to_cpu(config->total_len)) { 141562306a36Sopenharmony_ci rtl_dev_err(hdev, "config is too short"); 141662306a36Sopenharmony_ci return -EINVAL; 141762306a36Sopenharmony_ci } 141862306a36Sopenharmony_ci 141962306a36Sopenharmony_ci for (i = 0; i < total_data_len; ) { 142062306a36Sopenharmony_ci entry = ((void *)config->entry) + i; 142162306a36Sopenharmony_ci 142262306a36Sopenharmony_ci switch (le16_to_cpu(entry->offset)) { 142362306a36Sopenharmony_ci case 0xc: 142462306a36Sopenharmony_ci if (entry->len < sizeof(*device_baudrate)) { 142562306a36Sopenharmony_ci rtl_dev_err(hdev, "invalid UART config entry"); 142662306a36Sopenharmony_ci return -EINVAL; 142762306a36Sopenharmony_ci } 142862306a36Sopenharmony_ci 142962306a36Sopenharmony_ci *device_baudrate = get_unaligned_le32(entry->data); 143062306a36Sopenharmony_ci *controller_baudrate = btrtl_convert_baudrate( 143162306a36Sopenharmony_ci *device_baudrate); 143262306a36Sopenharmony_ci 143362306a36Sopenharmony_ci if (entry->len >= 13) 143462306a36Sopenharmony_ci *flow_control = !!(entry->data[12] & BIT(2)); 143562306a36Sopenharmony_ci else 143662306a36Sopenharmony_ci *flow_control = false; 143762306a36Sopenharmony_ci 143862306a36Sopenharmony_ci found = true; 143962306a36Sopenharmony_ci break; 144062306a36Sopenharmony_ci 144162306a36Sopenharmony_ci default: 144262306a36Sopenharmony_ci rtl_dev_dbg(hdev, "skipping config entry 0x%x (len %u)", 144362306a36Sopenharmony_ci le16_to_cpu(entry->offset), entry->len); 144462306a36Sopenharmony_ci break; 144562306a36Sopenharmony_ci } 144662306a36Sopenharmony_ci 144762306a36Sopenharmony_ci i += sizeof(*entry) + entry->len; 144862306a36Sopenharmony_ci } 144962306a36Sopenharmony_ci 145062306a36Sopenharmony_ci if (!found) { 145162306a36Sopenharmony_ci rtl_dev_err(hdev, "no UART config entry found"); 145262306a36Sopenharmony_ci return -ENOENT; 145362306a36Sopenharmony_ci } 145462306a36Sopenharmony_ci 145562306a36Sopenharmony_ci rtl_dev_dbg(hdev, "device baudrate = 0x%08x", *device_baudrate); 145662306a36Sopenharmony_ci rtl_dev_dbg(hdev, "controller baudrate = %u", *controller_baudrate); 145762306a36Sopenharmony_ci rtl_dev_dbg(hdev, "flow control %d", *flow_control); 145862306a36Sopenharmony_ci 145962306a36Sopenharmony_ci return 0; 146062306a36Sopenharmony_ci} 146162306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(btrtl_get_uart_settings); 146262306a36Sopenharmony_ci 146362306a36Sopenharmony_ciMODULE_AUTHOR("Daniel Drake <drake@endlessm.com>"); 146462306a36Sopenharmony_ciMODULE_DESCRIPTION("Bluetooth support for Realtek devices ver " VERSION); 146562306a36Sopenharmony_ciMODULE_VERSION(VERSION); 146662306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 146762306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723a_fw.bin"); 146862306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723b_fw.bin"); 146962306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723b_config.bin"); 147062306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723bs_fw.bin"); 147162306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723bs_config.bin"); 147262306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723cs_cg_fw.bin"); 147362306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723cs_cg_config.bin"); 147462306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723cs_vf_fw.bin"); 147562306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723cs_vf_config.bin"); 147662306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723cs_xx_fw.bin"); 147762306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723cs_xx_config.bin"); 147862306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723d_fw.bin"); 147962306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723d_config.bin"); 148062306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723ds_fw.bin"); 148162306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8723ds_config.bin"); 148262306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8761a_fw.bin"); 148362306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8761a_config.bin"); 148462306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8761b_fw.bin"); 148562306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8761b_config.bin"); 148662306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8761bu_fw.bin"); 148762306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8761bu_config.bin"); 148862306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8821a_fw.bin"); 148962306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8821a_config.bin"); 149062306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8821c_fw.bin"); 149162306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8821c_config.bin"); 149262306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8821cs_fw.bin"); 149362306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8821cs_config.bin"); 149462306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8822b_fw.bin"); 149562306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8822b_config.bin"); 149662306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8822cs_fw.bin"); 149762306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8822cs_config.bin"); 149862306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8822cu_fw.bin"); 149962306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8822cu_config.bin"); 150062306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8851bu_fw.bin"); 150162306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8851bu_config.bin"); 150262306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8852au_fw.bin"); 150362306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8852au_config.bin"); 150462306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8852bs_fw.bin"); 150562306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8852bs_config.bin"); 150662306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8852bu_fw.bin"); 150762306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8852bu_config.bin"); 150862306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8852cu_fw.bin"); 150962306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8852cu_fw_v2.bin"); 151062306a36Sopenharmony_ciMODULE_FIRMWARE("rtl_bt/rtl8852cu_config.bin"); 1511