| // SPDX-License-Identifier: GPL-2.0-or-later |
| /* |
| * devres.c -- Voltage/Current Regulator framework devres implementation. |
| * |
| * Copyright 2013 Linaro Ltd |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/err.h> |
| #include <linux/regmap.h> |
| #include <linux/regulator/consumer.h> |
| #include <linux/regulator/driver.h> |
| #include <linux/module.h> |
| |
| #include "internal.h" |
| |
| static void devm_regulator_release(struct device *dev, void *res) |
| { |
| regulator_put(*(struct regulator **)res); |
| } |
| |
| static struct regulator *_devm_regulator_get(struct device *dev, const char *id, |
| int get_type) |
| { |
| struct regulator **ptr, *regulator; |
| |
| ptr = devres_alloc(devm_regulator_release, sizeof(*ptr), GFP_KERNEL); |
| if (!ptr) |
| return ERR_PTR(-ENOMEM); |
| |
| regulator = _regulator_get(dev, id, get_type); |
| if (!IS_ERR(regulator)) { |
| *ptr = regulator; |
| devres_add(dev, ptr); |
| } else { |
| devres_free(ptr); |
| } |
| |
| return regulator; |
| } |
| |
| /** |
| * devm_regulator_get - Resource managed regulator_get() |
| * @dev: device for regulator "consumer" |
| * @id: Supply name or regulator ID. |
| * |
| * Managed regulator_get(). Regulators returned from this function are |
| * automatically regulator_put() on driver detach. See regulator_get() for more |
| * information. |
| */ |
| struct regulator *devm_regulator_get(struct device *dev, const char *id) |
| { |
| return _devm_regulator_get(dev, id, NORMAL_GET); |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_get); |
| |
| /** |
| * devm_regulator_get_exclusive - Resource managed regulator_get_exclusive() |
| * @dev: device for regulator "consumer" |
| * @id: Supply name or regulator ID. |
| * |
| * Managed regulator_get_exclusive(). Regulators returned from this function |
| * are automatically regulator_put() on driver detach. See regulator_get() for |
| * more information. |
| */ |
| struct regulator *devm_regulator_get_exclusive(struct device *dev, |
| const char *id) |
| { |
| return _devm_regulator_get(dev, id, EXCLUSIVE_GET); |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_get_exclusive); |
| |
| /** |
| * devm_regulator_get_optional - Resource managed regulator_get_optional() |
| * @dev: device for regulator "consumer" |
| * @id: Supply name or regulator ID. |
| * |
| * Managed regulator_get_optional(). Regulators returned from this |
| * function are automatically regulator_put() on driver detach. See |
| * regulator_get_optional() for more information. |
| */ |
| struct regulator *devm_regulator_get_optional(struct device *dev, |
| const char *id) |
| { |
| return _devm_regulator_get(dev, id, OPTIONAL_GET); |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_get_optional); |
| |
| static int devm_regulator_match(struct device *dev, void *res, void *data) |
| { |
| struct regulator **r = res; |
| if (!r || !*r) { |
| WARN_ON(!r || !*r); |
| return 0; |
| } |
| return *r == data; |
| } |
| |
| /** |
| * devm_regulator_put - Resource managed regulator_put() |
| * @regulator: regulator to free |
| * |
| * Deallocate a regulator allocated with devm_regulator_get(). Normally |
| * this function will not need to be called and the resource management |
| * code will ensure that the resource is freed. |
| */ |
| void devm_regulator_put(struct regulator *regulator) |
| { |
| int rc; |
| |
| rc = devres_release(regulator->dev, devm_regulator_release, |
| devm_regulator_match, regulator); |
| if (rc != 0) |
| WARN_ON(rc); |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_put); |
| |
| struct regulator_bulk_devres { |
| struct regulator_bulk_data *consumers; |
| int num_consumers; |
| }; |
| |
| static void devm_regulator_bulk_release(struct device *dev, void *res) |
| { |
| struct regulator_bulk_devres *devres = res; |
| |
| regulator_bulk_free(devres->num_consumers, devres->consumers); |
| } |
| |
| /** |
| * devm_regulator_bulk_get - managed get multiple regulator consumers |
| * |
| * @dev: Device to supply |
| * @num_consumers: Number of consumers to register |
| * @consumers: Configuration of consumers; clients are stored here. |
| * |
| * @return 0 on success, an errno on failure. |
| * |
| * This helper function allows drivers to get several regulator |
| * consumers in one operation with management, the regulators will |
| * automatically be freed when the device is unbound. If any of the |
| * regulators cannot be acquired then any regulators that were |
| * allocated will be freed before returning to the caller. |
| */ |
| int devm_regulator_bulk_get(struct device *dev, int num_consumers, |
| struct regulator_bulk_data *consumers) |
| { |
| struct regulator_bulk_devres *devres; |
| int ret; |
| |
| devres = devres_alloc(devm_regulator_bulk_release, |
| sizeof(*devres), GFP_KERNEL); |
| if (!devres) |
| return -ENOMEM; |
| |
| ret = regulator_bulk_get(dev, num_consumers, consumers); |
| if (!ret) { |
| devres->consumers = consumers; |
| devres->num_consumers = num_consumers; |
| devres_add(dev, devres); |
| } else { |
| devres_free(devres); |
| } |
| |
| return ret; |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_bulk_get); |
| |
| static void devm_rdev_release(struct device *dev, void *res) |
| { |
| regulator_unregister(*(struct regulator_dev **)res); |
| } |
| |
| /** |
| * devm_regulator_register - Resource managed regulator_register() |
| * @regulator_desc: regulator to register |
| * @config: runtime configuration for regulator |
| * |
| * Called by regulator drivers to register a regulator. Returns a |
| * valid pointer to struct regulator_dev on success or an ERR_PTR() on |
| * error. The regulator will automatically be released when the device |
| * is unbound. |
| */ |
| struct regulator_dev *devm_regulator_register(struct device *dev, |
| const struct regulator_desc *regulator_desc, |
| const struct regulator_config *config) |
| { |
| struct regulator_dev **ptr, *rdev; |
| |
| ptr = devres_alloc(devm_rdev_release, sizeof(*ptr), |
| GFP_KERNEL); |
| if (!ptr) |
| return ERR_PTR(-ENOMEM); |
| |
| rdev = regulator_register(regulator_desc, config); |
| if (!IS_ERR(rdev)) { |
| *ptr = rdev; |
| devres_add(dev, ptr); |
| } else { |
| devres_free(ptr); |
| } |
| |
| return rdev; |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_register); |
| |
| static int devm_rdev_match(struct device *dev, void *res, void *data) |
| { |
| struct regulator_dev **r = res; |
| if (!r || !*r) { |
| WARN_ON(!r || !*r); |
| return 0; |
| } |
| return *r == data; |
| } |
| |
| /** |
| * devm_regulator_unregister - Resource managed regulator_unregister() |
| * @regulator: regulator to free |
| * |
| * Unregister a regulator registered with devm_regulator_register(). |
| * Normally this function will not need to be called and the resource |
| * management code will ensure that the resource is freed. |
| */ |
| void devm_regulator_unregister(struct device *dev, struct regulator_dev *rdev) |
| { |
| int rc; |
| |
| rc = devres_release(dev, devm_rdev_release, devm_rdev_match, rdev); |
| if (rc != 0) |
| WARN_ON(rc); |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_unregister); |
| |
| struct regulator_supply_alias_match { |
| struct device *dev; |
| const char *id; |
| }; |
| |
| static int devm_regulator_match_supply_alias(struct device *dev, void *res, |
| void *data) |
| { |
| struct regulator_supply_alias_match *match = res; |
| struct regulator_supply_alias_match *target = data; |
| |
| return match->dev == target->dev && strcmp(match->id, target->id) == 0; |
| } |
| |
| static void devm_regulator_destroy_supply_alias(struct device *dev, void *res) |
| { |
| struct regulator_supply_alias_match *match = res; |
| |
| regulator_unregister_supply_alias(match->dev, match->id); |
| } |
| |
| /** |
| * devm_regulator_register_supply_alias - Resource managed |
| * regulator_register_supply_alias() |
| * |
| * @dev: device that will be given as the regulator "consumer" |
| * @id: Supply name or regulator ID |
| * @alias_dev: device that should be used to lookup the supply |
| * @alias_id: Supply name or regulator ID that should be used to lookup the |
| * supply |
| * |
| * The supply alias will automatically be unregistered when the source |
| * device is unbound. |
| */ |
| int devm_regulator_register_supply_alias(struct device *dev, const char *id, |
| struct device *alias_dev, |
| const char *alias_id) |
| { |
| struct regulator_supply_alias_match *match; |
| int ret; |
| |
| match = devres_alloc(devm_regulator_destroy_supply_alias, |
| sizeof(struct regulator_supply_alias_match), |
| GFP_KERNEL); |
| if (!match) |
| return -ENOMEM; |
| |
| match->dev = dev; |
| match->id = id; |
| |
| ret = regulator_register_supply_alias(dev, id, alias_dev, alias_id); |
| if (ret < 0) { |
| devres_free(match); |
| return ret; |
| } |
| |
| devres_add(dev, match); |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_register_supply_alias); |
| |
| /** |
| * devm_regulator_unregister_supply_alias - Resource managed |
| * regulator_unregister_supply_alias() |
| * |
| * @dev: device that will be given as the regulator "consumer" |
| * @id: Supply name or regulator ID |
| * |
| * Unregister an alias registered with |
| * devm_regulator_register_supply_alias(). Normally this function |
| * will not need to be called and the resource management code |
| * will ensure that the resource is freed. |
| */ |
| void devm_regulator_unregister_supply_alias(struct device *dev, const char *id) |
| { |
| struct regulator_supply_alias_match match; |
| int rc; |
| |
| match.dev = dev; |
| match.id = id; |
| |
| rc = devres_release(dev, devm_regulator_destroy_supply_alias, |
| devm_regulator_match_supply_alias, &match); |
| if (rc != 0) |
| WARN_ON(rc); |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_unregister_supply_alias); |
| |
| /** |
| * devm_regulator_bulk_register_supply_alias - Managed register |
| * multiple aliases |
| * |
| * @dev: device that will be given as the regulator "consumer" |
| * @id: List of supply names or regulator IDs |
| * @alias_dev: device that should be used to lookup the supply |
| * @alias_id: List of supply names or regulator IDs that should be used to |
| * lookup the supply |
| * @num_id: Number of aliases to register |
| * |
| * @return 0 on success, an errno on failure. |
| * |
| * This helper function allows drivers to register several supply |
| * aliases in one operation, the aliases will be automatically |
| * unregisters when the source device is unbound. If any of the |
| * aliases cannot be registered any aliases that were registered |
| * will be removed before returning to the caller. |
| */ |
| int devm_regulator_bulk_register_supply_alias(struct device *dev, |
| const char *const *id, |
| struct device *alias_dev, |
| const char *const *alias_id, |
| int num_id) |
| { |
| int i; |
| int ret; |
| |
| for (i = 0; i < num_id; ++i) { |
| ret = devm_regulator_register_supply_alias(dev, id[i], |
| alias_dev, |
| alias_id[i]); |
| if (ret < 0) |
| goto err; |
| } |
| |
| return 0; |
| |
| err: |
| dev_err(dev, |
| "Failed to create supply alias %s,%s -> %s,%s\n", |
| id[i], dev_name(dev), alias_id[i], dev_name(alias_dev)); |
| |
| while (--i >= 0) |
| devm_regulator_unregister_supply_alias(dev, id[i]); |
| |
| return ret; |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_bulk_register_supply_alias); |
| |
| /** |
| * devm_regulator_bulk_unregister_supply_alias - Managed unregister |
| * multiple aliases |
| * |
| * @dev: device that will be given as the regulator "consumer" |
| * @id: List of supply names or regulator IDs |
| * @num_id: Number of aliases to unregister |
| * |
| * Unregister aliases registered with |
| * devm_regulator_bulk_register_supply_alias(). Normally this function |
| * will not need to be called and the resource management code |
| * will ensure that the resource is freed. |
| */ |
| void devm_regulator_bulk_unregister_supply_alias(struct device *dev, |
| const char *const *id, |
| int num_id) |
| { |
| int i; |
| |
| for (i = 0; i < num_id; ++i) |
| devm_regulator_unregister_supply_alias(dev, id[i]); |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_bulk_unregister_supply_alias); |
| |
| struct regulator_notifier_match { |
| struct regulator *regulator; |
| struct notifier_block *nb; |
| }; |
| |
| static int devm_regulator_match_notifier(struct device *dev, void *res, |
| void *data) |
| { |
| struct regulator_notifier_match *match = res; |
| struct regulator_notifier_match *target = data; |
| |
| return match->regulator == target->regulator && match->nb == target->nb; |
| } |
| |
| static void devm_regulator_destroy_notifier(struct device *dev, void *res) |
| { |
| struct regulator_notifier_match *match = res; |
| |
| regulator_unregister_notifier(match->regulator, match->nb); |
| } |
| |
| /** |
| * devm_regulator_register_notifier - Resource managed |
| * regulator_register_notifier |
| * |
| * @regulator: regulator source |
| * @nb: notifier block |
| * |
| * The notifier will be registers under the consumer device and be |
| * automatically be unregistered when the source device is unbound. |
| */ |
| int devm_regulator_register_notifier(struct regulator *regulator, |
| struct notifier_block *nb) |
| { |
| struct regulator_notifier_match *match; |
| int ret; |
| |
| match = devres_alloc(devm_regulator_destroy_notifier, |
| sizeof(struct regulator_notifier_match), |
| GFP_KERNEL); |
| if (!match) |
| return -ENOMEM; |
| |
| match->regulator = regulator; |
| match->nb = nb; |
| |
| ret = regulator_register_notifier(regulator, nb); |
| if (ret < 0) { |
| devres_free(match); |
| return ret; |
| } |
| |
| devres_add(regulator->dev, match); |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_register_notifier); |
| |
| /** |
| * devm_regulator_unregister_notifier - Resource managed |
| * regulator_unregister_notifier() |
| * |
| * @regulator: regulator source |
| * @nb: notifier block |
| * |
| * Unregister a notifier registered with devm_regulator_register_notifier(). |
| * Normally this function will not need to be called and the resource |
| * management code will ensure that the resource is freed. |
| */ |
| void devm_regulator_unregister_notifier(struct regulator *regulator, |
| struct notifier_block *nb) |
| { |
| struct regulator_notifier_match match; |
| int rc; |
| |
| match.regulator = regulator; |
| match.nb = nb; |
| |
| rc = devres_release(regulator->dev, devm_regulator_destroy_notifier, |
| devm_regulator_match_notifier, &match); |
| if (rc != 0) |
| WARN_ON(rc); |
| } |
| EXPORT_SYMBOL_GPL(devm_regulator_unregister_notifier); |