1db33c77dSCarlo Caione /* 2db33c77dSCarlo Caione * Bluetooth support for Realtek devices 3db33c77dSCarlo Caione * 4db33c77dSCarlo Caione * Copyright (C) 2015 Endless Mobile, Inc. 5db33c77dSCarlo Caione * 6db33c77dSCarlo Caione * This program is free software; you can redistribute it and/or modify 7db33c77dSCarlo Caione * it under the terms of the GNU General Public License as published by 8db33c77dSCarlo Caione * the Free Software Foundation; either version 2 of the License, or 9db33c77dSCarlo Caione * (at your option) any later version. 10db33c77dSCarlo Caione * 11db33c77dSCarlo Caione * This program is distributed in the hope that it will be useful, 12db33c77dSCarlo Caione * but WITHOUT ANY WARRANTY; without even the implied warranty of 13db33c77dSCarlo Caione * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14db33c77dSCarlo Caione * GNU General Public License for more details. 15db33c77dSCarlo Caione * 16db33c77dSCarlo Caione */ 17db33c77dSCarlo Caione 18db33c77dSCarlo Caione #include <linux/module.h> 19db33c77dSCarlo Caione #include <linux/firmware.h> 20db33c77dSCarlo Caione #include <asm/unaligned.h> 21db33c77dSCarlo Caione #include <linux/usb.h> 22db33c77dSCarlo Caione 23db33c77dSCarlo Caione #include <net/bluetooth/bluetooth.h> 24db33c77dSCarlo Caione #include <net/bluetooth/hci_core.h> 25db33c77dSCarlo Caione 26db33c77dSCarlo Caione #include "btrtl.h" 27db33c77dSCarlo Caione 28db33c77dSCarlo Caione #define VERSION "0.1" 29db33c77dSCarlo Caione 30db33c77dSCarlo Caione #define RTL_EPATCH_SIGNATURE "Realtech" 31db33c77dSCarlo Caione #define RTL_ROM_LMP_3499 0x3499 32db33c77dSCarlo Caione #define RTL_ROM_LMP_8723A 0x1200 33db33c77dSCarlo Caione #define RTL_ROM_LMP_8723B 0x8723 34db33c77dSCarlo Caione #define RTL_ROM_LMP_8821A 0x8821 35db33c77dSCarlo Caione #define RTL_ROM_LMP_8761A 0x8761 361110a2dbSLarry Finger #define RTL_ROM_LMP_8822B 0x8822 37b85b0ee1SMartin Blumenstingl #define RTL_CONFIG_MAGIC 0x8723ab55 38db33c77dSCarlo Caione 39907f8499SAlex Lu #define IC_MATCH_FL_LMPSUBV (1 << 0) 40907f8499SAlex Lu #define IC_MATCH_FL_HCIREV (1 << 1) 41c50903e3SMartin Blumenstingl #define IC_MATCH_FL_HCIVER (1 << 2) 42c50903e3SMartin Blumenstingl #define IC_MATCH_FL_HCIBUS (1 << 3) 43907f8499SAlex Lu #define IC_INFO(lmps, hcir) \ 44907f8499SAlex Lu .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_HCIREV, \ 45907f8499SAlex Lu .lmp_subver = (lmps), \ 46907f8499SAlex Lu .hci_rev = (hcir) 47907f8499SAlex Lu 48907f8499SAlex Lu struct id_table { 49907f8499SAlex Lu __u16 match_flags; 50907f8499SAlex Lu __u16 lmp_subver; 51907f8499SAlex Lu __u16 hci_rev; 52c50903e3SMartin Blumenstingl __u8 hci_ver; 53c50903e3SMartin Blumenstingl __u8 hci_bus; 54907f8499SAlex Lu bool config_needed; 5526503ad2SMartin Blumenstingl bool has_rom_version; 56907f8499SAlex Lu char *fw_name; 57907f8499SAlex Lu char *cfg_name; 58907f8499SAlex Lu }; 59907f8499SAlex Lu 6026503ad2SMartin Blumenstingl struct btrtl_device_info { 6126503ad2SMartin Blumenstingl const struct id_table *ic_info; 6226503ad2SMartin Blumenstingl u8 rom_version; 6326503ad2SMartin Blumenstingl u8 *fw_data; 6426503ad2SMartin Blumenstingl int fw_len; 6526503ad2SMartin Blumenstingl u8 *cfg_data; 6626503ad2SMartin Blumenstingl int cfg_len; 6726503ad2SMartin Blumenstingl }; 6826503ad2SMartin Blumenstingl 69907f8499SAlex Lu static const struct id_table ic_id_table[] = { 7026503ad2SMartin Blumenstingl { IC_MATCH_FL_LMPSUBV, RTL_ROM_LMP_8723A, 0x0, 7126503ad2SMartin Blumenstingl .config_needed = false, 7226503ad2SMartin Blumenstingl .has_rom_version = false, 7326503ad2SMartin Blumenstingl .fw_name = "rtl_bt/rtl8723a_fw.bin", 7426503ad2SMartin Blumenstingl .cfg_name = NULL }, 7526503ad2SMartin Blumenstingl 7626503ad2SMartin Blumenstingl { IC_MATCH_FL_LMPSUBV, RTL_ROM_LMP_3499, 0x0, 7726503ad2SMartin Blumenstingl .config_needed = false, 7826503ad2SMartin Blumenstingl .has_rom_version = false, 7926503ad2SMartin Blumenstingl .fw_name = "rtl_bt/rtl8723a_fw.bin", 8026503ad2SMartin Blumenstingl .cfg_name = NULL }, 8126503ad2SMartin Blumenstingl 82c50903e3SMartin Blumenstingl /* 8723BS */ 83c50903e3SMartin Blumenstingl { .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_HCIREV | 84c50903e3SMartin Blumenstingl IC_MATCH_FL_HCIVER | IC_MATCH_FL_HCIBUS, 85c50903e3SMartin Blumenstingl .lmp_subver = RTL_ROM_LMP_8723B, 86c50903e3SMartin Blumenstingl .hci_rev = 0xb, 87c50903e3SMartin Blumenstingl .hci_ver = 6, 88c50903e3SMartin Blumenstingl .hci_bus = HCI_UART, 89c50903e3SMartin Blumenstingl .config_needed = true, 90c50903e3SMartin Blumenstingl .has_rom_version = true, 91c50903e3SMartin Blumenstingl .fw_name = "rtl_bt/rtl8723bs_fw.bin", 921cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8723bs_config" }, 93c50903e3SMartin Blumenstingl 94907f8499SAlex Lu /* 8723B */ 95907f8499SAlex Lu { IC_INFO(RTL_ROM_LMP_8723B, 0xb), 96907f8499SAlex Lu .config_needed = false, 9726503ad2SMartin Blumenstingl .has_rom_version = true, 98907f8499SAlex Lu .fw_name = "rtl_bt/rtl8723b_fw.bin", 991cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8723b_config" }, 100907f8499SAlex Lu 101907f8499SAlex Lu /* 8723D */ 102907f8499SAlex Lu { IC_INFO(RTL_ROM_LMP_8723B, 0xd), 103907f8499SAlex Lu .config_needed = true, 10426503ad2SMartin Blumenstingl .has_rom_version = true, 105907f8499SAlex Lu .fw_name = "rtl_bt/rtl8723d_fw.bin", 1061cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8723d_config" }, 107907f8499SAlex Lu 108c50903e3SMartin Blumenstingl /* 8723DS */ 109c50903e3SMartin Blumenstingl { .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_HCIREV | 110c50903e3SMartin Blumenstingl IC_MATCH_FL_HCIVER | IC_MATCH_FL_HCIBUS, 111c50903e3SMartin Blumenstingl .lmp_subver = RTL_ROM_LMP_8723B, 112c50903e3SMartin Blumenstingl .hci_rev = 0xd, 113c50903e3SMartin Blumenstingl .hci_ver = 8, 114c50903e3SMartin Blumenstingl .hci_bus = HCI_UART, 115c50903e3SMartin Blumenstingl .config_needed = true, 116c50903e3SMartin Blumenstingl .has_rom_version = true, 117c50903e3SMartin Blumenstingl .fw_name = "rtl_bt/rtl8723ds_fw.bin", 1181cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8723ds_config" }, 119c50903e3SMartin Blumenstingl 120907f8499SAlex Lu /* 8821A */ 121907f8499SAlex Lu { IC_INFO(RTL_ROM_LMP_8821A, 0xa), 122907f8499SAlex Lu .config_needed = false, 12326503ad2SMartin Blumenstingl .has_rom_version = true, 124907f8499SAlex Lu .fw_name = "rtl_bt/rtl8821a_fw.bin", 1251cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8821a_config" }, 126907f8499SAlex Lu 127907f8499SAlex Lu /* 8821C */ 128907f8499SAlex Lu { IC_INFO(RTL_ROM_LMP_8821A, 0xc), 129907f8499SAlex Lu .config_needed = false, 13026503ad2SMartin Blumenstingl .has_rom_version = true, 131907f8499SAlex Lu .fw_name = "rtl_bt/rtl8821c_fw.bin", 1321cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8821c_config" }, 133907f8499SAlex Lu 134907f8499SAlex Lu /* 8761A */ 135907f8499SAlex Lu { IC_MATCH_FL_LMPSUBV, RTL_ROM_LMP_8761A, 0x0, 136907f8499SAlex Lu .config_needed = false, 13726503ad2SMartin Blumenstingl .has_rom_version = true, 138907f8499SAlex Lu .fw_name = "rtl_bt/rtl8761a_fw.bin", 1391cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8761a_config" }, 140907f8499SAlex Lu 141907f8499SAlex Lu /* 8822B */ 142907f8499SAlex Lu { IC_INFO(RTL_ROM_LMP_8822B, 0xb), 143907f8499SAlex Lu .config_needed = true, 14426503ad2SMartin Blumenstingl .has_rom_version = true, 145907f8499SAlex Lu .fw_name = "rtl_bt/rtl8822b_fw.bin", 1461cc194caSHans de Goede .cfg_name = "rtl_bt/rtl8822b_config" }, 147907f8499SAlex Lu }; 148907f8499SAlex Lu 149c50903e3SMartin Blumenstingl static const struct id_table *btrtl_match_ic(u16 lmp_subver, u16 hci_rev, 150c50903e3SMartin Blumenstingl u8 hci_ver, u8 hci_bus) 15126503ad2SMartin Blumenstingl { 15226503ad2SMartin Blumenstingl int i; 15326503ad2SMartin Blumenstingl 15426503ad2SMartin Blumenstingl for (i = 0; i < ARRAY_SIZE(ic_id_table); i++) { 15526503ad2SMartin Blumenstingl if ((ic_id_table[i].match_flags & IC_MATCH_FL_LMPSUBV) && 15626503ad2SMartin Blumenstingl (ic_id_table[i].lmp_subver != lmp_subver)) 15726503ad2SMartin Blumenstingl continue; 15826503ad2SMartin Blumenstingl if ((ic_id_table[i].match_flags & IC_MATCH_FL_HCIREV) && 15926503ad2SMartin Blumenstingl (ic_id_table[i].hci_rev != hci_rev)) 16026503ad2SMartin Blumenstingl continue; 161c50903e3SMartin Blumenstingl if ((ic_id_table[i].match_flags & IC_MATCH_FL_HCIVER) && 162c50903e3SMartin Blumenstingl (ic_id_table[i].hci_ver != hci_ver)) 163c50903e3SMartin Blumenstingl continue; 164c50903e3SMartin Blumenstingl if ((ic_id_table[i].match_flags & IC_MATCH_FL_HCIBUS) && 165c50903e3SMartin Blumenstingl (ic_id_table[i].hci_bus != hci_bus)) 166c50903e3SMartin Blumenstingl continue; 16726503ad2SMartin Blumenstingl 16826503ad2SMartin Blumenstingl break; 16926503ad2SMartin Blumenstingl } 17026503ad2SMartin Blumenstingl if (i >= ARRAY_SIZE(ic_id_table)) 17126503ad2SMartin Blumenstingl return NULL; 17226503ad2SMartin Blumenstingl 17326503ad2SMartin Blumenstingl return &ic_id_table[i]; 17426503ad2SMartin Blumenstingl } 17526503ad2SMartin Blumenstingl 176db33c77dSCarlo Caione static int rtl_read_rom_version(struct hci_dev *hdev, u8 *version) 177db33c77dSCarlo Caione { 178db33c77dSCarlo Caione struct rtl_rom_version_evt *rom_version; 179db33c77dSCarlo Caione struct sk_buff *skb; 180db33c77dSCarlo Caione 181db33c77dSCarlo Caione /* Read RTL ROM version command */ 182db33c77dSCarlo Caione skb = __hci_cmd_sync(hdev, 0xfc6d, 0, NULL, HCI_INIT_TIMEOUT); 183db33c77dSCarlo Caione if (IS_ERR(skb)) { 184a5c76e67SHans de Goede rtl_dev_err(hdev, "Read ROM version failed (%ld)\n", 185a5c76e67SHans de Goede PTR_ERR(skb)); 186db33c77dSCarlo Caione return PTR_ERR(skb); 187db33c77dSCarlo Caione } 188db33c77dSCarlo Caione 189db33c77dSCarlo Caione if (skb->len != sizeof(*rom_version)) { 190a5c76e67SHans de Goede rtl_dev_err(hdev, "RTL version event length mismatch\n"); 191db33c77dSCarlo Caione kfree_skb(skb); 192db33c77dSCarlo Caione return -EIO; 193db33c77dSCarlo Caione } 194db33c77dSCarlo Caione 195db33c77dSCarlo Caione rom_version = (struct rtl_rom_version_evt *)skb->data; 196a5c76e67SHans de Goede rtl_dev_info(hdev, "rom_version status=%x version=%x\n", 1972064ee33SMarcel Holtmann rom_version->status, rom_version->version); 198db33c77dSCarlo Caione 199db33c77dSCarlo Caione *version = rom_version->version; 200db33c77dSCarlo Caione 201db33c77dSCarlo Caione kfree_skb(skb); 202db33c77dSCarlo Caione return 0; 203db33c77dSCarlo Caione } 204db33c77dSCarlo Caione 20526503ad2SMartin Blumenstingl static int rtlbt_parse_firmware(struct hci_dev *hdev, 20626503ad2SMartin Blumenstingl struct btrtl_device_info *btrtl_dev, 207db33c77dSCarlo Caione unsigned char **_buf) 208db33c77dSCarlo Caione { 209*e5070e07SColin Ian King static const u8 extension_sig[] = { 0x51, 0x04, 0xfd, 0x77 }; 210db33c77dSCarlo Caione struct rtl_epatch_header *epatch_info; 211db33c77dSCarlo Caione unsigned char *buf; 21226503ad2SMartin Blumenstingl int i, len; 213db33c77dSCarlo Caione size_t min_size; 21426503ad2SMartin Blumenstingl u8 opcode, length, data; 215db33c77dSCarlo Caione int project_id = -1; 216db33c77dSCarlo Caione const unsigned char *fwptr, *chip_id_base; 217db33c77dSCarlo Caione const unsigned char *patch_length_base, *patch_offset_base; 218db33c77dSCarlo Caione u32 patch_offset = 0; 219db33c77dSCarlo Caione u16 patch_length, num_patches; 2201110a2dbSLarry Finger static const struct { 2211110a2dbSLarry Finger __u16 lmp_subver; 2221110a2dbSLarry Finger __u8 id; 2231110a2dbSLarry Finger } project_id_to_lmp_subver[] = { 2241110a2dbSLarry Finger { RTL_ROM_LMP_8723A, 0 }, 2251110a2dbSLarry Finger { RTL_ROM_LMP_8723B, 1 }, 2261110a2dbSLarry Finger { RTL_ROM_LMP_8821A, 2 }, 2271110a2dbSLarry Finger { RTL_ROM_LMP_8761A, 3 }, 2281110a2dbSLarry Finger { RTL_ROM_LMP_8822B, 8 }, 229907f8499SAlex Lu { RTL_ROM_LMP_8723B, 9 }, /* 8723D */ 230907f8499SAlex Lu { RTL_ROM_LMP_8821A, 10 }, /* 8821C */ 231db33c77dSCarlo Caione }; 232db33c77dSCarlo Caione 233db33c77dSCarlo Caione min_size = sizeof(struct rtl_epatch_header) + sizeof(extension_sig) + 3; 23426503ad2SMartin Blumenstingl if (btrtl_dev->fw_len < min_size) 235db33c77dSCarlo Caione return -EINVAL; 236db33c77dSCarlo Caione 23726503ad2SMartin Blumenstingl fwptr = btrtl_dev->fw_data + btrtl_dev->fw_len - sizeof(extension_sig); 238db33c77dSCarlo Caione if (memcmp(fwptr, extension_sig, sizeof(extension_sig)) != 0) { 239a5c76e67SHans de Goede rtl_dev_err(hdev, "extension section signature mismatch\n"); 240db33c77dSCarlo Caione return -EINVAL; 241db33c77dSCarlo Caione } 242db33c77dSCarlo Caione 243db33c77dSCarlo Caione /* Loop from the end of the firmware parsing instructions, until 244db33c77dSCarlo Caione * we find an instruction that identifies the "project ID" for the 245db33c77dSCarlo Caione * hardware supported by this firwmare file. 246db33c77dSCarlo Caione * Once we have that, we double-check that that project_id is suitable 247db33c77dSCarlo Caione * for the hardware we are working with. 248db33c77dSCarlo Caione */ 24926503ad2SMartin Blumenstingl while (fwptr >= btrtl_dev->fw_data + (sizeof(*epatch_info) + 3)) { 250db33c77dSCarlo Caione opcode = *--fwptr; 251db33c77dSCarlo Caione length = *--fwptr; 252db33c77dSCarlo Caione data = *--fwptr; 253db33c77dSCarlo Caione 254db33c77dSCarlo Caione BT_DBG("check op=%x len=%x data=%x", opcode, length, data); 255db33c77dSCarlo Caione 256db33c77dSCarlo Caione if (opcode == 0xff) /* EOF */ 257db33c77dSCarlo Caione break; 258db33c77dSCarlo Caione 259db33c77dSCarlo Caione if (length == 0) { 260a5c76e67SHans de Goede rtl_dev_err(hdev, "found instruction with length 0\n"); 261db33c77dSCarlo Caione return -EINVAL; 262db33c77dSCarlo Caione } 263db33c77dSCarlo Caione 264db33c77dSCarlo Caione if (opcode == 0 && length == 1) { 265db33c77dSCarlo Caione project_id = data; 266db33c77dSCarlo Caione break; 267db33c77dSCarlo Caione } 268db33c77dSCarlo Caione 269db33c77dSCarlo Caione fwptr -= length; 270db33c77dSCarlo Caione } 271db33c77dSCarlo Caione 272db33c77dSCarlo Caione if (project_id < 0) { 273a5c76e67SHans de Goede rtl_dev_err(hdev, "failed to find version instruction\n"); 274db33c77dSCarlo Caione return -EINVAL; 275db33c77dSCarlo Caione } 276db33c77dSCarlo Caione 2771110a2dbSLarry Finger /* Find project_id in table */ 2781110a2dbSLarry Finger for (i = 0; i < ARRAY_SIZE(project_id_to_lmp_subver); i++) { 2791110a2dbSLarry Finger if (project_id == project_id_to_lmp_subver[i].id) 2801110a2dbSLarry Finger break; 2811110a2dbSLarry Finger } 2821110a2dbSLarry Finger 2831110a2dbSLarry Finger if (i >= ARRAY_SIZE(project_id_to_lmp_subver)) { 284a5c76e67SHans de Goede rtl_dev_err(hdev, "unknown project id %d\n", project_id); 285db33c77dSCarlo Caione return -EINVAL; 286db33c77dSCarlo Caione } 287db33c77dSCarlo Caione 28826503ad2SMartin Blumenstingl if (btrtl_dev->ic_info->lmp_subver != 28926503ad2SMartin Blumenstingl project_id_to_lmp_subver[i].lmp_subver) { 290a5c76e67SHans de Goede rtl_dev_err(hdev, "firmware is for %x but this is a %x\n", 29126503ad2SMartin Blumenstingl project_id_to_lmp_subver[i].lmp_subver, 29226503ad2SMartin Blumenstingl btrtl_dev->ic_info->lmp_subver); 293db33c77dSCarlo Caione return -EINVAL; 294db33c77dSCarlo Caione } 295db33c77dSCarlo Caione 29626503ad2SMartin Blumenstingl epatch_info = (struct rtl_epatch_header *)btrtl_dev->fw_data; 297db33c77dSCarlo Caione if (memcmp(epatch_info->signature, RTL_EPATCH_SIGNATURE, 8) != 0) { 298a5c76e67SHans de Goede rtl_dev_err(hdev, "bad EPATCH signature\n"); 299db33c77dSCarlo Caione return -EINVAL; 300db33c77dSCarlo Caione } 301db33c77dSCarlo Caione 302db33c77dSCarlo Caione num_patches = le16_to_cpu(epatch_info->num_patches); 303db33c77dSCarlo Caione BT_DBG("fw_version=%x, num_patches=%d", 304db33c77dSCarlo Caione le32_to_cpu(epatch_info->fw_version), num_patches); 305db33c77dSCarlo Caione 306db33c77dSCarlo Caione /* After the rtl_epatch_header there is a funky patch metadata section. 307db33c77dSCarlo Caione * Assuming 2 patches, the layout is: 308db33c77dSCarlo Caione * ChipID1 ChipID2 PatchLength1 PatchLength2 PatchOffset1 PatchOffset2 309db33c77dSCarlo Caione * 310db33c77dSCarlo Caione * Find the right patch for this chip. 311db33c77dSCarlo Caione */ 312db33c77dSCarlo Caione min_size += 8 * num_patches; 31326503ad2SMartin Blumenstingl if (btrtl_dev->fw_len < min_size) 314db33c77dSCarlo Caione return -EINVAL; 315db33c77dSCarlo Caione 31626503ad2SMartin Blumenstingl chip_id_base = btrtl_dev->fw_data + sizeof(struct rtl_epatch_header); 317db33c77dSCarlo Caione patch_length_base = chip_id_base + (sizeof(u16) * num_patches); 318db33c77dSCarlo Caione patch_offset_base = patch_length_base + (sizeof(u16) * num_patches); 319db33c77dSCarlo Caione for (i = 0; i < num_patches; i++) { 320db33c77dSCarlo Caione u16 chip_id = get_unaligned_le16(chip_id_base + 321db33c77dSCarlo Caione (i * sizeof(u16))); 32226503ad2SMartin Blumenstingl if (chip_id == btrtl_dev->rom_version + 1) { 323db33c77dSCarlo Caione patch_length = get_unaligned_le16(patch_length_base + 324db33c77dSCarlo Caione (i * sizeof(u16))); 325db33c77dSCarlo Caione patch_offset = get_unaligned_le32(patch_offset_base + 326db33c77dSCarlo Caione (i * sizeof(u32))); 327db33c77dSCarlo Caione break; 328db33c77dSCarlo Caione } 329db33c77dSCarlo Caione } 330db33c77dSCarlo Caione 331db33c77dSCarlo Caione if (!patch_offset) { 332a5c76e67SHans de Goede rtl_dev_err(hdev, "didn't find patch for chip id %d", 333a5c76e67SHans de Goede btrtl_dev->rom_version); 334db33c77dSCarlo Caione return -EINVAL; 335db33c77dSCarlo Caione } 336db33c77dSCarlo Caione 337db33c77dSCarlo Caione BT_DBG("length=%x offset=%x index %d", patch_length, patch_offset, i); 338db33c77dSCarlo Caione min_size = patch_offset + patch_length; 33926503ad2SMartin Blumenstingl if (btrtl_dev->fw_len < min_size) 340db33c77dSCarlo Caione return -EINVAL; 341db33c77dSCarlo Caione 342db33c77dSCarlo Caione /* Copy the firmware into a new buffer and write the version at 343db33c77dSCarlo Caione * the end. 344db33c77dSCarlo Caione */ 345db33c77dSCarlo Caione len = patch_length; 34626503ad2SMartin Blumenstingl buf = kmemdup(btrtl_dev->fw_data + patch_offset, patch_length, 34726503ad2SMartin Blumenstingl GFP_KERNEL); 348db33c77dSCarlo Caione if (!buf) 349db33c77dSCarlo Caione return -ENOMEM; 350db33c77dSCarlo Caione 351db33c77dSCarlo Caione memcpy(buf + patch_length - 4, &epatch_info->fw_version, 4); 352db33c77dSCarlo Caione 353db33c77dSCarlo Caione *_buf = buf; 354db33c77dSCarlo Caione return len; 355db33c77dSCarlo Caione } 356db33c77dSCarlo Caione 357db33c77dSCarlo Caione static int rtl_download_firmware(struct hci_dev *hdev, 358db33c77dSCarlo Caione const unsigned char *data, int fw_len) 359db33c77dSCarlo Caione { 360db33c77dSCarlo Caione struct rtl_download_cmd *dl_cmd; 361db33c77dSCarlo Caione int frag_num = fw_len / RTL_FRAG_LEN + 1; 362db33c77dSCarlo Caione int frag_len = RTL_FRAG_LEN; 363db33c77dSCarlo Caione int ret = 0; 364db33c77dSCarlo Caione int i; 365db33c77dSCarlo Caione 366db33c77dSCarlo Caione dl_cmd = kmalloc(sizeof(struct rtl_download_cmd), GFP_KERNEL); 367db33c77dSCarlo Caione if (!dl_cmd) 368db33c77dSCarlo Caione return -ENOMEM; 369db33c77dSCarlo Caione 370db33c77dSCarlo Caione for (i = 0; i < frag_num; i++) { 371db33c77dSCarlo Caione struct sk_buff *skb; 372db33c77dSCarlo Caione 373db33c77dSCarlo Caione BT_DBG("download fw (%d/%d)", i, frag_num); 374db33c77dSCarlo Caione 375db33c77dSCarlo Caione dl_cmd->index = i; 376db33c77dSCarlo Caione if (i == (frag_num - 1)) { 377db33c77dSCarlo Caione dl_cmd->index |= 0x80; /* data end */ 378db33c77dSCarlo Caione frag_len = fw_len % RTL_FRAG_LEN; 379db33c77dSCarlo Caione } 380db33c77dSCarlo Caione memcpy(dl_cmd->data, data, frag_len); 381db33c77dSCarlo Caione 382db33c77dSCarlo Caione /* Send download command */ 383db33c77dSCarlo Caione skb = __hci_cmd_sync(hdev, 0xfc20, frag_len + 1, dl_cmd, 384db33c77dSCarlo Caione HCI_INIT_TIMEOUT); 385db33c77dSCarlo Caione if (IS_ERR(skb)) { 386a5c76e67SHans de Goede rtl_dev_err(hdev, "download fw command failed (%ld)\n", 387a5c76e67SHans de Goede PTR_ERR(skb)); 388db33c77dSCarlo Caione ret = -PTR_ERR(skb); 389db33c77dSCarlo Caione goto out; 390db33c77dSCarlo Caione } 391db33c77dSCarlo Caione 392db33c77dSCarlo Caione if (skb->len != sizeof(struct rtl_download_response)) { 393a5c76e67SHans de Goede rtl_dev_err(hdev, "download fw event length mismatch\n"); 394db33c77dSCarlo Caione kfree_skb(skb); 395db33c77dSCarlo Caione ret = -EIO; 396db33c77dSCarlo Caione goto out; 397db33c77dSCarlo Caione } 398db33c77dSCarlo Caione 399db33c77dSCarlo Caione kfree_skb(skb); 400db33c77dSCarlo Caione data += RTL_FRAG_LEN; 401db33c77dSCarlo Caione } 402db33c77dSCarlo Caione 403db33c77dSCarlo Caione out: 404db33c77dSCarlo Caione kfree(dl_cmd); 405db33c77dSCarlo Caione return ret; 406db33c77dSCarlo Caione } 407db33c77dSCarlo Caione 40826503ad2SMartin Blumenstingl static int rtl_load_file(struct hci_dev *hdev, const char *name, u8 **buff) 4091110a2dbSLarry Finger { 4101110a2dbSLarry Finger const struct firmware *fw; 4111110a2dbSLarry Finger int ret; 4121110a2dbSLarry Finger 413a5c76e67SHans de Goede rtl_dev_info(hdev, "rtl: loading %s\n", name); 4141110a2dbSLarry Finger ret = request_firmware(&fw, name, &hdev->dev); 415abed84a0SLarry Finger if (ret < 0) 4161110a2dbSLarry Finger return ret; 4171110a2dbSLarry Finger ret = fw->size; 4181110a2dbSLarry Finger *buff = kmemdup(fw->data, ret, GFP_KERNEL); 419c3327bdeSDan Carpenter if (!*buff) 420c3327bdeSDan Carpenter ret = -ENOMEM; 4211110a2dbSLarry Finger 4221110a2dbSLarry Finger release_firmware(fw); 4231110a2dbSLarry Finger 4241110a2dbSLarry Finger return ret; 4251110a2dbSLarry Finger } 4261110a2dbSLarry Finger 42726503ad2SMartin Blumenstingl static int btrtl_setup_rtl8723a(struct hci_dev *hdev, 42826503ad2SMartin Blumenstingl struct btrtl_device_info *btrtl_dev) 429db33c77dSCarlo Caione { 43026503ad2SMartin Blumenstingl if (btrtl_dev->fw_len < 8) 43126503ad2SMartin Blumenstingl return -EINVAL; 432db33c77dSCarlo Caione 433db33c77dSCarlo Caione /* Check that the firmware doesn't have the epatch signature 434db33c77dSCarlo Caione * (which is only for RTL8723B and newer). 435db33c77dSCarlo Caione */ 43626503ad2SMartin Blumenstingl if (!memcmp(btrtl_dev->fw_data, RTL_EPATCH_SIGNATURE, 8)) { 437a5c76e67SHans de Goede rtl_dev_err(hdev, "unexpected EPATCH signature!\n"); 438907f8499SAlex Lu return -EINVAL; 439907f8499SAlex Lu } 440907f8499SAlex Lu 44126503ad2SMartin Blumenstingl return rtl_download_firmware(hdev, btrtl_dev->fw_data, 44226503ad2SMartin Blumenstingl btrtl_dev->fw_len); 443db33c77dSCarlo Caione } 444db33c77dSCarlo Caione 44526503ad2SMartin Blumenstingl static int btrtl_setup_rtl8723b(struct hci_dev *hdev, 44626503ad2SMartin Blumenstingl struct btrtl_device_info *btrtl_dev) 44726503ad2SMartin Blumenstingl { 44826503ad2SMartin Blumenstingl unsigned char *fw_data = NULL; 44926503ad2SMartin Blumenstingl int ret; 45026503ad2SMartin Blumenstingl u8 *tbuff; 45126503ad2SMartin Blumenstingl 45226503ad2SMartin Blumenstingl ret = rtlbt_parse_firmware(hdev, btrtl_dev, &fw_data); 453db33c77dSCarlo Caione if (ret < 0) 454db33c77dSCarlo Caione goto out; 455db33c77dSCarlo Caione 45626503ad2SMartin Blumenstingl if (btrtl_dev->cfg_len > 0) { 45726503ad2SMartin Blumenstingl tbuff = kzalloc(ret + btrtl_dev->cfg_len, GFP_KERNEL); 4581110a2dbSLarry Finger if (!tbuff) { 4591110a2dbSLarry Finger ret = -ENOMEM; 460db33c77dSCarlo Caione goto out; 4611110a2dbSLarry Finger } 4621110a2dbSLarry Finger 4631110a2dbSLarry Finger memcpy(tbuff, fw_data, ret); 4641110a2dbSLarry Finger kfree(fw_data); 4651110a2dbSLarry Finger 46626503ad2SMartin Blumenstingl memcpy(tbuff + ret, btrtl_dev->cfg_data, btrtl_dev->cfg_len); 46726503ad2SMartin Blumenstingl ret += btrtl_dev->cfg_len; 4681110a2dbSLarry Finger 4691110a2dbSLarry Finger fw_data = tbuff; 4701110a2dbSLarry Finger } 4711110a2dbSLarry Finger 47226503ad2SMartin Blumenstingl rtl_dev_info(hdev, "cfg_sz %d, total sz %d\n", btrtl_dev->cfg_len, ret); 4731110a2dbSLarry Finger 4741110a2dbSLarry Finger ret = rtl_download_firmware(hdev, fw_data, ret); 475db33c77dSCarlo Caione 476db33c77dSCarlo Caione out: 4771110a2dbSLarry Finger kfree(fw_data); 478db33c77dSCarlo Caione return ret; 479db33c77dSCarlo Caione } 480db33c77dSCarlo Caione 481db33c77dSCarlo Caione static struct sk_buff *btrtl_read_local_version(struct hci_dev *hdev) 482db33c77dSCarlo Caione { 483db33c77dSCarlo Caione struct sk_buff *skb; 484db33c77dSCarlo Caione 485db33c77dSCarlo Caione skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL, 486db33c77dSCarlo Caione HCI_INIT_TIMEOUT); 487db33c77dSCarlo Caione if (IS_ERR(skb)) { 488a5c76e67SHans de Goede rtl_dev_err(hdev, "HCI_OP_READ_LOCAL_VERSION failed (%ld)\n", 489a5c76e67SHans de Goede PTR_ERR(skb)); 490db33c77dSCarlo Caione return skb; 491db33c77dSCarlo Caione } 492db33c77dSCarlo Caione 493db33c77dSCarlo Caione if (skb->len != sizeof(struct hci_rp_read_local_version)) { 494a5c76e67SHans de Goede rtl_dev_err(hdev, "HCI_OP_READ_LOCAL_VERSION event length mismatch\n"); 495db33c77dSCarlo Caione kfree_skb(skb); 496db33c77dSCarlo Caione return ERR_PTR(-EIO); 497db33c77dSCarlo Caione } 498db33c77dSCarlo Caione 499db33c77dSCarlo Caione return skb; 500db33c77dSCarlo Caione } 501db33c77dSCarlo Caione 50226503ad2SMartin Blumenstingl void btrtl_free(struct btrtl_device_info *btrtl_dev) 503db33c77dSCarlo Caione { 50426503ad2SMartin Blumenstingl kfree(btrtl_dev->fw_data); 50526503ad2SMartin Blumenstingl kfree(btrtl_dev->cfg_data); 50626503ad2SMartin Blumenstingl kfree(btrtl_dev); 50726503ad2SMartin Blumenstingl } 50826503ad2SMartin Blumenstingl EXPORT_SYMBOL_GPL(btrtl_free); 50926503ad2SMartin Blumenstingl 5101cc194caSHans de Goede struct btrtl_device_info *btrtl_initialize(struct hci_dev *hdev, 5111cc194caSHans de Goede const char *postfix) 51226503ad2SMartin Blumenstingl { 51326503ad2SMartin Blumenstingl struct btrtl_device_info *btrtl_dev; 514db33c77dSCarlo Caione struct sk_buff *skb; 515db33c77dSCarlo Caione struct hci_rp_read_local_version *resp; 5161cc194caSHans de Goede char cfg_name[40]; 517907f8499SAlex Lu u16 hci_rev, lmp_subver; 518c50903e3SMartin Blumenstingl u8 hci_ver; 51926503ad2SMartin Blumenstingl int ret; 52026503ad2SMartin Blumenstingl 52126503ad2SMartin Blumenstingl btrtl_dev = kzalloc(sizeof(*btrtl_dev), GFP_KERNEL); 52226503ad2SMartin Blumenstingl if (!btrtl_dev) { 52326503ad2SMartin Blumenstingl ret = -ENOMEM; 52426503ad2SMartin Blumenstingl goto err_alloc; 52526503ad2SMartin Blumenstingl } 526db33c77dSCarlo Caione 527db33c77dSCarlo Caione skb = btrtl_read_local_version(hdev); 52826503ad2SMartin Blumenstingl if (IS_ERR(skb)) { 52926503ad2SMartin Blumenstingl ret = PTR_ERR(skb); 53026503ad2SMartin Blumenstingl goto err_free; 53126503ad2SMartin Blumenstingl } 532db33c77dSCarlo Caione 533db33c77dSCarlo Caione resp = (struct hci_rp_read_local_version *)skb->data; 534a5c76e67SHans de Goede rtl_dev_info(hdev, "rtl: examining hci_ver=%02x hci_rev=%04x lmp_ver=%02x lmp_subver=%04x\n", 5352064ee33SMarcel Holtmann resp->hci_ver, resp->hci_rev, 536db33c77dSCarlo Caione resp->lmp_ver, resp->lmp_subver); 537db33c77dSCarlo Caione 538c50903e3SMartin Blumenstingl hci_ver = resp->hci_ver; 539907f8499SAlex Lu hci_rev = le16_to_cpu(resp->hci_rev); 540db33c77dSCarlo Caione lmp_subver = le16_to_cpu(resp->lmp_subver); 541db33c77dSCarlo Caione kfree_skb(skb); 542db33c77dSCarlo Caione 543c50903e3SMartin Blumenstingl btrtl_dev->ic_info = btrtl_match_ic(lmp_subver, hci_rev, hci_ver, 544c50903e3SMartin Blumenstingl hdev->bus); 545c50903e3SMartin Blumenstingl 54626503ad2SMartin Blumenstingl if (!btrtl_dev->ic_info) { 547c50903e3SMartin Blumenstingl rtl_dev_err(hdev, "rtl: unknown IC info, lmp subver %04x, hci rev %04x, hci ver %04x", 548c50903e3SMartin Blumenstingl lmp_subver, hci_rev, hci_ver); 54926503ad2SMartin Blumenstingl ret = -EINVAL; 55026503ad2SMartin Blumenstingl goto err_free; 55126503ad2SMartin Blumenstingl } 55226503ad2SMartin Blumenstingl 55326503ad2SMartin Blumenstingl if (btrtl_dev->ic_info->has_rom_version) { 55426503ad2SMartin Blumenstingl ret = rtl_read_rom_version(hdev, &btrtl_dev->rom_version); 55526503ad2SMartin Blumenstingl if (ret) 55626503ad2SMartin Blumenstingl goto err_free; 55726503ad2SMartin Blumenstingl } 55826503ad2SMartin Blumenstingl 55926503ad2SMartin Blumenstingl btrtl_dev->fw_len = rtl_load_file(hdev, btrtl_dev->ic_info->fw_name, 56026503ad2SMartin Blumenstingl &btrtl_dev->fw_data); 56126503ad2SMartin Blumenstingl if (btrtl_dev->fw_len < 0) { 56226503ad2SMartin Blumenstingl rtl_dev_err(hdev, "firmware file %s not found\n", 56326503ad2SMartin Blumenstingl btrtl_dev->ic_info->fw_name); 56426503ad2SMartin Blumenstingl ret = btrtl_dev->fw_len; 56526503ad2SMartin Blumenstingl goto err_free; 56626503ad2SMartin Blumenstingl } 56726503ad2SMartin Blumenstingl 56826503ad2SMartin Blumenstingl if (btrtl_dev->ic_info->cfg_name) { 5691cc194caSHans de Goede if (postfix) { 5701cc194caSHans de Goede snprintf(cfg_name, sizeof(cfg_name), "%s-%s.bin", 5711cc194caSHans de Goede btrtl_dev->ic_info->cfg_name, postfix); 5721cc194caSHans de Goede } else { 5731cc194caSHans de Goede snprintf(cfg_name, sizeof(cfg_name), "%s.bin", 5741cc194caSHans de Goede btrtl_dev->ic_info->cfg_name); 5751cc194caSHans de Goede } 5761cc194caSHans de Goede btrtl_dev->cfg_len = rtl_load_file(hdev, cfg_name, 57726503ad2SMartin Blumenstingl &btrtl_dev->cfg_data); 57826503ad2SMartin Blumenstingl if (btrtl_dev->ic_info->config_needed && 57926503ad2SMartin Blumenstingl btrtl_dev->cfg_len <= 0) { 58026503ad2SMartin Blumenstingl rtl_dev_err(hdev, "mandatory config file %s not found\n", 58126503ad2SMartin Blumenstingl btrtl_dev->ic_info->cfg_name); 58226503ad2SMartin Blumenstingl ret = btrtl_dev->cfg_len; 58326503ad2SMartin Blumenstingl goto err_free; 58426503ad2SMartin Blumenstingl } 58526503ad2SMartin Blumenstingl } 58626503ad2SMartin Blumenstingl 58726503ad2SMartin Blumenstingl return btrtl_dev; 58826503ad2SMartin Blumenstingl 58926503ad2SMartin Blumenstingl err_free: 59026503ad2SMartin Blumenstingl btrtl_free(btrtl_dev); 59126503ad2SMartin Blumenstingl err_alloc: 59226503ad2SMartin Blumenstingl return ERR_PTR(ret); 59326503ad2SMartin Blumenstingl } 59426503ad2SMartin Blumenstingl EXPORT_SYMBOL_GPL(btrtl_initialize); 59526503ad2SMartin Blumenstingl 59626503ad2SMartin Blumenstingl int btrtl_download_firmware(struct hci_dev *hdev, 59726503ad2SMartin Blumenstingl struct btrtl_device_info *btrtl_dev) 59826503ad2SMartin Blumenstingl { 599db33c77dSCarlo Caione /* Match a set of subver values that correspond to stock firmware, 600db33c77dSCarlo Caione * which is not compatible with standard btusb. 601db33c77dSCarlo Caione * If matched, upload an alternative firmware that does conform to 602db33c77dSCarlo Caione * standard btusb. Once that firmware is uploaded, the subver changes 603db33c77dSCarlo Caione * to a different value. 604db33c77dSCarlo Caione */ 60526503ad2SMartin Blumenstingl switch (btrtl_dev->ic_info->lmp_subver) { 606db33c77dSCarlo Caione case RTL_ROM_LMP_8723A: 607db33c77dSCarlo Caione case RTL_ROM_LMP_3499: 60826503ad2SMartin Blumenstingl return btrtl_setup_rtl8723a(hdev, btrtl_dev); 609db33c77dSCarlo Caione case RTL_ROM_LMP_8723B: 610db33c77dSCarlo Caione case RTL_ROM_LMP_8821A: 611db33c77dSCarlo Caione case RTL_ROM_LMP_8761A: 6121110a2dbSLarry Finger case RTL_ROM_LMP_8822B: 61326503ad2SMartin Blumenstingl return btrtl_setup_rtl8723b(hdev, btrtl_dev); 614db33c77dSCarlo Caione default: 615a5c76e67SHans de Goede rtl_dev_info(hdev, "rtl: assuming no firmware upload needed\n"); 616db33c77dSCarlo Caione return 0; 617db33c77dSCarlo Caione } 618db33c77dSCarlo Caione } 61926503ad2SMartin Blumenstingl EXPORT_SYMBOL_GPL(btrtl_download_firmware); 62026503ad2SMartin Blumenstingl 62126503ad2SMartin Blumenstingl int btrtl_setup_realtek(struct hci_dev *hdev) 62226503ad2SMartin Blumenstingl { 62326503ad2SMartin Blumenstingl struct btrtl_device_info *btrtl_dev; 62426503ad2SMartin Blumenstingl int ret; 62526503ad2SMartin Blumenstingl 6261cc194caSHans de Goede btrtl_dev = btrtl_initialize(hdev, NULL); 62726503ad2SMartin Blumenstingl if (IS_ERR(btrtl_dev)) 62826503ad2SMartin Blumenstingl return PTR_ERR(btrtl_dev); 62926503ad2SMartin Blumenstingl 63026503ad2SMartin Blumenstingl ret = btrtl_download_firmware(hdev, btrtl_dev); 63126503ad2SMartin Blumenstingl 63226503ad2SMartin Blumenstingl btrtl_free(btrtl_dev); 63326503ad2SMartin Blumenstingl 63426503ad2SMartin Blumenstingl return ret; 63526503ad2SMartin Blumenstingl } 636db33c77dSCarlo Caione EXPORT_SYMBOL_GPL(btrtl_setup_realtek); 637db33c77dSCarlo Caione 638b85b0ee1SMartin Blumenstingl static unsigned int btrtl_convert_baudrate(u32 device_baudrate) 639b85b0ee1SMartin Blumenstingl { 640b85b0ee1SMartin Blumenstingl switch (device_baudrate) { 641b85b0ee1SMartin Blumenstingl case 0x0252a00a: 642b85b0ee1SMartin Blumenstingl return 230400; 643b85b0ee1SMartin Blumenstingl 644b85b0ee1SMartin Blumenstingl case 0x05f75004: 645b85b0ee1SMartin Blumenstingl return 921600; 646b85b0ee1SMartin Blumenstingl 647b85b0ee1SMartin Blumenstingl case 0x00005004: 648b85b0ee1SMartin Blumenstingl return 1000000; 649b85b0ee1SMartin Blumenstingl 650b85b0ee1SMartin Blumenstingl case 0x04928002: 651b85b0ee1SMartin Blumenstingl case 0x01128002: 652b85b0ee1SMartin Blumenstingl return 1500000; 653b85b0ee1SMartin Blumenstingl 654b85b0ee1SMartin Blumenstingl case 0x00005002: 655b85b0ee1SMartin Blumenstingl return 2000000; 656b85b0ee1SMartin Blumenstingl 657b85b0ee1SMartin Blumenstingl case 0x0000b001: 658b85b0ee1SMartin Blumenstingl return 2500000; 659b85b0ee1SMartin Blumenstingl 660b85b0ee1SMartin Blumenstingl case 0x04928001: 661b85b0ee1SMartin Blumenstingl return 3000000; 662b85b0ee1SMartin Blumenstingl 663b85b0ee1SMartin Blumenstingl case 0x052a6001: 664b85b0ee1SMartin Blumenstingl return 3500000; 665b85b0ee1SMartin Blumenstingl 666b85b0ee1SMartin Blumenstingl case 0x00005001: 667b85b0ee1SMartin Blumenstingl return 4000000; 668b85b0ee1SMartin Blumenstingl 669b85b0ee1SMartin Blumenstingl case 0x0252c014: 670b85b0ee1SMartin Blumenstingl default: 671b85b0ee1SMartin Blumenstingl return 115200; 672b85b0ee1SMartin Blumenstingl } 673b85b0ee1SMartin Blumenstingl } 674b85b0ee1SMartin Blumenstingl 675b85b0ee1SMartin Blumenstingl int btrtl_get_uart_settings(struct hci_dev *hdev, 676b85b0ee1SMartin Blumenstingl struct btrtl_device_info *btrtl_dev, 677b85b0ee1SMartin Blumenstingl unsigned int *controller_baudrate, 678b85b0ee1SMartin Blumenstingl u32 *device_baudrate, bool *flow_control) 679b85b0ee1SMartin Blumenstingl { 680b85b0ee1SMartin Blumenstingl struct rtl_vendor_config *config; 681b85b0ee1SMartin Blumenstingl struct rtl_vendor_config_entry *entry; 682b85b0ee1SMartin Blumenstingl int i, total_data_len; 683b85b0ee1SMartin Blumenstingl bool found = false; 684b85b0ee1SMartin Blumenstingl 685b85b0ee1SMartin Blumenstingl total_data_len = btrtl_dev->cfg_len - sizeof(*config); 686b85b0ee1SMartin Blumenstingl if (total_data_len <= 0) { 687b85b0ee1SMartin Blumenstingl rtl_dev_warn(hdev, "no config loaded\n"); 688b85b0ee1SMartin Blumenstingl return -EINVAL; 689b85b0ee1SMartin Blumenstingl } 690b85b0ee1SMartin Blumenstingl 691b85b0ee1SMartin Blumenstingl config = (struct rtl_vendor_config *)btrtl_dev->cfg_data; 692b85b0ee1SMartin Blumenstingl if (le32_to_cpu(config->signature) != RTL_CONFIG_MAGIC) { 693b85b0ee1SMartin Blumenstingl rtl_dev_err(hdev, "invalid config magic\n"); 694b85b0ee1SMartin Blumenstingl return -EINVAL; 695b85b0ee1SMartin Blumenstingl } 696b85b0ee1SMartin Blumenstingl 697b85b0ee1SMartin Blumenstingl if (total_data_len < le16_to_cpu(config->total_len)) { 698b85b0ee1SMartin Blumenstingl rtl_dev_err(hdev, "config is too short\n"); 699b85b0ee1SMartin Blumenstingl return -EINVAL; 700b85b0ee1SMartin Blumenstingl } 701b85b0ee1SMartin Blumenstingl 702b85b0ee1SMartin Blumenstingl for (i = 0; i < total_data_len; ) { 703b85b0ee1SMartin Blumenstingl entry = ((void *)config->entry) + i; 704b85b0ee1SMartin Blumenstingl 705b85b0ee1SMartin Blumenstingl switch (le16_to_cpu(entry->offset)) { 706b85b0ee1SMartin Blumenstingl case 0xc: 707b85b0ee1SMartin Blumenstingl if (entry->len < sizeof(*device_baudrate)) { 708b85b0ee1SMartin Blumenstingl rtl_dev_err(hdev, "invalid UART config entry\n"); 709b85b0ee1SMartin Blumenstingl return -EINVAL; 710b85b0ee1SMartin Blumenstingl } 711b85b0ee1SMartin Blumenstingl 712b85b0ee1SMartin Blumenstingl *device_baudrate = get_unaligned_le32(entry->data); 713b85b0ee1SMartin Blumenstingl *controller_baudrate = btrtl_convert_baudrate( 714b85b0ee1SMartin Blumenstingl *device_baudrate); 715b85b0ee1SMartin Blumenstingl 716b85b0ee1SMartin Blumenstingl if (entry->len >= 13) 717b85b0ee1SMartin Blumenstingl *flow_control = !!(entry->data[12] & BIT(2)); 718b85b0ee1SMartin Blumenstingl else 719b85b0ee1SMartin Blumenstingl *flow_control = false; 720b85b0ee1SMartin Blumenstingl 721b85b0ee1SMartin Blumenstingl found = true; 722b85b0ee1SMartin Blumenstingl break; 723b85b0ee1SMartin Blumenstingl 724b85b0ee1SMartin Blumenstingl default: 725b85b0ee1SMartin Blumenstingl rtl_dev_dbg(hdev, "skipping config entry 0x%x (len %u)\n", 726b85b0ee1SMartin Blumenstingl le16_to_cpu(entry->offset), entry->len); 727b85b0ee1SMartin Blumenstingl break; 728b85b0ee1SMartin Blumenstingl }; 729b85b0ee1SMartin Blumenstingl 730b85b0ee1SMartin Blumenstingl i += sizeof(*entry) + entry->len; 731b85b0ee1SMartin Blumenstingl } 732b85b0ee1SMartin Blumenstingl 733b85b0ee1SMartin Blumenstingl if (!found) { 734b85b0ee1SMartin Blumenstingl rtl_dev_err(hdev, "no UART config entry found\n"); 735b85b0ee1SMartin Blumenstingl return -ENOENT; 736b85b0ee1SMartin Blumenstingl } 737b85b0ee1SMartin Blumenstingl 738b85b0ee1SMartin Blumenstingl rtl_dev_dbg(hdev, "device baudrate = 0x%08x\n", *device_baudrate); 739b85b0ee1SMartin Blumenstingl rtl_dev_dbg(hdev, "controller baudrate = %u\n", *controller_baudrate); 740b85b0ee1SMartin Blumenstingl rtl_dev_dbg(hdev, "flow control %d\n", *flow_control); 741b85b0ee1SMartin Blumenstingl 742b85b0ee1SMartin Blumenstingl return 0; 743b85b0ee1SMartin Blumenstingl } 744b85b0ee1SMartin Blumenstingl EXPORT_SYMBOL_GPL(btrtl_get_uart_settings); 745b85b0ee1SMartin Blumenstingl 746db33c77dSCarlo Caione MODULE_AUTHOR("Daniel Drake <drake@endlessm.com>"); 747db33c77dSCarlo Caione MODULE_DESCRIPTION("Bluetooth support for Realtek devices ver " VERSION); 748db33c77dSCarlo Caione MODULE_VERSION(VERSION); 749db33c77dSCarlo Caione MODULE_LICENSE("GPL"); 750f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723a_fw.bin"); 751f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723b_fw.bin"); 752f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723b_config.bin"); 753c50903e3SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723bs_fw.bin"); 754c50903e3SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723bs_config.bin"); 755c50903e3SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723ds_fw.bin"); 756c50903e3SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8723ds_config.bin"); 757f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8761a_fw.bin"); 758f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8761a_config.bin"); 759f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8821a_fw.bin"); 760f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8821a_config.bin"); 761f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8822b_fw.bin"); 762f96dbd32SMartin Blumenstingl MODULE_FIRMWARE("rtl_bt/rtl8822b_config.bin"); 763