1 /* 2 * Copyright (c) 2016, NVIDIA CORPORATION. 3 * 4 * SPDX-License-Identifier: GPL-2.0 5 */ 6 7 #include <common.h> 8 #include <dm.h> 9 #include <power-domain.h> 10 #include <power-domain-uclass.h> 11 12 static inline struct power_domain_ops *power_domain_dev_ops(struct udevice *dev) 13 { 14 return (struct power_domain_ops *)dev->driver->ops; 15 } 16 17 static int power_domain_of_xlate_default(struct power_domain *power_domain, 18 struct ofnode_phandle_args *args) 19 { 20 debug("%s(power_domain=%p)\n", __func__, power_domain); 21 22 if (args->args_count != 1) { 23 debug("Invalid args_count: %d\n", args->args_count); 24 return -EINVAL; 25 } 26 27 power_domain->id = args->args[0]; 28 29 return 0; 30 } 31 32 int power_domain_get(struct udevice *dev, struct power_domain *power_domain) 33 { 34 struct ofnode_phandle_args args; 35 int ret; 36 struct udevice *dev_power_domain; 37 struct power_domain_ops *ops; 38 39 debug("%s(dev=%p, power_domain=%p)\n", __func__, dev, power_domain); 40 41 ret = dev_read_phandle_with_args(dev, "power-domains", 42 "#power-domain-cells", 0, 0, &args); 43 if (ret) { 44 debug("%s: dev_read_phandle_with_args failed: %d\n", 45 __func__, ret); 46 return ret; 47 } 48 49 ret = uclass_get_device_by_ofnode(UCLASS_POWER_DOMAIN, args.node, 50 &dev_power_domain); 51 if (ret) { 52 debug("%s: uclass_get_device_by_ofnode failed: %d\n", 53 __func__, ret); 54 return ret; 55 } 56 ops = power_domain_dev_ops(dev_power_domain); 57 58 power_domain->dev = dev_power_domain; 59 if (ops->of_xlate) 60 ret = ops->of_xlate(power_domain, &args); 61 else 62 ret = power_domain_of_xlate_default(power_domain, &args); 63 if (ret) { 64 debug("of_xlate() failed: %d\n", ret); 65 return ret; 66 } 67 68 ret = ops->request(power_domain); 69 if (ret) { 70 debug("ops->request() failed: %d\n", ret); 71 return ret; 72 } 73 74 return 0; 75 } 76 77 int power_domain_free(struct power_domain *power_domain) 78 { 79 struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev); 80 81 debug("%s(power_domain=%p)\n", __func__, power_domain); 82 83 return ops->free(power_domain); 84 } 85 86 int power_domain_on(struct power_domain *power_domain) 87 { 88 struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev); 89 90 debug("%s(power_domain=%p)\n", __func__, power_domain); 91 92 return ops->on(power_domain); 93 } 94 95 int power_domain_off(struct power_domain *power_domain) 96 { 97 struct power_domain_ops *ops = power_domain_dev_ops(power_domain->dev); 98 99 debug("%s(power_domain=%p)\n", __func__, power_domain); 100 101 return ops->off(power_domain); 102 } 103 104 UCLASS_DRIVER(power_domain) = { 105 .id = UCLASS_POWER_DOMAIN, 106 .name = "power_domain", 107 }; 108