mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-07-09 20:56:16 +09:00
2618cf3657
There are cases where there are more than one power domain attached to the device inorder to get the device functional. So add support for enabling power domain based on the index. Reviewed-by: Tom Rini <trini@konsulko.com> Signed-off-by: Lokesh Vutla <lokeshvutla@ti.com>
114 lines
2.6 KiB
C
114 lines
2.6 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright (c) 2016, NVIDIA CORPORATION.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <power-domain.h>
|
|
#include <power-domain-uclass.h>
|
|
|
|
static inline struct power_domain_ops *power_domain_dev_ops(struct udevice *dev)
|
|
{
|
|
return (struct power_domain_ops *)dev->driver->ops;
|
|
}
|
|
|
|
static int power_domain_of_xlate_default(struct power_domain *power_domain,
|
|
struct ofnode_phandle_args *args)
|
|
{
|
|
debug("%s(power_domain=%p)\n", __func__, power_domain);
|
|
|
|
if (args->args_count != 1) {
|
|
debug("Invalid args_count: %d\n", args->args_count);
|
|
return -EINVAL;
|
|
}
|
|
|
|
power_domain->id = args->args[0];
|
|
|
|
return 0;
|
|
}
|
|
|
|
int power_domain_get_by_index(struct udevice *dev,
|
|
struct power_domain *power_domain, int index)
|
|
{
|
|
struct ofnode_phandle_args args;
|
|
int ret;
|
|
struct udevice *dev_power_domain;
|
|
struct power_domain_ops *ops;
|
|
|
|
debug("%s(dev=%p, power_domain=%p)\n", __func__, dev, power_domain);
|
|
|
|
ret = dev_read_phandle_with_args(dev, "power-domains",
|
|
"#power-domain-cells", 0, index,
|
|
&args);
|
|
if (ret) {
|
|
debug("%s: dev_read_phandle_with_args failed: %d\n",
|
|
__func__, ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = uclass_get_device_by_ofnode(UCLASS_POWER_DOMAIN, args.node,
|
|
&dev_power_domain);
|
|
if (ret) {
|
|
debug("%s: uclass_get_device_by_ofnode failed: %d\n",
|
|
__func__, ret);
|
|
return ret;
|
|
}
|
|
ops = power_domain_dev_ops(dev_power_domain);
|
|
|
|
power_domain->dev = dev_power_domain;
|
|
if (ops->of_xlate)
|
|
ret = ops->of_xlate(power_domain, &args);
|
|
else
|
|
ret = power_domain_of_xlate_default(power_domain, &args);
|
|
if (ret) {
|
|
debug("of_xlate() failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = ops->request(power_domain);
|
|
if (ret) {
|
|
debug("ops->request() failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int power_domain_get(struct udevice *dev, struct power_domain *power_domain)
|
|
{
|
|
return power_domain_get_by_index(dev, power_domain, 0);
|
|
}
|
|
|
|
int power_domain_free(struct power_domain *power_domain)
|
|
{
|
|
struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
|
|
|
|
debug("%s(power_domain=%p)\n", __func__, power_domain);
|
|
|
|
return ops->free(power_domain);
|
|
}
|
|
|
|
int power_domain_on(struct power_domain *power_domain)
|
|
{
|
|
struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
|
|
|
|
debug("%s(power_domain=%p)\n", __func__, power_domain);
|
|
|
|
return ops->on(power_domain);
|
|
}
|
|
|
|
int power_domain_off(struct power_domain *power_domain)
|
|
{
|
|
struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev);
|
|
|
|
debug("%s(power_domain=%p)\n", __func__, power_domain);
|
|
|
|
return ops->off(power_domain);
|
|
}
|
|
|
|
UCLASS_DRIVER(power_domain) = {
|
|
.id = UCLASS_POWER_DOMAIN,
|
|
.name = "power_domain",
|
|
};
|