Bluetooth: hci_qca: Enable clocks required for BT SOC

Instead of relying on other subsytem to turn ON clocks
required for BT SoC to operate, voting them from the driver.

Signed-off-by: Venkata Lakshmi Narayana Gubba <gubbaven@codeaurora.org>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>

diff --git a/drivers/bluetooth/hci_qca.c b/drivers/bluetooth/hci_qca.c
index d6e0c99..eacc65b 100644 (file)
--- a/drivers/bluetooth/hci_qca.c
+++ b/drivers/bluetooth/hci_qca.c
@@ -1755,6 +1755,13 @@ static int qca_regulator_enable(struct qca_serdev *qcadev)
 
        power->vregs_on = true;
 
+       ret = clk_prepare_enable(qcadev->susclk);
+       if (ret) {
+               /* Turn off regulators to overcome power leakage */
+               qca_regulator_disable(qcadev);
+               return ret;
+       }
+
        return 0;
 }
 
@@ -1773,6 +1780,9 @@ static void qca_regulator_disable(struct qca_serdev *qcadev)
 
        regulator_bulk_disable(power->num_vregs, power->vreg_bulk);
        power->vregs_on = false;
+
+       if (qcadev->susclk)
+               clk_disable_unprepare(qcadev->susclk);
 }
 
 static int qca_init_regulators(struct qca_power *qca,
@@ -1839,6 +1849,12 @@ static int qca_serdev_probe(struct serdev_device *serdev)
 
                qcadev->bt_power->vregs_on = false;
 
+               qcadev->susclk = devm_clk_get_optional(&serdev->dev, NULL);
+               if (IS_ERR(qcadev->susclk)) {
+                       dev_err(&serdev->dev, "failed to acquire clk\n");
+                       return PTR_ERR(qcadev->susclk);
+               }
+
                device_property_read_u32(&serdev->dev, "max-speed",
                                         &qcadev->oper_speed);
                if (!qcadev->oper_speed)