diff --git a/drivers/bluetooth/hci_usb.c b/drivers/bluetooth/hci_usb.c index 406af57..0727f68 100644 --- a/drivers/bluetooth/hci_usb.c +++ b/drivers/bluetooth/hci_usb.c @@ -837,10 +837,50 @@ static void hci_usb_destruct(struct hci_dev *hdev) kfree(husb); } +#ifdef CONFIG_BT_HCIUSB_SCO static void hci_usb_notify(struct hci_dev *hdev, unsigned int evt) { + struct hci_usb *husb = (struct hci_usb *) hdev->driver_data; + unsigned long flags; + int new_alts; + BT_DBG("%s evt %d", hdev->name, evt); + + new_alts = hdev->conn_hash.sco_num; + + if (hdev->voice_setting & 0x0020) { + new_alts *= 2; + if (new_alts > 5) + new_alts = 5; + } + + write_lock_irqsave(&husb->completion_lock, flags); + + if (new_alts != husb->isoc_alts) { + husb->pend_alts = new_alts; + schedule_work(&husb->work); + } + + write_unlock_irqrestore(&husb->completion_lock, flags); +} + +static void set_isoc_alternate(struct work_struct *work) +{ + struct hci_usb *husb = container_of(work, struct hci_usb, work); + + write_lock(&husb->completion_lock); + + usb_set_interface(husb->udev, husb->isoc_ifnum, husb->pend_alts); + + husb->isoc_alts = husb->pend_alts; + + write_unlock(&husb->completion_lock); +} +#else +static void hci_usb_notify(struct hci_dev *hdev, unsigned int evt) +{ } +#endif static int hci_usb_probe(struct usb_interface *intf, const struct usb_device_id *id) { @@ -974,7 +1014,14 @@ static int hci_usb_probe(struct usb_interface *intf, const struct usb_device_id husb->isoc_out_ep = isoc_out_ep; } } + + husb->isoc_ifnum = isoc_ifnum; + husb->isoc_alts = 0; + + usb_set_interface(udev, isoc_ifnum, husb->isoc_alts); } + + INIT_WORK(&husb->work, set_isoc_alternate); #endif rwlock_init(&husb->completion_lock); diff --git a/drivers/bluetooth/hci_usb.h b/drivers/bluetooth/hci_usb.h index 963fc55..fbe0954 100644 --- a/drivers/bluetooth/hci_usb.h +++ b/drivers/bluetooth/hci_usb.h @@ -102,17 +102,26 @@ struct hci_usb { struct hci_dev *hdev; unsigned long state; - + struct usb_device *udev; - + struct usb_host_endpoint *bulk_in_ep; struct usb_host_endpoint *bulk_out_ep; struct usb_host_endpoint *intr_in_ep; struct usb_interface *isoc_iface; + +#ifdef CONFIG_BT_HCIUSB_SCO struct usb_host_endpoint *isoc_out_ep; struct usb_host_endpoint *isoc_in_ep; + int isoc_ifnum; + int isoc_alts; + int pend_alts; + + struct work_struct work; +#endif + __u8 ctrl_req; struct sk_buff_head transmit_q[4];