Commit 9f8f962c authored by Marcel Holtmann's avatar Marcel Holtmann Committed by Gustavo Padovan
Browse files

Bluetooth: Use separate function for BCM92035 vendor setup 



Trying to squeeze every single vendor setup routine into the same function
and have it assigned all the time is actually a bad idea. Especially since
the core can handle the absence of a setup routine perfectly fine.

To make this a lot simpler for future additions of vendor setup code,
split the BCM92035 setup into its own function and only assign it when
this specific device has been detected.

Doing it like this has the nice side benefit that we do not have to keep
a copy of the driver_info around.

Signed-off-by: default avatarMarcel Holtmann <marcel@holtmann.org>
Signed-off-by: default avatarGustavo Padovan <gustavo.padovan@collabora.co.uk>
parent b3916db3

drivers/bluetooth/btusb.c

+24 −28
Original line number Diff line number Diff line
@@ -246,7 +246,6 @@ struct btusb_data { 
	struct usb_endpoint_descriptor *isoc_rx_ep;



	__u8 cmdreq_type;

	unsigned long driver_info;



	unsigned int sco_num;

	int isoc_altsetting;
@@ -700,26 +699,6 @@ static int btusb_flush(struct hci_dev *hdev) 
	return 0;

}



static int btusb_setup(struct hci_dev *hdev)

{

	struct btusb_data *data = hci_get_drvdata(hdev);



	BT_DBG("%s", hdev->name);



	if (data->driver_info & BTUSB_BCM92035) {

		struct sk_buff *skb;

		__u8 val = 0x00;



		skb = __hci_cmd_sync(hdev, 0xfc3b, 1, &val, HCI_INIT_TIMEOUT);

		if (IS_ERR(skb))

			BT_ERR("BCM92035 command failed (%ld)", -PTR_ERR(skb));

		else

			kfree_skb(skb);

	}



	return 0;

}



static int btusb_send_frame(struct sk_buff *skb)

{

	struct hci_dev *hdev = (struct hci_dev *) skb->dev;
@@ -948,6 +927,22 @@ static void btusb_waker(struct work_struct *work) 
	usb_autopm_put_interface(data->intf);

}



static int btusb_setup_bcm92035(struct hci_dev *hdev)

{

	struct sk_buff *skb;

	u8 val = 0x00;



	BT_DBG("%s", hdev->name);



	skb = __hci_cmd_sync(hdev, 0xfc3b, 1, &val, HCI_INIT_TIMEOUT);

	if (IS_ERR(skb))

		BT_ERR("BCM92035 command failed (%ld)", -PTR_ERR(skb));

	else

		kfree_skb(skb);



	return 0;

}



static int btusb_probe(struct usb_interface *intf,

				const struct usb_device_id *id)

{
@@ -1017,7 +1012,6 @@ static int btusb_probe(struct usb_interface *intf, 
		return -ENODEV;



	data->cmdreq_type = USB_TYPE_CLASS;

	data->driver_info = id->driver_info;



	data->udev = interface_to_usbdev(intf);

	data->intf = intf;
@@ -1048,10 +1042,12 @@ static int btusb_probe(struct usb_interface *intf, 
	hdev->open   = btusb_open;

	hdev->close  = btusb_close;

	hdev->flush  = btusb_flush;

	hdev->setup    = btusb_setup;

	hdev->send   = btusb_send_frame;

	hdev->notify = btusb_notify;



	if (id->driver_info & BTUSB_BCM92035)

		hdev->setup = btusb_setup_bcm92035;



	/* Interface numbers are hardcoded in the specification */

	data->isoc = usb_ifnum_to_if(data->udev, 1);

CRA Git | Maintained and supported by SUSTech CRA and CCSE