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