drivers/clk/ti/clk.c

   1 /*
   2  * TI clock support
   3  *
   4  * Copyright (C) 2013 Texas Instruments, Inc.
   5  *
   6  * Tero Kristo <t-kristo@ti.com>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License version 2 as
  10  * published by the Free Software Foundation.
  11  *
  12  * This program is distributed "as is" WITHOUT ANY WARRANTY of any
  13  * kind, whether express or implied; without even the implied warranty
  14  * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  */
  17
  18 #include <linux/clk-provider.h>
  19 #include <linux/clkdev.h>
  20 #include <linux/clk/ti.h>
  21 #include <linux/of.h>
  22 #include <linux/of_address.h>
  23 #include <linux/list.h>
  24
  25 #undef pr_fmt
  26 #define pr_fmt(fmt) "%s: " fmt, __func__
  27
  28 static int ti_dt_clk_memmap_index;
  29 struct ti_clk_ll_ops *ti_clk_ll_ops;
  30
  31 /**
  32  * ti_dt_clocks_register - register DT alias clocks during boot
  33  * @oclks: list of clocks to register
  34  *
  35  * Register alias or non-standard DT clock entries during boot. By
  36  * default, DT clocks are found based on their node name. If any
  37  * additional con-id / dev-id -> clock mapping is required, use this
  38  * function to list these.
  39  */
  40 void __init ti_dt_clocks_register(struct ti_dt_clk oclks[])
  41 {
  42         struct ti_dt_clk *c;
  43         struct device_node *node;
  44         struct clk *clk;
  45         struct of_phandle_args clkspec;
  46
  47         for (c = oclks; c->node_name != NULL; c++) {
  48                 node = of_find_node_by_name(NULL, c->node_name);
  49                 clkspec.np = node;
  50                 clk = of_clk_get_from_provider(&clkspec);
  51
  52                 if (!IS_ERR(clk)) {
  53                         c->lk.clk = clk;
  54                         clkdev_add(&c->lk);
  55                 } else {
  56                         pr_warn("failed to lookup clock node %s\n",
  57                                 c->node_name);
  58                 }
  59         }
  60 }
  61
  62 struct clk_init_item {
  63         struct device_node *node;
  64         struct clk_hw *hw;
  65         ti_of_clk_init_cb_t func;
  66         struct list_head link;
  67 };
  68
  69 static LIST_HEAD(retry_list);
  70
  71 /**
  72  * ti_clk_retry_init - retries a failed clock init at later phase
  73  * @node: device not for the clock
  74  * @hw: partially initialized clk_hw struct for the clock
  75  * @func: init function to be called for the clock
  76  *
  77  * Adds a failed clock init to the retry list. The retry list is parsed
  78  * once all the other clocks have been initialized.
  79  */
  80 int __init ti_clk_retry_init(struct device_node *node, struct clk_hw *hw,
  81                               ti_of_clk_init_cb_t func)
  82 {
  83         struct clk_init_item *retry;
  84
  85         pr_debug("%s: adding to retry list...\n", node->name);
  86         retry = kzalloc(sizeof(*retry), GFP_KERNEL);
  87         if (!retry)
  88                 return -ENOMEM;
  89
  90         retry->node = node;
  91         retry->func = func;
  92         retry->hw = hw;
  93         list_add(&retry->link, &retry_list);
  94
  95         return 0;
  96 }
  97
  98 /**
  99  * ti_clk_get_reg_addr - get register address for a clock register
 100  * @node: device node for the clock
 101  * @index: register index from the clock node
 102  *
 103  * Builds clock register address from device tree information. This
 104  * is a struct of type clk_omap_reg.
 105  */
 106 void __iomem *ti_clk_get_reg_addr(struct device_node *node, int index)
 107 {
 108         struct clk_omap_reg *reg;
 109         u32 val;
 110         u32 tmp;
 111
 112         reg = (struct clk_omap_reg *)&tmp;
 113         reg->index = ti_dt_clk_memmap_index;
 114
 115         if (of_property_read_u32_index(node, "reg", index, &val)) {
 116                 pr_err("%s must have reg[%d]!\n", node->name, index);
 117                 return NULL;
 118         }
 119
 120         reg->offset = val;
 121
 122         return (void __iomem *)tmp;
 123 }
 124
 125 /**
 126  * ti_dt_clk_init_provider - init master clock provider
 127  * @parent: master node
 128  * @index: internal index for clk_reg_ops
 129  *
 130  * Initializes a master clock IP block and its child clock nodes.
 131  * Regmap is provided for accessing the register space for the
 132  * IP block and all the clocks under it.
 133  */
 134 void ti_dt_clk_init_provider(struct device_node *parent, int index)
 135 {
 136         const struct of_device_id *match;
 137         struct device_node *np;
 138         struct device_node *clocks;
 139         of_clk_init_cb_t clk_init_cb;
 140         struct clk_init_item *retry;
 141         struct clk_init_item *tmp;
 142
 143         ti_dt_clk_memmap_index = index;
 144
 145         /* get clocks for this parent */
 146         clocks = of_get_child_by_name(parent, "clocks");
 147         if (!clocks) {
 148                 pr_err("%s missing 'clocks' child node.\n", parent->name);
 149                 return;
 150         }
 151
 152         for_each_child_of_node(clocks, np) {
 153                 match = of_match_node(&__clk_of_table, np);
 154                 if (!match)
 155                         continue;
 156                 clk_init_cb = (of_clk_init_cb_t)match->data;
 157                 pr_debug("%s: initializing: %s\n", __func__, np->name);
 158                 clk_init_cb(np);
 159         }
 160
 161         list_for_each_entry_safe(retry, tmp, &retry_list, link) {
 162                 pr_debug("retry-init: %s\n", retry->node->name);
 163                 retry->func(retry->hw, retry->node);
 164                 list_del(&retry->link);
 165                 kfree(retry);
 166         }
 167 }