Re: [PATCH v8 10/17] power: sequencing: implement the pwrseq core

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



On 2024-05-29 at 00:33:18, Bartosz Golaszewski (brgl@xxxxxxxx) wrote:
> From: Bartosz Golaszewski <bartosz.golaszewski@xxxxxxxxxx>
>
> Implement the power sequencing subsystem allowing devices to share
> complex powering-up and down procedures. It's split into the consumer
> and provider parts but does not implement any new DT bindings so that
> the actual power sequencing is never revealed in the DT representation.
>
> Tested-by: Amit Pundir <amit.pundir@xxxxxxxxxx>
> Signed-off-by: Bartosz Golaszewski <bartosz.golaszewski@xxxxxxxxxx>
> ---
>  MAINTAINERS                       |    8 +
>  drivers/power/Kconfig             |    1 +
>  drivers/power/Makefile            |    1 +
>  drivers/power/sequencing/Kconfig  |   12 +
>  drivers/power/sequencing/Makefile |    4 +
>  drivers/power/sequencing/core.c   | 1105 +++++++++++++++++++++++++++++++++++++
>  include/linux/pwrseq/consumer.h   |   56 ++
>  include/linux/pwrseq/provider.h   |   75 +++
>  8 files changed, 1262 insertions(+)
>
> diff --git a/MAINTAINERS b/MAINTAINERS
> index dbc5d9ec3d20..dd129735e7c6 100644
> --- a/MAINTAINERS
> +++ b/MAINTAINERS
> @@ -17893,6 +17893,14 @@ F:	include/linux/pm_*
>  F:	include/linux/powercap.h
>  F:	kernel/configs/nopm.config
>
> +POWER SEQUENCING
> +M:	Bartosz Golaszewski <brgl@xxxxxxxx>
> +L:	linux-pm@xxxxxxxxxxxxxxx
> +S:	Maintained
> +T:	git git://git.kernel.org/pub/scm/linux/kernel/git/brgl/linux.git
> +F:	drivers/power/sequencing/
> +F:	include/linux/pwrseq/
> +
>  POWER STATE COORDINATION INTERFACE (PSCI)
>  M:	Mark Rutland <mark.rutland@xxxxxxx>
>  M:	Lorenzo Pieralisi <lpieralisi@xxxxxxxxxx>
> diff --git a/drivers/power/Kconfig b/drivers/power/Kconfig
> index 696bf77a7042..9a8e44ca9ae4 100644
> --- a/drivers/power/Kconfig
> +++ b/drivers/power/Kconfig
> @@ -1,3 +1,4 @@
>  # SPDX-License-Identifier: GPL-2.0-only
>  source "drivers/power/reset/Kconfig"
> +source "drivers/power/sequencing/Kconfig"
>  source "drivers/power/supply/Kconfig"
> diff --git a/drivers/power/Makefile b/drivers/power/Makefile
> index effbf0377f32..962a2cd30a51 100644
> --- a/drivers/power/Makefile
> +++ b/drivers/power/Makefile
> @@ -1,3 +1,4 @@
>  # SPDX-License-Identifier: GPL-2.0-only
>  obj-$(CONFIG_POWER_RESET)	+= reset/
> +obj-$(CONFIG_POWER_SEQUENCING)	+= sequencing/
>  obj-$(CONFIG_POWER_SUPPLY)	+= supply/
> diff --git a/drivers/power/sequencing/Kconfig b/drivers/power/sequencing/Kconfig
> new file mode 100644
> index 000000000000..ba5732b1dbf8
> --- /dev/null
> +++ b/drivers/power/sequencing/Kconfig
> @@ -0,0 +1,12 @@
> +# SPDX-License-Identifier: GPL-2.0-only
> +
> +menuconfig POWER_SEQUENCING
> +	tristate "Power Sequencing support"
> +	help
> +	  Say Y here to enable the Power Sequencing subsystem.
> +
> +	  This subsystem is designed to control power to devices that share
> +	  complex resources and/or require specific power sequences to be run
> +	  during power-up.
> +
> +	  If unsure, say no.
> diff --git a/drivers/power/sequencing/Makefile b/drivers/power/sequencing/Makefile
> new file mode 100644
> index 000000000000..dcdf8c0c159e
> --- /dev/null
> +++ b/drivers/power/sequencing/Makefile
> @@ -0,0 +1,4 @@
> +# SPDX-License-Identifier: GPL-2.0
> +
> +obj-$(CONFIG_POWER_SEQUENCING)		+= pwrseq-core.o
> +pwrseq-core-y				:= core.o
> diff --git a/drivers/power/sequencing/core.c b/drivers/power/sequencing/core.c
> new file mode 100644
> index 000000000000..e07037ea5be0
> --- /dev/null
> +++ b/drivers/power/sequencing/core.c
> @@ -0,0 +1,1105 @@
> +// SPDX-License-Identifier: GPL-2.0-only
> +/*
> + * Copyright (C) 2024 Linaro Ltd.
> + */
> +
> +#include <linux/bug.h>
> +#include <linux/cleanup.h>
> +#include <linux/debugfs.h>
> +#include <linux/device.h>
> +#include <linux/err.h>
> +#include <linux/export.h>
> +#include <linux/idr.h>
> +#include <linux/kernel.h>
> +#include <linux/kref.h>
> +#include <linux/list.h>
> +#include <linux/lockdep.h>
> +#include <linux/module.h>
> +#include <linux/mutex.h>
> +#include <linux/property.h>
> +#include <linux/pwrseq/consumer.h>
> +#include <linux/pwrseq/provider.h>
> +#include <linux/radix-tree.h>
> +#include <linux/rwsem.h>
> +#include <linux/slab.h>
> +
> +/*
> + * Power-sequencing framework for linux.
> + *
> + * This subsystem allows power sequence providers to register a set of targets
> + * that consumers may request and power-up/down.
> + *
> + * Glossary:
> + *
> + * Unit - a unit is a discreet chunk of a power sequence. For instance one unit
> + * may enable a set of regulators, another may enable a specific GPIO. Units
> + * can define dependencies in the form of other units that must be enabled
> + * before it itself can be.
> + *
> + * Target - a target is a set of units (composed of the "final" unit and its
> + * dependencies) that a consumer selects by its name when requesting a handle
> + * to the power sequencer. Via the dependency system, multiple targets may
> + * share the same parts of a power sequence but ignore parts that are
> + * irrelevant.
> + *
> + * Descriptor - a handle passed by the pwrseq core to every consumer that
> + * serves as the entry point to the provider layer. It ensures coherence
> + * between different users and keeps reference counting consistent.
> + *
> + * Each provider must define a .match() callback whose role is to determine
> + * whether a potential consumer is in fact associated with this sequencer.
> + * This allows creating abstraction layers on top of regular device-tree
> + * resources like regulators, clocks and other nodes connected to the consumer
> + * via phandle.
> + */
> +
> +static DEFINE_IDA(pwrseq_ida);
> +
> +/*
> + * Protects the device list on the pwrseq bus from concurrent modifications
> + * but allows simultaneous read-only access.
> + */
> +static DECLARE_RWSEM(pwrseq_sem);
> +
> +/**
> + * struct pwrseq_unit - Private power-sequence unit data.
> + * @ref: Reference count for this object. When it goes to 0, the object is
> + *       destroyed.
> + * @name: Name of this target.
> + * @list: Link to siblings on the list of all units of a single sequencer.
> + * @deps: List of units on which this unit depends.
> + * @enable: Callback running the part of the power-on sequence provided by
> + *          this unit.
> + * @disable: Callback running the part of the power-off sequence provided
> + *           by this unit.
> + * @enable_count: Current number of users that enabled this unit. May be the
> + *                consumer of the power sequencer or other units that depend
> + *                on this one.
> + */
> +struct pwrseq_unit {
> +	struct kref ref;
> +	const char *name;
> +	struct list_head list;
> +	struct list_head deps;
> +	pwrseq_power_state_func enable;
> +	pwrseq_power_state_func disable;
> +	unsigned int enable_count;
> +};
> +
> +static struct pwrseq_unit *pwrseq_unit_new(const struct pwrseq_unit_data *data)
> +{
> +	struct pwrseq_unit *unit;
> +
> +	unit = kzalloc(sizeof(*unit), GFP_KERNEL);
> +	if (!unit)
> +		return NULL;
> +
> +	unit->name = kstrdup_const(data->name, GFP_KERNEL);
> +	if (!unit->name) {
> +		kfree(unit);
> +		return NULL;
> +	}
> +
> +	kref_init(&unit->ref);
> +	INIT_LIST_HEAD(&unit->deps);
> +	unit->enable = data->enable;
> +	unit->disable = data->disable;
> +
> +	return unit;
> +}
> +
> +static struct pwrseq_unit *pwrseq_unit_incref(struct pwrseq_unit *unit)
> +{
> +	kref_get(&unit->ref);
> +
> +	return unit;
> +}
> +
> +static void pwrseq_unit_release(struct kref *ref);
> +
> +static void pwrseq_unit_decref(struct pwrseq_unit *unit)
> +{
> +	kref_put(&unit->ref, pwrseq_unit_release);
> +}
> +
> +/**
> + * struct pwrseq_unit_dep - Wrapper around a reference to the unit structure
> + *                          allowing to keep it on multiple dependency lists
> + *                          in different units.
> + * @list: Siblings on the list.
> + * @unit: Address of the referenced unit.
> + */
> +struct pwrseq_unit_dep {
> +	struct list_head list;
> +	struct pwrseq_unit *unit;
> +};
> +
> +static struct pwrseq_unit_dep *pwrseq_unit_dep_new(struct pwrseq_unit *unit)
nit. pwrseq_unit_dep_alloc/create rhymes well with pwrseq_unit_dep_free(),
> +{
> +	struct pwrseq_unit_dep *dep;
> +
> +	dep = kzalloc(sizeof(*dep), GFP_KERNEL);
> +	if (!dep)
> +		return NULL;
> +
> +	dep->unit = unit;
> +
> +	return dep;
> +}
> +
> +static void pwrseq_unit_dep_free(struct pwrseq_unit_dep *ref)
> +{
> +	pwrseq_unit_decref(ref->unit);
> +	kfree(ref);
> +}
> +
> +static void pwrseq_unit_free_deps(struct list_head *list)
> +{
> +	struct pwrseq_unit_dep *dep, *next;
> +
> +	list_for_each_entry_safe(dep, next, list, list) {
no need of 'locks' to protect against simutaneous 'add' ?
> +		list_del(&dep->list);
> +		pwrseq_unit_dep_free(dep);
> +	}
> +}
> +
> +static void pwrseq_unit_release(struct kref *ref)
> +{
> +	struct pwrseq_unit *unit = container_of(ref, struct pwrseq_unit, ref);
> +
> +	pwrseq_unit_free_deps(&unit->deps);
> +	list_del(&unit->list);
> +	kfree_const(unit->name);
> +	kfree(unit);
> +}
> +
> +/**
> + * struct pwrseq_target - Private power-sequence target data.
> + * @list: Siblings on the list of all targets exposed by a power sequencer.
> + * @name: Name of the target.
> + * @unit: Final unit for this target.
> + * @post_enable: Callback run after the target unit has been enabled, *after*
> + *               the state lock has been released. It's useful for implementing
> + *               boot-up delays without blocking other users from powering up
> + *               using the same power sequencer.
> + */
> +struct pwrseq_target {
> +	struct list_head list;
> +	const char *name;
> +	struct pwrseq_unit *unit;
> +	pwrseq_power_state_func post_enable;
> +};
> +
> +static struct pwrseq_target *
> +pwrseq_target_new(const struct pwrseq_target_data *data)
> +{
> +	struct pwrseq_target *target;
> +
> +	target = kzalloc(sizeof(*target), GFP_KERNEL);
> +	if (!target)
> +		return NULL;
> +
> +	target->name = kstrdup_const(data->name, GFP_KERNEL);
> +	if (!target->name) {
> +		kfree(target);
> +		return NULL;
> +	}
> +
> +	target->post_enable = data->post_enable;
> +
> +	return target;
> +}
> +
> +static void pwrseq_target_free(struct pwrseq_target *target)
> +{
> +	pwrseq_unit_decref(target->unit);
> +	kfree_const(target->name);
> +	kfree(target);
> +}
> +
> +/**
> + * struct pwrseq_device - Private power sequencing data.
> + * @dev: Device struct associated with this sequencer.
> + * @id: Device ID.
> + * @owner: Prevents removal of active power sequencing providers.
> + * @rw_lock: Protects the device from being unregistered while in use.
> + * @state_lock: Prevents multiple users running the power sequence at the same
> + *              time.
> + * @match: Power sequencer matching callback.
> + * @targets: List of targets exposed by this sequencer.
> + * @units: List of all units supported by this sequencer.
> + */
> +struct pwrseq_device {
> +	struct device dev;
> +	int id;
> +	struct module *owner;
> +	struct rw_semaphore rw_lock;
> +	struct mutex state_lock;
> +	pwrseq_match_func match;
> +	struct list_head targets;
> +	struct list_head units;
> +};
> +
> +static struct pwrseq_device *to_pwrseq_device(struct device *dev)
> +{
> +	return container_of(dev, struct pwrseq_device, dev);
> +}
> +
> +static struct pwrseq_device *pwrseq_device_get(struct pwrseq_device *pwrseq)
> +{
> +	get_device(&pwrseq->dev);
> +
> +	return pwrseq;
> +}
> +
> +static void pwrseq_device_put(struct pwrseq_device *pwrseq)
> +{
> +	put_device(&pwrseq->dev);
> +}
> +
> +/**
> + * struct pwrseq_desc - Wraps access to the pwrseq_device and ensures that one
> + *                      user cannot break the reference counting for others.
> + * @pwrseq: Reference to the power sequencing device.
> + * @target: Reference to the target this descriptor allows to control.
> + * @powered_on: Power state set by the holder of the descriptor (not necessarily
> + * corresponding to the actual power state of the device).
> + */
> +struct pwrseq_desc {
> +	struct pwrseq_device *pwrseq;
> +	struct pwrseq_target *target;
> +	bool powered_on;
> +};
> +
> +static const struct bus_type pwrseq_bus = {
> +	.name = "pwrseq",
> +};
> +
> +static void pwrseq_release(struct device *dev)
> +{
> +	struct pwrseq_device *pwrseq = to_pwrseq_device(dev);
> +	struct pwrseq_target *target, *pos;
> +
> +	list_for_each_entry_safe(target, pos, &pwrseq->targets, list) {
> +		list_del(&target->list);
> +		pwrseq_target_free(target);
> +	}
> +
> +	mutex_destroy(&pwrseq->state_lock);
> +	ida_free(&pwrseq_ida, pwrseq->id);
> +	kfree(pwrseq);
> +}
> +
> +static const struct device_type pwrseq_device_type = {
> +	.name = "power_sequencer",
> +	.release = pwrseq_release,
> +};
> +
> +static int pwrseq_check_unit_deps(const struct pwrseq_unit_data *data,
> +				  struct radix_tree_root *visited_units)
> +{
> +	const struct pwrseq_unit_data *tmp, **cur;
> +	int ret;
> +
> +	ret = radix_tree_insert(visited_units, (unsigned long)data,
> +				(void *)data);
> +	if (ret)
> +		return ret;
> +
> +	for (cur = data->deps; cur && *cur; cur++) {
> +		tmp = radix_tree_lookup(visited_units, (unsigned long)*cur);
> +		if (tmp) {
> +			WARN(1, "Circular dependency in power sequencing flow detected!\n");
> +			return -EINVAL;
> +		}
> +
> +		ret = pwrseq_check_unit_deps(*cur, visited_units);
> +		if (ret)
> +			return ret;
> +	}
> +
> +	return 0;
> +}
> +
> +static int pwrseq_check_target_deps(const struct pwrseq_target_data *data)
> +{
> +	struct radix_tree_root visited_units;
> +	struct radix_tree_iter iter;
> +	void __rcu **slot;
> +	int ret;
> +
> +	if (!data->unit)
> +		return -EINVAL;
> +
> +	INIT_RADIX_TREE(&visited_units, GFP_KERNEL);
> +	ret = pwrseq_check_unit_deps(data->unit, &visited_units);
> +	radix_tree_for_each_slot(slot, &visited_units, &iter, 0)
> +		radix_tree_delete(&visited_units, iter.index);
> +
> +	return ret;
> +}
> +
> +static int pwrseq_unit_setup_deps(const struct pwrseq_unit_data **data,
> +				  struct list_head *dep_list,
> +				  struct list_head *unit_list,
> +				  struct radix_tree_root *processed_units);
> +
> +static struct pwrseq_unit *
> +pwrseq_unit_setup(const struct pwrseq_unit_data *data,
> +		  struct list_head *unit_list,
> +		  struct radix_tree_root *processed_units)
> +{
> +	struct pwrseq_unit *unit;
> +	int ret;
> +
> +	unit = radix_tree_lookup(processed_units, (unsigned long)data);
> +	if (unit)
> +		return pwrseq_unit_incref(unit);
> +
> +	unit = pwrseq_unit_new(data);
> +	if (!unit)
> +		return ERR_PTR(-ENOMEM);
> +
> +	if (data->deps) {
> +		ret = pwrseq_unit_setup_deps(data->deps, &unit->deps,
> +					     unit_list, processed_units);
> +		if (ret) {
> +			pwrseq_unit_decref(unit);
> +			return ERR_PTR(ret);
> +		}
> +	}
> +
> +	ret = radix_tree_insert(processed_units, (unsigned long)data, unit);
> +	if (ret) {
> +		pwrseq_unit_decref(unit);
> +		return ERR_PTR(ret);
> +	}
> +
> +	list_add_tail(&unit->list, unit_list);
> +
> +	return unit;
> +}
> +
> +static int pwrseq_unit_setup_deps(const struct pwrseq_unit_data **data,
> +				  struct list_head *dep_list,
> +				  struct list_head *unit_list,
> +				  struct radix_tree_root *processed_units)
> +{
> +	const struct pwrseq_unit_data *pos;
> +	struct pwrseq_unit_dep *dep;
> +	struct pwrseq_unit *unit;
> +	int i;
> +
> +	for (i = 0; data[i]; i++) {
Can we add range for i ? just depending on data[i] to be zero looks to be risky.

> +		pos = data[i];
> +
> +		unit = pwrseq_unit_setup(pos, unit_list, processed_units);
> +		if (IS_ERR(unit))
> +			return PTR_ERR(unit);
> +
> +		dep = pwrseq_unit_dep_new(unit);
> +		if (!dep) {
> +			pwrseq_unit_decref(unit);
This frees only one 'unit'. is there any chance for multiple 'unit', then better clean
up here ?
> +			return -ENOMEM;
> +		}
> +
> +		list_add_tail(&dep->list, dep_list);
> +	}
> +
> +	return 0;
> +}
> +
> +static int pwrseq_do_setup_targets(const struct pwrseq_target_data **data,
> +				   struct pwrseq_device *pwrseq,
> +				   struct radix_tree_root *processed_units)
> +{
> +	const struct pwrseq_target_data *pos;
> +	struct pwrseq_target *target;
> +	int ret, i;
> +
> +	for (i = 0; data[i]; i++) {
> +		pos = data[i];
> +
> +		ret = pwrseq_check_target_deps(pos);
> +		if (ret)
> +			return ret;
> +
> +		target = pwrseq_target_new(pos);
> +		if (!target)
> +			return -ENOMEM;
> +
> +		target->unit = pwrseq_unit_setup(pos->unit, &pwrseq->units,
> +						 processed_units);
> +		if (IS_ERR(target->unit)) {
> +			ret = PTR_ERR(target->unit);
> +			pwrseq_target_free(target);
> +			return ret;
> +		}
> +
> +		list_add_tail(&target->list, &pwrseq->targets);
> +	}
> +
> +	return 0;
> +}
> +
> +static int pwrseq_setup_targets(const struct pwrseq_target_data **targets,
> +				struct pwrseq_device *pwrseq)
> +{
> +	struct radix_tree_root processed_units;
> +	struct radix_tree_iter iter;
> +	void __rcu **slot;
> +	int ret;
> +
> +	INIT_RADIX_TREE(&processed_units, GFP_KERNEL);
> +	ret = pwrseq_do_setup_targets(targets, pwrseq, &processed_units);
> +	radix_tree_for_each_slot(slot, &processed_units, &iter, 0)
> +		radix_tree_delete(&processed_units, iter.index);
> +
> +	return ret;
> +}
> +
> +/**
> + * pwrseq_device_register() - Register a new power sequencer.
> + * @config: Configuration of the new power sequencing device.
> + *
> + * The config structure is only used during the call and can be freed after
> + * the function returns. The config structure *must* have the parent device
> + * as well as the match() callback and at least one target set.
> + *
> + * Returns:
> + * Returns the address of the new pwrseq device or ERR_PTR() on failure.
> + */
> +struct pwrseq_device *
> +pwrseq_device_register(const struct pwrseq_config *config)
> +{
> +	struct pwrseq_device *pwrseq;
> +	int ret, id;
> +
> +	if (!config->parent || !config->match || !config->targets ||
> +	    !config->targets[0])
> +		return ERR_PTR(-EINVAL);
> +
> +	pwrseq = kzalloc(sizeof(*pwrseq), GFP_KERNEL);
> +	if (!pwrseq)
> +		return ERR_PTR(-ENOMEM);
> +
> +	pwrseq->dev.type = &pwrseq_device_type;
> +	pwrseq->dev.bus = &pwrseq_bus;
> +	pwrseq->dev.parent = config->parent;
> +	device_set_node(&pwrseq->dev, dev_fwnode(config->parent));
> +	dev_set_drvdata(&pwrseq->dev, config->drvdata);
> +
> +	id = ida_alloc(&pwrseq_ida, GFP_KERNEL);
> +	if (id < 0) {
> +		kfree(pwrseq);
> +		return ERR_PTR(id);
> +	}
> +
> +	pwrseq->id = id;
> +
> +	/*
> +	 * From this point onwards the device's release() callback is
> +	 * responsible for freeing resources.
> +	 */
> +	device_initialize(&pwrseq->dev);
> +
> +	ret = dev_set_name(&pwrseq->dev, "pwrseq.%d", pwrseq->id);
> +	if (ret)
> +		goto err_put_pwrseq;
> +
> +	pwrseq->owner = config->owner ?: THIS_MODULE;
> +	pwrseq->match = config->match;
> +
> +	init_rwsem(&pwrseq->rw_lock);
> +	mutex_init(&pwrseq->state_lock);
> +	INIT_LIST_HEAD(&pwrseq->targets);
> +	INIT_LIST_HEAD(&pwrseq->units);
> +
> +	ret = pwrseq_setup_targets(config->targets, pwrseq);
> +	if (ret)
> +		goto err_put_pwrseq;
> +
> +	scoped_guard(rwsem_write, &pwrseq_sem) {
> +		ret = device_add(&pwrseq->dev);
> +		if (ret)
> +			goto err_put_pwrseq;
> +	}
> +
> +	return pwrseq;
> +
> +err_put_pwrseq:
no need to kfree(pwrseq) ?
> +	pwrseq_device_put(pwrseq);
> +	return ERR_PTR(ret);
> +}
> +EXPORT_SYMBOL_GPL(pwrseq_device_register);
> +
> +/**
> + * pwrseq_device_unregister() - Unregister the power sequencer.
> + * @pwrseq: Power sequencer to unregister.
> + */
> +void pwrseq_device_unregister(struct pwrseq_device *pwrseq)
> +{
> +	struct device *dev = &pwrseq->dev;
> +	struct pwrseq_target *target;
> +
> +	scoped_guard(mutex, &pwrseq->state_lock) {
> +		guard(rwsem_write)(&pwrseq->rw_lock);
> +
> +		list_for_each_entry(target, &pwrseq->targets, list)
> +			WARN_ONCE(target->unit->enable_count,
> +				  "REMOVING POWER SEQUENCER WITH ACTIVE USERS\n");
> +
> +		guard(rwsem_write)(&pwrseq_sem);
> +
> +		device_del(dev);
> +	}
> +
> +	pwrseq_device_put(pwrseq);
> +}
> +EXPORT_SYMBOL_GPL(pwrseq_device_unregister);
> +
> +static void devm_pwrseq_device_unregister(void *data)
> +{
> +	struct pwrseq_device *pwrseq = data;
> +
> +	pwrseq_device_unregister(pwrseq);
> +}
> +
> +/**
> + * devm_pwrseq_device_register() - Managed variant of pwrseq_device_register().
> + * @dev: Managing device.
> + * @config: Configuration of the new power sequencing device.
> + *
> + * Returns:
> + * Returns the address of the new pwrseq device or ERR_PTR() on failure.
> + */
> +struct pwrseq_device *
> +devm_pwrseq_device_register(struct device *dev,
> +			    const struct pwrseq_config *config)
> +{
> +	struct pwrseq_device *pwrseq;
> +	int ret;
> +
> +	pwrseq = pwrseq_device_register(config);
> +	if (IS_ERR(pwrseq))
> +		return pwrseq;
> +
> +	ret = devm_add_action_or_reset(dev, devm_pwrseq_device_unregister,
> +				       pwrseq);
> +	if (ret)
> +		return ERR_PTR(ret);
> +
> +	return pwrseq;
> +}
> +EXPORT_SYMBOL_GPL(devm_pwrseq_device_register);
> +
> +/**
> + * pwrseq_device_get_drvdata() - Get the driver private data associated with
> + *                               this sequencer.
> + * @pwrseq: Power sequencer object.
> + *
> + * Returns:
> + * Address of the private driver data.
> + */
> +void *pwrseq_device_get_drvdata(struct pwrseq_device *pwrseq)
> +{
> +	return dev_get_drvdata(&pwrseq->dev);
> +}
> +EXPORT_SYMBOL_GPL(pwrseq_device_get_drvdata);
> +
> +struct pwrseq_match_data {
> +	struct pwrseq_desc *desc;
> +	struct device *dev;
> +	const char *target;
> +};
> +
> +static int pwrseq_match_device(struct device *pwrseq_dev, void *data)
> +{
> +	struct pwrseq_device *pwrseq = to_pwrseq_device(pwrseq_dev);
> +	struct pwrseq_match_data *match_data = data;
> +	struct pwrseq_target *target;
> +	int ret;
> +
> +	lockdep_assert_held_read(&pwrseq_sem);
> +
> +	guard(rwsem_read)(&pwrseq->rw_lock);
> +	if (!device_is_registered(&pwrseq->dev))
> +		return 0;
> +
> +	ret = pwrseq->match(pwrseq, match_data->dev);
> +	if (ret <= 0)
> +		return ret;
> +
> +	/* We got the matching device, let's find the right target. */
> +	list_for_each_entry(target, &pwrseq->targets, list) {
> +		if (strcmp(target->name, match_data->target))
> +			continue;
> +
> +		match_data->desc->target = target;
> +	}
> +
> +	/*
> +	 * This device does not have this target. No point in deferring as it
> +	 * will not get a new target dynamically later.
> +	 */
> +	if (!match_data->desc->target)
> +		return -ENOENT;
> +
> +	if (!try_module_get(pwrseq->owner))
> +		return -EPROBE_DEFER;
> +
> +	match_data->desc->pwrseq = pwrseq_device_get(pwrseq);
> +
> +	return 1;
> +}
> +
> +/**
> + * pwrseq_get() - Get the power sequencer associated with this device.
> + * @dev: Device for which to get the sequencer.
> + * @target: Name of the target exposed by the sequencer this device wants to
> + *          reach.
> + *
> + * Returns:
> + * New power sequencer descriptor for use by the consumer driver or ERR_PTR()
> + * on failure.
> + */
> +struct pwrseq_desc *pwrseq_get(struct device *dev, const char *target)
> +{
> +	struct pwrseq_match_data match_data;
> +	int ret;
> +
> +	struct pwrseq_desc *desc __free(kfree) = kzalloc(sizeof(*desc),
> +							 GFP_KERNEL);
> +	if (!desc)
> +		return ERR_PTR(-ENOMEM);
> +
> +	match_data.desc = desc;
> +	match_data.dev = dev;
> +	match_data.target = target;
> +
> +	guard(rwsem_read)(&pwrseq_sem);
> +
> +	ret = bus_for_each_dev(&pwrseq_bus, NULL, &match_data,
> +			       pwrseq_match_device);
> +	if (ret < 0)
> +		return ERR_PTR(ret);
> +	if (ret == 0)
> +		/* No device matched. */
> +		return ERR_PTR(-EPROBE_DEFER);
> +
> +	return no_free_ptr(desc);
> +}
> +EXPORT_SYMBOL_GPL(pwrseq_get);
> +
> +/**
> + * pwrseq_put() - Release the power sequencer descriptor.
> + * @desc: Descriptor to release.
> + */
> +void pwrseq_put(struct pwrseq_desc *desc)
> +{
> +	struct pwrseq_device *pwrseq;
> +
> +	if (!desc)
> +		return;
> +
> +	pwrseq = desc->pwrseq;
> +
> +	if (desc->powered_on)
> +		pwrseq_power_off(desc);
> +
> +	kfree(desc);
> +	module_put(pwrseq->owner);
> +	pwrseq_device_put(pwrseq);
> +}
> +EXPORT_SYMBOL_GPL(pwrseq_put);
> +
> +static void devm_pwrseq_put(void *data)
> +{
> +	struct pwrseq_desc *desc = data;
> +
> +	pwrseq_put(desc);
> +}
> +
> +/**
> + * devm_pwrseq_get() - Managed variant of pwrseq_get().
> + * @dev: Device for which to get the sequencer and which also manages its
> + *       lifetime.
> + * @target: Name of the target exposed by the sequencer this device wants to
> + *          reach.
> + *
> + * Returns:
> + * New power sequencer descriptor for use by the consumer driver or ERR_PTR()
> + * on failure.
> + */
> +struct pwrseq_desc *devm_pwrseq_get(struct device *dev, const char *target)
> +{
> +	struct pwrseq_desc *desc;
> +	int ret;
> +
> +	desc = pwrseq_get(dev, target);
> +	if (IS_ERR(desc))
> +		return desc;
> +
> +	ret = devm_add_action_or_reset(dev, devm_pwrseq_put, desc);
> +	if (ret)
> +		return ERR_PTR(ret);
> +
> +	return desc;
> +}
> +EXPORT_SYMBOL_GPL(devm_pwrseq_get);
> +
> +static int pwrseq_unit_enable(struct pwrseq_device *pwrseq,
> +			      struct pwrseq_unit *target);
> +static int pwrseq_unit_disable(struct pwrseq_device *pwrseq,
> +			       struct pwrseq_unit *target);
> +
> +static int pwrseq_unit_enable_deps(struct pwrseq_device *pwrseq,
> +				   struct list_head *list)
> +{
> +	struct pwrseq_unit_dep *pos;
> +	int ret = 0;
> +
> +	list_for_each_entry(pos, list, list) {
> +		ret = pwrseq_unit_enable(pwrseq, pos->unit);
> +		if (ret) {
> +			list_for_each_entry_continue_reverse(pos, list, list)
> +				pwrseq_unit_disable(pwrseq, pos->unit);
> +			break;
> +		}
> +	}
> +
> +	return ret;
> +}
> +
> +static int pwrseq_unit_disable_deps(struct pwrseq_device *pwrseq,
> +				    struct list_head *list)
> +{
> +	struct pwrseq_unit_dep *pos;
> +	int ret = 0;
> +
> +	list_for_each_entry_reverse(pos, list, list) {
> +		ret = pwrseq_unit_disable(pwrseq, pos->unit);
> +		if (ret) {
> +			list_for_each_entry_continue(pos, list, list)
> +				pwrseq_unit_enable(pwrseq, pos->unit);
> +			break;
> +		}
> +	}
> +
> +	return ret;
> +}
> +
> +static int pwrseq_unit_enable(struct pwrseq_device *pwrseq,
> +			      struct pwrseq_unit *unit)
> +{
> +	int ret;
> +
> +	lockdep_assert_held_read(&pwrseq->rw_lock);
> +	lockdep_assert_held(&pwrseq->state_lock);
> +
> +	if (unit->enable_count != 0) {
> +		unit->enable_count++;
> +		return 0;
> +	}
> +
> +	ret = pwrseq_unit_enable_deps(pwrseq, &unit->deps);
> +	if (ret) {
> +		dev_err(&pwrseq->dev,
> +			"Failed to enable dependencies before power-on for target '%s': %d\n",
> +			unit->name, ret);
> +		return ret;
> +	}
> +
> +	if (unit->enable) {
> +		ret = unit->enable(pwrseq);
> +		if (ret) {
> +			dev_err(&pwrseq->dev,
> +				"Failed to enable target '%s': %d\n",
> +				unit->name, ret);
> +			pwrseq_unit_disable_deps(pwrseq, &unit->deps);
> +			return ret;
> +		}
> +	}
> +
> +	unit->enable_count++;
> +
> +	return 0;
> +}
> +
> +static int pwrseq_unit_disable(struct pwrseq_device *pwrseq,
> +			       struct pwrseq_unit *unit)
> +{
> +	int ret;
> +
> +	lockdep_assert_held_read(&pwrseq->rw_lock);
> +	lockdep_assert_held(&pwrseq->state_lock);
> +
> +	if (unit->enable_count == 0) {
> +		WARN_ONCE(1, "Unmatched power-off for target '%s'\n",
> +			  unit->name);
> +		return -EBUSY;
> +	}
> +
> +	if (unit->enable_count != 1) {
> +		unit->enable_count--;
> +		return 0;
> +	}
> +
> +	if (unit->disable) {
> +		ret = unit->disable(pwrseq);
> +		if (ret) {
> +			dev_err(&pwrseq->dev,
> +				"Failed to disable target '%s': %d\n",
> +				unit->name, ret);
> +			return ret;
> +		}
> +	}
> +
> +	ret = pwrseq_unit_disable_deps(pwrseq, &unit->deps);
> +	if (ret) {
> +		dev_err(&pwrseq->dev,
> +			"Failed to disable dependencies after power-off for target '%s': %d\n",
> +			unit->name, ret);
> +		if (unit->enable)
> +			unit->enable(pwrseq);
> +		return ret;
> +	}
> +
> +	unit->enable_count--;
> +
> +	return 0;
> +}
> +
> +/**
> + * pwrseq_power_on() - Issue a power-on request on behalf of the consumer
> + *                     device.
> + * @desc: Descriptor referencing the power sequencer.
> + *
> + * This function tells the power sequencer that the consumer wants to be
> + * powered-up. The sequencer may already have powered-up the device in which
> + * case the function returns 0. If the power-up sequence is already in
> + * progress, the function will block until it's done and return 0. If this is
> + * the first request, the device will be powered up.
> + *
> + * Returns:
> + * 0 on success, negative error number on failure.
> + */
> +int pwrseq_power_on(struct pwrseq_desc *desc)
> +{
> +	struct pwrseq_device *pwrseq;
> +	struct pwrseq_target *target;
> +	struct pwrseq_unit *unit;
> +	int ret;
> +
> +	might_sleep();
> +
> +	if (!desc || desc->powered_on)
> +		return 0;
> +
> +	pwrseq = desc->pwrseq;
> +	target = desc->target;
> +	unit = target->unit;
> +
> +	guard(rwsem_read)(&pwrseq->rw_lock);
> +	if (!device_is_registered(&pwrseq->dev))
> +		return -ENODEV;
> +
> +	scoped_guard(mutex, &pwrseq->state_lock) {
> +		ret = pwrseq_unit_enable(pwrseq, unit);
> +		if (!ret)
> +			desc->powered_on = true;
> +	}
> +
> +	if (target->post_enable) {
> +		ret = target->post_enable(pwrseq);
> +		if (ret) {
> +			pwrseq_unit_disable(pwrseq, unit);
> +			desc->powered_on = false;
> +		}
> +	}
> +
> +	return ret;
> +}
> +EXPORT_SYMBOL_GPL(pwrseq_power_on);
> +
> +/**
> + * pwrseq_power_off() - Issue a power-off request on behalf of the consumer
> + *                      device.
> + * @desc: Descriptor referencing the power sequencer.
> + *
> + * This undoes the effects of pwrseq_power_on(). It issues a power-off request
> + * on behalf of the consumer and when the last remaining user does so, the
> + * power-down sequence will be started. If one is in progress, the function
> + * will block until it's complete and then return.
> + *
> + * Returns:
> + * 0 on success, negative error number on failure.
> + */
> +int pwrseq_power_off(struct pwrseq_desc *desc)
> +{
> +	struct pwrseq_device *pwrseq;
> +	struct pwrseq_unit *unit;
> +	int ret;
> +
> +	might_sleep();
> +
> +	if (!desc || !desc->powered_on)
> +		return 0;
> +
> +	pwrseq = desc->pwrseq;
> +	unit = desc->target->unit;
> +
> +	guard(rwsem_read)(&pwrseq->rw_lock);
> +	if (!device_is_registered(&pwrseq->dev))
> +		return -ENODEV;
> +
> +	guard(mutex)(&pwrseq->state_lock);
> +
> +	ret = pwrseq_unit_disable(pwrseq, unit);
> +	if (!ret)
> +		desc->powered_on = false;
> +
> +	return ret;
> +}
> +EXPORT_SYMBOL_GPL(pwrseq_power_off);
> +
> +#if IS_ENABLED(CONFIG_DEBUG_FS)
> +
> +struct pwrseq_debugfs_count_ctx {
> +	struct device *dev;
> +	loff_t index;
> +};
> +
> +static int pwrseq_debugfs_seq_count(struct device *dev, void *data)
> +{
> +	struct pwrseq_debugfs_count_ctx *ctx = data;
> +
> +	ctx->dev = dev;
> +
> +	return ctx->index-- ? 0 : 1;
> +}
> +
> +static void *pwrseq_debugfs_seq_start(struct seq_file *seq, loff_t *pos)
> +{
> +	struct pwrseq_debugfs_count_ctx ctx;
> +
> +	ctx.dev = NULL;
> +	ctx.index = *pos;
> +
> +	/*
> +	 * We're holding the lock for the entire printout so no need to fiddle
> +	 * with device reference count.
> +	 */
> +	down_read(&pwrseq_sem);
> +
> +	bus_for_each_dev(&pwrseq_bus, NULL, &ctx, pwrseq_debugfs_seq_count);
> +	if (!ctx.index)
> +		return NULL;
> +
> +	return ctx.dev;
> +}
> +
> +static void *pwrseq_debugfs_seq_next(struct seq_file *seq, void *data,
> +				     loff_t *pos)
> +{
> +	struct device *curr = data;
> +
> +	++*pos;
> +
> +	struct device *next __free(put_device) =
> +			bus_find_next_device(&pwrseq_bus, curr);
> +	return next;
> +}
> +
> +static void pwrseq_debugfs_seq_show_target(struct seq_file *seq,
> +					   struct pwrseq_target *target)
> +{
> +	seq_printf(seq, "    target: [%s] (target unit: [%s])\n",
> +		   target->name, target->unit->name);
> +}
> +
> +static void pwrseq_debugfs_seq_show_unit(struct seq_file *seq,
> +					 struct pwrseq_unit *unit)
> +{
> +	struct pwrseq_unit_dep *ref;
> +
> +	seq_printf(seq, "    unit: [%s] - enable count: %u\n",
> +		   unit->name, unit->enable_count);
> +
> +	if (list_empty(&unit->deps))
> +		return;
> +
> +	seq_puts(seq, "      dependencies:\n");
> +	list_for_each_entry(ref, &unit->deps, list)
> +		seq_printf(seq, "        [%s]\n", ref->unit->name);
> +}
> +
> +static int pwrseq_debugfs_seq_show(struct seq_file *seq, void *data)
> +{
> +	struct device *dev = data;
> +	struct pwrseq_device *pwrseq = to_pwrseq_device(dev);
> +	struct pwrseq_target *target;
> +	struct pwrseq_unit *unit;
> +
> +	seq_printf(seq, "%s:\n", dev_name(dev));
> +
> +	seq_puts(seq, "  targets:\n");
> +	list_for_each_entry(target, &pwrseq->targets, list)
> +		pwrseq_debugfs_seq_show_target(seq, target);
> +
> +	seq_puts(seq, "  units:\n");
> +	list_for_each_entry(unit, &pwrseq->units, list)
> +		pwrseq_debugfs_seq_show_unit(seq, unit);
> +
> +	return 0;
> +}
> +
> +static void pwrseq_debugfs_seq_stop(struct seq_file *seq, void *data)
> +{
> +	up_read(&pwrseq_sem);
> +}
> +
> +static const struct seq_operations pwrseq_debugfs_sops = {
> +	.start = pwrseq_debugfs_seq_start,
> +	.next = pwrseq_debugfs_seq_next,
> +	.show = pwrseq_debugfs_seq_show,
> +	.stop = pwrseq_debugfs_seq_stop,
> +};
> +DEFINE_SEQ_ATTRIBUTE(pwrseq_debugfs);
> +
> +static struct dentry *pwrseq_debugfs_dentry;
> +
> +#endif /* CONFIG_DEBUG_FS */
> +
> +static int __init pwrseq_init(void)
> +{
> +	int ret;
> +
> +	ret = bus_register(&pwrseq_bus);
> +	if (ret) {
> +		pr_err("Failed to register the power sequencer bus\n");
> +		return ret;
> +	}
> +
> +#if IS_ENABLED(CONFIG_DEBUG_FS)
> +	pwrseq_debugfs_dentry = debugfs_create_file("pwrseq", 0444, NULL, NULL,
> +						    &pwrseq_debugfs_fops);
> +#endif  /* CONFIG_DEBUG_FS */
> +
> +	return 0;
> +}
> +subsys_initcall(pwrseq_init);
> +
> +static void __exit pwrseq_exit(void)
> +{
> +#if IS_ENABLED(CONFIG_DEBUG_FS)
> +	debugfs_remove_recursive(pwrseq_debugfs_dentry);
> +#endif  /* CONFIG_DEBUG_FS */
> +
> +	bus_unregister(&pwrseq_bus);
> +}
> +module_exit(pwrseq_exit);
> +
> +MODULE_AUTHOR("Bartosz Golaszewski <bartosz.golaszewski@xxxxxxxxxx>");
> +MODULE_DESCRIPTION("Power Sequencing subsystem core");
> +MODULE_LICENSE("GPL");
> diff --git a/include/linux/pwrseq/consumer.h b/include/linux/pwrseq/consumer.h
> new file mode 100644
> index 000000000000..7d583b4f266e
> --- /dev/null
> +++ b/include/linux/pwrseq/consumer.h
> @@ -0,0 +1,56 @@
> +/* SPDX-License-Identifier: GPL-2.0-only */
> +/*
> + * Copyright (C) 2024 Linaro Ltd.
> + */
> +
> +#ifndef __POWER_SEQUENCING_CONSUMER_H__
> +#define __POWER_SEQUENCING_CONSUMER_H__
> +
> +#include <linux/err.h>
> +
> +struct device;
> +struct pwrseq_desc;
> +
> +#if IS_ENABLED(CONFIG_POWER_SEQUENCING)
> +
> +struct pwrseq_desc * __must_check
> +pwrseq_get(struct device *dev, const char *target);
> +void pwrseq_put(struct pwrseq_desc *desc);
> +
> +struct pwrseq_desc * __must_check
> +devm_pwrseq_get(struct device *dev, const char *target);
> +
> +int pwrseq_power_on(struct pwrseq_desc *desc);
> +int pwrseq_power_off(struct pwrseq_desc *desc);
> +
> +#else /* CONFIG_POWER_SEQUENCING */
> +
> +static inline struct pwrseq_desc * __must_check
> +pwrseq_get(struct device *dev, const char *target)
> +{
> +	return ERR_PTR(-ENOSYS);
> +}
> +
> +static inline void pwrseq_put(struct pwrseq_desc *desc)
> +{
> +}
> +
> +static inline struct pwrseq_desc * __must_check
> +devm_pwrseq_get(struct device *dev, const char *target)
> +{
> +	return ERR_PTR(-ENOSYS);
> +}
> +
> +static inline int pwrseq_power_on(struct pwrseq_desc *desc)
> +{
> +	return -ENOSYS;
> +}
> +
> +static inline int pwrseq_power_off(struct pwrseq_desc *desc)
> +{
> +	return -ENOSYS;
> +}
> +
> +#endif /* CONFIG_POWER_SEQUENCING */
> +
> +#endif /* __POWER_SEQUENCING_CONSUMER_H__ */
> diff --git a/include/linux/pwrseq/provider.h b/include/linux/pwrseq/provider.h
> new file mode 100644
> index 000000000000..e627ed2f4d91
> --- /dev/null
> +++ b/include/linux/pwrseq/provider.h
> @@ -0,0 +1,75 @@
> +/* SPDX-License-Identifier: GPL-2.0-only */
> +/*
> + * Copyright (C) 2024 Linaro Ltd.
> + */
> +
> +#ifndef __POWER_SEQUENCING_PROVIDER_H__
> +#define __POWER_SEQUENCING_PROVIDER_H__
> +
> +struct device;
> +struct module;
> +struct pwrseq_device;
> +
> +typedef int (*pwrseq_power_state_func)(struct pwrseq_device *);
> +typedef int (*pwrseq_match_func)(struct pwrseq_device *, struct device *);
> +
> +/**
> + * struct pwrseq_unit_data - Configuration of a single power sequencing
> + *                           unit.
> + * @name: Name of the unit.
> + * @deps: Units that must be enabled before this one and disabled after it
> + *        in the order they come in this array.
> + * @enable: Callback running the part of the power-on sequence provided by
> + *          this unit.
> + * @disable: Callback running the part of the power-off sequence provided
> + *           by this unit.
> + */
> +struct pwrseq_unit_data {
> +	const char *name;
> +	const struct pwrseq_unit_data **deps;
> +	pwrseq_power_state_func enable;
> +	pwrseq_power_state_func disable;
> +};
> +
> +/**
> + * struct pwrseq_target_data - Configuration of a power sequencing target.
> + * @name: Name of the target.
> + * @unit: Final unit that this target must reach in order to be considered
> + *        enabled.
> + * @post_enable: Callback run after the target unit has been enabled, *after*
> + *               the state lock has been released. It's useful for implementing
> + *               boot-up delays without blocking other users from powering up
> + *               using the same power sequencer.
> + */
> +struct pwrseq_target_data {
> +	const char *name;
> +	const struct pwrseq_unit_data *unit;
> +	pwrseq_power_state_func post_enable;
> +};
> +
> +/**
> + * struct pwrseq_config - Configuration used for registering a new provider.
> + * @parent: Parent device for the sequencer. Must be set.
> + * @owner: Module providing this device.
> + * @drvdata: Private driver data.
> + * @match: Provider callback used to match the consumer device to the sequencer.
> + * @targets: Array of targets for this power sequencer. Must be NULL-terminated.
> + */
> +struct pwrseq_config {
> +	struct device *parent;
> +	struct module *owner;
> +	void *drvdata;
> +	pwrseq_match_func match;
> +	const struct pwrseq_target_data **targets;
> +};
> +
> +struct pwrseq_device *
> +pwrseq_device_register(const struct pwrseq_config *config);
> +void pwrseq_device_unregister(struct pwrseq_device *pwrseq);
> +struct pwrseq_device *
> +devm_pwrseq_device_register(struct device *dev,
> +			    const struct pwrseq_config *config);
> +
> +void *pwrseq_device_get_drvdata(struct pwrseq_device *pwrseq);
> +
> +#endif /* __POWER_SEQUENCING_PROVIDER_H__ */
>
> --
> 2.43.0
>




[Index of Archives]     [DMA Engine]     [Linux Coverity]     [Linux USB]     [Video for Linux]     [Linux Audio Users]     [Yosemite News]     [Linux Kernel]     [Linux SCSI]     [Greybus]

  Powered by Linux