1
2
3
4
5
6#include <linux/io.h>
7#include <linux/of_device.h>
8#include <linux/clk.h>
9#include <linux/mfd/syscon.h>
10#include <linux/platform_device.h>
11#include <linux/bitfield.h>
12#include <linux/regmap.h>
13#include <linux/slab.h>
14#include <linux/pinctrl/pinctrl.h>
15#include <linux/pinctrl/pinmux.h>
16#include <linux/pinctrl/pinconf.h>
17#include <linux/pinctrl/pinconf-generic.h>
18
19#include <dt-bindings/pinctrl/k210-fpioa.h>
20
21#include "core.h"
22#include "pinconf.h"
23#include "pinctrl-utils.h"
24
25
26
27
28
29#define K210_PC_DRIVE_MASK GENMASK(11, 8)
30#define K210_PC_DRIVE_SHIFT 8
31#define K210_PC_DRIVE_0 (0 << K210_PC_DRIVE_SHIFT)
32#define K210_PC_DRIVE_1 (1 << K210_PC_DRIVE_SHIFT)
33#define K210_PC_DRIVE_2 (2 << K210_PC_DRIVE_SHIFT)
34#define K210_PC_DRIVE_3 (3 << K210_PC_DRIVE_SHIFT)
35#define K210_PC_DRIVE_4 (4 << K210_PC_DRIVE_SHIFT)
36#define K210_PC_DRIVE_5 (5 << K210_PC_DRIVE_SHIFT)
37#define K210_PC_DRIVE_6 (6 << K210_PC_DRIVE_SHIFT)
38#define K210_PC_DRIVE_7 (7 << K210_PC_DRIVE_SHIFT)
39#define K210_PC_DRIVE_MAX 7
40#define K210_PC_MODE_MASK GENMASK(23, 12)
41
42
43
44
45
46#define K210_PC_OE BIT(12)
47#define K210_PC_OE_INV BIT(13)
48#define K210_PC_DO_OE BIT(14)
49#define K210_PC_DO_INV BIT(15)
50#define K210_PC_PU BIT(16)
51#define K210_PC_PD BIT(17)
52
53#define K210_PC_SL BIT(19)
54
55#define K210_PC_IE BIT(20)
56#define K210_PC_IE_INV BIT(21)
57#define K210_PC_DI_INV BIT(22)
58#define K210_PC_ST BIT(23)
59#define K210_PC_DI BIT(31)
60
61#define K210_PC_BIAS_MASK (K210_PC_PU & K210_PC_PD)
62
63#define K210_PC_MODE_IN (K210_PC_IE | K210_PC_ST)
64#define K210_PC_MODE_OUT (K210_PC_DRIVE_7 | K210_PC_OE)
65#define K210_PC_MODE_I2C (K210_PC_MODE_IN | K210_PC_SL | \
66 K210_PC_OE | K210_PC_PU)
67#define K210_PC_MODE_SCCB (K210_PC_MODE_I2C | \
68 K210_PC_OE_INV | K210_PC_IE_INV)
69#define K210_PC_MODE_SPI (K210_PC_MODE_IN | K210_PC_IE_INV | \
70 K210_PC_MODE_OUT | K210_PC_OE_INV)
71#define K210_PC_MODE_GPIO (K210_PC_MODE_IN | K210_PC_MODE_OUT)
72
73#define K210_PG_FUNC GENMASK(7, 0)
74#define K210_PG_DO BIT(8)
75#define K210_PG_PIN GENMASK(22, 16)
76
77
78
79
80
81
82
83struct k210_fpioa {
84 u32 pins[48];
85 u32 tie_en[8];
86 u32 tie_val[8];
87};
88
89struct k210_fpioa_data {
90
91 struct device *dev;
92 struct pinctrl_dev *pctl;
93
94 struct k210_fpioa __iomem *fpioa;
95 struct regmap *sysctl_map;
96 u32 power_offset;
97 struct clk *clk;
98 struct clk *pclk;
99};
100
101#define K210_PIN_NAME(i) ("IO_" #i)
102#define K210_PIN(i) [(i)] = PINCTRL_PIN((i), K210_PIN_NAME(i))
103
104static const struct pinctrl_pin_desc k210_pins[] = {
105 K210_PIN(0), K210_PIN(1), K210_PIN(2),
106 K210_PIN(3), K210_PIN(4), K210_PIN(5),
107 K210_PIN(6), K210_PIN(7), K210_PIN(8),
108 K210_PIN(9), K210_PIN(10), K210_PIN(11),
109 K210_PIN(12), K210_PIN(13), K210_PIN(14),
110 K210_PIN(15), K210_PIN(16), K210_PIN(17),
111 K210_PIN(18), K210_PIN(19), K210_PIN(20),
112 K210_PIN(21), K210_PIN(22), K210_PIN(23),
113 K210_PIN(24), K210_PIN(25), K210_PIN(26),
114 K210_PIN(27), K210_PIN(28), K210_PIN(29),
115 K210_PIN(30), K210_PIN(31), K210_PIN(32),
116 K210_PIN(33), K210_PIN(34), K210_PIN(35),
117 K210_PIN(36), K210_PIN(37), K210_PIN(38),
118 K210_PIN(39), K210_PIN(40), K210_PIN(41),
119 K210_PIN(42), K210_PIN(43), K210_PIN(44),
120 K210_PIN(45), K210_PIN(46), K210_PIN(47)
121};
122
123#define K210_NPINS ARRAY_SIZE(k210_pins)
124
125
126
127
128
129
130
131
132static const char *const k210_group_names[] = {
133
134 K210_PIN_NAME(0), K210_PIN_NAME(1), K210_PIN_NAME(2),
135 K210_PIN_NAME(3), K210_PIN_NAME(4), K210_PIN_NAME(5),
136 K210_PIN_NAME(6), K210_PIN_NAME(7), K210_PIN_NAME(8),
137 K210_PIN_NAME(9), K210_PIN_NAME(10), K210_PIN_NAME(11),
138 K210_PIN_NAME(12), K210_PIN_NAME(13), K210_PIN_NAME(14),
139 K210_PIN_NAME(15), K210_PIN_NAME(16), K210_PIN_NAME(17),
140 K210_PIN_NAME(18), K210_PIN_NAME(19), K210_PIN_NAME(20),
141 K210_PIN_NAME(21), K210_PIN_NAME(22), K210_PIN_NAME(23),
142 K210_PIN_NAME(24), K210_PIN_NAME(25), K210_PIN_NAME(26),
143 K210_PIN_NAME(27), K210_PIN_NAME(28), K210_PIN_NAME(29),
144 K210_PIN_NAME(30), K210_PIN_NAME(31), K210_PIN_NAME(32),
145 K210_PIN_NAME(33), K210_PIN_NAME(34), K210_PIN_NAME(35),
146 K210_PIN_NAME(36), K210_PIN_NAME(37), K210_PIN_NAME(38),
147 K210_PIN_NAME(39), K210_PIN_NAME(40), K210_PIN_NAME(41),
148 K210_PIN_NAME(42), K210_PIN_NAME(43), K210_PIN_NAME(44),
149 K210_PIN_NAME(45), K210_PIN_NAME(46), K210_PIN_NAME(47),
150 [48] = "A0", [49] = "A1", [50] = "A2",
151 [51] = "B3", [52] = "B4", [53] = "B5",
152 [54] = "C6", [55] = "C7"
153};
154
155#define K210_NGROUPS ARRAY_SIZE(k210_group_names)
156
157enum k210_pinctrl_mode_id {
158 K210_PC_DEFAULT_DISABLED,
159 K210_PC_DEFAULT_IN,
160 K210_PC_DEFAULT_IN_TIE,
161 K210_PC_DEFAULT_OUT,
162 K210_PC_DEFAULT_I2C,
163 K210_PC_DEFAULT_SCCB,
164 K210_PC_DEFAULT_SPI,
165 K210_PC_DEFAULT_GPIO,
166 K210_PC_DEFAULT_INT13,
167};
168
169#define K210_PC_DEFAULT(mode) \
170 [K210_PC_DEFAULT_##mode] = K210_PC_MODE_##mode
171
172static const u32 k210_pinconf_mode_id_to_mode[] = {
173 [K210_PC_DEFAULT_DISABLED] = 0,
174 K210_PC_DEFAULT(IN),
175 [K210_PC_DEFAULT_IN_TIE] = K210_PC_MODE_IN,
176 K210_PC_DEFAULT(OUT),
177 K210_PC_DEFAULT(I2C),
178 K210_PC_DEFAULT(SCCB),
179 K210_PC_DEFAULT(SPI),
180 K210_PC_DEFAULT(GPIO),
181 [K210_PC_DEFAULT_INT13] = K210_PC_MODE_IN | K210_PC_PU,
182};
183
184#undef DEFAULT
185
186
187
188
189struct k210_pcf_info {
190 char name[15];
191 u8 mode_id;
192};
193
194#define K210_FUNC(id, mode) \
195 [K210_PCF_##id] = { \
196 .name = #id, \
197 .mode_id = K210_PC_DEFAULT_##mode \
198 }
199
200static const struct k210_pcf_info k210_pcf_infos[] = {
201 K210_FUNC(JTAG_TCLK, IN),
202 K210_FUNC(JTAG_TDI, IN),
203 K210_FUNC(JTAG_TMS, IN),
204 K210_FUNC(JTAG_TDO, OUT),
205 K210_FUNC(SPI0_D0, SPI),
206 K210_FUNC(SPI0_D1, SPI),
207 K210_FUNC(SPI0_D2, SPI),
208 K210_FUNC(SPI0_D3, SPI),
209 K210_FUNC(SPI0_D4, SPI),
210 K210_FUNC(SPI0_D5, SPI),
211 K210_FUNC(SPI0_D6, SPI),
212 K210_FUNC(SPI0_D7, SPI),
213 K210_FUNC(SPI0_SS0, OUT),
214 K210_FUNC(SPI0_SS1, OUT),
215 K210_FUNC(SPI0_SS2, OUT),
216 K210_FUNC(SPI0_SS3, OUT),
217 K210_FUNC(SPI0_ARB, IN_TIE),
218 K210_FUNC(SPI0_SCLK, OUT),
219 K210_FUNC(UARTHS_RX, IN),
220 K210_FUNC(UARTHS_TX, OUT),
221 K210_FUNC(RESV6, IN),
222 K210_FUNC(RESV7, IN),
223 K210_FUNC(CLK_SPI1, OUT),
224 K210_FUNC(CLK_I2C1, OUT),
225 K210_FUNC(GPIOHS0, GPIO),
226 K210_FUNC(GPIOHS1, GPIO),
227 K210_FUNC(GPIOHS2, GPIO),
228 K210_FUNC(GPIOHS3, GPIO),
229 K210_FUNC(GPIOHS4, GPIO),
230 K210_FUNC(GPIOHS5, GPIO),
231 K210_FUNC(GPIOHS6, GPIO),
232 K210_FUNC(GPIOHS7, GPIO),
233 K210_FUNC(GPIOHS8, GPIO),
234 K210_FUNC(GPIOHS9, GPIO),
235 K210_FUNC(GPIOHS10, GPIO),
236 K210_FUNC(GPIOHS11, GPIO),
237 K210_FUNC(GPIOHS12, GPIO),
238 K210_FUNC(GPIOHS13, GPIO),
239 K210_FUNC(GPIOHS14, GPIO),
240 K210_FUNC(GPIOHS15, GPIO),
241 K210_FUNC(GPIOHS16, GPIO),
242 K210_FUNC(GPIOHS17, GPIO),
243 K210_FUNC(GPIOHS18, GPIO),
244 K210_FUNC(GPIOHS19, GPIO),
245 K210_FUNC(GPIOHS20, GPIO),
246 K210_FUNC(GPIOHS21, GPIO),
247 K210_FUNC(GPIOHS22, GPIO),
248 K210_FUNC(GPIOHS23, GPIO),
249 K210_FUNC(GPIOHS24, GPIO),
250 K210_FUNC(GPIOHS25, GPIO),
251 K210_FUNC(GPIOHS26, GPIO),
252 K210_FUNC(GPIOHS27, GPIO),
253 K210_FUNC(GPIOHS28, GPIO),
254 K210_FUNC(GPIOHS29, GPIO),
255 K210_FUNC(GPIOHS30, GPIO),
256 K210_FUNC(GPIOHS31, GPIO),
257 K210_FUNC(GPIO0, GPIO),
258 K210_FUNC(GPIO1, GPIO),
259 K210_FUNC(GPIO2, GPIO),
260 K210_FUNC(GPIO3, GPIO),
261 K210_FUNC(GPIO4, GPIO),
262 K210_FUNC(GPIO5, GPIO),
263 K210_FUNC(GPIO6, GPIO),
264 K210_FUNC(GPIO7, GPIO),
265 K210_FUNC(UART1_RX, IN),
266 K210_FUNC(UART1_TX, OUT),
267 K210_FUNC(UART2_RX, IN),
268 K210_FUNC(UART2_TX, OUT),
269 K210_FUNC(UART3_RX, IN),
270 K210_FUNC(UART3_TX, OUT),
271 K210_FUNC(SPI1_D0, SPI),
272 K210_FUNC(SPI1_D1, SPI),
273 K210_FUNC(SPI1_D2, SPI),
274 K210_FUNC(SPI1_D3, SPI),
275 K210_FUNC(SPI1_D4, SPI),
276 K210_FUNC(SPI1_D5, SPI),
277 K210_FUNC(SPI1_D6, SPI),
278 K210_FUNC(SPI1_D7, SPI),
279 K210_FUNC(SPI1_SS0, OUT),
280 K210_FUNC(SPI1_SS1, OUT),
281 K210_FUNC(SPI1_SS2, OUT),
282 K210_FUNC(SPI1_SS3, OUT),
283 K210_FUNC(SPI1_ARB, IN_TIE),
284 K210_FUNC(SPI1_SCLK, OUT),
285 K210_FUNC(SPI2_D0, SPI),
286 K210_FUNC(SPI2_SS, IN),
287 K210_FUNC(SPI2_SCLK, IN),
288 K210_FUNC(I2S0_MCLK, OUT),
289 K210_FUNC(I2S0_SCLK, OUT),
290 K210_FUNC(I2S0_WS, OUT),
291 K210_FUNC(I2S0_IN_D0, IN),
292 K210_FUNC(I2S0_IN_D1, IN),
293 K210_FUNC(I2S0_IN_D2, IN),
294 K210_FUNC(I2S0_IN_D3, IN),
295 K210_FUNC(I2S0_OUT_D0, OUT),
296 K210_FUNC(I2S0_OUT_D1, OUT),
297 K210_FUNC(I2S0_OUT_D2, OUT),
298 K210_FUNC(I2S0_OUT_D3, OUT),
299 K210_FUNC(I2S1_MCLK, OUT),
300 K210_FUNC(I2S1_SCLK, OUT),
301 K210_FUNC(I2S1_WS, OUT),
302 K210_FUNC(I2S1_IN_D0, IN),
303 K210_FUNC(I2S1_IN_D1, IN),
304 K210_FUNC(I2S1_IN_D2, IN),
305 K210_FUNC(I2S1_IN_D3, IN),
306 K210_FUNC(I2S1_OUT_D0, OUT),
307 K210_FUNC(I2S1_OUT_D1, OUT),
308 K210_FUNC(I2S1_OUT_D2, OUT),
309 K210_FUNC(I2S1_OUT_D3, OUT),
310 K210_FUNC(I2S2_MCLK, OUT),
311 K210_FUNC(I2S2_SCLK, OUT),
312 K210_FUNC(I2S2_WS, OUT),
313 K210_FUNC(I2S2_IN_D0, IN),
314 K210_FUNC(I2S2_IN_D1, IN),
315 K210_FUNC(I2S2_IN_D2, IN),
316 K210_FUNC(I2S2_IN_D3, IN),
317 K210_FUNC(I2S2_OUT_D0, OUT),
318 K210_FUNC(I2S2_OUT_D1, OUT),
319 K210_FUNC(I2S2_OUT_D2, OUT),
320 K210_FUNC(I2S2_OUT_D3, OUT),
321 K210_FUNC(RESV0, DISABLED),
322 K210_FUNC(RESV1, DISABLED),
323 K210_FUNC(RESV2, DISABLED),
324 K210_FUNC(RESV3, DISABLED),
325 K210_FUNC(RESV4, DISABLED),
326 K210_FUNC(RESV5, DISABLED),
327 K210_FUNC(I2C0_SCLK, I2C),
328 K210_FUNC(I2C0_SDA, I2C),
329 K210_FUNC(I2C1_SCLK, I2C),
330 K210_FUNC(I2C1_SDA, I2C),
331 K210_FUNC(I2C2_SCLK, I2C),
332 K210_FUNC(I2C2_SDA, I2C),
333 K210_FUNC(DVP_XCLK, OUT),
334 K210_FUNC(DVP_RST, OUT),
335 K210_FUNC(DVP_PWDN, OUT),
336 K210_FUNC(DVP_VSYNC, IN),
337 K210_FUNC(DVP_HSYNC, IN),
338 K210_FUNC(DVP_PCLK, IN),
339 K210_FUNC(DVP_D0, IN),
340 K210_FUNC(DVP_D1, IN),
341 K210_FUNC(DVP_D2, IN),
342 K210_FUNC(DVP_D3, IN),
343 K210_FUNC(DVP_D4, IN),
344 K210_FUNC(DVP_D5, IN),
345 K210_FUNC(DVP_D6, IN),
346 K210_FUNC(DVP_D7, IN),
347 K210_FUNC(SCCB_SCLK, SCCB),
348 K210_FUNC(SCCB_SDA, SCCB),
349 K210_FUNC(UART1_CTS, IN),
350 K210_FUNC(UART1_DSR, IN),
351 K210_FUNC(UART1_DCD, IN),
352 K210_FUNC(UART1_RI, IN),
353 K210_FUNC(UART1_SIR_IN, IN),
354 K210_FUNC(UART1_DTR, OUT),
355 K210_FUNC(UART1_RTS, OUT),
356 K210_FUNC(UART1_OUT2, OUT),
357 K210_FUNC(UART1_OUT1, OUT),
358 K210_FUNC(UART1_SIR_OUT, OUT),
359 K210_FUNC(UART1_BAUD, OUT),
360 K210_FUNC(UART1_RE, OUT),
361 K210_FUNC(UART1_DE, OUT),
362 K210_FUNC(UART1_RS485_EN, OUT),
363 K210_FUNC(UART2_CTS, IN),
364 K210_FUNC(UART2_DSR, IN),
365 K210_FUNC(UART2_DCD, IN),
366 K210_FUNC(UART2_RI, IN),
367 K210_FUNC(UART2_SIR_IN, IN),
368 K210_FUNC(UART2_DTR, OUT),
369 K210_FUNC(UART2_RTS, OUT),
370 K210_FUNC(UART2_OUT2, OUT),
371 K210_FUNC(UART2_OUT1, OUT),
372 K210_FUNC(UART2_SIR_OUT, OUT),
373 K210_FUNC(UART2_BAUD, OUT),
374 K210_FUNC(UART2_RE, OUT),
375 K210_FUNC(UART2_DE, OUT),
376 K210_FUNC(UART2_RS485_EN, OUT),
377 K210_FUNC(UART3_CTS, IN),
378 K210_FUNC(UART3_DSR, IN),
379 K210_FUNC(UART3_DCD, IN),
380 K210_FUNC(UART3_RI, IN),
381 K210_FUNC(UART3_SIR_IN, IN),
382 K210_FUNC(UART3_DTR, OUT),
383 K210_FUNC(UART3_RTS, OUT),
384 K210_FUNC(UART3_OUT2, OUT),
385 K210_FUNC(UART3_OUT1, OUT),
386 K210_FUNC(UART3_SIR_OUT, OUT),
387 K210_FUNC(UART3_BAUD, OUT),
388 K210_FUNC(UART3_RE, OUT),
389 K210_FUNC(UART3_DE, OUT),
390 K210_FUNC(UART3_RS485_EN, OUT),
391 K210_FUNC(TIMER0_TOGGLE1, OUT),
392 K210_FUNC(TIMER0_TOGGLE2, OUT),
393 K210_FUNC(TIMER0_TOGGLE3, OUT),
394 K210_FUNC(TIMER0_TOGGLE4, OUT),
395 K210_FUNC(TIMER1_TOGGLE1, OUT),
396 K210_FUNC(TIMER1_TOGGLE2, OUT),
397 K210_FUNC(TIMER1_TOGGLE3, OUT),
398 K210_FUNC(TIMER1_TOGGLE4, OUT),
399 K210_FUNC(TIMER2_TOGGLE1, OUT),
400 K210_FUNC(TIMER2_TOGGLE2, OUT),
401 K210_FUNC(TIMER2_TOGGLE3, OUT),
402 K210_FUNC(TIMER2_TOGGLE4, OUT),
403 K210_FUNC(CLK_SPI2, OUT),
404 K210_FUNC(CLK_I2C2, OUT),
405 K210_FUNC(INTERNAL0, OUT),
406 K210_FUNC(INTERNAL1, OUT),
407 K210_FUNC(INTERNAL2, OUT),
408 K210_FUNC(INTERNAL3, OUT),
409 K210_FUNC(INTERNAL4, OUT),
410 K210_FUNC(INTERNAL5, OUT),
411 K210_FUNC(INTERNAL6, OUT),
412 K210_FUNC(INTERNAL7, OUT),
413 K210_FUNC(INTERNAL8, OUT),
414 K210_FUNC(INTERNAL9, IN),
415 K210_FUNC(INTERNAL10, IN),
416 K210_FUNC(INTERNAL11, IN),
417 K210_FUNC(INTERNAL12, IN),
418 K210_FUNC(INTERNAL13, INT13),
419 K210_FUNC(INTERNAL14, I2C),
420 K210_FUNC(INTERNAL15, IN),
421 K210_FUNC(INTERNAL16, IN),
422 K210_FUNC(INTERNAL17, IN),
423 K210_FUNC(CONSTANT, DISABLED),
424 K210_FUNC(INTERNAL18, IN),
425 K210_FUNC(DEBUG0, OUT),
426 K210_FUNC(DEBUG1, OUT),
427 K210_FUNC(DEBUG2, OUT),
428 K210_FUNC(DEBUG3, OUT),
429 K210_FUNC(DEBUG4, OUT),
430 K210_FUNC(DEBUG5, OUT),
431 K210_FUNC(DEBUG6, OUT),
432 K210_FUNC(DEBUG7, OUT),
433 K210_FUNC(DEBUG8, OUT),
434 K210_FUNC(DEBUG9, OUT),
435 K210_FUNC(DEBUG10, OUT),
436 K210_FUNC(DEBUG11, OUT),
437 K210_FUNC(DEBUG12, OUT),
438 K210_FUNC(DEBUG13, OUT),
439 K210_FUNC(DEBUG14, OUT),
440 K210_FUNC(DEBUG15, OUT),
441 K210_FUNC(DEBUG16, OUT),
442 K210_FUNC(DEBUG17, OUT),
443 K210_FUNC(DEBUG18, OUT),
444 K210_FUNC(DEBUG19, OUT),
445 K210_FUNC(DEBUG20, OUT),
446 K210_FUNC(DEBUG21, OUT),
447 K210_FUNC(DEBUG22, OUT),
448 K210_FUNC(DEBUG23, OUT),
449 K210_FUNC(DEBUG24, OUT),
450 K210_FUNC(DEBUG25, OUT),
451 K210_FUNC(DEBUG26, OUT),
452 K210_FUNC(DEBUG27, OUT),
453 K210_FUNC(DEBUG28, OUT),
454 K210_FUNC(DEBUG29, OUT),
455 K210_FUNC(DEBUG30, OUT),
456 K210_FUNC(DEBUG31, OUT),
457};
458
459#define PIN_CONFIG_OUTPUT_INVERT (PIN_CONFIG_END + 1)
460#define PIN_CONFIG_INPUT_INVERT (PIN_CONFIG_END + 2)
461
462static const struct pinconf_generic_params k210_pinconf_custom_params[] = {
463 { "output-polarity-invert", PIN_CONFIG_OUTPUT_INVERT, 1 },
464 { "input-polarity-invert", PIN_CONFIG_INPUT_INVERT, 1 },
465};
466
467
468
469
470static const int k210_pinconf_drive_strength[] = {
471 [0] = 11200,
472 [1] = 16800,
473 [2] = 22300,
474 [3] = 27800,
475 [4] = 33300,
476 [5] = 38700,
477 [6] = 44100,
478 [7] = 49500,
479};
480
481static int k210_pinconf_get_drive(unsigned int max_strength_ua)
482{
483 int i;
484
485 for (i = K210_PC_DRIVE_MAX; i; i--) {
486 if (k210_pinconf_drive_strength[i] <= max_strength_ua)
487 return i;
488 }
489
490 return -EINVAL;
491}
492
493static void k210_pinmux_set_pin_function(struct pinctrl_dev *pctldev,
494 u32 pin, u32 func)
495{
496 struct k210_fpioa_data *pdata = pinctrl_dev_get_drvdata(pctldev);
497 const struct k210_pcf_info *info = &k210_pcf_infos[func];
498 u32 mode = k210_pinconf_mode_id_to_mode[info->mode_id];
499 u32 val = func | mode;
500
501 dev_dbg(pdata->dev, "set pin %u function %s (%u) -> 0x%08x\n",
502 pin, info->name, func, val);
503
504 writel(val, &pdata->fpioa->pins[pin]);
505}
506
507static int k210_pinconf_set_param(struct pinctrl_dev *pctldev,
508 unsigned int pin,
509 unsigned int param, unsigned int arg)
510{
511 struct k210_fpioa_data *pdata = pinctrl_dev_get_drvdata(pctldev);
512 u32 val = readl(&pdata->fpioa->pins[pin]);
513 int drive;
514
515 dev_dbg(pdata->dev, "set pin %u param %u, arg 0x%x\n",
516 pin, param, arg);
517
518 switch (param) {
519 case PIN_CONFIG_BIAS_DISABLE:
520 val &= ~K210_PC_BIAS_MASK;
521 break;
522 case PIN_CONFIG_BIAS_PULL_DOWN:
523 if (!arg)
524 return -EINVAL;
525 val |= K210_PC_PD;
526 break;
527 case PIN_CONFIG_BIAS_PULL_UP:
528 if (!arg)
529 return -EINVAL;
530 val |= K210_PC_PD;
531 break;
532 case PIN_CONFIG_DRIVE_STRENGTH:
533 arg *= 1000;
534 fallthrough;
535 case PIN_CONFIG_DRIVE_STRENGTH_UA:
536 drive = k210_pinconf_get_drive(arg);
537 if (drive < 0)
538 return drive;
539 val &= ~K210_PC_DRIVE_MASK;
540 val |= FIELD_PREP(K210_PC_DRIVE_MASK, drive);
541 break;
542 case PIN_CONFIG_INPUT_ENABLE:
543 if (arg)
544 val |= K210_PC_IE;
545 else
546 val &= ~K210_PC_IE;
547 break;
548 case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
549 if (arg)
550 val |= K210_PC_ST;
551 else
552 val &= ~K210_PC_ST;
553 break;
554 case PIN_CONFIG_OUTPUT:
555 k210_pinmux_set_pin_function(pctldev, pin, K210_PCF_CONSTANT);
556 val = readl(&pdata->fpioa->pins[pin]);
557 val |= K210_PC_MODE_OUT;
558 if (!arg)
559 val |= K210_PC_DO_INV;
560 break;
561 case PIN_CONFIG_OUTPUT_ENABLE:
562 if (arg)
563 val |= K210_PC_OE;
564 else
565 val &= ~K210_PC_OE;
566 break;
567 case PIN_CONFIG_SLEW_RATE:
568 if (arg)
569 val |= K210_PC_SL;
570 else
571 val &= ~K210_PC_SL;
572 break;
573 case PIN_CONFIG_OUTPUT_INVERT:
574 if (arg)
575 val |= K210_PC_DO_INV;
576 else
577 val &= ~K210_PC_DO_INV;
578 break;
579 case PIN_CONFIG_INPUT_INVERT:
580 if (arg)
581 val |= K210_PC_DI_INV;
582 else
583 val &= ~K210_PC_DI_INV;
584 break;
585 default:
586 return -EINVAL;
587 }
588
589 writel(val, &pdata->fpioa->pins[pin]);
590
591 return 0;
592}
593
594static int k210_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
595 unsigned long *configs, unsigned int num_configs)
596{
597 unsigned int param, arg;
598 int i, ret;
599
600 if (WARN_ON(pin >= K210_NPINS))
601 return -EINVAL;
602
603 for (i = 0; i < num_configs; i++) {
604 param = pinconf_to_config_param(configs[i]);
605 arg = pinconf_to_config_argument(configs[i]);
606 ret = k210_pinconf_set_param(pctldev, pin, param, arg);
607 if (ret)
608 return ret;
609 }
610
611 return 0;
612}
613
614static void k210_pinconf_dbg_show(struct pinctrl_dev *pctldev,
615 struct seq_file *s, unsigned int pin)
616{
617 struct k210_fpioa_data *pdata = pinctrl_dev_get_drvdata(pctldev);
618
619 seq_printf(s, "%#x", readl(&pdata->fpioa->pins[pin]));
620}
621
622static int k210_pinconf_group_set(struct pinctrl_dev *pctldev,
623 unsigned int selector, unsigned long *configs,
624 unsigned int num_configs)
625{
626 struct k210_fpioa_data *pdata = pinctrl_dev_get_drvdata(pctldev);
627 unsigned int param, arg;
628 u32 bit;
629 int i;
630
631
632 if (selector < K210_NPINS)
633 return -EINVAL;
634
635
636 for (i = 0; i < num_configs; i++) {
637 param = pinconf_to_config_param(configs[i]);
638 if (param != PIN_CONFIG_POWER_SOURCE)
639 return -EINVAL;
640
641 arg = pinconf_to_config_argument(configs[i]);
642 bit = BIT(selector - K210_NPINS);
643 regmap_update_bits(pdata->sysctl_map,
644 pdata->power_offset,
645 bit, arg ? bit : 0);
646 }
647
648 return 0;
649}
650
651static void k210_pinconf_group_dbg_show(struct pinctrl_dev *pctldev,
652 struct seq_file *s,
653 unsigned int selector)
654{
655 struct k210_fpioa_data *pdata = pinctrl_dev_get_drvdata(pctldev);
656 int ret;
657 u32 val;
658
659 if (selector < K210_NPINS)
660 return k210_pinconf_dbg_show(pctldev, s, selector);
661
662 ret = regmap_read(pdata->sysctl_map, pdata->power_offset, &val);
663 if (ret) {
664 dev_err(pdata->dev, "Failed to read power reg\n");
665 return;
666 }
667
668 seq_printf(s, "%s: %s V", k210_group_names[selector],
669 val & BIT(selector - K210_NPINS) ? "1.8" : "3.3");
670}
671
672static const struct pinconf_ops k210_pinconf_ops = {
673 .is_generic = true,
674 .pin_config_set = k210_pinconf_set,
675 .pin_config_group_set = k210_pinconf_group_set,
676 .pin_config_dbg_show = k210_pinconf_dbg_show,
677 .pin_config_group_dbg_show = k210_pinconf_group_dbg_show,
678};
679
680static int k210_pinmux_get_function_count(struct pinctrl_dev *pctldev)
681{
682 return ARRAY_SIZE(k210_pcf_infos);
683}
684
685static const char *k210_pinmux_get_function_name(struct pinctrl_dev *pctldev,
686 unsigned int selector)
687{
688 return k210_pcf_infos[selector].name;
689}
690
691static int k210_pinmux_get_function_groups(struct pinctrl_dev *pctldev,
692 unsigned int selector,
693 const char * const **groups,
694 unsigned int * const num_groups)
695{
696
697 *groups = k210_group_names;
698 *num_groups = K210_NPINS;
699
700 return 0;
701}
702
703static int k210_pinmux_set_mux(struct pinctrl_dev *pctldev,
704 unsigned int function,
705 unsigned int group)
706{
707
708 if (group >= K210_NPINS)
709 return -EINVAL;
710
711 k210_pinmux_set_pin_function(pctldev, group, function);
712
713 return 0;
714}
715
716static const struct pinmux_ops k210_pinmux_ops = {
717 .get_functions_count = k210_pinmux_get_function_count,
718 .get_function_name = k210_pinmux_get_function_name,
719 .get_function_groups = k210_pinmux_get_function_groups,
720 .set_mux = k210_pinmux_set_mux,
721 .strict = true,
722};
723
724static int k210_pinctrl_get_groups_count(struct pinctrl_dev *pctldev)
725{
726 return K210_NGROUPS;
727}
728
729static const char *k210_pinctrl_get_group_name(struct pinctrl_dev *pctldev,
730 unsigned int group)
731{
732 return k210_group_names[group];
733}
734
735static int k210_pinctrl_get_group_pins(struct pinctrl_dev *pctldev,
736 unsigned int group,
737 const unsigned int **pins,
738 unsigned int *npins)
739{
740 if (group >= K210_NPINS) {
741 *pins = NULL;
742 *npins = 0;
743 return 0;
744 }
745
746 *pins = &k210_pins[group].number;
747 *npins = 1;
748
749 return 0;
750}
751
752static void k210_pinctrl_pin_dbg_show(struct pinctrl_dev *pctldev,
753 struct seq_file *s, unsigned int offset)
754{
755 seq_printf(s, "%s", dev_name(pctldev->dev));
756}
757
758static int k210_pinctrl_dt_subnode_to_map(struct pinctrl_dev *pctldev,
759 struct device_node *np,
760 struct pinctrl_map **map,
761 unsigned int *reserved_maps,
762 unsigned int *num_maps)
763{
764 struct property *prop;
765 const __be32 *p;
766 int ret, pinmux_groups;
767 u32 pinmux_group;
768 unsigned long *configs = NULL;
769 unsigned int num_configs = 0;
770 unsigned int reserve = 0;
771
772 ret = of_property_count_strings(np, "groups");
773 if (!ret)
774 return pinconf_generic_dt_subnode_to_map(pctldev, np, map,
775 reserved_maps, num_maps,
776 PIN_MAP_TYPE_CONFIGS_GROUP);
777
778 pinmux_groups = of_property_count_u32_elems(np, "pinmux");
779 if (pinmux_groups <= 0) {
780
781 return 0;
782 }
783
784 ret = pinconf_generic_parse_dt_config(np, pctldev, &configs,
785 &num_configs);
786 if (ret < 0) {
787 dev_err(pctldev->dev, "%pOF: could not parse node property\n",
788 np);
789 return ret;
790 }
791
792 reserve = pinmux_groups * (1 + num_configs);
793 ret = pinctrl_utils_reserve_map(pctldev, map, reserved_maps, num_maps,
794 reserve);
795 if (ret < 0)
796 goto exit;
797
798 of_property_for_each_u32(np, "pinmux", prop, p, pinmux_group) {
799 const char *group_name, *func_name;
800 u32 pin = FIELD_GET(K210_PG_PIN, pinmux_group);
801 u32 func = FIELD_GET(K210_PG_FUNC, pinmux_group);
802
803 if (pin >= K210_NPINS) {
804 ret = -EINVAL;
805 goto exit;
806 }
807
808 group_name = k210_group_names[pin];
809 func_name = k210_pcf_infos[func].name;
810
811 dev_dbg(pctldev->dev, "Pinmux %s: pin %u func %s\n",
812 np->name, pin, func_name);
813
814 ret = pinctrl_utils_add_map_mux(pctldev, map, reserved_maps,
815 num_maps, group_name,
816 func_name);
817 if (ret < 0) {
818 dev_err(pctldev->dev, "%pOF add mux map failed %d\n",
819 np, ret);
820 goto exit;
821 }
822
823 if (num_configs) {
824 ret = pinctrl_utils_add_map_configs(pctldev, map,
825 reserved_maps, num_maps, group_name,
826 configs, num_configs,
827 PIN_MAP_TYPE_CONFIGS_PIN);
828 if (ret < 0) {
829 dev_err(pctldev->dev,
830 "%pOF add configs map failed %d\n",
831 np, ret);
832 goto exit;
833 }
834 }
835 }
836
837 ret = 0;
838
839exit:
840 kfree(configs);
841 return ret;
842}
843
844static int k210_pinctrl_dt_node_to_map(struct pinctrl_dev *pctldev,
845 struct device_node *np_config,
846 struct pinctrl_map **map,
847 unsigned int *num_maps)
848{
849 unsigned int reserved_maps;
850 struct device_node *np;
851 int ret;
852
853 reserved_maps = 0;
854 *map = NULL;
855 *num_maps = 0;
856
857 ret = k210_pinctrl_dt_subnode_to_map(pctldev, np_config, map,
858 &reserved_maps, num_maps);
859 if (ret < 0)
860 goto err;
861
862 for_each_available_child_of_node(np_config, np) {
863 ret = k210_pinctrl_dt_subnode_to_map(pctldev, np, map,
864 &reserved_maps, num_maps);
865 if (ret < 0)
866 goto err;
867 }
868 return 0;
869
870err:
871 pinctrl_utils_free_map(pctldev, *map, *num_maps);
872 return ret;
873}
874
875
876static const struct pinctrl_ops k210_pinctrl_ops = {
877 .get_groups_count = k210_pinctrl_get_groups_count,
878 .get_group_name = k210_pinctrl_get_group_name,
879 .get_group_pins = k210_pinctrl_get_group_pins,
880 .pin_dbg_show = k210_pinctrl_pin_dbg_show,
881 .dt_node_to_map = k210_pinctrl_dt_node_to_map,
882 .dt_free_map = pinconf_generic_dt_free_map,
883};
884
885static struct pinctrl_desc k210_pinctrl_desc = {
886 .name = "k210-pinctrl",
887 .pins = k210_pins,
888 .npins = K210_NPINS,
889 .pctlops = &k210_pinctrl_ops,
890 .pmxops = &k210_pinmux_ops,
891 .confops = &k210_pinconf_ops,
892 .custom_params = k210_pinconf_custom_params,
893 .num_custom_params = ARRAY_SIZE(k210_pinconf_custom_params),
894};
895
896static void k210_fpioa_init_ties(struct k210_fpioa_data *pdata)
897{
898 struct k210_fpioa __iomem *fpioa = pdata->fpioa;
899 u32 val;
900 int i, j;
901
902 dev_dbg(pdata->dev, "Init pin ties\n");
903
904
905 for (i = 0; i < ARRAY_SIZE(fpioa->tie_en); i++) {
906 val = 0;
907 for (j = 0; j < 32; j++) {
908 if (k210_pcf_infos[i * 32 + j].mode_id ==
909 K210_PC_DEFAULT_IN_TIE) {
910 dev_dbg(pdata->dev,
911 "tie_en function %d (%s)\n",
912 i * 32 + j,
913 k210_pcf_infos[i * 32 + j].name);
914 val |= BIT(j);
915 }
916 }
917
918
919 writel(val, &fpioa->tie_val[i]);
920 writel(val, &fpioa->tie_en[i]);
921 }
922}
923
924static int k210_fpioa_probe(struct platform_device *pdev)
925{
926 struct device *dev = &pdev->dev;
927 struct device_node *np = dev->of_node;
928 struct k210_fpioa_data *pdata;
929 int ret;
930
931 dev_info(dev, "K210 FPIOA pin controller\n");
932
933 pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
934 if (!pdata)
935 return -ENOMEM;
936
937 pdata->dev = dev;
938 platform_set_drvdata(pdev, pdata);
939
940 pdata->fpioa = devm_platform_ioremap_resource(pdev, 0);
941 if (IS_ERR(pdata->fpioa))
942 return PTR_ERR(pdata->fpioa);
943
944 pdata->clk = devm_clk_get(dev, "ref");
945 if (IS_ERR(pdata->clk))
946 return PTR_ERR(pdata->clk);
947
948 ret = clk_prepare_enable(pdata->clk);
949 if (ret)
950 return ret;
951
952 pdata->pclk = devm_clk_get_optional(dev, "pclk");
953 if (!IS_ERR(pdata->pclk)) {
954 ret = clk_prepare_enable(pdata->pclk);
955 if (ret)
956 goto disable_clk;
957 }
958
959 pdata->sysctl_map =
960 syscon_regmap_lookup_by_phandle_args(np,
961 "canaan,k210-sysctl-power",
962 1, &pdata->power_offset);
963 if (IS_ERR(pdata->sysctl_map)) {
964 ret = PTR_ERR(pdata->sysctl_map);
965 goto disable_pclk;
966 }
967
968 k210_fpioa_init_ties(pdata);
969
970 pdata->pctl = pinctrl_register(&k210_pinctrl_desc, dev, (void *)pdata);
971 if (IS_ERR(pdata->pctl)) {
972 ret = PTR_ERR(pdata->pctl);
973 goto disable_pclk;
974 }
975
976 return 0;
977
978disable_pclk:
979 clk_disable_unprepare(pdata->pclk);
980disable_clk:
981 clk_disable_unprepare(pdata->clk);
982
983 return ret;
984}
985
986static const struct of_device_id k210_fpioa_dt_ids[] = {
987 { .compatible = "canaan,k210-fpioa" },
988 { },
989};
990
991static struct platform_driver k210_fpioa_driver = {
992 .probe = k210_fpioa_probe,
993 .driver = {
994 .name = "k210-fpioa",
995 .of_match_table = k210_fpioa_dt_ids,
996 },
997};
998builtin_platform_driver(k210_fpioa_driver);
999
