drivers/power/domain/bcm6328-power-domain.c

   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
  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_free(struct power_domain *power_domain)
  27 {
  28         return 0;
  29 }
  30
  31 static int bcm6328_power_domain_on(struct power_domain *power_domain)
  32 {
  33         struct bcm6328_power_domain *priv = dev_get_priv(power_domain->dev);
  34
  35         clrbits_be32(priv->regs, BIT(power_domain->id));
  36
  37         return 0;
  38 }
  39
  40 static int bcm6328_power_domain_off(struct power_domain *power_domain)
  41 {
  42         struct bcm6328_power_domain *priv = dev_get_priv(power_domain->dev);
  43
  44         setbits_be32(priv->regs, BIT(power_domain->id));
  45
  46         return 0;
  47 }
  48
  49 static int bcm6328_power_domain_probe(struct udevice *dev)
  50 {
  51         struct bcm6328_power_domain *priv = dev_get_priv(dev);
  52
  53         priv->regs = dev_remap_addr(dev);
  54         if (!priv->regs)
  55                 return -EINVAL;
  56
  57         return 0;
  58 }
  59
  60 static const struct udevice_id bcm6328_power_domain_ids[] = {
  61         { .compatible = "brcm,bcm6328-power-domain" },
  62         { /* sentinel */ }
  63 };
  64
  65 struct power_domain_ops bcm6328_power_domain_ops = {
  66         .rfree = bcm6328_power_domain_free,
  67         .off = bcm6328_power_domain_off,
  68         .on = bcm6328_power_domain_on,
  69         .request = bcm6328_power_domain_request,
  70 };
  71
  72 U_BOOT_DRIVER(bcm6328_power_domain) = {
  73         .name = "bcm6328_power_domain",
  74         .id = UCLASS_POWER_DOMAIN,
  75         .of_match = bcm6328_power_domain_ids,
  76         .ops = &bcm6328_power_domain_ops,
  77         .priv_auto_alloc_size = sizeof(struct bcm6328_power_domain),
  78         .probe = bcm6328_power_domain_probe,
  79 };