1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (C) 2017 Álvaro Fernández Rojas <noltari@gmail.com>
4 */
5
6 #include <common.h>
7 #include <dm.h>
8 #include <malloc.h>
9 #include <power-domain-uclass.h>
10 #include <asm/io.h>
11 #include <linux/bitops.h>
12
13 #define MAX_DOMAINS 32
14
15 struct bcm6328_power_domain {
16 void __iomem *regs;
17 };
18
bcm6328_power_domain_request(struct power_domain * power_domain)19 static int bcm6328_power_domain_request(struct power_domain *power_domain)
20 {
21 if (power_domain->id >= MAX_DOMAINS)
22 return -EINVAL;
23
24 return 0;
25 }
26
bcm6328_power_domain_free(struct power_domain * power_domain)27 static int bcm6328_power_domain_free(struct power_domain *power_domain)
28 {
29 return 0;
30 }
31
bcm6328_power_domain_on(struct power_domain * power_domain)32 static int bcm6328_power_domain_on(struct power_domain *power_domain)
33 {
34 struct bcm6328_power_domain *priv = dev_get_priv(power_domain->dev);
35
36 clrbits_be32(priv->regs, BIT(power_domain->id));
37
38 return 0;
39 }
40
bcm6328_power_domain_off(struct power_domain * power_domain)41 static int bcm6328_power_domain_off(struct power_domain *power_domain)
42 {
43 struct bcm6328_power_domain *priv = dev_get_priv(power_domain->dev);
44
45 setbits_be32(priv->regs, BIT(power_domain->id));
46
47 return 0;
48 }
49
bcm6328_power_domain_probe(struct udevice * dev)50 static int bcm6328_power_domain_probe(struct udevice *dev)
51 {
52 struct bcm6328_power_domain *priv = dev_get_priv(dev);
53
54 priv->regs = dev_remap_addr(dev);
55 if (!priv->regs)
56 return -EINVAL;
57
58 return 0;
59 }
60
61 static const struct udevice_id bcm6328_power_domain_ids[] = {
62 { .compatible = "brcm,bcm6328-power-domain" },
63 { /* sentinel */ }
64 };
65
66 struct power_domain_ops bcm6328_power_domain_ops = {
67 .rfree = bcm6328_power_domain_free,
68 .off = bcm6328_power_domain_off,
69 .on = bcm6328_power_domain_on,
70 .request = bcm6328_power_domain_request,
71 };
72
73 U_BOOT_DRIVER(bcm6328_power_domain) = {
74 .name = "bcm6328_power_domain",
75 .id = UCLASS_POWER_DOMAIN,
76 .of_match = bcm6328_power_domain_ids,
77 .ops = &bcm6328_power_domain_ops,
78 .priv_auto = sizeof(struct bcm6328_power_domain),
79 .probe = bcm6328_power_domain_probe,
80 };
81