xref: /OK3568_Linux_fs/kernel/drivers/pinctrl/renesas/pinctrl-rza1.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Combined GPIO and pin controller support for Renesas RZ/A1 (r7s72100) SoC
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2017 Jacopo Mondi
6*4882a593Smuzhiyun  */
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun /*
9*4882a593Smuzhiyun  * This pin controller/gpio combined driver supports Renesas devices of RZ/A1
10*4882a593Smuzhiyun  * family.
11*4882a593Smuzhiyun  * This includes SoCs which are sub- or super- sets of this particular line,
12*4882a593Smuzhiyun  * as RZ/A1H (r7s721000), RZ/A1M (r7s721010) and RZ/A1L (r7s721020).
13*4882a593Smuzhiyun  */
14*4882a593Smuzhiyun 
15*4882a593Smuzhiyun #include <linux/bitops.h>
16*4882a593Smuzhiyun #include <linux/err.h>
17*4882a593Smuzhiyun #include <linux/gpio/driver.h>
18*4882a593Smuzhiyun #include <linux/init.h>
19*4882a593Smuzhiyun #include <linux/ioport.h>
20*4882a593Smuzhiyun #include <linux/module.h>
21*4882a593Smuzhiyun #include <linux/of.h>
22*4882a593Smuzhiyun #include <linux/of_address.h>
23*4882a593Smuzhiyun #include <linux/of_device.h>
24*4882a593Smuzhiyun #include <linux/pinctrl/pinconf-generic.h>
25*4882a593Smuzhiyun #include <linux/pinctrl/pinctrl.h>
26*4882a593Smuzhiyun #include <linux/pinctrl/pinmux.h>
27*4882a593Smuzhiyun #include <linux/slab.h>
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun #include "../core.h"
30*4882a593Smuzhiyun #include "../devicetree.h"
31*4882a593Smuzhiyun #include "../pinconf.h"
32*4882a593Smuzhiyun #include "../pinmux.h"
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun #define DRIVER_NAME			"pinctrl-rza1"
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun #define RZA1_P_REG			0x0000
37*4882a593Smuzhiyun #define RZA1_PPR_REG			0x0200
38*4882a593Smuzhiyun #define RZA1_PM_REG			0x0300
39*4882a593Smuzhiyun #define RZA1_PMC_REG			0x0400
40*4882a593Smuzhiyun #define RZA1_PFC_REG			0x0500
41*4882a593Smuzhiyun #define RZA1_PFCE_REG			0x0600
42*4882a593Smuzhiyun #define RZA1_PFCEA_REG			0x0a00
43*4882a593Smuzhiyun #define RZA1_PIBC_REG			0x4000
44*4882a593Smuzhiyun #define RZA1_PBDC_REG			0x4100
45*4882a593Smuzhiyun #define RZA1_PIPC_REG			0x4200
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun #define RZA1_ADDR(mem, reg, port)	((mem) + (reg) + ((port) * 4))
48*4882a593Smuzhiyun 
49*4882a593Smuzhiyun #define RZA1_NPORTS			12
50*4882a593Smuzhiyun #define RZA1_PINS_PER_PORT		16
51*4882a593Smuzhiyun #define RZA1_NPINS			(RZA1_PINS_PER_PORT * RZA1_NPORTS)
52*4882a593Smuzhiyun #define RZA1_PIN_ID_TO_PORT(id)		((id) / RZA1_PINS_PER_PORT)
53*4882a593Smuzhiyun #define RZA1_PIN_ID_TO_PIN(id)		((id) % RZA1_PINS_PER_PORT)
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun /*
56*4882a593Smuzhiyun  * Use 16 lower bits [15:0] for pin identifier
57*4882a593Smuzhiyun  * Use 16 higher bits [31:16] for pin mux function
58*4882a593Smuzhiyun  */
59*4882a593Smuzhiyun #define MUX_PIN_ID_MASK			GENMASK(15, 0)
60*4882a593Smuzhiyun #define MUX_FUNC_MASK			GENMASK(31, 16)
61*4882a593Smuzhiyun 
62*4882a593Smuzhiyun #define MUX_FUNC_OFFS			16
63*4882a593Smuzhiyun #define MUX_FUNC(pinconf)		\
64*4882a593Smuzhiyun 	((pinconf & MUX_FUNC_MASK) >> MUX_FUNC_OFFS)
65*4882a593Smuzhiyun #define MUX_FUNC_PFC_MASK		BIT(0)
66*4882a593Smuzhiyun #define MUX_FUNC_PFCE_MASK		BIT(1)
67*4882a593Smuzhiyun #define MUX_FUNC_PFCEA_MASK		BIT(2)
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun /* Pin mux flags */
70*4882a593Smuzhiyun #define MUX_FLAGS_BIDIR			BIT(0)
71*4882a593Smuzhiyun #define MUX_FLAGS_SWIO_INPUT		BIT(1)
72*4882a593Smuzhiyun #define MUX_FLAGS_SWIO_OUTPUT		BIT(2)
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun /* ----------------------------------------------------------------------------
75*4882a593Smuzhiyun  * RZ/A1 pinmux flags
76*4882a593Smuzhiyun  */
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun /*
79*4882a593Smuzhiyun  * rza1_bidir_pin - describe a single pin that needs bidir flag applied.
80*4882a593Smuzhiyun  */
81*4882a593Smuzhiyun struct rza1_bidir_pin {
82*4882a593Smuzhiyun 	u8 pin: 4;
83*4882a593Smuzhiyun 	u8 func: 4;
84*4882a593Smuzhiyun };
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun /*
87*4882a593Smuzhiyun  * rza1_bidir_entry - describe a list of pins that needs bidir flag applied.
88*4882a593Smuzhiyun  *		      Each struct rza1_bidir_entry describes a port.
89*4882a593Smuzhiyun  */
90*4882a593Smuzhiyun struct rza1_bidir_entry {
91*4882a593Smuzhiyun 	const unsigned int npins;
92*4882a593Smuzhiyun 	const struct rza1_bidir_pin *pins;
93*4882a593Smuzhiyun };
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun /*
96*4882a593Smuzhiyun  * rza1_swio_pin - describe a single pin that needs swio flag applied.
97*4882a593Smuzhiyun  */
98*4882a593Smuzhiyun struct rza1_swio_pin {
99*4882a593Smuzhiyun 	u16 pin: 4;
100*4882a593Smuzhiyun 	u16 port: 4;
101*4882a593Smuzhiyun 	u16 func: 4;
102*4882a593Smuzhiyun 	u16 input: 1;
103*4882a593Smuzhiyun };
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun /*
106*4882a593Smuzhiyun  * rza1_swio_entry - describe a list of pins that needs swio flag applied
107*4882a593Smuzhiyun  */
108*4882a593Smuzhiyun struct rza1_swio_entry {
109*4882a593Smuzhiyun 	const unsigned int npins;
110*4882a593Smuzhiyun 	const struct rza1_swio_pin *pins;
111*4882a593Smuzhiyun };
112*4882a593Smuzhiyun 
113*4882a593Smuzhiyun /*
114*4882a593Smuzhiyun  * rza1_pinmux_conf - group together bidir and swio pinmux flag tables
115*4882a593Smuzhiyun  */
116*4882a593Smuzhiyun struct rza1_pinmux_conf {
117*4882a593Smuzhiyun 	const struct rza1_bidir_entry *bidir_entries;
118*4882a593Smuzhiyun 	const struct rza1_swio_entry *swio_entries;
119*4882a593Smuzhiyun };
120*4882a593Smuzhiyun 
121*4882a593Smuzhiyun /* ----------------------------------------------------------------------------
122*4882a593Smuzhiyun  * RZ/A1H (r7s72100) pinmux flags
123*4882a593Smuzhiyun  */
124*4882a593Smuzhiyun 
125*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1h_bidir_pins_p1[] = {
126*4882a593Smuzhiyun 	{ .pin = 0, .func = 1 },
127*4882a593Smuzhiyun 	{ .pin = 1, .func = 1 },
128*4882a593Smuzhiyun 	{ .pin = 2, .func = 1 },
129*4882a593Smuzhiyun 	{ .pin = 3, .func = 1 },
130*4882a593Smuzhiyun 	{ .pin = 4, .func = 1 },
131*4882a593Smuzhiyun 	{ .pin = 5, .func = 1 },
132*4882a593Smuzhiyun 	{ .pin = 6, .func = 1 },
133*4882a593Smuzhiyun 	{ .pin = 7, .func = 1 },
134*4882a593Smuzhiyun };
135*4882a593Smuzhiyun 
136*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1h_bidir_pins_p2[] = {
137*4882a593Smuzhiyun 	{ .pin = 0, .func = 1 },
138*4882a593Smuzhiyun 	{ .pin = 1, .func = 1 },
139*4882a593Smuzhiyun 	{ .pin = 2, .func = 1 },
140*4882a593Smuzhiyun 	{ .pin = 3, .func = 1 },
141*4882a593Smuzhiyun 	{ .pin = 4, .func = 1 },
142*4882a593Smuzhiyun 	{ .pin = 0, .func = 4 },
143*4882a593Smuzhiyun 	{ .pin = 1, .func = 4 },
144*4882a593Smuzhiyun 	{ .pin = 2, .func = 4 },
145*4882a593Smuzhiyun 	{ .pin = 3, .func = 4 },
146*4882a593Smuzhiyun 	{ .pin = 5, .func = 1 },
147*4882a593Smuzhiyun 	{ .pin = 6, .func = 1 },
148*4882a593Smuzhiyun 	{ .pin = 7, .func = 1 },
149*4882a593Smuzhiyun 	{ .pin = 8, .func = 1 },
150*4882a593Smuzhiyun 	{ .pin = 9, .func = 1 },
151*4882a593Smuzhiyun 	{ .pin = 10, .func = 1 },
152*4882a593Smuzhiyun 	{ .pin = 11, .func = 1 },
153*4882a593Smuzhiyun 	{ .pin = 12, .func = 1 },
154*4882a593Smuzhiyun 	{ .pin = 13, .func = 1 },
155*4882a593Smuzhiyun 	{ .pin = 14, .func = 1 },
156*4882a593Smuzhiyun 	{ .pin = 15, .func = 1 },
157*4882a593Smuzhiyun 	{ .pin = 12, .func = 4 },
158*4882a593Smuzhiyun 	{ .pin = 13, .func = 4 },
159*4882a593Smuzhiyun 	{ .pin = 14, .func = 4 },
160*4882a593Smuzhiyun 	{ .pin = 15, .func = 4 },
161*4882a593Smuzhiyun };
162*4882a593Smuzhiyun 
163*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1h_bidir_pins_p3[] = {
164*4882a593Smuzhiyun 	{ .pin = 3, .func = 2 },
165*4882a593Smuzhiyun 	{ .pin = 10, .func = 7 },
166*4882a593Smuzhiyun 	{ .pin = 11, .func = 7 },
167*4882a593Smuzhiyun 	{ .pin = 13, .func = 7 },
168*4882a593Smuzhiyun 	{ .pin = 14, .func = 7 },
169*4882a593Smuzhiyun 	{ .pin = 15, .func = 7 },
170*4882a593Smuzhiyun 	{ .pin = 10, .func = 8 },
171*4882a593Smuzhiyun 	{ .pin = 11, .func = 8 },
172*4882a593Smuzhiyun 	{ .pin = 13, .func = 8 },
173*4882a593Smuzhiyun 	{ .pin = 14, .func = 8 },
174*4882a593Smuzhiyun 	{ .pin = 15, .func = 8 },
175*4882a593Smuzhiyun };
176*4882a593Smuzhiyun 
177*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1h_bidir_pins_p4[] = {
178*4882a593Smuzhiyun 	{ .pin = 0, .func = 8 },
179*4882a593Smuzhiyun 	{ .pin = 1, .func = 8 },
180*4882a593Smuzhiyun 	{ .pin = 2, .func = 8 },
181*4882a593Smuzhiyun 	{ .pin = 3, .func = 8 },
182*4882a593Smuzhiyun 	{ .pin = 10, .func = 3 },
183*4882a593Smuzhiyun 	{ .pin = 11, .func = 3 },
184*4882a593Smuzhiyun 	{ .pin = 13, .func = 3 },
185*4882a593Smuzhiyun 	{ .pin = 14, .func = 3 },
186*4882a593Smuzhiyun 	{ .pin = 15, .func = 3 },
187*4882a593Smuzhiyun 	{ .pin = 10, .func = 4 },
188*4882a593Smuzhiyun 	{ .pin = 11, .func = 4 },
189*4882a593Smuzhiyun 	{ .pin = 13, .func = 4 },
190*4882a593Smuzhiyun 	{ .pin = 14, .func = 4 },
191*4882a593Smuzhiyun 	{ .pin = 15, .func = 4 },
192*4882a593Smuzhiyun 	{ .pin = 12, .func = 5 },
193*4882a593Smuzhiyun 	{ .pin = 13, .func = 5 },
194*4882a593Smuzhiyun 	{ .pin = 14, .func = 5 },
195*4882a593Smuzhiyun 	{ .pin = 15, .func = 5 },
196*4882a593Smuzhiyun };
197*4882a593Smuzhiyun 
198*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1h_bidir_pins_p6[] = {
199*4882a593Smuzhiyun 	{ .pin = 0, .func = 1 },
200*4882a593Smuzhiyun 	{ .pin = 1, .func = 1 },
201*4882a593Smuzhiyun 	{ .pin = 2, .func = 1 },
202*4882a593Smuzhiyun 	{ .pin = 3, .func = 1 },
203*4882a593Smuzhiyun 	{ .pin = 4, .func = 1 },
204*4882a593Smuzhiyun 	{ .pin = 5, .func = 1 },
205*4882a593Smuzhiyun 	{ .pin = 6, .func = 1 },
206*4882a593Smuzhiyun 	{ .pin = 7, .func = 1 },
207*4882a593Smuzhiyun 	{ .pin = 8, .func = 1 },
208*4882a593Smuzhiyun 	{ .pin = 9, .func = 1 },
209*4882a593Smuzhiyun 	{ .pin = 10, .func = 1 },
210*4882a593Smuzhiyun 	{ .pin = 11, .func = 1 },
211*4882a593Smuzhiyun 	{ .pin = 12, .func = 1 },
212*4882a593Smuzhiyun 	{ .pin = 13, .func = 1 },
213*4882a593Smuzhiyun 	{ .pin = 14, .func = 1 },
214*4882a593Smuzhiyun 	{ .pin = 15, .func = 1 },
215*4882a593Smuzhiyun };
216*4882a593Smuzhiyun 
217*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1h_bidir_pins_p7[] = {
218*4882a593Smuzhiyun 	{ .pin = 13, .func = 3 },
219*4882a593Smuzhiyun };
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1h_bidir_pins_p8[] = {
222*4882a593Smuzhiyun 	{ .pin = 8, .func = 3 },
223*4882a593Smuzhiyun 	{ .pin = 9, .func = 3 },
224*4882a593Smuzhiyun 	{ .pin = 10, .func = 3 },
225*4882a593Smuzhiyun 	{ .pin = 11, .func = 3 },
226*4882a593Smuzhiyun 	{ .pin = 14, .func = 2 },
227*4882a593Smuzhiyun 	{ .pin = 15, .func = 2 },
228*4882a593Smuzhiyun 	{ .pin = 14, .func = 3 },
229*4882a593Smuzhiyun 	{ .pin = 15, .func = 3 },
230*4882a593Smuzhiyun };
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1h_bidir_pins_p9[] = {
233*4882a593Smuzhiyun 	{ .pin = 0, .func = 2 },
234*4882a593Smuzhiyun 	{ .pin = 1, .func = 2 },
235*4882a593Smuzhiyun 	{ .pin = 4, .func = 2 },
236*4882a593Smuzhiyun 	{ .pin = 5, .func = 2 },
237*4882a593Smuzhiyun 	{ .pin = 6, .func = 2 },
238*4882a593Smuzhiyun 	{ .pin = 7, .func = 2 },
239*4882a593Smuzhiyun };
240*4882a593Smuzhiyun 
241*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1h_bidir_pins_p11[] = {
242*4882a593Smuzhiyun 	{ .pin = 6, .func = 2 },
243*4882a593Smuzhiyun 	{ .pin = 7, .func = 2 },
244*4882a593Smuzhiyun 	{ .pin = 9, .func = 2 },
245*4882a593Smuzhiyun 	{ .pin = 6, .func = 4 },
246*4882a593Smuzhiyun 	{ .pin = 7, .func = 4 },
247*4882a593Smuzhiyun 	{ .pin = 9, .func = 4 },
248*4882a593Smuzhiyun 	{ .pin = 10, .func = 2 },
249*4882a593Smuzhiyun 	{ .pin = 11, .func = 2 },
250*4882a593Smuzhiyun 	{ .pin = 10, .func = 4 },
251*4882a593Smuzhiyun 	{ .pin = 11, .func = 4 },
252*4882a593Smuzhiyun 	{ .pin = 12, .func = 4 },
253*4882a593Smuzhiyun 	{ .pin = 13, .func = 4 },
254*4882a593Smuzhiyun 	{ .pin = 14, .func = 4 },
255*4882a593Smuzhiyun 	{ .pin = 15, .func = 4 },
256*4882a593Smuzhiyun };
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun static const struct rza1_swio_pin rza1h_swio_pins[] = {
259*4882a593Smuzhiyun 	{ .port = 2, .pin = 7, .func = 4, .input = 0 },
260*4882a593Smuzhiyun 	{ .port = 2, .pin = 11, .func = 4, .input = 0 },
261*4882a593Smuzhiyun 	{ .port = 3, .pin = 7, .func = 3, .input = 0 },
262*4882a593Smuzhiyun 	{ .port = 3, .pin = 7, .func = 8, .input = 0 },
263*4882a593Smuzhiyun 	{ .port = 4, .pin = 7, .func = 5, .input = 0 },
264*4882a593Smuzhiyun 	{ .port = 4, .pin = 7, .func = 11, .input = 0 },
265*4882a593Smuzhiyun 	{ .port = 4, .pin = 15, .func = 6, .input = 0 },
266*4882a593Smuzhiyun 	{ .port = 5, .pin = 0, .func = 1, .input = 1 },
267*4882a593Smuzhiyun 	{ .port = 5, .pin = 1, .func = 1, .input = 1 },
268*4882a593Smuzhiyun 	{ .port = 5, .pin = 2, .func = 1, .input = 1 },
269*4882a593Smuzhiyun 	{ .port = 5, .pin = 3, .func = 1, .input = 1 },
270*4882a593Smuzhiyun 	{ .port = 5, .pin = 4, .func = 1, .input = 1 },
271*4882a593Smuzhiyun 	{ .port = 5, .pin = 5, .func = 1, .input = 1 },
272*4882a593Smuzhiyun 	{ .port = 5, .pin = 6, .func = 1, .input = 1 },
273*4882a593Smuzhiyun 	{ .port = 5, .pin = 7, .func = 1, .input = 1 },
274*4882a593Smuzhiyun 	{ .port = 7, .pin = 4, .func = 6, .input = 0 },
275*4882a593Smuzhiyun 	{ .port = 7, .pin = 11, .func = 2, .input = 0 },
276*4882a593Smuzhiyun 	{ .port = 8, .pin = 10, .func = 8, .input = 0 },
277*4882a593Smuzhiyun 	{ .port = 10, .pin = 15, .func = 2, .input = 0 },
278*4882a593Smuzhiyun };
279*4882a593Smuzhiyun 
280*4882a593Smuzhiyun static const struct rza1_bidir_entry rza1h_bidir_entries[RZA1_NPORTS] = {
281*4882a593Smuzhiyun 	[1] = { ARRAY_SIZE(rza1h_bidir_pins_p1), rza1h_bidir_pins_p1 },
282*4882a593Smuzhiyun 	[2] = { ARRAY_SIZE(rza1h_bidir_pins_p2), rza1h_bidir_pins_p2 },
283*4882a593Smuzhiyun 	[3] = { ARRAY_SIZE(rza1h_bidir_pins_p3), rza1h_bidir_pins_p3 },
284*4882a593Smuzhiyun 	[4] = { ARRAY_SIZE(rza1h_bidir_pins_p4), rza1h_bidir_pins_p4 },
285*4882a593Smuzhiyun 	[6] = { ARRAY_SIZE(rza1h_bidir_pins_p6), rza1h_bidir_pins_p6 },
286*4882a593Smuzhiyun 	[7] = { ARRAY_SIZE(rza1h_bidir_pins_p7), rza1h_bidir_pins_p7 },
287*4882a593Smuzhiyun 	[8] = { ARRAY_SIZE(rza1h_bidir_pins_p8), rza1h_bidir_pins_p8 },
288*4882a593Smuzhiyun 	[9] = { ARRAY_SIZE(rza1h_bidir_pins_p9), rza1h_bidir_pins_p9 },
289*4882a593Smuzhiyun 	[11] = { ARRAY_SIZE(rza1h_bidir_pins_p11), rza1h_bidir_pins_p11 },
290*4882a593Smuzhiyun };
291*4882a593Smuzhiyun 
292*4882a593Smuzhiyun static const struct rza1_swio_entry rza1h_swio_entries[] = {
293*4882a593Smuzhiyun 	[0] = { ARRAY_SIZE(rza1h_swio_pins), rza1h_swio_pins },
294*4882a593Smuzhiyun };
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun /* RZ/A1H (r7s72100x) pinmux flags table */
297*4882a593Smuzhiyun static const struct rza1_pinmux_conf rza1h_pmx_conf = {
298*4882a593Smuzhiyun 	.bidir_entries	= rza1h_bidir_entries,
299*4882a593Smuzhiyun 	.swio_entries	= rza1h_swio_entries,
300*4882a593Smuzhiyun };
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun /* ----------------------------------------------------------------------------
303*4882a593Smuzhiyun  * RZ/A1L (r7s72102) pinmux flags
304*4882a593Smuzhiyun  */
305*4882a593Smuzhiyun 
306*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1l_bidir_pins_p1[] = {
307*4882a593Smuzhiyun 	{ .pin = 0, .func = 1 },
308*4882a593Smuzhiyun 	{ .pin = 1, .func = 1 },
309*4882a593Smuzhiyun 	{ .pin = 2, .func = 1 },
310*4882a593Smuzhiyun 	{ .pin = 3, .func = 1 },
311*4882a593Smuzhiyun 	{ .pin = 4, .func = 1 },
312*4882a593Smuzhiyun 	{ .pin = 5, .func = 1 },
313*4882a593Smuzhiyun 	{ .pin = 6, .func = 1 },
314*4882a593Smuzhiyun 	{ .pin = 7, .func = 1 },
315*4882a593Smuzhiyun };
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1l_bidir_pins_p3[] = {
318*4882a593Smuzhiyun 	{ .pin = 0, .func = 2 },
319*4882a593Smuzhiyun 	{ .pin = 1, .func = 2 },
320*4882a593Smuzhiyun 	{ .pin = 2, .func = 2 },
321*4882a593Smuzhiyun 	{ .pin = 4, .func = 2 },
322*4882a593Smuzhiyun 	{ .pin = 5, .func = 2 },
323*4882a593Smuzhiyun 	{ .pin = 10, .func = 2 },
324*4882a593Smuzhiyun 	{ .pin = 11, .func = 2 },
325*4882a593Smuzhiyun 	{ .pin = 12, .func = 2 },
326*4882a593Smuzhiyun 	{ .pin = 13, .func = 2 },
327*4882a593Smuzhiyun };
328*4882a593Smuzhiyun 
329*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1l_bidir_pins_p4[] = {
330*4882a593Smuzhiyun 	{ .pin = 1, .func = 4 },
331*4882a593Smuzhiyun 	{ .pin = 2, .func = 2 },
332*4882a593Smuzhiyun 	{ .pin = 3, .func = 2 },
333*4882a593Smuzhiyun 	{ .pin = 6, .func = 2 },
334*4882a593Smuzhiyun 	{ .pin = 7, .func = 2 },
335*4882a593Smuzhiyun };
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1l_bidir_pins_p5[] = {
338*4882a593Smuzhiyun 	{ .pin = 0, .func = 1 },
339*4882a593Smuzhiyun 	{ .pin = 1, .func = 1 },
340*4882a593Smuzhiyun 	{ .pin = 2, .func = 1 },
341*4882a593Smuzhiyun 	{ .pin = 3, .func = 1 },
342*4882a593Smuzhiyun 	{ .pin = 4, .func = 1 },
343*4882a593Smuzhiyun 	{ .pin = 5, .func = 1 },
344*4882a593Smuzhiyun 	{ .pin = 6, .func = 1 },
345*4882a593Smuzhiyun 	{ .pin = 7, .func = 1 },
346*4882a593Smuzhiyun 	{ .pin = 8, .func = 1 },
347*4882a593Smuzhiyun 	{ .pin = 9, .func = 1 },
348*4882a593Smuzhiyun 	{ .pin = 10, .func = 1 },
349*4882a593Smuzhiyun 	{ .pin = 11, .func = 1 },
350*4882a593Smuzhiyun 	{ .pin = 12, .func = 1 },
351*4882a593Smuzhiyun 	{ .pin = 13, .func = 1 },
352*4882a593Smuzhiyun 	{ .pin = 14, .func = 1 },
353*4882a593Smuzhiyun 	{ .pin = 15, .func = 1 },
354*4882a593Smuzhiyun 	{ .pin = 0, .func = 2 },
355*4882a593Smuzhiyun 	{ .pin = 1, .func = 2 },
356*4882a593Smuzhiyun 	{ .pin = 2, .func = 2 },
357*4882a593Smuzhiyun 	{ .pin = 3, .func = 2 },
358*4882a593Smuzhiyun };
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1l_bidir_pins_p6[] = {
361*4882a593Smuzhiyun 	{ .pin = 0, .func = 1 },
362*4882a593Smuzhiyun 	{ .pin = 1, .func = 1 },
363*4882a593Smuzhiyun 	{ .pin = 2, .func = 1 },
364*4882a593Smuzhiyun 	{ .pin = 3, .func = 1 },
365*4882a593Smuzhiyun 	{ .pin = 4, .func = 1 },
366*4882a593Smuzhiyun 	{ .pin = 5, .func = 1 },
367*4882a593Smuzhiyun 	{ .pin = 6, .func = 1 },
368*4882a593Smuzhiyun 	{ .pin = 7, .func = 1 },
369*4882a593Smuzhiyun 	{ .pin = 8, .func = 1 },
370*4882a593Smuzhiyun 	{ .pin = 9, .func = 1 },
371*4882a593Smuzhiyun 	{ .pin = 10, .func = 1 },
372*4882a593Smuzhiyun 	{ .pin = 11, .func = 1 },
373*4882a593Smuzhiyun 	{ .pin = 12, .func = 1 },
374*4882a593Smuzhiyun 	{ .pin = 13, .func = 1 },
375*4882a593Smuzhiyun 	{ .pin = 14, .func = 1 },
376*4882a593Smuzhiyun 	{ .pin = 15, .func = 1 },
377*4882a593Smuzhiyun };
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1l_bidir_pins_p7[] = {
380*4882a593Smuzhiyun 	{ .pin = 2, .func = 2 },
381*4882a593Smuzhiyun 	{ .pin = 3, .func = 2 },
382*4882a593Smuzhiyun 	{ .pin = 5, .func = 2 },
383*4882a593Smuzhiyun 	{ .pin = 6, .func = 2 },
384*4882a593Smuzhiyun 	{ .pin = 7, .func = 2 },
385*4882a593Smuzhiyun 	{ .pin = 2, .func = 3 },
386*4882a593Smuzhiyun 	{ .pin = 3, .func = 3 },
387*4882a593Smuzhiyun 	{ .pin = 5, .func = 3 },
388*4882a593Smuzhiyun 	{ .pin = 6, .func = 3 },
389*4882a593Smuzhiyun 	{ .pin = 7, .func = 3 },
390*4882a593Smuzhiyun };
391*4882a593Smuzhiyun 
392*4882a593Smuzhiyun static const struct rza1_bidir_pin rza1l_bidir_pins_p9[] = {
393*4882a593Smuzhiyun 	{ .pin = 1, .func = 2 },
394*4882a593Smuzhiyun 	{ .pin = 0, .func = 3 },
395*4882a593Smuzhiyun 	{ .pin = 1, .func = 3 },
396*4882a593Smuzhiyun 	{ .pin = 3, .func = 3 },
397*4882a593Smuzhiyun 	{ .pin = 4, .func = 3 },
398*4882a593Smuzhiyun 	{ .pin = 5, .func = 3 },
399*4882a593Smuzhiyun };
400*4882a593Smuzhiyun 
401*4882a593Smuzhiyun static const struct rza1_swio_pin rza1l_swio_pins[] = {
402*4882a593Smuzhiyun 	{ .port = 2, .pin = 8, .func = 2, .input = 0 },
403*4882a593Smuzhiyun 	{ .port = 5, .pin = 6, .func = 3, .input = 0 },
404*4882a593Smuzhiyun 	{ .port = 6, .pin = 6, .func = 3, .input = 0 },
405*4882a593Smuzhiyun 	{ .port = 6, .pin = 10, .func = 3, .input = 0 },
406*4882a593Smuzhiyun 	{ .port = 7, .pin = 10, .func = 2, .input = 0 },
407*4882a593Smuzhiyun 	{ .port = 8, .pin = 2, .func = 3, .input = 0 },
408*4882a593Smuzhiyun };
409*4882a593Smuzhiyun 
410*4882a593Smuzhiyun static const struct rza1_bidir_entry rza1l_bidir_entries[RZA1_NPORTS] = {
411*4882a593Smuzhiyun 	[1] = { ARRAY_SIZE(rza1l_bidir_pins_p1), rza1l_bidir_pins_p1 },
412*4882a593Smuzhiyun 	[3] = { ARRAY_SIZE(rza1l_bidir_pins_p3), rza1l_bidir_pins_p3 },
413*4882a593Smuzhiyun 	[4] = { ARRAY_SIZE(rza1l_bidir_pins_p4), rza1l_bidir_pins_p4 },
414*4882a593Smuzhiyun 	[5] = { ARRAY_SIZE(rza1l_bidir_pins_p4), rza1l_bidir_pins_p5 },
415*4882a593Smuzhiyun 	[6] = { ARRAY_SIZE(rza1l_bidir_pins_p6), rza1l_bidir_pins_p6 },
416*4882a593Smuzhiyun 	[7] = { ARRAY_SIZE(rza1l_bidir_pins_p7), rza1l_bidir_pins_p7 },
417*4882a593Smuzhiyun 	[9] = { ARRAY_SIZE(rza1l_bidir_pins_p9), rza1l_bidir_pins_p9 },
418*4882a593Smuzhiyun };
419*4882a593Smuzhiyun 
420*4882a593Smuzhiyun static const struct rza1_swio_entry rza1l_swio_entries[] = {
421*4882a593Smuzhiyun 	[0] = { ARRAY_SIZE(rza1l_swio_pins), rza1l_swio_pins },
422*4882a593Smuzhiyun };
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun /* RZ/A1L (r7s72102x) pinmux flags table */
425*4882a593Smuzhiyun static const struct rza1_pinmux_conf rza1l_pmx_conf = {
426*4882a593Smuzhiyun 	.bidir_entries	= rza1l_bidir_entries,
427*4882a593Smuzhiyun 	.swio_entries	= rza1l_swio_entries,
428*4882a593Smuzhiyun };
429*4882a593Smuzhiyun 
430*4882a593Smuzhiyun /* ----------------------------------------------------------------------------
431*4882a593Smuzhiyun  * RZ/A1 types
432*4882a593Smuzhiyun  */
433*4882a593Smuzhiyun /**
434*4882a593Smuzhiyun  * struct rza1_mux_conf - describes a pin multiplexing operation
435*4882a593Smuzhiyun  *
436*4882a593Smuzhiyun  * @id: the pin identifier from 0 to RZA1_NPINS
437*4882a593Smuzhiyun  * @port: the port where pin sits on
438*4882a593Smuzhiyun  * @pin: pin id
439*4882a593Smuzhiyun  * @mux_func: alternate function id number
440*4882a593Smuzhiyun  * @mux_flags: alternate function flags
441*4882a593Smuzhiyun  * @value: output value to set the pin to
442*4882a593Smuzhiyun  */
443*4882a593Smuzhiyun struct rza1_mux_conf {
444*4882a593Smuzhiyun 	u16 id;
445*4882a593Smuzhiyun 	u8 port;
446*4882a593Smuzhiyun 	u8 pin;
447*4882a593Smuzhiyun 	u8 mux_func;
448*4882a593Smuzhiyun 	u8 mux_flags;
449*4882a593Smuzhiyun 	u8 value;
450*4882a593Smuzhiyun };
451*4882a593Smuzhiyun 
452*4882a593Smuzhiyun /**
453*4882a593Smuzhiyun  * struct rza1_port - describes a pin port
454*4882a593Smuzhiyun  *
455*4882a593Smuzhiyun  * This is mostly useful to lock register writes per-bank and not globally.
456*4882a593Smuzhiyun  *
457*4882a593Smuzhiyun  * @lock: protect access to HW registers
458*4882a593Smuzhiyun  * @id: port number
459*4882a593Smuzhiyun  * @base: logical address base
460*4882a593Smuzhiyun  * @pins: pins sitting on this port
461*4882a593Smuzhiyun  */
462*4882a593Smuzhiyun struct rza1_port {
463*4882a593Smuzhiyun 	spinlock_t lock;
464*4882a593Smuzhiyun 	unsigned int id;
465*4882a593Smuzhiyun 	void __iomem *base;
466*4882a593Smuzhiyun 	struct pinctrl_pin_desc *pins;
467*4882a593Smuzhiyun };
468*4882a593Smuzhiyun 
469*4882a593Smuzhiyun /**
470*4882a593Smuzhiyun  * struct rza1_pinctrl - RZ pincontroller device
471*4882a593Smuzhiyun  *
472*4882a593Smuzhiyun  * @dev: parent device structure
473*4882a593Smuzhiyun  * @mutex: protect [pinctrl|pinmux]_generic functions
474*4882a593Smuzhiyun  * @base: logical address base
475*4882a593Smuzhiyun  * @nport: number of pin controller ports
476*4882a593Smuzhiyun  * @ports: pin controller banks
477*4882a593Smuzhiyun  * @pins: pin array for pinctrl core
478*4882a593Smuzhiyun  * @desc: pincontroller desc for pinctrl core
479*4882a593Smuzhiyun  * @pctl: pinctrl device
480*4882a593Smuzhiyun  * @data: device specific data
481*4882a593Smuzhiyun  */
482*4882a593Smuzhiyun struct rza1_pinctrl {
483*4882a593Smuzhiyun 	struct device *dev;
484*4882a593Smuzhiyun 
485*4882a593Smuzhiyun 	struct mutex mutex;
486*4882a593Smuzhiyun 
487*4882a593Smuzhiyun 	void __iomem *base;
488*4882a593Smuzhiyun 
489*4882a593Smuzhiyun 	unsigned int nport;
490*4882a593Smuzhiyun 	struct rza1_port *ports;
491*4882a593Smuzhiyun 
492*4882a593Smuzhiyun 	struct pinctrl_pin_desc *pins;
493*4882a593Smuzhiyun 	struct pinctrl_desc desc;
494*4882a593Smuzhiyun 	struct pinctrl_dev *pctl;
495*4882a593Smuzhiyun 
496*4882a593Smuzhiyun 	const void *data;
497*4882a593Smuzhiyun };
498*4882a593Smuzhiyun 
499*4882a593Smuzhiyun /* ----------------------------------------------------------------------------
500*4882a593Smuzhiyun  * RZ/A1 pinmux flags
501*4882a593Smuzhiyun  */
rza1_pinmux_get_bidir(unsigned int port,unsigned int pin,unsigned int func,const struct rza1_bidir_entry * table)502*4882a593Smuzhiyun static inline bool rza1_pinmux_get_bidir(unsigned int port,
503*4882a593Smuzhiyun 					 unsigned int pin,
504*4882a593Smuzhiyun 					 unsigned int func,
505*4882a593Smuzhiyun 					 const struct rza1_bidir_entry *table)
506*4882a593Smuzhiyun {
507*4882a593Smuzhiyun 	const struct rza1_bidir_entry *entry = &table[port];
508*4882a593Smuzhiyun 	const struct rza1_bidir_pin *bidir_pin;
509*4882a593Smuzhiyun 	unsigned int i;
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun 	for (i = 0; i < entry->npins; ++i) {
512*4882a593Smuzhiyun 		bidir_pin = &entry->pins[i];
513*4882a593Smuzhiyun 		if (bidir_pin->pin == pin && bidir_pin->func == func)
514*4882a593Smuzhiyun 			return true;
515*4882a593Smuzhiyun 	}
516*4882a593Smuzhiyun 
517*4882a593Smuzhiyun 	return false;
518*4882a593Smuzhiyun }
519*4882a593Smuzhiyun 
rza1_pinmux_get_swio(unsigned int port,unsigned int pin,unsigned int func,const struct rza1_swio_entry * table)520*4882a593Smuzhiyun static inline int rza1_pinmux_get_swio(unsigned int port,
521*4882a593Smuzhiyun 				       unsigned int pin,
522*4882a593Smuzhiyun 				       unsigned int func,
523*4882a593Smuzhiyun 				       const struct rza1_swio_entry *table)
524*4882a593Smuzhiyun {
525*4882a593Smuzhiyun 	const struct rza1_swio_pin *swio_pin;
526*4882a593Smuzhiyun 	unsigned int i;
527*4882a593Smuzhiyun 
528*4882a593Smuzhiyun 
529*4882a593Smuzhiyun 	for (i = 0; i < table->npins; ++i) {
530*4882a593Smuzhiyun 		swio_pin = &table->pins[i];
531*4882a593Smuzhiyun 		if (swio_pin->port == port && swio_pin->pin == pin &&
532*4882a593Smuzhiyun 		    swio_pin->func == func)
533*4882a593Smuzhiyun 			return swio_pin->input;
534*4882a593Smuzhiyun 	}
535*4882a593Smuzhiyun 
536*4882a593Smuzhiyun 	return -ENOENT;
537*4882a593Smuzhiyun }
538*4882a593Smuzhiyun 
539*4882a593Smuzhiyun /*
540*4882a593Smuzhiyun  * rza1_pinmux_get_flags() - return pinmux flags associated to a pin
541*4882a593Smuzhiyun  */
rza1_pinmux_get_flags(unsigned int port,unsigned int pin,unsigned int func,struct rza1_pinctrl * rza1_pctl)542*4882a593Smuzhiyun static unsigned int rza1_pinmux_get_flags(unsigned int port, unsigned int pin,
543*4882a593Smuzhiyun 					  unsigned int func,
544*4882a593Smuzhiyun 					  struct rza1_pinctrl *rza1_pctl)
545*4882a593Smuzhiyun 
546*4882a593Smuzhiyun {
547*4882a593Smuzhiyun 	const struct rza1_pinmux_conf *pmx_conf = rza1_pctl->data;
548*4882a593Smuzhiyun 	const struct rza1_bidir_entry *bidir_entries = pmx_conf->bidir_entries;
549*4882a593Smuzhiyun 	const struct rza1_swio_entry *swio_entries = pmx_conf->swio_entries;
550*4882a593Smuzhiyun 	unsigned int pmx_flags = 0;
551*4882a593Smuzhiyun 	int ret;
552*4882a593Smuzhiyun 
553*4882a593Smuzhiyun 	if (rza1_pinmux_get_bidir(port, pin, func, bidir_entries))
554*4882a593Smuzhiyun 		pmx_flags |= MUX_FLAGS_BIDIR;
555*4882a593Smuzhiyun 
556*4882a593Smuzhiyun 	ret = rza1_pinmux_get_swio(port, pin, func, swio_entries);
557*4882a593Smuzhiyun 	if (ret == 0)
558*4882a593Smuzhiyun 		pmx_flags |= MUX_FLAGS_SWIO_OUTPUT;
559*4882a593Smuzhiyun 	else if (ret > 0)
560*4882a593Smuzhiyun 		pmx_flags |= MUX_FLAGS_SWIO_INPUT;
561*4882a593Smuzhiyun 
562*4882a593Smuzhiyun 	return pmx_flags;
563*4882a593Smuzhiyun }
564*4882a593Smuzhiyun 
565*4882a593Smuzhiyun /* ----------------------------------------------------------------------------
566*4882a593Smuzhiyun  * RZ/A1 SoC operations
567*4882a593Smuzhiyun  */
568*4882a593Smuzhiyun 
569*4882a593Smuzhiyun /*
570*4882a593Smuzhiyun  * rza1_set_bit() - un-locked set/clear a single bit in pin configuration
571*4882a593Smuzhiyun  *		    registers
572*4882a593Smuzhiyun  */
rza1_set_bit(struct rza1_port * port,unsigned int reg,unsigned int bit,bool set)573*4882a593Smuzhiyun static inline void rza1_set_bit(struct rza1_port *port, unsigned int reg,
574*4882a593Smuzhiyun 				unsigned int bit, bool set)
575*4882a593Smuzhiyun {
576*4882a593Smuzhiyun 	void __iomem *mem = RZA1_ADDR(port->base, reg, port->id);
577*4882a593Smuzhiyun 	u16 val = ioread16(mem);
578*4882a593Smuzhiyun 
579*4882a593Smuzhiyun 	if (set)
580*4882a593Smuzhiyun 		val |= BIT(bit);
581*4882a593Smuzhiyun 	else
582*4882a593Smuzhiyun 		val &= ~BIT(bit);
583*4882a593Smuzhiyun 
584*4882a593Smuzhiyun 	iowrite16(val, mem);
585*4882a593Smuzhiyun }
586*4882a593Smuzhiyun 
rza1_get_bit(struct rza1_port * port,unsigned int reg,unsigned int bit)587*4882a593Smuzhiyun static inline unsigned int rza1_get_bit(struct rza1_port *port,
588*4882a593Smuzhiyun 					unsigned int reg, unsigned int bit)
589*4882a593Smuzhiyun {
590*4882a593Smuzhiyun 	void __iomem *mem = RZA1_ADDR(port->base, reg, port->id);
591*4882a593Smuzhiyun 
592*4882a593Smuzhiyun 	return ioread16(mem) & BIT(bit);
593*4882a593Smuzhiyun }
594*4882a593Smuzhiyun 
595*4882a593Smuzhiyun /**
596*4882a593Smuzhiyun  * rza1_pin_reset() - reset a pin to default initial state
597*4882a593Smuzhiyun  *
598*4882a593Smuzhiyun  * Reset pin state disabling input buffer and bi-directional control,
599*4882a593Smuzhiyun  * and configure it as input port.
600*4882a593Smuzhiyun  * Note that pin is now configured with direction as input but with input
601*4882a593Smuzhiyun  * buffer disabled. This implies the pin value cannot be read in this state.
602*4882a593Smuzhiyun  *
603*4882a593Smuzhiyun  * @port: port where pin sits on
604*4882a593Smuzhiyun  * @pin: pin offset
605*4882a593Smuzhiyun  */
rza1_pin_reset(struct rza1_port * port,unsigned int pin)606*4882a593Smuzhiyun static void rza1_pin_reset(struct rza1_port *port, unsigned int pin)
607*4882a593Smuzhiyun {
608*4882a593Smuzhiyun 	unsigned long irqflags;
609*4882a593Smuzhiyun 
610*4882a593Smuzhiyun 	spin_lock_irqsave(&port->lock, irqflags);
611*4882a593Smuzhiyun 	rza1_set_bit(port, RZA1_PIBC_REG, pin, 0);
612*4882a593Smuzhiyun 	rza1_set_bit(port, RZA1_PBDC_REG, pin, 0);
613*4882a593Smuzhiyun 
614*4882a593Smuzhiyun 	rza1_set_bit(port, RZA1_PM_REG, pin, 1);
615*4882a593Smuzhiyun 	rza1_set_bit(port, RZA1_PMC_REG, pin, 0);
616*4882a593Smuzhiyun 	rza1_set_bit(port, RZA1_PIPC_REG, pin, 0);
617*4882a593Smuzhiyun 	spin_unlock_irqrestore(&port->lock, irqflags);
618*4882a593Smuzhiyun }
619*4882a593Smuzhiyun 
620*4882a593Smuzhiyun /**
621*4882a593Smuzhiyun  * rza1_pin_set_direction() - set I/O direction on a pin in port mode
622*4882a593Smuzhiyun  *
623*4882a593Smuzhiyun  * When running in output port mode keep PBDC enabled to allow reading the
624*4882a593Smuzhiyun  * pin value from PPR.
625*4882a593Smuzhiyun  *
626*4882a593Smuzhiyun  * @port: port where pin sits on
627*4882a593Smuzhiyun  * @pin: pin offset
628*4882a593Smuzhiyun  * @input: input enable/disable flag
629*4882a593Smuzhiyun  */
rza1_pin_set_direction(struct rza1_port * port,unsigned int pin,bool input)630*4882a593Smuzhiyun static inline void rza1_pin_set_direction(struct rza1_port *port,
631*4882a593Smuzhiyun 					  unsigned int pin, bool input)
632*4882a593Smuzhiyun {
633*4882a593Smuzhiyun 	unsigned long irqflags;
634*4882a593Smuzhiyun 
635*4882a593Smuzhiyun 	spin_lock_irqsave(&port->lock, irqflags);
636*4882a593Smuzhiyun 
637*4882a593Smuzhiyun 	rza1_set_bit(port, RZA1_PIBC_REG, pin, 1);
638*4882a593Smuzhiyun 	if (input) {
639*4882a593Smuzhiyun 		rza1_set_bit(port, RZA1_PM_REG, pin, 1);
640*4882a593Smuzhiyun 		rza1_set_bit(port, RZA1_PBDC_REG, pin, 0);
641*4882a593Smuzhiyun 	} else {
642*4882a593Smuzhiyun 		rza1_set_bit(port, RZA1_PM_REG, pin, 0);
643*4882a593Smuzhiyun 		rza1_set_bit(port, RZA1_PBDC_REG, pin, 1);
644*4882a593Smuzhiyun 	}
645*4882a593Smuzhiyun 
646*4882a593Smuzhiyun 	spin_unlock_irqrestore(&port->lock, irqflags);
647*4882a593Smuzhiyun }
648*4882a593Smuzhiyun 
rza1_pin_set(struct rza1_port * port,unsigned int pin,unsigned int value)649*4882a593Smuzhiyun static inline void rza1_pin_set(struct rza1_port *port, unsigned int pin,
650*4882a593Smuzhiyun 				unsigned int value)
651*4882a593Smuzhiyun {
652*4882a593Smuzhiyun 	unsigned long irqflags;
653*4882a593Smuzhiyun 
654*4882a593Smuzhiyun 	spin_lock_irqsave(&port->lock, irqflags);
655*4882a593Smuzhiyun 	rza1_set_bit(port, RZA1_P_REG, pin, !!value);
656*4882a593Smuzhiyun 	spin_unlock_irqrestore(&port->lock, irqflags);
657*4882a593Smuzhiyun }
658*4882a593Smuzhiyun 
rza1_pin_get(struct rza1_port * port,unsigned int pin)659*4882a593Smuzhiyun static inline int rza1_pin_get(struct rza1_port *port, unsigned int pin)
660*4882a593Smuzhiyun {
661*4882a593Smuzhiyun 	return rza1_get_bit(port, RZA1_PPR_REG, pin);
662*4882a593Smuzhiyun }
663*4882a593Smuzhiyun 
664*4882a593Smuzhiyun /**
665*4882a593Smuzhiyun  * rza1_pin_mux_single() - configure pin multiplexing on a single pin
666*4882a593Smuzhiyun  *
667*4882a593Smuzhiyun  * @rza1_pctl: RZ/A1 pin controller device
668*4882a593Smuzhiyun  * @mux_conf: pin multiplexing descriptor
669*4882a593Smuzhiyun  */
rza1_pin_mux_single(struct rza1_pinctrl * rza1_pctl,struct rza1_mux_conf * mux_conf)670*4882a593Smuzhiyun static int rza1_pin_mux_single(struct rza1_pinctrl *rza1_pctl,
671*4882a593Smuzhiyun 			       struct rza1_mux_conf *mux_conf)
672*4882a593Smuzhiyun {
673*4882a593Smuzhiyun 	struct rza1_port *port = &rza1_pctl->ports[mux_conf->port];
674*4882a593Smuzhiyun 	unsigned int pin = mux_conf->pin;
675*4882a593Smuzhiyun 	u8 mux_func = mux_conf->mux_func;
676*4882a593Smuzhiyun 	u8 mux_flags = mux_conf->mux_flags;
677*4882a593Smuzhiyun 	u8 mux_flags_from_table;
678*4882a593Smuzhiyun 
679*4882a593Smuzhiyun 	rza1_pin_reset(port, pin);
680*4882a593Smuzhiyun 
681*4882a593Smuzhiyun 	/* SWIO pinmux flags coming from DT are high precedence */
682*4882a593Smuzhiyun 	mux_flags_from_table = rza1_pinmux_get_flags(port->id, pin, mux_func,
683*4882a593Smuzhiyun 						     rza1_pctl);
684*4882a593Smuzhiyun 	if (mux_flags)
685*4882a593Smuzhiyun 		mux_flags |= (mux_flags_from_table & MUX_FLAGS_BIDIR);
686*4882a593Smuzhiyun 	else
687*4882a593Smuzhiyun 		mux_flags = mux_flags_from_table;
688*4882a593Smuzhiyun 
689*4882a593Smuzhiyun 	if (mux_flags & MUX_FLAGS_BIDIR)
690*4882a593Smuzhiyun 		rza1_set_bit(port, RZA1_PBDC_REG, pin, 1);
691*4882a593Smuzhiyun 
692*4882a593Smuzhiyun 	/*
693*4882a593Smuzhiyun 	 * Enable alternate function mode and select it.
694*4882a593Smuzhiyun 	 *
695*4882a593Smuzhiyun 	 * Be careful here: the pin mux sub-nodes in device tree
696*4882a593Smuzhiyun 	 * enumerate alternate functions from 1 to 8;
697*4882a593Smuzhiyun 	 * subtract 1 before using macros to match registers configuration
698*4882a593Smuzhiyun 	 * which expects numbers from 0 to 7 instead.
699*4882a593Smuzhiyun 	 *
700*4882a593Smuzhiyun 	 * ----------------------------------------------------
701*4882a593Smuzhiyun 	 * Alternate mode selection table:
702*4882a593Smuzhiyun 	 *
703*4882a593Smuzhiyun 	 * PMC	PFC	PFCE	PFCAE	(mux_func - 1)
704*4882a593Smuzhiyun 	 * 1	0	0	0	0
705*4882a593Smuzhiyun 	 * 1	1	0	0	1
706*4882a593Smuzhiyun 	 * 1	0	1	0	2
707*4882a593Smuzhiyun 	 * 1	1	1	0	3
708*4882a593Smuzhiyun 	 * 1	0	0	1	4
709*4882a593Smuzhiyun 	 * 1	1	0	1	5
710*4882a593Smuzhiyun 	 * 1	0	1	1	6
711*4882a593Smuzhiyun 	 * 1	1	1	1	7
712*4882a593Smuzhiyun 	 * ----------------------------------------------------
713*4882a593Smuzhiyun 	 */
714*4882a593Smuzhiyun 	mux_func -= 1;
715*4882a593Smuzhiyun 	rza1_set_bit(port, RZA1_PFC_REG, pin, mux_func & MUX_FUNC_PFC_MASK);
716*4882a593Smuzhiyun 	rza1_set_bit(port, RZA1_PFCE_REG, pin, mux_func & MUX_FUNC_PFCE_MASK);
717*4882a593Smuzhiyun 	rza1_set_bit(port, RZA1_PFCEA_REG, pin, mux_func & MUX_FUNC_PFCEA_MASK);
718*4882a593Smuzhiyun 
719*4882a593Smuzhiyun 	/*
720*4882a593Smuzhiyun 	 * All alternate functions except a few need PIPCn = 1.
721*4882a593Smuzhiyun 	 * If PIPCn has to stay disabled (SW IO mode), configure PMn according
722*4882a593Smuzhiyun 	 * to I/O direction specified by pin configuration -after- PMC has been
723*4882a593Smuzhiyun 	 * set to one.
724*4882a593Smuzhiyun 	 */
725*4882a593Smuzhiyun 	if (mux_flags & (MUX_FLAGS_SWIO_INPUT | MUX_FLAGS_SWIO_OUTPUT))
726*4882a593Smuzhiyun 		rza1_set_bit(port, RZA1_PM_REG, pin,
727*4882a593Smuzhiyun 			     mux_flags & MUX_FLAGS_SWIO_INPUT);
728*4882a593Smuzhiyun 	else
729*4882a593Smuzhiyun 		rza1_set_bit(port, RZA1_PIPC_REG, pin, 1);
730*4882a593Smuzhiyun 
731*4882a593Smuzhiyun 	rza1_set_bit(port, RZA1_PMC_REG, pin, 1);
732*4882a593Smuzhiyun 
733*4882a593Smuzhiyun 	return 0;
734*4882a593Smuzhiyun }
735*4882a593Smuzhiyun 
736*4882a593Smuzhiyun /* ----------------------------------------------------------------------------
737*4882a593Smuzhiyun  * gpio operations
738*4882a593Smuzhiyun  */
739*4882a593Smuzhiyun 
740*4882a593Smuzhiyun /**
741*4882a593Smuzhiyun  * rza1_gpio_request() - configure pin in port mode
742*4882a593Smuzhiyun  *
743*4882a593Smuzhiyun  * Configure a pin as gpio (port mode).
744*4882a593Smuzhiyun  * After reset, the pin is in input mode with input buffer disabled.
745*4882a593Smuzhiyun  * To use the pin as input or output, set_direction shall be called first
746*4882a593Smuzhiyun  *
747*4882a593Smuzhiyun  * @chip: gpio chip where the gpio sits on
748*4882a593Smuzhiyun  * @gpio: gpio offset
749*4882a593Smuzhiyun  */
rza1_gpio_request(struct gpio_chip * chip,unsigned int gpio)750*4882a593Smuzhiyun static int rza1_gpio_request(struct gpio_chip *chip, unsigned int gpio)
751*4882a593Smuzhiyun {
752*4882a593Smuzhiyun 	struct rza1_port *port = gpiochip_get_data(chip);
753*4882a593Smuzhiyun 
754*4882a593Smuzhiyun 	rza1_pin_reset(port, gpio);
755*4882a593Smuzhiyun 
756*4882a593Smuzhiyun 	return 0;
757*4882a593Smuzhiyun }
758*4882a593Smuzhiyun 
759*4882a593Smuzhiyun /**
760*4882a593Smuzhiyun  * rza1_gpio_disable_free() - reset a pin
761*4882a593Smuzhiyun  *
762*4882a593Smuzhiyun  * Surprisingly, disable_free a gpio, is equivalent to request it.
763*4882a593Smuzhiyun  * Reset pin to port mode, with input buffer disabled. This overwrites all
764*4882a593Smuzhiyun  * port direction settings applied with set_direction
765*4882a593Smuzhiyun  *
766*4882a593Smuzhiyun  * @chip: gpio chip where the gpio sits on
767*4882a593Smuzhiyun  * @gpio: gpio offset
768*4882a593Smuzhiyun  */
rza1_gpio_free(struct gpio_chip * chip,unsigned int gpio)769*4882a593Smuzhiyun static void rza1_gpio_free(struct gpio_chip *chip, unsigned int gpio)
770*4882a593Smuzhiyun {
771*4882a593Smuzhiyun 	struct rza1_port *port = gpiochip_get_data(chip);
772*4882a593Smuzhiyun 
773*4882a593Smuzhiyun 	rza1_pin_reset(port, gpio);
774*4882a593Smuzhiyun }
775*4882a593Smuzhiyun 
rza1_gpio_get_direction(struct gpio_chip * chip,unsigned int gpio)776*4882a593Smuzhiyun static int rza1_gpio_get_direction(struct gpio_chip *chip, unsigned int gpio)
777*4882a593Smuzhiyun {
778*4882a593Smuzhiyun 	struct rza1_port *port = gpiochip_get_data(chip);
779*4882a593Smuzhiyun 
780*4882a593Smuzhiyun 	if (rza1_get_bit(port, RZA1_PM_REG, gpio))
781*4882a593Smuzhiyun 		return GPIO_LINE_DIRECTION_IN;
782*4882a593Smuzhiyun 
783*4882a593Smuzhiyun 	return GPIO_LINE_DIRECTION_OUT;
784*4882a593Smuzhiyun }
785*4882a593Smuzhiyun 
rza1_gpio_direction_input(struct gpio_chip * chip,unsigned int gpio)786*4882a593Smuzhiyun static int rza1_gpio_direction_input(struct gpio_chip *chip,
787*4882a593Smuzhiyun 				     unsigned int gpio)
788*4882a593Smuzhiyun {
789*4882a593Smuzhiyun 	struct rza1_port *port = gpiochip_get_data(chip);
790*4882a593Smuzhiyun 
791*4882a593Smuzhiyun 	rza1_pin_set_direction(port, gpio, true);
792*4882a593Smuzhiyun 
793*4882a593Smuzhiyun 	return 0;
794*4882a593Smuzhiyun }
795*4882a593Smuzhiyun 
rza1_gpio_direction_output(struct gpio_chip * chip,unsigned int gpio,int value)796*4882a593Smuzhiyun static int rza1_gpio_direction_output(struct gpio_chip *chip,
797*4882a593Smuzhiyun 				      unsigned int gpio,
798*4882a593Smuzhiyun 				      int value)
799*4882a593Smuzhiyun {
800*4882a593Smuzhiyun 	struct rza1_port *port = gpiochip_get_data(chip);
801*4882a593Smuzhiyun 
802*4882a593Smuzhiyun 	/* Set value before driving pin direction */
803*4882a593Smuzhiyun 	rza1_pin_set(port, gpio, value);
804*4882a593Smuzhiyun 	rza1_pin_set_direction(port, gpio, false);
805*4882a593Smuzhiyun 
806*4882a593Smuzhiyun 	return 0;
807*4882a593Smuzhiyun }
808*4882a593Smuzhiyun 
809*4882a593Smuzhiyun /**
810*4882a593Smuzhiyun  * rza1_gpio_get() - read a gpio pin value
811*4882a593Smuzhiyun  *
812*4882a593Smuzhiyun  * Read gpio pin value through PPR register.
813*4882a593Smuzhiyun  * Requires bi-directional mode to work when reading the value of a pin
814*4882a593Smuzhiyun  * in output mode
815*4882a593Smuzhiyun  *
816*4882a593Smuzhiyun  * @chip: gpio chip where the gpio sits on
817*4882a593Smuzhiyun  * @gpio: gpio offset
818*4882a593Smuzhiyun  */
rza1_gpio_get(struct gpio_chip * chip,unsigned int gpio)819*4882a593Smuzhiyun static int rza1_gpio_get(struct gpio_chip *chip, unsigned int gpio)
820*4882a593Smuzhiyun {
821*4882a593Smuzhiyun 	struct rza1_port *port = gpiochip_get_data(chip);
822*4882a593Smuzhiyun 
823*4882a593Smuzhiyun 	return rza1_pin_get(port, gpio);
824*4882a593Smuzhiyun }
825*4882a593Smuzhiyun 
rza1_gpio_set(struct gpio_chip * chip,unsigned int gpio,int value)826*4882a593Smuzhiyun static void rza1_gpio_set(struct gpio_chip *chip, unsigned int gpio,
827*4882a593Smuzhiyun 			  int value)
828*4882a593Smuzhiyun {
829*4882a593Smuzhiyun 	struct rza1_port *port = gpiochip_get_data(chip);
830*4882a593Smuzhiyun 
831*4882a593Smuzhiyun 	rza1_pin_set(port, gpio, value);
832*4882a593Smuzhiyun }
833*4882a593Smuzhiyun 
834*4882a593Smuzhiyun static const struct gpio_chip rza1_gpiochip_template = {
835*4882a593Smuzhiyun 	.request		= rza1_gpio_request,
836*4882a593Smuzhiyun 	.free			= rza1_gpio_free,
837*4882a593Smuzhiyun 	.get_direction		= rza1_gpio_get_direction,
838*4882a593Smuzhiyun 	.direction_input	= rza1_gpio_direction_input,
839*4882a593Smuzhiyun 	.direction_output	= rza1_gpio_direction_output,
840*4882a593Smuzhiyun 	.get			= rza1_gpio_get,
841*4882a593Smuzhiyun 	.set			= rza1_gpio_set,
842*4882a593Smuzhiyun };
843*4882a593Smuzhiyun /* ----------------------------------------------------------------------------
844*4882a593Smuzhiyun  * pinctrl operations
845*4882a593Smuzhiyun  */
846*4882a593Smuzhiyun 
847*4882a593Smuzhiyun /**
848*4882a593Smuzhiyun  * rza1_dt_node_pin_count() - Count number of pins in a dt node or in all its
849*4882a593Smuzhiyun  *			      children sub-nodes
850*4882a593Smuzhiyun  *
851*4882a593Smuzhiyun  * @np: device tree node to parse
852*4882a593Smuzhiyun  */
rza1_dt_node_pin_count(struct device_node * np)853*4882a593Smuzhiyun static int rza1_dt_node_pin_count(struct device_node *np)
854*4882a593Smuzhiyun {
855*4882a593Smuzhiyun 	struct device_node *child;
856*4882a593Smuzhiyun 	struct property *of_pins;
857*4882a593Smuzhiyun 	unsigned int npins;
858*4882a593Smuzhiyun 
859*4882a593Smuzhiyun 	of_pins = of_find_property(np, "pinmux", NULL);
860*4882a593Smuzhiyun 	if (of_pins)
861*4882a593Smuzhiyun 		return of_pins->length / sizeof(u32);
862*4882a593Smuzhiyun 
863*4882a593Smuzhiyun 	npins = 0;
864*4882a593Smuzhiyun 	for_each_child_of_node(np, child) {
865*4882a593Smuzhiyun 		of_pins = of_find_property(child, "pinmux", NULL);
866*4882a593Smuzhiyun 		if (!of_pins) {
867*4882a593Smuzhiyun 			of_node_put(child);
868*4882a593Smuzhiyun 			return -EINVAL;
869*4882a593Smuzhiyun 		}
870*4882a593Smuzhiyun 
871*4882a593Smuzhiyun 		npins += of_pins->length / sizeof(u32);
872*4882a593Smuzhiyun 	}
873*4882a593Smuzhiyun 
874*4882a593Smuzhiyun 	return npins;
875*4882a593Smuzhiyun }
876*4882a593Smuzhiyun 
877*4882a593Smuzhiyun /**
878*4882a593Smuzhiyun  * rza1_parse_pmx_function() - parse a pin mux sub-node
879*4882a593Smuzhiyun  *
880*4882a593Smuzhiyun  * @rza1_pctl: RZ/A1 pin controller device
881*4882a593Smuzhiyun  * @np: of pmx sub-node
882*4882a593Smuzhiyun  * @mux_confs: array of pin mux configurations to fill with parsed info
883*4882a593Smuzhiyun  * @grpins: array of pin ids to mux
884*4882a593Smuzhiyun  */
rza1_parse_pinmux_node(struct rza1_pinctrl * rza1_pctl,struct device_node * np,struct rza1_mux_conf * mux_confs,unsigned int * grpins)885*4882a593Smuzhiyun static int rza1_parse_pinmux_node(struct rza1_pinctrl *rza1_pctl,
886*4882a593Smuzhiyun 				  struct device_node *np,
887*4882a593Smuzhiyun 				  struct rza1_mux_conf *mux_confs,
888*4882a593Smuzhiyun 				  unsigned int *grpins)
889*4882a593Smuzhiyun {
890*4882a593Smuzhiyun 	struct pinctrl_dev *pctldev = rza1_pctl->pctl;
891*4882a593Smuzhiyun 	char const *prop_name = "pinmux";
892*4882a593Smuzhiyun 	unsigned long *pin_configs;
893*4882a593Smuzhiyun 	unsigned int npin_configs;
894*4882a593Smuzhiyun 	struct property *of_pins;
895*4882a593Smuzhiyun 	unsigned int npins;
896*4882a593Smuzhiyun 	u8 pinmux_flags;
897*4882a593Smuzhiyun 	unsigned int i;
898*4882a593Smuzhiyun 	int ret;
899*4882a593Smuzhiyun 
900*4882a593Smuzhiyun 	of_pins = of_find_property(np, prop_name, NULL);
901*4882a593Smuzhiyun 	if (!of_pins) {
902*4882a593Smuzhiyun 		dev_dbg(rza1_pctl->dev, "Missing %s property\n", prop_name);
903*4882a593Smuzhiyun 		return -ENOENT;
904*4882a593Smuzhiyun 	}
905*4882a593Smuzhiyun 	npins = of_pins->length / sizeof(u32);
906*4882a593Smuzhiyun 
907*4882a593Smuzhiyun 	/*
908*4882a593Smuzhiyun 	 * Collect pin configuration properties: they apply to all pins in
909*4882a593Smuzhiyun 	 * this sub-node
910*4882a593Smuzhiyun 	 */
911*4882a593Smuzhiyun 	ret = pinconf_generic_parse_dt_config(np, pctldev, &pin_configs,
912*4882a593Smuzhiyun 					      &npin_configs);
913*4882a593Smuzhiyun 	if (ret) {
914*4882a593Smuzhiyun 		dev_err(rza1_pctl->dev,
915*4882a593Smuzhiyun 			"Unable to parse pin configuration options for %pOFn\n",
916*4882a593Smuzhiyun 			np);
917*4882a593Smuzhiyun 		return ret;
918*4882a593Smuzhiyun 	}
919*4882a593Smuzhiyun 
920*4882a593Smuzhiyun 	/*
921*4882a593Smuzhiyun 	 * Create a mask with pinmux flags from pin configuration;
922*4882a593Smuzhiyun 	 * very few pins (TIOC[0-4][A|B|C|D] require SWIO direction
923*4882a593Smuzhiyun 	 * specified in device tree.
924*4882a593Smuzhiyun 	 */
925*4882a593Smuzhiyun 	pinmux_flags = 0;
926*4882a593Smuzhiyun 	for (i = 0; i < npin_configs && pinmux_flags == 0; i++)
927*4882a593Smuzhiyun 		switch (pinconf_to_config_param(pin_configs[i])) {
928*4882a593Smuzhiyun 		case PIN_CONFIG_INPUT_ENABLE:
929*4882a593Smuzhiyun 			pinmux_flags |= MUX_FLAGS_SWIO_INPUT;
930*4882a593Smuzhiyun 			break;
931*4882a593Smuzhiyun 		case PIN_CONFIG_OUTPUT:	/* for DT backwards compatibility */
932*4882a593Smuzhiyun 		case PIN_CONFIG_OUTPUT_ENABLE:
933*4882a593Smuzhiyun 			pinmux_flags |= MUX_FLAGS_SWIO_OUTPUT;
934*4882a593Smuzhiyun 		default:
935*4882a593Smuzhiyun 			break;
936*4882a593Smuzhiyun 
937*4882a593Smuzhiyun 		}
938*4882a593Smuzhiyun 
939*4882a593Smuzhiyun 	kfree(pin_configs);
940*4882a593Smuzhiyun 
941*4882a593Smuzhiyun 	/* Collect pin positions and their mux settings. */
942*4882a593Smuzhiyun 	for (i = 0; i < npins; ++i) {
943*4882a593Smuzhiyun 		u32 of_pinconf;
944*4882a593Smuzhiyun 		struct rza1_mux_conf *mux_conf = &mux_confs[i];
945*4882a593Smuzhiyun 
946*4882a593Smuzhiyun 		ret = of_property_read_u32_index(np, prop_name, i, &of_pinconf);
947*4882a593Smuzhiyun 		if (ret)
948*4882a593Smuzhiyun 			return ret;
949*4882a593Smuzhiyun 
950*4882a593Smuzhiyun 		mux_conf->id		= of_pinconf & MUX_PIN_ID_MASK;
951*4882a593Smuzhiyun 		mux_conf->port		= RZA1_PIN_ID_TO_PORT(mux_conf->id);
952*4882a593Smuzhiyun 		mux_conf->pin		= RZA1_PIN_ID_TO_PIN(mux_conf->id);
953*4882a593Smuzhiyun 		mux_conf->mux_func	= MUX_FUNC(of_pinconf);
954*4882a593Smuzhiyun 		mux_conf->mux_flags	= pinmux_flags;
955*4882a593Smuzhiyun 
956*4882a593Smuzhiyun 		if (mux_conf->port >= RZA1_NPORTS ||
957*4882a593Smuzhiyun 		    mux_conf->pin >= RZA1_PINS_PER_PORT) {
958*4882a593Smuzhiyun 			dev_err(rza1_pctl->dev,
959*4882a593Smuzhiyun 				"Wrong port %u pin %u for %s property\n",
960*4882a593Smuzhiyun 				mux_conf->port, mux_conf->pin, prop_name);
961*4882a593Smuzhiyun 			return -EINVAL;
962*4882a593Smuzhiyun 		}
963*4882a593Smuzhiyun 
964*4882a593Smuzhiyun 		grpins[i] = mux_conf->id;
965*4882a593Smuzhiyun 	}
966*4882a593Smuzhiyun 
967*4882a593Smuzhiyun 	return npins;
968*4882a593Smuzhiyun }
969*4882a593Smuzhiyun 
970*4882a593Smuzhiyun /**
971*4882a593Smuzhiyun  * rza1_dt_node_to_map() - map a pin mux node to a function/group
972*4882a593Smuzhiyun  *
973*4882a593Smuzhiyun  * Parse and register a pin mux function.
974*4882a593Smuzhiyun  *
975*4882a593Smuzhiyun  * @pctldev: pin controller device
976*4882a593Smuzhiyun  * @np: device tree node to parse
977*4882a593Smuzhiyun  * @map: pointer to pin map (output)
978*4882a593Smuzhiyun  * @num_maps: number of collected maps (output)
979*4882a593Smuzhiyun  */
rza1_dt_node_to_map(struct pinctrl_dev * pctldev,struct device_node * np,struct pinctrl_map ** map,unsigned int * num_maps)980*4882a593Smuzhiyun static int rza1_dt_node_to_map(struct pinctrl_dev *pctldev,
981*4882a593Smuzhiyun 			       struct device_node *np,
982*4882a593Smuzhiyun 			       struct pinctrl_map **map,
983*4882a593Smuzhiyun 			       unsigned int *num_maps)
984*4882a593Smuzhiyun {
985*4882a593Smuzhiyun 	struct rza1_pinctrl *rza1_pctl = pinctrl_dev_get_drvdata(pctldev);
986*4882a593Smuzhiyun 	struct rza1_mux_conf *mux_confs, *mux_conf;
987*4882a593Smuzhiyun 	unsigned int *grpins, *grpin;
988*4882a593Smuzhiyun 	struct device_node *child;
989*4882a593Smuzhiyun 	const char *grpname;
990*4882a593Smuzhiyun 	const char **fngrps;
991*4882a593Smuzhiyun 	int ret, npins;
992*4882a593Smuzhiyun 	int gsel, fsel;
993*4882a593Smuzhiyun 
994*4882a593Smuzhiyun 	npins = rza1_dt_node_pin_count(np);
995*4882a593Smuzhiyun 	if (npins < 0) {
996*4882a593Smuzhiyun 		dev_err(rza1_pctl->dev, "invalid pinmux node structure\n");
997*4882a593Smuzhiyun 		return -EINVAL;
998*4882a593Smuzhiyun 	}
999*4882a593Smuzhiyun 
1000*4882a593Smuzhiyun 	/*
1001*4882a593Smuzhiyun 	 * Functions are made of 1 group only;
1002*4882a593Smuzhiyun 	 * in fact, functions and groups are identical for this pin controller
1003*4882a593Smuzhiyun 	 * except that functions carry an array of per-pin mux configuration
1004*4882a593Smuzhiyun 	 * settings.
1005*4882a593Smuzhiyun 	 */
1006*4882a593Smuzhiyun 	mux_confs = devm_kcalloc(rza1_pctl->dev, npins, sizeof(*mux_confs),
1007*4882a593Smuzhiyun 				 GFP_KERNEL);
1008*4882a593Smuzhiyun 	grpins = devm_kcalloc(rza1_pctl->dev, npins, sizeof(*grpins),
1009*4882a593Smuzhiyun 			      GFP_KERNEL);
1010*4882a593Smuzhiyun 	fngrps = devm_kzalloc(rza1_pctl->dev, sizeof(*fngrps), GFP_KERNEL);
1011*4882a593Smuzhiyun 
1012*4882a593Smuzhiyun 	if (!mux_confs || !grpins || !fngrps)
1013*4882a593Smuzhiyun 		return -ENOMEM;
1014*4882a593Smuzhiyun 
1015*4882a593Smuzhiyun 	/*
1016*4882a593Smuzhiyun 	 * Parse the pinmux node.
1017*4882a593Smuzhiyun 	 * If the node does not contain "pinmux" property (-ENOENT)
1018*4882a593Smuzhiyun 	 * that property shall be specified in all its children sub-nodes.
1019*4882a593Smuzhiyun 	 */
1020*4882a593Smuzhiyun 	mux_conf = &mux_confs[0];
1021*4882a593Smuzhiyun 	grpin = &grpins[0];
1022*4882a593Smuzhiyun 
1023*4882a593Smuzhiyun 	ret = rza1_parse_pinmux_node(rza1_pctl, np, mux_conf, grpin);
1024*4882a593Smuzhiyun 	if (ret == -ENOENT)
1025*4882a593Smuzhiyun 		for_each_child_of_node(np, child) {
1026*4882a593Smuzhiyun 			ret = rza1_parse_pinmux_node(rza1_pctl, child, mux_conf,
1027*4882a593Smuzhiyun 						     grpin);
1028*4882a593Smuzhiyun 			if (ret < 0) {
1029*4882a593Smuzhiyun 				of_node_put(child);
1030*4882a593Smuzhiyun 				return ret;
1031*4882a593Smuzhiyun 			}
1032*4882a593Smuzhiyun 
1033*4882a593Smuzhiyun 			grpin += ret;
1034*4882a593Smuzhiyun 			mux_conf += ret;
1035*4882a593Smuzhiyun 		}
1036*4882a593Smuzhiyun 	else if (ret < 0)
1037*4882a593Smuzhiyun 		return ret;
1038*4882a593Smuzhiyun 
1039*4882a593Smuzhiyun 	/* Register pin group and function name to pinctrl_generic */
1040*4882a593Smuzhiyun 	grpname	= np->name;
1041*4882a593Smuzhiyun 	fngrps[0] = grpname;
1042*4882a593Smuzhiyun 
1043*4882a593Smuzhiyun 	mutex_lock(&rza1_pctl->mutex);
1044*4882a593Smuzhiyun 	gsel = pinctrl_generic_add_group(pctldev, grpname, grpins, npins,
1045*4882a593Smuzhiyun 					 NULL);
1046*4882a593Smuzhiyun 	if (gsel < 0) {
1047*4882a593Smuzhiyun 		mutex_unlock(&rza1_pctl->mutex);
1048*4882a593Smuzhiyun 		return gsel;
1049*4882a593Smuzhiyun 	}
1050*4882a593Smuzhiyun 
1051*4882a593Smuzhiyun 	fsel = pinmux_generic_add_function(pctldev, grpname, fngrps, 1,
1052*4882a593Smuzhiyun 					   mux_confs);
1053*4882a593Smuzhiyun 	if (fsel < 0) {
1054*4882a593Smuzhiyun 		ret = fsel;
1055*4882a593Smuzhiyun 		goto remove_group;
1056*4882a593Smuzhiyun 	}
1057*4882a593Smuzhiyun 
1058*4882a593Smuzhiyun 	dev_info(rza1_pctl->dev, "Parsed function and group %s with %d pins\n",
1059*4882a593Smuzhiyun 				 grpname, npins);
1060*4882a593Smuzhiyun 
1061*4882a593Smuzhiyun 	/* Create map where to retrieve function and mux settings from */
1062*4882a593Smuzhiyun 	*num_maps = 0;
1063*4882a593Smuzhiyun 	*map = kzalloc(sizeof(**map), GFP_KERNEL);
1064*4882a593Smuzhiyun 	if (!*map) {
1065*4882a593Smuzhiyun 		ret = -ENOMEM;
1066*4882a593Smuzhiyun 		goto remove_function;
1067*4882a593Smuzhiyun 	}
1068*4882a593Smuzhiyun 
1069*4882a593Smuzhiyun 	(*map)->type = PIN_MAP_TYPE_MUX_GROUP;
1070*4882a593Smuzhiyun 	(*map)->data.mux.group = np->name;
1071*4882a593Smuzhiyun 	(*map)->data.mux.function = np->name;
1072*4882a593Smuzhiyun 	*num_maps = 1;
1073*4882a593Smuzhiyun 	mutex_unlock(&rza1_pctl->mutex);
1074*4882a593Smuzhiyun 
1075*4882a593Smuzhiyun 	return 0;
1076*4882a593Smuzhiyun 
1077*4882a593Smuzhiyun remove_function:
1078*4882a593Smuzhiyun 	pinmux_generic_remove_function(pctldev, fsel);
1079*4882a593Smuzhiyun 
1080*4882a593Smuzhiyun remove_group:
1081*4882a593Smuzhiyun 	pinctrl_generic_remove_group(pctldev, gsel);
1082*4882a593Smuzhiyun 	mutex_unlock(&rza1_pctl->mutex);
1083*4882a593Smuzhiyun 
1084*4882a593Smuzhiyun 	dev_info(rza1_pctl->dev, "Unable to parse function and group %s\n",
1085*4882a593Smuzhiyun 				 grpname);
1086*4882a593Smuzhiyun 
1087*4882a593Smuzhiyun 	return ret;
1088*4882a593Smuzhiyun }
1089*4882a593Smuzhiyun 
rza1_dt_free_map(struct pinctrl_dev * pctldev,struct pinctrl_map * map,unsigned int num_maps)1090*4882a593Smuzhiyun static void rza1_dt_free_map(struct pinctrl_dev *pctldev,
1091*4882a593Smuzhiyun 			     struct pinctrl_map *map, unsigned int num_maps)
1092*4882a593Smuzhiyun {
1093*4882a593Smuzhiyun 	kfree(map);
1094*4882a593Smuzhiyun }
1095*4882a593Smuzhiyun 
1096*4882a593Smuzhiyun static const struct pinctrl_ops rza1_pinctrl_ops = {
1097*4882a593Smuzhiyun 	.get_groups_count	= pinctrl_generic_get_group_count,
1098*4882a593Smuzhiyun 	.get_group_name		= pinctrl_generic_get_group_name,
1099*4882a593Smuzhiyun 	.get_group_pins		= pinctrl_generic_get_group_pins,
1100*4882a593Smuzhiyun 	.dt_node_to_map		= rza1_dt_node_to_map,
1101*4882a593Smuzhiyun 	.dt_free_map		= rza1_dt_free_map,
1102*4882a593Smuzhiyun };
1103*4882a593Smuzhiyun 
1104*4882a593Smuzhiyun /* ----------------------------------------------------------------------------
1105*4882a593Smuzhiyun  * pinmux operations
1106*4882a593Smuzhiyun  */
1107*4882a593Smuzhiyun 
1108*4882a593Smuzhiyun /**
1109*4882a593Smuzhiyun  * rza1_set_mux() - retrieve pins from a group and apply their mux settings
1110*4882a593Smuzhiyun  *
1111*4882a593Smuzhiyun  * @pctldev: pin controller device
1112*4882a593Smuzhiyun  * @selector: function selector
1113*4882a593Smuzhiyun  * @group: group selector
1114*4882a593Smuzhiyun  */
rza1_set_mux(struct pinctrl_dev * pctldev,unsigned int selector,unsigned int group)1115*4882a593Smuzhiyun static int rza1_set_mux(struct pinctrl_dev *pctldev, unsigned int selector,
1116*4882a593Smuzhiyun 			   unsigned int group)
1117*4882a593Smuzhiyun {
1118*4882a593Smuzhiyun 	struct rza1_pinctrl *rza1_pctl = pinctrl_dev_get_drvdata(pctldev);
1119*4882a593Smuzhiyun 	struct rza1_mux_conf *mux_confs;
1120*4882a593Smuzhiyun 	struct function_desc *func;
1121*4882a593Smuzhiyun 	struct group_desc *grp;
1122*4882a593Smuzhiyun 	int i;
1123*4882a593Smuzhiyun 
1124*4882a593Smuzhiyun 	grp = pinctrl_generic_get_group(pctldev, group);
1125*4882a593Smuzhiyun 	if (!grp)
1126*4882a593Smuzhiyun 		return -EINVAL;
1127*4882a593Smuzhiyun 
1128*4882a593Smuzhiyun 	func = pinmux_generic_get_function(pctldev, selector);
1129*4882a593Smuzhiyun 	if (!func)
1130*4882a593Smuzhiyun 		return -EINVAL;
1131*4882a593Smuzhiyun 
1132*4882a593Smuzhiyun 	mux_confs = (struct rza1_mux_conf *)func->data;
1133*4882a593Smuzhiyun 	for (i = 0; i < grp->num_pins; ++i) {
1134*4882a593Smuzhiyun 		int ret;
1135*4882a593Smuzhiyun 
1136*4882a593Smuzhiyun 		ret = rza1_pin_mux_single(rza1_pctl, &mux_confs[i]);
1137*4882a593Smuzhiyun 		if (ret)
1138*4882a593Smuzhiyun 			return ret;
1139*4882a593Smuzhiyun 	}
1140*4882a593Smuzhiyun 
1141*4882a593Smuzhiyun 	return 0;
1142*4882a593Smuzhiyun }
1143*4882a593Smuzhiyun 
1144*4882a593Smuzhiyun static const struct pinmux_ops rza1_pinmux_ops = {
1145*4882a593Smuzhiyun 	.get_functions_count	= pinmux_generic_get_function_count,
1146*4882a593Smuzhiyun 	.get_function_name	= pinmux_generic_get_function_name,
1147*4882a593Smuzhiyun 	.get_function_groups	= pinmux_generic_get_function_groups,
1148*4882a593Smuzhiyun 	.set_mux		= rza1_set_mux,
1149*4882a593Smuzhiyun 	.strict			= true,
1150*4882a593Smuzhiyun };
1151*4882a593Smuzhiyun 
1152*4882a593Smuzhiyun /* ----------------------------------------------------------------------------
1153*4882a593Smuzhiyun  * RZ/A1 pin controller driver operations
1154*4882a593Smuzhiyun  */
1155*4882a593Smuzhiyun 
rza1_count_gpio_chips(struct device_node * np)1156*4882a593Smuzhiyun static unsigned int rza1_count_gpio_chips(struct device_node *np)
1157*4882a593Smuzhiyun {
1158*4882a593Smuzhiyun 	struct device_node *child;
1159*4882a593Smuzhiyun 	unsigned int count = 0;
1160*4882a593Smuzhiyun 
1161*4882a593Smuzhiyun 	for_each_child_of_node(np, child) {
1162*4882a593Smuzhiyun 		if (!of_property_read_bool(child, "gpio-controller"))
1163*4882a593Smuzhiyun 			continue;
1164*4882a593Smuzhiyun 
1165*4882a593Smuzhiyun 		count++;
1166*4882a593Smuzhiyun 	}
1167*4882a593Smuzhiyun 
1168*4882a593Smuzhiyun 	return count;
1169*4882a593Smuzhiyun }
1170*4882a593Smuzhiyun 
1171*4882a593Smuzhiyun /**
1172*4882a593Smuzhiyun  * rza1_parse_gpiochip() - parse and register a gpio chip and pin range
1173*4882a593Smuzhiyun  *
1174*4882a593Smuzhiyun  * The gpio controller subnode shall provide a "gpio-ranges" list property as
1175*4882a593Smuzhiyun  * defined by gpio device tree binding documentation.
1176*4882a593Smuzhiyun  *
1177*4882a593Smuzhiyun  * @rza1_pctl: RZ/A1 pin controller device
1178*4882a593Smuzhiyun  * @np: of gpio-controller node
1179*4882a593Smuzhiyun  * @chip: gpio chip to register to gpiolib
1180*4882a593Smuzhiyun  * @range: pin range to register to pinctrl core
1181*4882a593Smuzhiyun  */
rza1_parse_gpiochip(struct rza1_pinctrl * rza1_pctl,struct device_node * np,struct gpio_chip * chip,struct pinctrl_gpio_range * range)1182*4882a593Smuzhiyun static int rza1_parse_gpiochip(struct rza1_pinctrl *rza1_pctl,
1183*4882a593Smuzhiyun 			       struct device_node *np,
1184*4882a593Smuzhiyun 			       struct gpio_chip *chip,
1185*4882a593Smuzhiyun 			       struct pinctrl_gpio_range *range)
1186*4882a593Smuzhiyun {
1187*4882a593Smuzhiyun 	const char *list_name = "gpio-ranges";
1188*4882a593Smuzhiyun 	struct of_phandle_args of_args;
1189*4882a593Smuzhiyun 	unsigned int gpioport;
1190*4882a593Smuzhiyun 	u32 pinctrl_base;
1191*4882a593Smuzhiyun 	int ret;
1192*4882a593Smuzhiyun 
1193*4882a593Smuzhiyun 	ret = of_parse_phandle_with_fixed_args(np, list_name, 3, 0, &of_args);
1194*4882a593Smuzhiyun 	if (ret) {
1195*4882a593Smuzhiyun 		dev_err(rza1_pctl->dev, "Unable to parse %s list property\n",
1196*4882a593Smuzhiyun 			list_name);
1197*4882a593Smuzhiyun 		return ret;
1198*4882a593Smuzhiyun 	}
1199*4882a593Smuzhiyun 
1200*4882a593Smuzhiyun 	/*
1201*4882a593Smuzhiyun 	 * Find out on which port this gpio-chip maps to by inspecting the
1202*4882a593Smuzhiyun 	 * second argument of the "gpio-ranges" property.
1203*4882a593Smuzhiyun 	 */
1204*4882a593Smuzhiyun 	pinctrl_base = of_args.args[1];
1205*4882a593Smuzhiyun 	gpioport = RZA1_PIN_ID_TO_PORT(pinctrl_base);
1206*4882a593Smuzhiyun 	if (gpioport >= RZA1_NPORTS) {
1207*4882a593Smuzhiyun 		dev_err(rza1_pctl->dev,
1208*4882a593Smuzhiyun 			"Invalid values in property %s\n", list_name);
1209*4882a593Smuzhiyun 		return -EINVAL;
1210*4882a593Smuzhiyun 	}
1211*4882a593Smuzhiyun 
1212*4882a593Smuzhiyun 	*chip		= rza1_gpiochip_template;
1213*4882a593Smuzhiyun 	chip->base	= -1;
1214*4882a593Smuzhiyun 	chip->label	= devm_kasprintf(rza1_pctl->dev, GFP_KERNEL, "%pOFn",
1215*4882a593Smuzhiyun 					 np);
1216*4882a593Smuzhiyun 	if (!chip->label)
1217*4882a593Smuzhiyun 		return -ENOMEM;
1218*4882a593Smuzhiyun 
1219*4882a593Smuzhiyun 	chip->ngpio	= of_args.args[2];
1220*4882a593Smuzhiyun 	chip->of_node	= np;
1221*4882a593Smuzhiyun 	chip->parent	= rza1_pctl->dev;
1222*4882a593Smuzhiyun 
1223*4882a593Smuzhiyun 	range->id	= gpioport;
1224*4882a593Smuzhiyun 	range->name	= chip->label;
1225*4882a593Smuzhiyun 	range->pin_base	= range->base = pinctrl_base;
1226*4882a593Smuzhiyun 	range->npins	= of_args.args[2];
1227*4882a593Smuzhiyun 	range->gc	= chip;
1228*4882a593Smuzhiyun 
1229*4882a593Smuzhiyun 	ret = devm_gpiochip_add_data(rza1_pctl->dev, chip,
1230*4882a593Smuzhiyun 				     &rza1_pctl->ports[gpioport]);
1231*4882a593Smuzhiyun 	if (ret)
1232*4882a593Smuzhiyun 		return ret;
1233*4882a593Smuzhiyun 
1234*4882a593Smuzhiyun 	pinctrl_add_gpio_range(rza1_pctl->pctl, range);
1235*4882a593Smuzhiyun 
1236*4882a593Smuzhiyun 	dev_dbg(rza1_pctl->dev, "Parsed gpiochip %s with %d pins\n",
1237*4882a593Smuzhiyun 		chip->label, chip->ngpio);
1238*4882a593Smuzhiyun 
1239*4882a593Smuzhiyun 	return 0;
1240*4882a593Smuzhiyun }
1241*4882a593Smuzhiyun 
1242*4882a593Smuzhiyun /**
1243*4882a593Smuzhiyun  * rza1_gpio_register() - parse DT to collect gpio-chips and gpio-ranges
1244*4882a593Smuzhiyun  *
1245*4882a593Smuzhiyun  * @rza1_pctl: RZ/A1 pin controller device
1246*4882a593Smuzhiyun  */
rza1_gpio_register(struct rza1_pinctrl * rza1_pctl)1247*4882a593Smuzhiyun static int rza1_gpio_register(struct rza1_pinctrl *rza1_pctl)
1248*4882a593Smuzhiyun {
1249*4882a593Smuzhiyun 	struct device_node *np = rza1_pctl->dev->of_node;
1250*4882a593Smuzhiyun 	struct pinctrl_gpio_range *gpio_ranges;
1251*4882a593Smuzhiyun 	struct gpio_chip *gpio_chips;
1252*4882a593Smuzhiyun 	struct device_node *child;
1253*4882a593Smuzhiyun 	unsigned int ngpiochips;
1254*4882a593Smuzhiyun 	unsigned int i;
1255*4882a593Smuzhiyun 	int ret;
1256*4882a593Smuzhiyun 
1257*4882a593Smuzhiyun 	ngpiochips = rza1_count_gpio_chips(np);
1258*4882a593Smuzhiyun 	if (ngpiochips == 0) {
1259*4882a593Smuzhiyun 		dev_dbg(rza1_pctl->dev, "No gpiochip registered\n");
1260*4882a593Smuzhiyun 		return 0;
1261*4882a593Smuzhiyun 	}
1262*4882a593Smuzhiyun 
1263*4882a593Smuzhiyun 	gpio_chips = devm_kcalloc(rza1_pctl->dev, ngpiochips,
1264*4882a593Smuzhiyun 				  sizeof(*gpio_chips), GFP_KERNEL);
1265*4882a593Smuzhiyun 	gpio_ranges = devm_kcalloc(rza1_pctl->dev, ngpiochips,
1266*4882a593Smuzhiyun 				   sizeof(*gpio_ranges), GFP_KERNEL);
1267*4882a593Smuzhiyun 	if (!gpio_chips || !gpio_ranges)
1268*4882a593Smuzhiyun 		return -ENOMEM;
1269*4882a593Smuzhiyun 
1270*4882a593Smuzhiyun 	i = 0;
1271*4882a593Smuzhiyun 	for_each_child_of_node(np, child) {
1272*4882a593Smuzhiyun 		if (!of_property_read_bool(child, "gpio-controller"))
1273*4882a593Smuzhiyun 			continue;
1274*4882a593Smuzhiyun 
1275*4882a593Smuzhiyun 		ret = rza1_parse_gpiochip(rza1_pctl, child, &gpio_chips[i],
1276*4882a593Smuzhiyun 					  &gpio_ranges[i]);
1277*4882a593Smuzhiyun 		if (ret) {
1278*4882a593Smuzhiyun 			of_node_put(child);
1279*4882a593Smuzhiyun 			return ret;
1280*4882a593Smuzhiyun 		}
1281*4882a593Smuzhiyun 
1282*4882a593Smuzhiyun 		++i;
1283*4882a593Smuzhiyun 	}
1284*4882a593Smuzhiyun 
1285*4882a593Smuzhiyun 	dev_info(rza1_pctl->dev, "Registered %u gpio controllers\n", i);
1286*4882a593Smuzhiyun 
1287*4882a593Smuzhiyun 	return 0;
1288*4882a593Smuzhiyun }
1289*4882a593Smuzhiyun 
1290*4882a593Smuzhiyun /**
1291*4882a593Smuzhiyun  * rza1_pinctrl_register() - Enumerate pins, ports and gpiochips; register
1292*4882a593Smuzhiyun  *			     them to pinctrl and gpio cores.
1293*4882a593Smuzhiyun  *
1294*4882a593Smuzhiyun  * @rza1_pctl: RZ/A1 pin controller device
1295*4882a593Smuzhiyun  */
rza1_pinctrl_register(struct rza1_pinctrl * rza1_pctl)1296*4882a593Smuzhiyun static int rza1_pinctrl_register(struct rza1_pinctrl *rza1_pctl)
1297*4882a593Smuzhiyun {
1298*4882a593Smuzhiyun 	struct pinctrl_pin_desc *pins;
1299*4882a593Smuzhiyun 	struct rza1_port *ports;
1300*4882a593Smuzhiyun 	unsigned int i;
1301*4882a593Smuzhiyun 	int ret;
1302*4882a593Smuzhiyun 
1303*4882a593Smuzhiyun 	pins = devm_kcalloc(rza1_pctl->dev, RZA1_NPINS, sizeof(*pins),
1304*4882a593Smuzhiyun 			    GFP_KERNEL);
1305*4882a593Smuzhiyun 	ports = devm_kcalloc(rza1_pctl->dev, RZA1_NPORTS, sizeof(*ports),
1306*4882a593Smuzhiyun 			     GFP_KERNEL);
1307*4882a593Smuzhiyun 	if (!pins || !ports)
1308*4882a593Smuzhiyun 		return -ENOMEM;
1309*4882a593Smuzhiyun 
1310*4882a593Smuzhiyun 	rza1_pctl->pins		= pins;
1311*4882a593Smuzhiyun 	rza1_pctl->desc.pins	= pins;
1312*4882a593Smuzhiyun 	rza1_pctl->desc.npins	= RZA1_NPINS;
1313*4882a593Smuzhiyun 	rza1_pctl->ports	= ports;
1314*4882a593Smuzhiyun 
1315*4882a593Smuzhiyun 	for (i = 0; i < RZA1_NPINS; ++i) {
1316*4882a593Smuzhiyun 		unsigned int pin = RZA1_PIN_ID_TO_PIN(i);
1317*4882a593Smuzhiyun 		unsigned int port = RZA1_PIN_ID_TO_PORT(i);
1318*4882a593Smuzhiyun 
1319*4882a593Smuzhiyun 		pins[i].number = i;
1320*4882a593Smuzhiyun 		pins[i].name = devm_kasprintf(rza1_pctl->dev, GFP_KERNEL,
1321*4882a593Smuzhiyun 					      "P%u-%u", port, pin);
1322*4882a593Smuzhiyun 		if (!pins[i].name)
1323*4882a593Smuzhiyun 			return -ENOMEM;
1324*4882a593Smuzhiyun 
1325*4882a593Smuzhiyun 		if (i % RZA1_PINS_PER_PORT == 0) {
1326*4882a593Smuzhiyun 			/*
1327*4882a593Smuzhiyun 			 * Setup ports;
1328*4882a593Smuzhiyun 			 * they provide per-port lock and logical base address.
1329*4882a593Smuzhiyun 			 */
1330*4882a593Smuzhiyun 			unsigned int port_id = RZA1_PIN_ID_TO_PORT(i);
1331*4882a593Smuzhiyun 
1332*4882a593Smuzhiyun 			ports[port_id].id	= port_id;
1333*4882a593Smuzhiyun 			ports[port_id].base	= rza1_pctl->base;
1334*4882a593Smuzhiyun 			ports[port_id].pins	= &pins[i];
1335*4882a593Smuzhiyun 			spin_lock_init(&ports[port_id].lock);
1336*4882a593Smuzhiyun 		}
1337*4882a593Smuzhiyun 	}
1338*4882a593Smuzhiyun 
1339*4882a593Smuzhiyun 	ret = devm_pinctrl_register_and_init(rza1_pctl->dev, &rza1_pctl->desc,
1340*4882a593Smuzhiyun 					     rza1_pctl, &rza1_pctl->pctl);
1341*4882a593Smuzhiyun 	if (ret) {
1342*4882a593Smuzhiyun 		dev_err(rza1_pctl->dev,
1343*4882a593Smuzhiyun 			"RZ/A1 pin controller registration failed\n");
1344*4882a593Smuzhiyun 		return ret;
1345*4882a593Smuzhiyun 	}
1346*4882a593Smuzhiyun 
1347*4882a593Smuzhiyun 	ret = pinctrl_enable(rza1_pctl->pctl);
1348*4882a593Smuzhiyun 	if (ret) {
1349*4882a593Smuzhiyun 		dev_err(rza1_pctl->dev,
1350*4882a593Smuzhiyun 			"RZ/A1 pin controller failed to start\n");
1351*4882a593Smuzhiyun 		return ret;
1352*4882a593Smuzhiyun 	}
1353*4882a593Smuzhiyun 
1354*4882a593Smuzhiyun 	ret = rza1_gpio_register(rza1_pctl);
1355*4882a593Smuzhiyun 	if (ret) {
1356*4882a593Smuzhiyun 		dev_err(rza1_pctl->dev, "RZ/A1 GPIO registration failed\n");
1357*4882a593Smuzhiyun 		return ret;
1358*4882a593Smuzhiyun 	}
1359*4882a593Smuzhiyun 
1360*4882a593Smuzhiyun 	return 0;
1361*4882a593Smuzhiyun }
1362*4882a593Smuzhiyun 
rza1_pinctrl_probe(struct platform_device * pdev)1363*4882a593Smuzhiyun static int rza1_pinctrl_probe(struct platform_device *pdev)
1364*4882a593Smuzhiyun {
1365*4882a593Smuzhiyun 	struct rza1_pinctrl *rza1_pctl;
1366*4882a593Smuzhiyun 	int ret;
1367*4882a593Smuzhiyun 
1368*4882a593Smuzhiyun 	rza1_pctl = devm_kzalloc(&pdev->dev, sizeof(*rza1_pctl), GFP_KERNEL);
1369*4882a593Smuzhiyun 	if (!rza1_pctl)
1370*4882a593Smuzhiyun 		return -ENOMEM;
1371*4882a593Smuzhiyun 
1372*4882a593Smuzhiyun 	rza1_pctl->dev = &pdev->dev;
1373*4882a593Smuzhiyun 
1374*4882a593Smuzhiyun 	rza1_pctl->base = devm_platform_ioremap_resource(pdev, 0);
1375*4882a593Smuzhiyun 	if (IS_ERR(rza1_pctl->base))
1376*4882a593Smuzhiyun 		return PTR_ERR(rza1_pctl->base);
1377*4882a593Smuzhiyun 
1378*4882a593Smuzhiyun 	mutex_init(&rza1_pctl->mutex);
1379*4882a593Smuzhiyun 
1380*4882a593Smuzhiyun 	platform_set_drvdata(pdev, rza1_pctl);
1381*4882a593Smuzhiyun 
1382*4882a593Smuzhiyun 	rza1_pctl->desc.name	= DRIVER_NAME;
1383*4882a593Smuzhiyun 	rza1_pctl->desc.pctlops	= &rza1_pinctrl_ops;
1384*4882a593Smuzhiyun 	rza1_pctl->desc.pmxops	= &rza1_pinmux_ops;
1385*4882a593Smuzhiyun 	rza1_pctl->desc.owner	= THIS_MODULE;
1386*4882a593Smuzhiyun 	rza1_pctl->data		= of_device_get_match_data(&pdev->dev);
1387*4882a593Smuzhiyun 
1388*4882a593Smuzhiyun 	ret = rza1_pinctrl_register(rza1_pctl);
1389*4882a593Smuzhiyun 	if (ret)
1390*4882a593Smuzhiyun 		return ret;
1391*4882a593Smuzhiyun 
1392*4882a593Smuzhiyun 	dev_info(&pdev->dev,
1393*4882a593Smuzhiyun 		 "RZ/A1 pin controller and gpio successfully registered\n");
1394*4882a593Smuzhiyun 
1395*4882a593Smuzhiyun 	return 0;
1396*4882a593Smuzhiyun }
1397*4882a593Smuzhiyun 
1398*4882a593Smuzhiyun static const struct of_device_id rza1_pinctrl_of_match[] = {
1399*4882a593Smuzhiyun 	{
1400*4882a593Smuzhiyun 		/* RZ/A1H, RZ/A1M */
1401*4882a593Smuzhiyun 		.compatible	= "renesas,r7s72100-ports",
1402*4882a593Smuzhiyun 		.data		= &rza1h_pmx_conf,
1403*4882a593Smuzhiyun 	},
1404*4882a593Smuzhiyun 	{
1405*4882a593Smuzhiyun 		/* RZ/A1L */
1406*4882a593Smuzhiyun 		.compatible	= "renesas,r7s72102-ports",
1407*4882a593Smuzhiyun 		.data		= &rza1l_pmx_conf,
1408*4882a593Smuzhiyun 	},
1409*4882a593Smuzhiyun 	{ }
1410*4882a593Smuzhiyun };
1411*4882a593Smuzhiyun 
1412*4882a593Smuzhiyun static struct platform_driver rza1_pinctrl_driver = {
1413*4882a593Smuzhiyun 	.driver = {
1414*4882a593Smuzhiyun 		.name = DRIVER_NAME,
1415*4882a593Smuzhiyun 		.of_match_table = rza1_pinctrl_of_match,
1416*4882a593Smuzhiyun 	},
1417*4882a593Smuzhiyun 	.probe = rza1_pinctrl_probe,
1418*4882a593Smuzhiyun };
1419*4882a593Smuzhiyun 
rza1_pinctrl_init(void)1420*4882a593Smuzhiyun static int __init rza1_pinctrl_init(void)
1421*4882a593Smuzhiyun {
1422*4882a593Smuzhiyun 	return platform_driver_register(&rza1_pinctrl_driver);
1423*4882a593Smuzhiyun }
1424*4882a593Smuzhiyun core_initcall(rza1_pinctrl_init);
1425*4882a593Smuzhiyun 
1426*4882a593Smuzhiyun MODULE_AUTHOR("Jacopo Mondi <jacopo+renesas@jmondi.org");
1427*4882a593Smuzhiyun MODULE_DESCRIPTION("Pin and gpio controller driver for Reneas RZ/A1 SoC");
1428*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
1429