1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Core driver for the pin muxing portions of the pin control subsystem
4 *
5 * Copyright (C) 2011-2012 ST-Ericsson SA
6 * Written on behalf of Linaro for ST-Ericsson
7 * Based on bits of regulator core, gpio core and clk core
8 *
9 * Author: Linus Walleij <linus.walleij@linaro.org>
10 *
11 * Copyright (C) 2012 NVIDIA CORPORATION. All rights reserved.
12 */
13 #define pr_fmt(fmt) "pinmux core: " fmt
14
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/init.h>
18 #include <linux/device.h>
19 #include <linux/slab.h>
20 #include <linux/radix-tree.h>
21 #include <linux/err.h>
22 #include <linux/list.h>
23 #include <linux/string.h>
24 #include <linux/debugfs.h>
25 #include <linux/seq_file.h>
26 #include <linux/pinctrl/machine.h>
27 #include <linux/pinctrl/pinmux.h>
28 #include "core.h"
29 #include "pinmux.h"
30
pinmux_check_ops(struct pinctrl_dev * pctldev)31 int pinmux_check_ops(struct pinctrl_dev *pctldev)
32 {
33 const struct pinmux_ops *ops = pctldev->desc->pmxops;
34 unsigned nfuncs;
35 unsigned selector = 0;
36
37 /* Check that we implement required operations */
38 if (!ops ||
39 !ops->get_functions_count ||
40 !ops->get_function_name ||
41 !ops->get_function_groups ||
42 !ops->set_mux) {
43 dev_err(pctldev->dev, "pinmux ops lacks necessary functions\n");
44 return -EINVAL;
45 }
46 /* Check that all functions registered have names */
47 nfuncs = ops->get_functions_count(pctldev);
48 while (selector < nfuncs) {
49 const char *fname = ops->get_function_name(pctldev,
50 selector);
51 if (!fname) {
52 dev_err(pctldev->dev, "pinmux ops has no name for function%u\n",
53 selector);
54 return -EINVAL;
55 }
56 selector++;
57 }
58
59 return 0;
60 }
61
pinmux_validate_map(const struct pinctrl_map * map,int i)62 int pinmux_validate_map(const struct pinctrl_map *map, int i)
63 {
64 if (!map->data.mux.function) {
65 pr_err("failed to register map %s (%d): no function given\n",
66 map->name, i);
67 return -EINVAL;
68 }
69
70 return 0;
71 }
72
73 /**
74 * pinmux_can_be_used_for_gpio() - check if a specific pin
75 * is either muxed to a different function or used as gpio.
76 *
77 * @pin: the pin number in the global pin space
78 *
79 * Controllers not defined as strict will always return true,
80 * menaning that the gpio can be used.
81 */
pinmux_can_be_used_for_gpio(struct pinctrl_dev * pctldev,unsigned pin)82 bool pinmux_can_be_used_for_gpio(struct pinctrl_dev *pctldev, unsigned pin)
83 {
84 struct pin_desc *desc = pin_desc_get(pctldev, pin);
85 const struct pinmux_ops *ops = pctldev->desc->pmxops;
86
87 /* Can't inspect pin, assume it can be used */
88 if (!desc)
89 return true;
90
91 if (ops->strict && desc->mux_usecount)
92 return false;
93
94 return !(ops->strict && !!desc->gpio_owner);
95 }
96
97 /**
98 * pin_request() - request a single pin to be muxed in, typically for GPIO
99 * @pin: the pin number in the global pin space
100 * @owner: a representation of the owner of this pin; typically the device
101 * name that controls its mux function, or the requested GPIO name
102 * @gpio_range: the range matching the GPIO pin if this is a request for a
103 * single GPIO pin
104 */
pin_request(struct pinctrl_dev * pctldev,int pin,const char * owner,struct pinctrl_gpio_range * gpio_range)105 static int pin_request(struct pinctrl_dev *pctldev,
106 int pin, const char *owner,
107 struct pinctrl_gpio_range *gpio_range)
108 {
109 struct pin_desc *desc;
110 const struct pinmux_ops *ops = pctldev->desc->pmxops;
111 int status = -EINVAL;
112
113 desc = pin_desc_get(pctldev, pin);
114 if (desc == NULL) {
115 dev_err(pctldev->dev,
116 "pin %d is not registered so it cannot be requested\n",
117 pin);
118 goto out;
119 }
120
121 dev_dbg(pctldev->dev, "request pin %d (%s) for %s\n",
122 pin, desc->name, owner);
123
124 if ((!gpio_range || ops->strict) &&
125 desc->mux_usecount && strcmp(desc->mux_owner, owner)) {
126 dev_err(pctldev->dev,
127 "pin %s already requested by %s; cannot claim for %s\n",
128 desc->name, desc->mux_owner, owner);
129 goto out;
130 }
131
132 if ((gpio_range || ops->strict) && desc->gpio_owner) {
133 dev_err(pctldev->dev,
134 "pin %s already requested by %s; cannot claim for %s\n",
135 desc->name, desc->gpio_owner, owner);
136 goto out;
137 }
138
139 if (gpio_range) {
140 desc->gpio_owner = owner;
141 } else {
142 desc->mux_usecount++;
143 if (desc->mux_usecount > 1)
144 return 0;
145
146 desc->mux_owner = owner;
147 }
148
149 /* Let each pin increase references to this module */
150 if (!try_module_get(pctldev->owner)) {
151 dev_err(pctldev->dev,
152 "could not increase module refcount for pin %d\n",
153 pin);
154 status = -EINVAL;
155 goto out_free_pin;
156 }
157
158 /*
159 * If there is no kind of request function for the pin we just assume
160 * we got it by default and proceed.
161 */
162 if (gpio_range && ops->gpio_request_enable)
163 /* This requests and enables a single GPIO pin */
164 status = ops->gpio_request_enable(pctldev, gpio_range, pin);
165 else if (ops->request)
166 status = ops->request(pctldev, pin);
167 else
168 status = 0;
169
170 if (status) {
171 dev_err(pctldev->dev, "request() failed for pin %d\n", pin);
172 module_put(pctldev->owner);
173 }
174
175 out_free_pin:
176 if (status) {
177 if (gpio_range) {
178 desc->gpio_owner = NULL;
179 } else {
180 desc->mux_usecount--;
181 if (!desc->mux_usecount)
182 desc->mux_owner = NULL;
183 }
184 }
185 out:
186 if (status)
187 dev_err(pctldev->dev, "pin-%d (%s) status %d\n",
188 pin, owner, status);
189
190 return status;
191 }
192
193 /**
194 * pin_free() - release a single muxed in pin so something else can be muxed
195 * @pctldev: pin controller device handling this pin
196 * @pin: the pin to free
197 * @gpio_range: the range matching the GPIO pin if this is a request for a
198 * single GPIO pin
199 *
200 * This function returns a pointer to the previous owner. This is used
201 * for callers that dynamically allocate an owner name so it can be freed
202 * once the pin is free. This is done for GPIO request functions.
203 */
pin_free(struct pinctrl_dev * pctldev,int pin,struct pinctrl_gpio_range * gpio_range)204 static const char *pin_free(struct pinctrl_dev *pctldev, int pin,
205 struct pinctrl_gpio_range *gpio_range)
206 {
207 const struct pinmux_ops *ops = pctldev->desc->pmxops;
208 struct pin_desc *desc;
209 const char *owner;
210
211 desc = pin_desc_get(pctldev, pin);
212 if (desc == NULL) {
213 dev_err(pctldev->dev,
214 "pin is not registered so it cannot be freed\n");
215 return NULL;
216 }
217
218 if (!gpio_range) {
219 /*
220 * A pin should not be freed more times than allocated.
221 */
222 if (WARN_ON(!desc->mux_usecount))
223 return NULL;
224 desc->mux_usecount--;
225 if (desc->mux_usecount)
226 return NULL;
227 }
228
229 /*
230 * If there is no kind of request function for the pin we just assume
231 * we got it by default and proceed.
232 */
233 if (gpio_range && ops->gpio_disable_free)
234 ops->gpio_disable_free(pctldev, gpio_range, pin);
235 else if (ops->free)
236 ops->free(pctldev, pin);
237
238 if (gpio_range) {
239 owner = desc->gpio_owner;
240 desc->gpio_owner = NULL;
241 } else {
242 owner = desc->mux_owner;
243 desc->mux_owner = NULL;
244 desc->mux_setting = NULL;
245 }
246
247 module_put(pctldev->owner);
248
249 return owner;
250 }
251
252 /**
253 * pinmux_request_gpio() - request pinmuxing for a GPIO pin
254 * @pctldev: pin controller device affected
255 * @pin: the pin to mux in for GPIO
256 * @range: the applicable GPIO range
257 */
pinmux_request_gpio(struct pinctrl_dev * pctldev,struct pinctrl_gpio_range * range,unsigned pin,unsigned gpio)258 int pinmux_request_gpio(struct pinctrl_dev *pctldev,
259 struct pinctrl_gpio_range *range,
260 unsigned pin, unsigned gpio)
261 {
262 const char *owner;
263 int ret;
264
265 /* Conjure some name stating what chip and pin this is taken by */
266 owner = kasprintf(GFP_KERNEL, "%s:%d", range->name, gpio);
267 if (!owner)
268 return -ENOMEM;
269
270 ret = pin_request(pctldev, pin, owner, range);
271 if (ret < 0)
272 kfree(owner);
273
274 return ret;
275 }
276
277 /**
278 * pinmux_free_gpio() - release a pin from GPIO muxing
279 * @pctldev: the pin controller device for the pin
280 * @pin: the affected currently GPIO-muxed in pin
281 * @range: applicable GPIO range
282 */
pinmux_free_gpio(struct pinctrl_dev * pctldev,unsigned pin,struct pinctrl_gpio_range * range)283 void pinmux_free_gpio(struct pinctrl_dev *pctldev, unsigned pin,
284 struct pinctrl_gpio_range *range)
285 {
286 const char *owner;
287
288 owner = pin_free(pctldev, pin, range);
289 kfree(owner);
290 }
291
292 /**
293 * pinmux_gpio_direction() - set the direction of a single muxed-in GPIO pin
294 * @pctldev: the pin controller handling this pin
295 * @range: applicable GPIO range
296 * @pin: the affected GPIO pin in this controller
297 * @input: true if we set the pin as input, false for output
298 */
pinmux_gpio_direction(struct pinctrl_dev * pctldev,struct pinctrl_gpio_range * range,unsigned pin,bool input)299 int pinmux_gpio_direction(struct pinctrl_dev *pctldev,
300 struct pinctrl_gpio_range *range,
301 unsigned pin, bool input)
302 {
303 const struct pinmux_ops *ops;
304 int ret;
305
306 ops = pctldev->desc->pmxops;
307
308 if (ops->gpio_set_direction)
309 ret = ops->gpio_set_direction(pctldev, range, pin, input);
310 else
311 ret = 0;
312
313 return ret;
314 }
315
pinmux_func_name_to_selector(struct pinctrl_dev * pctldev,const char * function)316 static int pinmux_func_name_to_selector(struct pinctrl_dev *pctldev,
317 const char *function)
318 {
319 const struct pinmux_ops *ops = pctldev->desc->pmxops;
320 unsigned nfuncs = ops->get_functions_count(pctldev);
321 unsigned selector = 0;
322
323 /* See if this pctldev has this function */
324 while (selector < nfuncs) {
325 const char *fname = ops->get_function_name(pctldev, selector);
326
327 if (!strcmp(function, fname))
328 return selector;
329
330 selector++;
331 }
332
333 return -EINVAL;
334 }
335
pinmux_map_to_setting(const struct pinctrl_map * map,struct pinctrl_setting * setting)336 int pinmux_map_to_setting(const struct pinctrl_map *map,
337 struct pinctrl_setting *setting)
338 {
339 struct pinctrl_dev *pctldev = setting->pctldev;
340 const struct pinmux_ops *pmxops = pctldev->desc->pmxops;
341 char const * const *groups;
342 unsigned num_groups;
343 int ret;
344 const char *group;
345
346 if (!pmxops) {
347 dev_err(pctldev->dev, "does not support mux function\n");
348 return -EINVAL;
349 }
350
351 ret = pinmux_func_name_to_selector(pctldev, map->data.mux.function);
352 if (ret < 0) {
353 dev_err(pctldev->dev, "invalid function %s in map table\n",
354 map->data.mux.function);
355 return ret;
356 }
357 setting->data.mux.func = ret;
358
359 ret = pmxops->get_function_groups(pctldev, setting->data.mux.func,
360 &groups, &num_groups);
361 if (ret < 0) {
362 dev_err(pctldev->dev, "can't query groups for function %s\n",
363 map->data.mux.function);
364 return ret;
365 }
366 if (!num_groups) {
367 dev_err(pctldev->dev,
368 "function %s can't be selected on any group\n",
369 map->data.mux.function);
370 return -EINVAL;
371 }
372 if (map->data.mux.group) {
373 group = map->data.mux.group;
374 ret = match_string(groups, num_groups, group);
375 if (ret < 0) {
376 dev_err(pctldev->dev,
377 "invalid group \"%s\" for function \"%s\"\n",
378 group, map->data.mux.function);
379 return ret;
380 }
381 } else {
382 group = groups[0];
383 }
384
385 ret = pinctrl_get_group_selector(pctldev, group);
386 if (ret < 0) {
387 dev_err(pctldev->dev, "invalid group %s in map table\n",
388 map->data.mux.group);
389 return ret;
390 }
391 setting->data.mux.group = ret;
392
393 return 0;
394 }
395
pinmux_free_setting(const struct pinctrl_setting * setting)396 void pinmux_free_setting(const struct pinctrl_setting *setting)
397 {
398 /* This function is currently unused */
399 }
400
pinmux_enable_setting(const struct pinctrl_setting * setting)401 int pinmux_enable_setting(const struct pinctrl_setting *setting)
402 {
403 struct pinctrl_dev *pctldev = setting->pctldev;
404 const struct pinctrl_ops *pctlops = pctldev->desc->pctlops;
405 const struct pinmux_ops *ops = pctldev->desc->pmxops;
406 int ret = 0;
407 const unsigned *pins = NULL;
408 unsigned num_pins = 0;
409 int i;
410 struct pin_desc *desc;
411
412 if (pctlops->get_group_pins)
413 ret = pctlops->get_group_pins(pctldev, setting->data.mux.group,
414 &pins, &num_pins);
415
416 if (ret) {
417 const char *gname;
418
419 /* errors only affect debug data, so just warn */
420 gname = pctlops->get_group_name(pctldev,
421 setting->data.mux.group);
422 dev_warn(pctldev->dev,
423 "could not get pins for group %s\n",
424 gname);
425 num_pins = 0;
426 }
427
428 /* Try to allocate all pins in this group, one by one */
429 for (i = 0; i < num_pins; i++) {
430 ret = pin_request(pctldev, pins[i], setting->dev_name, NULL);
431 if (ret) {
432 const char *gname;
433 const char *pname;
434
435 desc = pin_desc_get(pctldev, pins[i]);
436 pname = desc ? desc->name : "non-existing";
437 gname = pctlops->get_group_name(pctldev,
438 setting->data.mux.group);
439 dev_err(pctldev->dev,
440 "could not request pin %d (%s) from group %s "
441 " on device %s\n",
442 pins[i], pname, gname,
443 pinctrl_dev_get_name(pctldev));
444 goto err_pin_request;
445 }
446 }
447
448 /* Now that we have acquired the pins, encode the mux setting */
449 for (i = 0; i < num_pins; i++) {
450 desc = pin_desc_get(pctldev, pins[i]);
451 if (desc == NULL) {
452 dev_warn(pctldev->dev,
453 "could not get pin desc for pin %d\n",
454 pins[i]);
455 continue;
456 }
457 desc->mux_setting = &(setting->data.mux);
458 }
459
460 ret = ops->set_mux(pctldev, setting->data.mux.func,
461 setting->data.mux.group);
462
463 if (ret)
464 goto err_set_mux;
465
466 return 0;
467
468 err_set_mux:
469 for (i = 0; i < num_pins; i++) {
470 desc = pin_desc_get(pctldev, pins[i]);
471 if (desc)
472 desc->mux_setting = NULL;
473 }
474 err_pin_request:
475 /* On error release all taken pins */
476 while (--i >= 0)
477 pin_free(pctldev, pins[i], NULL);
478
479 return ret;
480 }
481
pinmux_disable_setting(const struct pinctrl_setting * setting)482 void pinmux_disable_setting(const struct pinctrl_setting *setting)
483 {
484 struct pinctrl_dev *pctldev = setting->pctldev;
485 const struct pinctrl_ops *pctlops = pctldev->desc->pctlops;
486 int ret = 0;
487 const unsigned *pins = NULL;
488 unsigned num_pins = 0;
489 int i;
490 struct pin_desc *desc;
491
492 if (pctlops->get_group_pins)
493 ret = pctlops->get_group_pins(pctldev, setting->data.mux.group,
494 &pins, &num_pins);
495 if (ret) {
496 const char *gname;
497
498 /* errors only affect debug data, so just warn */
499 gname = pctlops->get_group_name(pctldev,
500 setting->data.mux.group);
501 dev_warn(pctldev->dev,
502 "could not get pins for group %s\n",
503 gname);
504 num_pins = 0;
505 }
506
507 /* Flag the descs that no setting is active */
508 for (i = 0; i < num_pins; i++) {
509 desc = pin_desc_get(pctldev, pins[i]);
510 if (desc == NULL) {
511 dev_warn(pctldev->dev,
512 "could not get pin desc for pin %d\n",
513 pins[i]);
514 continue;
515 }
516 if (desc->mux_setting == &(setting->data.mux)) {
517 pin_free(pctldev, pins[i], NULL);
518 } else {
519 const char *gname;
520
521 gname = pctlops->get_group_name(pctldev,
522 setting->data.mux.group);
523 dev_warn(pctldev->dev,
524 "not freeing pin %d (%s) as part of "
525 "deactivating group %s - it is already "
526 "used for some other setting",
527 pins[i], desc->name, gname);
528 }
529 }
530 }
531
532 #ifdef CONFIG_DEBUG_FS
533
534 /* Called from pincontrol core */
pinmux_functions_show(struct seq_file * s,void * what)535 static int pinmux_functions_show(struct seq_file *s, void *what)
536 {
537 struct pinctrl_dev *pctldev = s->private;
538 const struct pinmux_ops *pmxops = pctldev->desc->pmxops;
539 unsigned nfuncs;
540 unsigned func_selector = 0;
541
542 if (!pmxops)
543 return 0;
544
545 mutex_lock(&pctldev->mutex);
546 nfuncs = pmxops->get_functions_count(pctldev);
547 while (func_selector < nfuncs) {
548 const char *func = pmxops->get_function_name(pctldev,
549 func_selector);
550 const char * const *groups;
551 unsigned num_groups;
552 int ret;
553 int i;
554
555 ret = pmxops->get_function_groups(pctldev, func_selector,
556 &groups, &num_groups);
557 if (ret) {
558 seq_printf(s, "function %s: COULD NOT GET GROUPS\n",
559 func);
560 func_selector++;
561 continue;
562 }
563
564 seq_printf(s, "function: %s, groups = [ ", func);
565 for (i = 0; i < num_groups; i++)
566 seq_printf(s, "%s ", groups[i]);
567 seq_puts(s, "]\n");
568
569 func_selector++;
570 }
571
572 mutex_unlock(&pctldev->mutex);
573
574 return 0;
575 }
576
pinmux_pins_show(struct seq_file * s,void * what)577 static int pinmux_pins_show(struct seq_file *s, void *what)
578 {
579 struct pinctrl_dev *pctldev = s->private;
580 const struct pinctrl_ops *pctlops = pctldev->desc->pctlops;
581 const struct pinmux_ops *pmxops = pctldev->desc->pmxops;
582 unsigned i, pin;
583
584 if (!pmxops)
585 return 0;
586
587 seq_puts(s, "Pinmux settings per pin\n");
588 if (pmxops->strict)
589 seq_puts(s,
590 "Format: pin (name): mux_owner|gpio_owner (strict) hog?\n");
591 else
592 seq_puts(s,
593 "Format: pin (name): mux_owner gpio_owner hog?\n");
594
595 mutex_lock(&pctldev->mutex);
596
597 /* The pin number can be retrived from the pin controller descriptor */
598 for (i = 0; i < pctldev->desc->npins; i++) {
599 struct pin_desc *desc;
600 bool is_hog = false;
601
602 pin = pctldev->desc->pins[i].number;
603 desc = pin_desc_get(pctldev, pin);
604 /* Skip if we cannot search the pin */
605 if (desc == NULL)
606 continue;
607
608 if (desc->mux_owner &&
609 !strcmp(desc->mux_owner, pinctrl_dev_get_name(pctldev)))
610 is_hog = true;
611
612 if (pmxops->strict) {
613 if (desc->mux_owner)
614 seq_printf(s, "pin %d (%s): device %s%s",
615 pin, desc->name, desc->mux_owner,
616 is_hog ? " (HOG)" : "");
617 else if (desc->gpio_owner)
618 seq_printf(s, "pin %d (%s): GPIO %s",
619 pin, desc->name, desc->gpio_owner);
620 else
621 seq_printf(s, "pin %d (%s): UNCLAIMED",
622 pin, desc->name);
623 } else {
624 /* For non-strict controllers */
625 seq_printf(s, "pin %d (%s): %s %s%s", pin, desc->name,
626 desc->mux_owner ? desc->mux_owner
627 : "(MUX UNCLAIMED)",
628 desc->gpio_owner ? desc->gpio_owner
629 : "(GPIO UNCLAIMED)",
630 is_hog ? " (HOG)" : "");
631 }
632
633 /* If mux: print function+group claiming the pin */
634 if (desc->mux_setting)
635 seq_printf(s, " function %s group %s\n",
636 pmxops->get_function_name(pctldev,
637 desc->mux_setting->func),
638 pctlops->get_group_name(pctldev,
639 desc->mux_setting->group));
640 else
641 seq_putc(s, '\n');
642 }
643
644 mutex_unlock(&pctldev->mutex);
645
646 return 0;
647 }
648
pinmux_show_map(struct seq_file * s,const struct pinctrl_map * map)649 void pinmux_show_map(struct seq_file *s, const struct pinctrl_map *map)
650 {
651 seq_printf(s, "group %s\nfunction %s\n",
652 map->data.mux.group ? map->data.mux.group : "(default)",
653 map->data.mux.function);
654 }
655
pinmux_show_setting(struct seq_file * s,const struct pinctrl_setting * setting)656 void pinmux_show_setting(struct seq_file *s,
657 const struct pinctrl_setting *setting)
658 {
659 struct pinctrl_dev *pctldev = setting->pctldev;
660 const struct pinmux_ops *pmxops = pctldev->desc->pmxops;
661 const struct pinctrl_ops *pctlops = pctldev->desc->pctlops;
662
663 seq_printf(s, "group: %s (%u) function: %s (%u)\n",
664 pctlops->get_group_name(pctldev, setting->data.mux.group),
665 setting->data.mux.group,
666 pmxops->get_function_name(pctldev, setting->data.mux.func),
667 setting->data.mux.func);
668 }
669
670 DEFINE_SHOW_ATTRIBUTE(pinmux_functions);
671 DEFINE_SHOW_ATTRIBUTE(pinmux_pins);
672
pinmux_init_device_debugfs(struct dentry * devroot,struct pinctrl_dev * pctldev)673 void pinmux_init_device_debugfs(struct dentry *devroot,
674 struct pinctrl_dev *pctldev)
675 {
676 debugfs_create_file("pinmux-functions", S_IFREG | S_IRUGO,
677 devroot, pctldev, &pinmux_functions_fops);
678 debugfs_create_file("pinmux-pins", S_IFREG | S_IRUGO,
679 devroot, pctldev, &pinmux_pins_fops);
680 }
681
682 #endif /* CONFIG_DEBUG_FS */
683
684 #ifdef CONFIG_GENERIC_PINMUX_FUNCTIONS
685
686 /**
687 * pinmux_generic_get_function_count() - returns number of functions
688 * @pctldev: pin controller device
689 */
pinmux_generic_get_function_count(struct pinctrl_dev * pctldev)690 int pinmux_generic_get_function_count(struct pinctrl_dev *pctldev)
691 {
692 return pctldev->num_functions;
693 }
694 EXPORT_SYMBOL_GPL(pinmux_generic_get_function_count);
695
696 /**
697 * pinmux_generic_get_function_name() - returns the function name
698 * @pctldev: pin controller device
699 * @selector: function number
700 */
701 const char *
pinmux_generic_get_function_name(struct pinctrl_dev * pctldev,unsigned int selector)702 pinmux_generic_get_function_name(struct pinctrl_dev *pctldev,
703 unsigned int selector)
704 {
705 struct function_desc *function;
706
707 function = radix_tree_lookup(&pctldev->pin_function_tree,
708 selector);
709 if (!function)
710 return NULL;
711
712 return function->name;
713 }
714 EXPORT_SYMBOL_GPL(pinmux_generic_get_function_name);
715
716 /**
717 * pinmux_generic_get_function_groups() - gets the function groups
718 * @pctldev: pin controller device
719 * @selector: function number
720 * @groups: array of pin groups
721 * @num_groups: number of pin groups
722 */
pinmux_generic_get_function_groups(struct pinctrl_dev * pctldev,unsigned int selector,const char * const ** groups,unsigned * const num_groups)723 int pinmux_generic_get_function_groups(struct pinctrl_dev *pctldev,
724 unsigned int selector,
725 const char * const **groups,
726 unsigned * const num_groups)
727 {
728 struct function_desc *function;
729
730 function = radix_tree_lookup(&pctldev->pin_function_tree,
731 selector);
732 if (!function) {
733 dev_err(pctldev->dev, "%s could not find function%i\n",
734 __func__, selector);
735 return -EINVAL;
736 }
737 *groups = function->group_names;
738 *num_groups = function->num_group_names;
739
740 return 0;
741 }
742 EXPORT_SYMBOL_GPL(pinmux_generic_get_function_groups);
743
744 /**
745 * pinmux_generic_get_function() - returns a function based on the number
746 * @pctldev: pin controller device
747 * @group_selector: function number
748 */
pinmux_generic_get_function(struct pinctrl_dev * pctldev,unsigned int selector)749 struct function_desc *pinmux_generic_get_function(struct pinctrl_dev *pctldev,
750 unsigned int selector)
751 {
752 struct function_desc *function;
753
754 function = radix_tree_lookup(&pctldev->pin_function_tree,
755 selector);
756 if (!function)
757 return NULL;
758
759 return function;
760 }
761 EXPORT_SYMBOL_GPL(pinmux_generic_get_function);
762
763 /**
764 * pinmux_generic_add_function() - adds a function group
765 * @pctldev: pin controller device
766 * @name: name of the function
767 * @groups: array of pin groups
768 * @num_groups: number of pin groups
769 * @data: pin controller driver specific data
770 */
pinmux_generic_add_function(struct pinctrl_dev * pctldev,const char * name,const char ** groups,const unsigned int num_groups,void * data)771 int pinmux_generic_add_function(struct pinctrl_dev *pctldev,
772 const char *name,
773 const char **groups,
774 const unsigned int num_groups,
775 void *data)
776 {
777 struct function_desc *function;
778 int selector;
779
780 if (!name)
781 return -EINVAL;
782
783 selector = pinmux_func_name_to_selector(pctldev, name);
784 if (selector >= 0)
785 return selector;
786
787 selector = pctldev->num_functions;
788
789 function = devm_kzalloc(pctldev->dev, sizeof(*function), GFP_KERNEL);
790 if (!function)
791 return -ENOMEM;
792
793 function->name = name;
794 function->group_names = groups;
795 function->num_group_names = num_groups;
796 function->data = data;
797
798 radix_tree_insert(&pctldev->pin_function_tree, selector, function);
799
800 pctldev->num_functions++;
801
802 return selector;
803 }
804 EXPORT_SYMBOL_GPL(pinmux_generic_add_function);
805
806 /**
807 * pinmux_generic_remove_function() - removes a numbered function
808 * @pctldev: pin controller device
809 * @selector: function number
810 *
811 * Note that the caller must take care of locking.
812 */
pinmux_generic_remove_function(struct pinctrl_dev * pctldev,unsigned int selector)813 int pinmux_generic_remove_function(struct pinctrl_dev *pctldev,
814 unsigned int selector)
815 {
816 struct function_desc *function;
817
818 function = radix_tree_lookup(&pctldev->pin_function_tree,
819 selector);
820 if (!function)
821 return -ENOENT;
822
823 radix_tree_delete(&pctldev->pin_function_tree, selector);
824 devm_kfree(pctldev->dev, function);
825
826 pctldev->num_functions--;
827
828 return 0;
829 }
830 EXPORT_SYMBOL_GPL(pinmux_generic_remove_function);
831
832 /**
833 * pinmux_generic_free_functions() - removes all functions
834 * @pctldev: pin controller device
835 *
836 * Note that the caller must take care of locking. The pinctrl
837 * functions are allocated with devm_kzalloc() so no need to free
838 * them here.
839 */
pinmux_generic_free_functions(struct pinctrl_dev * pctldev)840 void pinmux_generic_free_functions(struct pinctrl_dev *pctldev)
841 {
842 struct radix_tree_iter iter;
843 void __rcu **slot;
844
845 radix_tree_for_each_slot(slot, &pctldev->pin_function_tree, &iter, 0)
846 radix_tree_delete(&pctldev->pin_function_tree, iter.index);
847
848 pctldev->num_functions = 0;
849 }
850
851 #endif /* CONFIG_GENERIC_PINMUX_FUNCTIONS */
852