Loading drivers/regulator/Kconfig +9 −0 Original line number Diff line number Diff line Loading @@ -803,6 +803,15 @@ config REGULATOR_QCOM_SPMI Qualcomm SPMI PMICs as a module. The module will be named "qcom_spmi-regulator". config REGULATOR_QPNP_AMOLED tristate "Qualcomm Technologies, Inc. QPNP AMOLED support" depends on SPMI help Supports the OLEDB/AB/IBB module in the Qualcomm Technologies, Inc. QPNP PMICs. Exposes regulators to control the triple power supply positive, negative and bias for the AMOLED display panel. It also allows configurability for the various bias-voltage parameters. config REGULATOR_RC5T583 tristate "RICOH RC5T583 Power regulators" depends on MFD_RC5T583 Loading drivers/regulator/Makefile +1 −0 Original line number Diff line number Diff line Loading @@ -88,6 +88,7 @@ obj-$(CONFIG_REGULATOR_QCOM_RPM) += qcom_rpm-regulator.o obj-$(CONFIG_REGULATOR_QCOM_RPMH) += qcom-rpmh-regulator.o obj-$(CONFIG_REGULATOR_QCOM_SMD_RPM) += qcom_smd-regulator.o obj-$(CONFIG_REGULATOR_QCOM_SPMI) += qcom_spmi-regulator.o obj-$(CONFIG_REGULATOR_QPNP_AMOLED) += qpnp-amoled-regulator.o obj-$(CONFIG_REGULATOR_PALMAS) += palmas-regulator.o obj-$(CONFIG_REGULATOR_PFUZE100) += pfuze100-regulator.o obj-$(CONFIG_REGULATOR_PV88060) += pv88060-regulator.o Loading drivers/regulator/qpnp-amoled-regulator.c 0 → 100644 +600 −0 Original line number Diff line number Diff line // SPDX-License-Identifier: GPL-2.0-only /* * Copyright (c) 2018-2020, The Linux Foundation. All rights reserved. */ #define pr_fmt(fmt) "AMOLED: %s: " fmt, __func__ #include <linux/kernel.h> #include <linux/module.h> #include <linux/of_address.h> #include <linux/platform_device.h> #include <linux/regmap.h> #include <linux/regulator/driver.h> #include <linux/regulator/of_regulator.h> #include <linux/regulator/machine.h> /* Register definitions */ #define PERIPH_TYPE 0x04 #define IBB_PERIPH_TYPE 0x20 #define AB_PERIPH_TYPE 0x24 #define OLEDB_PERIPH_TYPE 0x2C /* AB */ #define AB_LDO_PD_CTL(chip) (chip->ab_base + 0x78) /* AB_LDO_PD_CTL */ #define PULLDN_EN_BIT BIT(7) /* IBB */ #define IBB_PD_CTL(chip) (chip->ibb_base + 0x47) /* IBB_PD_CTL */ #define ENABLE_PD_BIT BIT(7) struct amoled_regulator { struct regulator_desc rdesc; struct regulator_dev *rdev; struct device_node *node; unsigned int mode; bool enabled; }; struct oledb_regulator { struct amoled_regulator vreg; /* DT params */ bool swire_control; }; struct ab_regulator { struct amoled_regulator vreg; /* DT params */ bool swire_control; bool pd_control; }; struct ibb_regulator { struct amoled_regulator vreg; /* DT params */ bool swire_control; bool pd_control; }; struct qpnp_amoled { struct device *dev; struct regmap *regmap; struct oledb_regulator oledb; struct ab_regulator ab; struct ibb_regulator ibb; /* DT params */ u32 oledb_base; u32 ab_base; u32 ibb_base; }; enum reg_type { OLEDB, AB, IBB, }; static int qpnp_amoled_read(struct qpnp_amoled *chip, u16 addr, u8 *value, u8 count) { int rc = 0; rc = regmap_bulk_read(chip->regmap, addr, value, count); if (rc < 0) pr_err("Failed to read from addr=0x%02x rc=%d\n", addr, rc); return rc; } static int qpnp_amoled_write(struct qpnp_amoled *chip, u16 addr, u8 *value, u8 count) { int rc; rc = regmap_bulk_write(chip->regmap, addr, value, count); if (rc < 0) pr_err("Failed to write to addr=0x%02x rc=%d\n", addr, rc); return rc; } static int qpnp_amoled_masked_write(struct qpnp_amoled *chip, u16 addr, u8 mask, u8 value) { int rc = 0; rc = regmap_update_bits(chip->regmap, addr, mask, value); if (rc < 0) pr_err("Failed to write addr=0x%02x value=0x%02x rc=%d\n", addr, value, rc); return rc; } /* AB regulator */ static int qpnp_ab_regulator_is_enabled(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); return chip->ab.vreg.enabled; } static int qpnp_ab_regulator_enable(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->ab.vreg.enabled = true; return 0; } static int qpnp_ab_regulator_disable(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->ab.vreg.enabled = false; return 0; } /* IBB regulator */ static int qpnp_ibb_regulator_is_enabled(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); return chip->ibb.vreg.enabled; } static int qpnp_ibb_regulator_enable(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->ibb.vreg.enabled = true; return 0; } static int qpnp_ibb_regulator_disable(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->ibb.vreg.enabled = false; return 0; } /* common to AB and IBB */ static int qpnp_ab_ibb_regulator_set_voltage(struct regulator_dev *rdev, int min_uV, int max_uV, unsigned int *selector) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); /* HW controlled */ if (chip->ab.swire_control || chip->ibb.swire_control) return 0; return 0; } static int qpnp_ab_ibb_regulator_get_voltage(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); /* HW controlled */ if (chip->ab.swire_control || chip->ibb.swire_control) return 0; return 0; } static int qpnp_ab_pd_control(struct qpnp_amoled *chip, bool en) { u8 val = en ? PULLDN_EN_BIT : 0; return qpnp_amoled_write(chip, AB_LDO_PD_CTL(chip), &val, 1); } static int qpnp_ibb_pd_control(struct qpnp_amoled *chip, bool en) { u8 val = en ? ENABLE_PD_BIT : 0; return qpnp_amoled_masked_write(chip, IBB_PD_CTL(chip), ENABLE_PD_BIT, val); } static int qpnp_ab_ibb_regulator_set_mode(struct regulator_dev *rdev, unsigned int mode) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); int rc = 0; if (mode != REGULATOR_MODE_NORMAL && mode != REGULATOR_MODE_STANDBY && mode != REGULATOR_MODE_IDLE) { pr_err("Unsupported mode %u\n", mode); return -EINVAL; } if (mode == chip->ab.vreg.mode || mode == chip->ibb.vreg.mode) return 0; pr_debug("mode: %d\n", mode); if (mode == REGULATOR_MODE_NORMAL || mode == REGULATOR_MODE_STANDBY) { if (chip->ibb.pd_control) { rc = qpnp_ibb_pd_control(chip, true); if (rc < 0) goto error; } if (chip->ab.pd_control) { rc = qpnp_ab_pd_control(chip, true); if (rc < 0) goto error; } } else if (mode == REGULATOR_MODE_IDLE) { if (chip->ibb.pd_control) { rc = qpnp_ibb_pd_control(chip, false); if (rc < 0) goto error; } if (chip->ab.pd_control) { rc = qpnp_ab_pd_control(chip, false); if (rc < 0) goto error; } } chip->ab.vreg.mode = chip->ibb.vreg.mode = mode; error: if (rc < 0) pr_err("Failed to configure for mode %d\n", mode); return rc; } static unsigned int qpnp_ab_ibb_regulator_get_mode(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); return chip->ibb.vreg.mode; } static struct regulator_ops qpnp_amoled_ab_ops = { .enable = qpnp_ab_regulator_enable, .disable = qpnp_ab_regulator_disable, .is_enabled = qpnp_ab_regulator_is_enabled, .set_voltage = qpnp_ab_ibb_regulator_set_voltage, .get_voltage = qpnp_ab_ibb_regulator_get_voltage, .set_mode = qpnp_ab_ibb_regulator_set_mode, .get_mode = qpnp_ab_ibb_regulator_get_mode, }; static struct regulator_ops qpnp_amoled_ibb_ops = { .enable = qpnp_ibb_regulator_enable, .disable = qpnp_ibb_regulator_disable, .is_enabled = qpnp_ibb_regulator_is_enabled, .set_voltage = qpnp_ab_ibb_regulator_set_voltage, .get_voltage = qpnp_ab_ibb_regulator_get_voltage, .set_mode = qpnp_ab_ibb_regulator_set_mode, .get_mode = qpnp_ab_ibb_regulator_get_mode, }; /* OLEDB regulator */ static int qpnp_oledb_regulator_is_enabled(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); return chip->oledb.vreg.enabled; } static int qpnp_oledb_regulator_enable(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->oledb.vreg.enabled = true; return 0; } static int qpnp_oledb_regulator_disable(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->oledb.vreg.enabled = false; return 0; } static int qpnp_oledb_regulator_set_voltage(struct regulator_dev *rdev, int min_uV, int max_uV, unsigned int *selector) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); /* HW controlled */ if (chip->oledb.swire_control) return 0; return 0; } static int qpnp_oledb_regulator_get_voltage(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); /* HW controlled */ if (chip->oledb.swire_control) return 0; return 0; } static int qpnp_oledb_regulator_set_mode(struct regulator_dev *rdev, unsigned int mode) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->oledb.vreg.mode = mode; return 0; } static unsigned int qpnp_oledb_regulator_get_mode(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); return chip->oledb.vreg.mode; } static struct regulator_ops qpnp_amoled_oledb_ops = { .enable = qpnp_oledb_regulator_enable, .disable = qpnp_oledb_regulator_disable, .is_enabled = qpnp_oledb_regulator_is_enabled, .set_voltage = qpnp_oledb_regulator_set_voltage, .get_voltage = qpnp_oledb_regulator_get_voltage, .set_mode = qpnp_oledb_regulator_set_mode, .get_mode = qpnp_oledb_regulator_get_mode, }; static int qpnp_amoled_regulator_register(struct qpnp_amoled *chip, enum reg_type type) { int rc = 0; struct regulator_init_data *init_data; struct regulator_config cfg = {}; struct regulator_desc *rdesc; struct regulator_dev *rdev; struct device_node *node; if (type == OLEDB) { node = chip->oledb.vreg.node; rdesc = &chip->oledb.vreg.rdesc; rdesc->ops = &qpnp_amoled_oledb_ops; rdev = chip->oledb.vreg.rdev; } else if (type == AB) { node = chip->ab.vreg.node; rdesc = &chip->ab.vreg.rdesc; rdesc->ops = &qpnp_amoled_ab_ops; rdev = chip->ab.vreg.rdev; } else if (type == IBB) { node = chip->ibb.vreg.node; rdesc = &chip->ibb.vreg.rdesc; rdesc->ops = &qpnp_amoled_ibb_ops; rdev = chip->ibb.vreg.rdev; } else { pr_err("Invalid regulator type %d\n", type); return -EINVAL; } init_data = of_get_regulator_init_data(chip->dev, node, rdesc); if (!init_data) { pr_err("Failed to get regulator_init_data for type %d\n", type); return -ENOMEM; } if (init_data->constraints.name) { rdesc->owner = THIS_MODULE; rdesc->type = REGULATOR_VOLTAGE; rdesc->name = init_data->constraints.name; cfg.dev = chip->dev; cfg.init_data = init_data; cfg.driver_data = chip; cfg.of_node = node; if (of_get_property(chip->dev->of_node, "parent-supply", NULL)) init_data->supply_regulator = "parent"; init_data->constraints.valid_ops_mask |= REGULATOR_CHANGE_VOLTAGE | REGULATOR_CHANGE_STATUS | REGULATOR_CHANGE_MODE; init_data->constraints.valid_modes_mask |= REGULATOR_MODE_NORMAL | REGULATOR_MODE_IDLE | REGULATOR_MODE_STANDBY; rdev = devm_regulator_register(chip->dev, rdesc, &cfg); if (IS_ERR(rdev)) { rc = PTR_ERR(rdev); rdev = NULL; pr_err("Failed to register amoled regulator for type %d rc = %d\n", type, rc); return rc; } if (type == OLEDB) chip->oledb.vreg.mode = REGULATOR_MODE_NORMAL; else if (type == IBB) chip->ibb.vreg.mode = REGULATOR_MODE_NORMAL; else chip->ab.vreg.mode = REGULATOR_MODE_NORMAL; } else { pr_err("regulator name missing for type %d\n", type); return -EINVAL; } return rc; } static int qpnp_amoled_hw_init(struct qpnp_amoled *chip) { int rc; rc = qpnp_amoled_regulator_register(chip, OLEDB); if (rc < 0) { dev_err(chip->dev, "Failed to register OLEDB regulator rc=%d\n", rc); return rc; } rc = qpnp_amoled_regulator_register(chip, AB); if (rc < 0) { dev_err(chip->dev, "Failed to register AB regulator rc=%d\n", rc); return rc; } rc = qpnp_amoled_regulator_register(chip, IBB); if (rc < 0) { dev_err(chip->dev, "Failed to register IBB regulator rc=%d\n", rc); return rc; } return 0; } static int qpnp_amoled_parse_dt(struct qpnp_amoled *chip) { struct device_node *temp, *node = chip->dev->of_node; const __be32 *prop_addr; int rc = 0; u32 base; u8 val; for_each_available_child_of_node(node, temp) { prop_addr = of_get_address(temp, 0, NULL, NULL); if (!prop_addr) { pr_err("Couldn't get reg address\n"); return -EINVAL; } base = be32_to_cpu(*prop_addr); rc = qpnp_amoled_read(chip, base + PERIPH_TYPE, &val, 1); if (rc < 0) { pr_err("Couldn't read PERIPH_TYPE for base %x\n", base); return rc; } switch (val) { case OLEDB_PERIPH_TYPE: chip->oledb_base = base; chip->oledb.vreg.node = temp; chip->oledb.swire_control = of_property_read_bool(temp, "qcom,swire-control"); break; case AB_PERIPH_TYPE: chip->ab_base = base; chip->ab.vreg.node = temp; chip->ab.swire_control = of_property_read_bool(temp, "qcom,swire-control"); chip->ab.pd_control = of_property_read_bool(temp, "qcom,aod-pd-control"); break; case IBB_PERIPH_TYPE: chip->ibb_base = base; chip->ibb.vreg.node = temp; chip->ibb.swire_control = of_property_read_bool(temp, "qcom,swire-control"); chip->ibb.pd_control = of_property_read_bool(temp, "qcom,aod-pd-control"); break; default: pr_err("Unknown peripheral type 0x%x\n", val); return -EINVAL; } } return 0; } static int qpnp_amoled_regulator_probe(struct platform_device *pdev) { int rc; struct device_node *node; struct qpnp_amoled *chip; node = pdev->dev.of_node; if (!node) { pr_err("No nodes defined\n"); return -ENODEV; } chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL); if (!chip) return -ENOMEM; chip->dev = &pdev->dev; chip->regmap = dev_get_regmap(pdev->dev.parent, NULL); if (!chip->regmap) { dev_err(&pdev->dev, "Failed to get the regmap handle\n"); rc = -EINVAL; goto error; } dev_set_drvdata(&pdev->dev, chip); rc = qpnp_amoled_parse_dt(chip); if (rc < 0) { dev_err(chip->dev, "Failed to parse DT params rc=%d\n", rc); goto error; } rc = qpnp_amoled_hw_init(chip); if (rc < 0) dev_err(chip->dev, "Failed to initialize HW rc=%d\n", rc); error: return rc; } static int qpnp_amoled_regulator_remove(struct platform_device *pdev) { return 0; } static const struct of_device_id amoled_match_table[] = { { .compatible = "qcom,qpnp-amoled-regulator", }, { }, }; static struct platform_driver qpnp_amoled_regulator_driver = { .driver = { .name = "qpnp-amoled-regulator", .of_match_table = amoled_match_table, }, .probe = qpnp_amoled_regulator_probe, .remove = qpnp_amoled_regulator_remove, }; static int __init qpnp_amoled_regulator_init(void) { return platform_driver_register(&qpnp_amoled_regulator_driver); } arch_initcall(qpnp_amoled_regulator_init); static void __exit qpnp_amoled_regulator_exit(void) { platform_driver_unregister(&qpnp_amoled_regulator_driver); } module_exit(qpnp_amoled_regulator_exit); MODULE_DESCRIPTION("QPNP AMOLED regulator driver"); MODULE_LICENSE("GPL v2"); Loading
drivers/regulator/Kconfig +9 −0 Original line number Diff line number Diff line Loading @@ -803,6 +803,15 @@ config REGULATOR_QCOM_SPMI Qualcomm SPMI PMICs as a module. The module will be named "qcom_spmi-regulator". config REGULATOR_QPNP_AMOLED tristate "Qualcomm Technologies, Inc. QPNP AMOLED support" depends on SPMI help Supports the OLEDB/AB/IBB module in the Qualcomm Technologies, Inc. QPNP PMICs. Exposes regulators to control the triple power supply positive, negative and bias for the AMOLED display panel. It also allows configurability for the various bias-voltage parameters. config REGULATOR_RC5T583 tristate "RICOH RC5T583 Power regulators" depends on MFD_RC5T583 Loading
drivers/regulator/Makefile +1 −0 Original line number Diff line number Diff line Loading @@ -88,6 +88,7 @@ obj-$(CONFIG_REGULATOR_QCOM_RPM) += qcom_rpm-regulator.o obj-$(CONFIG_REGULATOR_QCOM_RPMH) += qcom-rpmh-regulator.o obj-$(CONFIG_REGULATOR_QCOM_SMD_RPM) += qcom_smd-regulator.o obj-$(CONFIG_REGULATOR_QCOM_SPMI) += qcom_spmi-regulator.o obj-$(CONFIG_REGULATOR_QPNP_AMOLED) += qpnp-amoled-regulator.o obj-$(CONFIG_REGULATOR_PALMAS) += palmas-regulator.o obj-$(CONFIG_REGULATOR_PFUZE100) += pfuze100-regulator.o obj-$(CONFIG_REGULATOR_PV88060) += pv88060-regulator.o Loading
drivers/regulator/qpnp-amoled-regulator.c 0 → 100644 +600 −0 Original line number Diff line number Diff line // SPDX-License-Identifier: GPL-2.0-only /* * Copyright (c) 2018-2020, The Linux Foundation. All rights reserved. */ #define pr_fmt(fmt) "AMOLED: %s: " fmt, __func__ #include <linux/kernel.h> #include <linux/module.h> #include <linux/of_address.h> #include <linux/platform_device.h> #include <linux/regmap.h> #include <linux/regulator/driver.h> #include <linux/regulator/of_regulator.h> #include <linux/regulator/machine.h> /* Register definitions */ #define PERIPH_TYPE 0x04 #define IBB_PERIPH_TYPE 0x20 #define AB_PERIPH_TYPE 0x24 #define OLEDB_PERIPH_TYPE 0x2C /* AB */ #define AB_LDO_PD_CTL(chip) (chip->ab_base + 0x78) /* AB_LDO_PD_CTL */ #define PULLDN_EN_BIT BIT(7) /* IBB */ #define IBB_PD_CTL(chip) (chip->ibb_base + 0x47) /* IBB_PD_CTL */ #define ENABLE_PD_BIT BIT(7) struct amoled_regulator { struct regulator_desc rdesc; struct regulator_dev *rdev; struct device_node *node; unsigned int mode; bool enabled; }; struct oledb_regulator { struct amoled_regulator vreg; /* DT params */ bool swire_control; }; struct ab_regulator { struct amoled_regulator vreg; /* DT params */ bool swire_control; bool pd_control; }; struct ibb_regulator { struct amoled_regulator vreg; /* DT params */ bool swire_control; bool pd_control; }; struct qpnp_amoled { struct device *dev; struct regmap *regmap; struct oledb_regulator oledb; struct ab_regulator ab; struct ibb_regulator ibb; /* DT params */ u32 oledb_base; u32 ab_base; u32 ibb_base; }; enum reg_type { OLEDB, AB, IBB, }; static int qpnp_amoled_read(struct qpnp_amoled *chip, u16 addr, u8 *value, u8 count) { int rc = 0; rc = regmap_bulk_read(chip->regmap, addr, value, count); if (rc < 0) pr_err("Failed to read from addr=0x%02x rc=%d\n", addr, rc); return rc; } static int qpnp_amoled_write(struct qpnp_amoled *chip, u16 addr, u8 *value, u8 count) { int rc; rc = regmap_bulk_write(chip->regmap, addr, value, count); if (rc < 0) pr_err("Failed to write to addr=0x%02x rc=%d\n", addr, rc); return rc; } static int qpnp_amoled_masked_write(struct qpnp_amoled *chip, u16 addr, u8 mask, u8 value) { int rc = 0; rc = regmap_update_bits(chip->regmap, addr, mask, value); if (rc < 0) pr_err("Failed to write addr=0x%02x value=0x%02x rc=%d\n", addr, value, rc); return rc; } /* AB regulator */ static int qpnp_ab_regulator_is_enabled(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); return chip->ab.vreg.enabled; } static int qpnp_ab_regulator_enable(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->ab.vreg.enabled = true; return 0; } static int qpnp_ab_regulator_disable(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->ab.vreg.enabled = false; return 0; } /* IBB regulator */ static int qpnp_ibb_regulator_is_enabled(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); return chip->ibb.vreg.enabled; } static int qpnp_ibb_regulator_enable(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->ibb.vreg.enabled = true; return 0; } static int qpnp_ibb_regulator_disable(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->ibb.vreg.enabled = false; return 0; } /* common to AB and IBB */ static int qpnp_ab_ibb_regulator_set_voltage(struct regulator_dev *rdev, int min_uV, int max_uV, unsigned int *selector) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); /* HW controlled */ if (chip->ab.swire_control || chip->ibb.swire_control) return 0; return 0; } static int qpnp_ab_ibb_regulator_get_voltage(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); /* HW controlled */ if (chip->ab.swire_control || chip->ibb.swire_control) return 0; return 0; } static int qpnp_ab_pd_control(struct qpnp_amoled *chip, bool en) { u8 val = en ? PULLDN_EN_BIT : 0; return qpnp_amoled_write(chip, AB_LDO_PD_CTL(chip), &val, 1); } static int qpnp_ibb_pd_control(struct qpnp_amoled *chip, bool en) { u8 val = en ? ENABLE_PD_BIT : 0; return qpnp_amoled_masked_write(chip, IBB_PD_CTL(chip), ENABLE_PD_BIT, val); } static int qpnp_ab_ibb_regulator_set_mode(struct regulator_dev *rdev, unsigned int mode) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); int rc = 0; if (mode != REGULATOR_MODE_NORMAL && mode != REGULATOR_MODE_STANDBY && mode != REGULATOR_MODE_IDLE) { pr_err("Unsupported mode %u\n", mode); return -EINVAL; } if (mode == chip->ab.vreg.mode || mode == chip->ibb.vreg.mode) return 0; pr_debug("mode: %d\n", mode); if (mode == REGULATOR_MODE_NORMAL || mode == REGULATOR_MODE_STANDBY) { if (chip->ibb.pd_control) { rc = qpnp_ibb_pd_control(chip, true); if (rc < 0) goto error; } if (chip->ab.pd_control) { rc = qpnp_ab_pd_control(chip, true); if (rc < 0) goto error; } } else if (mode == REGULATOR_MODE_IDLE) { if (chip->ibb.pd_control) { rc = qpnp_ibb_pd_control(chip, false); if (rc < 0) goto error; } if (chip->ab.pd_control) { rc = qpnp_ab_pd_control(chip, false); if (rc < 0) goto error; } } chip->ab.vreg.mode = chip->ibb.vreg.mode = mode; error: if (rc < 0) pr_err("Failed to configure for mode %d\n", mode); return rc; } static unsigned int qpnp_ab_ibb_regulator_get_mode(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); return chip->ibb.vreg.mode; } static struct regulator_ops qpnp_amoled_ab_ops = { .enable = qpnp_ab_regulator_enable, .disable = qpnp_ab_regulator_disable, .is_enabled = qpnp_ab_regulator_is_enabled, .set_voltage = qpnp_ab_ibb_regulator_set_voltage, .get_voltage = qpnp_ab_ibb_regulator_get_voltage, .set_mode = qpnp_ab_ibb_regulator_set_mode, .get_mode = qpnp_ab_ibb_regulator_get_mode, }; static struct regulator_ops qpnp_amoled_ibb_ops = { .enable = qpnp_ibb_regulator_enable, .disable = qpnp_ibb_regulator_disable, .is_enabled = qpnp_ibb_regulator_is_enabled, .set_voltage = qpnp_ab_ibb_regulator_set_voltage, .get_voltage = qpnp_ab_ibb_regulator_get_voltage, .set_mode = qpnp_ab_ibb_regulator_set_mode, .get_mode = qpnp_ab_ibb_regulator_get_mode, }; /* OLEDB regulator */ static int qpnp_oledb_regulator_is_enabled(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); return chip->oledb.vreg.enabled; } static int qpnp_oledb_regulator_enable(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->oledb.vreg.enabled = true; return 0; } static int qpnp_oledb_regulator_disable(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->oledb.vreg.enabled = false; return 0; } static int qpnp_oledb_regulator_set_voltage(struct regulator_dev *rdev, int min_uV, int max_uV, unsigned int *selector) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); /* HW controlled */ if (chip->oledb.swire_control) return 0; return 0; } static int qpnp_oledb_regulator_get_voltage(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); /* HW controlled */ if (chip->oledb.swire_control) return 0; return 0; } static int qpnp_oledb_regulator_set_mode(struct regulator_dev *rdev, unsigned int mode) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); chip->oledb.vreg.mode = mode; return 0; } static unsigned int qpnp_oledb_regulator_get_mode(struct regulator_dev *rdev) { struct qpnp_amoled *chip = rdev_get_drvdata(rdev); return chip->oledb.vreg.mode; } static struct regulator_ops qpnp_amoled_oledb_ops = { .enable = qpnp_oledb_regulator_enable, .disable = qpnp_oledb_regulator_disable, .is_enabled = qpnp_oledb_regulator_is_enabled, .set_voltage = qpnp_oledb_regulator_set_voltage, .get_voltage = qpnp_oledb_regulator_get_voltage, .set_mode = qpnp_oledb_regulator_set_mode, .get_mode = qpnp_oledb_regulator_get_mode, }; static int qpnp_amoled_regulator_register(struct qpnp_amoled *chip, enum reg_type type) { int rc = 0; struct regulator_init_data *init_data; struct regulator_config cfg = {}; struct regulator_desc *rdesc; struct regulator_dev *rdev; struct device_node *node; if (type == OLEDB) { node = chip->oledb.vreg.node; rdesc = &chip->oledb.vreg.rdesc; rdesc->ops = &qpnp_amoled_oledb_ops; rdev = chip->oledb.vreg.rdev; } else if (type == AB) { node = chip->ab.vreg.node; rdesc = &chip->ab.vreg.rdesc; rdesc->ops = &qpnp_amoled_ab_ops; rdev = chip->ab.vreg.rdev; } else if (type == IBB) { node = chip->ibb.vreg.node; rdesc = &chip->ibb.vreg.rdesc; rdesc->ops = &qpnp_amoled_ibb_ops; rdev = chip->ibb.vreg.rdev; } else { pr_err("Invalid regulator type %d\n", type); return -EINVAL; } init_data = of_get_regulator_init_data(chip->dev, node, rdesc); if (!init_data) { pr_err("Failed to get regulator_init_data for type %d\n", type); return -ENOMEM; } if (init_data->constraints.name) { rdesc->owner = THIS_MODULE; rdesc->type = REGULATOR_VOLTAGE; rdesc->name = init_data->constraints.name; cfg.dev = chip->dev; cfg.init_data = init_data; cfg.driver_data = chip; cfg.of_node = node; if (of_get_property(chip->dev->of_node, "parent-supply", NULL)) init_data->supply_regulator = "parent"; init_data->constraints.valid_ops_mask |= REGULATOR_CHANGE_VOLTAGE | REGULATOR_CHANGE_STATUS | REGULATOR_CHANGE_MODE; init_data->constraints.valid_modes_mask |= REGULATOR_MODE_NORMAL | REGULATOR_MODE_IDLE | REGULATOR_MODE_STANDBY; rdev = devm_regulator_register(chip->dev, rdesc, &cfg); if (IS_ERR(rdev)) { rc = PTR_ERR(rdev); rdev = NULL; pr_err("Failed to register amoled regulator for type %d rc = %d\n", type, rc); return rc; } if (type == OLEDB) chip->oledb.vreg.mode = REGULATOR_MODE_NORMAL; else if (type == IBB) chip->ibb.vreg.mode = REGULATOR_MODE_NORMAL; else chip->ab.vreg.mode = REGULATOR_MODE_NORMAL; } else { pr_err("regulator name missing for type %d\n", type); return -EINVAL; } return rc; } static int qpnp_amoled_hw_init(struct qpnp_amoled *chip) { int rc; rc = qpnp_amoled_regulator_register(chip, OLEDB); if (rc < 0) { dev_err(chip->dev, "Failed to register OLEDB regulator rc=%d\n", rc); return rc; } rc = qpnp_amoled_regulator_register(chip, AB); if (rc < 0) { dev_err(chip->dev, "Failed to register AB regulator rc=%d\n", rc); return rc; } rc = qpnp_amoled_regulator_register(chip, IBB); if (rc < 0) { dev_err(chip->dev, "Failed to register IBB regulator rc=%d\n", rc); return rc; } return 0; } static int qpnp_amoled_parse_dt(struct qpnp_amoled *chip) { struct device_node *temp, *node = chip->dev->of_node; const __be32 *prop_addr; int rc = 0; u32 base; u8 val; for_each_available_child_of_node(node, temp) { prop_addr = of_get_address(temp, 0, NULL, NULL); if (!prop_addr) { pr_err("Couldn't get reg address\n"); return -EINVAL; } base = be32_to_cpu(*prop_addr); rc = qpnp_amoled_read(chip, base + PERIPH_TYPE, &val, 1); if (rc < 0) { pr_err("Couldn't read PERIPH_TYPE for base %x\n", base); return rc; } switch (val) { case OLEDB_PERIPH_TYPE: chip->oledb_base = base; chip->oledb.vreg.node = temp; chip->oledb.swire_control = of_property_read_bool(temp, "qcom,swire-control"); break; case AB_PERIPH_TYPE: chip->ab_base = base; chip->ab.vreg.node = temp; chip->ab.swire_control = of_property_read_bool(temp, "qcom,swire-control"); chip->ab.pd_control = of_property_read_bool(temp, "qcom,aod-pd-control"); break; case IBB_PERIPH_TYPE: chip->ibb_base = base; chip->ibb.vreg.node = temp; chip->ibb.swire_control = of_property_read_bool(temp, "qcom,swire-control"); chip->ibb.pd_control = of_property_read_bool(temp, "qcom,aod-pd-control"); break; default: pr_err("Unknown peripheral type 0x%x\n", val); return -EINVAL; } } return 0; } static int qpnp_amoled_regulator_probe(struct platform_device *pdev) { int rc; struct device_node *node; struct qpnp_amoled *chip; node = pdev->dev.of_node; if (!node) { pr_err("No nodes defined\n"); return -ENODEV; } chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL); if (!chip) return -ENOMEM; chip->dev = &pdev->dev; chip->regmap = dev_get_regmap(pdev->dev.parent, NULL); if (!chip->regmap) { dev_err(&pdev->dev, "Failed to get the regmap handle\n"); rc = -EINVAL; goto error; } dev_set_drvdata(&pdev->dev, chip); rc = qpnp_amoled_parse_dt(chip); if (rc < 0) { dev_err(chip->dev, "Failed to parse DT params rc=%d\n", rc); goto error; } rc = qpnp_amoled_hw_init(chip); if (rc < 0) dev_err(chip->dev, "Failed to initialize HW rc=%d\n", rc); error: return rc; } static int qpnp_amoled_regulator_remove(struct platform_device *pdev) { return 0; } static const struct of_device_id amoled_match_table[] = { { .compatible = "qcom,qpnp-amoled-regulator", }, { }, }; static struct platform_driver qpnp_amoled_regulator_driver = { .driver = { .name = "qpnp-amoled-regulator", .of_match_table = amoled_match_table, }, .probe = qpnp_amoled_regulator_probe, .remove = qpnp_amoled_regulator_remove, }; static int __init qpnp_amoled_regulator_init(void) { return platform_driver_register(&qpnp_amoled_regulator_driver); } arch_initcall(qpnp_amoled_regulator_init); static void __exit qpnp_amoled_regulator_exit(void) { platform_driver_unregister(&qpnp_amoled_regulator_driver); } module_exit(qpnp_amoled_regulator_exit); MODULE_DESCRIPTION("QPNP AMOLED regulator driver"); MODULE_LICENSE("GPL v2");
