Return-Path: From: Frederic Danis To: linux-bluetooth@vger.kernel.org Subject: [PATCH 7/7] Bluetooth: btbcm: Add bcm_set_baudrate() Date: Fri, 10 Apr 2015 15:37:46 +0200 Message-Id: <1428673066-1349-7-git-send-email-frederic.danis@linux.intel.com> In-Reply-To: <1428673066-1349-1-git-send-email-frederic.danis@linux.intel.com> References: <1428673066-1349-1-git-send-email-frederic.danis@linux.intel.com> Content-Type: text/plain; charset="utf-8" Sender: linux-bluetooth-owner@vger.kernel.org List-ID: Add vendor specific command to change controller device speed. Signed-off-by: Frederic Danis --- drivers/bluetooth/hci_bcm.c | 71 +++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 71 insertions(+) diff --git a/drivers/bluetooth/hci_bcm.c b/drivers/bluetooth/hci_bcm.c index 25c9883..7308cf4 100644 --- a/drivers/bluetooth/hci_bcm.c +++ b/drivers/bluetooth/hci_bcm.c @@ -24,6 +24,7 @@ #include #include #include +#include #include #include @@ -31,11 +32,80 @@ #include "btbcm.h" #include "hci_uart.h" +#define BCM43XX_CLOCK_48 1 +#define BCM43XX_CLOCK_24 2 + struct bcm_data { struct sk_buff *rx_skb; struct sk_buff_head txq; }; +static int bcm_set_clock(struct hci_uart *hu, unsigned char clock) +{ + struct hci_dev *hdev = hu->hdev; + struct sk_buff *skb; + + BT_DBG("%s: Set Controller clock (%d)", hdev->name, clock); + + skb = __hci_cmd_sync(hdev, 0xfc45, 1, &clock, HCI_INIT_TIMEOUT); + if (IS_ERR(skb)) { + BT_ERR("%s: failed to write update clock command (%ld)", + hdev->name, PTR_ERR(skb)); + return PTR_ERR(skb); + } + + if (skb->data[0]) { + u8 evt_status = skb->data[0]; + + BT_ERR("%s: write update clock event failed (%02x)", + hdev->name, evt_status); + kfree_skb(skb); + return -bt_to_errno(evt_status); + } + + kfree_skb(skb); + + return 0; +} + +struct hci_cp_bcm_set_speed { + __le16 dummy; + __le32 speed; +} __packed; + +static int bcm_set_baudrate(struct hci_uart *hu, int speed) +{ + struct hci_dev *hdev = hu->hdev; + struct sk_buff *skb; + struct hci_cp_bcm_set_speed param = { 0, cpu_to_le32(speed) }; + + if (speed > 3000000 && bcm_set_clock(hu, BCM43XX_CLOCK_48)) + return -EINVAL; + + BT_DBG("%s: Set Controller UART speed to %d bit/s", hdev->name, speed); + + skb = __hci_cmd_sync(hdev, 0xfc18, sizeof(param), ¶m, + HCI_INIT_TIMEOUT); + if (IS_ERR(skb)) { + BT_ERR("%s: failed to write update baudrate command (%ld)", + hdev->name, PTR_ERR(skb)); + return PTR_ERR(skb); + } + + if (skb->data[0]) { + u8 evt_status = skb->data[0]; + + BT_ERR("%s: write update baudrate event failed (%02x)", + hdev->name, evt_status); + kfree_skb(skb); + return -bt_to_errno(evt_status); + } + + kfree_skb(skb); + + return 0; +} + static int bcm_open(struct hci_uart *hu) { struct bcm_data *bcm; @@ -145,6 +215,7 @@ static const struct hci_uart_proto bcm_proto = { .flush = bcm_flush, .setup = bcm_setup, .post_setup = bcm_post_setup, + .set_baudrate = bcm_set_baudrate, .recv = bcm_recv, .enqueue = bcm_enqueue, .dequeue = bcm_dequeue, -- 1.9.1