drivers/clk/clk-gpio.c

   1 /*
   2  * Copyright (C) 2013 - 2014 Texas Instruments Incorporated - http://www.ti.com
   3  *
   4  * Authors:
   5  *    Jyri Sarha <jsarha@ti.com>
   6  *    Sergej Sawazki <ce3a@gmx.de>
   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  * Gpio controlled clock implementation
  13  */
  14
  15 #include <linux/clk-provider.h>
  16 #include <linux/export.h>
  17 #include <linux/slab.h>
  18 #include <linux/gpio.h>
  19 #include <linux/gpio/consumer.h>
  20 #include <linux/of_gpio.h>
  21 #include <linux/err.h>
  22 #include <linux/device.h>
  23
  24 /**
  25  * DOC: basic gpio gated clock which can be enabled and disabled
  26  *      with gpio output
  27  * Traits of this clock:
  28  * prepare - clk_(un)prepare only ensures parent is (un)prepared
  29  * enable - clk_enable and clk_disable are functional & control gpio
  30  * rate - inherits rate from parent.  No clk_set_rate support
  31  * parent - fixed parent.  No clk_set_parent support
  32  */
  33
  34 #define to_clk_gpio(_hw) container_of(_hw, struct clk_gpio, hw)
  35
  36 static int clk_gpio_gate_enable(struct clk_hw *hw)
  37 {
  38         struct clk_gpio *clk = to_clk_gpio(hw);
  39
  40         gpiod_set_value(clk->gpiod, 1);
  41
  42         return 0;
  43 }
  44
  45 static void clk_gpio_gate_disable(struct clk_hw *hw)
  46 {
  47         struct clk_gpio *clk = to_clk_gpio(hw);
  48
  49         gpiod_set_value(clk->gpiod, 0);
  50 }
  51
  52 static int clk_gpio_gate_is_enabled(struct clk_hw *hw)
  53 {
  54         struct clk_gpio *clk = to_clk_gpio(hw);
  55
  56         return gpiod_get_value(clk->gpiod);
  57 }
  58
  59 const struct clk_ops clk_gpio_gate_ops = {
  60         .enable = clk_gpio_gate_enable,
  61         .disable = clk_gpio_gate_disable,
  62         .is_enabled = clk_gpio_gate_is_enabled,
  63 };
  64 EXPORT_SYMBOL_GPL(clk_gpio_gate_ops);
  65
  66 /**
  67  * DOC: basic clock multiplexer which can be controlled with a gpio output
  68  * Traits of this clock:
  69  * prepare - clk_prepare only ensures that parents are prepared
  70  * rate - rate is only affected by parent switching.  No clk_set_rate support
  71  * parent - parent is adjustable through clk_set_parent
  72  */
  73
  74 static u8 clk_gpio_mux_get_parent(struct clk_hw *hw)
  75 {
  76         struct clk_gpio *clk = to_clk_gpio(hw);
  77
  78         return gpiod_get_value(clk->gpiod);
  79 }
  80
  81 static int clk_gpio_mux_set_parent(struct clk_hw *hw, u8 index)
  82 {
  83         struct clk_gpio *clk = to_clk_gpio(hw);
  84
  85         gpiod_set_value(clk->gpiod, index);
  86
  87         return 0;
  88 }
  89
  90 const struct clk_ops clk_gpio_mux_ops = {
  91         .get_parent = clk_gpio_mux_get_parent,
  92         .set_parent = clk_gpio_mux_set_parent,
  93         .determine_rate = __clk_mux_determine_rate,
  94 };
  95 EXPORT_SYMBOL_GPL(clk_gpio_mux_ops);
  96
  97 static struct clk *clk_register_gpio(struct device *dev, const char *name,
  98                 const char * const *parent_names, u8 num_parents, unsigned gpio,
  99                 bool active_low, unsigned long flags,
 100                 const struct clk_ops *clk_gpio_ops)
 101 {
 102         struct clk_gpio *clk_gpio;
 103         struct clk *clk;
 104         struct clk_init_data init = {};
 105         unsigned long gpio_flags;
 106         int err;
 107
 108         if (dev)
 109                 clk_gpio = devm_kzalloc(dev, sizeof(*clk_gpio), GFP_KERNEL);
 110         else
 111                 clk_gpio = kzalloc(sizeof(*clk_gpio), GFP_KERNEL);
 112
 113         if (!clk_gpio)
 114                 return ERR_PTR(-ENOMEM);
 115
 116         if (active_low)
 117                 gpio_flags = GPIOF_ACTIVE_LOW | GPIOF_OUT_INIT_HIGH;
 118         else
 119                 gpio_flags = GPIOF_OUT_INIT_LOW;
 120
 121         if (dev)
 122                 err = devm_gpio_request_one(dev, gpio, gpio_flags, name);
 123         else
 124                 err = gpio_request_one(gpio, gpio_flags, name);
 125         if (err) {
 126                 if (err != -EPROBE_DEFER)
 127                         pr_err("%s: %s: Error requesting clock control gpio %u\n",
 128                                         __func__, name, gpio);
 129                 if (!dev)
 130                         kfree(clk_gpio);
 131
 132                 return ERR_PTR(err);
 133         }
 134
 135         init.name = name;
 136         init.ops = clk_gpio_ops;
 137         init.flags = flags | CLK_IS_BASIC;
 138         init.parent_names = parent_names;
 139         init.num_parents = num_parents;
 140
 141         clk_gpio->gpiod = gpio_to_desc(gpio);
 142         clk_gpio->hw.init = &init;
 143
 144         if (dev)
 145                 clk = devm_clk_register(dev, &clk_gpio->hw);
 146         else
 147                 clk = clk_register(NULL, &clk_gpio->hw);
 148
 149         if (!IS_ERR(clk))
 150                 return clk;
 151
 152         if (!dev) {
 153                 gpiod_put(clk_gpio->gpiod);
 154                 kfree(clk_gpio);
 155         }
 156
 157         return clk;
 158 }
 159
 160 /**
 161  * clk_register_gpio_gate - register a gpio clock gate with the clock framework
 162  * @dev: device that is registering this clock
 163  * @name: name of this clock
 164  * @parent_name: name of this clock's parent
 165  * @gpio: gpio number to gate this clock
 166  * @active_low: true if gpio should be set to 0 to enable clock
 167  * @flags: clock flags
 168  */
 169 struct clk *clk_register_gpio_gate(struct device *dev, const char *name,
 170                 const char *parent_name, unsigned gpio, bool active_low,
 171                 unsigned long flags)
 172 {
 173         return clk_register_gpio(dev, name,
 174                         (parent_name ? &parent_name : NULL),
 175                         (parent_name ? 1 : 0), gpio, active_low, flags,
 176                         &clk_gpio_gate_ops);
 177 }
 178 EXPORT_SYMBOL_GPL(clk_register_gpio_gate);
 179
 180 /**
 181  * clk_register_gpio_mux - register a gpio clock mux with the clock framework
 182  * @dev: device that is registering this clock
 183  * @name: name of this clock
 184  * @parent_names: names of this clock's parents
 185  * @num_parents: number of parents listed in @parent_names
 186  * @gpio: gpio number to gate this clock
 187  * @active_low: true if gpio should be set to 0 to enable clock
 188  * @flags: clock flags
 189  */
 190 struct clk *clk_register_gpio_mux(struct device *dev, const char *name,
 191                 const char * const *parent_names, u8 num_parents, unsigned gpio,
 192                 bool active_low, unsigned long flags)
 193 {
 194         if (num_parents != 2) {
 195                 pr_err("mux-clock %s must have 2 parents\n", name);
 196                 return ERR_PTR(-EINVAL);
 197         }
 198
 199         return clk_register_gpio(dev, name, parent_names, num_parents,
 200                         gpio, active_low, flags, &clk_gpio_mux_ops);
 201 }
 202 EXPORT_SYMBOL_GPL(clk_register_gpio_mux);
 203
 204 #ifdef CONFIG_OF
 205 /**
 206  * clk_register_get() has to be delayed, because -EPROBE_DEFER
 207  * can not be handled properly at of_clk_init() call time.
 208  */
 209
 210 struct clk_gpio_delayed_register_data {
 211         const char *gpio_name;
 212         int num_parents;
 213         const char **parent_names;
 214         struct device_node *node;
 215         struct mutex lock;
 216         struct clk *clk;
 217         struct clk *(*clk_register_get)(const char *name,
 218                         const char * const *parent_names, u8 num_parents,
 219                         unsigned gpio, bool active_low);
 220 };
 221
 222 static struct clk *of_clk_gpio_delayed_register_get(
 223                 struct of_phandle_args *clkspec, void *_data)
 224 {
 225         struct clk_gpio_delayed_register_data *data = _data;
 226         struct clk *clk;
 227         int gpio;
 228         enum of_gpio_flags of_flags;
 229
 230         mutex_lock(&data->lock);
 231
 232         if (data->clk) {
 233                 mutex_unlock(&data->lock);
 234                 return data->clk;
 235         }
 236
 237         gpio = of_get_named_gpio_flags(data->node, data->gpio_name, 0,
 238                         &of_flags);
 239         if (gpio < 0) {
 240                 mutex_unlock(&data->lock);
 241                 if (gpio == -EPROBE_DEFER)
 242                         pr_debug("%s: %s: GPIOs not yet available, retry later\n",
 243                                         data->node->name, __func__);
 244                 else
 245                         pr_err("%s: %s: Can't get '%s' DT property\n",
 246                                         data->node->name, __func__,
 247                                         data->gpio_name);
 248                 return ERR_PTR(gpio);
 249         }
 250
 251         clk = data->clk_register_get(data->node->name, data->parent_names,
 252                         data->num_parents, gpio, of_flags & OF_GPIO_ACTIVE_LOW);
 253         if (IS_ERR(clk))
 254                 goto out;
 255
 256         data->clk = clk;
 257 out:
 258         mutex_unlock(&data->lock);
 259
 260         return clk;
 261 }
 262
 263 static struct clk *of_clk_gpio_gate_delayed_register_get(const char *name,
 264                 const char * const *parent_names, u8 num_parents,
 265                 unsigned gpio, bool active_low)
 266 {
 267         return clk_register_gpio_gate(NULL, name, parent_names[0],
 268                         gpio, active_low, 0);
 269 }
 270
 271 static struct clk *of_clk_gpio_mux_delayed_register_get(const char *name,
 272                 const char * const *parent_names, u8 num_parents, unsigned gpio,
 273                 bool active_low)
 274 {
 275         return clk_register_gpio_mux(NULL, name, parent_names, num_parents,
 276                         gpio, active_low, 0);
 277 }
 278
 279 static void __init of_gpio_clk_setup(struct device_node *node,
 280                 const char *gpio_name,
 281                 struct clk *(*clk_register_get)(const char *name,
 282                                 const char * const *parent_names,
 283                                 u8 num_parents,
 284                                 unsigned gpio, bool active_low))
 285 {
 286         struct clk_gpio_delayed_register_data *data;
 287         const char **parent_names;
 288         int i, num_parents;
 289
 290         num_parents = of_clk_get_parent_count(node);
 291         if (num_parents < 0)
 292                 return;
 293
 294         data = kzalloc(sizeof(*data), GFP_KERNEL);
 295         if (!data)
 296                 return;
 297
 298         parent_names = kcalloc(num_parents, sizeof(char *), GFP_KERNEL);
 299         if (!parent_names)
 300                 return;
 301
 302         for (i = 0; i < num_parents; i++)
 303                 parent_names[i] = of_clk_get_parent_name(node, i);
 304
 305         data->num_parents = num_parents;
 306         data->parent_names = parent_names;
 307         data->node = node;
 308         data->gpio_name = gpio_name;
 309         data->clk_register_get = clk_register_get;
 310         mutex_init(&data->lock);
 311
 312         of_clk_add_provider(node, of_clk_gpio_delayed_register_get, data);
 313 }
 314
 315 static void __init of_gpio_gate_clk_setup(struct device_node *node)
 316 {
 317         of_gpio_clk_setup(node, "enable-gpios",
 318                 of_clk_gpio_gate_delayed_register_get);
 319 }
 320 CLK_OF_DECLARE(gpio_gate_clk, "gpio-gate-clock", of_gpio_gate_clk_setup);
 321
 322 void __init of_gpio_mux_clk_setup(struct device_node *node)
 323 {
 324         of_gpio_clk_setup(node, "select-gpios",
 325                 of_clk_gpio_mux_delayed_register_get);
 326 }
 327 CLK_OF_DECLARE(gpio_mux_clk, "gpio-mux-clock", of_gpio_mux_clk_setup);
 328 #endif