1 // SPDX-License-Identifier: BSD-3-Clause
2 /*
3 * Copyright (c) 2025, Linaro Limited
4 */
5 #define pr_fmt(fmt) "qcom_usb_vbus: " fmt
6
7 #include <bitfield.h>
8 #include <errno.h>
9 #include <dm.h>
10 #include <fdtdec.h>
11 #include <log.h>
12 #include <asm/gpio.h>
13 #include <linux/bitops.h>
14 #include <linux/printk.h>
15 #include <power/pmic.h>
16 #include <power/regulator.h>
17
18 enum pm8x50b_vbus {
19 PM8150B,
20 PM8550B,
21 };
22
23 #define OTG_EN BIT(0)
24
25 #define OTG_EN_SRC_CFG BIT(1)
26
27 struct qcom_otg_regs {
28 u32 otg_cmd;
29 u32 otg_cfg;
30 };
31 struct qcom_usb_vbus_priv {
32 phys_addr_t base;
33 struct qcom_otg_regs *regs;
34 };
35
36 static const struct qcom_otg_regs qcom_otg[] = {
37 [PM8150B] = {
38 .otg_cmd = 0x40,
39 .otg_cfg = 0x53,
40 },
41 [PM8550B] = {
42 .otg_cmd = 0x50,
43 .otg_cfg = 0x56,
44 },
45 };
46
qcom_usb_vbus_regulator_of_to_plat(struct udevice * dev)47 static int qcom_usb_vbus_regulator_of_to_plat(struct udevice *dev)
48 {
49 struct qcom_usb_vbus_priv *priv = dev_get_priv(dev);
50
51 priv->base = dev_read_addr(dev);
52 if (priv->base == FDT_ADDR_T_NONE)
53 return -EINVAL;
54
55 return 0;
56 }
57
qcom_usb_vbus_regulator_get_enable(struct udevice * dev)58 static int qcom_usb_vbus_regulator_get_enable(struct udevice *dev)
59 {
60 const struct qcom_otg_regs *regs = &qcom_otg[dev_get_driver_data(dev)];
61 struct qcom_usb_vbus_priv *priv = dev_get_priv(dev);
62 int otg_en_reg = priv->base + regs->otg_cmd;
63 int ret;
64
65 ret = pmic_reg_read(dev->parent, otg_en_reg);
66 if (ret < 0)
67 log_err("failed to read usb vbus: %d\n", ret);
68 else
69 ret &= OTG_EN;
70
71 return ret;
72 }
73
qcom_usb_vbus_regulator_set_enable(struct udevice * dev,bool enable)74 static int qcom_usb_vbus_regulator_set_enable(struct udevice *dev, bool enable)
75 {
76 const struct qcom_otg_regs *regs = &qcom_otg[dev_get_driver_data(dev)];
77 struct qcom_usb_vbus_priv *priv = dev_get_priv(dev);
78 int otg_en_reg = priv->base + regs->otg_cmd;
79 int ret;
80
81 if (enable) {
82 ret = pmic_clrsetbits(dev->parent, otg_en_reg, 0, OTG_EN);
83 if (ret < 0) {
84 log_err("error enabling: %d\n", ret);
85 return ret;
86 }
87 } else {
88 ret = pmic_clrsetbits(dev->parent, otg_en_reg, OTG_EN, 0);
89 if (ret < 0) {
90 log_err("error disabling: %d\n", ret);
91 return ret;
92 }
93 }
94
95 return 0;
96 }
97
qcom_usb_vbus_regulator_probe(struct udevice * dev)98 static int qcom_usb_vbus_regulator_probe(struct udevice *dev)
99 {
100 const struct qcom_otg_regs *regs = &qcom_otg[dev_get_driver_data(dev)];
101 struct qcom_usb_vbus_priv *priv = dev_get_priv(dev);
102 int otg_cfg_reg = priv->base + regs->otg_cfg;
103 int ret;
104
105 /* Disable HW logic for VBUS enable */
106 ret = pmic_clrsetbits(dev->parent, otg_cfg_reg, OTG_EN_SRC_CFG, 0);
107 if (ret < 0) {
108 log_err("error setting EN_SRC_CFG: %d\n", ret);
109 return ret;
110 }
111
112 return 0;
113 }
114
115 static const struct dm_regulator_ops qcom_usb_vbus_regulator_ops = {
116 .get_enable = qcom_usb_vbus_regulator_get_enable,
117 .set_enable = qcom_usb_vbus_regulator_set_enable,
118 };
119
120 static const struct udevice_id qcom_usb_vbus_regulator_ids[] = {
121 { .compatible = "qcom,pm8150b-vbus-reg", .data = PM8150B },
122 { .compatible = "qcom,pm8550b-vbus-reg", .data = PM8550B },
123 { },
124 };
125
126 U_BOOT_DRIVER(qcom_usb_vbus_regulator) = {
127 .name = "qcom-usb-vbus-regulator",
128 .id = UCLASS_REGULATOR,
129 .of_match = qcom_usb_vbus_regulator_ids,
130 .of_to_plat = qcom_usb_vbus_regulator_of_to_plat,
131 .ops = &qcom_usb_vbus_regulator_ops,
132 .probe = qcom_usb_vbus_regulator_probe,
133 .priv_auto = sizeof(struct qcom_usb_vbus_priv),
134 };
135