Bluetooth: hci_h5: Add support for the RTL8723BS

Implement support for the RTL8723BS chip.

Signed-off-by: Jeremy Cline <jeremy@jcline.org>
[hdegoede@redhat.com: Port from bt3wire.c to hci_h5.c, drop broken GPIO code]
Signed-off-by: Hans de Goede <hdegoede@redhat.com>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>

diff --git a/drivers/bluetooth/hci_h5.c b/drivers/bluetooth/hci_h5.c
index b3f762291e7ff2dd5964bd7df7718f8521f2fbdd..3513dad43f3c59c7a9ed7e3b24f3033b26b25327 100644 (file)
--- a/drivers/bluetooth/hci_h5.c
+++ b/drivers/bluetooth/hci_h5.c
@@ -31,6 +31,7 @@
 #include <net/bluetooth/bluetooth.h>
 #include <net/bluetooth/hci_core.h>
 
+#include "btrtl.h"
 #include "hci_uart.h"
 
 #define HCI_3WIRE_ACK_PKT      0
@@ -822,11 +823,79 @@ static void h5_serdev_remove(struct serdev_device *serdev)
        hci_uart_unregister_device(&h5->serdev_hu);
 }
 
+static int h5_btrtl_setup(struct h5 *h5)
+{
+       struct btrtl_device_info *btrtl_dev;
+       struct sk_buff *skb;
+       __le32 baudrate_data;
+       u32 device_baudrate;
+       unsigned int controller_baudrate;
+       bool flow_control;
+       int err;
+
+       btrtl_dev = btrtl_initialize(h5->hu->hdev, h5->id);
+       if (IS_ERR(btrtl_dev))
+               return PTR_ERR(btrtl_dev);
+
+       err = btrtl_get_uart_settings(h5->hu->hdev, btrtl_dev,
+                                     &controller_baudrate, &device_baudrate,
+                                     &flow_control);
+       if (err)
+               goto out_free;
+
+       baudrate_data = cpu_to_le32(device_baudrate);
+       skb = __hci_cmd_sync(h5->hu->hdev, 0xfc17, sizeof(baudrate_data),
+                            &baudrate_data, HCI_INIT_TIMEOUT);
+       if (IS_ERR(skb)) {
+               rtl_dev_err(h5->hu->hdev, "set baud rate command failed\n");
+               err = PTR_ERR(skb);
+               goto out_free;
+       } else {
+               kfree_skb(skb);
+       }
+       /* Give the device some time to set up the new baudrate. */
+       usleep_range(10000, 20000);
+
+       serdev_device_set_baudrate(h5->hu->serdev, controller_baudrate);
+       serdev_device_set_flow_control(h5->hu->serdev, flow_control);
+
+       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);
+
+out_free:
+       btrtl_free(btrtl_dev);
+
+       return err;
+}
+
+static void h5_btrtl_open(struct h5 *h5)
+{
+       /* Devices always start with these fixed parameters */
+       serdev_device_set_flow_control(h5->hu->serdev, false);
+       serdev_device_set_parity(h5->hu->serdev, SERDEV_PARITY_EVEN);
+       serdev_device_set_baudrate(h5->hu->serdev, 115200);
+}
+
+static struct h5_vnd rtl_vnd = {
+       .setup          = h5_btrtl_setup,
+       .open           = h5_btrtl_open,
+};
+
+#ifdef CONFIG_ACPI
+static const struct acpi_device_id h5_acpi_match[] = {
+       { "OBDA8723", (kernel_ulong_t)&rtl_vnd },
+       { },
+};
+MODULE_DEVICE_TABLE(acpi, h5_acpi_match);
+#endif
+
 static struct serdev_device_driver h5_serdev_driver = {
        .probe = h5_serdev_probe,
        .remove = h5_serdev_remove,
        .driver = {
                .name = "hci_uart_h5",
+               .acpi_match_table = ACPI_PTR(h5_acpi_match),
        },
 };