Bluetooth: hci_uart: Add bcm_set_baudrate()

Add vendor specific command to change controller device speed.

Signed-off-by: Frederic Danis <frederic.danis@linux.intel.com>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>

diff --git a/drivers/bluetooth/btbcm.h b/drivers/bluetooth/btbcm.h
index f405f84243993e96af51f873638cc5880d3a77a9..02f5f966541126a5a2d7f74d56e03385733df8b0 100644 (file)
--- a/drivers/bluetooth/btbcm.h
+++ b/drivers/bluetooth/btbcm.h
@@ -21,6 +21,18 @@
  *
  */
 
+#define BCM_UART_CLOCK_48MHZ   0x01
+#define BCM_UART_CLOCK_24MHZ   0x02
+
+struct bcm_update_uart_baud_rate {
+       __le16 zero;
+       __le32 baud_rate;
+} __packed;
+
+struct bcm_write_uart_clock_setting {
+       __u8 type;
+} __packed;
+
 #if IS_ENABLED(CONFIG_BT_BCM)
 
 int btbcm_check_bdaddr(struct hci_dev *hdev);

diff --git a/drivers/bluetooth/hci_bcm.c b/drivers/bluetooth/hci_bcm.c
index 070452256816dee16c6f5fc97ffc9f43285b978f..e4d66b61cda0e0714d0e927c99b1b4f59c1febb2 100644 (file)
--- a/drivers/bluetooth/hci_bcm.c
+++ b/drivers/bluetooth/hci_bcm.c
@@ -37,6 +37,55 @@ struct bcm_data {
        struct sk_buff_head txq;
 };
 
+static int bcm_set_baudrate(struct hci_uart *hu, unsigned int speed)
+{
+       struct hci_dev *hdev = hu->hdev;
+       struct sk_buff *skb;
+       struct bcm_update_uart_baud_rate param;
+
+       if (speed > 3000000) {
+               struct bcm_write_uart_clock_setting clock;
+
+               clock.type = BCM_UART_CLOCK_48MHZ;
+
+               BT_DBG("%s: Set Controller clock (%d)", hdev->name, clock.type);
+
+               /* This Broadcom specific command changes the UART's controller
+                * clock for baud rate > 3000000.
+                */
+               skb = __hci_cmd_sync(hdev, 0xfc45, 1, &clock, HCI_INIT_TIMEOUT);
+               if (IS_ERR(skb)) {
+                       int err = PTR_ERR(skb);
+                       BT_ERR("%s: BCM: failed to write clock command (%d)",
+                              hdev->name, err);
+                       return err;
+               }
+
+               kfree_skb(skb);
+       }
+
+       BT_DBG("%s: Set Controller UART speed to %d bit/s", hdev->name, speed);
+
+       param.zero = cpu_to_le16(0);
+       param.baud_rate = cpu_to_le32(speed);
+
+       /* This Broadcom specific command changes the UART's controller baud
+        * rate.
+        */
+       skb = __hci_cmd_sync(hdev, 0xfc18, sizeof(param), &param,
+                            HCI_INIT_TIMEOUT);
+       if (IS_ERR(skb)) {
+               int err = PTR_ERR(skb);
+               BT_ERR("%s: BCM: failed to write update baudrate command (%d)",
+                      hdev->name, err);
+               return err;
+       }
+
+       kfree_skb(skb);
+
+       return 0;
+}
+
 static int bcm_open(struct hci_uart *hu)
 {
        struct bcm_data *bcm;
@@ -107,6 +156,12 @@ static int bcm_setup(struct hci_uart *hu)
        if (hu->proto->init_speed)
                hci_uart_set_baudrate(hu, hu->proto->init_speed);
 
+       if (hu->proto->oper_speed) {
+               err = bcm_set_baudrate(hu, hu->proto->oper_speed);
+               if (!err)
+                       hci_uart_set_baudrate(hu, hu->proto->oper_speed);
+       }
+
 finalize:
        release_firmware(fw);
 
@@ -162,10 +217,13 @@ static struct sk_buff *bcm_dequeue(struct hci_uart *hu)
 static const struct hci_uart_proto bcm_proto = {
        .id             = HCI_UART_BCM,
        .name           = "BCM",
+       .init_speed     = 115200,
+       .oper_speed     = 4000000,
        .open           = bcm_open,
        .close          = bcm_close,
        .flush          = bcm_flush,
        .setup          = bcm_setup,
+       .set_baudrate   = bcm_set_baudrate,
        .recv           = bcm_recv,
        .enqueue        = bcm_enqueue,
        .dequeue        = bcm_dequeue,