forked from OERV-BSP/u-boot
Add regulator driver that allow some Qualcomm PMIC to feed VBUS output to peripherals that are connected. Signed-off-by: Rui Miguel Silva <rui.silva@linaro.org> Acked-by: Caleb Connolly <caleb.connolly@linaro.org> Reviewed-by: Neil Armstrong <neil.armstrong@linaro.org> Reviewed-by: Caleb Connolly <caleb.connolly@linaro.org> Link: https://lore.kernel.org/r/20250227094911.497219-3-rui.silva@linaro.org Signed-off-by: Caleb Connolly <caleb.connolly@linaro.org>
112 lines
2.6 KiB
C
112 lines
2.6 KiB
C
// SPDX-License-Identifier: BSD-3-Clause
|
|
/*
|
|
* Copyright (c) 2025, Linaro Limited
|
|
*/
|
|
#define pr_fmt(fmt) "qcom_usb_vbus: " fmt
|
|
|
|
#include <bitfield.h>
|
|
#include <errno.h>
|
|
#include <dm.h>
|
|
#include <fdtdec.h>
|
|
#include <log.h>
|
|
#include <asm/gpio.h>
|
|
#include <linux/bitops.h>
|
|
#include <linux/printk.h>
|
|
#include <power/pmic.h>
|
|
#include <power/regulator.h>
|
|
|
|
#define CMD_OTG 0x50
|
|
#define OTG_EN BIT(0)
|
|
// The 0 bit in this register's bit field is undocumented
|
|
#define OTG_CFG 0x56
|
|
#define OTG_EN_SRC_CFG BIT(1)
|
|
|
|
struct qcom_usb_vbus_priv {
|
|
phys_addr_t base;
|
|
};
|
|
|
|
static int qcom_usb_vbus_regulator_of_to_plat(struct udevice *dev)
|
|
{
|
|
struct qcom_usb_vbus_priv *priv = dev_get_priv(dev);
|
|
|
|
priv->base = dev_read_addr(dev);
|
|
if (priv->base == FDT_ADDR_T_NONE)
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qcom_usb_vbus_regulator_get_enable(struct udevice *dev)
|
|
{
|
|
struct qcom_usb_vbus_priv *priv = dev_get_priv(dev);
|
|
int otg_en_reg = priv->base + CMD_OTG;
|
|
int ret;
|
|
|
|
ret = pmic_reg_read(dev->parent, otg_en_reg);
|
|
if (ret < 0)
|
|
log_err("failed to read usb vbus: %d\n", ret);
|
|
else
|
|
ret &= OTG_EN;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int qcom_usb_vbus_regulator_set_enable(struct udevice *dev, bool enable)
|
|
{
|
|
struct qcom_usb_vbus_priv *priv = dev_get_priv(dev);
|
|
int otg_en_reg = priv->base + CMD_OTG;
|
|
int ret;
|
|
|
|
if (enable) {
|
|
ret = pmic_clrsetbits(dev->parent, otg_en_reg, 0, OTG_EN);
|
|
if (ret < 0) {
|
|
log_err("error enabling: %d\n", ret);
|
|
return ret;
|
|
}
|
|
} else {
|
|
ret = pmic_clrsetbits(dev->parent, otg_en_reg, OTG_EN, 0);
|
|
if (ret < 0) {
|
|
log_err("error disabling: %d\n", ret);
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int qcom_usb_vbus_regulator_probe(struct udevice *dev)
|
|
{
|
|
struct qcom_usb_vbus_priv *priv = dev_get_priv(dev);
|
|
int otg_cfg_reg = priv->base + OTG_CFG;
|
|
int ret;
|
|
|
|
/* Disable HW logic for VBUS enable */
|
|
ret = pmic_clrsetbits(dev->parent, otg_cfg_reg, OTG_EN_SRC_CFG, 0);
|
|
if (ret < 0) {
|
|
log_err("error setting EN_SRC_CFG: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dm_regulator_ops qcom_usb_vbus_regulator_ops = {
|
|
.get_enable = qcom_usb_vbus_regulator_get_enable,
|
|
.set_enable = qcom_usb_vbus_regulator_set_enable,
|
|
};
|
|
|
|
static const struct udevice_id qcom_usb_vbus_regulator_ids[] = {
|
|
{ .compatible = "qcom,pm8150b-vbus-reg"},
|
|
{ },
|
|
};
|
|
|
|
U_BOOT_DRIVER(qcom_usb_vbus_regulator) = {
|
|
.name = "qcom-usb-vbus-regulator",
|
|
.id = UCLASS_REGULATOR,
|
|
.of_match = qcom_usb_vbus_regulator_ids,
|
|
.of_to_plat = qcom_usb_vbus_regulator_of_to_plat,
|
|
.ops = &qcom_usb_vbus_regulator_ops,
|
|
.probe = qcom_usb_vbus_regulator_probe,
|
|
.priv_auto = sizeof(struct qcom_usb_vbus_priv),
|
|
};
|