Bluetooth: mt7921s: fix bus hang with wrong privilege

According to chip hw flow, mt7921s need to re-acquire privilege
again before normal running. Otherwise, the bus may be stuck in
an abnormal status.

Fixes: c603bf1f94d0 ("Bluetooth: btmtksdio: add MT7921s Bluetooth support")
Co-developed-by: Sean Wang <sean.wang@mediatek.com>
Signed-off-by: Sean Wang <sean.wang@mediatek.com>
Signed-off-by: Mark Chen <mark-yw.chen@mediatek.com>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>

diff --git a/drivers/bluetooth/btmtksdio.c b/drivers/bluetooth/btmtksdio.c
index 8cbd49013d868492cd13a22efe30e32d90f4f038..0951bb10d1176fb129455acc1fb6ab47f28a6397 100644 (file)
--- a/drivers/bluetooth/btmtksdio.c
+++ b/drivers/bluetooth/btmtksdio.c
@@ -960,6 +960,14 @@ static int btmtksdio_setup(struct hci_dev *hdev)
                if (err < 0)
                        return err;
 
+               err = btmtksdio_fw_pmctrl(bdev);
+               if (err < 0)
+                       return err;
+
+               err = btmtksdio_drv_pmctrl(bdev);
+               if (err < 0)
+                       return err;
+
                /* Enable SCO over I2S/PCM */
                err = btmtksdio_sco_setting(hdev);
                if (err < 0) {