1*c942fddfSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 2db33c77dSCarlo Caione /* 3db33c77dSCarlo Caione * Bluetooth support for Realtek devices 4db33c77dSCarlo Caione * 5db33c77dSCarlo Caione * Copyright (C) 2015 Endless Mobile, Inc. 6db33c77dSCarlo Caione */ 7db33c77dSCarlo Caione 8db33c77dSCarlo Caione #include <linux/module.h> 9db33c77dSCarlo Caione #include <linux/firmware.h> 10db33c77dSCarlo Caione #include <asm/unaligned.h> 11db33c77dSCarlo Caione #include <linux/usb.h> 12db33c77dSCarlo Caione 13db33c77dSCarlo Caione #include <net/bluetooth/bluetooth.h> 14db33c77dSCarlo Caione #include <net/bluetooth/hci_core.h> 15db33c77dSCarlo Caione 16db33c77dSCarlo Caione #include "btrtl.h" 17db33c77dSCarlo Caione 18db33c77dSCarlo Caione #define VERSION "0.1" 19db33c77dSCarlo Caione 20db33c77dSCarlo Caione #define RTL_EPATCH_SIGNATURE "Realtech" 21db33c77dSCarlo Caione #define RTL_ROM_LMP_3499 0x3499 22db33c77dSCarlo Caione #define RTL_ROM_LMP_8723A 0x1200 23db33c77dSCarlo Caione #define RTL_ROM_LMP_8723B 0x8723 24db33c77dSCarlo Caione #define RTL_ROM_LMP_8821A 0x8821 25db33c77dSCarlo Caione #define RTL_ROM_LMP_8761A 0x8761 261110a2dbSLarry Finger #define RTL_ROM_LMP_8822B 0x8822 27b85b0ee1SMartin Blumenstingl #define RTL_CONFIG_MAGIC 0x8723ab55 28db33c77dSCarlo Caione 29907f8499SAlex Lu #define IC_MATCH_FL_LMPSUBV (1 << 0) 30907f8499SAlex Lu #define IC_MATCH_FL_HCIREV (1 << 1) 31c50903e3SMartin Blumenstingl #define IC_MATCH_FL_HCIVER (1 << 2) 32c50903e3SMartin Blumenstingl #define IC_MATCH_FL_HCIBUS (1 << 3) 33907f8499SAlex Lu #define IC_INFO(lmps, hcir) \ 34907f8499SAlex Lu .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_HCIREV, \ 35907f8499SAlex Lu .lmp_subver = (lmps), \ 36907f8499SAlex Lu .hci_rev = (hcir) 37907f8499SAlex Lu 38907f8499SAlex Lu struct id_table { 39907f8499SAlex Lu __u16 match_flags; 40907f8499SAlex Lu __u16 lmp_subver; 41907f8499SAlex Lu __u16 hci_rev; 42c50903e3SMartin Blumenstingl __u8 hci_ver; 43c50903e3SMartin Blumenstingl __u8 hci_bus; 44907f8499SAlex Lu bool config_needed; 4526503ad2SMartin Blumenstingl bool has_rom_version; 46907f8499SAlex Lu char *fw_name; 47907f8499SAlex Lu char *cfg_name; 48907f8499SAlex Lu }; 49907f8499SAlex Lu 5026503ad2SMartin Blumenstingl struct btrtl_device_info { 5126503ad2SMartin Blumenstingl const struct id_table *ic_info; 5226503ad2SMartin Blumenstingl u8 rom_version; 5326503ad2SMartin Blumenstingl u8 *fw_data; 5426503ad2SMartin Blumenstingl int fw_len; 5526503ad2SMartin Blumenstingl u8 *cfg_data; 5626503ad2SMartin Blumenstingl int cfg_len; 5726503ad2SMartin Blumenstingl }; 5826503ad2SMartin Blumenstingl 59907f8499SAlex Lu static const struct id_table ic_id_table[] = { 6026503ad2SMartin Blumenstingl { IC_MATCH_FL_LMPSUBV, RTL_ROM_LMP_8723A, 0x0, 6126503ad2SMartin Blumenstingl .config_needed = false, 6226503ad2SMartin Blumenstingl .has_rom_version = false, 6326503ad2SMartin Blumenstingl .fw_name = "rtl_bt/rtl8723a_fw.bin", 6426503ad2SMartin Blumenstingl .cfg_name = NULL }, 6526503ad2SMartin Blumenstingl 6626503ad2SMartin Blumenstingl { IC_MATCH_FL_LMPSUBV, RTL_ROM_LMP_3499, 0x0, 6726503ad2SMartin Blumenstingl .config_needed = false, 6826503ad2SMartin Blumenstingl .has_rom_version = false, 6926503ad2SMartin Blumenstingl .fw_name = "rtl_bt/rtl8723a_fw.bin", 7026503ad2SMartin Blumenstingl .cfg_name = NULL }, 7126503ad2SMartin Blumenstingl 72c50903e3SMartin Blumenstingl /* 8723BS */ 73c50903e3SMartin Blumenstingl { .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_HCIREV | 74c50903e3SMartin Blumenstingl IC_MATCH_FL_HCIVER | IC_MATCH_FL_HCIBUS, 75c50903e3SMartin Blumenstingl .lmp_subver = RTL_ROM_LMP_8723B, 76c50903e3SMartin Blumenstingl .hci_rev = 0xb, 77c50903e3SMartin Blumenstingl .hci_ver = 6, 78c50903e3SMartin Blumenstingl .hci_bus = HCI_UART, 79c50903e3SMartin Blumenstingl .config_needed = true, 80c50903e3SMartin Blumenstingl .has_rom_version = true, 81c50903e3SMartin Blumenstingl .fw_name = "rtl_bt/rtl8723bs_fw.bin", 821cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8723bs_config" }, 83c50903e3SMartin Blumenstingl 84907f8499SAlex Lu /* 8723B */ 85907f8499SAlex Lu { IC_INFO(RTL_ROM_LMP_8723B, 0xb), 86907f8499SAlex Lu .config_needed = false, 8726503ad2SMartin Blumenstingl .has_rom_version = true, 88907f8499SAlex Lu .fw_name = "rtl_bt/rtl8723b_fw.bin", 891cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8723b_config" }, 90907f8499SAlex Lu 91907f8499SAlex Lu /* 8723D */ 92907f8499SAlex Lu { IC_INFO(RTL_ROM_LMP_8723B, 0xd), 93907f8499SAlex Lu .config_needed = true, 9426503ad2SMartin Blumenstingl .has_rom_version = true, 95907f8499SAlex Lu .fw_name = "rtl_bt/rtl8723d_fw.bin", 961cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8723d_config" }, 97907f8499SAlex Lu 98c50903e3SMartin Blumenstingl /* 8723DS */ 99c50903e3SMartin Blumenstingl { .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_HCIREV | 100c50903e3SMartin Blumenstingl IC_MATCH_FL_HCIVER | IC_MATCH_FL_HCIBUS, 101c50903e3SMartin Blumenstingl .lmp_subver = RTL_ROM_LMP_8723B, 102c50903e3SMartin Blumenstingl .hci_rev = 0xd, 103c50903e3SMartin Blumenstingl .hci_ver = 8, 104c50903e3SMartin Blumenstingl .hci_bus = HCI_UART, 105c50903e3SMartin Blumenstingl .config_needed = true, 106c50903e3SMartin Blumenstingl .has_rom_version = true, 107c50903e3SMartin Blumenstingl .fw_name = "rtl_bt/rtl8723ds_fw.bin", 1081cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8723ds_config" }, 109c50903e3SMartin Blumenstingl 110907f8499SAlex Lu /* 8821A */ 111907f8499SAlex Lu { IC_INFO(RTL_ROM_LMP_8821A, 0xa), 112907f8499SAlex Lu .config_needed = false, 11326503ad2SMartin Blumenstingl .has_rom_version = true, 114907f8499SAlex Lu .fw_name = "rtl_bt/rtl8821a_fw.bin", 1151cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8821a_config" }, 116907f8499SAlex Lu 117907f8499SAlex Lu /* 8821C */ 118907f8499SAlex Lu { IC_INFO(RTL_ROM_LMP_8821A, 0xc), 119907f8499SAlex Lu .config_needed = false, 12026503ad2SMartin Blumenstingl .has_rom_version = true, 121907f8499SAlex Lu .fw_name = "rtl_bt/rtl8821c_fw.bin", 1221cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8821c_config" }, 123907f8499SAlex Lu 124907f8499SAlex Lu /* 8761A */ 125907f8499SAlex Lu { IC_MATCH_FL_LMPSUBV, RTL_ROM_LMP_8761A, 0x0, 126907f8499SAlex Lu .config_needed = false, 12726503ad2SMartin Blumenstingl .has_rom_version = true, 128907f8499SAlex Lu .fw_name = "rtl_bt/rtl8761a_fw.bin", 1291cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8761a_config" }, 130907f8499SAlex Lu 1318ecfdc95SAlex Lu /* 8822C with USB interface */ 1328ecfdc95SAlex Lu { IC_INFO(RTL_ROM_LMP_8822B, 0xc), 1338ecfdc95SAlex Lu .config_needed = false, 1348ecfdc95SAlex Lu .has_rom_version = true, 1358ecfdc95SAlex Lu .fw_name = "rtl_bt/rtl8822cu_fw.bin", 1368ecfdc95SAlex Lu .cfg_name = "rtl_bt/rtl8822cu_config" }, 1378ecfdc95SAlex Lu 138907f8499SAlex Lu /* 8822B */ 139907f8499SAlex Lu { IC_INFO(RTL_ROM_LMP_8822B, 0xb), 140907f8499SAlex Lu .config_needed = true, 14126503ad2SMartin Blumenstingl .has_rom_version = true, 142907f8499SAlex Lu .fw_name = "rtl_bt/rtl8822b_fw.bin", 1431cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8822b_config" }, 144907f8499SAlex Lu }; 145907f8499SAlex Lu 146c50903e3SMartin Blumenstingl static const struct id_table *btrtl_match_ic(u16 lmp_subver, u16 hci_rev, 147c50903e3SMartin Blumenstingl u8 hci_ver, u8 hci_bus) 14826503ad2SMartin Blumenstingl { 14926503ad2SMartin Blumenstingl int i; 15026503ad2SMartin Blumenstingl 15126503ad2SMartin Blumenstingl for (i = 0; i < ARRAY_SIZE(ic_id_table); i++) { 15226503ad2SMartin Blumenstingl if ((ic_id_table[i].match_flags & IC_MATCH_FL_LMPSUBV) && 15326503ad2SMartin Blumenstingl (ic_id_table[i].lmp_subver != lmp_subver)) 15426503ad2SMartin Blumenstingl continue; 15526503ad2SMartin Blumenstingl if ((ic_id_table[i].match_flags & IC_MATCH_FL_HCIREV) && 15626503ad2SMartin Blumenstingl (ic_id_table[i].hci_rev != hci_rev)) 15726503ad2SMartin Blumenstingl continue; 158c50903e3SMartin Blumenstingl if ((ic_id_table[i].match_flags & IC_MATCH_FL_HCIVER) && 159c50903e3SMartin Blumenstingl (ic_id_table[i].hci_ver != hci_ver)) 160c50903e3SMartin Blumenstingl continue; 161c50903e3SMartin Blumenstingl if ((ic_id_table[i].match_flags & IC_MATCH_FL_HCIBUS) && 162c50903e3SMartin Blumenstingl (ic_id_table[i].hci_bus != hci_bus)) 163c50903e3SMartin Blumenstingl continue; 16426503ad2SMartin Blumenstingl 16526503ad2SMartin Blumenstingl break; 16626503ad2SMartin Blumenstingl } 16726503ad2SMartin Blumenstingl if (i >= ARRAY_SIZE(ic_id_table)) 16826503ad2SMartin Blumenstingl return NULL; 16926503ad2SMartin Blumenstingl 17026503ad2SMartin Blumenstingl return &ic_id_table[i]; 17126503ad2SMartin Blumenstingl } 17226503ad2SMartin Blumenstingl 173db33c77dSCarlo Caione static int rtl_read_rom_version(struct hci_dev *hdev, u8 *version) 174db33c77dSCarlo Caione { 175db33c77dSCarlo Caione struct rtl_rom_version_evt *rom_version; 176db33c77dSCarlo Caione struct sk_buff *skb; 177db33c77dSCarlo Caione 178db33c77dSCarlo Caione /* Read RTL ROM version command */ 179db33c77dSCarlo Caione skb = __hci_cmd_sync(hdev, 0xfc6d, 0, NULL, HCI_INIT_TIMEOUT); 180db33c77dSCarlo Caione if (IS_ERR(skb)) { 181a5c76e67SHans de Goede rtl_dev_err(hdev, "Read ROM version failed (%ld)\n", 182a5c76e67SHans de Goede PTR_ERR(skb)); 183db33c77dSCarlo Caione return PTR_ERR(skb); 184db33c77dSCarlo Caione } 185db33c77dSCarlo Caione 186db33c77dSCarlo Caione if (skb->len != sizeof(*rom_version)) { 187a5c76e67SHans de Goede rtl_dev_err(hdev, "RTL version event length mismatch\n"); 188db33c77dSCarlo Caione kfree_skb(skb); 189db33c77dSCarlo Caione return -EIO; 190db33c77dSCarlo Caione } 191db33c77dSCarlo Caione 192db33c77dSCarlo Caione rom_version = (struct rtl_rom_version_evt *)skb->data; 193a5c76e67SHans de Goede rtl_dev_info(hdev, "rom_version status=%x version=%x\n", 1942064ee33SMarcel Holtmann rom_version->status, rom_version->version); 195db33c77dSCarlo Caione 196db33c77dSCarlo Caione *version = rom_version->version; 197db33c77dSCarlo Caione 198db33c77dSCarlo Caione kfree_skb(skb); 199db33c77dSCarlo Caione return 0; 200db33c77dSCarlo Caione } 201db33c77dSCarlo Caione 20226503ad2SMartin Blumenstingl static int rtlbt_parse_firmware(struct hci_dev *hdev, 20326503ad2SMartin Blumenstingl struct btrtl_device_info *btrtl_dev, 204db33c77dSCarlo Caione unsigned char **_buf) 205db33c77dSCarlo Caione { 206e5070e07SColin Ian King static const u8 extension_sig[] = { 0x51, 0x04, 0xfd, 0x77 }; 207db33c77dSCarlo Caione struct rtl_epatch_header *epatch_info; 208db33c77dSCarlo Caione unsigned char *buf; 20926503ad2SMartin Blumenstingl int i, len; 210db33c77dSCarlo Caione size_t min_size; 21126503ad2SMartin Blumenstingl u8 opcode, length, data; 212db33c77dSCarlo Caione int project_id = -1; 213db33c77dSCarlo Caione const unsigned char *fwptr, *chip_id_base; 214db33c77dSCarlo Caione const unsigned char *patch_length_base, *patch_offset_base; 215db33c77dSCarlo Caione u32 patch_offset = 0; 216db33c77dSCarlo Caione u16 patch_length, num_patches; 2171110a2dbSLarry Finger static const struct { 2181110a2dbSLarry Finger __u16 lmp_subver; 2191110a2dbSLarry Finger __u8 id; 2201110a2dbSLarry Finger } project_id_to_lmp_subver[] = { 2211110a2dbSLarry Finger { RTL_ROM_LMP_8723A, 0 }, 2221110a2dbSLarry Finger { RTL_ROM_LMP_8723B, 1 }, 2231110a2dbSLarry Finger { RTL_ROM_LMP_8821A, 2 }, 2241110a2dbSLarry Finger { RTL_ROM_LMP_8761A, 3 }, 2251110a2dbSLarry Finger { RTL_ROM_LMP_8822B, 8 }, 226907f8499SAlex Lu { RTL_ROM_LMP_8723B, 9 }, /* 8723D */ 227907f8499SAlex Lu { RTL_ROM_LMP_8821A, 10 }, /* 8821C */ 2288ecfdc95SAlex Lu { RTL_ROM_LMP_8822B, 13 }, /* 8822C */ 229db33c77dSCarlo Caione }; 230db33c77dSCarlo Caione 231db33c77dSCarlo Caione min_size = sizeof(struct rtl_epatch_header) + sizeof(extension_sig) + 3; 23226503ad2SMartin Blumenstingl if (btrtl_dev->fw_len < min_size) 233db33c77dSCarlo Caione return -EINVAL; 234db33c77dSCarlo Caione 23526503ad2SMartin Blumenstingl fwptr = btrtl_dev->fw_data + btrtl_dev->fw_len - sizeof(extension_sig); 236db33c77dSCarlo Caione if (memcmp(fwptr, extension_sig, sizeof(extension_sig)) != 0) { 237a5c76e67SHans de Goede rtl_dev_err(hdev, "extension section signature mismatch\n"); 238db33c77dSCarlo Caione return -EINVAL; 239db33c77dSCarlo Caione } 240db33c77dSCarlo Caione 241db33c77dSCarlo Caione /* Loop from the end of the firmware parsing instructions, until 242db33c77dSCarlo Caione * we find an instruction that identifies the "project ID" for the 243db33c77dSCarlo Caione * hardware supported by this firwmare file. 244db33c77dSCarlo Caione * Once we have that, we double-check that that project_id is suitable 245db33c77dSCarlo Caione * for the hardware we are working with. 246db33c77dSCarlo Caione */ 24726503ad2SMartin Blumenstingl while (fwptr >= btrtl_dev->fw_data + (sizeof(*epatch_info) + 3)) { 248db33c77dSCarlo Caione opcode = *--fwptr; 249db33c77dSCarlo Caione length = *--fwptr; 250db33c77dSCarlo Caione data = *--fwptr; 251db33c77dSCarlo Caione 252db33c77dSCarlo Caione BT_DBG("check op=%x len=%x data=%x", opcode, length, data); 253db33c77dSCarlo Caione 254db33c77dSCarlo Caione if (opcode == 0xff) /* EOF */ 255db33c77dSCarlo Caione break; 256db33c77dSCarlo Caione 257db33c77dSCarlo Caione if (length == 0) { 258a5c76e67SHans de Goede rtl_dev_err(hdev, "found instruction with length 0\n"); 259db33c77dSCarlo Caione return -EINVAL; 260db33c77dSCarlo Caione } 261db33c77dSCarlo Caione 262db33c77dSCarlo Caione if (opcode == 0 && length == 1) { 263db33c77dSCarlo Caione project_id = data; 264db33c77dSCarlo Caione break; 265db33c77dSCarlo Caione } 266db33c77dSCarlo Caione 267db33c77dSCarlo Caione fwptr -= length; 268db33c77dSCarlo Caione } 269db33c77dSCarlo Caione 270db33c77dSCarlo Caione if (project_id < 0) { 271a5c76e67SHans de Goede rtl_dev_err(hdev, "failed to find version instruction\n"); 272db33c77dSCarlo Caione return -EINVAL; 273db33c77dSCarlo Caione } 274db33c77dSCarlo Caione 2751110a2dbSLarry Finger /* Find project_id in table */ 2761110a2dbSLarry Finger for (i = 0; i < ARRAY_SIZE(project_id_to_lmp_subver); i++) { 2771110a2dbSLarry Finger if (project_id == project_id_to_lmp_subver[i].id) 2781110a2dbSLarry Finger break; 2791110a2dbSLarry Finger } 2801110a2dbSLarry Finger 2811110a2dbSLarry Finger if (i >= ARRAY_SIZE(project_id_to_lmp_subver)) { 282a5c76e67SHans de Goede rtl_dev_err(hdev, "unknown project id %d\n", project_id); 283db33c77dSCarlo Caione return -EINVAL; 284db33c77dSCarlo Caione } 285db33c77dSCarlo Caione 28626503ad2SMartin Blumenstingl if (btrtl_dev->ic_info->lmp_subver != 28726503ad2SMartin Blumenstingl project_id_to_lmp_subver[i].lmp_subver) { 288a5c76e67SHans de Goede rtl_dev_err(hdev, "firmware is for %x but this is a %x\n", 28926503ad2SMartin Blumenstingl project_id_to_lmp_subver[i].lmp_subver, 29026503ad2SMartin Blumenstingl btrtl_dev->ic_info->lmp_subver); 291db33c77dSCarlo Caione return -EINVAL; 292db33c77dSCarlo Caione } 293db33c77dSCarlo Caione 29426503ad2SMartin Blumenstingl epatch_info = (struct rtl_epatch_header *)btrtl_dev->fw_data; 295db33c77dSCarlo Caione if (memcmp(epatch_info->signature, RTL_EPATCH_SIGNATURE, 8) != 0) { 296a5c76e67SHans de Goede rtl_dev_err(hdev, "bad EPATCH signature\n"); 297db33c77dSCarlo Caione return -EINVAL; 298db33c77dSCarlo Caione } 299db33c77dSCarlo Caione 300db33c77dSCarlo Caione num_patches = le16_to_cpu(epatch_info->num_patches); 301db33c77dSCarlo Caione BT_DBG("fw_version=%x, num_patches=%d", 302db33c77dSCarlo Caione le32_to_cpu(epatch_info->fw_version), num_patches); 303db33c77dSCarlo Caione 304db33c77dSCarlo Caione /* After the rtl_epatch_header there is a funky patch metadata section. 305db33c77dSCarlo Caione * Assuming 2 patches, the layout is: 306db33c77dSCarlo Caione * ChipID1 ChipID2 PatchLength1 PatchLength2 PatchOffset1 PatchOffset2 307db33c77dSCarlo Caione * 308db33c77dSCarlo Caione * Find the right patch for this chip. 309db33c77dSCarlo Caione */ 310db33c77dSCarlo Caione min_size += 8 * num_patches; 31126503ad2SMartin Blumenstingl if (btrtl_dev->fw_len < min_size) 312db33c77dSCarlo Caione return -EINVAL; 313db33c77dSCarlo Caione 31426503ad2SMartin Blumenstingl chip_id_base = btrtl_dev->fw_data + sizeof(struct rtl_epatch_header); 315db33c77dSCarlo Caione patch_length_base = chip_id_base + (sizeof(u16) * num_patches); 316db33c77dSCarlo Caione patch_offset_base = patch_length_base + (sizeof(u16) * num_patches); 317db33c77dSCarlo Caione for (i = 0; i < num_patches; i++) { 318db33c77dSCarlo Caione u16 chip_id = get_unaligned_le16(chip_id_base + 319db33c77dSCarlo Caione (i * sizeof(u16))); 32026503ad2SMartin Blumenstingl if (chip_id == btrtl_dev->rom_version + 1) { 321db33c77dSCarlo Caione patch_length = get_unaligned_le16(patch_length_base + 322db33c77dSCarlo Caione (i * sizeof(u16))); 323db33c77dSCarlo Caione patch_offset = get_unaligned_le32(patch_offset_base + 324db33c77dSCarlo Caione (i * sizeof(u32))); 325db33c77dSCarlo Caione break; 326db33c77dSCarlo Caione } 327db33c77dSCarlo Caione } 328db33c77dSCarlo Caione 329db33c77dSCarlo Caione if (!patch_offset) { 330a5c76e67SHans de Goede rtl_dev_err(hdev, "didn't find patch for chip id %d", 331a5c76e67SHans de Goede btrtl_dev->rom_version); 332db33c77dSCarlo Caione return -EINVAL; 333db33c77dSCarlo Caione } 334db33c77dSCarlo Caione 335db33c77dSCarlo Caione BT_DBG("length=%x offset=%x index %d", patch_length, patch_offset, i); 336db33c77dSCarlo Caione min_size = patch_offset + patch_length; 33726503ad2SMartin Blumenstingl if (btrtl_dev->fw_len < min_size) 338db33c77dSCarlo Caione return -EINVAL; 339db33c77dSCarlo Caione 340db33c77dSCarlo Caione /* Copy the firmware into a new buffer and write the version at 341db33c77dSCarlo Caione * the end. 342db33c77dSCarlo Caione */ 343db33c77dSCarlo Caione len = patch_length; 34426503ad2SMartin Blumenstingl buf = kmemdup(btrtl_dev->fw_data + patch_offset, patch_length, 34526503ad2SMartin Blumenstingl GFP_KERNEL); 346db33c77dSCarlo Caione if (!buf) 347db33c77dSCarlo Caione return -ENOMEM; 348db33c77dSCarlo Caione 349db33c77dSCarlo Caione memcpy(buf + patch_length - 4, &epatch_info->fw_version, 4); 350db33c77dSCarlo Caione 351db33c77dSCarlo Caione *_buf = buf; 352db33c77dSCarlo Caione return len; 353db33c77dSCarlo Caione } 354db33c77dSCarlo Caione 355db33c77dSCarlo Caione static int rtl_download_firmware(struct hci_dev *hdev, 356db33c77dSCarlo Caione const unsigned char *data, int fw_len) 357db33c77dSCarlo Caione { 358db33c77dSCarlo Caione struct rtl_download_cmd *dl_cmd; 359db33c77dSCarlo Caione int frag_num = fw_len / RTL_FRAG_LEN + 1; 360db33c77dSCarlo Caione int frag_len = RTL_FRAG_LEN; 361db33c77dSCarlo Caione int ret = 0; 362db33c77dSCarlo Caione int i; 363db33c77dSCarlo Caione 364db33c77dSCarlo Caione dl_cmd = kmalloc(sizeof(struct rtl_download_cmd), GFP_KERNEL); 365db33c77dSCarlo Caione if (!dl_cmd) 366db33c77dSCarlo Caione return -ENOMEM; 367db33c77dSCarlo Caione 368db33c77dSCarlo Caione for (i = 0; i < frag_num; i++) { 369db33c77dSCarlo Caione struct sk_buff *skb; 370db33c77dSCarlo Caione 371db33c77dSCarlo Caione BT_DBG("download fw (%d/%d)", i, frag_num); 372db33c77dSCarlo Caione 373db33c77dSCarlo Caione dl_cmd->index = i; 374db33c77dSCarlo Caione if (i == (frag_num - 1)) { 375db33c77dSCarlo Caione dl_cmd->index |= 0x80; /* data end */ 376db33c77dSCarlo Caione frag_len = fw_len % RTL_FRAG_LEN; 377db33c77dSCarlo Caione } 378db33c77dSCarlo Caione memcpy(dl_cmd->data, data, frag_len); 379db33c77dSCarlo Caione 380db33c77dSCarlo Caione /* Send download command */ 381db33c77dSCarlo Caione skb = __hci_cmd_sync(hdev, 0xfc20, frag_len + 1, dl_cmd, 382db33c77dSCarlo Caione HCI_INIT_TIMEOUT); 383db33c77dSCarlo Caione if (IS_ERR(skb)) { 384a5c76e67SHans de Goede rtl_dev_err(hdev, "download fw command failed (%ld)\n", 385a5c76e67SHans de Goede PTR_ERR(skb)); 386db33c77dSCarlo Caione ret = -PTR_ERR(skb); 387db33c77dSCarlo Caione goto out; 388db33c77dSCarlo Caione } 389db33c77dSCarlo Caione 390db33c77dSCarlo Caione if (skb->len != sizeof(struct rtl_download_response)) { 391a5c76e67SHans de Goede rtl_dev_err(hdev, "download fw event length mismatch\n"); 392db33c77dSCarlo Caione kfree_skb(skb); 393db33c77dSCarlo Caione ret = -EIO; 394db33c77dSCarlo Caione goto out; 395db33c77dSCarlo Caione } 396db33c77dSCarlo Caione 397db33c77dSCarlo Caione kfree_skb(skb); 398db33c77dSCarlo Caione data += RTL_FRAG_LEN; 399db33c77dSCarlo Caione } 400db33c77dSCarlo Caione 401db33c77dSCarlo Caione out: 402db33c77dSCarlo Caione kfree(dl_cmd); 403db33c77dSCarlo Caione return ret; 404db33c77dSCarlo Caione } 405db33c77dSCarlo Caione 40626503ad2SMartin Blumenstingl static int rtl_load_file(struct hci_dev *hdev, const char *name, u8 **buff) 4071110a2dbSLarry Finger { 4081110a2dbSLarry Finger const struct firmware *fw; 4091110a2dbSLarry Finger int ret; 4101110a2dbSLarry Finger 411a5c76e67SHans de Goede rtl_dev_info(hdev, "rtl: loading %s\n", name); 4121110a2dbSLarry Finger ret = request_firmware(&fw, name, &hdev->dev); 413abed84a0SLarry Finger if (ret < 0) 4141110a2dbSLarry Finger return ret; 4151110a2dbSLarry Finger ret = fw->size; 4161110a2dbSLarry Finger *buff = kmemdup(fw->data, ret, GFP_KERNEL); 417c3327bdeSDan Carpenter if (!*buff) 418c3327bdeSDan Carpenter ret = -ENOMEM; 4191110a2dbSLarry Finger 4201110a2dbSLarry Finger release_firmware(fw); 4211110a2dbSLarry Finger 4221110a2dbSLarry Finger return ret; 4231110a2dbSLarry Finger } 4241110a2dbSLarry Finger 42526503ad2SMartin Blumenstingl static int btrtl_setup_rtl8723a(struct hci_dev *hdev, 42626503ad2SMartin Blumenstingl struct btrtl_device_info *btrtl_dev) 427db33c77dSCarlo Caione { 42826503ad2SMartin Blumenstingl if (btrtl_dev->fw_len < 8) 42926503ad2SMartin Blumenstingl return -EINVAL; 430db33c77dSCarlo Caione 431db33c77dSCarlo Caione /* Check that the firmware doesn't have the epatch signature 432db33c77dSCarlo Caione * (which is only for RTL8723B and newer). 433db33c77dSCarlo Caione */ 43426503ad2SMartin Blumenstingl if (!memcmp(btrtl_dev->fw_data, RTL_EPATCH_SIGNATURE, 8)) { 435a5c76e67SHans de Goede rtl_dev_err(hdev, "unexpected EPATCH signature!\n"); 436907f8499SAlex Lu return -EINVAL; 437907f8499SAlex Lu } 438907f8499SAlex Lu 43926503ad2SMartin Blumenstingl return rtl_download_firmware(hdev, btrtl_dev->fw_data, 44026503ad2SMartin Blumenstingl btrtl_dev->fw_len); 441db33c77dSCarlo Caione } 442db33c77dSCarlo Caione 44326503ad2SMartin Blumenstingl static int btrtl_setup_rtl8723b(struct hci_dev *hdev, 44426503ad2SMartin Blumenstingl struct btrtl_device_info *btrtl_dev) 44526503ad2SMartin Blumenstingl { 44626503ad2SMartin Blumenstingl unsigned char *fw_data = NULL; 44726503ad2SMartin Blumenstingl int ret; 44826503ad2SMartin Blumenstingl u8 *tbuff; 44926503ad2SMartin Blumenstingl 45026503ad2SMartin Blumenstingl ret = rtlbt_parse_firmware(hdev, btrtl_dev, &fw_data); 451db33c77dSCarlo Caione if (ret < 0) 452db33c77dSCarlo Caione goto out; 453db33c77dSCarlo Caione 45426503ad2SMartin Blumenstingl if (btrtl_dev->cfg_len > 0) { 45526503ad2SMartin Blumenstingl tbuff = kzalloc(ret + btrtl_dev->cfg_len, GFP_KERNEL); 4561110a2dbSLarry Finger if (!tbuff) { 4571110a2dbSLarry Finger ret = -ENOMEM; 458db33c77dSCarlo Caione goto out; 4591110a2dbSLarry Finger } 4601110a2dbSLarry Finger 4611110a2dbSLarry Finger memcpy(tbuff, fw_data, ret); 4621110a2dbSLarry Finger kfree(fw_data); 4631110a2dbSLarry Finger 46426503ad2SMartin Blumenstingl memcpy(tbuff + ret, btrtl_dev->cfg_data, btrtl_dev->cfg_len); 46526503ad2SMartin Blumenstingl ret += btrtl_dev->cfg_len; 4661110a2dbSLarry Finger 4671110a2dbSLarry Finger fw_data = tbuff; 4681110a2dbSLarry Finger } 4691110a2dbSLarry Finger 47026503ad2SMartin Blumenstingl rtl_dev_info(hdev, "cfg_sz %d, total sz %d\n", btrtl_dev->cfg_len, ret); 4711110a2dbSLarry Finger 4721110a2dbSLarry Finger ret = rtl_download_firmware(hdev, fw_data, ret); 473db33c77dSCarlo Caione 474db33c77dSCarlo Caione out: 4751110a2dbSLarry Finger kfree(fw_data); 476db33c77dSCarlo Caione return ret; 477db33c77dSCarlo Caione } 478db33c77dSCarlo Caione 479db33c77dSCarlo Caione static struct sk_buff *btrtl_read_local_version(struct hci_dev *hdev) 480db33c77dSCarlo Caione { 481db33c77dSCarlo Caione struct sk_buff *skb; 482db33c77dSCarlo Caione 483db33c77dSCarlo Caione skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL, 484db33c77dSCarlo Caione HCI_INIT_TIMEOUT); 485db33c77dSCarlo Caione if (IS_ERR(skb)) { 486a5c76e67SHans de Goede rtl_dev_err(hdev, "HCI_OP_READ_LOCAL_VERSION failed (%ld)\n", 487a5c76e67SHans de Goede PTR_ERR(skb)); 488db33c77dSCarlo Caione return skb; 489db33c77dSCarlo Caione } 490db33c77dSCarlo Caione 491db33c77dSCarlo Caione if (skb->len != sizeof(struct hci_rp_read_local_version)) { 492a5c76e67SHans de Goede rtl_dev_err(hdev, "HCI_OP_READ_LOCAL_VERSION event length mismatch\n"); 493db33c77dSCarlo Caione kfree_skb(skb); 494db33c77dSCarlo Caione return ERR_PTR(-EIO); 495db33c77dSCarlo Caione } 496db33c77dSCarlo Caione 497db33c77dSCarlo Caione return skb; 498db33c77dSCarlo Caione } 499db33c77dSCarlo Caione 50026503ad2SMartin Blumenstingl void btrtl_free(struct btrtl_device_info *btrtl_dev) 501db33c77dSCarlo Caione { 50226503ad2SMartin Blumenstingl kfree(btrtl_dev->fw_data); 50326503ad2SMartin Blumenstingl kfree(btrtl_dev->cfg_data); 50426503ad2SMartin Blumenstingl kfree(btrtl_dev); 50526503ad2SMartin Blumenstingl } 50626503ad2SMartin Blumenstingl EXPORT_SYMBOL_GPL(btrtl_free); 50726503ad2SMartin Blumenstingl 5081cc194caSHans de Goede struct btrtl_device_info *btrtl_initialize(struct hci_dev *hdev, 5091cc194caSHans de Goede const char *postfix) 51026503ad2SMartin Blumenstingl { 51126503ad2SMartin Blumenstingl struct btrtl_device_info *btrtl_dev; 512db33c77dSCarlo Caione struct sk_buff *skb; 513db33c77dSCarlo Caione struct hci_rp_read_local_version *resp; 5141cc194caSHans de Goede char cfg_name[40]; 515907f8499SAlex Lu u16 hci_rev, lmp_subver; 516c50903e3SMartin Blumenstingl u8 hci_ver; 51726503ad2SMartin Blumenstingl int ret; 51826503ad2SMartin Blumenstingl 51926503ad2SMartin Blumenstingl btrtl_dev = kzalloc(sizeof(*btrtl_dev), GFP_KERNEL); 52026503ad2SMartin Blumenstingl if (!btrtl_dev) { 52126503ad2SMartin Blumenstingl ret = -ENOMEM; 52226503ad2SMartin Blumenstingl goto err_alloc; 52326503ad2SMartin Blumenstingl } 524db33c77dSCarlo Caione 525db33c77dSCarlo Caione skb = btrtl_read_local_version(hdev); 52626503ad2SMartin Blumenstingl if (IS_ERR(skb)) { 52726503ad2SMartin Blumenstingl ret = PTR_ERR(skb); 52826503ad2SMartin Blumenstingl goto err_free; 52926503ad2SMartin Blumenstingl } 530db33c77dSCarlo Caione 531db33c77dSCarlo Caione resp = (struct hci_rp_read_local_version *)skb->data; 532a5c76e67SHans de Goede rtl_dev_info(hdev, "rtl: examining hci_ver=%02x hci_rev=%04x lmp_ver=%02x lmp_subver=%04x\n", 5332064ee33SMarcel Holtmann resp->hci_ver, resp->hci_rev, 534db33c77dSCarlo Caione resp->lmp_ver, resp->lmp_subver); 535db33c77dSCarlo Caione 536c50903e3SMartin Blumenstingl hci_ver = resp->hci_ver; 537907f8499SAlex Lu hci_rev = le16_to_cpu(resp->hci_rev); 538db33c77dSCarlo Caione lmp_subver = le16_to_cpu(resp->lmp_subver); 539db33c77dSCarlo Caione kfree_skb(skb); 540db33c77dSCarlo Caione 541c50903e3SMartin Blumenstingl btrtl_dev->ic_info = btrtl_match_ic(lmp_subver, hci_rev, hci_ver, 542c50903e3SMartin Blumenstingl hdev->bus); 543c50903e3SMartin Blumenstingl 54426503ad2SMartin Blumenstingl if (!btrtl_dev->ic_info) { 54500df214bSKai-Heng Feng rtl_dev_info(hdev, "rtl: unknown IC info, lmp subver %04x, hci rev %04x, hci ver %04x", 546c50903e3SMartin Blumenstingl lmp_subver, hci_rev, hci_ver); 54700df214bSKai-Heng Feng return btrtl_dev; 54826503ad2SMartin Blumenstingl } 54926503ad2SMartin Blumenstingl 55026503ad2SMartin Blumenstingl if (btrtl_dev->ic_info->has_rom_version) { 55126503ad2SMartin Blumenstingl ret = rtl_read_rom_version(hdev, &btrtl_dev->rom_version); 55226503ad2SMartin Blumenstingl if (ret) 55326503ad2SMartin Blumenstingl goto err_free; 55426503ad2SMartin Blumenstingl } 55526503ad2SMartin Blumenstingl 55626503ad2SMartin Blumenstingl btrtl_dev->fw_len = rtl_load_file(hdev, btrtl_dev->ic_info->fw_name, 55726503ad2SMartin Blumenstingl &btrtl_dev->fw_data); 55826503ad2SMartin Blumenstingl if (btrtl_dev->fw_len < 0) { 55926503ad2SMartin Blumenstingl rtl_dev_err(hdev, "firmware file %s not found\n", 56026503ad2SMartin Blumenstingl btrtl_dev->ic_info->fw_name); 56126503ad2SMartin Blumenstingl ret = btrtl_dev->fw_len; 56226503ad2SMartin Blumenstingl goto err_free; 56326503ad2SMartin Blumenstingl } 56426503ad2SMartin Blumenstingl 56526503ad2SMartin Blumenstingl if (btrtl_dev->ic_info->cfg_name) { 5661cc194caSHans de Goede if (postfix) { 5671cc194caSHans de Goede snprintf(cfg_name, sizeof(cfg_name), "%s-%s.bin", 5681cc194caSHans de Goede btrtl_dev->ic_info->cfg_name, postfix); 5691cc194caSHans de Goede } else { 5701cc194caSHans de Goede snprintf(cfg_name, sizeof(cfg_name), "%s.bin", 5711cc194caSHans de Goede btrtl_dev->ic_info->cfg_name); 5721cc194caSHans de Goede } 5731cc194caSHans de Goede btrtl_dev->cfg_len = rtl_load_file(hdev, cfg_name, 57426503ad2SMartin Blumenstingl &btrtl_dev->cfg_data); 57526503ad2SMartin Blumenstingl if (btrtl_dev->ic_info->config_needed && 57626503ad2SMartin Blumenstingl btrtl_dev->cfg_len <= 0) { 57726503ad2SMartin Blumenstingl rtl_dev_err(hdev, "mandatory config file %s not found\n", 57826503ad2SMartin Blumenstingl btrtl_dev->ic_info->cfg_name); 57926503ad2SMartin Blumenstingl ret = btrtl_dev->cfg_len; 58026503ad2SMartin Blumenstingl goto err_free; 58126503ad2SMartin Blumenstingl } 58226503ad2SMartin Blumenstingl } 58326503ad2SMartin Blumenstingl 58426503ad2SMartin Blumenstingl return btrtl_dev; 58526503ad2SMartin Blumenstingl 58626503ad2SMartin Blumenstingl err_free: 58726503ad2SMartin Blumenstingl btrtl_free(btrtl_dev); 58826503ad2SMartin Blumenstingl err_alloc: 58926503ad2SMartin Blumenstingl return ERR_PTR(ret); 59026503ad2SMartin Blumenstingl } 59126503ad2SMartin Blumenstingl EXPORT_SYMBOL_GPL(btrtl_initialize); 59226503ad2SMartin Blumenstingl 59326503ad2SMartin Blumenstingl int btrtl_download_firmware(struct hci_dev *hdev, 59426503ad2SMartin Blumenstingl struct btrtl_device_info *btrtl_dev) 59526503ad2SMartin Blumenstingl { 596db33c77dSCarlo Caione /* Match a set of subver values that correspond to stock firmware, 597db33c77dSCarlo Caione * which is not compatible with standard btusb. 598db33c77dSCarlo Caione * If matched, upload an alternative firmware that does conform to 599db33c77dSCarlo Caione * standard btusb. Once that firmware is uploaded, the subver changes 600db33c77dSCarlo Caione * to a different value. 601db33c77dSCarlo Caione */ 60200df214bSKai-Heng Feng if (!btrtl_dev->ic_info) { 60300df214bSKai-Heng Feng rtl_dev_info(hdev, "rtl: assuming no firmware upload needed\n"); 60400df214bSKai-Heng Feng return 0; 60500df214bSKai-Heng Feng } 60600df214bSKai-Heng Feng 60726503ad2SMartin Blumenstingl switch (btrtl_dev->ic_info->lmp_subver) { 608db33c77dSCarlo Caione case RTL_ROM_LMP_8723A: 609db33c77dSCarlo Caione case RTL_ROM_LMP_3499: 61026503ad2SMartin Blumenstingl return btrtl_setup_rtl8723a(hdev, btrtl_dev); 611db33c77dSCarlo Caione case RTL_ROM_LMP_8723B: 612db33c77dSCarlo Caione case RTL_ROM_LMP_8821A: 613db33c77dSCarlo Caione case RTL_ROM_LMP_8761A: 6141110a2dbSLarry Finger case RTL_ROM_LMP_8822B: 61526503ad2SMartin Blumenstingl return btrtl_setup_rtl8723b(hdev, btrtl_dev); 616db33c77dSCarlo Caione default: 617a5c76e67SHans de Goede rtl_dev_info(hdev, "rtl: assuming no firmware upload needed\n"); 618db33c77dSCarlo Caione return 0; 619db33c77dSCarlo Caione } 620db33c77dSCarlo Caione } 62126503ad2SMartin Blumenstingl EXPORT_SYMBOL_GPL(btrtl_download_firmware); 62226503ad2SMartin Blumenstingl 62326503ad2SMartin Blumenstingl int btrtl_setup_realtek(struct hci_dev *hdev) 62426503ad2SMartin Blumenstingl { 62526503ad2SMartin Blumenstingl struct btrtl_device_info *btrtl_dev; 62626503ad2SMartin Blumenstingl int ret; 62726503ad2SMartin Blumenstingl 6281cc194caSHans de Goede btrtl_dev = btrtl_initialize(hdev, NULL); 62926503ad2SMartin Blumenstingl if (IS_ERR(btrtl_dev)) 63026503ad2SMartin Blumenstingl return PTR_ERR(btrtl_dev); 63126503ad2SMartin Blumenstingl 63226503ad2SMartin Blumenstingl ret = btrtl_download_firmware(hdev, btrtl_dev); 63326503ad2SMartin Blumenstingl 63426503ad2SMartin Blumenstingl btrtl_free(btrtl_dev); 63526503ad2SMartin Blumenstingl 63626503ad2SMartin Blumenstingl return ret; 63726503ad2SMartin Blumenstingl } 638db33c77dSCarlo Caione EXPORT_SYMBOL_GPL(btrtl_setup_realtek); 639db33c77dSCarlo Caione 640b85b0ee1SMartin Blumenstingl static unsigned int btrtl_convert_baudrate(u32 device_baudrate) 641b85b0ee1SMartin Blumenstingl { 642b85b0ee1SMartin Blumenstingl switch (device_baudrate) { 643b85b0ee1SMartin Blumenstingl case 0x0252a00a: 644b85b0ee1SMartin Blumenstingl return 230400; 645b85b0ee1SMartin Blumenstingl 646b85b0ee1SMartin Blumenstingl case 0x05f75004: 647b85b0ee1SMartin Blumenstingl return 921600; 648b85b0ee1SMartin Blumenstingl 649b85b0ee1SMartin Blumenstingl case 0x00005004: 650b85b0ee1SMartin Blumenstingl return 1000000; 651b85b0ee1SMartin Blumenstingl 652b85b0ee1SMartin Blumenstingl case 0x04928002: 653b85b0ee1SMartin Blumenstingl case 0x01128002: 654b85b0ee1SMartin Blumenstingl return 1500000; 655b85b0ee1SMartin Blumenstingl 656b85b0ee1SMartin Blumenstingl case 0x00005002: 657b85b0ee1SMartin Blumenstingl return 2000000; 658b85b0ee1SMartin Blumenstingl 659b85b0ee1SMartin Blumenstingl case 0x0000b001: 660b85b0ee1SMartin Blumenstingl return 2500000; 661b85b0ee1SMartin Blumenstingl 662b85b0ee1SMartin Blumenstingl case 0x04928001: 663b85b0ee1SMartin Blumenstingl return 3000000; 664b85b0ee1SMartin Blumenstingl 665b85b0ee1SMartin Blumenstingl case 0x052a6001: 666b85b0ee1SMartin Blumenstingl return 3500000; 667b85b0ee1SMartin Blumenstingl 668b85b0ee1SMartin Blumenstingl case 0x00005001: 669b85b0ee1SMartin Blumenstingl return 4000000; 670b85b0ee1SMartin Blumenstingl 671b85b0ee1SMartin Blumenstingl case 0x0252c014: 672b85b0ee1SMartin Blumenstingl default: 673b85b0ee1SMartin Blumenstingl return 115200; 674b85b0ee1SMartin Blumenstingl } 675b85b0ee1SMartin Blumenstingl } 676b85b0ee1SMartin Blumenstingl 677b85b0ee1SMartin Blumenstingl int btrtl_get_uart_settings(struct hci_dev *hdev, 678b85b0ee1SMartin Blumenstingl struct btrtl_device_info *btrtl_dev, 679b85b0ee1SMartin Blumenstingl unsigned int *controller_baudrate, 680b85b0ee1SMartin Blumenstingl u32 *device_baudrate, bool *flow_control) 681b85b0ee1SMartin Blumenstingl { 682b85b0ee1SMartin Blumenstingl struct rtl_vendor_config *config; 683b85b0ee1SMartin Blumenstingl struct rtl_vendor_config_entry *entry; 684b85b0ee1SMartin Blumenstingl int i, total_data_len; 685b85b0ee1SMartin Blumenstingl bool found = false; 686b85b0ee1SMartin Blumenstingl 687b85b0ee1SMartin Blumenstingl total_data_len = btrtl_dev->cfg_len - sizeof(*config); 688b85b0ee1SMartin Blumenstingl if (total_data_len <= 0) { 689b85b0ee1SMartin Blumenstingl rtl_dev_warn(hdev, "no config loaded\n"); 690b85b0ee1SMartin Blumenstingl return -EINVAL; 691b85b0ee1SMartin Blumenstingl } 692b85b0ee1SMartin Blumenstingl 693b85b0ee1SMartin Blumenstingl config = (struct rtl_vendor_config *)btrtl_dev->cfg_data; 694b85b0ee1SMartin Blumenstingl if (le32_to_cpu(config->signature) != RTL_CONFIG_MAGIC) { 695b85b0ee1SMartin Blumenstingl rtl_dev_err(hdev, "invalid config magic\n"); 696b85b0ee1SMartin Blumenstingl return -EINVAL; 697b85b0ee1SMartin Blumenstingl } 698b85b0ee1SMartin Blumenstingl 699b85b0ee1SMartin Blumenstingl if (total_data_len < le16_to_cpu(config->total_len)) { 700b85b0ee1SMartin Blumenstingl rtl_dev_err(hdev, "config is too short\n"); 701b85b0ee1SMartin Blumenstingl return -EINVAL; 702b85b0ee1SMartin Blumenstingl } 703b85b0ee1SMartin Blumenstingl 704b85b0ee1SMartin Blumenstingl for (i = 0; i < total_data_len; ) { 705b85b0ee1SMartin Blumenstingl entry = ((void *)config->entry) + i; 706b85b0ee1SMartin Blumenstingl 707b85b0ee1SMartin Blumenstingl switch (le16_to_cpu(entry->offset)) { 708b85b0ee1SMartin Blumenstingl case 0xc: 709b85b0ee1SMartin Blumenstingl if (entry->len < sizeof(*device_baudrate)) { 710b85b0ee1SMartin Blumenstingl rtl_dev_err(hdev, "invalid UART config entry\n"); 711b85b0ee1SMartin Blumenstingl return -EINVAL; 712b85b0ee1SMartin Blumenstingl } 713b85b0ee1SMartin Blumenstingl 714b85b0ee1SMartin Blumenstingl *device_baudrate = get_unaligned_le32(entry->data); 715b85b0ee1SMartin Blumenstingl *controller_baudrate = btrtl_convert_baudrate( 716b85b0ee1SMartin Blumenstingl *device_baudrate); 717b85b0ee1SMartin Blumenstingl 718b85b0ee1SMartin Blumenstingl if (entry->len >= 13) 719b85b0ee1SMartin Blumenstingl *flow_control = !!(entry->data[12] & BIT(2)); 720b85b0ee1SMartin Blumenstingl else 721b85b0ee1SMartin Blumenstingl *flow_control = false; 722b85b0ee1SMartin Blumenstingl 723b85b0ee1SMartin Blumenstingl found = true; 724b85b0ee1SMartin Blumenstingl break; 725b85b0ee1SMartin Blumenstingl 726b85b0ee1SMartin Blumenstingl default: 727b85b0ee1SMartin Blumenstingl rtl_dev_dbg(hdev, "skipping config entry 0x%x (len %u)\n", 728b85b0ee1SMartin Blumenstingl le16_to_cpu(entry->offset), entry->len); 729b85b0ee1SMartin Blumenstingl break; 730b85b0ee1SMartin Blumenstingl }; 731b85b0ee1SMartin Blumenstingl 732b85b0ee1SMartin Blumenstingl i += sizeof(*entry) + entry->len; 733b85b0ee1SMartin Blumenstingl } 734b85b0ee1SMartin Blumenstingl 735b85b0ee1SMartin Blumenstingl if (!found) { 736b85b0ee1SMartin Blumenstingl rtl_dev_err(hdev, "no UART config entry found\n"); 737b85b0ee1SMartin Blumenstingl return -ENOENT; 738b85b0ee1SMartin Blumenstingl } 739b85b0ee1SMartin Blumenstingl 740b85b0ee1SMartin Blumenstingl rtl_dev_dbg(hdev, "device baudrate = 0x%08x\n", *device_baudrate); 741b85b0ee1SMartin Blumenstingl rtl_dev_dbg(hdev, "controller baudrate = %u\n", *controller_baudrate); 742b85b0ee1SMartin Blumenstingl rtl_dev_dbg(hdev, "flow control %d\n", *flow_control); 743b85b0ee1SMartin Blumenstingl 744b85b0ee1SMartin Blumenstingl return 0; 745b85b0ee1SMartin Blumenstingl } 746b85b0ee1SMartin Blumenstingl EXPORT_SYMBOL_GPL(btrtl_get_uart_settings); 747b85b0ee1SMartin Blumenstingl 748db33c77dSCarlo Caione MODULE_AUTHOR("Daniel Drake <drake@endlessm.com>"); 749db33c77dSCarlo Caione MODULE_DESCRIPTION("Bluetooth support for Realtek devices ver " VERSION); 750db33c77dSCarlo Caione MODULE_VERSION(VERSION); 751db33c77dSCarlo Caione MODULE_LICENSE("GPL"); 752f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723a_fw.bin"); 753f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723b_fw.bin"); 754f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723b_config.bin"); 755c50903e3SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723bs_fw.bin"); 756c50903e3SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723bs_config.bin"); 757c50903e3SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723ds_fw.bin"); 758c50903e3SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723ds_config.bin"); 759f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8761a_fw.bin"); 760f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8761a_config.bin"); 761f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8821a_fw.bin"); 762f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8821a_config.bin"); 763f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8822b_fw.bin"); 764f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8822b_config.bin"); 765