| .. | .. |
|---|
| 1 | +// SPDX-License-Identifier: GPL-2.0 |
|---|
| 1 | 2 | /* |
|---|
| 2 | 3 | * Copyright (C) 2011 Sascha Hauer, Pengutronix <s.hauer@pengutronix.de> |
|---|
| 3 | 4 | * Copyright (C) 2011 Richard Zhao, Linaro <richard.zhao@linaro.org> |
|---|
| 4 | 5 | * Copyright (C) 2011-2012 Mike Turquette, Linaro Ltd <mturquette@linaro.org> |
|---|
| 5 | | - * |
|---|
| 6 | | - * This program is free software; you can redistribute it and/or modify |
|---|
| 7 | | - * it under the terms of the GNU General Public License version 2 as |
|---|
| 8 | | - * published by the Free Software Foundation. |
|---|
| 9 | 6 | * |
|---|
| 10 | 7 | * Simple multiplexer clock implementation |
|---|
| 11 | 8 | */ |
|---|
| .. | .. |
|---|
| 25 | 22 | * rate - rate is only affected by parent switching. No clk_set_rate support |
|---|
| 26 | 23 | * parent - parent is adjustable through clk_set_parent |
|---|
| 27 | 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 | +} |
|---|
| 28 | 41 | |
|---|
| 29 | 42 | int clk_mux_val_to_index(struct clk_hw *hw, u32 *table, unsigned int flags, |
|---|
| 30 | 43 | unsigned int val) |
|---|
| .. | .. |
|---|
| 76 | 89 | struct clk_mux *mux = to_clk_mux(hw); |
|---|
| 77 | 90 | u32 val; |
|---|
| 78 | 91 | |
|---|
| 79 | | - val = clk_readl(mux->reg) >> mux->shift; |
|---|
| 92 | + val = clk_mux_readl(mux) >> mux->shift; |
|---|
| 80 | 93 | val &= mux->mask; |
|---|
| 81 | 94 | |
|---|
| 82 | 95 | return clk_mux_val_to_index(hw, mux->table, mux->flags, val); |
|---|
| .. | .. |
|---|
| 97 | 110 | if (mux->flags & CLK_MUX_HIWORD_MASK) { |
|---|
| 98 | 111 | reg = mux->mask << (mux->shift + 16); |
|---|
| 99 | 112 | } else { |
|---|
| 100 | | - reg = clk_readl(mux->reg); |
|---|
| 113 | + reg = clk_mux_readl(mux); |
|---|
| 101 | 114 | reg &= ~(mux->mask << mux->shift); |
|---|
| 102 | 115 | } |
|---|
| 103 | 116 | val = val << mux->shift; |
|---|
| 104 | 117 | reg |= val; |
|---|
| 105 | | - clk_writel(reg, mux->reg); |
|---|
| 118 | + clk_mux_writel(mux, reg); |
|---|
| 106 | 119 | |
|---|
| 107 | 120 | if (mux->lock) |
|---|
| 108 | 121 | spin_unlock_irqrestore(mux->lock, flags); |
|---|
| .. | .. |
|---|
| 132 | 145 | }; |
|---|
| 133 | 146 | EXPORT_SYMBOL_GPL(clk_mux_ro_ops); |
|---|
| 134 | 147 | |
|---|
| 135 | | -struct clk_hw *clk_hw_register_mux_table(struct device *dev, const char *name, |
|---|
| 136 | | - const char * const *parent_names, u8 num_parents, |
|---|
| 137 | | - unsigned long flags, |
|---|
| 138 | | - void __iomem *reg, u8 shift, u32 mask, |
|---|
| 148 | +struct clk_hw *__clk_hw_register_mux(struct device *dev, struct device_node *np, |
|---|
| 149 | + const char *name, u8 num_parents, |
|---|
| 150 | + const char * const *parent_names, |
|---|
| 151 | + const struct clk_hw **parent_hws, |
|---|
| 152 | + const struct clk_parent_data *parent_data, |
|---|
| 153 | + unsigned long flags, void __iomem *reg, u8 shift, u32 mask, |
|---|
| 139 | 154 | u8 clk_mux_flags, u32 *table, spinlock_t *lock) |
|---|
| 140 | 155 | { |
|---|
| 141 | 156 | struct clk_mux *mux; |
|---|
| 142 | 157 | struct clk_hw *hw; |
|---|
| 143 | 158 | struct clk_init_data init = {}; |
|---|
| 144 | 159 | u8 width = 0; |
|---|
| 145 | | - int ret; |
|---|
| 160 | + int ret = -EINVAL; |
|---|
| 146 | 161 | |
|---|
| 147 | 162 | if (clk_mux_flags & CLK_MUX_HIWORD_MASK) { |
|---|
| 148 | 163 | width = fls(mask) - ffs(mask) + 1; |
|---|
| .. | .. |
|---|
| 162 | 177 | init.ops = &clk_mux_ro_ops; |
|---|
| 163 | 178 | else |
|---|
| 164 | 179 | init.ops = &clk_mux_ops; |
|---|
| 165 | | - init.flags = flags | CLK_IS_BASIC; |
|---|
| 180 | + init.flags = flags; |
|---|
| 166 | 181 | init.parent_names = parent_names; |
|---|
| 182 | + init.parent_data = parent_data; |
|---|
| 183 | + init.parent_hws = parent_hws; |
|---|
| 167 | 184 | init.num_parents = num_parents; |
|---|
| 168 | 185 | |
|---|
| 169 | 186 | /* struct clk_mux assignments */ |
|---|
| .. | .. |
|---|
| 176 | 193 | mux->hw.init = &init; |
|---|
| 177 | 194 | |
|---|
| 178 | 195 | hw = &mux->hw; |
|---|
| 179 | | - ret = clk_hw_register(dev, hw); |
|---|
| 196 | + if (dev || !np) |
|---|
| 197 | + ret = clk_hw_register(dev, hw); |
|---|
| 198 | + else if (np) |
|---|
| 199 | + ret = of_clk_hw_register(np, hw); |
|---|
| 180 | 200 | if (ret) { |
|---|
| 181 | 201 | kfree(mux); |
|---|
| 182 | 202 | hw = ERR_PTR(ret); |
|---|
| .. | .. |
|---|
| 184 | 204 | |
|---|
| 185 | 205 | return hw; |
|---|
| 186 | 206 | } |
|---|
| 187 | | -EXPORT_SYMBOL_GPL(clk_hw_register_mux_table); |
|---|
| 207 | +EXPORT_SYMBOL_GPL(__clk_hw_register_mux); |
|---|
| 188 | 208 | |
|---|
| 189 | 209 | struct clk *clk_register_mux_table(struct device *dev, const char *name, |
|---|
| 190 | 210 | const char * const *parent_names, u8 num_parents, |
|---|
| 191 | | - unsigned long flags, |
|---|
| 192 | | - void __iomem *reg, u8 shift, u32 mask, |
|---|
| 211 | + unsigned long flags, void __iomem *reg, u8 shift, u32 mask, |
|---|
| 193 | 212 | u8 clk_mux_flags, u32 *table, spinlock_t *lock) |
|---|
| 194 | 213 | { |
|---|
| 195 | 214 | struct clk_hw *hw; |
|---|
| 196 | 215 | |
|---|
| 197 | | - hw = clk_hw_register_mux_table(dev, name, parent_names, num_parents, |
|---|
| 198 | | - flags, reg, shift, mask, clk_mux_flags, |
|---|
| 199 | | - table, lock); |
|---|
| 216 | + hw = clk_hw_register_mux_table(dev, name, parent_names, |
|---|
| 217 | + num_parents, flags, reg, shift, mask, |
|---|
| 218 | + clk_mux_flags, table, lock); |
|---|
| 200 | 219 | if (IS_ERR(hw)) |
|---|
| 201 | 220 | return ERR_CAST(hw); |
|---|
| 202 | 221 | return hw->clk; |
|---|
| 203 | 222 | } |
|---|
| 204 | 223 | EXPORT_SYMBOL_GPL(clk_register_mux_table); |
|---|
| 205 | | - |
|---|
| 206 | | -struct clk *clk_register_mux(struct device *dev, const char *name, |
|---|
| 207 | | - const char * const *parent_names, u8 num_parents, |
|---|
| 208 | | - unsigned long flags, |
|---|
| 209 | | - void __iomem *reg, u8 shift, u8 width, |
|---|
| 210 | | - u8 clk_mux_flags, spinlock_t *lock) |
|---|
| 211 | | -{ |
|---|
| 212 | | - u32 mask = BIT(width) - 1; |
|---|
| 213 | | - |
|---|
| 214 | | - return clk_register_mux_table(dev, name, parent_names, num_parents, |
|---|
| 215 | | - flags, reg, shift, mask, clk_mux_flags, |
|---|
| 216 | | - NULL, lock); |
|---|
| 217 | | -} |
|---|
| 218 | | -EXPORT_SYMBOL_GPL(clk_register_mux); |
|---|
| 219 | | - |
|---|
| 220 | | -struct clk_hw *clk_hw_register_mux(struct device *dev, const char *name, |
|---|
| 221 | | - const char * const *parent_names, u8 num_parents, |
|---|
| 222 | | - unsigned long flags, |
|---|
| 223 | | - void __iomem *reg, u8 shift, u8 width, |
|---|
| 224 | | - u8 clk_mux_flags, spinlock_t *lock) |
|---|
| 225 | | -{ |
|---|
| 226 | | - u32 mask = BIT(width) - 1; |
|---|
| 227 | | - |
|---|
| 228 | | - return clk_hw_register_mux_table(dev, name, parent_names, num_parents, |
|---|
| 229 | | - flags, reg, shift, mask, clk_mux_flags, |
|---|
| 230 | | - NULL, lock); |
|---|
| 231 | | -} |
|---|
| 232 | | -EXPORT_SYMBOL_GPL(clk_hw_register_mux); |
|---|
| 233 | 224 | |
|---|
| 234 | 225 | void clk_unregister_mux(struct clk *clk) |
|---|
| 235 | 226 | { |
|---|