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 } 116