add new system file

hc

2024-02-20 102a0743326a03cd1a1202ceda21e175b7d3575c

 kernel/drivers/clk/clk-mux.c
..
..
@@ -1,11 +1,8 @@
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,6 +22,22 @@
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,7 +89,7 @@
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,12 +110,12 @@
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,17 +145,19 @@
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,8 +177,10 @@
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,7 +193,10 @@
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,52 +204,23 @@
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
 {