1224 lines
34 KiB
Diff
1224 lines
34 KiB
Diff
From c26270a4d76f20b3ee1af133269ac67e60185e8c Mon Sep 17 00:00:00 2001
|
|
From: Lionel VITTE <lionel.vitte@st.com>
|
|
Date: Thu, 11 Jul 2019 14:12:03 +0200
|
|
Subject: [PATCH 19/30] ARM stm32mp1 r2 REGULATOR
|
|
|
|
---
|
|
drivers/regulator/Kconfig | 19 +
|
|
drivers/regulator/Makefile | 2 +
|
|
drivers/regulator/stm32-pwr.c | 245 +++++++++++++
|
|
drivers/regulator/stm32-vrefbuf.c | 123 ++++++-
|
|
drivers/regulator/stpmic1_regulator.c | 663 ++++++++++++++++++++++++++++++++++
|
|
5 files changed, 1045 insertions(+), 7 deletions(-)
|
|
create mode 100644 drivers/regulator/stm32-pwr.c
|
|
create mode 100644 drivers/regulator/stpmic1_regulator.c
|
|
|
|
diff --git a/drivers/regulator/Kconfig b/drivers/regulator/Kconfig
|
|
index 329cdd3..9ecafba 100644
|
|
--- a/drivers/regulator/Kconfig
|
|
+++ b/drivers/regulator/Kconfig
|
|
@@ -803,6 +803,25 @@ config REGULATOR_STM32_VREFBUF
|
|
This driver can also be built as a module. If so, the module
|
|
will be called stm32-vrefbuf.
|
|
|
|
+config REGULATOR_STM32_PWR
|
|
+ bool "STMicroelectronics STM32 PWR"
|
|
+ depends on ARCH_STM32
|
|
+ help
|
|
+ This driver supports internal regulators (1V1 & 1V8) in the
|
|
+ STMicroelectronics STM32 chips.
|
|
+
|
|
+config REGULATOR_STPMIC1
|
|
+ tristate "STMicroelectronics STPMIC1 PMIC Regulators"
|
|
+ depends on MFD_STPMIC1
|
|
+ help
|
|
+ This driver supports STMicroelectronics STPMIC1 PMIC voltage
|
|
+ regulators and switches. The STPMIC1 regulators supply power to
|
|
+ an application processor as well as to external system
|
|
+ peripherals such as DDR, Flash memories and system devices.
|
|
+
|
|
+ To compile this driver as a module, choose M here: the
|
|
+ module will be called stpmic1_regulator.
|
|
+
|
|
config REGULATOR_TI_ABB
|
|
tristate "TI Adaptive Body Bias on-chip LDO"
|
|
depends on ARCH_OMAP
|
|
diff --git a/drivers/regulator/Makefile b/drivers/regulator/Makefile
|
|
index 801d9a3..3506ec2 100644
|
|
--- a/drivers/regulator/Makefile
|
|
+++ b/drivers/regulator/Makefile
|
|
@@ -101,6 +101,8 @@ obj-$(CONFIG_REGULATOR_S5M8767) += s5m8767.o
|
|
obj-$(CONFIG_REGULATOR_SC2731) += sc2731-regulator.o
|
|
obj-$(CONFIG_REGULATOR_SKY81452) += sky81452-regulator.o
|
|
obj-$(CONFIG_REGULATOR_STM32_VREFBUF) += stm32-vrefbuf.o
|
|
+obj-$(CONFIG_REGULATOR_STM32_PWR) += stm32-pwr.o
|
|
+obj-$(CONFIG_REGULATOR_STPMIC1) += stpmic1_regulator.o
|
|
obj-$(CONFIG_REGULATOR_STW481X_VMMC) += stw481x-vmmc.o
|
|
obj-$(CONFIG_REGULATOR_SY8106A) += sy8106a-regulator.o
|
|
obj-$(CONFIG_REGULATOR_TI_ABB) += ti-abb-regulator.o
|
|
diff --git a/drivers/regulator/stm32-pwr.c b/drivers/regulator/stm32-pwr.c
|
|
new file mode 100644
|
|
index 0000000..e6f41eb
|
|
--- /dev/null
|
|
+++ b/drivers/regulator/stm32-pwr.c
|
|
@@ -0,0 +1,245 @@
|
|
+/*
|
|
+ * Copyright (C) STMicroelectronics SA 2017
|
|
+ * Author: Gabriel Fernandez <gabriel.fernandez@st.com>
|
|
+ *
|
|
+ * License terms: GPL V2.0.
|
|
+ *
|
|
+ * This program is free software; you can redistribute it and/or modify it
|
|
+ * under the terms and conditions of the GNU General Public License,
|
|
+ * version 2, as published by the Free Software Foundation.
|
|
+ *
|
|
+ * This program is distributed in the hope it will be useful, but WITHOUT
|
|
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
+ * more details.
|
|
+ *
|
|
+ * You should have received a copy of the GNU General Public License along with
|
|
+ * this program. If not, see <http://www.gnu.org/licenses/>.
|
|
+ */
|
|
+
|
|
+#include <linux/arm-smccc.h>
|
|
+#include <linux/err.h>
|
|
+#include <linux/io.h>
|
|
+#include <linux/module.h>
|
|
+#include <linux/mfd/syscon.h>
|
|
+#include <linux/of.h>
|
|
+#include <linux/of_device.h>
|
|
+#include <linux/platform_device.h>
|
|
+#include <linux/regulator/driver.h>
|
|
+#include <linux/regulator/machine.h>
|
|
+#include <linux/regulator/of_regulator.h>
|
|
+#include <linux/regmap.h>
|
|
+#include <linux/slab.h>
|
|
+
|
|
+/*
|
|
+ * Registers
|
|
+ */
|
|
+#define REG_PWR_CR3 0x0C
|
|
+
|
|
+/*
|
|
+ * SYSTEM_PARAMETER
|
|
+ */
|
|
+#define REG_1_1_EN BIT(30)
|
|
+#define REG_1_8_EN BIT(28)
|
|
+#define USB_3_3_EN BIT(24)
|
|
+
|
|
+#define STM32_SMC_PWR 0x82001001
|
|
+#define STM32_WRITE 0x1
|
|
+#define STM32_SMC_REG_SET 0x2
|
|
+#define STM32_SMC_REG_CLEAR 0x3
|
|
+
|
|
+#define SMC(class, op, address, val)\
|
|
+ ({\
|
|
+ struct arm_smccc_res res;\
|
|
+ arm_smccc_smc(class, op, address, val,\
|
|
+ 0, 0, 0, 0, &res);\
|
|
+ })
|
|
+
|
|
+static int stm32_pwr_secure_regulator_enable(struct regulator_dev *rdev)
|
|
+{
|
|
+ SMC(STM32_SMC_PWR, STM32_SMC_REG_SET, rdev->desc->enable_reg,
|
|
+ rdev->desc->enable_mask);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int stm32_pwr_secure_regulator_disable(struct regulator_dev *rdev)
|
|
+{
|
|
+ SMC(STM32_SMC_PWR, STM32_SMC_REG_CLEAR, rdev->desc->enable_reg,
|
|
+ rdev->desc->enable_mask);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static const struct regulator_ops stm32_pwr_reg_ops = {
|
|
+ .list_voltage = regulator_list_voltage_linear,
|
|
+ .enable = regulator_enable_regmap,
|
|
+ .disable = regulator_disable_regmap,
|
|
+ .is_enabled = regulator_is_enabled_regmap,
|
|
+};
|
|
+
|
|
+static const struct regulator_ops stm32_pwr_reg_secure_ops = {
|
|
+ .list_voltage = regulator_list_voltage_linear,
|
|
+ .enable = stm32_pwr_secure_regulator_enable,
|
|
+ .disable = stm32_pwr_secure_regulator_disable,
|
|
+ .is_enabled = regulator_is_enabled_regmap,
|
|
+};
|
|
+
|
|
+static const struct regulator_desc stm32_pwr_reg11 = {
|
|
+ .name = "REG11",
|
|
+ .of_match = of_match_ptr("reg11"),
|
|
+ .n_voltages = 1,
|
|
+ .type = REGULATOR_VOLTAGE,
|
|
+ .min_uV = 1100000,
|
|
+ .fixed_uV = 1100000,
|
|
+ .ops = &stm32_pwr_reg_ops,
|
|
+ .enable_reg = REG_PWR_CR3,
|
|
+ .enable_mask = REG_1_1_EN,
|
|
+ .owner = THIS_MODULE,
|
|
+ .supply_name = "vdd",
|
|
+};
|
|
+
|
|
+static const struct regulator_desc stm32_pwr_reg18 = {
|
|
+ .name = "REG18",
|
|
+ .of_match = of_match_ptr("reg18"),
|
|
+ .n_voltages = 1,
|
|
+ .type = REGULATOR_VOLTAGE,
|
|
+ .min_uV = 1800000,
|
|
+ .fixed_uV = 1800000,
|
|
+ .ops = &stm32_pwr_reg_ops,
|
|
+ .enable_reg = REG_PWR_CR3,
|
|
+ .enable_mask = REG_1_8_EN,
|
|
+ .owner = THIS_MODULE,
|
|
+ .supply_name = "vdd",
|
|
+};
|
|
+
|
|
+static const struct regulator_desc stm32_pwr_usb33 = {
|
|
+ .name = "USB33",
|
|
+ .of_match = of_match_ptr("usb33"),
|
|
+ .n_voltages = 1,
|
|
+ .type = REGULATOR_VOLTAGE,
|
|
+ .min_uV = 3300000,
|
|
+ .fixed_uV = 3300000,
|
|
+ .ops = &stm32_pwr_reg_ops,
|
|
+ .enable_reg = REG_PWR_CR3,
|
|
+ .enable_mask = USB_3_3_EN,
|
|
+ .owner = THIS_MODULE,
|
|
+ .supply_name = "vdd_3v3_usbfs",
|
|
+};
|
|
+
|
|
+static struct of_regulator_match stm32_pwr_reg_matches[] = {
|
|
+ { .name = "reg11", .driver_data = (void *)&stm32_pwr_reg11 },
|
|
+ { .name = "reg18", .driver_data = (void *)&stm32_pwr_reg18 },
|
|
+ { .name = "usb33", .driver_data = (void *)&stm32_pwr_usb33 },
|
|
+};
|
|
+
|
|
+#define STM32PWR_REG_NUM_REGS ARRAY_SIZE(stm32_pwr_reg_matches)
|
|
+
|
|
+static int is_stm32_soc_secured(struct platform_device *pdev, int *val)
|
|
+{
|
|
+ struct device_node *np = pdev->dev.of_node;
|
|
+ struct regmap *syscon;
|
|
+ u32 reg, mask;
|
|
+ int tzc_val = 0;
|
|
+ int err;
|
|
+
|
|
+ syscon = syscon_regmap_lookup_by_phandle(np, "st,tzcr");
|
|
+ if (IS_ERR(syscon)) {
|
|
+ dev_err(&pdev->dev, "tzcr syscon required !\n");
|
|
+ return PTR_ERR(syscon);
|
|
+ }
|
|
+
|
|
+ err = of_property_read_u32_index(np, "st,tzcr", 1, ®);
|
|
+ if (err) {
|
|
+ dev_err(&pdev->dev, "tzcr offset required !\n");
|
|
+ return err;
|
|
+ }
|
|
+
|
|
+ err = of_property_read_u32_index(np, "st,tzcr", 2, &mask);
|
|
+ if (err) {
|
|
+ dev_err(&pdev->dev, "tzcr mask required !\n");
|
|
+ return err;
|
|
+ }
|
|
+
|
|
+ err = regmap_read(syscon, reg, &tzc_val);
|
|
+ if (err) {
|
|
+ dev_err(&pdev->dev, "failed to read tzcr status !\n");
|
|
+ return err;
|
|
+ }
|
|
+
|
|
+ *val = tzc_val & mask;
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int stm32_power_regulator_probe(struct platform_device *pdev)
|
|
+{
|
|
+ struct device_node *np = pdev->dev.of_node;
|
|
+ struct regulator_dev *rdev;
|
|
+ struct regulator_config config = { };
|
|
+ struct regmap *regmap;
|
|
+ struct regulator_desc *desc;
|
|
+ int i, ret = 0;
|
|
+ int tzen = 0;
|
|
+
|
|
+ of_regulator_match(&pdev->dev, np, stm32_pwr_reg_matches,
|
|
+ STM32PWR_REG_NUM_REGS);
|
|
+
|
|
+ regmap = syscon_node_to_regmap(pdev->dev.parent->of_node);
|
|
+ if (IS_ERR(regmap))
|
|
+ return PTR_ERR(regmap);
|
|
+
|
|
+ config.regmap = regmap;
|
|
+ config.dev = &pdev->dev;
|
|
+
|
|
+ ret = is_stm32_soc_secured(pdev, &tzen);
|
|
+ if (ret)
|
|
+ return ret;
|
|
+
|
|
+ for (i = 0; i < STM32PWR_REG_NUM_REGS; i++) {
|
|
+ struct of_regulator_match *match = &stm32_pwr_reg_matches[i];
|
|
+
|
|
+ if (!match->init_data ||
|
|
+ !match->of_node)
|
|
+ continue;
|
|
+
|
|
+ config.init_data = match->init_data;
|
|
+ config.driver_data = match->driver_data;
|
|
+ config.of_node = match->of_node;
|
|
+
|
|
+ if (tzen) {
|
|
+ desc = match->driver_data;
|
|
+ desc->ops = &stm32_pwr_reg_secure_ops;
|
|
+ }
|
|
+
|
|
+ rdev = devm_regulator_register(&pdev->dev,
|
|
+ match->driver_data,
|
|
+ &config);
|
|
+ if (IS_ERR(rdev)) {
|
|
+ ret = PTR_ERR(rdev);
|
|
+ dev_err(&pdev->dev,
|
|
+ "Failed to register regulator: %d\n", ret);
|
|
+ break;
|
|
+ }
|
|
+ }
|
|
+ return ret;
|
|
+}
|
|
+
|
|
+static const struct of_device_id stm32_pwr_reg_of_match[] = {
|
|
+ { .compatible = "st,stm32mp1,pwr-reg", },
|
|
+ {},
|
|
+};
|
|
+
|
|
+static struct platform_driver stm32_pwr_reg_driver = {
|
|
+ .probe = stm32_power_regulator_probe,
|
|
+ .driver = {
|
|
+ .name = "stm32-pwr-regulator",
|
|
+ .of_match_table = of_match_ptr(stm32_pwr_reg_of_match),
|
|
+ },
|
|
+};
|
|
+
|
|
+static int __init stm32_pwr_regulator_init(void)
|
|
+{
|
|
+ return platform_driver_register(&stm32_pwr_reg_driver);
|
|
+}
|
|
+subsys_initcall(stm32_pwr_regulator_init);
|
|
diff --git a/drivers/regulator/stm32-vrefbuf.c b/drivers/regulator/stm32-vrefbuf.c
|
|
index e0a9c44..29cca32 100644
|
|
--- a/drivers/regulator/stm32-vrefbuf.c
|
|
+++ b/drivers/regulator/stm32-vrefbuf.c
|
|
@@ -15,6 +15,7 @@
|
|
#include <linux/platform_device.h>
|
|
#include <linux/regulator/driver.h>
|
|
#include <linux/regulator/of_regulator.h>
|
|
+#include <linux/pm_runtime.h>
|
|
|
|
/* STM32 VREFBUF registers */
|
|
#define STM32_VREFBUF_CSR 0x00
|
|
@@ -25,9 +26,12 @@
|
|
#define STM32_HIZ BIT(1)
|
|
#define STM32_ENVR BIT(0)
|
|
|
|
+#define STM32_VREFBUF_AUTO_SUSPEND_DELAY_MS 10
|
|
+
|
|
struct stm32_vrefbuf {
|
|
void __iomem *base;
|
|
struct clk *clk;
|
|
+ struct device *dev;
|
|
};
|
|
|
|
static const unsigned int stm32_vrefbuf_voltages[] = {
|
|
@@ -38,9 +42,16 @@ static const unsigned int stm32_vrefbuf_voltages[] = {
|
|
static int stm32_vrefbuf_enable(struct regulator_dev *rdev)
|
|
{
|
|
struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev);
|
|
- u32 val = readl_relaxed(priv->base + STM32_VREFBUF_CSR);
|
|
+ u32 val;
|
|
int ret;
|
|
|
|
+ ret = pm_runtime_get_sync(priv->dev);
|
|
+ if (ret < 0) {
|
|
+ pm_runtime_put_noidle(priv->dev);
|
|
+ return ret;
|
|
+ }
|
|
+
|
|
+ val = readl_relaxed(priv->base + STM32_VREFBUF_CSR);
|
|
val = (val & ~STM32_HIZ) | STM32_ENVR;
|
|
writel_relaxed(val, priv->base + STM32_VREFBUF_CSR);
|
|
|
|
@@ -59,45 +70,95 @@ static int stm32_vrefbuf_enable(struct regulator_dev *rdev)
|
|
writel_relaxed(val, priv->base + STM32_VREFBUF_CSR);
|
|
}
|
|
|
|
+ pm_runtime_mark_last_busy(priv->dev);
|
|
+ pm_runtime_put_autosuspend(priv->dev);
|
|
+
|
|
return ret;
|
|
}
|
|
|
|
static int stm32_vrefbuf_disable(struct regulator_dev *rdev)
|
|
{
|
|
struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev);
|
|
- u32 val = readl_relaxed(priv->base + STM32_VREFBUF_CSR);
|
|
+ u32 val;
|
|
+ int ret;
|
|
|
|
+ ret = pm_runtime_get_sync(priv->dev);
|
|
+ if (ret < 0) {
|
|
+ pm_runtime_put_noidle(priv->dev);
|
|
+ return ret;
|
|
+ }
|
|
+
|
|
+ val = readl_relaxed(priv->base + STM32_VREFBUF_CSR);
|
|
val = (val & ~STM32_ENVR) | STM32_HIZ;
|
|
writel_relaxed(val, priv->base + STM32_VREFBUF_CSR);
|
|
|
|
+ pm_runtime_mark_last_busy(priv->dev);
|
|
+ pm_runtime_put_autosuspend(priv->dev);
|
|
+
|
|
return 0;
|
|
}
|
|
|
|
static int stm32_vrefbuf_is_enabled(struct regulator_dev *rdev)
|
|
{
|
|
struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev);
|
|
+ int ret;
|
|
|
|
- return readl_relaxed(priv->base + STM32_VREFBUF_CSR) & STM32_ENVR;
|
|
+ ret = pm_runtime_get_sync(priv->dev);
|
|
+ if (ret < 0) {
|
|
+ pm_runtime_put_noidle(priv->dev);
|
|
+ return ret;
|
|
+ }
|
|
+
|
|
+ ret = readl_relaxed(priv->base + STM32_VREFBUF_CSR) & STM32_ENVR;
|
|
+
|
|
+ pm_runtime_mark_last_busy(priv->dev);
|
|
+ pm_runtime_put_autosuspend(priv->dev);
|
|
+
|
|
+ return ret;
|
|
}
|
|
|
|
static int stm32_vrefbuf_set_voltage_sel(struct regulator_dev *rdev,
|
|
unsigned sel)
|
|
{
|
|
struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev);
|
|
- u32 val = readl_relaxed(priv->base + STM32_VREFBUF_CSR);
|
|
+ u32 val;
|
|
+ int ret;
|
|
|
|
+ ret = pm_runtime_get_sync(priv->dev);
|
|
+ if (ret < 0) {
|
|
+ pm_runtime_put_noidle(priv->dev);
|
|
+ return ret;
|
|
+ }
|
|
+
|
|
+ val = readl_relaxed(priv->base + STM32_VREFBUF_CSR);
|
|
val = (val & ~STM32_VRS) | FIELD_PREP(STM32_VRS, sel);
|
|
writel_relaxed(val, priv->base + STM32_VREFBUF_CSR);
|
|
|
|
+ pm_runtime_mark_last_busy(priv->dev);
|
|
+ pm_runtime_put_autosuspend(priv->dev);
|
|
+
|
|
return 0;
|
|
}
|
|
|
|
static int stm32_vrefbuf_get_voltage_sel(struct regulator_dev *rdev)
|
|
{
|
|
struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev);
|
|
- u32 val = readl_relaxed(priv->base + STM32_VREFBUF_CSR);
|
|
+ u32 val;
|
|
+ int ret;
|
|
|
|
- return FIELD_GET(STM32_VRS, val);
|
|
+ ret = pm_runtime_get_sync(priv->dev);
|
|
+ if (ret < 0) {
|
|
+ pm_runtime_put_noidle(priv->dev);
|
|
+ return ret;
|
|
+ }
|
|
+
|
|
+ val = readl_relaxed(priv->base + STM32_VREFBUF_CSR);
|
|
+ ret = FIELD_GET(STM32_VRS, val);
|
|
+
|
|
+ pm_runtime_mark_last_busy(priv->dev);
|
|
+ pm_runtime_put_autosuspend(priv->dev);
|
|
+
|
|
+ return ret;
|
|
}
|
|
|
|
static const struct regulator_ops stm32_vrefbuf_volt_ops = {
|
|
@@ -130,6 +191,7 @@ static int stm32_vrefbuf_probe(struct platform_device *pdev)
|
|
priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
|
|
if (!priv)
|
|
return -ENOMEM;
|
|
+ priv->dev = &pdev->dev;
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
priv->base = devm_ioremap_resource(&pdev->dev, res);
|
|
@@ -140,10 +202,17 @@ static int stm32_vrefbuf_probe(struct platform_device *pdev)
|
|
if (IS_ERR(priv->clk))
|
|
return PTR_ERR(priv->clk);
|
|
|
|
+ pm_runtime_get_noresume(&pdev->dev);
|
|
+ pm_runtime_set_active(&pdev->dev);
|
|
+ pm_runtime_set_autosuspend_delay(&pdev->dev,
|
|
+ STM32_VREFBUF_AUTO_SUSPEND_DELAY_MS);
|
|
+ pm_runtime_use_autosuspend(&pdev->dev);
|
|
+ pm_runtime_enable(&pdev->dev);
|
|
+
|
|
ret = clk_prepare_enable(priv->clk);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "clk prepare failed with error %d\n", ret);
|
|
- return ret;
|
|
+ goto err_pm_stop;
|
|
}
|
|
|
|
config.dev = &pdev->dev;
|
|
@@ -161,10 +230,17 @@ static int stm32_vrefbuf_probe(struct platform_device *pdev)
|
|
}
|
|
platform_set_drvdata(pdev, rdev);
|
|
|
|
+ pm_runtime_mark_last_busy(&pdev->dev);
|
|
+ pm_runtime_put_autosuspend(&pdev->dev);
|
|
+
|
|
return 0;
|
|
|
|
err_clk_dis:
|
|
clk_disable_unprepare(priv->clk);
|
|
+err_pm_stop:
|
|
+ pm_runtime_disable(&pdev->dev);
|
|
+ pm_runtime_set_suspended(&pdev->dev);
|
|
+ pm_runtime_put_noidle(&pdev->dev);
|
|
|
|
return ret;
|
|
}
|
|
@@ -174,12 +250,44 @@ static int stm32_vrefbuf_remove(struct platform_device *pdev)
|
|
struct regulator_dev *rdev = platform_get_drvdata(pdev);
|
|
struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev);
|
|
|
|
+ pm_runtime_get_sync(&pdev->dev);
|
|
regulator_unregister(rdev);
|
|
clk_disable_unprepare(priv->clk);
|
|
+ pm_runtime_disable(&pdev->dev);
|
|
+ pm_runtime_set_suspended(&pdev->dev);
|
|
+ pm_runtime_put_noidle(&pdev->dev);
|
|
|
|
return 0;
|
|
};
|
|
|
|
+#if defined(CONFIG_PM)
|
|
+static int stm32_vrefbuf_runtime_suspend(struct device *dev)
|
|
+{
|
|
+ struct regulator_dev *rdev = dev_get_drvdata(dev);
|
|
+ struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev);
|
|
+
|
|
+ clk_disable_unprepare(priv->clk);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int stm32_vrefbuf_runtime_resume(struct device *dev)
|
|
+{
|
|
+ struct regulator_dev *rdev = dev_get_drvdata(dev);
|
|
+ struct stm32_vrefbuf *priv = rdev_get_drvdata(rdev);
|
|
+
|
|
+ return clk_prepare_enable(priv->clk);
|
|
+}
|
|
+#endif
|
|
+
|
|
+static const struct dev_pm_ops stm32_vrefbuf_pm_ops = {
|
|
+ SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
|
|
+ pm_runtime_force_resume)
|
|
+ SET_RUNTIME_PM_OPS(stm32_vrefbuf_runtime_suspend,
|
|
+ stm32_vrefbuf_runtime_resume,
|
|
+ NULL)
|
|
+};
|
|
+
|
|
static const struct of_device_id stm32_vrefbuf_of_match[] = {
|
|
{ .compatible = "st,stm32-vrefbuf", },
|
|
{},
|
|
@@ -192,6 +300,7 @@ static struct platform_driver stm32_vrefbuf_driver = {
|
|
.driver = {
|
|
.name = "stm32-vrefbuf",
|
|
.of_match_table = of_match_ptr(stm32_vrefbuf_of_match),
|
|
+ .pm = &stm32_vrefbuf_pm_ops,
|
|
},
|
|
};
|
|
module_platform_driver(stm32_vrefbuf_driver);
|
|
diff --git a/drivers/regulator/stpmic1_regulator.c b/drivers/regulator/stpmic1_regulator.c
|
|
new file mode 100644
|
|
index 0000000..31c960c
|
|
--- /dev/null
|
|
+++ b/drivers/regulator/stpmic1_regulator.c
|
|
@@ -0,0 +1,663 @@
|
|
+// SPDX-License-Identifier: GPL-2.0
|
|
+// Copyright (C) STMicroelectronics 2018
|
|
+// Author: Pascal Paillet <p.paillet@st.com> for STMicroelectronics.
|
|
+
|
|
+#include <linux/interrupt.h>
|
|
+#include <linux/mfd/stpmic1.h>
|
|
+#include <linux/module.h>
|
|
+#include <linux/of_irq.h>
|
|
+#include <linux/platform_device.h>
|
|
+#include <linux/regmap.h>
|
|
+#include <linux/regulator/driver.h>
|
|
+#include <linux/regulator/machine.h>
|
|
+#include <linux/regulator/of_regulator.h>
|
|
+
|
|
+/**
|
|
+ * stpmic1 regulator description
|
|
+ * @desc: regulator framework description
|
|
+ * @mask_reset_reg: mask reset register address
|
|
+ * @mask_reset_mask: mask rank and mask reset register mask
|
|
+ * @icc_reg: icc register address
|
|
+ * @icc_mask: icc register mask
|
|
+ */
|
|
+struct stpmic1_regulator_cfg {
|
|
+ struct regulator_desc desc;
|
|
+ u8 mask_reset_reg;
|
|
+ u8 mask_reset_mask;
|
|
+ u8 icc_reg;
|
|
+ u8 icc_mask;
|
|
+};
|
|
+
|
|
+/**
|
|
+ * stpmic1 regulator data: this structure is used as driver data
|
|
+ * @regul_id: regulator id
|
|
+ * @reg_node: DT node of regulator (unused on non-DT platforms)
|
|
+ * @cfg: stpmic specific regulator description
|
|
+ * @mask_reset: mask_reset bit value
|
|
+ * @irq_curlim: current limit interrupt number
|
|
+ * @regmap: point to parent regmap structure
|
|
+ */
|
|
+struct stpmic1_regulator {
|
|
+ unsigned int regul_id;
|
|
+ struct device_node *reg_node;
|
|
+ struct stpmic1_regulator_cfg *cfg;
|
|
+ u8 mask_reset;
|
|
+ int irq_curlim;
|
|
+ struct regmap *regmap;
|
|
+};
|
|
+
|
|
+static int stpmic1_set_mode(struct regulator_dev *rdev, unsigned int mode);
|
|
+static unsigned int stpmic1_get_mode(struct regulator_dev *rdev);
|
|
+static int stpmic1_set_icc(struct regulator_dev *rdev);
|
|
+static int stpmic1_regulator_parse_dt(void *driver_data);
|
|
+static unsigned int stpmic1_map_mode(unsigned int mode);
|
|
+
|
|
+enum {
|
|
+ STPMIC1_BUCK1 = 0,
|
|
+ STPMIC1_BUCK2 = 1,
|
|
+ STPMIC1_BUCK3 = 2,
|
|
+ STPMIC1_BUCK4 = 3,
|
|
+ STPMIC1_LDO1 = 4,
|
|
+ STPMIC1_LDO2 = 5,
|
|
+ STPMIC1_LDO3 = 6,
|
|
+ STPMIC1_LDO4 = 7,
|
|
+ STPMIC1_LDO5 = 8,
|
|
+ STPMIC1_LDO6 = 9,
|
|
+ STPMIC1_VREF_DDR = 10,
|
|
+ STPMIC1_BOOST = 11,
|
|
+ STPMIC1_VBUS_OTG = 12,
|
|
+ STPMIC1_SW_OUT = 13,
|
|
+};
|
|
+
|
|
+/* Enable time worst case is 5000mV/(2250uV/uS) */
|
|
+#define PMIC_ENABLE_TIME_US 2200
|
|
+
|
|
+#define STPMIC1_BUCK_MODE_NORMAL 0
|
|
+#define STPMIC1_BUCK_MODE_LP BUCK_HPLP_ENABLE_MASK
|
|
+
|
|
+struct regulator_linear_range buck1_ranges[] = {
|
|
+ REGULATOR_LINEAR_RANGE(725000, 0, 4, 0),
|
|
+ REGULATOR_LINEAR_RANGE(725000, 5, 36, 25000),
|
|
+ REGULATOR_LINEAR_RANGE(1500000, 37, 63, 0),
|
|
+};
|
|
+
|
|
+struct regulator_linear_range buck2_ranges[] = {
|
|
+ REGULATOR_LINEAR_RANGE(1000000, 0, 17, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1050000, 18, 19, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1100000, 20, 21, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1150000, 22, 23, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1200000, 24, 25, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1250000, 26, 27, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1300000, 28, 29, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1350000, 30, 31, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1400000, 32, 33, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1450000, 34, 35, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1500000, 36, 63, 0),
|
|
+};
|
|
+
|
|
+struct regulator_linear_range buck3_ranges[] = {
|
|
+ REGULATOR_LINEAR_RANGE(1000000, 0, 19, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1100000, 20, 23, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1200000, 24, 27, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1300000, 28, 31, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1400000, 32, 35, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1500000, 36, 55, 100000),
|
|
+ REGULATOR_LINEAR_RANGE(3400000, 56, 63, 0),
|
|
+
|
|
+};
|
|
+
|
|
+struct regulator_linear_range buck4_ranges[] = {
|
|
+ REGULATOR_LINEAR_RANGE(600000, 0, 27, 25000),
|
|
+ REGULATOR_LINEAR_RANGE(1300000, 28, 29, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1350000, 30, 31, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1400000, 32, 33, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1450000, 34, 35, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1500000, 36, 60, 100000),
|
|
+ REGULATOR_LINEAR_RANGE(3900000, 61, 63, 0),
|
|
+
|
|
+};
|
|
+
|
|
+struct regulator_linear_range ldo1_ranges[] = {
|
|
+ REGULATOR_LINEAR_RANGE(1700000, 0, 7, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1700000, 8, 24, 100000),
|
|
+ REGULATOR_LINEAR_RANGE(3300000, 25, 31, 0),
|
|
+
|
|
+};
|
|
+
|
|
+struct regulator_linear_range ldo2_ranges[] = {
|
|
+ REGULATOR_LINEAR_RANGE(1700000, 0, 7, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1700000, 8, 24, 100000),
|
|
+ REGULATOR_LINEAR_RANGE(3300000, 25, 30, 0),
|
|
+
|
|
+};
|
|
+
|
|
+struct regulator_linear_range ldo3_ranges[] = {
|
|
+ REGULATOR_LINEAR_RANGE(1700000, 0, 7, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1700000, 8, 24, 100000),
|
|
+ REGULATOR_LINEAR_RANGE(3300000, 25, 30, 0),
|
|
+ /* with index 31 LDO3 is in DDR mode */
|
|
+ REGULATOR_LINEAR_RANGE(500000, 31, 31, 0),
|
|
+};
|
|
+
|
|
+struct regulator_linear_range ldo5_ranges[] = {
|
|
+ REGULATOR_LINEAR_RANGE(1700000, 0, 7, 0),
|
|
+ REGULATOR_LINEAR_RANGE(1700000, 8, 30, 100000),
|
|
+ REGULATOR_LINEAR_RANGE(3900000, 31, 31, 0),
|
|
+};
|
|
+
|
|
+struct regulator_linear_range ldo6_ranges[] = {
|
|
+ REGULATOR_LINEAR_RANGE(900000, 0, 24, 100000),
|
|
+ REGULATOR_LINEAR_RANGE(3300000, 25, 31, 0),
|
|
+};
|
|
+
|
|
+static struct regulator_ops stpmic1_ldo_ops = {
|
|
+ .list_voltage = regulator_list_voltage_linear_range,
|
|
+ .map_voltage = regulator_map_voltage_linear_range,
|
|
+ .is_enabled = regulator_is_enabled_regmap,
|
|
+ .enable = regulator_enable_regmap,
|
|
+ .disable = regulator_disable_regmap,
|
|
+ .get_voltage_sel = regulator_get_voltage_sel_regmap,
|
|
+ .set_voltage_sel = regulator_set_voltage_sel_regmap,
|
|
+ .set_over_current_protection = stpmic1_set_icc,
|
|
+};
|
|
+
|
|
+static struct regulator_ops stpmic1_ldo3_ops = {
|
|
+ .list_voltage = regulator_list_voltage_linear_range,
|
|
+ .map_voltage = regulator_map_voltage_iterate,
|
|
+ .is_enabled = regulator_is_enabled_regmap,
|
|
+ .enable = regulator_enable_regmap,
|
|
+ .disable = regulator_disable_regmap,
|
|
+ .get_voltage_sel = regulator_get_voltage_sel_regmap,
|
|
+ .set_voltage_sel = regulator_set_voltage_sel_regmap,
|
|
+ .get_bypass = regulator_get_bypass_regmap,
|
|
+ .set_bypass = regulator_set_bypass_regmap,
|
|
+ .set_over_current_protection = stpmic1_set_icc,
|
|
+};
|
|
+
|
|
+static struct regulator_ops stpmic1_ldo4_fixed_regul_ops = {
|
|
+ .is_enabled = regulator_is_enabled_regmap,
|
|
+ .enable = regulator_enable_regmap,
|
|
+ .disable = regulator_disable_regmap,
|
|
+ .set_over_current_protection = stpmic1_set_icc,
|
|
+};
|
|
+
|
|
+static struct regulator_ops stpmic1_buck_ops = {
|
|
+ .list_voltage = regulator_list_voltage_linear_range,
|
|
+ .map_voltage = regulator_map_voltage_linear_range,
|
|
+ .is_enabled = regulator_is_enabled_regmap,
|
|
+ .enable = regulator_enable_regmap,
|
|
+ .disable = regulator_disable_regmap,
|
|
+ .get_voltage_sel = regulator_get_voltage_sel_regmap,
|
|
+ .set_voltage_sel = regulator_set_voltage_sel_regmap,
|
|
+ .set_pull_down = regulator_set_pull_down_regmap,
|
|
+ .set_mode = stpmic1_set_mode,
|
|
+ .get_mode = stpmic1_get_mode,
|
|
+ .set_over_current_protection = stpmic1_set_icc,
|
|
+};
|
|
+
|
|
+static struct regulator_ops stpmic1_vref_ddr_ops = {
|
|
+ .is_enabled = regulator_is_enabled_regmap,
|
|
+ .enable = regulator_enable_regmap,
|
|
+ .disable = regulator_disable_regmap,
|
|
+};
|
|
+
|
|
+static struct regulator_ops stpmic1_switch_regul_ops = {
|
|
+ .is_enabled = regulator_is_enabled_regmap,
|
|
+ .enable = regulator_enable_regmap,
|
|
+ .disable = regulator_disable_regmap,
|
|
+ .set_over_current_protection = stpmic1_set_icc,
|
|
+};
|
|
+
|
|
+#define REG_LDO(ids, base) { \
|
|
+ .name = #ids, \
|
|
+ .id = STPMIC1_##ids, \
|
|
+ .n_voltages = 32, \
|
|
+ .ops = &stpmic1_ldo_ops, \
|
|
+ .linear_ranges = base ## _ranges, \
|
|
+ .n_linear_ranges = ARRAY_SIZE(base ## _ranges), \
|
|
+ .type = REGULATOR_VOLTAGE, \
|
|
+ .owner = THIS_MODULE, \
|
|
+ .vsel_reg = ids##_ACTIVE_CR, \
|
|
+ .vsel_mask = LDO_VOLTAGE_MASK, \
|
|
+ .enable_reg = ids##_ACTIVE_CR, \
|
|
+ .enable_mask = LDO_ENABLE_MASK, \
|
|
+ .enable_val = 1, \
|
|
+ .disable_val = 0, \
|
|
+ .enable_time = PMIC_ENABLE_TIME_US, \
|
|
+ .supply_name = #base, \
|
|
+}
|
|
+
|
|
+#define REG_LDO3(ids, base) { \
|
|
+ .name = #ids, \
|
|
+ .id = STPMIC1_##ids, \
|
|
+ .n_voltages = 32, \
|
|
+ .ops = &stpmic1_ldo3_ops, \
|
|
+ .linear_ranges = ldo3_ranges, \
|
|
+ .n_linear_ranges = ARRAY_SIZE(ldo3_ranges), \
|
|
+ .type = REGULATOR_VOLTAGE, \
|
|
+ .owner = THIS_MODULE, \
|
|
+ .vsel_reg = LDO3_ACTIVE_CR, \
|
|
+ .vsel_mask = LDO_VOLTAGE_MASK, \
|
|
+ .enable_reg = LDO3_ACTIVE_CR, \
|
|
+ .enable_mask = LDO_ENABLE_MASK, \
|
|
+ .enable_val = 1, \
|
|
+ .disable_val = 0, \
|
|
+ .enable_time = PMIC_ENABLE_TIME_US, \
|
|
+ .bypass_reg = LDO3_ACTIVE_CR, \
|
|
+ .bypass_mask = LDO_BYPASS_MASK, \
|
|
+ .bypass_val_on = LDO_BYPASS_MASK, \
|
|
+ .bypass_val_off = 0, \
|
|
+ .supply_name = #base, \
|
|
+}
|
|
+
|
|
+#define REG_LDO4(ids, base) { \
|
|
+ .name = #ids, \
|
|
+ .id = STPMIC1_##ids, \
|
|
+ .n_voltages = 1, \
|
|
+ .ops = &stpmic1_ldo4_fixed_regul_ops, \
|
|
+ .type = REGULATOR_VOLTAGE, \
|
|
+ .owner = THIS_MODULE, \
|
|
+ .min_uV = 3300000, \
|
|
+ .fixed_uV = 3300000, \
|
|
+ .enable_reg = LDO4_ACTIVE_CR, \
|
|
+ .enable_mask = LDO_ENABLE_MASK, \
|
|
+ .enable_val = 1, \
|
|
+ .disable_val = 0, \
|
|
+ .enable_time = PMIC_ENABLE_TIME_US, \
|
|
+ .supply_name = #base, \
|
|
+}
|
|
+
|
|
+#define REG_BUCK(ids, base) { \
|
|
+ .name = #ids, \
|
|
+ .id = STPMIC1_##ids, \
|
|
+ .ops = &stpmic1_buck_ops, \
|
|
+ .n_voltages = 64, \
|
|
+ .linear_ranges = base ## _ranges, \
|
|
+ .n_linear_ranges = ARRAY_SIZE(base ## _ranges), \
|
|
+ .type = REGULATOR_VOLTAGE, \
|
|
+ .owner = THIS_MODULE, \
|
|
+ .vsel_reg = ids##_ACTIVE_CR, \
|
|
+ .vsel_mask = BUCK_VOLTAGE_MASK, \
|
|
+ .enable_reg = ids##_ACTIVE_CR, \
|
|
+ .enable_mask = BUCK_ENABLE_MASK, \
|
|
+ .enable_val = 1, \
|
|
+ .disable_val = 0, \
|
|
+ .enable_time = PMIC_ENABLE_TIME_US, \
|
|
+ .of_map_mode = stpmic1_map_mode, \
|
|
+ .pull_down_reg = ids##_PULL_DOWN_REG, \
|
|
+ .pull_down_mask = ids##_PULL_DOWN_MASK, \
|
|
+ .supply_name = #base, \
|
|
+}
|
|
+
|
|
+#define REG_VREF_DDR(ids, base) { \
|
|
+ .name = #ids, \
|
|
+ .id = STPMIC1_##ids, \
|
|
+ .n_voltages = 1, \
|
|
+ .ops = &stpmic1_vref_ddr_ops, \
|
|
+ .type = REGULATOR_VOLTAGE, \
|
|
+ .owner = THIS_MODULE, \
|
|
+ .min_uV = 500000, \
|
|
+ .fixed_uV = 500000, \
|
|
+ .enable_reg = VREF_DDR_ACTIVE_CR, \
|
|
+ .enable_mask = BUCK_ENABLE_MASK, \
|
|
+ .enable_val = 1, \
|
|
+ .disable_val = 0, \
|
|
+ .enable_time = PMIC_ENABLE_TIME_US, \
|
|
+ .supply_name = #base, \
|
|
+}
|
|
+
|
|
+#define REG_SWITCH(ids, base, reg, mask, val) { \
|
|
+ .name = #ids, \
|
|
+ .id = STPMIC1_##ids, \
|
|
+ .n_voltages = 1, \
|
|
+ .ops = &stpmic1_switch_regul_ops, \
|
|
+ .type = REGULATOR_VOLTAGE, \
|
|
+ .owner = THIS_MODULE, \
|
|
+ .min_uV = 0, \
|
|
+ .fixed_uV = 5000000, \
|
|
+ .enable_reg = (reg), \
|
|
+ .enable_mask = (mask), \
|
|
+ .enable_val = (val), \
|
|
+ .disable_val = 0, \
|
|
+ .enable_time = PMIC_ENABLE_TIME_US, \
|
|
+ .supply_name = #base, \
|
|
+}
|
|
+
|
|
+struct stpmic1_regulator_cfg stpmic1_regulator_cfgs[] = {
|
|
+ [STPMIC1_BUCK1] = {
|
|
+ .desc = REG_BUCK(BUCK1, buck1),
|
|
+ .icc_reg = BUCKS_ICCTO_CR,
|
|
+ .icc_mask = BIT(0),
|
|
+ .mask_reset_reg = BUCKS_MASK_RESET_CR,
|
|
+ .mask_reset_mask = BIT(0),
|
|
+ },
|
|
+ [STPMIC1_BUCK2] = {
|
|
+ .desc = REG_BUCK(BUCK2, buck2),
|
|
+ .icc_reg = BUCKS_ICCTO_CR,
|
|
+ .icc_mask = BIT(1),
|
|
+ .mask_reset_reg = BUCKS_MASK_RESET_CR,
|
|
+ .mask_reset_mask = BIT(1),
|
|
+ },
|
|
+ [STPMIC1_BUCK3] = {
|
|
+ .desc = REG_BUCK(BUCK3, buck3),
|
|
+ .icc_reg = BUCKS_ICCTO_CR,
|
|
+ .icc_mask = BIT(2),
|
|
+ .mask_reset_reg = BUCKS_MASK_RESET_CR,
|
|
+ .mask_reset_mask = BIT(2),
|
|
+ },
|
|
+ [STPMIC1_BUCK4] = {
|
|
+ .desc = REG_BUCK(BUCK4, buck4),
|
|
+ .icc_reg = BUCKS_ICCTO_CR,
|
|
+ .icc_mask = BIT(3),
|
|
+ .mask_reset_reg = BUCKS_MASK_RESET_CR,
|
|
+ .mask_reset_mask = BIT(3),
|
|
+ },
|
|
+ [STPMIC1_LDO1] = {
|
|
+ .desc = REG_LDO(LDO1, ldo1),
|
|
+ .icc_reg = LDOS_ICCTO_CR,
|
|
+ .icc_mask = BIT(0),
|
|
+ .mask_reset_reg = LDOS_MASK_RESET_CR,
|
|
+ .mask_reset_mask = BIT(0),
|
|
+ },
|
|
+ [STPMIC1_LDO2] = {
|
|
+ .desc = REG_LDO(LDO2, ldo2),
|
|
+ .icc_reg = LDOS_ICCTO_CR,
|
|
+ .icc_mask = BIT(1),
|
|
+ .mask_reset_reg = LDOS_MASK_RESET_CR,
|
|
+ .mask_reset_mask = BIT(1),
|
|
+ },
|
|
+ [STPMIC1_LDO3] = {
|
|
+ .desc = REG_LDO3(LDO3, ldo3),
|
|
+ .icc_reg = LDOS_ICCTO_CR,
|
|
+ .icc_mask = BIT(2),
|
|
+ .mask_reset_reg = LDOS_MASK_RESET_CR,
|
|
+ .mask_reset_mask = BIT(2),
|
|
+ },
|
|
+ [STPMIC1_LDO4] = {
|
|
+ .desc = REG_LDO4(LDO4, ldo4),
|
|
+ .icc_reg = LDOS_ICCTO_CR,
|
|
+ .icc_mask = BIT(3),
|
|
+ .mask_reset_reg = LDOS_MASK_RESET_CR,
|
|
+ .mask_reset_mask = BIT(3),
|
|
+ },
|
|
+ [STPMIC1_LDO5] = {
|
|
+ .desc = REG_LDO(LDO5, ldo5),
|
|
+ .icc_reg = LDOS_ICCTO_CR,
|
|
+ .icc_mask = BIT(4),
|
|
+ .mask_reset_reg = LDOS_MASK_RESET_CR,
|
|
+ .mask_reset_mask = BIT(4),
|
|
+ },
|
|
+ [STPMIC1_LDO6] = {
|
|
+ .desc = REG_LDO(LDO6, ldo6),
|
|
+ .icc_reg = LDOS_ICCTO_CR,
|
|
+ .icc_mask = BIT(5),
|
|
+ .mask_reset_reg = LDOS_MASK_RESET_CR,
|
|
+ .mask_reset_mask = BIT(5),
|
|
+ },
|
|
+ [STPMIC1_VREF_DDR] = {
|
|
+ .desc = REG_VREF_DDR(VREF_DDR, vref_ddr),
|
|
+ .mask_reset_reg = LDOS_MASK_RESET_CR,
|
|
+ .mask_reset_mask = BIT(6),
|
|
+ },
|
|
+ [STPMIC1_BOOST] = {
|
|
+ .desc = REG_SWITCH(BOOST, boost, BST_SW_CR,
|
|
+ BOOST_ENABLED,
|
|
+ BOOST_ENABLED),
|
|
+ .icc_reg = BUCKS_ICCTO_CR,
|
|
+ .icc_mask = BIT(6),
|
|
+ },
|
|
+ [STPMIC1_VBUS_OTG] = {
|
|
+ .desc = REG_SWITCH(VBUS_OTG, pwr_sw1, BST_SW_CR,
|
|
+ USBSW_OTG_SWITCH_ENABLED,
|
|
+ USBSW_OTG_SWITCH_ENABLED),
|
|
+ .icc_reg = BUCKS_ICCTO_CR,
|
|
+ .icc_mask = BIT(4),
|
|
+ },
|
|
+ [STPMIC1_SW_OUT] = {
|
|
+ .desc = REG_SWITCH(SW_OUT, pwr_sw2, BST_SW_CR,
|
|
+ SWIN_SWOUT_ENABLED,
|
|
+ SWIN_SWOUT_ENABLED),
|
|
+ .icc_reg = BUCKS_ICCTO_CR,
|
|
+ .icc_mask = BIT(5),
|
|
+ },
|
|
+};
|
|
+
|
|
+static unsigned int stpmic1_map_mode(unsigned int mode)
|
|
+{
|
|
+ switch (mode) {
|
|
+ case STPMIC1_BUCK_MODE_NORMAL:
|
|
+ return REGULATOR_MODE_NORMAL;
|
|
+ case STPMIC1_BUCK_MODE_LP:
|
|
+ return REGULATOR_MODE_STANDBY;
|
|
+ default:
|
|
+ return -EINVAL;
|
|
+ }
|
|
+}
|
|
+
|
|
+static unsigned int stpmic1_get_mode(struct regulator_dev *rdev)
|
|
+{
|
|
+ int value;
|
|
+
|
|
+ regmap_read(rdev->regmap, rdev->desc->enable_reg, &value);
|
|
+
|
|
+ if (value & STPMIC1_BUCK_MODE_LP)
|
|
+ return REGULATOR_MODE_STANDBY;
|
|
+
|
|
+ return REGULATOR_MODE_NORMAL;
|
|
+}
|
|
+
|
|
+static int stpmic1_set_mode(struct regulator_dev *rdev, unsigned int mode)
|
|
+{
|
|
+ int value;
|
|
+
|
|
+ switch (mode) {
|
|
+ case REGULATOR_MODE_NORMAL:
|
|
+ value = STPMIC1_BUCK_MODE_NORMAL;
|
|
+ break;
|
|
+ case REGULATOR_MODE_STANDBY:
|
|
+ value = STPMIC1_BUCK_MODE_LP;
|
|
+ break;
|
|
+ default:
|
|
+ return -EINVAL;
|
|
+ }
|
|
+
|
|
+ return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
|
|
+ STPMIC1_BUCK_MODE_LP, value);
|
|
+}
|
|
+
|
|
+static int stpmic1_set_icc(struct regulator_dev *rdev)
|
|
+{
|
|
+ struct stpmic1_regulator *regul = rdev_get_drvdata(rdev);
|
|
+
|
|
+ /* enable switch off in case of over current */
|
|
+ return regmap_update_bits(regul->regmap, regul->cfg->icc_reg,
|
|
+ regul->cfg->icc_mask, regul->cfg->icc_mask);
|
|
+}
|
|
+
|
|
+static irqreturn_t stpmic1_curlim_irq_handler(int irq, void *data)
|
|
+{
|
|
+ struct regulator_dev *rdev = (struct regulator_dev *)data;
|
|
+
|
|
+ mutex_lock(&rdev->mutex);
|
|
+
|
|
+ /* Send an overcurrent notification */
|
|
+ regulator_notifier_call_chain(rdev,
|
|
+ REGULATOR_EVENT_OVER_CURRENT,
|
|
+ NULL);
|
|
+
|
|
+ mutex_unlock(&rdev->mutex);
|
|
+
|
|
+ return IRQ_HANDLED;
|
|
+}
|
|
+
|
|
+static int stpmic1_regulator_init(struct platform_device *pdev,
|
|
+ struct regulator_dev *rdev)
|
|
+{
|
|
+ struct stpmic1_regulator *regul = rdev_get_drvdata(rdev);
|
|
+ int ret = 0;
|
|
+
|
|
+ /* set mask reset */
|
|
+ if (regul->mask_reset && regul->cfg->mask_reset_reg != 0) {
|
|
+ ret = regmap_update_bits(regul->regmap,
|
|
+ regul->cfg->mask_reset_reg,
|
|
+ regul->cfg->mask_reset_mask,
|
|
+ regul->cfg->mask_reset_mask);
|
|
+ if (ret) {
|
|
+ dev_err(&pdev->dev, "set mask reset failed\n");
|
|
+ return ret;
|
|
+ }
|
|
+ }
|
|
+
|
|
+ /* setup an irq handler for over-current detection */
|
|
+ if (regul->irq_curlim > 0) {
|
|
+ ret = devm_request_threaded_irq(&pdev->dev,
|
|
+ regul->irq_curlim, NULL,
|
|
+ stpmic1_curlim_irq_handler,
|
|
+ IRQF_ONESHOT | IRQF_SHARED,
|
|
+ pdev->name, rdev);
|
|
+ if (ret) {
|
|
+ dev_err(&pdev->dev, "Request IRQ failed\n");
|
|
+ return ret;
|
|
+ }
|
|
+ }
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+#define MATCH(_name, _id) \
|
|
+ [STPMIC1_##_id] = { \
|
|
+ .name = #_name, \
|
|
+ .desc = &stpmic1_regulator_cfgs[STPMIC1_##_id].desc, \
|
|
+ }
|
|
+
|
|
+static struct of_regulator_match stpmic1_regulators_matches[] = {
|
|
+ MATCH(buck1, BUCK1),
|
|
+ MATCH(buck2, BUCK2),
|
|
+ MATCH(buck3, BUCK3),
|
|
+ MATCH(buck4, BUCK4),
|
|
+ MATCH(ldo1, LDO1),
|
|
+ MATCH(ldo2, LDO2),
|
|
+ MATCH(ldo3, LDO3),
|
|
+ MATCH(ldo4, LDO4),
|
|
+ MATCH(ldo5, LDO5),
|
|
+ MATCH(ldo6, LDO6),
|
|
+ MATCH(vref_ddr, VREF_DDR),
|
|
+ MATCH(boost, BOOST),
|
|
+ MATCH(pwr_sw1, VBUS_OTG),
|
|
+ MATCH(pwr_sw2, SW_OUT),
|
|
+};
|
|
+
|
|
+static int stpmic1_regulator_parse_dt(void *driver_data)
|
|
+{
|
|
+ struct stpmic1_regulator *regul =
|
|
+ (struct stpmic1_regulator *)driver_data;
|
|
+
|
|
+ if (!regul)
|
|
+ return -EINVAL;
|
|
+
|
|
+ if (of_get_property(regul->reg_node, "st,mask-reset", NULL))
|
|
+ regul->mask_reset = 1;
|
|
+
|
|
+ regul->irq_curlim = of_irq_get(regul->reg_node, 0);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static struct
|
|
+regulator_dev *stpmic1_regulator_register(struct platform_device *pdev, int id,
|
|
+ struct regulator_init_data *init_data,
|
|
+ struct stpmic1_regulator *regul)
|
|
+{
|
|
+ struct stpmic1 *pmic_dev = dev_get_drvdata(pdev->dev.parent);
|
|
+ struct regulator_dev *rdev;
|
|
+ struct regulator_config config = {};
|
|
+
|
|
+ config.dev = &pdev->dev;
|
|
+ config.init_data = init_data;
|
|
+ config.of_node = stpmic1_regulators_matches[id].of_node;
|
|
+ config.regmap = pmic_dev->regmap;
|
|
+ config.driver_data = regul;
|
|
+
|
|
+ regul->regul_id = id;
|
|
+ regul->reg_node = config.of_node;
|
|
+ regul->cfg = &stpmic1_regulator_cfgs[id];
|
|
+ regul->regmap = pmic_dev->regmap;
|
|
+
|
|
+ rdev = devm_regulator_register(&pdev->dev, ®ul->cfg->desc, &config);
|
|
+ if (IS_ERR(rdev)) {
|
|
+ dev_err(&pdev->dev, "failed to register %s regulator\n",
|
|
+ regul->cfg->desc.name);
|
|
+ }
|
|
+
|
|
+ return rdev;
|
|
+}
|
|
+
|
|
+static int stpmic1_regulator_probe(struct platform_device *pdev)
|
|
+{
|
|
+ struct regulator_dev *rdev;
|
|
+ struct stpmic1_regulator *regul;
|
|
+ struct regulator_init_data *init_data;
|
|
+ struct device_node *np;
|
|
+ int i, ret;
|
|
+
|
|
+ np = pdev->dev.of_node;
|
|
+
|
|
+ ret = of_regulator_match(&pdev->dev, np,
|
|
+ stpmic1_regulators_matches,
|
|
+ ARRAY_SIZE(stpmic1_regulators_matches));
|
|
+ if (ret < 0) {
|
|
+ dev_err(&pdev->dev,
|
|
+ "Error in PMIC regulator device tree node");
|
|
+ return ret;
|
|
+ }
|
|
+
|
|
+ regul = devm_kzalloc(&pdev->dev, ARRAY_SIZE(stpmic1_regulator_cfgs) *
|
|
+ sizeof(struct stpmic1_regulator),
|
|
+ GFP_KERNEL);
|
|
+ if (!regul)
|
|
+ return -ENOMEM;
|
|
+
|
|
+ for (i = 0; i < ARRAY_SIZE(stpmic1_regulator_cfgs); i++) {
|
|
+ /* Parse DT & find regulators to register */
|
|
+ init_data = stpmic1_regulators_matches[i].init_data;
|
|
+ if (init_data)
|
|
+ init_data->regulator_init = &stpmic1_regulator_parse_dt;
|
|
+
|
|
+ rdev = stpmic1_regulator_register(pdev, i, init_data, regul);
|
|
+ if (IS_ERR(rdev))
|
|
+ return PTR_ERR(rdev);
|
|
+
|
|
+ ret = stpmic1_regulator_init(pdev, rdev);
|
|
+ if (ret) {
|
|
+ dev_err(&pdev->dev,
|
|
+ "failed to initialize regulator %d\n", ret);
|
|
+ return ret;
|
|
+ }
|
|
+
|
|
+ regul++;
|
|
+ }
|
|
+
|
|
+ dev_dbg(&pdev->dev, "stpmic1_regulator driver probed\n");
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static const struct of_device_id of_pmic_regulator_match[] = {
|
|
+ { .compatible = "st,stpmic1-regulators" },
|
|
+ { },
|
|
+};
|
|
+
|
|
+MODULE_DEVICE_TABLE(of, of_pmic_regulator_match);
|
|
+
|
|
+static struct platform_driver stpmic1_regulator_driver = {
|
|
+ .driver = {
|
|
+ .name = "stpmic1-regulator",
|
|
+ .of_match_table = of_match_ptr(of_pmic_regulator_match),
|
|
+ },
|
|
+ .probe = stpmic1_regulator_probe,
|
|
+};
|
|
+
|
|
+module_platform_driver(stpmic1_regulator_driver);
|
|
+
|
|
+MODULE_DESCRIPTION("STPMIC1 PMIC voltage regulator driver");
|
|
+MODULE_AUTHOR("Pascal Paillet <p.paillet@st.com>");
|
|
+MODULE_LICENSE("GPL v2");
|
|
--
|
|
2.7.4
|
|
|