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 = ¶ms[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