Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 9727a16e authored by Mayank Rana's avatar Mayank Rana
Browse files

usb: phy: qusb: Add support to configure QUSB PHY regulator 



Currently QUSB PHY driver is enabling vdd18, vdd33 and vdd related
regulator without setting optimum voltage and current requirement
for QUSB PHY to be in operational mode. Hence this change adds
required voltage/current configuration for those regulators when
those are enabled and disabled.

Change-Id: I7e281ecb5f8255d85bc53048f1eab2a789a4be99
Signed-off-by: default avatarMayank Rana <mrana@codeaurora.org>
parent 42162e39

drivers/usb/phy/phy-msm-qusb.c

+112 −14
Original line number Diff line number Diff line 
/*

 * Copyright (c) 2014, The Linux Foundation. All rights reserved.

 * Copyright (c) 2014-2015, The Linux Foundation. All rights reserved.

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 and
@@ -57,6 +57,14 @@ 
#define PORT_OFFSET(i) ((i == 0) ? 0x0 : ((i == 1) ? 0x6c : 0x88))

#define HS_PHY_CTRL_REG(i)              (0x10 + PORT_OFFSET(i))



#define QUSB2PHY_1P8_VOL_MIN           1800000 /* uV */

#define QUSB2PHY_1P8_VOL_MAX           1800000 /* uV */

#define QUSB2PHY_1P8_HPM_LOAD          30000   /* uA */



#define QUSB2PHY_3P3_VOL_MIN		3075000 /* uV */

#define QUSB2PHY_3P3_VOL_MAX		3200000 /* uV */

#define QUSB2PHY_3P3_HPM_LOAD		30000	/* uA */



struct qusb_phy {

	struct usb_phy		phy;

	void __iomem		*base;
@@ -93,49 +101,139 @@ static int qusb_phy_reset(struct usb_phy *phy) 
	return 0;

}



static int qusb_phy_config_vdd(struct qusb_phy *qphy, int high)

{

	int min, ret;



	min = high ? 1 : 0; /* low or none? */

	ret = regulator_set_voltage(qphy->vdd, qphy->vdd_levels[min],

						qphy->vdd_levels[2]);

	if (ret) {

		dev_err(qphy->phy.dev, "unable to set voltage for qusb vdd\n");

		return ret;

	}



	dev_dbg(qphy->phy.dev, "min_vol:%d max_vol:%d\n",

			qphy->vdd_levels[min], qphy->vdd_levels[2]);

	return ret;

}



static int qusb_phy_enable_power(struct qusb_phy *qphy, bool on)

{

	int ret = 0;



	dev_dbg(qphy->phy.dev, "%s turn %s regulators\n", __func__,

			on ? "on" : "off");

	dev_dbg(qphy->phy.dev, "%s turn %s regulators. power_enabled:%d\n",

			__func__, on ? "on" : "off", qphy->power_enabled);



	if (qphy->power_enabled == on)

	if (qphy->power_enabled == on) {

		dev_dbg(qphy->phy.dev, "PHYs' regulators are already ON.\n");

		return 0;

	}



	if (!on)

		goto disable_vdda33;



	ret = qusb_phy_config_vdd(qphy, true);

	if (ret) {

		dev_err(qphy->phy.dev, "Unable to config VDD:%d\n", ret);

		goto err_vdd;

	}



	ret = regulator_enable(qphy->vdd);

	if (ret) {

		dev_err(qphy->phy.dev, "unable to enable vdd\n");

		return ret;

		dev_err(qphy->phy.dev, "Unable to enable VDD\n");

		goto unconfig_vdd;

	}



	ret = regulator_set_optimum_mode(qphy->vdda18, QUSB2PHY_1P8_HPM_LOAD);

	if (ret < 0) {

		dev_err(qphy->phy.dev, "Unable to set HPM of vdda18:%d\n", ret);

		goto disable_vdd;

	}



	ret = regulator_set_voltage(qphy->vdda18, QUSB2PHY_1P8_VOL_MIN,

						QUSB2PHY_1P8_VOL_MAX);

	if (ret) {

		dev_err(qphy->phy.dev,

				"Unable to set voltage for vdda18:%d\n", ret);

		goto put_vdda18_lpm;

	}



	ret = regulator_enable(qphy->vdda18);

	if (ret) {

		dev_err(qphy->phy.dev, "unable to enable vdda18\n");

		goto disable_vdd;

		dev_err(qphy->phy.dev, "Unable to enable vdda18:%d\n", ret);

		goto unset_vdda18;

	}



	ret = regulator_set_optimum_mode(qphy->vdda33, QUSB2PHY_3P3_HPM_LOAD);

	if (ret < 0) {

		dev_err(qphy->phy.dev, "Unable to set HPM of vdda33:%d\n", ret);

		goto disable_vdda18;

	}



	ret = regulator_set_voltage(qphy->vdda33, QUSB2PHY_3P3_VOL_MIN,

						QUSB2PHY_3P3_VOL_MAX);

	if (ret) {

		dev_err(qphy->phy.dev,

				"Unable to set voltage for vdda33:%d\n", ret);

		goto put_vdda33_lpm;

	}



	ret = regulator_enable(qphy->vdda33);

	if (ret) {

		dev_err(qphy->phy.dev, "unable to enable vdda33\n");

		goto disable_vdda18;

		dev_err(qphy->phy.dev, "Unable to enable vdda33:%d\n", ret);

		goto unset_vdd33;

	}



	qphy->power_enabled = true;



	pr_debug("%s(): QUSB PHY's regulators are turned ON.\n", __func__);

	return 0;



disable_vdda33:

	regulator_disable(qphy->vdda33);

	ret = regulator_disable(qphy->vdda33);

	if (ret)

		dev_err(qphy->phy.dev, "Unable to disable vdda33:%d\n", ret);



unset_vdd33:

	ret = regulator_set_voltage(qphy->vdda33, 0, QUSB2PHY_3P3_VOL_MAX);

	if (ret)

		dev_err(qphy->phy.dev,

			"Unable to set (0) voltage for vdda33:%d\n", ret);



put_vdda33_lpm:

	ret = regulator_set_optimum_mode(qphy->vdda33, 0);

	if (ret < 0)

		dev_err(qphy->phy.dev, "Unable to set (0) HPM of vdda33\n");



disable_vdda18:

	regulator_disable(qphy->vdda18);

	ret = regulator_disable(qphy->vdda18);

	if (ret)

		dev_err(qphy->phy.dev, "Unable to disable vdda18:%d\n", ret);



unset_vdda18:

	ret = regulator_set_voltage(qphy->vdda18, 0, QUSB2PHY_1P8_VOL_MAX);

	if (ret)

		dev_err(qphy->phy.dev,

			"Unable to set (0) voltage for vdda18:%d\n", ret);



put_vdda18_lpm:

	ret = regulator_set_optimum_mode(qphy->vdda18, 0);

	if (ret < 0)

		dev_err(qphy->phy.dev, "Unable to set LPM of vdda18\n");



disable_vdd:

	regulator_disable(qphy->vdd);

	ret = regulator_disable(qphy->vdd);

	if (ret)

		dev_err(qphy->phy.dev, "Unable to disable vdd:%d\n", ret);



unconfig_vdd:

	ret = qusb_phy_config_vdd(qphy, false);

	if (ret)

		dev_err(qphy->phy.dev, "Unable unconfig VDD:%d\n", ret);



err_vdd:

	qphy->power_enabled = false;

	dev_dbg(qphy->phy.dev, "QUSB PHY's regulators are turned OFF.\n");

	return ret;

}