Bluetooth: btusb: mediatek: add intf release flow when usb disconnect

commit 489304e67087abddc2666c5af0159cb95afdcf59 upstream.

MediaTek claim an special usb intr interface for ISO data transmission.
The interface need to be released before unregistering hci device when
usb disconnect. Removing BT usb dongle without properly releasing the
interface may cause Kernel panic while unregister hci device.

Signed-off-by: Chris Lu <chris.lu@mediatek.com>
Signed-off-by: Luiz Augusto von Dentz <luiz.von.dentz@intel.com>
Cc: Fedor Pchelkin <boddah8794@gmail.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>

diff --git a/drivers/bluetooth/btusb.c b/drivers/bluetooth/btusb.c
index 5f7cfee0143979db78ce641505dcdf2b9c512d79..d7515dc0e77e49480cdc7229fac6ecd2fd8360aa 100644 (file)
--- a/drivers/bluetooth/btusb.c
+++ b/drivers/bluetooth/btusb.c
@@ -2644,9 +2644,9 @@ static void btusb_mtk_claim_iso_intf(struct btusb_data *data)
        init_usb_anchor(&btmtk_data->isopkt_anchor);
 }
 
-static void btusb_mtk_release_iso_intf(struct btusb_data *data)
+static void btusb_mtk_release_iso_intf(struct hci_dev *hdev)
 {
-       struct btmtk_data *btmtk_data = hci_get_priv(data->hdev);
+       struct btmtk_data *btmtk_data = hci_get_priv(hdev);
 
        if (btmtk_data->isopkt_intf) {
                usb_kill_anchored_urbs(&btmtk_data->isopkt_anchor);
@@ -2662,6 +2662,16 @@ static void btusb_mtk_release_iso_intf(struct btusb_data *data)
        clear_bit(BTMTK_ISOPKT_OVER_INTR, &btmtk_data->flags);
 }
 
+static int btusb_mtk_disconnect(struct hci_dev *hdev)
+{
+       /* This function describes the specific additional steps taken by MediaTek
+        * when Bluetooth usb driver's resume function is called.
+        */
+       btusb_mtk_release_iso_intf(hdev);
+
+       return 0;
+}
+
 static int btusb_mtk_reset(struct hci_dev *hdev, void *rst_data)
 {
        struct btusb_data *data = hci_get_drvdata(hdev);
@@ -2679,7 +2689,7 @@ static int btusb_mtk_reset(struct hci_dev *hdev, void *rst_data)
                return err;
 
        if (test_bit(BTMTK_ISOPKT_RUNNING, &btmtk_data->flags))
-               btusb_mtk_release_iso_intf(data);
+               btusb_mtk_release_iso_intf(hdev);
 
        btusb_stop_traffic(data);
        usb_kill_anchored_urbs(&data->tx_anchor);
@@ -2733,14 +2743,13 @@ static int btusb_mtk_setup(struct hci_dev *hdev)
 
 static int btusb_mtk_shutdown(struct hci_dev *hdev)
 {
-       struct btusb_data *data = hci_get_drvdata(hdev);
        struct btmtk_data *btmtk_data = hci_get_priv(hdev);
        int ret;
 
        ret = btmtk_usb_shutdown(hdev);
 
        if (test_bit(BTMTK_ISOPKT_RUNNING, &btmtk_data->flags))
-               btusb_mtk_release_iso_intf(data);
+               btusb_mtk_release_iso_intf(hdev);
 
        return ret;
 }
@@ -3854,6 +3863,7 @@ static int btusb_probe(struct usb_interface *intf,
                data->recv_acl = btmtk_usb_recv_acl;
                data->suspend = btmtk_usb_suspend;
                data->resume = btmtk_usb_resume;
+               data->disconnect = btusb_mtk_disconnect;
        }
 
        if (id->driver_info & BTUSB_SWAVE) {