Hi Fred,
> Add vendor specific command to change controller device speed.
>
> Signed-off-by: Frederic Danis <frederic.danis@xxxxxxxxxxxxxxx>
> ---
> 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 <linux/kernel.h>
> #include <linux/errno.h>
> #include <linux/skbuff.h>
> +#include <linux/tty.h>
>
> #include <net/bluetooth/bluetooth.h>
> #include <net/bluetooth/hci_core.h>
> @@ -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;
Please just fold this in to this function. I prefer if you can read the changes like a sequence of actions that have to happen.
Also curious is when we fallback to default baudrate, do we have to change the clock back to 24?
> +
> + 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];
This part seems a bit duplicated. I actually wonder if we should change __hci_cmd_sync to also handle command complete events and just extract the error/status for us. I have done it that way in userspace and the command complete return response parameters are guaranteed to have status as their first parameter. So it is doable. Do you mind looking into that.
> +
> + 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,
Regards
Marcel
--
To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
