PM / sleep: Asynchronous threads for suspend_noirq
[linux/fpc-iii.git] / drivers / pinctrl / sh-pfc / pinctrl.c
blobe758af95c209324f91d547877bc2b6a9bc2aab1f
1 /*
2 * SuperH Pin Function Controller pinmux support.
4 * Copyright (C) 2012 Paul Mundt
6 * This file is subject to the terms and conditions of the GNU General Public
7 * License. See the file "COPYING" in the main directory of this archive
8 * for more details.
9 */
11 #define DRV_NAME "sh-pfc"
13 #include <linux/device.h>
14 #include <linux/err.h>
15 #include <linux/init.h>
16 #include <linux/module.h>
17 #include <linux/of.h>
18 #include <linux/pinctrl/consumer.h>
19 #include <linux/pinctrl/machine.h>
20 #include <linux/pinctrl/pinconf.h>
21 #include <linux/pinctrl/pinconf-generic.h>
22 #include <linux/pinctrl/pinctrl.h>
23 #include <linux/pinctrl/pinmux.h>
24 #include <linux/slab.h>
25 #include <linux/spinlock.h>
27 #include "core.h"
28 #include "../core.h"
29 #include "../pinconf.h"
31 struct sh_pfc_pin_config {
32 u32 type;
35 struct sh_pfc_pinctrl {
36 struct pinctrl_dev *pctl;
37 struct pinctrl_desc pctl_desc;
39 struct sh_pfc *pfc;
41 struct pinctrl_pin_desc *pins;
42 struct sh_pfc_pin_config *configs;
45 static int sh_pfc_get_groups_count(struct pinctrl_dev *pctldev)
47 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
49 return pmx->pfc->info->nr_groups;
52 static const char *sh_pfc_get_group_name(struct pinctrl_dev *pctldev,
53 unsigned selector)
55 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
57 return pmx->pfc->info->groups[selector].name;
60 static int sh_pfc_get_group_pins(struct pinctrl_dev *pctldev, unsigned selector,
61 const unsigned **pins, unsigned *num_pins)
63 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
65 *pins = pmx->pfc->info->groups[selector].pins;
66 *num_pins = pmx->pfc->info->groups[selector].nr_pins;
68 return 0;
71 static void sh_pfc_pin_dbg_show(struct pinctrl_dev *pctldev, struct seq_file *s,
72 unsigned offset)
74 seq_printf(s, "%s", DRV_NAME);
77 #ifdef CONFIG_OF
78 static int sh_pfc_map_add_config(struct pinctrl_map *map,
79 const char *group_or_pin,
80 enum pinctrl_map_type type,
81 unsigned long *configs,
82 unsigned int num_configs)
84 unsigned long *cfgs;
86 cfgs = kmemdup(configs, num_configs * sizeof(*cfgs),
87 GFP_KERNEL);
88 if (cfgs == NULL)
89 return -ENOMEM;
91 map->type = type;
92 map->data.configs.group_or_pin = group_or_pin;
93 map->data.configs.configs = cfgs;
94 map->data.configs.num_configs = num_configs;
96 return 0;
99 static int sh_pfc_dt_subnode_to_map(struct device *dev, struct device_node *np,
100 struct pinctrl_map **map,
101 unsigned int *num_maps, unsigned int *index)
103 struct pinctrl_map *maps = *map;
104 unsigned int nmaps = *num_maps;
105 unsigned int idx = *index;
106 unsigned int num_configs;
107 const char *function = NULL;
108 unsigned long *configs;
109 struct property *prop;
110 unsigned int num_groups;
111 unsigned int num_pins;
112 const char *group;
113 const char *pin;
114 int ret;
116 /* Parse the function and configuration properties. At least a function
117 * or one configuration must be specified.
119 ret = of_property_read_string(np, "renesas,function", &function);
120 if (ret < 0 && ret != -EINVAL) {
121 dev_err(dev, "Invalid function in DT\n");
122 return ret;
125 ret = pinconf_generic_parse_dt_config(np, &configs, &num_configs);
126 if (ret < 0)
127 return ret;
129 if (!function && num_configs == 0) {
130 dev_err(dev,
131 "DT node must contain at least a function or config\n");
132 goto done;
135 /* Count the number of pins and groups and reallocate mappings. */
136 ret = of_property_count_strings(np, "renesas,pins");
137 if (ret == -EINVAL) {
138 num_pins = 0;
139 } else if (ret < 0) {
140 dev_err(dev, "Invalid pins list in DT\n");
141 goto done;
142 } else {
143 num_pins = ret;
146 ret = of_property_count_strings(np, "renesas,groups");
147 if (ret == -EINVAL) {
148 num_groups = 0;
149 } else if (ret < 0) {
150 dev_err(dev, "Invalid pin groups list in DT\n");
151 goto done;
152 } else {
153 num_groups = ret;
156 if (!num_pins && !num_groups) {
157 dev_err(dev, "No pin or group provided in DT node\n");
158 ret = -ENODEV;
159 goto done;
162 if (function)
163 nmaps += num_groups;
164 if (configs)
165 nmaps += num_pins + num_groups;
167 maps = krealloc(maps, sizeof(*maps) * nmaps, GFP_KERNEL);
168 if (maps == NULL) {
169 ret = -ENOMEM;
170 goto done;
173 *map = maps;
174 *num_maps = nmaps;
176 /* Iterate over pins and groups and create the mappings. */
177 of_property_for_each_string(np, "renesas,groups", prop, group) {
178 if (function) {
179 maps[idx].type = PIN_MAP_TYPE_MUX_GROUP;
180 maps[idx].data.mux.group = group;
181 maps[idx].data.mux.function = function;
182 idx++;
185 if (configs) {
186 ret = sh_pfc_map_add_config(&maps[idx], group,
187 PIN_MAP_TYPE_CONFIGS_GROUP,
188 configs, num_configs);
189 if (ret < 0)
190 goto done;
192 idx++;
196 if (!configs) {
197 ret = 0;
198 goto done;
201 of_property_for_each_string(np, "renesas,pins", prop, pin) {
202 ret = sh_pfc_map_add_config(&maps[idx], pin,
203 PIN_MAP_TYPE_CONFIGS_PIN,
204 configs, num_configs);
205 if (ret < 0)
206 goto done;
208 idx++;
211 done:
212 *index = idx;
213 kfree(configs);
214 return ret;
217 static void sh_pfc_dt_free_map(struct pinctrl_dev *pctldev,
218 struct pinctrl_map *map, unsigned num_maps)
220 unsigned int i;
222 if (map == NULL)
223 return;
225 for (i = 0; i < num_maps; ++i) {
226 if (map[i].type == PIN_MAP_TYPE_CONFIGS_GROUP ||
227 map[i].type == PIN_MAP_TYPE_CONFIGS_PIN)
228 kfree(map[i].data.configs.configs);
231 kfree(map);
234 static int sh_pfc_dt_node_to_map(struct pinctrl_dev *pctldev,
235 struct device_node *np,
236 struct pinctrl_map **map, unsigned *num_maps)
238 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
239 struct device *dev = pmx->pfc->dev;
240 struct device_node *child;
241 unsigned int index;
242 int ret;
244 *map = NULL;
245 *num_maps = 0;
246 index = 0;
248 for_each_child_of_node(np, child) {
249 ret = sh_pfc_dt_subnode_to_map(dev, child, map, num_maps,
250 &index);
251 if (ret < 0)
252 goto done;
255 /* If no mapping has been found in child nodes try the config node. */
256 if (*num_maps == 0) {
257 ret = sh_pfc_dt_subnode_to_map(dev, np, map, num_maps, &index);
258 if (ret < 0)
259 goto done;
262 if (*num_maps)
263 return 0;
265 dev_err(dev, "no mapping found in node %s\n", np->full_name);
266 ret = -EINVAL;
268 done:
269 if (ret < 0)
270 sh_pfc_dt_free_map(pctldev, *map, *num_maps);
272 return ret;
274 #endif /* CONFIG_OF */
276 static const struct pinctrl_ops sh_pfc_pinctrl_ops = {
277 .get_groups_count = sh_pfc_get_groups_count,
278 .get_group_name = sh_pfc_get_group_name,
279 .get_group_pins = sh_pfc_get_group_pins,
280 .pin_dbg_show = sh_pfc_pin_dbg_show,
281 #ifdef CONFIG_OF
282 .dt_node_to_map = sh_pfc_dt_node_to_map,
283 .dt_free_map = sh_pfc_dt_free_map,
284 #endif
287 static int sh_pfc_get_functions_count(struct pinctrl_dev *pctldev)
289 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
291 return pmx->pfc->info->nr_functions;
294 static const char *sh_pfc_get_function_name(struct pinctrl_dev *pctldev,
295 unsigned selector)
297 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
299 return pmx->pfc->info->functions[selector].name;
302 static int sh_pfc_get_function_groups(struct pinctrl_dev *pctldev,
303 unsigned selector,
304 const char * const **groups,
305 unsigned * const num_groups)
307 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
309 *groups = pmx->pfc->info->functions[selector].groups;
310 *num_groups = pmx->pfc->info->functions[selector].nr_groups;
312 return 0;
315 static int sh_pfc_func_enable(struct pinctrl_dev *pctldev, unsigned selector,
316 unsigned group)
318 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
319 struct sh_pfc *pfc = pmx->pfc;
320 const struct sh_pfc_pin_group *grp = &pfc->info->groups[group];
321 unsigned long flags;
322 unsigned int i;
323 int ret = 0;
325 spin_lock_irqsave(&pfc->lock, flags);
327 for (i = 0; i < grp->nr_pins; ++i) {
328 int idx = sh_pfc_get_pin_index(pfc, grp->pins[i]);
329 struct sh_pfc_pin_config *cfg = &pmx->configs[idx];
331 if (cfg->type != PINMUX_TYPE_NONE) {
332 ret = -EBUSY;
333 goto done;
337 for (i = 0; i < grp->nr_pins; ++i) {
338 ret = sh_pfc_config_mux(pfc, grp->mux[i], PINMUX_TYPE_FUNCTION);
339 if (ret < 0)
340 break;
343 done:
344 spin_unlock_irqrestore(&pfc->lock, flags);
345 return ret;
348 static void sh_pfc_func_disable(struct pinctrl_dev *pctldev, unsigned selector,
349 unsigned group)
351 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
352 struct sh_pfc *pfc = pmx->pfc;
353 const struct sh_pfc_pin_group *grp = &pfc->info->groups[group];
354 unsigned long flags;
355 unsigned int i;
357 spin_lock_irqsave(&pfc->lock, flags);
359 for (i = 0; i < grp->nr_pins; ++i) {
360 int idx = sh_pfc_get_pin_index(pfc, grp->pins[i]);
361 struct sh_pfc_pin_config *cfg = &pmx->configs[idx];
363 cfg->type = PINMUX_TYPE_NONE;
366 spin_unlock_irqrestore(&pfc->lock, flags);
369 static int sh_pfc_gpio_request_enable(struct pinctrl_dev *pctldev,
370 struct pinctrl_gpio_range *range,
371 unsigned offset)
373 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
374 struct sh_pfc *pfc = pmx->pfc;
375 int idx = sh_pfc_get_pin_index(pfc, offset);
376 struct sh_pfc_pin_config *cfg = &pmx->configs[idx];
377 unsigned long flags;
378 int ret;
380 spin_lock_irqsave(&pfc->lock, flags);
382 if (cfg->type != PINMUX_TYPE_NONE) {
383 dev_err(pfc->dev,
384 "Pin %u is busy, can't configure it as GPIO.\n",
385 offset);
386 ret = -EBUSY;
387 goto done;
390 if (!pfc->gpio) {
391 /* If GPIOs are handled externally the pin mux type need to be
392 * set to GPIO here.
394 const struct sh_pfc_pin *pin = &pfc->info->pins[idx];
396 ret = sh_pfc_config_mux(pfc, pin->enum_id, PINMUX_TYPE_GPIO);
397 if (ret < 0)
398 goto done;
401 cfg->type = PINMUX_TYPE_GPIO;
403 ret = 0;
405 done:
406 spin_unlock_irqrestore(&pfc->lock, flags);
408 return ret;
411 static void sh_pfc_gpio_disable_free(struct pinctrl_dev *pctldev,
412 struct pinctrl_gpio_range *range,
413 unsigned offset)
415 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
416 struct sh_pfc *pfc = pmx->pfc;
417 int idx = sh_pfc_get_pin_index(pfc, offset);
418 struct sh_pfc_pin_config *cfg = &pmx->configs[idx];
419 unsigned long flags;
421 spin_lock_irqsave(&pfc->lock, flags);
422 cfg->type = PINMUX_TYPE_NONE;
423 spin_unlock_irqrestore(&pfc->lock, flags);
426 static int sh_pfc_gpio_set_direction(struct pinctrl_dev *pctldev,
427 struct pinctrl_gpio_range *range,
428 unsigned offset, bool input)
430 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
431 struct sh_pfc *pfc = pmx->pfc;
432 int new_type = input ? PINMUX_TYPE_INPUT : PINMUX_TYPE_OUTPUT;
433 int idx = sh_pfc_get_pin_index(pfc, offset);
434 const struct sh_pfc_pin *pin = &pfc->info->pins[idx];
435 struct sh_pfc_pin_config *cfg = &pmx->configs[idx];
436 unsigned long flags;
437 unsigned int dir;
438 int ret;
440 /* Check if the requested direction is supported by the pin. Not all SoC
441 * provide pin config data, so perform the check conditionally.
443 if (pin->configs) {
444 dir = input ? SH_PFC_PIN_CFG_INPUT : SH_PFC_PIN_CFG_OUTPUT;
445 if (!(pin->configs & dir))
446 return -EINVAL;
449 spin_lock_irqsave(&pfc->lock, flags);
451 ret = sh_pfc_config_mux(pfc, pin->enum_id, new_type);
452 if (ret < 0)
453 goto done;
455 cfg->type = new_type;
457 done:
458 spin_unlock_irqrestore(&pfc->lock, flags);
459 return ret;
462 static const struct pinmux_ops sh_pfc_pinmux_ops = {
463 .get_functions_count = sh_pfc_get_functions_count,
464 .get_function_name = sh_pfc_get_function_name,
465 .get_function_groups = sh_pfc_get_function_groups,
466 .enable = sh_pfc_func_enable,
467 .disable = sh_pfc_func_disable,
468 .gpio_request_enable = sh_pfc_gpio_request_enable,
469 .gpio_disable_free = sh_pfc_gpio_disable_free,
470 .gpio_set_direction = sh_pfc_gpio_set_direction,
473 /* Check whether the requested parameter is supported for a pin. */
474 static bool sh_pfc_pinconf_validate(struct sh_pfc *pfc, unsigned int _pin,
475 enum pin_config_param param)
477 int idx = sh_pfc_get_pin_index(pfc, _pin);
478 const struct sh_pfc_pin *pin = &pfc->info->pins[idx];
480 switch (param) {
481 case PIN_CONFIG_BIAS_DISABLE:
482 return true;
484 case PIN_CONFIG_BIAS_PULL_UP:
485 return pin->configs & SH_PFC_PIN_CFG_PULL_UP;
487 case PIN_CONFIG_BIAS_PULL_DOWN:
488 return pin->configs & SH_PFC_PIN_CFG_PULL_DOWN;
490 default:
491 return false;
495 static int sh_pfc_pinconf_get(struct pinctrl_dev *pctldev, unsigned _pin,
496 unsigned long *config)
498 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
499 struct sh_pfc *pfc = pmx->pfc;
500 enum pin_config_param param = pinconf_to_config_param(*config);
501 unsigned long flags;
502 unsigned int bias;
504 if (!sh_pfc_pinconf_validate(pfc, _pin, param))
505 return -ENOTSUPP;
507 switch (param) {
508 case PIN_CONFIG_BIAS_DISABLE:
509 case PIN_CONFIG_BIAS_PULL_UP:
510 case PIN_CONFIG_BIAS_PULL_DOWN:
511 if (!pfc->info->ops || !pfc->info->ops->get_bias)
512 return -ENOTSUPP;
514 spin_lock_irqsave(&pfc->lock, flags);
515 bias = pfc->info->ops->get_bias(pfc, _pin);
516 spin_unlock_irqrestore(&pfc->lock, flags);
518 if (bias != param)
519 return -EINVAL;
521 *config = 0;
522 break;
524 default:
525 return -ENOTSUPP;
528 return 0;
531 static int sh_pfc_pinconf_set(struct pinctrl_dev *pctldev, unsigned _pin,
532 unsigned long *configs, unsigned num_configs)
534 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
535 struct sh_pfc *pfc = pmx->pfc;
536 enum pin_config_param param;
537 unsigned long flags;
538 unsigned int i;
540 for (i = 0; i < num_configs; i++) {
541 param = pinconf_to_config_param(configs[i]);
543 if (!sh_pfc_pinconf_validate(pfc, _pin, param))
544 return -ENOTSUPP;
546 switch (param) {
547 case PIN_CONFIG_BIAS_PULL_UP:
548 case PIN_CONFIG_BIAS_PULL_DOWN:
549 case PIN_CONFIG_BIAS_DISABLE:
550 if (!pfc->info->ops || !pfc->info->ops->set_bias)
551 return -ENOTSUPP;
553 spin_lock_irqsave(&pfc->lock, flags);
554 pfc->info->ops->set_bias(pfc, _pin, param);
555 spin_unlock_irqrestore(&pfc->lock, flags);
557 break;
559 default:
560 return -ENOTSUPP;
562 } /* for each config */
564 return 0;
567 static int sh_pfc_pinconf_group_set(struct pinctrl_dev *pctldev, unsigned group,
568 unsigned long *configs,
569 unsigned num_configs)
571 struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev);
572 const unsigned int *pins;
573 unsigned int num_pins;
574 unsigned int i;
576 pins = pmx->pfc->info->groups[group].pins;
577 num_pins = pmx->pfc->info->groups[group].nr_pins;
579 for (i = 0; i < num_pins; ++i)
580 sh_pfc_pinconf_set(pctldev, pins[i], configs, num_configs);
582 return 0;
585 static const struct pinconf_ops sh_pfc_pinconf_ops = {
586 .is_generic = true,
587 .pin_config_get = sh_pfc_pinconf_get,
588 .pin_config_set = sh_pfc_pinconf_set,
589 .pin_config_group_set = sh_pfc_pinconf_group_set,
590 .pin_config_config_dbg_show = pinconf_generic_dump_config,
593 /* PFC ranges -> pinctrl pin descs */
594 static int sh_pfc_map_pins(struct sh_pfc *pfc, struct sh_pfc_pinctrl *pmx)
596 unsigned int i;
598 /* Allocate and initialize the pins and configs arrays. */
599 pmx->pins = devm_kzalloc(pfc->dev,
600 sizeof(*pmx->pins) * pfc->info->nr_pins,
601 GFP_KERNEL);
602 if (unlikely(!pmx->pins))
603 return -ENOMEM;
605 pmx->configs = devm_kzalloc(pfc->dev,
606 sizeof(*pmx->configs) * pfc->info->nr_pins,
607 GFP_KERNEL);
608 if (unlikely(!pmx->configs))
609 return -ENOMEM;
611 for (i = 0; i < pfc->info->nr_pins; ++i) {
612 const struct sh_pfc_pin *info = &pfc->info->pins[i];
613 struct sh_pfc_pin_config *cfg = &pmx->configs[i];
614 struct pinctrl_pin_desc *pin = &pmx->pins[i];
616 /* If the pin number is equal to -1 all pins are considered */
617 pin->number = info->pin != (u16)-1 ? info->pin : i;
618 pin->name = info->name;
619 cfg->type = PINMUX_TYPE_NONE;
622 return 0;
625 int sh_pfc_register_pinctrl(struct sh_pfc *pfc)
627 struct sh_pfc_pinctrl *pmx;
628 int ret;
630 pmx = devm_kzalloc(pfc->dev, sizeof(*pmx), GFP_KERNEL);
631 if (unlikely(!pmx))
632 return -ENOMEM;
634 pmx->pfc = pfc;
635 pfc->pinctrl = pmx;
637 ret = sh_pfc_map_pins(pfc, pmx);
638 if (ret < 0)
639 return ret;
641 pmx->pctl_desc.name = DRV_NAME;
642 pmx->pctl_desc.owner = THIS_MODULE;
643 pmx->pctl_desc.pctlops = &sh_pfc_pinctrl_ops;
644 pmx->pctl_desc.pmxops = &sh_pfc_pinmux_ops;
645 pmx->pctl_desc.confops = &sh_pfc_pinconf_ops;
646 pmx->pctl_desc.pins = pmx->pins;
647 pmx->pctl_desc.npins = pfc->info->nr_pins;
649 pmx->pctl = pinctrl_register(&pmx->pctl_desc, pfc->dev, pmx);
650 if (pmx->pctl == NULL)
651 return -EINVAL;
653 return 0;
656 int sh_pfc_unregister_pinctrl(struct sh_pfc *pfc)
658 struct sh_pfc_pinctrl *pmx = pfc->pinctrl;
660 pinctrl_unregister(pmx->pctl);
662 pfc->pinctrl = NULL;
663 return 0;