drivers/clk/at91/pmc.c

   1 /*
   2  * Copyright (C) 2016 Atmel Corporation
   3  *               Wenyou.Yang <wenyou.yang@atmel.com>
   4  *
   5  * SPDX-License-Identifier:     GPL-2.0+
   6  */
   7
   8 #include <common.h>
   9 #include <clk-uclass.h>
  10 #include <dm/device.h>
  11 #include <dm/lists.h>
  12 #include <dm/root.h>
  13 #include <dm/util.h>
  14 #include "pmc.h"
  15
  16 DECLARE_GLOBAL_DATA_PTR;
  17
  18 static const struct udevice_id at91_pmc_match[] = {
  19         { .compatible = "atmel,sama5d2-pmc" },
  20         {}
  21 };
  22
  23 U_BOOT_DRIVER(at91_pmc) = {
  24         .name = "at91-pmc",
  25         .id = UCLASS_SIMPLE_BUS,
  26         .of_match = at91_pmc_match,
  27 };
  28
  29 /*---------------------------------------------------------*/
  30
  31 int at91_pmc_core_probe(struct udevice *dev)
  32 {
  33         struct pmc_platdata *plat = dev_get_platdata(dev);
  34
  35         dev = dev_get_parent(dev);
  36
  37         plat->reg_base = (struct at91_pmc *)dev_get_addr_ptr(dev);
  38
  39         return 0;
  40 }
  41
  42 /**
  43  * at91_clk_sub_device_bind() - for the at91 clock driver
  44  * Recursively bind its children as clk devices.
  45  *
  46  * @return: 0 on success, or negative error code on failure
  47  */
  48 int at91_clk_sub_device_bind(struct udevice *dev, const char *drv_name)
  49 {
  50         const void *fdt = gd->fdt_blob;
  51         int offset = dev_of_offset(dev);
  52         bool pre_reloc_only = !(gd->flags & GD_FLG_RELOC);
  53         const char *name;
  54         int ret;
  55
  56         for (offset = fdt_first_subnode(fdt, offset);
  57              offset > 0;
  58              offset = fdt_next_subnode(fdt, offset)) {
  59                 if (pre_reloc_only &&
  60                     !dm_fdt_pre_reloc(fdt, offset))
  61                         continue;
  62                 /*
  63                  * If this node has "compatible" property, this is not
  64                  * a clock sub-node, but a normal device. skip.
  65                  */
  66                 fdt_get_property(fdt, offset, "compatible", &ret);
  67                 if (ret >= 0)
  68                         continue;
  69
  70                 if (ret != -FDT_ERR_NOTFOUND)
  71                         return ret;
  72
  73                 name = fdt_get_name(fdt, offset, NULL);
  74                 if (!name)
  75                         return -EINVAL;
  76                 ret = device_bind_driver_to_node(dev, drv_name, name,
  77                                                  offset, NULL);
  78                 if (ret)
  79                         return ret;
  80         }
  81
  82         return 0;
  83 }
  84
  85 int at91_clk_of_xlate(struct clk *clk, struct fdtdec_phandle_args *args)
  86 {
  87         int periph;
  88
  89         if (args->args_count) {
  90                 debug("Invalid args_count: %d\n", args->args_count);
  91                 return -EINVAL;
  92         }
  93
  94         periph = fdtdec_get_uint(gd->fdt_blob, dev_of_offset(clk->dev), "reg",
  95                                  -1);
  96         if (periph < 0)
  97                 return -EINVAL;
  98
  99         clk->id = periph;
 100
 101         return 0;
 102 }
 103
 104 int at91_clk_probe(struct udevice *dev)
 105 {
 106         struct udevice *dev_periph_container, *dev_pmc;
 107         struct pmc_platdata *plat = dev_get_platdata(dev);
 108
 109         dev_periph_container = dev_get_parent(dev);
 110         dev_pmc = dev_get_parent(dev_periph_container);
 111
 112         plat->reg_base = (struct at91_pmc *)dev_get_addr_ptr(dev_pmc);
 113
 114         return 0;
 115 }