diff --git a/drivers/bluetooth/hci_usb.c b/drivers/bluetooth/hci_usb.c index 406af57..b668476 100644 --- a/drivers/bluetooth/hci_usb.c +++ b/drivers/bluetooth/hci_usb.c @@ -839,7 +839,41 @@ static void hci_usb_destruct(struct hci_dev *hdev) 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); } static int hci_usb_probe(struct usb_interface *intf, const struct usb_device_id *id) @@ -974,6 +1008,11 @@ 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); } #endif @@ -994,6 +1033,8 @@ static int hci_usb_probe(struct usb_interface *intf, const struct usb_device_id husb->hdev = hdev; + INIT_WORK(&husb->work, set_isoc_alternate); + hdev->type = HCI_USB; hdev->driver_data = husb; SET_HCIDEV_DEV(hdev, &intf->dev); diff --git a/drivers/bluetooth/hci_usb.h b/drivers/bluetooth/hci_usb.h index 963fc55..f1a7934 100644 --- a/drivers/bluetooth/hci_usb.h +++ b/drivers/bluetooth/hci_usb.h @@ -102,9 +102,9 @@ 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; @@ -113,8 +113,14 @@ struct hci_usb { struct usb_host_endpoint *isoc_out_ep; struct usb_host_endpoint *isoc_in_ep; + int isoc_ifnum; + int isoc_alts; + int pend_alts; + __u8 ctrl_req; + struct work_struct work; + struct sk_buff_head transmit_q[4]; struct sk_buff *reassembly[4]; /* Reassembly buffers */