xref: /OK3568_Linux_fs/kernel/drivers/pinctrl/pinconf-generic.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Core driver for the generic pin config portions of the pin control subsystem
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2011 ST-Ericsson SA
6*4882a593Smuzhiyun  * Written on behalf of Linaro for ST-Ericsson
7*4882a593Smuzhiyun  *
8*4882a593Smuzhiyun  * Author: Linus Walleij <linus.walleij@linaro.org>
9*4882a593Smuzhiyun  */
10*4882a593Smuzhiyun 
11*4882a593Smuzhiyun #define pr_fmt(fmt) "generic pinconfig core: " fmt
12*4882a593Smuzhiyun 
13*4882a593Smuzhiyun #include <linux/kernel.h>
14*4882a593Smuzhiyun #include <linux/module.h>
15*4882a593Smuzhiyun #include <linux/init.h>
16*4882a593Smuzhiyun #include <linux/device.h>
17*4882a593Smuzhiyun #include <linux/slab.h>
18*4882a593Smuzhiyun #include <linux/debugfs.h>
19*4882a593Smuzhiyun #include <linux/seq_file.h>
20*4882a593Smuzhiyun #include <linux/pinctrl/pinctrl.h>
21*4882a593Smuzhiyun #include <linux/pinctrl/pinconf.h>
22*4882a593Smuzhiyun #include <linux/pinctrl/pinconf-generic.h>
23*4882a593Smuzhiyun #include <linux/of.h>
24*4882a593Smuzhiyun #include "core.h"
25*4882a593Smuzhiyun #include "pinconf.h"
26*4882a593Smuzhiyun #include "pinctrl-utils.h"
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun #ifdef CONFIG_DEBUG_FS
29*4882a593Smuzhiyun static const struct pin_config_item conf_items[] = {
30*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_BIAS_BUS_HOLD, "input bias bus hold", NULL, false),
31*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_BIAS_DISABLE, "input bias disabled", NULL, false),
32*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_BIAS_HIGH_IMPEDANCE, "input bias high impedance", NULL, false),
33*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_BIAS_PULL_DOWN, "input bias pull down", "ohms", true),
34*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_BIAS_PULL_PIN_DEFAULT,
35*4882a593Smuzhiyun 				"input bias pull to pin specific state", "ohms", true),
36*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_BIAS_PULL_UP, "input bias pull up", "ohms", true),
37*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_DRIVE_OPEN_DRAIN, "output drive open drain", NULL, false),
38*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_DRIVE_OPEN_SOURCE, "output drive open source", NULL, false),
39*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_DRIVE_PUSH_PULL, "output drive push pull", NULL, false),
40*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_DRIVE_STRENGTH, "output drive strength", "mA", true),
41*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_DRIVE_STRENGTH_UA, "output drive strength", "uA", true),
42*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_INPUT_DEBOUNCE, "input debounce", "usec", true),
43*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_INPUT_ENABLE, "input enabled", NULL, false),
44*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_INPUT_SCHMITT, "input schmitt trigger", NULL, false),
45*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_INPUT_SCHMITT_ENABLE, "input schmitt enabled", NULL, false),
46*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_LOW_POWER_MODE, "pin low power", "mode", true),
47*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_OUTPUT_ENABLE, "output enabled", NULL, false),
48*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_OUTPUT, "pin output", "level", true),
49*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_POWER_SOURCE, "pin power source", "selector", true),
50*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_SLEEP_HARDWARE_STATE, "sleep hardware state", NULL, false),
51*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_SLEW_RATE, "slew rate", NULL, true),
52*4882a593Smuzhiyun 	PCONFDUMP(PIN_CONFIG_SKEW_DELAY, "skew delay", NULL, true),
53*4882a593Smuzhiyun };
54*4882a593Smuzhiyun 
pinconf_generic_dump_one(struct pinctrl_dev * pctldev,struct seq_file * s,const char * gname,unsigned pin,const struct pin_config_item * items,int nitems,int * print_sep)55*4882a593Smuzhiyun static void pinconf_generic_dump_one(struct pinctrl_dev *pctldev,
56*4882a593Smuzhiyun 				     struct seq_file *s, const char *gname,
57*4882a593Smuzhiyun 				     unsigned pin,
58*4882a593Smuzhiyun 				     const struct pin_config_item *items,
59*4882a593Smuzhiyun 				     int nitems, int *print_sep)
60*4882a593Smuzhiyun {
61*4882a593Smuzhiyun 	int i;
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun 	for (i = 0; i < nitems; i++) {
64*4882a593Smuzhiyun 		unsigned long config;
65*4882a593Smuzhiyun 		int ret;
66*4882a593Smuzhiyun 
67*4882a593Smuzhiyun 		/* We want to check out this parameter */
68*4882a593Smuzhiyun 		config = pinconf_to_config_packed(items[i].param, 0);
69*4882a593Smuzhiyun 		if (gname)
70*4882a593Smuzhiyun 			ret = pin_config_group_get(dev_name(pctldev->dev),
71*4882a593Smuzhiyun 						   gname, &config);
72*4882a593Smuzhiyun 		else
73*4882a593Smuzhiyun 			ret = pin_config_get_for_pin(pctldev, pin, &config);
74*4882a593Smuzhiyun 		/* These are legal errors */
75*4882a593Smuzhiyun 		if (ret == -EINVAL || ret == -ENOTSUPP)
76*4882a593Smuzhiyun 			continue;
77*4882a593Smuzhiyun 		if (ret) {
78*4882a593Smuzhiyun 			seq_printf(s, "ERROR READING CONFIG SETTING %d ", i);
79*4882a593Smuzhiyun 			continue;
80*4882a593Smuzhiyun 		}
81*4882a593Smuzhiyun 		/* comma between multiple configs */
82*4882a593Smuzhiyun 		if (*print_sep)
83*4882a593Smuzhiyun 			seq_puts(s, ", ");
84*4882a593Smuzhiyun 		*print_sep = 1;
85*4882a593Smuzhiyun 		seq_puts(s, items[i].display);
86*4882a593Smuzhiyun 		/* Print unit if available */
87*4882a593Smuzhiyun 		if (items[i].has_arg) {
88*4882a593Smuzhiyun 			seq_printf(s, " (%u",
89*4882a593Smuzhiyun 				   pinconf_to_config_argument(config));
90*4882a593Smuzhiyun 			if (items[i].format)
91*4882a593Smuzhiyun 				seq_printf(s, " %s)", items[i].format);
92*4882a593Smuzhiyun 			else
93*4882a593Smuzhiyun 				seq_puts(s, ")");
94*4882a593Smuzhiyun 		}
95*4882a593Smuzhiyun 	}
96*4882a593Smuzhiyun }
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun /**
99*4882a593Smuzhiyun  * pinconf_generic_dump_pins - Print information about pin or group of pins
100*4882a593Smuzhiyun  * @pctldev:	Pincontrol device
101*4882a593Smuzhiyun  * @s:		File to print to
102*4882a593Smuzhiyun  * @gname:	Group name specifying pins
103*4882a593Smuzhiyun  * @pin:	Pin number specyfying pin
104*4882a593Smuzhiyun  *
105*4882a593Smuzhiyun  * Print the pinconf configuration for the requested pin(s) to @s. Pins can be
106*4882a593Smuzhiyun  * specified either by pin using @pin or by group using @gname. Only one needs
107*4882a593Smuzhiyun  * to be specified the other can be NULL/0.
108*4882a593Smuzhiyun  */
pinconf_generic_dump_pins(struct pinctrl_dev * pctldev,struct seq_file * s,const char * gname,unsigned pin)109*4882a593Smuzhiyun void pinconf_generic_dump_pins(struct pinctrl_dev *pctldev, struct seq_file *s,
110*4882a593Smuzhiyun 			       const char *gname, unsigned pin)
111*4882a593Smuzhiyun {
112*4882a593Smuzhiyun 	const struct pinconf_ops *ops = pctldev->desc->confops;
113*4882a593Smuzhiyun 	int print_sep = 0;
114*4882a593Smuzhiyun 
115*4882a593Smuzhiyun 	if (!ops->is_generic)
116*4882a593Smuzhiyun 		return;
117*4882a593Smuzhiyun 
118*4882a593Smuzhiyun 	/* generic parameters */
119*4882a593Smuzhiyun 	pinconf_generic_dump_one(pctldev, s, gname, pin, conf_items,
120*4882a593Smuzhiyun 				 ARRAY_SIZE(conf_items), &print_sep);
121*4882a593Smuzhiyun 	/* driver-specific parameters */
122*4882a593Smuzhiyun 	if (pctldev->desc->num_custom_params &&
123*4882a593Smuzhiyun 	    pctldev->desc->custom_conf_items)
124*4882a593Smuzhiyun 		pinconf_generic_dump_one(pctldev, s, gname, pin,
125*4882a593Smuzhiyun 					 pctldev->desc->custom_conf_items,
126*4882a593Smuzhiyun 					 pctldev->desc->num_custom_params,
127*4882a593Smuzhiyun 					 &print_sep);
128*4882a593Smuzhiyun }
129*4882a593Smuzhiyun 
pinconf_generic_dump_config(struct pinctrl_dev * pctldev,struct seq_file * s,unsigned long config)130*4882a593Smuzhiyun void pinconf_generic_dump_config(struct pinctrl_dev *pctldev,
131*4882a593Smuzhiyun 				 struct seq_file *s, unsigned long config)
132*4882a593Smuzhiyun {
133*4882a593Smuzhiyun 	int i;
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(conf_items); i++) {
136*4882a593Smuzhiyun 		if (pinconf_to_config_param(config) != conf_items[i].param)
137*4882a593Smuzhiyun 			continue;
138*4882a593Smuzhiyun 		seq_printf(s, "%s: 0x%x", conf_items[i].display,
139*4882a593Smuzhiyun 			   pinconf_to_config_argument(config));
140*4882a593Smuzhiyun 	}
141*4882a593Smuzhiyun 
142*4882a593Smuzhiyun 	if (!pctldev->desc->num_custom_params ||
143*4882a593Smuzhiyun 	    !pctldev->desc->custom_conf_items)
144*4882a593Smuzhiyun 		return;
145*4882a593Smuzhiyun 
146*4882a593Smuzhiyun 	for (i = 0; i < pctldev->desc->num_custom_params; i++) {
147*4882a593Smuzhiyun 		if (pinconf_to_config_param(config) !=
148*4882a593Smuzhiyun 		    pctldev->desc->custom_conf_items[i].param)
149*4882a593Smuzhiyun 			continue;
150*4882a593Smuzhiyun 		seq_printf(s, "%s: 0x%x",
151*4882a593Smuzhiyun 				pctldev->desc->custom_conf_items[i].display,
152*4882a593Smuzhiyun 				pinconf_to_config_argument(config));
153*4882a593Smuzhiyun 	}
154*4882a593Smuzhiyun }
155*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(pinconf_generic_dump_config);
156*4882a593Smuzhiyun #endif
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun #ifdef CONFIG_OF
159*4882a593Smuzhiyun static const struct pinconf_generic_params dt_params[] = {
160*4882a593Smuzhiyun 	{ "bias-bus-hold", PIN_CONFIG_BIAS_BUS_HOLD, 0 },
161*4882a593Smuzhiyun 	{ "bias-disable", PIN_CONFIG_BIAS_DISABLE, 0 },
162*4882a593Smuzhiyun 	{ "bias-high-impedance", PIN_CONFIG_BIAS_HIGH_IMPEDANCE, 0 },
163*4882a593Smuzhiyun 	{ "bias-pull-up", PIN_CONFIG_BIAS_PULL_UP, 1 },
164*4882a593Smuzhiyun 	{ "bias-pull-pin-default", PIN_CONFIG_BIAS_PULL_PIN_DEFAULT, 1 },
165*4882a593Smuzhiyun 	{ "bias-pull-down", PIN_CONFIG_BIAS_PULL_DOWN, 1 },
166*4882a593Smuzhiyun 	{ "drive-open-drain", PIN_CONFIG_DRIVE_OPEN_DRAIN, 0 },
167*4882a593Smuzhiyun 	{ "drive-open-source", PIN_CONFIG_DRIVE_OPEN_SOURCE, 0 },
168*4882a593Smuzhiyun 	{ "drive-push-pull", PIN_CONFIG_DRIVE_PUSH_PULL, 0 },
169*4882a593Smuzhiyun 	{ "drive-strength", PIN_CONFIG_DRIVE_STRENGTH, 0 },
170*4882a593Smuzhiyun 	{ "drive-strength-microamp", PIN_CONFIG_DRIVE_STRENGTH_UA, 0 },
171*4882a593Smuzhiyun 	{ "input-debounce", PIN_CONFIG_INPUT_DEBOUNCE, 0 },
172*4882a593Smuzhiyun 	{ "input-disable", PIN_CONFIG_INPUT_ENABLE, 0 },
173*4882a593Smuzhiyun 	{ "input-enable", PIN_CONFIG_INPUT_ENABLE, 1 },
174*4882a593Smuzhiyun 	{ "input-schmitt", PIN_CONFIG_INPUT_SCHMITT, 0 },
175*4882a593Smuzhiyun 	{ "input-schmitt-disable", PIN_CONFIG_INPUT_SCHMITT_ENABLE, 0 },
176*4882a593Smuzhiyun 	{ "input-schmitt-enable", PIN_CONFIG_INPUT_SCHMITT_ENABLE, 1 },
177*4882a593Smuzhiyun 	{ "low-power-disable", PIN_CONFIG_LOW_POWER_MODE, 0 },
178*4882a593Smuzhiyun 	{ "low-power-enable", PIN_CONFIG_LOW_POWER_MODE, 1 },
179*4882a593Smuzhiyun 	{ "output-disable", PIN_CONFIG_OUTPUT_ENABLE, 0 },
180*4882a593Smuzhiyun 	{ "output-enable", PIN_CONFIG_OUTPUT_ENABLE, 1 },
181*4882a593Smuzhiyun 	{ "output-high", PIN_CONFIG_OUTPUT, 1, },
182*4882a593Smuzhiyun 	{ "output-low", PIN_CONFIG_OUTPUT, 0, },
183*4882a593Smuzhiyun 	{ "power-source", PIN_CONFIG_POWER_SOURCE, 0 },
184*4882a593Smuzhiyun 	{ "sleep-hardware-state", PIN_CONFIG_SLEEP_HARDWARE_STATE, 0 },
185*4882a593Smuzhiyun 	{ "slew-rate", PIN_CONFIG_SLEW_RATE, 0 },
186*4882a593Smuzhiyun 	{ "skew-delay", PIN_CONFIG_SKEW_DELAY, 0 },
187*4882a593Smuzhiyun };
188*4882a593Smuzhiyun 
189*4882a593Smuzhiyun /**
190*4882a593Smuzhiyun  * parse_dt_cfg() - Parse DT pinconf parameters
191*4882a593Smuzhiyun  * @np:	DT node
192*4882a593Smuzhiyun  * @params:	Array of describing generic parameters
193*4882a593Smuzhiyun  * @count:	Number of entries in @params
194*4882a593Smuzhiyun  * @cfg:	Array of parsed config options
195*4882a593Smuzhiyun  * @ncfg:	Number of entries in @cfg
196*4882a593Smuzhiyun  *
197*4882a593Smuzhiyun  * Parse the config options described in @params from @np and puts the result
198*4882a593Smuzhiyun  * in @cfg. @cfg does not need to be empty, entries are added beginning at
199*4882a593Smuzhiyun  * @ncfg. @ncfg is updated to reflect the number of entries after parsing. @cfg
200*4882a593Smuzhiyun  * needs to have enough memory allocated to hold all possible entries.
201*4882a593Smuzhiyun  */
parse_dt_cfg(struct device_node * np,const struct pinconf_generic_params * params,unsigned int count,unsigned long * cfg,unsigned int * ncfg)202*4882a593Smuzhiyun static void parse_dt_cfg(struct device_node *np,
203*4882a593Smuzhiyun 			 const struct pinconf_generic_params *params,
204*4882a593Smuzhiyun 			 unsigned int count, unsigned long *cfg,
205*4882a593Smuzhiyun 			 unsigned int *ncfg)
206*4882a593Smuzhiyun {
207*4882a593Smuzhiyun 	int i;
208*4882a593Smuzhiyun 
209*4882a593Smuzhiyun 	for (i = 0; i < count; i++) {
210*4882a593Smuzhiyun 		u32 val;
211*4882a593Smuzhiyun 		int ret;
212*4882a593Smuzhiyun 		const struct pinconf_generic_params *par = &params[i];
213*4882a593Smuzhiyun 
214*4882a593Smuzhiyun 		ret = of_property_read_u32(np, par->property, &val);
215*4882a593Smuzhiyun 
216*4882a593Smuzhiyun 		/* property not found */
217*4882a593Smuzhiyun 		if (ret == -EINVAL)
218*4882a593Smuzhiyun 			continue;
219*4882a593Smuzhiyun 
220*4882a593Smuzhiyun 		/* use default value, when no value is specified */
221*4882a593Smuzhiyun 		if (ret)
222*4882a593Smuzhiyun 			val = par->default_value;
223*4882a593Smuzhiyun 
224*4882a593Smuzhiyun 		pr_debug("found %s with value %u\n", par->property, val);
225*4882a593Smuzhiyun 		cfg[*ncfg] = pinconf_to_config_packed(par->param, val);
226*4882a593Smuzhiyun 		(*ncfg)++;
227*4882a593Smuzhiyun 	}
228*4882a593Smuzhiyun }
229*4882a593Smuzhiyun 
230*4882a593Smuzhiyun /**
231*4882a593Smuzhiyun  * pinconf_generic_parse_dt_config()
232*4882a593Smuzhiyun  * parse the config properties into generic pinconfig values.
233*4882a593Smuzhiyun  * @np: node containing the pinconfig properties
234*4882a593Smuzhiyun  * @pctldev: pincontrol device
235*4882a593Smuzhiyun  * @configs: array with nconfigs entries containing the generic pinconf values
236*4882a593Smuzhiyun  *           must be freed when no longer necessary.
237*4882a593Smuzhiyun  * @nconfigs: number of configurations
238*4882a593Smuzhiyun  */
pinconf_generic_parse_dt_config(struct device_node * np,struct pinctrl_dev * pctldev,unsigned long ** configs,unsigned int * nconfigs)239*4882a593Smuzhiyun int pinconf_generic_parse_dt_config(struct device_node *np,
240*4882a593Smuzhiyun 				    struct pinctrl_dev *pctldev,
241*4882a593Smuzhiyun 				    unsigned long **configs,
242*4882a593Smuzhiyun 				    unsigned int *nconfigs)
243*4882a593Smuzhiyun {
244*4882a593Smuzhiyun 	unsigned long *cfg;
245*4882a593Smuzhiyun 	unsigned int max_cfg, ncfg = 0;
246*4882a593Smuzhiyun 	int ret;
247*4882a593Smuzhiyun 
248*4882a593Smuzhiyun 	if (!np)
249*4882a593Smuzhiyun 		return -EINVAL;
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 	/* allocate a temporary array big enough to hold one of each option */
252*4882a593Smuzhiyun 	max_cfg = ARRAY_SIZE(dt_params);
253*4882a593Smuzhiyun 	if (pctldev)
254*4882a593Smuzhiyun 		max_cfg += pctldev->desc->num_custom_params;
255*4882a593Smuzhiyun 	cfg = kcalloc(max_cfg, sizeof(*cfg), GFP_KERNEL);
256*4882a593Smuzhiyun 	if (!cfg)
257*4882a593Smuzhiyun 		return -ENOMEM;
258*4882a593Smuzhiyun 
259*4882a593Smuzhiyun 	parse_dt_cfg(np, dt_params, ARRAY_SIZE(dt_params), cfg, &ncfg);
260*4882a593Smuzhiyun 	if (pctldev && pctldev->desc->num_custom_params &&
261*4882a593Smuzhiyun 		pctldev->desc->custom_params)
262*4882a593Smuzhiyun 		parse_dt_cfg(np, pctldev->desc->custom_params,
263*4882a593Smuzhiyun 			     pctldev->desc->num_custom_params, cfg, &ncfg);
264*4882a593Smuzhiyun 
265*4882a593Smuzhiyun 	ret = 0;
266*4882a593Smuzhiyun 
267*4882a593Smuzhiyun 	/* no configs found at all */
268*4882a593Smuzhiyun 	if (ncfg == 0) {
269*4882a593Smuzhiyun 		*configs = NULL;
270*4882a593Smuzhiyun 		*nconfigs = 0;
271*4882a593Smuzhiyun 		goto out;
272*4882a593Smuzhiyun 	}
273*4882a593Smuzhiyun 
274*4882a593Smuzhiyun 	/*
275*4882a593Smuzhiyun 	 * Now limit the number of configs to the real number of
276*4882a593Smuzhiyun 	 * found properties.
277*4882a593Smuzhiyun 	 */
278*4882a593Smuzhiyun 	*configs = kmemdup(cfg, ncfg * sizeof(unsigned long), GFP_KERNEL);
279*4882a593Smuzhiyun 	if (!*configs) {
280*4882a593Smuzhiyun 		ret = -ENOMEM;
281*4882a593Smuzhiyun 		goto out;
282*4882a593Smuzhiyun 	}
283*4882a593Smuzhiyun 
284*4882a593Smuzhiyun 	*nconfigs = ncfg;
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun out:
287*4882a593Smuzhiyun 	kfree(cfg);
288*4882a593Smuzhiyun 	return ret;
289*4882a593Smuzhiyun }
290*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(pinconf_generic_parse_dt_config);
291*4882a593Smuzhiyun 
pinconf_generic_dt_subnode_to_map(struct pinctrl_dev * pctldev,struct device_node * np,struct pinctrl_map ** map,unsigned * reserved_maps,unsigned * num_maps,enum pinctrl_map_type type)292*4882a593Smuzhiyun int pinconf_generic_dt_subnode_to_map(struct pinctrl_dev *pctldev,
293*4882a593Smuzhiyun 		struct device_node *np, struct pinctrl_map **map,
294*4882a593Smuzhiyun 		unsigned *reserved_maps, unsigned *num_maps,
295*4882a593Smuzhiyun 		enum pinctrl_map_type type)
296*4882a593Smuzhiyun {
297*4882a593Smuzhiyun 	int ret;
298*4882a593Smuzhiyun 	const char *function;
299*4882a593Smuzhiyun 	struct device *dev = pctldev->dev;
300*4882a593Smuzhiyun 	unsigned long *configs = NULL;
301*4882a593Smuzhiyun 	unsigned num_configs = 0;
302*4882a593Smuzhiyun 	unsigned reserve, strings_count;
303*4882a593Smuzhiyun 	struct property *prop;
304*4882a593Smuzhiyun 	const char *group;
305*4882a593Smuzhiyun 	const char *subnode_target_type = "pins";
306*4882a593Smuzhiyun 
307*4882a593Smuzhiyun 	ret = of_property_count_strings(np, "pins");
308*4882a593Smuzhiyun 	if (ret < 0) {
309*4882a593Smuzhiyun 		ret = of_property_count_strings(np, "groups");
310*4882a593Smuzhiyun 		if (ret < 0)
311*4882a593Smuzhiyun 			/* skip this node; may contain config child nodes */
312*4882a593Smuzhiyun 			return 0;
313*4882a593Smuzhiyun 		if (type == PIN_MAP_TYPE_INVALID)
314*4882a593Smuzhiyun 			type = PIN_MAP_TYPE_CONFIGS_GROUP;
315*4882a593Smuzhiyun 		subnode_target_type = "groups";
316*4882a593Smuzhiyun 	} else {
317*4882a593Smuzhiyun 		if (type == PIN_MAP_TYPE_INVALID)
318*4882a593Smuzhiyun 			type = PIN_MAP_TYPE_CONFIGS_PIN;
319*4882a593Smuzhiyun 	}
320*4882a593Smuzhiyun 	strings_count = ret;
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	ret = of_property_read_string(np, "function", &function);
323*4882a593Smuzhiyun 	if (ret < 0) {
324*4882a593Smuzhiyun 		/* EINVAL=missing, which is fine since it's optional */
325*4882a593Smuzhiyun 		if (ret != -EINVAL)
326*4882a593Smuzhiyun 			dev_err(dev, "%pOF: could not parse property function\n",
327*4882a593Smuzhiyun 				np);
328*4882a593Smuzhiyun 		function = NULL;
329*4882a593Smuzhiyun 	}
330*4882a593Smuzhiyun 
331*4882a593Smuzhiyun 	ret = pinconf_generic_parse_dt_config(np, pctldev, &configs,
332*4882a593Smuzhiyun 					      &num_configs);
333*4882a593Smuzhiyun 	if (ret < 0) {
334*4882a593Smuzhiyun 		dev_err(dev, "%pOF: could not parse node property\n", np);
335*4882a593Smuzhiyun 		return ret;
336*4882a593Smuzhiyun 	}
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	reserve = 0;
339*4882a593Smuzhiyun 	if (function != NULL)
340*4882a593Smuzhiyun 		reserve++;
341*4882a593Smuzhiyun 	if (num_configs)
342*4882a593Smuzhiyun 		reserve++;
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun 	reserve *= strings_count;
345*4882a593Smuzhiyun 
346*4882a593Smuzhiyun 	ret = pinctrl_utils_reserve_map(pctldev, map, reserved_maps,
347*4882a593Smuzhiyun 			num_maps, reserve);
348*4882a593Smuzhiyun 	if (ret < 0)
349*4882a593Smuzhiyun 		goto exit;
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun 	of_property_for_each_string(np, subnode_target_type, prop, group) {
352*4882a593Smuzhiyun 		if (function) {
353*4882a593Smuzhiyun 			ret = pinctrl_utils_add_map_mux(pctldev, map,
354*4882a593Smuzhiyun 					reserved_maps, num_maps, group,
355*4882a593Smuzhiyun 					function);
356*4882a593Smuzhiyun 			if (ret < 0)
357*4882a593Smuzhiyun 				goto exit;
358*4882a593Smuzhiyun 		}
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun 		if (num_configs) {
361*4882a593Smuzhiyun 			ret = pinctrl_utils_add_map_configs(pctldev, map,
362*4882a593Smuzhiyun 					reserved_maps, num_maps, group, configs,
363*4882a593Smuzhiyun 					num_configs, type);
364*4882a593Smuzhiyun 			if (ret < 0)
365*4882a593Smuzhiyun 				goto exit;
366*4882a593Smuzhiyun 		}
367*4882a593Smuzhiyun 	}
368*4882a593Smuzhiyun 	ret = 0;
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun exit:
371*4882a593Smuzhiyun 	kfree(configs);
372*4882a593Smuzhiyun 	return ret;
373*4882a593Smuzhiyun }
374*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(pinconf_generic_dt_subnode_to_map);
375*4882a593Smuzhiyun 
pinconf_generic_dt_node_to_map(struct pinctrl_dev * pctldev,struct device_node * np_config,struct pinctrl_map ** map,unsigned * num_maps,enum pinctrl_map_type type)376*4882a593Smuzhiyun int pinconf_generic_dt_node_to_map(struct pinctrl_dev *pctldev,
377*4882a593Smuzhiyun 		struct device_node *np_config, struct pinctrl_map **map,
378*4882a593Smuzhiyun 		unsigned *num_maps, enum pinctrl_map_type type)
379*4882a593Smuzhiyun {
380*4882a593Smuzhiyun 	unsigned reserved_maps;
381*4882a593Smuzhiyun 	struct device_node *np;
382*4882a593Smuzhiyun 	int ret;
383*4882a593Smuzhiyun 
384*4882a593Smuzhiyun 	reserved_maps = 0;
385*4882a593Smuzhiyun 	*map = NULL;
386*4882a593Smuzhiyun 	*num_maps = 0;
387*4882a593Smuzhiyun 
388*4882a593Smuzhiyun 	ret = pinconf_generic_dt_subnode_to_map(pctldev, np_config, map,
389*4882a593Smuzhiyun 						&reserved_maps, num_maps, type);
390*4882a593Smuzhiyun 	if (ret < 0)
391*4882a593Smuzhiyun 		goto exit;
392*4882a593Smuzhiyun 
393*4882a593Smuzhiyun 	for_each_available_child_of_node(np_config, np) {
394*4882a593Smuzhiyun 		ret = pinconf_generic_dt_subnode_to_map(pctldev, np, map,
395*4882a593Smuzhiyun 					&reserved_maps, num_maps, type);
396*4882a593Smuzhiyun 		if (ret < 0)
397*4882a593Smuzhiyun 			goto exit;
398*4882a593Smuzhiyun 	}
399*4882a593Smuzhiyun 	return 0;
400*4882a593Smuzhiyun 
401*4882a593Smuzhiyun exit:
402*4882a593Smuzhiyun 	pinctrl_utils_free_map(pctldev, *map, *num_maps);
403*4882a593Smuzhiyun 	return ret;
404*4882a593Smuzhiyun }
405*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(pinconf_generic_dt_node_to_map);
406*4882a593Smuzhiyun 
pinconf_generic_dt_free_map(struct pinctrl_dev * pctldev,struct pinctrl_map * map,unsigned num_maps)407*4882a593Smuzhiyun void pinconf_generic_dt_free_map(struct pinctrl_dev *pctldev,
408*4882a593Smuzhiyun 				 struct pinctrl_map *map,
409*4882a593Smuzhiyun 				 unsigned num_maps)
410*4882a593Smuzhiyun {
411*4882a593Smuzhiyun 	pinctrl_utils_free_map(pctldev, map, num_maps);
412*4882a593Smuzhiyun }
413*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(pinconf_generic_dt_free_map);
414*4882a593Smuzhiyun 
415*4882a593Smuzhiyun #endif
416