1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Spreadtrum pin controller driver 4 * Copyright (C) 2017 Spreadtrum - http://www.spreadtrum.com 5 */ 6 7 #include <linux/debugfs.h> 8 #include <linux/err.h> 9 #include <linux/init.h> 10 #include <linux/io.h> 11 #include <linux/kernel.h> 12 #include <linux/module.h> 13 #include <linux/of.h> 14 #include <linux/of_device.h> 15 #include <linux/platform_device.h> 16 #include <linux/pinctrl/machine.h> 17 #include <linux/pinctrl/pinconf.h> 18 #include <linux/pinctrl/pinconf-generic.h> 19 #include <linux/pinctrl/pinctrl.h> 20 #include <linux/pinctrl/pinmux.h> 21 #include <linux/slab.h> 22 23 #include "../core.h" 24 #include "../pinmux.h" 25 #include "../pinconf.h" 26 #include "../pinctrl-utils.h" 27 #include "pinctrl-sprd.h" 28 29 #define PINCTRL_BIT_MASK(width) (~(~0UL << (width))) 30 #define PINCTRL_REG_OFFSET 0x20 31 #define PINCTRL_REG_MISC_OFFSET 0x4020 32 #define PINCTRL_REG_LEN 0x4 33 34 #define PIN_FUNC_MASK (BIT(4) | BIT(5)) 35 #define PIN_FUNC_SEL_1 ~PIN_FUNC_MASK 36 #define PIN_FUNC_SEL_2 BIT(4) 37 #define PIN_FUNC_SEL_3 BIT(5) 38 #define PIN_FUNC_SEL_4 PIN_FUNC_MASK 39 40 #define AP_SLEEP_MODE BIT(13) 41 #define PUBCP_SLEEP_MODE BIT(14) 42 #define TGLDSP_SLEEP_MODE BIT(15) 43 #define AGDSP_SLEEP_MODE BIT(16) 44 #define CM4_SLEEP_MODE BIT(17) 45 #define SLEEP_MODE_MASK GENMASK(5, 0) 46 #define SLEEP_MODE_SHIFT 13 47 48 #define SLEEP_INPUT BIT(1) 49 #define SLEEP_INPUT_MASK 0x1 50 #define SLEEP_INPUT_SHIFT 1 51 52 #define SLEEP_OUTPUT BIT(0) 53 #define SLEEP_OUTPUT_MASK 0x1 54 #define SLEEP_OUTPUT_SHIFT 0 55 56 #define DRIVE_STRENGTH_MASK GENMASK(3, 0) 57 #define DRIVE_STRENGTH_SHIFT 19 58 59 #define SLEEP_PULL_DOWN BIT(2) 60 #define SLEEP_PULL_DOWN_MASK 0x1 61 #define SLEEP_PULL_DOWN_SHIFT 2 62 63 #define PULL_DOWN BIT(6) 64 #define PULL_DOWN_MASK 0x1 65 #define PULL_DOWN_SHIFT 6 66 67 #define SLEEP_PULL_UP BIT(3) 68 #define SLEEP_PULL_UP_MASK 0x1 69 #define SLEEP_PULL_UP_SHIFT 3 70 71 #define PULL_UP_4_7K (BIT(12) | BIT(7)) 72 #define PULL_UP_20K BIT(7) 73 #define PULL_UP_MASK 0x21 74 #define PULL_UP_SHIFT 7 75 76 #define INPUT_SCHMITT BIT(11) 77 #define INPUT_SCHMITT_MASK 0x1 78 #define INPUT_SCHMITT_SHIFT 11 79 80 enum pin_sleep_mode { 81 AP_SLEEP = BIT(0), 82 PUBCP_SLEEP = BIT(1), 83 TGLDSP_SLEEP = BIT(2), 84 AGDSP_SLEEP = BIT(3), 85 CM4_SLEEP = BIT(4), 86 }; 87 88 enum pin_func_sel { 89 PIN_FUNC_1, 90 PIN_FUNC_2, 91 PIN_FUNC_3, 92 PIN_FUNC_4, 93 PIN_FUNC_MAX, 94 }; 95 96 /** 97 * struct sprd_pin: represent one pin's description 98 * @name: pin name 99 * @number: pin number 100 * @type: pin type, can be GLOBAL_CTRL_PIN/COMMON_PIN/MISC_PIN 101 * @reg: pin register address 102 * @bit_offset: bit offset in pin register 103 * @bit_width: bit width in pin register 104 */ 105 struct sprd_pin { 106 const char *name; 107 unsigned int number; 108 enum pin_type type; 109 unsigned long reg; 110 unsigned long bit_offset; 111 unsigned long bit_width; 112 }; 113 114 /** 115 * struct sprd_pin_group: represent one group's description 116 * @name: group name 117 * @npins: pin numbers of this group 118 * @pins: pointer to pins array 119 */ 120 struct sprd_pin_group { 121 const char *name; 122 unsigned int npins; 123 unsigned int *pins; 124 }; 125 126 /** 127 * struct sprd_pinctrl_soc_info: represent the SoC's pins description 128 * @groups: pointer to groups of pins 129 * @ngroups: group numbers of the whole SoC 130 * @pins: pointer to pins description 131 * @npins: pin numbers of the whole SoC 132 * @grp_names: pointer to group names array 133 */ 134 struct sprd_pinctrl_soc_info { 135 struct sprd_pin_group *groups; 136 unsigned int ngroups; 137 struct sprd_pin *pins; 138 unsigned int npins; 139 const char **grp_names; 140 }; 141 142 /** 143 * struct sprd_pinctrl: represent the pin controller device 144 * @dev: pointer to the device structure 145 * @pctl: pointer to the pinctrl handle 146 * @base: base address of the controller 147 * @info: pointer to SoC's pins description information 148 */ 149 struct sprd_pinctrl { 150 struct device *dev; 151 struct pinctrl_dev *pctl; 152 void __iomem *base; 153 struct sprd_pinctrl_soc_info *info; 154 }; 155 156 #define SPRD_PIN_CONFIG_CONTROL (PIN_CONFIG_END + 1) 157 #define SPRD_PIN_CONFIG_SLEEP_MODE (PIN_CONFIG_END + 2) 158 159 static int sprd_pinctrl_get_id_by_name(struct sprd_pinctrl *sprd_pctl, 160 const char *name) 161 { 162 struct sprd_pinctrl_soc_info *info = sprd_pctl->info; 163 int i; 164 165 for (i = 0; i < info->npins; i++) { 166 if (!strcmp(info->pins[i].name, name)) 167 return info->pins[i].number; 168 } 169 170 return -ENODEV; 171 } 172 173 static struct sprd_pin * 174 sprd_pinctrl_get_pin_by_id(struct sprd_pinctrl *sprd_pctl, unsigned int id) 175 { 176 struct sprd_pinctrl_soc_info *info = sprd_pctl->info; 177 struct sprd_pin *pin = NULL; 178 int i; 179 180 for (i = 0; i < info->npins; i++) { 181 if (info->pins[i].number == id) { 182 pin = &info->pins[i]; 183 break; 184 } 185 } 186 187 return pin; 188 } 189 190 static const struct sprd_pin_group * 191 sprd_pinctrl_find_group_by_name(struct sprd_pinctrl *sprd_pctl, 192 const char *name) 193 { 194 struct sprd_pinctrl_soc_info *info = sprd_pctl->info; 195 const struct sprd_pin_group *grp = NULL; 196 int i; 197 198 for (i = 0; i < info->ngroups; i++) { 199 if (!strcmp(info->groups[i].name, name)) { 200 grp = &info->groups[i]; 201 break; 202 } 203 } 204 205 return grp; 206 } 207 208 static int sprd_pctrl_group_count(struct pinctrl_dev *pctldev) 209 { 210 struct sprd_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); 211 struct sprd_pinctrl_soc_info *info = pctl->info; 212 213 return info->ngroups; 214 } 215 216 static const char *sprd_pctrl_group_name(struct pinctrl_dev *pctldev, 217 unsigned int selector) 218 { 219 struct sprd_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); 220 struct sprd_pinctrl_soc_info *info = pctl->info; 221 222 return info->groups[selector].name; 223 } 224 225 static int sprd_pctrl_group_pins(struct pinctrl_dev *pctldev, 226 unsigned int selector, 227 const unsigned int **pins, 228 unsigned int *npins) 229 { 230 struct sprd_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); 231 struct sprd_pinctrl_soc_info *info = pctl->info; 232 233 if (selector >= info->ngroups) 234 return -EINVAL; 235 236 *pins = info->groups[selector].pins; 237 *npins = info->groups[selector].npins; 238 239 return 0; 240 } 241 242 static int sprd_dt_node_to_map(struct pinctrl_dev *pctldev, 243 struct device_node *np, 244 struct pinctrl_map **map, 245 unsigned int *num_maps) 246 { 247 struct sprd_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); 248 const struct sprd_pin_group *grp; 249 unsigned long *configs = NULL; 250 unsigned int num_configs = 0; 251 unsigned int reserved_maps = 0; 252 unsigned int reserve = 0; 253 const char *function; 254 enum pinctrl_map_type type; 255 int ret; 256 257 grp = sprd_pinctrl_find_group_by_name(pctl, np->name); 258 if (!grp) { 259 dev_err(pctl->dev, "unable to find group for node %s\n", 260 of_node_full_name(np)); 261 return -EINVAL; 262 } 263 264 ret = of_property_count_strings(np, "pins"); 265 if (ret < 0) 266 return ret; 267 268 if (ret == 1) 269 type = PIN_MAP_TYPE_CONFIGS_PIN; 270 else 271 type = PIN_MAP_TYPE_CONFIGS_GROUP; 272 273 ret = of_property_read_string(np, "function", &function); 274 if (ret < 0) { 275 if (ret != -EINVAL) 276 dev_err(pctl->dev, 277 "%s: could not parse property function\n", 278 of_node_full_name(np)); 279 function = NULL; 280 } 281 282 ret = pinconf_generic_parse_dt_config(np, pctldev, &configs, 283 &num_configs); 284 if (ret < 0) { 285 dev_err(pctl->dev, "%s: could not parse node property\n", 286 of_node_full_name(np)); 287 return ret; 288 } 289 290 *map = NULL; 291 *num_maps = 0; 292 293 if (function != NULL) 294 reserve++; 295 if (num_configs) 296 reserve++; 297 298 ret = pinctrl_utils_reserve_map(pctldev, map, &reserved_maps, 299 num_maps, reserve); 300 if (ret < 0) 301 goto out; 302 303 if (function) { 304 ret = pinctrl_utils_add_map_mux(pctldev, map, 305 &reserved_maps, num_maps, 306 grp->name, function); 307 if (ret < 0) 308 goto out; 309 } 310 311 if (num_configs) { 312 const char *group_or_pin; 313 unsigned int pin_id; 314 315 if (type == PIN_MAP_TYPE_CONFIGS_PIN) { 316 pin_id = grp->pins[0]; 317 group_or_pin = pin_get_name(pctldev, pin_id); 318 } else { 319 group_or_pin = grp->name; 320 } 321 322 ret = pinctrl_utils_add_map_configs(pctldev, map, 323 &reserved_maps, num_maps, 324 group_or_pin, configs, 325 num_configs, type); 326 } 327 328 out: 329 kfree(configs); 330 return ret; 331 } 332 333 static void sprd_pctrl_dbg_show(struct pinctrl_dev *pctldev, struct seq_file *s, 334 unsigned int offset) 335 { 336 seq_printf(s, "%s", dev_name(pctldev->dev)); 337 } 338 339 static const struct pinctrl_ops sprd_pctrl_ops = { 340 .get_groups_count = sprd_pctrl_group_count, 341 .get_group_name = sprd_pctrl_group_name, 342 .get_group_pins = sprd_pctrl_group_pins, 343 .pin_dbg_show = sprd_pctrl_dbg_show, 344 .dt_node_to_map = sprd_dt_node_to_map, 345 .dt_free_map = pinctrl_utils_free_map, 346 }; 347 348 static int sprd_pmx_get_function_count(struct pinctrl_dev *pctldev) 349 { 350 return PIN_FUNC_MAX; 351 } 352 353 static const char *sprd_pmx_get_function_name(struct pinctrl_dev *pctldev, 354 unsigned int selector) 355 { 356 switch (selector) { 357 case PIN_FUNC_1: 358 return "func1"; 359 case PIN_FUNC_2: 360 return "func2"; 361 case PIN_FUNC_3: 362 return "func3"; 363 case PIN_FUNC_4: 364 return "func4"; 365 default: 366 return "null"; 367 } 368 } 369 370 static int sprd_pmx_get_function_groups(struct pinctrl_dev *pctldev, 371 unsigned int selector, 372 const char * const **groups, 373 unsigned int * const num_groups) 374 { 375 struct sprd_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); 376 struct sprd_pinctrl_soc_info *info = pctl->info; 377 378 *groups = info->grp_names; 379 *num_groups = info->ngroups; 380 381 return 0; 382 } 383 384 static int sprd_pmx_set_mux(struct pinctrl_dev *pctldev, 385 unsigned int func_selector, 386 unsigned int group_selector) 387 { 388 struct sprd_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); 389 struct sprd_pinctrl_soc_info *info = pctl->info; 390 struct sprd_pin_group *grp = &info->groups[group_selector]; 391 unsigned int i, grp_pins = grp->npins; 392 unsigned long reg; 393 unsigned int val = 0; 394 395 if (group_selector >= info->ngroups) 396 return -EINVAL; 397 398 switch (func_selector) { 399 case PIN_FUNC_1: 400 val &= PIN_FUNC_SEL_1; 401 break; 402 case PIN_FUNC_2: 403 val |= PIN_FUNC_SEL_2; 404 break; 405 case PIN_FUNC_3: 406 val |= PIN_FUNC_SEL_3; 407 break; 408 case PIN_FUNC_4: 409 val |= PIN_FUNC_SEL_4; 410 break; 411 default: 412 break; 413 } 414 415 for (i = 0; i < grp_pins; i++) { 416 unsigned int pin_id = grp->pins[i]; 417 struct sprd_pin *pin = sprd_pinctrl_get_pin_by_id(pctl, pin_id); 418 419 if (!pin || pin->type != COMMON_PIN) 420 continue; 421 422 reg = readl((void __iomem *)pin->reg); 423 reg &= ~PIN_FUNC_MASK; 424 reg |= val; 425 writel(reg, (void __iomem *)pin->reg); 426 } 427 428 return 0; 429 } 430 431 static const struct pinmux_ops sprd_pmx_ops = { 432 .get_functions_count = sprd_pmx_get_function_count, 433 .get_function_name = sprd_pmx_get_function_name, 434 .get_function_groups = sprd_pmx_get_function_groups, 435 .set_mux = sprd_pmx_set_mux, 436 }; 437 438 static int sprd_pinconf_get(struct pinctrl_dev *pctldev, unsigned int pin_id, 439 unsigned long *config) 440 { 441 struct sprd_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); 442 struct sprd_pin *pin = sprd_pinctrl_get_pin_by_id(pctl, pin_id); 443 unsigned int param = pinconf_to_config_param(*config); 444 unsigned int reg, arg; 445 446 if (!pin) 447 return -EINVAL; 448 449 if (pin->type == GLOBAL_CTRL_PIN) { 450 reg = (readl((void __iomem *)pin->reg) >> 451 pin->bit_offset) & PINCTRL_BIT_MASK(pin->bit_width); 452 } else { 453 reg = readl((void __iomem *)pin->reg); 454 } 455 456 if (pin->type == GLOBAL_CTRL_PIN && 457 param == SPRD_PIN_CONFIG_CONTROL) { 458 arg = reg; 459 } else if (pin->type == COMMON_PIN || pin->type == MISC_PIN) { 460 switch (param) { 461 case SPRD_PIN_CONFIG_SLEEP_MODE: 462 arg = (reg >> SLEEP_MODE_SHIFT) & SLEEP_MODE_MASK; 463 break; 464 case PIN_CONFIG_INPUT_ENABLE: 465 arg = (reg >> SLEEP_INPUT_SHIFT) & SLEEP_INPUT_MASK; 466 break; 467 case PIN_CONFIG_OUTPUT_ENABLE: 468 arg = reg & SLEEP_OUTPUT_MASK; 469 break; 470 case PIN_CONFIG_BIAS_HIGH_IMPEDANCE: 471 if ((reg & SLEEP_OUTPUT) || (reg & SLEEP_INPUT)) 472 return -EINVAL; 473 474 arg = 1; 475 break; 476 case PIN_CONFIG_DRIVE_STRENGTH: 477 arg = (reg >> DRIVE_STRENGTH_SHIFT) & 478 DRIVE_STRENGTH_MASK; 479 break; 480 case PIN_CONFIG_BIAS_PULL_DOWN: 481 /* combine sleep pull down and pull down config */ 482 arg = ((reg >> SLEEP_PULL_DOWN_SHIFT) & 483 SLEEP_PULL_DOWN_MASK) << 16; 484 arg |= (reg >> PULL_DOWN_SHIFT) & PULL_DOWN_MASK; 485 break; 486 case PIN_CONFIG_INPUT_SCHMITT_ENABLE: 487 arg = (reg >> INPUT_SCHMITT_SHIFT) & INPUT_SCHMITT_MASK; 488 break; 489 case PIN_CONFIG_BIAS_PULL_UP: 490 /* combine sleep pull up and pull up config */ 491 arg = ((reg >> SLEEP_PULL_UP_SHIFT) & 492 SLEEP_PULL_UP_MASK) << 16; 493 arg |= (reg >> PULL_UP_SHIFT) & PULL_UP_MASK; 494 break; 495 case PIN_CONFIG_BIAS_DISABLE: 496 if ((reg & (SLEEP_PULL_DOWN | SLEEP_PULL_UP)) || 497 (reg & (PULL_DOWN | PULL_UP_4_7K | PULL_UP_20K))) 498 return -EINVAL; 499 500 arg = 1; 501 break; 502 case PIN_CONFIG_SLEEP_HARDWARE_STATE: 503 arg = 0; 504 break; 505 default: 506 return -ENOTSUPP; 507 } 508 } else { 509 return -ENOTSUPP; 510 } 511 512 *config = pinconf_to_config_packed(param, arg); 513 return 0; 514 } 515 516 static unsigned int sprd_pinconf_drive(unsigned int mA) 517 { 518 unsigned int val = 0; 519 520 switch (mA) { 521 case 2: 522 break; 523 case 4: 524 val |= BIT(19); 525 break; 526 case 6: 527 val |= BIT(20); 528 break; 529 case 8: 530 val |= BIT(19) | BIT(20); 531 break; 532 case 10: 533 val |= BIT(21); 534 break; 535 case 12: 536 val |= BIT(21) | BIT(19); 537 break; 538 case 14: 539 val |= BIT(21) | BIT(20); 540 break; 541 case 16: 542 val |= BIT(19) | BIT(20) | BIT(21); 543 break; 544 case 20: 545 val |= BIT(22); 546 break; 547 case 21: 548 val |= BIT(22) | BIT(19); 549 break; 550 case 24: 551 val |= BIT(22) | BIT(20); 552 break; 553 case 25: 554 val |= BIT(22) | BIT(20) | BIT(19); 555 break; 556 case 27: 557 val |= BIT(22) | BIT(21); 558 break; 559 case 29: 560 val |= BIT(22) | BIT(21) | BIT(19); 561 break; 562 case 31: 563 val |= BIT(22) | BIT(21) | BIT(20); 564 break; 565 case 33: 566 val |= BIT(22) | BIT(21) | BIT(20) | BIT(19); 567 break; 568 default: 569 break; 570 } 571 572 return val; 573 } 574 575 static bool sprd_pinctrl_check_sleep_config(unsigned long *configs, 576 unsigned int num_configs) 577 { 578 unsigned int param; 579 int i; 580 581 for (i = 0; i < num_configs; i++) { 582 param = pinconf_to_config_param(configs[i]); 583 if (param == PIN_CONFIG_SLEEP_HARDWARE_STATE) 584 return true; 585 } 586 587 return false; 588 } 589 590 static int sprd_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin_id, 591 unsigned long *configs, unsigned int num_configs) 592 { 593 struct sprd_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); 594 struct sprd_pin *pin = sprd_pinctrl_get_pin_by_id(pctl, pin_id); 595 bool is_sleep_config; 596 unsigned long reg; 597 int i; 598 599 if (!pin) 600 return -EINVAL; 601 602 is_sleep_config = sprd_pinctrl_check_sleep_config(configs, num_configs); 603 604 for (i = 0; i < num_configs; i++) { 605 unsigned int param, arg, shift, mask, val; 606 607 param = pinconf_to_config_param(configs[i]); 608 arg = pinconf_to_config_argument(configs[i]); 609 610 val = 0; 611 shift = 0; 612 mask = 0; 613 if (pin->type == GLOBAL_CTRL_PIN && 614 param == SPRD_PIN_CONFIG_CONTROL) { 615 val = arg; 616 } else if (pin->type == COMMON_PIN || pin->type == MISC_PIN) { 617 switch (param) { 618 case SPRD_PIN_CONFIG_SLEEP_MODE: 619 if (arg & AP_SLEEP) 620 val |= AP_SLEEP_MODE; 621 if (arg & PUBCP_SLEEP) 622 val |= PUBCP_SLEEP_MODE; 623 if (arg & TGLDSP_SLEEP) 624 val |= TGLDSP_SLEEP_MODE; 625 if (arg & AGDSP_SLEEP) 626 val |= AGDSP_SLEEP_MODE; 627 if (arg & CM4_SLEEP) 628 val |= CM4_SLEEP_MODE; 629 630 mask = SLEEP_MODE_MASK; 631 shift = SLEEP_MODE_SHIFT; 632 break; 633 case PIN_CONFIG_INPUT_ENABLE: 634 if (is_sleep_config == true) { 635 if (arg > 0) 636 val |= SLEEP_INPUT; 637 else 638 val &= ~SLEEP_INPUT; 639 640 mask = SLEEP_INPUT_MASK; 641 shift = SLEEP_INPUT_SHIFT; 642 } 643 break; 644 case PIN_CONFIG_OUTPUT_ENABLE: 645 if (is_sleep_config == true) { 646 if (arg > 0) 647 val |= SLEEP_OUTPUT; 648 else 649 val &= ~SLEEP_OUTPUT; 650 651 mask = SLEEP_OUTPUT_MASK; 652 shift = SLEEP_OUTPUT_SHIFT; 653 } 654 break; 655 case PIN_CONFIG_BIAS_HIGH_IMPEDANCE: 656 if (is_sleep_config == true) { 657 val = shift = 0; 658 mask = SLEEP_OUTPUT | SLEEP_INPUT; 659 } 660 break; 661 case PIN_CONFIG_DRIVE_STRENGTH: 662 if (arg < 2 || arg > 60) 663 return -EINVAL; 664 665 val = sprd_pinconf_drive(arg); 666 mask = DRIVE_STRENGTH_MASK; 667 shift = DRIVE_STRENGTH_SHIFT; 668 break; 669 case PIN_CONFIG_BIAS_PULL_DOWN: 670 if (is_sleep_config == true) { 671 val |= SLEEP_PULL_DOWN; 672 mask = SLEEP_PULL_DOWN_MASK; 673 shift = SLEEP_PULL_DOWN_SHIFT; 674 } else { 675 val |= PULL_DOWN; 676 mask = PULL_DOWN_MASK; 677 shift = PULL_DOWN_SHIFT; 678 } 679 break; 680 case PIN_CONFIG_INPUT_SCHMITT_ENABLE: 681 if (arg > 0) 682 val |= INPUT_SCHMITT; 683 else 684 val &= ~INPUT_SCHMITT; 685 686 mask = INPUT_SCHMITT_MASK; 687 shift = INPUT_SCHMITT_SHIFT; 688 break; 689 case PIN_CONFIG_BIAS_PULL_UP: 690 if (is_sleep_config) { 691 val |= SLEEP_PULL_UP; 692 mask = SLEEP_PULL_UP_MASK; 693 shift = SLEEP_PULL_UP_SHIFT; 694 } else { 695 if (arg == 20000) 696 val |= PULL_UP_20K; 697 else if (arg == 4700) 698 val |= PULL_UP_4_7K; 699 700 mask = PULL_UP_MASK; 701 shift = PULL_UP_SHIFT; 702 } 703 break; 704 case PIN_CONFIG_BIAS_DISABLE: 705 if (is_sleep_config == true) { 706 val = shift = 0; 707 mask = SLEEP_PULL_DOWN | SLEEP_PULL_UP; 708 } else { 709 val = shift = 0; 710 mask = PULL_DOWN | PULL_UP_20K | 711 PULL_UP_4_7K; 712 } 713 break; 714 case PIN_CONFIG_SLEEP_HARDWARE_STATE: 715 continue; 716 default: 717 return -ENOTSUPP; 718 } 719 } else { 720 return -ENOTSUPP; 721 } 722 723 if (pin->type == GLOBAL_CTRL_PIN) { 724 reg = readl((void __iomem *)pin->reg); 725 reg &= ~(PINCTRL_BIT_MASK(pin->bit_width) 726 << pin->bit_offset); 727 reg |= (val & PINCTRL_BIT_MASK(pin->bit_width)) 728 << pin->bit_offset; 729 writel(reg, (void __iomem *)pin->reg); 730 } else { 731 reg = readl((void __iomem *)pin->reg); 732 reg &= ~(mask << shift); 733 reg |= val; 734 writel(reg, (void __iomem *)pin->reg); 735 } 736 } 737 738 return 0; 739 } 740 741 static int sprd_pinconf_group_get(struct pinctrl_dev *pctldev, 742 unsigned int selector, unsigned long *config) 743 { 744 struct sprd_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); 745 struct sprd_pinctrl_soc_info *info = pctl->info; 746 struct sprd_pin_group *grp; 747 unsigned int pin_id; 748 749 if (selector >= info->ngroups) 750 return -EINVAL; 751 752 grp = &info->groups[selector]; 753 pin_id = grp->pins[0]; 754 755 return sprd_pinconf_get(pctldev, pin_id, config); 756 } 757 758 static int sprd_pinconf_group_set(struct pinctrl_dev *pctldev, 759 unsigned int selector, 760 unsigned long *configs, 761 unsigned int num_configs) 762 { 763 struct sprd_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); 764 struct sprd_pinctrl_soc_info *info = pctl->info; 765 struct sprd_pin_group *grp; 766 int ret, i; 767 768 if (selector >= info->ngroups) 769 return -EINVAL; 770 771 grp = &info->groups[selector]; 772 773 for (i = 0; i < grp->npins; i++) { 774 unsigned int pin_id = grp->pins[i]; 775 776 ret = sprd_pinconf_set(pctldev, pin_id, configs, num_configs); 777 if (ret) 778 return ret; 779 } 780 781 return 0; 782 } 783 784 static int sprd_pinconf_get_config(struct pinctrl_dev *pctldev, 785 unsigned int pin_id, 786 unsigned long *config) 787 { 788 struct sprd_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); 789 struct sprd_pin *pin = sprd_pinctrl_get_pin_by_id(pctl, pin_id); 790 791 if (!pin) 792 return -EINVAL; 793 794 if (pin->type == GLOBAL_CTRL_PIN) { 795 *config = (readl((void __iomem *)pin->reg) >> 796 pin->bit_offset) & PINCTRL_BIT_MASK(pin->bit_width); 797 } else { 798 *config = readl((void __iomem *)pin->reg); 799 } 800 801 return 0; 802 } 803 804 static void sprd_pinconf_dbg_show(struct pinctrl_dev *pctldev, 805 struct seq_file *s, unsigned int pin_id) 806 { 807 unsigned long config; 808 int ret; 809 810 ret = sprd_pinconf_get_config(pctldev, pin_id, &config); 811 if (ret) 812 return; 813 814 seq_printf(s, "0x%lx", config); 815 } 816 817 static void sprd_pinconf_group_dbg_show(struct pinctrl_dev *pctldev, 818 struct seq_file *s, 819 unsigned int selector) 820 { 821 struct sprd_pinctrl *pctl = pinctrl_dev_get_drvdata(pctldev); 822 struct sprd_pinctrl_soc_info *info = pctl->info; 823 struct sprd_pin_group *grp; 824 unsigned long config; 825 const char *name; 826 int i, ret; 827 828 if (selector >= info->ngroups) 829 return; 830 831 grp = &info->groups[selector]; 832 833 seq_putc(s, '\n'); 834 for (i = 0; i < grp->npins; i++, config++) { 835 unsigned int pin_id = grp->pins[i]; 836 837 name = pin_get_name(pctldev, pin_id); 838 ret = sprd_pinconf_get_config(pctldev, pin_id, &config); 839 if (ret) 840 return; 841 842 seq_printf(s, "%s: 0x%lx ", name, config); 843 } 844 } 845 846 static const struct pinconf_ops sprd_pinconf_ops = { 847 .is_generic = true, 848 .pin_config_get = sprd_pinconf_get, 849 .pin_config_set = sprd_pinconf_set, 850 .pin_config_group_get = sprd_pinconf_group_get, 851 .pin_config_group_set = sprd_pinconf_group_set, 852 .pin_config_dbg_show = sprd_pinconf_dbg_show, 853 .pin_config_group_dbg_show = sprd_pinconf_group_dbg_show, 854 }; 855 856 static const struct pinconf_generic_params sprd_dt_params[] = { 857 {"sprd,control", SPRD_PIN_CONFIG_CONTROL, 0}, 858 {"sprd,sleep-mode", SPRD_PIN_CONFIG_SLEEP_MODE, 0}, 859 }; 860 861 #ifdef CONFIG_DEBUG_FS 862 static const struct pin_config_item sprd_conf_items[] = { 863 PCONFDUMP(SPRD_PIN_CONFIG_CONTROL, "global control", NULL, true), 864 PCONFDUMP(SPRD_PIN_CONFIG_SLEEP_MODE, "sleep mode", NULL, true), 865 }; 866 #endif 867 868 static struct pinctrl_desc sprd_pinctrl_desc = { 869 .pctlops = &sprd_pctrl_ops, 870 .pmxops = &sprd_pmx_ops, 871 .confops = &sprd_pinconf_ops, 872 .num_custom_params = ARRAY_SIZE(sprd_dt_params), 873 .custom_params = sprd_dt_params, 874 #ifdef CONFIG_DEBUG_FS 875 .custom_conf_items = sprd_conf_items, 876 #endif 877 .owner = THIS_MODULE, 878 }; 879 880 static int sprd_pinctrl_parse_groups(struct device_node *np, 881 struct sprd_pinctrl *sprd_pctl, 882 struct sprd_pin_group *grp) 883 { 884 struct property *prop; 885 const char *pin_name; 886 int ret, i = 0; 887 888 ret = of_property_count_strings(np, "pins"); 889 if (ret < 0) 890 return ret; 891 892 grp->name = np->name; 893 grp->npins = ret; 894 grp->pins = devm_kcalloc(sprd_pctl->dev, 895 grp->npins, sizeof(unsigned int), 896 GFP_KERNEL); 897 if (!grp->pins) 898 return -ENOMEM; 899 900 of_property_for_each_string(np, "pins", prop, pin_name) { 901 ret = sprd_pinctrl_get_id_by_name(sprd_pctl, pin_name); 902 if (ret >= 0) 903 grp->pins[i++] = ret; 904 } 905 906 for (i = 0; i < grp->npins; i++) { 907 dev_dbg(sprd_pctl->dev, 908 "Group[%s] contains [%d] pins: id = %d\n", 909 grp->name, grp->npins, grp->pins[i]); 910 } 911 912 return 0; 913 } 914 915 static unsigned int sprd_pinctrl_get_groups(struct device_node *np) 916 { 917 struct device_node *child; 918 unsigned int group_cnt, cnt; 919 920 group_cnt = of_get_child_count(np); 921 922 for_each_child_of_node(np, child) { 923 cnt = of_get_child_count(child); 924 if (cnt > 0) 925 group_cnt += cnt; 926 } 927 928 return group_cnt; 929 } 930 931 static int sprd_pinctrl_parse_dt(struct sprd_pinctrl *sprd_pctl) 932 { 933 struct sprd_pinctrl_soc_info *info = sprd_pctl->info; 934 struct device_node *np = sprd_pctl->dev->of_node; 935 struct device_node *child, *sub_child; 936 struct sprd_pin_group *grp; 937 const char **temp; 938 int ret; 939 940 if (!np) 941 return -ENODEV; 942 943 info->ngroups = sprd_pinctrl_get_groups(np); 944 if (!info->ngroups) 945 return 0; 946 947 info->groups = devm_kcalloc(sprd_pctl->dev, 948 info->ngroups, 949 sizeof(struct sprd_pin_group), 950 GFP_KERNEL); 951 if (!info->groups) 952 return -ENOMEM; 953 954 info->grp_names = devm_kcalloc(sprd_pctl->dev, 955 info->ngroups, sizeof(char *), 956 GFP_KERNEL); 957 if (!info->grp_names) 958 return -ENOMEM; 959 960 temp = info->grp_names; 961 grp = info->groups; 962 963 for_each_child_of_node(np, child) { 964 ret = sprd_pinctrl_parse_groups(child, sprd_pctl, grp); 965 if (ret) { 966 of_node_put(child); 967 return ret; 968 } 969 970 *temp++ = grp->name; 971 grp++; 972 973 if (of_get_child_count(child) > 0) { 974 for_each_child_of_node(child, sub_child) { 975 ret = sprd_pinctrl_parse_groups(sub_child, 976 sprd_pctl, grp); 977 if (ret) { 978 of_node_put(sub_child); 979 of_node_put(child); 980 return ret; 981 } 982 983 *temp++ = grp->name; 984 grp++; 985 } 986 } 987 } 988 989 return 0; 990 } 991 992 static int sprd_pinctrl_add_pins(struct sprd_pinctrl *sprd_pctl, 993 struct sprd_pins_info *sprd_soc_pin_info, 994 int pins_cnt) 995 { 996 struct sprd_pinctrl_soc_info *info = sprd_pctl->info; 997 unsigned int ctrl_pin = 0, com_pin = 0; 998 struct sprd_pin *pin; 999 int i; 1000 1001 info->npins = pins_cnt; 1002 info->pins = devm_kcalloc(sprd_pctl->dev, 1003 info->npins, sizeof(struct sprd_pin), 1004 GFP_KERNEL); 1005 if (!info->pins) 1006 return -ENOMEM; 1007 1008 for (i = 0, pin = info->pins; i < info->npins; i++, pin++) { 1009 unsigned int reg; 1010 1011 pin->name = sprd_soc_pin_info[i].name; 1012 pin->type = sprd_soc_pin_info[i].type; 1013 pin->number = sprd_soc_pin_info[i].num; 1014 reg = sprd_soc_pin_info[i].reg; 1015 if (pin->type == GLOBAL_CTRL_PIN) { 1016 pin->reg = (unsigned long)sprd_pctl->base + 1017 PINCTRL_REG_LEN * reg; 1018 pin->bit_offset = sprd_soc_pin_info[i].bit_offset; 1019 pin->bit_width = sprd_soc_pin_info[i].bit_width; 1020 ctrl_pin++; 1021 } else if (pin->type == COMMON_PIN) { 1022 pin->reg = (unsigned long)sprd_pctl->base + 1023 PINCTRL_REG_OFFSET + PINCTRL_REG_LEN * 1024 (i - ctrl_pin); 1025 com_pin++; 1026 } else if (pin->type == MISC_PIN) { 1027 pin->reg = (unsigned long)sprd_pctl->base + 1028 PINCTRL_REG_MISC_OFFSET + PINCTRL_REG_LEN * 1029 (i - ctrl_pin - com_pin); 1030 } 1031 } 1032 1033 for (i = 0, pin = info->pins; i < info->npins; pin++, i++) { 1034 dev_dbg(sprd_pctl->dev, "pin name[%s-%d], type = %d, " 1035 "bit offset = %ld, bit width = %ld, reg = 0x%lx\n", 1036 pin->name, pin->number, pin->type, 1037 pin->bit_offset, pin->bit_width, pin->reg); 1038 } 1039 1040 return 0; 1041 } 1042 1043 int sprd_pinctrl_core_probe(struct platform_device *pdev, 1044 struct sprd_pins_info *sprd_soc_pin_info, 1045 int pins_cnt) 1046 { 1047 struct sprd_pinctrl *sprd_pctl; 1048 struct sprd_pinctrl_soc_info *pinctrl_info; 1049 struct pinctrl_pin_desc *pin_desc; 1050 int ret, i; 1051 1052 sprd_pctl = devm_kzalloc(&pdev->dev, sizeof(struct sprd_pinctrl), 1053 GFP_KERNEL); 1054 if (!sprd_pctl) 1055 return -ENOMEM; 1056 1057 sprd_pctl->base = devm_platform_ioremap_resource(pdev, 0); 1058 if (IS_ERR(sprd_pctl->base)) 1059 return PTR_ERR(sprd_pctl->base); 1060 1061 pinctrl_info = devm_kzalloc(&pdev->dev, 1062 sizeof(struct sprd_pinctrl_soc_info), 1063 GFP_KERNEL); 1064 if (!pinctrl_info) 1065 return -ENOMEM; 1066 1067 sprd_pctl->info = pinctrl_info; 1068 sprd_pctl->dev = &pdev->dev; 1069 platform_set_drvdata(pdev, sprd_pctl); 1070 1071 ret = sprd_pinctrl_add_pins(sprd_pctl, sprd_soc_pin_info, pins_cnt); 1072 if (ret) { 1073 dev_err(&pdev->dev, "fail to add pins information\n"); 1074 return ret; 1075 } 1076 1077 ret = sprd_pinctrl_parse_dt(sprd_pctl); 1078 if (ret) { 1079 dev_err(&pdev->dev, "fail to parse dt properties\n"); 1080 return ret; 1081 } 1082 1083 pin_desc = devm_kcalloc(&pdev->dev, 1084 pinctrl_info->npins, 1085 sizeof(struct pinctrl_pin_desc), 1086 GFP_KERNEL); 1087 if (!pin_desc) 1088 return -ENOMEM; 1089 1090 for (i = 0; i < pinctrl_info->npins; i++) { 1091 pin_desc[i].number = pinctrl_info->pins[i].number; 1092 pin_desc[i].name = pinctrl_info->pins[i].name; 1093 pin_desc[i].drv_data = pinctrl_info; 1094 } 1095 1096 sprd_pinctrl_desc.pins = pin_desc; 1097 sprd_pinctrl_desc.name = dev_name(&pdev->dev); 1098 sprd_pinctrl_desc.npins = pinctrl_info->npins; 1099 1100 sprd_pctl->pctl = pinctrl_register(&sprd_pinctrl_desc, 1101 &pdev->dev, (void *)sprd_pctl); 1102 if (IS_ERR(sprd_pctl->pctl)) { 1103 dev_err(&pdev->dev, "could not register pinctrl driver\n"); 1104 return PTR_ERR(sprd_pctl->pctl); 1105 } 1106 1107 return 0; 1108 } 1109 EXPORT_SYMBOL_GPL(sprd_pinctrl_core_probe); 1110 1111 int sprd_pinctrl_remove(struct platform_device *pdev) 1112 { 1113 struct sprd_pinctrl *sprd_pctl = platform_get_drvdata(pdev); 1114 1115 pinctrl_unregister(sprd_pctl->pctl); 1116 return 0; 1117 } 1118 EXPORT_SYMBOL_GPL(sprd_pinctrl_remove); 1119 1120 void sprd_pinctrl_shutdown(struct platform_device *pdev) 1121 { 1122 struct pinctrl *pinctl; 1123 struct pinctrl_state *state; 1124 1125 pinctl = devm_pinctrl_get(&pdev->dev); 1126 if (IS_ERR(pinctl)) 1127 return; 1128 state = pinctrl_lookup_state(pinctl, "shutdown"); 1129 if (IS_ERR(state)) 1130 return; 1131 pinctrl_select_state(pinctl, state); 1132 } 1133 EXPORT_SYMBOL_GPL(sprd_pinctrl_shutdown); 1134 1135 MODULE_DESCRIPTION("SPREADTRUM Pin Controller Driver"); 1136 MODULE_AUTHOR("Baolin Wang <baolin.wang@spreadtrum.com>"); 1137 MODULE_LICENSE("GPL v2"); 1138