drivers/clk/clk-mux.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright (C) 2011 Sascha Hauer, Pengutronix <s.hauer@pengutronix.de>
   4  * Copyright (C) 2011 Richard Zhao, Linaro <richard.zhao@linaro.org>
   5  * Copyright (C) 2011-2012 Mike Turquette, Linaro Ltd <mturquette@linaro.org>
   6  *
   7  * Simple multiplexer clock implementation
   8  */
   9
  10 #include <linux/clk-provider.h>
  11 #include <linux/module.h>
  12 #include <linux/slab.h>
  13 #include <linux/io.h>
  14 #include <linux/err.h>
  15
  16 /*
  17  * DOC: basic adjustable multiplexer clock that cannot gate
  18  *
  19  * Traits of this clock:
  20  * prepare - clk_prepare only ensures that parents are prepared
  21  * enable - clk_enable only ensures that parents are enabled
  22  * rate - rate is only affected by parent switching.  No clk_set_rate support
  23  * parent - parent is adjustable through clk_set_parent
  24  */
  25
  26 static inline u32 clk_mux_readl(struct clk_mux *mux)
  27 {
  28         if (mux->flags & CLK_MUX_BIG_ENDIAN)
  29                 return ioread32be(mux->reg);
  30
  31         return readl(mux->reg);
  32 }
  33
  34 static inline void clk_mux_writel(struct clk_mux *mux, u32 val)
  35 {
  36         if (mux->flags & CLK_MUX_BIG_ENDIAN)
  37                 iowrite32be(val, mux->reg);
  38         else
  39                 writel(val, mux->reg);
  40 }
  41
  42 int clk_mux_val_to_index(struct clk_hw *hw, u32 *table, unsigned int flags,
  43                          unsigned int val)
  44 {
  45         int num_parents = clk_hw_get_num_parents(hw);
  46
  47         if (table) {
  48                 int i;
  49
  50                 for (i = 0; i < num_parents; i++)
  51                         if (table[i] == val)
  52                                 return i;
  53                 return -EINVAL;
  54         }
  55
  56         if (val && (flags & CLK_MUX_INDEX_BIT))
  57                 val = ffs(val) - 1;
  58
  59         if (val && (flags & CLK_MUX_INDEX_ONE))
  60                 val--;
  61
  62         if (val >= num_parents)
  63                 return -EINVAL;
  64
  65         return val;
  66 }
  67 EXPORT_SYMBOL_GPL(clk_mux_val_to_index);
  68
  69 unsigned int clk_mux_index_to_val(u32 *table, unsigned int flags, u8 index)
  70 {
  71         unsigned int val = index;
  72
  73         if (table) {
  74                 val = table[index];
  75         } else {
  76                 if (flags & CLK_MUX_INDEX_BIT)
  77                         val = 1 << index;
  78
  79                 if (flags & CLK_MUX_INDEX_ONE)
  80                         val++;
  81         }
  82
  83         return val;
  84 }
  85 EXPORT_SYMBOL_GPL(clk_mux_index_to_val);
  86
  87 static u8 clk_mux_get_parent(struct clk_hw *hw)
  88 {
  89         struct clk_mux *mux = to_clk_mux(hw);
  90         u32 val;
  91
  92         val = clk_mux_readl(mux) >> mux->shift;
  93         val &= mux->mask;
  94
  95         return clk_mux_val_to_index(hw, mux->table, mux->flags, val);
  96 }
  97
  98 static int clk_mux_set_parent(struct clk_hw *hw, u8 index)
  99 {
 100         struct clk_mux *mux = to_clk_mux(hw);
 101         u32 val = clk_mux_index_to_val(mux->table, mux->flags, index);
 102         unsigned long flags = 0;
 103         u32 reg;
 104
 105         if (mux->lock)
 106                 spin_lock_irqsave(mux->lock, flags);
 107         else
 108                 __acquire(mux->lock);
 109
 110         if (mux->flags & CLK_MUX_HIWORD_MASK) {
 111                 reg = mux->mask << (mux->shift + 16);
 112         } else {
 113                 reg = clk_mux_readl(mux);
 114                 reg &= ~(mux->mask << mux->shift);
 115         }
 116         val = val << mux->shift;
 117         reg |= val;
 118         clk_mux_writel(mux, reg);
 119
 120         if (mux->lock)
 121                 spin_unlock_irqrestore(mux->lock, flags);
 122         else
 123                 __release(mux->lock);
 124
 125         return 0;
 126 }
 127
 128 static int clk_mux_determine_rate(struct clk_hw *hw,
 129                                   struct clk_rate_request *req)
 130 {
 131         struct clk_mux *mux = to_clk_mux(hw);
 132
 133         return clk_mux_determine_rate_flags(hw, req, mux->flags);
 134 }
 135
 136 const struct clk_ops clk_mux_ops = {
 137         .get_parent = clk_mux_get_parent,
 138         .set_parent = clk_mux_set_parent,
 139         .determine_rate = clk_mux_determine_rate,
 140 };
 141 EXPORT_SYMBOL_GPL(clk_mux_ops);
 142
 143 const struct clk_ops clk_mux_ro_ops = {
 144         .get_parent = clk_mux_get_parent,
 145 };
 146 EXPORT_SYMBOL_GPL(clk_mux_ro_ops);
 147
 148 struct clk_hw *clk_hw_register_mux_table(struct device *dev, const char *name,
 149                 const char * const *parent_names, u8 num_parents,
 150                 unsigned long flags,
 151                 void __iomem *reg, u8 shift, u32 mask,
 152                 u8 clk_mux_flags, u32 *table, spinlock_t *lock)
 153 {
 154         struct clk_mux *mux;
 155         struct clk_hw *hw;
 156         struct clk_init_data init;
 157         u8 width = 0;
 158         int ret;
 159
 160         if (clk_mux_flags & CLK_MUX_HIWORD_MASK) {
 161                 width = fls(mask) - ffs(mask) + 1;
 162                 if (width + shift > 16) {
 163                         pr_err("mux value exceeds LOWORD field\n");
 164                         return ERR_PTR(-EINVAL);
 165                 }
 166         }
 167
 168         /* allocate the mux */
 169         mux = kzalloc(sizeof(*mux), GFP_KERNEL);
 170         if (!mux)
 171                 return ERR_PTR(-ENOMEM);
 172
 173         init.name = name;
 174         if (clk_mux_flags & CLK_MUX_READ_ONLY)
 175                 init.ops = &clk_mux_ro_ops;
 176         else
 177                 init.ops = &clk_mux_ops;
 178         init.flags = flags;
 179         init.parent_names = parent_names;
 180         init.num_parents = num_parents;
 181
 182         /* struct clk_mux assignments */
 183         mux->reg = reg;
 184         mux->shift = shift;
 185         mux->mask = mask;
 186         mux->flags = clk_mux_flags;
 187         mux->lock = lock;
 188         mux->table = table;
 189         mux->hw.init = &init;
 190
 191         hw = &mux->hw;
 192         ret = clk_hw_register(dev, hw);
 193         if (ret) {
 194                 kfree(mux);
 195                 hw = ERR_PTR(ret);
 196         }
 197
 198         return hw;
 199 }
 200 EXPORT_SYMBOL_GPL(clk_hw_register_mux_table);
 201
 202 struct clk *clk_register_mux_table(struct device *dev, const char *name,
 203                 const char * const *parent_names, u8 num_parents,
 204                 unsigned long flags,
 205                 void __iomem *reg, u8 shift, u32 mask,
 206                 u8 clk_mux_flags, u32 *table, spinlock_t *lock)
 207 {
 208         struct clk_hw *hw;
 209
 210         hw = clk_hw_register_mux_table(dev, name, parent_names, num_parents,
 211                                        flags, reg, shift, mask, clk_mux_flags,
 212                                        table, lock);
 213         if (IS_ERR(hw))
 214                 return ERR_CAST(hw);
 215         return hw->clk;
 216 }
 217 EXPORT_SYMBOL_GPL(clk_register_mux_table);
 218
 219 struct clk *clk_register_mux(struct device *dev, const char *name,
 220                 const char * const *parent_names, u8 num_parents,
 221                 unsigned long flags,
 222                 void __iomem *reg, u8 shift, u8 width,
 223                 u8 clk_mux_flags, spinlock_t *lock)
 224 {
 225         u32 mask = BIT(width) - 1;
 226
 227         return clk_register_mux_table(dev, name, parent_names, num_parents,
 228                                       flags, reg, shift, mask, clk_mux_flags,
 229                                       NULL, lock);
 230 }
 231 EXPORT_SYMBOL_GPL(clk_register_mux);
 232
 233 struct clk_hw *clk_hw_register_mux(struct device *dev, const char *name,
 234                 const char * const *parent_names, u8 num_parents,
 235                 unsigned long flags,
 236                 void __iomem *reg, u8 shift, u8 width,
 237                 u8 clk_mux_flags, spinlock_t *lock)
 238 {
 239         u32 mask = BIT(width) - 1;
 240
 241         return clk_hw_register_mux_table(dev, name, parent_names, num_parents,
 242                                       flags, reg, shift, mask, clk_mux_flags,
 243                                       NULL, lock);
 244 }
 245 EXPORT_SYMBOL_GPL(clk_hw_register_mux);
 246
 247 void clk_unregister_mux(struct clk *clk)
 248 {
 249         struct clk_mux *mux;
 250         struct clk_hw *hw;
 251
 252         hw = __clk_get_hw(clk);
 253         if (!hw)
 254                 return;
 255
 256         mux = to_clk_mux(hw);
 257
 258         clk_unregister(clk);
 259         kfree(mux);
 260 }
 261 EXPORT_SYMBOL_GPL(clk_unregister_mux);
 262
 263 void clk_hw_unregister_mux(struct clk_hw *hw)
 264 {
 265         struct clk_mux *mux;
 266
 267         mux = to_clk_mux(hw);
 268
 269         clk_hw_unregister(hw);
 270         kfree(mux);
 271 }
 272 EXPORT_SYMBOL_GPL(clk_hw_unregister_mux);