The Realtek RTL8723CS is SDIO WiFi chip. It also contains a Bluetooth
module which is connected via UART to the host.

It shares lmp subversion with 8703B, so Realtek's userspace
initialization tool (rtk_hciattach) differentiates varieties of RTL8723CS
(CG, VF, XX) with RTL8703B using vendor's command to read chip type.

Also this chip declares support for some features it doesn't support
so add a quirk to indicate that these features are broken.

Signed-off-by: Vasily Khoruzhick <anars...@gmail.com>
---
 drivers/bluetooth/btrtl.c  | 128 ++++++++++++++++++++++++++++++++++++-
 drivers/bluetooth/btrtl.h  |  12 ++++
 drivers/bluetooth/hci_h5.c |   4 ++
 3 files changed, 141 insertions(+), 3 deletions(-)

diff --git a/drivers/bluetooth/btrtl.c b/drivers/bluetooth/btrtl.c
index 41405de27d66..ec51667c4549 100644
--- a/drivers/bluetooth/btrtl.c
+++ b/drivers/bluetooth/btrtl.c
@@ -27,8 +27,12 @@
 
 #define VERSION "0.1"
 
+#define RTL_CHIP_8723CS_CG     3
+#define RTL_CHIP_8723CS_VF     4
+#define RTL_CHIP_8723CS_XX     5
 #define RTL_EPATCH_SIGNATURE   "Realtech"
 #define RTL_ROM_LMP_3499       0x3499
+#define RTL_ROM_LMP_8703B      0x8703
 #define RTL_ROM_LMP_8723A      0x1200
 #define RTL_ROM_LMP_8723B      0x8723
 #define RTL_ROM_LMP_8821A      0x8821
@@ -40,6 +44,7 @@
 #define IC_MATCH_FL_HCIREV     (1 << 1)
 #define IC_MATCH_FL_HCIVER     (1 << 2)
 #define IC_MATCH_FL_HCIBUS     (1 << 3)
+#define IC_MATCH_FL_CHIP_TYPE  (1 << 4)
 #define IC_INFO(lmps, hcir) \
        .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_HCIREV, \
        .lmp_subver = (lmps), \
@@ -51,6 +56,7 @@ struct id_table {
        __u16 hci_rev;
        __u8 hci_ver;
        __u8 hci_bus;
+       __u8 chip_type;
        bool config_needed;
        bool has_rom_version;
        char *fw_name;
@@ -98,6 +104,39 @@ static const struct id_table ic_id_table[] = {
          .fw_name  = "rtl_bt/rtl8723b_fw.bin",
          .cfg_name = "rtl_bt/rtl8723b_config" },
 
+       /* 8723CS-CG */
+       { .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_CHIP_TYPE |
+                        IC_MATCH_FL_HCIBUS,
+         .lmp_subver = RTL_ROM_LMP_8703B,
+         .chip_type = RTL_CHIP_8723CS_CG,
+         .hci_bus = HCI_UART,
+         .config_needed = true,
+         .has_rom_version = true,
+         .fw_name  = "rtl_bt/rtl8723cs_cg_fw.bin",
+         .cfg_name = "rtl_bt/rtl8723cs_cg_config" },
+
+       /* 8723CS-VF */
+       { .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_CHIP_TYPE |
+                        IC_MATCH_FL_HCIBUS,
+         .lmp_subver = RTL_ROM_LMP_8703B,
+         .chip_type = RTL_CHIP_8723CS_VF,
+         .hci_bus = HCI_UART,
+         .config_needed = true,
+         .has_rom_version = true,
+         .fw_name  = "rtl_bt/rtl8723cs_vf_fw.bin",
+         .cfg_name = "rtl_bt/rtl8723cs_vf_config" },
+
+       /* 8723CS-XX */
+       { .match_flags = IC_MATCH_FL_LMPSUBV | IC_MATCH_FL_CHIP_TYPE |
+                        IC_MATCH_FL_HCIBUS,
+         .lmp_subver = RTL_ROM_LMP_8703B,
+         .chip_type = RTL_CHIP_8723CS_XX,
+         .hci_bus = HCI_UART,
+         .config_needed = true,
+         .has_rom_version = true,
+         .fw_name  = "rtl_bt/rtl8723cs_xx_fw.bin",
+         .cfg_name = "rtl_bt/rtl8723cs_xx_config" },
+
        /* 8723D */
        { IC_INFO(RTL_ROM_LMP_8723B, 0xd),
          .config_needed = true,
@@ -154,7 +193,8 @@ static const struct id_table ic_id_table[] = {
        };
 
 static const struct id_table *btrtl_match_ic(u16 lmp_subver, u16 hci_rev,
-                                            u8 hci_ver, u8 hci_bus)
+                                            u8 hci_ver, u8 hci_bus,
+                                            u8 chip_type)
 {
        int i;
 
@@ -171,6 +211,9 @@ static const struct id_table *btrtl_match_ic(u16 
lmp_subver, u16 hci_rev,
                if ((ic_id_table[i].match_flags & IC_MATCH_FL_HCIBUS) &&
                    (ic_id_table[i].hci_bus != hci_bus))
                        continue;
+               if ((ic_id_table[i].match_flags & IC_MATCH_FL_CHIP_TYPE) &&
+                   (ic_id_table[i].chip_type != chip_type))
+                       continue;
 
                break;
        }
@@ -232,6 +275,7 @@ static int rtlbt_parse_firmware(struct hci_dev *hdev,
                { RTL_ROM_LMP_8723B, 1 },
                { RTL_ROM_LMP_8821A, 2 },
                { RTL_ROM_LMP_8761A, 3 },
+               { RTL_ROM_LMP_8703B, 7 },
                { RTL_ROM_LMP_8822B, 8 },
                { RTL_ROM_LMP_8723B, 9 },       /* 8723D */
                { RTL_ROM_LMP_8821A, 10 },      /* 8821C */
@@ -507,6 +551,48 @@ static struct sk_buff *btrtl_read_local_version(struct 
hci_dev *hdev)
        return skb;
 }
 
+static bool rtl_has_chip_type(u16 lmp_subver)
+{
+       switch (lmp_subver) {
+       case RTL_ROM_LMP_8703B:
+               return true;
+       default:
+               break;
+       }
+
+       return  false;
+}
+
+static int rtl_read_chip_type(struct hci_dev *hdev, u8 *type)
+{
+       struct rtl_chip_type_evt *chip_type;
+       struct sk_buff *skb;
+       const unsigned char cmd_buf[] = {0x00, 0x94, 0xa0, 0x00, 0xb0};
+
+       /* Read RTL chip type command */
+       skb = __hci_cmd_sync(hdev, 0xfc61, 5, cmd_buf, HCI_INIT_TIMEOUT);
+       if (IS_ERR(skb)) {
+               rtl_dev_err(hdev, "Read chip type failed (%ld)",
+                           PTR_ERR(skb));
+               return PTR_ERR(skb);
+       }
+
+       if (skb->len != sizeof(*chip_type)) {
+               rtl_dev_err(hdev, "RTL chip type event length mismatch");
+               kfree_skb(skb);
+               return -EIO;
+       }
+
+       chip_type = (struct rtl_chip_type_evt *)skb->data;
+       rtl_dev_info(hdev, "chip_type status=%x type=%x",
+                    chip_type->status, chip_type->type);
+
+       *type = chip_type->type & 0x0f;
+
+       kfree_skb(skb);
+       return 0;
+}
+
 void btrtl_free(struct btrtl_device_info *btrtl_dev)
 {
        kfree(btrtl_dev->fw_data);
@@ -523,7 +609,7 @@ struct btrtl_device_info *btrtl_initialize(struct hci_dev 
*hdev,
        struct hci_rp_read_local_version *resp;
        char cfg_name[40];
        u16 hci_rev, lmp_subver;
-       u8 hci_ver;
+       u8 hci_ver, chip_type = 0;
        int ret;
 
        btrtl_dev = kzalloc(sizeof(*btrtl_dev), GFP_KERNEL);
@@ -548,8 +634,14 @@ struct btrtl_device_info *btrtl_initialize(struct hci_dev 
*hdev,
        lmp_subver = le16_to_cpu(resp->lmp_subver);
        kfree_skb(skb);
 
+       if (rtl_has_chip_type(lmp_subver)) {
+               ret = rtl_read_chip_type(hdev, &chip_type);
+               if (ret)
+                       goto err_free;
+       }
+
        btrtl_dev->ic_info = btrtl_match_ic(lmp_subver, hci_rev, hci_ver,
-                                           hdev->bus);
+                                           hdev->bus, chip_type);
 
        if (!btrtl_dev->ic_info) {
                rtl_dev_err(hdev, "rtl: unknown IC info, lmp subver %04x, hci 
rev %04x, hci ver %04x",
@@ -618,6 +710,7 @@ int btrtl_download_firmware(struct hci_dev *hdev,
        case RTL_ROM_LMP_8821A:
        case RTL_ROM_LMP_8761A:
        case RTL_ROM_LMP_8822B:
+       case RTL_ROM_LMP_8703B:
                return btrtl_setup_rtl8723b(hdev, btrtl_dev);
        default:
                rtl_dev_info(hdev, "rtl: assuming no firmware upload needed\n");
@@ -636,7 +729,12 @@ int btrtl_setup_realtek(struct hci_dev *hdev)
                return PTR_ERR(btrtl_dev);
 
        ret = btrtl_download_firmware(hdev, btrtl_dev);
+       if (ret)
+               goto out_free;
 
+       btrtl_apply_quirks(hdev, btrtl_dev);
+
+out_free:
        btrtl_free(btrtl_dev);
 
        return ret;
@@ -751,6 +849,24 @@ int btrtl_get_uart_settings(struct hci_dev *hdev,
 }
 EXPORT_SYMBOL_GPL(btrtl_get_uart_settings);
 
+void btrtl_apply_quirks(struct hci_dev *hdev,
+                       struct btrtl_device_info *btrtl_dev)
+{
+       switch (btrtl_dev->ic_info->lmp_subver) {
+       case RTL_ROM_LMP_8703B:
+               /* 8723CS reports two pages for local ext features,
+                * but it doesn't support any features from page 2 -
+                * it either responds with garbage or with error status
+                */
+               set_bit(HCI_QUIRK_BROKEN_LOCAL_EXT_FTR_MAX_PAGE,
+                       &hdev->quirks);
+               break;
+       default:
+               break;
+       }
+}
+EXPORT_SYMBOL_GPL(btrtl_apply_quirks);
+
 MODULE_AUTHOR("Daniel Drake <dr...@endlessm.com>");
 MODULE_DESCRIPTION("Bluetooth support for Realtek devices ver " VERSION);
 MODULE_VERSION(VERSION);
@@ -760,6 +876,12 @@ MODULE_FIRMWARE("rtl_bt/rtl8723b_fw.bin");
 MODULE_FIRMWARE("rtl_bt/rtl8723b_config.bin");
 MODULE_FIRMWARE("rtl_bt/rtl8723bs_fw.bin");
 MODULE_FIRMWARE("rtl_bt/rtl8723bs_config.bin");
+MODULE_FIRMWARE("rtl_bt/rtl8723cs_cg_fw.bin");
+MODULE_FIRMWARE("rtl_bt/rtl8723cs_cg_config.bin");
+MODULE_FIRMWARE("rtl_bt/rtl8723cs_vf_fw.bin");
+MODULE_FIRMWARE("rtl_bt/rtl8723cs_vf_config.bin");
+MODULE_FIRMWARE("rtl_bt/rtl8723cs_xx_fw.bin");
+MODULE_FIRMWARE("rtl_bt/rtl8723cs_xx_config.bin");
 MODULE_FIRMWARE("rtl_bt/rtl8723ds_fw.bin");
 MODULE_FIRMWARE("rtl_bt/rtl8723ds_config.bin");
 MODULE_FIRMWARE("rtl_bt/rtl8761a_fw.bin");
diff --git a/drivers/bluetooth/btrtl.h b/drivers/bluetooth/btrtl.h
index f5e36f3993a8..db4e4a1542b7 100644
--- a/drivers/bluetooth/btrtl.h
+++ b/drivers/bluetooth/btrtl.h
@@ -24,6 +24,11 @@
 
 struct btrtl_device_info;
 
+struct rtl_chip_type_evt {
+       __u8 status;
+       __u8 type;
+} __packed;
+
 struct rtl_download_cmd {
        __u8 index;
        __u8 data[RTL_FRAG_LEN];
@@ -69,6 +74,8 @@ int btrtl_get_uart_settings(struct hci_dev *hdev,
                            struct btrtl_device_info *btrtl_dev,
                            unsigned int *controller_baudrate,
                            u32 *device_baudrate, bool *flow_control);
+void btrtl_apply_quirks(struct hci_dev *hdev,
+                       struct btrtl_device_info *btrtl_dev);
 
 #else
 
@@ -100,6 +107,11 @@ static inline int btrtl_get_uart_settings(struct hci_dev 
*hdev,
                                          bool *flow_control)
 {
        return -ENOENT;
+
+static inline void btrtl_apply_quirks(struct hci_dev *hdev,
+                       struct btrtl_device_info *btrtl_dev)
+{
+}
 }
 
 #endif
diff --git a/drivers/bluetooth/hci_h5.c b/drivers/bluetooth/hci_h5.c
index 44f848c02c63..ebd84e9d7aed 100644
--- a/drivers/bluetooth/hci_h5.c
+++ b/drivers/bluetooth/hci_h5.c
@@ -916,6 +916,10 @@ static int h5_btrtl_setup(struct h5 *h5)
        err = btrtl_download_firmware(h5->hu->hdev, btrtl_dev);
        /* Give the device some time before the hci-core sends it a reset */
        usleep_range(10000, 20000);
+       if (err)
+               goto out_free;
+
+       btrtl_apply_quirks(h5->hu->hdev, btrtl_dev);
 
 out_free:
        btrtl_free(btrtl_dev);
-- 
2.20.1

Reply via email to