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