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