1 files changed, 125 insertions, 0 deletions
diff --git a/drivers/power/pmic/cpcap.c b/drivers/power/pmic/cpcap.c
new file mode 100644
index 00000000000..f2076afff43
--- /dev/null
+++ b/drivers/power/pmic/cpcap.c
@@ -0,0 +1,125 @@
+// SPDX-License-Identifier: GPL-2.0+
+/*
+ * Copyright (c) 2025 Svyatoslav Ryhel <clamor95@gmail.com>
+ */
+
+#include <dm.h>
+#include <dm/lists.h>
+#include <log.h>
+#include <power/pmic.h>
+#include <power/cpcap.h>
+#include <spi.h>
+#include <linux/delay.h>
+#include <linux/err.h>
+
+static const struct pmic_child_info pmic_children_info[] = {
+	{ .prefix = "sw", .driver = CPCAP_SW_DRIVER },
+	{ .prefix = "v", .driver = CPCAP_LDO_DRIVER },
+	{ },
+};
+
+static int cpcap_write(struct udevice *dev, uint reg, const uint8_t *buff, int len)
+{
+	u8 buf[4];
+	u16 data = *(u16 *)buff;
+	int ret;
+
+	buf[0] = ((reg >> 8) & 0xff) | 0x80;
+	buf[1] = reg & 0xff;
+	buf[2] = data >> 8 & 0xff;
+	buf[3] = data & 0xff;
+
+	ret = dm_spi_xfer(dev, 32, buf, NULL, SPI_XFER_ONCE);
+
+	log_debug("%s: reg 0x%x, data 0x%04x, ret %d\n", __func__, reg, data, ret);
+
+	return ret;
+}
+
+static int cpcap_read(struct udevice *dev, uint reg, uint8_t *buff, int len)
+{
+	u8 buf[4];
+	int ret;
+
+	buf[0] = (reg >> 8) & 0xff;
+	buf[1] = reg & 0xff;
+	buf[2] = 0;
+	buf[3] = 0;
+
+	ret = dm_spi_xfer(dev, 32, buf, buf, SPI_XFER_ONCE);
+	*buff = (buf[2] << 8) | buf[3];
+
+	log_debug("%s: reg 0x%x, data 0x%04x, ret %d\n", __func__, reg, *buff, ret);
+	return ret;
+}
+
+static int cpcap_bind(struct udevice *dev)
+{
+	ofnode regulators_node;
+	int children;
+
+	/* Regulator device node of PMIC */
+	regulators_node = dev_read_subnode(dev, "regulator");
+	if (!ofnode_valid(regulators_node)) {
+		log_err("%s regulator subnode not found!\n", dev->name);
+		return -ENXIO;
+	}
+
+	/* Actual regulators container */
+	regulators_node = ofnode_find_subnode(regulators_node, "regulators");
+	if (!ofnode_valid(regulators_node)) {
+		log_err("%s regulators subnode not found!\n", dev->name);
+		return -ENXIO;
+	}
+
+	debug("%s: '%s' - found regulators subnode\n", __func__, dev->name);
+
+	children = pmic_bind_children(dev, regulators_node, pmic_children_info);
+	if (!children)
+		log_err("%s - no child found\n", dev->name);
+
+	return dm_scan_fdt_dev(dev);
+}
+
+static int cpcap_probe(struct udevice *dev)
+{
+	struct spi_slave *slave = dev_get_parent_priv(dev);
+	int ret;
+
+	ret = spi_claim_bus(slave);
+	if (ret) {
+		log_err("SPI bus allocation failed (%d)\n", ret);
+		return ret;
+	}
+
+	u16 id = pmic_reg_read(dev, CPCAP_REG_VERSC1);
+
+	u16 ven = (id >> 6) & 0x7;
+	u16 rev = ((id >> 3) & 0x7) | ((id << 3) & 0x38);
+
+	log_debug("%s: vendor %s rev: %i.%i (%x)\n", __func__,
+		  ven == CPCAP_VENDOR_ST ? "ST" : "TI",
+		  CPCAP_REVISION_MAJOR(rev), CPCAP_REVISION_MINOR(rev),
+		  rev);
+	return 0;
+}
+
+static struct dm_pmic_ops cpcap_ops = {
+	.read = cpcap_read,
+	.write = cpcap_write,
+};
+
+static const struct udevice_id cpcap_ids[] = {
+	{ .compatible = "motorola,cpcap" },
+	{ .compatible = "st,6556002" },
+	{ }
+};
+
+U_BOOT_DRIVER(pmic_cpcap) = {
+	.name = "cpcap_pmic",
+	.id = UCLASS_PMIC,
+	.of_match = cpcap_ids,
+	.bind = cpcap_bind,
+	.probe = cpcap_probe,
+	.ops = &cpcap_ops,
+};