| .. | .. |
|---|
| 20 | 20 | #include <linux/platform_device.h> |
|---|
| 21 | 21 | #include <linux/io.h> |
|---|
| 22 | 22 | #include <linux/bitops.h> |
|---|
| 23 | | -#include <linux/gpio.h> |
|---|
| 23 | +#include <linux/gpio/driver.h> |
|---|
| 24 | 24 | #include <linux/of_address.h> |
|---|
| 25 | | -#include <linux/of_irq.h> |
|---|
| 26 | 25 | #include <linux/of_device.h> |
|---|
| 26 | +#include <linux/of_irq.h> |
|---|
| 27 | 27 | #include <linux/pinctrl/machine.h> |
|---|
| 28 | 28 | #include <linux/pinctrl/pinconf.h> |
|---|
| 29 | 29 | #include <linux/pinctrl/pinctrl.h> |
|---|
| .. | .. |
|---|
| 40 | 40 | #include "pinconf.h" |
|---|
| 41 | 41 | #include "pinctrl-rockchip.h" |
|---|
| 42 | 42 | |
|---|
| 43 | | -/** |
|---|
| 43 | +/* |
|---|
| 44 | 44 | * Generate a bitmask for setting a value (v) with a write mask bit in hiword |
|---|
| 45 | 45 | * register 31:16 area. |
|---|
| 46 | 46 | */ |
|---|
| .. | .. |
|---|
| 117 | 117 | { .drv_type = type2, .offset = -1 }, \ |
|---|
| 118 | 118 | { .drv_type = type3, .offset = -1 }, \ |
|---|
| 119 | 119 | }, \ |
|---|
| 120 | + } |
|---|
| 121 | + |
|---|
| 122 | +#define PIN_BANK_IOMUX_FLAGS_PULL_FLAGS(id, pins, label, iom0, iom1, \ |
|---|
| 123 | + iom2, iom3, pull0, pull1, \ |
|---|
| 124 | + pull2, pull3) \ |
|---|
| 125 | + { \ |
|---|
| 126 | + .bank_num = id, \ |
|---|
| 127 | + .nr_pins = pins, \ |
|---|
| 128 | + .name = label, \ |
|---|
| 129 | + .iomux = { \ |
|---|
| 130 | + { .type = iom0, .offset = -1 }, \ |
|---|
| 131 | + { .type = iom1, .offset = -1 }, \ |
|---|
| 132 | + { .type = iom2, .offset = -1 }, \ |
|---|
| 133 | + { .type = iom3, .offset = -1 }, \ |
|---|
| 134 | + }, \ |
|---|
| 135 | + .pull_type[0] = pull0, \ |
|---|
| 136 | + .pull_type[1] = pull1, \ |
|---|
| 137 | + .pull_type[2] = pull2, \ |
|---|
| 138 | + .pull_type[3] = pull3, \ |
|---|
| 120 | 139 | } |
|---|
| 121 | 140 | |
|---|
| 122 | 141 | #define PIN_BANK_DRV_FLAGS_PULL_FLAGS(id, pins, label, drv0, drv1, \ |
|---|
| .. | .. |
|---|
| 204 | 223 | .route_location = FLAG, \ |
|---|
| 205 | 224 | } |
|---|
| 206 | 225 | |
|---|
| 207 | | -#define PX30S_PIN_BANK_FLAGS(ID, PIN, LABEL, MTYPE, DTYPE) \ |
|---|
| 226 | +#define S_PIN_BANK_FLAGS(ID, PIN, LABEL, MTYPE, DTYPE) \ |
|---|
| 208 | 227 | PIN_BANK_IOMUX_DRV_FLAGS_OFFSET(ID, PIN, LABEL, \ |
|---|
| 209 | 228 | MTYPE, MTYPE, MTYPE, MTYPE, \ |
|---|
| 210 | 229 | DTYPE, DTYPE, DTYPE, DTYPE, \ |
|---|
| .. | .. |
|---|
| 218 | 237 | |
|---|
| 219 | 238 | #define RK_MUXROUTE_PMU(ID, PIN, FUNC, REG, VAL) \ |
|---|
| 220 | 239 | PIN_BANK_MUX_ROUTE_FLAGS(ID, PIN, FUNC, REG, VAL, ROCKCHIP_ROUTE_PMU) |
|---|
| 240 | + |
|---|
| 241 | +#define RK3588_PIN_BANK_FLAGS(ID, PIN, LABEL, M, P) \ |
|---|
| 242 | + PIN_BANK_IOMUX_FLAGS_PULL_FLAGS(ID, PIN, LABEL, M, M, M, M, P, P, P, P) |
|---|
| 243 | + |
|---|
| 244 | +static struct pinctrl_dev *g_pctldev; |
|---|
| 245 | +static DEFINE_MUTEX(iomux_lock); |
|---|
| 221 | 246 | |
|---|
| 222 | 247 | static struct regmap_config rockchip_regmap_config = { |
|---|
| 223 | 248 | .reg_bits = 32, |
|---|
| .. | .. |
|---|
| 309 | 334 | { |
|---|
| 310 | 335 | struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
|---|
| 311 | 336 | const struct rockchip_pin_group *grp; |
|---|
| 337 | + struct device *dev = info->dev; |
|---|
| 312 | 338 | struct pinctrl_map *new_map; |
|---|
| 313 | 339 | struct device_node *parent; |
|---|
| 314 | 340 | int map_num = 1; |
|---|
| .. | .. |
|---|
| 320 | 346 | */ |
|---|
| 321 | 347 | grp = pinctrl_name_to_group(info, np->name); |
|---|
| 322 | 348 | if (!grp) { |
|---|
| 323 | | - dev_err(info->dev, "unable to find group for node %pOFn\n", |
|---|
| 324 | | - np); |
|---|
| 349 | + dev_err(dev, "unable to find group for node %pOFn\n", np); |
|---|
| 325 | 350 | return -EINVAL; |
|---|
| 326 | 351 | } |
|---|
| 327 | 352 | |
|---|
| .. | .. |
|---|
| 355 | 380 | new_map[i].data.configs.num_configs = grp->data[i].nconfigs; |
|---|
| 356 | 381 | } |
|---|
| 357 | 382 | |
|---|
| 358 | | - dev_dbg(pctldev->dev, "maps: function %s group %s num %d\n", |
|---|
| 383 | + dev_dbg(dev, "maps: function %s group %s num %d\n", |
|---|
| 359 | 384 | (*map)->data.mux.function, (*map)->data.mux.group, map_num); |
|---|
| 360 | 385 | |
|---|
| 361 | 386 | return 0; |
|---|
| .. | .. |
|---|
| 510 | 535 | |
|---|
| 511 | 536 | static struct rockchip_mux_recalced_data rk3308_mux_recalced_data[] = { |
|---|
| 512 | 537 | { |
|---|
| 538 | + /* gpio1b6_sel */ |
|---|
| 513 | 539 | .num = 1, |
|---|
| 514 | 540 | .pin = 14, |
|---|
| 515 | 541 | .reg = 0x28, |
|---|
| 516 | 542 | .bit = 12, |
|---|
| 517 | 543 | .mask = 0xf |
|---|
| 518 | 544 | }, { |
|---|
| 545 | + /* gpio1b7_sel */ |
|---|
| 519 | 546 | .num = 1, |
|---|
| 520 | 547 | .pin = 15, |
|---|
| 521 | 548 | .reg = 0x2c, |
|---|
| 522 | 549 | .bit = 0, |
|---|
| 523 | 550 | .mask = 0x3 |
|---|
| 524 | 551 | }, { |
|---|
| 552 | + /* gpio1c2_sel */ |
|---|
| 525 | 553 | .num = 1, |
|---|
| 526 | 554 | .pin = 18, |
|---|
| 527 | 555 | .reg = 0x30, |
|---|
| 528 | 556 | .bit = 4, |
|---|
| 529 | 557 | .mask = 0xf |
|---|
| 530 | 558 | }, { |
|---|
| 559 | + /* gpio1c3_sel */ |
|---|
| 531 | 560 | .num = 1, |
|---|
| 532 | 561 | .pin = 19, |
|---|
| 533 | 562 | .reg = 0x30, |
|---|
| 534 | 563 | .bit = 8, |
|---|
| 535 | 564 | .mask = 0xf |
|---|
| 536 | 565 | }, { |
|---|
| 566 | + /* gpio1c4_sel */ |
|---|
| 537 | 567 | .num = 1, |
|---|
| 538 | 568 | .pin = 20, |
|---|
| 539 | 569 | .reg = 0x30, |
|---|
| 540 | 570 | .bit = 12, |
|---|
| 541 | 571 | .mask = 0xf |
|---|
| 542 | 572 | }, { |
|---|
| 573 | + /* gpio1c5_sel */ |
|---|
| 543 | 574 | .num = 1, |
|---|
| 544 | 575 | .pin = 21, |
|---|
| 545 | 576 | .reg = 0x34, |
|---|
| 546 | 577 | .bit = 0, |
|---|
| 547 | 578 | .mask = 0xf |
|---|
| 548 | 579 | }, { |
|---|
| 580 | + /* gpio1c6_sel */ |
|---|
| 549 | 581 | .num = 1, |
|---|
| 550 | 582 | .pin = 22, |
|---|
| 551 | 583 | .reg = 0x34, |
|---|
| 552 | 584 | .bit = 4, |
|---|
| 553 | 585 | .mask = 0xf |
|---|
| 554 | 586 | }, { |
|---|
| 587 | + /* gpio1c7_sel */ |
|---|
| 555 | 588 | .num = 1, |
|---|
| 556 | 589 | .pin = 23, |
|---|
| 557 | 590 | .reg = 0x34, |
|---|
| 558 | 591 | .bit = 8, |
|---|
| 559 | 592 | .mask = 0xf |
|---|
| 560 | 593 | }, { |
|---|
| 561 | | - .num = 3, |
|---|
| 562 | | - .pin = 12, |
|---|
| 563 | | - .reg = 0x68, |
|---|
| 564 | | - .bit = 8, |
|---|
| 565 | | - .mask = 0xf |
|---|
| 566 | | - }, { |
|---|
| 567 | | - .num = 3, |
|---|
| 568 | | - .pin = 13, |
|---|
| 569 | | - .reg = 0x68, |
|---|
| 570 | | - .bit = 12, |
|---|
| 571 | | - .mask = 0xf |
|---|
| 572 | | - }, |
|---|
| 573 | | -}; |
|---|
| 574 | | - |
|---|
| 575 | | -static struct rockchip_mux_recalced_data rk3308b_mux_recalced_data[] = { |
|---|
| 576 | | - { |
|---|
| 577 | | - .num = 1, |
|---|
| 578 | | - .pin = 14, |
|---|
| 579 | | - .reg = 0x28, |
|---|
| 580 | | - .bit = 12, |
|---|
| 581 | | - .mask = 0xf |
|---|
| 582 | | - }, { |
|---|
| 583 | | - .num = 1, |
|---|
| 584 | | - .pin = 15, |
|---|
| 585 | | - .reg = 0x2c, |
|---|
| 586 | | - .bit = 0, |
|---|
| 587 | | - .mask = 0x3 |
|---|
| 588 | | - }, { |
|---|
| 589 | | - .num = 1, |
|---|
| 590 | | - .pin = 18, |
|---|
| 591 | | - .reg = 0x30, |
|---|
| 592 | | - .bit = 4, |
|---|
| 593 | | - .mask = 0xf |
|---|
| 594 | | - }, { |
|---|
| 595 | | - .num = 1, |
|---|
| 596 | | - .pin = 19, |
|---|
| 597 | | - .reg = 0x30, |
|---|
| 598 | | - .bit = 8, |
|---|
| 599 | | - .mask = 0xf |
|---|
| 600 | | - }, { |
|---|
| 601 | | - .num = 1, |
|---|
| 602 | | - .pin = 20, |
|---|
| 603 | | - .reg = 0x30, |
|---|
| 604 | | - .bit = 12, |
|---|
| 605 | | - .mask = 0xf |
|---|
| 606 | | - }, { |
|---|
| 607 | | - .num = 1, |
|---|
| 608 | | - .pin = 21, |
|---|
| 609 | | - .reg = 0x34, |
|---|
| 610 | | - .bit = 0, |
|---|
| 611 | | - .mask = 0xf |
|---|
| 612 | | - }, { |
|---|
| 613 | | - .num = 1, |
|---|
| 614 | | - .pin = 22, |
|---|
| 615 | | - .reg = 0x34, |
|---|
| 616 | | - .bit = 4, |
|---|
| 617 | | - .mask = 0xf |
|---|
| 618 | | - }, { |
|---|
| 619 | | - .num = 1, |
|---|
| 620 | | - .pin = 23, |
|---|
| 621 | | - .reg = 0x34, |
|---|
| 622 | | - .bit = 8, |
|---|
| 623 | | - .mask = 0xf |
|---|
| 624 | | - }, { |
|---|
| 625 | | - .num = 3, |
|---|
| 626 | | - .pin = 12, |
|---|
| 627 | | - .reg = 0x68, |
|---|
| 628 | | - .bit = 8, |
|---|
| 629 | | - .mask = 0xf |
|---|
| 630 | | - }, { |
|---|
| 631 | | - .num = 3, |
|---|
| 632 | | - .pin = 13, |
|---|
| 633 | | - .reg = 0x68, |
|---|
| 634 | | - .bit = 12, |
|---|
| 635 | | - .mask = 0xf |
|---|
| 636 | | - }, { |
|---|
| 594 | + /* gpio2a2_sel_plus */ |
|---|
| 637 | 595 | .num = 2, |
|---|
| 638 | 596 | .pin = 2, |
|---|
| 639 | 597 | .reg = 0x608, |
|---|
| 640 | 598 | .bit = 0, |
|---|
| 641 | 599 | .mask = 0x7 |
|---|
| 642 | 600 | }, { |
|---|
| 601 | + /* gpio2a3_sel_plus */ |
|---|
| 643 | 602 | .num = 2, |
|---|
| 644 | 603 | .pin = 3, |
|---|
| 645 | 604 | .reg = 0x608, |
|---|
| 646 | 605 | .bit = 4, |
|---|
| 647 | 606 | .mask = 0x7 |
|---|
| 648 | 607 | }, { |
|---|
| 608 | + /* gpio2c0_sel_plus */ |
|---|
| 649 | 609 | .num = 2, |
|---|
| 650 | 610 | .pin = 16, |
|---|
| 651 | 611 | .reg = 0x610, |
|---|
| 652 | 612 | .bit = 8, |
|---|
| 653 | 613 | .mask = 0x7 |
|---|
| 654 | 614 | }, { |
|---|
| 615 | + /* gpio3b2_sel_plus */ |
|---|
| 655 | 616 | .num = 3, |
|---|
| 656 | 617 | .pin = 10, |
|---|
| 657 | 618 | .reg = 0x610, |
|---|
| 658 | 619 | .bit = 0, |
|---|
| 659 | 620 | .mask = 0x7 |
|---|
| 660 | 621 | }, { |
|---|
| 622 | + /* gpio3b3_sel_plus */ |
|---|
| 661 | 623 | .num = 3, |
|---|
| 662 | 624 | .pin = 11, |
|---|
| 663 | 625 | .reg = 0x610, |
|---|
| 664 | 626 | .bit = 4, |
|---|
| 665 | 627 | .mask = 0x7 |
|---|
| 628 | + }, { |
|---|
| 629 | + /* gpio3b4_sel */ |
|---|
| 630 | + .num = 3, |
|---|
| 631 | + .pin = 12, |
|---|
| 632 | + .reg = 0x68, |
|---|
| 633 | + .bit = 8, |
|---|
| 634 | + .mask = 0xf |
|---|
| 635 | + }, { |
|---|
| 636 | + /* gpio3b5_sel */ |
|---|
| 637 | + .num = 3, |
|---|
| 638 | + .pin = 13, |
|---|
| 639 | + .reg = 0x68, |
|---|
| 640 | + .bit = 12, |
|---|
| 641 | + .mask = 0xf |
|---|
| 666 | 642 | }, |
|---|
| 667 | 643 | }; |
|---|
| 668 | 644 | |
|---|
| .. | .. |
|---|
| 914 | 890 | RK_MUXROUTE_SAME(0, RK_PC3, 1, 0x314, BIT(16 + 0) | BIT(0)), /* rtc_clk */ |
|---|
| 915 | 891 | RK_MUXROUTE_SAME(1, RK_PC6, 2, 0x314, BIT(16 + 2) | BIT(16 + 3)), /* uart2_rxm0 */ |
|---|
| 916 | 892 | RK_MUXROUTE_SAME(4, RK_PD2, 2, 0x314, BIT(16 + 2) | BIT(16 + 3) | BIT(2)), /* uart2_rxm1 */ |
|---|
| 917 | | - RK_MUXROUTE_SAME(0, RK_PC7, 2, 0x314, BIT(16 + 4)), /* i2c3_sdam0 */ |
|---|
| 918 | | - RK_MUXROUTE_SAME(3, RK_PB4, 2, 0x314, BIT(16 + 4) | BIT(4)), /* i2c3_sdam1 */ |
|---|
| 919 | | - RK_MUXROUTE_SAME(1, RK_PA3, 2, 0x308, BIT(16 + 3)), /* i2s-8ch-1-sclktxm0 */ |
|---|
| 920 | | - RK_MUXROUTE_SAME(1, RK_PA4, 2, 0x308, BIT(16 + 3)), /* i2s-8ch-1-sclkrxm0 */ |
|---|
| 921 | | - RK_MUXROUTE_SAME(1, RK_PB5, 2, 0x308, BIT(16 + 3) | BIT(3)), /* i2s-8ch-1-sclktxm1 */ |
|---|
| 922 | | - RK_MUXROUTE_SAME(1, RK_PB6, 2, 0x308, BIT(16 + 3) | BIT(3)), /* i2s-8ch-1-sclkrxm1 */ |
|---|
| 923 | | - RK_MUXROUTE_SAME(1, RK_PA4, 3, 0x308, BIT(16 + 12) | BIT(16 + 13)), /* pdm-clkm0 */ |
|---|
| 924 | | - RK_MUXROUTE_SAME(1, RK_PB6, 4, 0x308, BIT(16 + 12) | BIT(16 + 13) | BIT(12)), /* pdm-clkm1 */ |
|---|
| 925 | | - RK_MUXROUTE_SAME(2, RK_PA6, 2, 0x308, BIT(16 + 12) | BIT(16 + 13) | BIT(13)), /* pdm-clkm2 */ |
|---|
| 926 | | - RK_MUXROUTE_SAME(2, RK_PA4, 3, 0x600, BIT(16 + 2) | BIT(2)), /* pdm-clkm-m2 */ |
|---|
| 927 | | -}; |
|---|
| 928 | | - |
|---|
| 929 | | -static struct rockchip_mux_route_data rk3308b_mux_route_data[] = { |
|---|
| 930 | | - RK_MUXROUTE_SAME(0, RK_PC3, 1, 0x314, BIT(16 + 0) | BIT(0)), /* rtc_clk */ |
|---|
| 931 | | - RK_MUXROUTE_SAME(1, RK_PC6, 2, 0x314, BIT(16 + 2) | BIT(16 + 3)), /* uart2_rxm0 */ |
|---|
| 932 | | - RK_MUXROUTE_SAME(4, RK_PD2, 2, 0x314, BIT(16 + 2) | BIT(16 + 3) | BIT(2)), /* uart2_rxm1 */ |
|---|
| 933 | 893 | RK_MUXROUTE_SAME(0, RK_PB7, 2, 0x608, BIT(16 + 8) | BIT(16 + 9)), /* i2c3_sdam0 */ |
|---|
| 934 | 894 | RK_MUXROUTE_SAME(3, RK_PB4, 2, 0x608, BIT(16 + 8) | BIT(16 + 9) | BIT(8)), /* i2c3_sdam1 */ |
|---|
| 935 | 895 | RK_MUXROUTE_SAME(2, RK_PA0, 3, 0x608, BIT(16 + 8) | BIT(16 + 9) | BIT(9)), /* i2c3_sdam2 */ |
|---|
| .. | .. |
|---|
| 1053 | 1013 | RK_MUXROUTE_GRF(4, RK_PC5, 4, 0x0310, WRITE_MASK_VAL(9, 8, 1)), /* UART9 IO mux M1 */ |
|---|
| 1054 | 1014 | RK_MUXROUTE_GRF(4, RK_PA4, 4, 0x0310, WRITE_MASK_VAL(9, 8, 2)), /* UART9 IO mux M2 */ |
|---|
| 1055 | 1015 | RK_MUXROUTE_GRF(1, RK_PA2, 1, 0x0310, WRITE_MASK_VAL(11, 10, 0)), /* I2S1 IO mux M0 */ |
|---|
| 1056 | | - RK_MUXROUTE_GRF(1, RK_PA3, 1, 0x0310, WRITE_MASK_VAL(11, 10, 0)), /* I2S1 IO mux sclk tx M0 */ |
|---|
| 1057 | | - RK_MUXROUTE_GRF(1, RK_PA4, 1, 0x0310, WRITE_MASK_VAL(11, 10, 0)), /* I2S1 IO mux sclk rx M0 */ |
|---|
| 1058 | 1016 | RK_MUXROUTE_GRF(3, RK_PC6, 4, 0x0310, WRITE_MASK_VAL(11, 10, 1)), /* I2S1 IO mux M1 */ |
|---|
| 1059 | | - RK_MUXROUTE_GRF(3, RK_PC7, 4, 0x0310, WRITE_MASK_VAL(11, 10, 1)), /* I2S1 IO mux sclk tx M1 */ |
|---|
| 1060 | | - RK_MUXROUTE_GRF(4, RK_PA6, 5, 0x0310, WRITE_MASK_VAL(11, 10, 1)), /* I2S1 IO mux sclk rx M1 */ |
|---|
| 1061 | 1017 | RK_MUXROUTE_GRF(2, RK_PD0, 5, 0x0310, WRITE_MASK_VAL(11, 10, 2)), /* I2S1 IO mux M2 */ |
|---|
| 1062 | | - RK_MUXROUTE_GRF(2, RK_PD1, 5, 0x0310, WRITE_MASK_VAL(11, 10, 2)), /* I2S1 IO mux sclk tx M2 */ |
|---|
| 1063 | | - RK_MUXROUTE_GRF(3, RK_PC3, 5, 0x0310, WRITE_MASK_VAL(11, 10, 2)), /* I2S1 IO mux sclk rx M2 */ |
|---|
| 1064 | 1018 | RK_MUXROUTE_GRF(2, RK_PC1, 1, 0x0310, WRITE_MASK_VAL(12, 12, 0)), /* I2S2 IO mux M0 */ |
|---|
| 1065 | | - RK_MUXROUTE_GRF(2, RK_PC2, 1, 0x0310, WRITE_MASK_VAL(12, 12, 0)), /* I2S2 IO mux sclk tx M0 */ |
|---|
| 1066 | | - RK_MUXROUTE_GRF(2, RK_PB7, 1, 0x0310, WRITE_MASK_VAL(12, 12, 0)), /* I2S2 IO mux sclk rx M0 */ |
|---|
| 1067 | 1019 | RK_MUXROUTE_GRF(4, RK_PB6, 5, 0x0310, WRITE_MASK_VAL(12, 12, 1)), /* I2S2 IO mux M1 */ |
|---|
| 1068 | | - RK_MUXROUTE_GRF(4, RK_PB7, 4, 0x0310, WRITE_MASK_VAL(12, 12, 1)), /* I2S1 IO mux sclk tx M1 */ |
|---|
| 1069 | | - RK_MUXROUTE_GRF(4, RK_PC1, 5, 0x0310, WRITE_MASK_VAL(12, 12, 1)), /* I2S1 IO mux sclk rx M1 */ |
|---|
| 1070 | 1020 | RK_MUXROUTE_GRF(3, RK_PA2, 4, 0x0310, WRITE_MASK_VAL(14, 14, 0)), /* I2S3 IO mux M0 */ |
|---|
| 1071 | | - RK_MUXROUTE_GRF(3, RK_PA3, 4, 0x0310, WRITE_MASK_VAL(14, 14, 0)), /* I2S3 IO mux sclk M0 */ |
|---|
| 1072 | 1021 | RK_MUXROUTE_GRF(4, RK_PC2, 5, 0x0310, WRITE_MASK_VAL(14, 14, 1)), /* I2S3 IO mux M1 */ |
|---|
| 1073 | | - RK_MUXROUTE_GRF(4, RK_PC3, 5, 0x0310, WRITE_MASK_VAL(14, 14, 1)), /* I2S3 IO mux sclk M1 */ |
|---|
| 1074 | 1022 | RK_MUXROUTE_GRF(1, RK_PA4, 3, 0x0314, WRITE_MASK_VAL(1, 0, 0)), /* PDM IO mux M0 */ |
|---|
| 1075 | 1023 | RK_MUXROUTE_GRF(1, RK_PA6, 3, 0x0314, WRITE_MASK_VAL(1, 0, 0)), /* PDM IO mux M0 */ |
|---|
| 1076 | 1024 | RK_MUXROUTE_GRF(3, RK_PD6, 5, 0x0314, WRITE_MASK_VAL(1, 0, 1)), /* PDM IO mux M1 */ |
|---|
| .. | .. |
|---|
| 1115 | 1063 | static int rockchip_get_mux(struct rockchip_pin_bank *bank, int pin) |
|---|
| 1116 | 1064 | { |
|---|
| 1117 | 1065 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1066 | + struct rockchip_pin_ctrl *ctrl = info->ctrl; |
|---|
| 1118 | 1067 | int iomux_num = (pin / 8); |
|---|
| 1119 | 1068 | struct regmap *regmap; |
|---|
| 1120 | 1069 | unsigned int val; |
|---|
| .. | .. |
|---|
| 1160 | 1109 | if (bank->recalced_mask & BIT(pin)) |
|---|
| 1161 | 1110 | rockchip_get_recalced_mux(bank, pin, ®, &bit, &mask); |
|---|
| 1162 | 1111 | |
|---|
| 1112 | + if (ctrl->type == RK3588) { |
|---|
| 1113 | + if (bank->bank_num == 0) { |
|---|
| 1114 | + if ((pin >= RK_PB4) && (pin <= RK_PD7)) { |
|---|
| 1115 | + u32 reg0 = 0; |
|---|
| 1116 | + |
|---|
| 1117 | + reg0 = reg + 0x4000 - 0xC; /* PMU2_IOC_BASE */ |
|---|
| 1118 | + ret = regmap_read(regmap, reg0, &val); |
|---|
| 1119 | + if (ret) |
|---|
| 1120 | + return ret; |
|---|
| 1121 | + |
|---|
| 1122 | + if (((val >> bit) & mask) != 8) |
|---|
| 1123 | + return ((val >> bit) & mask); |
|---|
| 1124 | + |
|---|
| 1125 | + reg = reg + 0x8000; /* BUS_IOC_BASE */ |
|---|
| 1126 | + regmap = info->regmap_base; |
|---|
| 1127 | + } |
|---|
| 1128 | + } else if (bank->bank_num > 0) { |
|---|
| 1129 | + reg += 0x8000; /* BUS_IOC_BASE */ |
|---|
| 1130 | + } |
|---|
| 1131 | + } |
|---|
| 1132 | + |
|---|
| 1163 | 1133 | ret = regmap_read(regmap, reg, &val); |
|---|
| 1164 | 1134 | if (ret) |
|---|
| 1165 | 1135 | return ret; |
|---|
| .. | .. |
|---|
| 1171 | 1141 | int pin, int mux) |
|---|
| 1172 | 1142 | { |
|---|
| 1173 | 1143 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1144 | + struct device *dev = info->dev; |
|---|
| 1174 | 1145 | int iomux_num = (pin / 8); |
|---|
| 1175 | 1146 | |
|---|
| 1176 | 1147 | if (iomux_num > 3) |
|---|
| 1177 | 1148 | return -EINVAL; |
|---|
| 1178 | 1149 | |
|---|
| 1179 | 1150 | if (bank->iomux[iomux_num].type & IOMUX_UNROUTED) { |
|---|
| 1180 | | - dev_err(info->dev, "pin %d is unrouted\n", pin); |
|---|
| 1151 | + dev_err(dev, "pin %d is unrouted\n", pin); |
|---|
| 1181 | 1152 | return -EINVAL; |
|---|
| 1182 | 1153 | } |
|---|
| 1183 | 1154 | |
|---|
| 1184 | 1155 | if (bank->iomux[iomux_num].type & IOMUX_GPIO_ONLY) { |
|---|
| 1185 | 1156 | if (mux != RK_FUNC_GPIO) { |
|---|
| 1186 | | - dev_err(info->dev, |
|---|
| 1187 | | - "pin %d only supports a gpio mux\n", pin); |
|---|
| 1157 | + dev_err(dev, "pin %d only supports a gpio mux\n", pin); |
|---|
| 1188 | 1158 | return -ENOTSUPP; |
|---|
| 1189 | 1159 | } |
|---|
| 1190 | 1160 | } |
|---|
| .. | .. |
|---|
| 1208 | 1178 | static int rockchip_set_mux(struct rockchip_pin_bank *bank, int pin, int mux) |
|---|
| 1209 | 1179 | { |
|---|
| 1210 | 1180 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1181 | + struct rockchip_pin_ctrl *ctrl = info->ctrl; |
|---|
| 1182 | + struct device *dev = info->dev; |
|---|
| 1211 | 1183 | int iomux_num = (pin / 8); |
|---|
| 1212 | 1184 | struct regmap *regmap; |
|---|
| 1213 | 1185 | int reg, ret, mask, mux_type; |
|---|
| .. | .. |
|---|
| 1221 | 1193 | if (bank->iomux[iomux_num].type & IOMUX_GPIO_ONLY) |
|---|
| 1222 | 1194 | return 0; |
|---|
| 1223 | 1195 | |
|---|
| 1224 | | - dev_dbg(info->dev, "setting mux of GPIO%d-%d to %d\n", |
|---|
| 1225 | | - bank->bank_num, pin, mux); |
|---|
| 1196 | + dev_dbg(dev, "setting mux of GPIO%d-%d to %d\n", bank->bank_num, pin, mux); |
|---|
| 1226 | 1197 | |
|---|
| 1227 | 1198 | if (bank->iomux[iomux_num].type & IOMUX_SOURCE_PMU) |
|---|
| 1228 | 1199 | regmap = info->regmap_pmu; |
|---|
| .. | .. |
|---|
| 1251 | 1222 | |
|---|
| 1252 | 1223 | if (bank->recalced_mask & BIT(pin)) |
|---|
| 1253 | 1224 | rockchip_get_recalced_mux(bank, pin, ®, &bit, &mask); |
|---|
| 1225 | + |
|---|
| 1226 | + /* rk3562 force jtag m1 */ |
|---|
| 1227 | + if (ctrl->type == RK3562) { |
|---|
| 1228 | + if (bank->bank_num == 1) { |
|---|
| 1229 | + if ((pin == RK_PB5) || (pin == RK_PB6)) { |
|---|
| 1230 | + if (mux == 1) { |
|---|
| 1231 | + regmap_update_bits(regmap, 0x504, 0x10001, 0x10001); |
|---|
| 1232 | + } else { |
|---|
| 1233 | + regmap_update_bits(regmap, 0x504, 0x10001, 0x10000); |
|---|
| 1234 | + } |
|---|
| 1235 | + } |
|---|
| 1236 | + } |
|---|
| 1237 | + } |
|---|
| 1238 | + |
|---|
| 1239 | + if (ctrl->type == RK3588) { |
|---|
| 1240 | + if (bank->bank_num == 0) { |
|---|
| 1241 | + if ((pin >= RK_PB4) && (pin <= RK_PD7)) { |
|---|
| 1242 | + if (mux < 8) { |
|---|
| 1243 | + u32 reg0 = 0; |
|---|
| 1244 | + |
|---|
| 1245 | + reg0 = reg + 0x4000 - 0xC; /* PMU2_IOC_BASE */ |
|---|
| 1246 | + data = (mask << (bit + 16)); |
|---|
| 1247 | + rmask = data | (data >> 16); |
|---|
| 1248 | + data |= (mux & mask) << bit; |
|---|
| 1249 | + ret = regmap_update_bits(regmap, reg0, rmask, data); |
|---|
| 1250 | + |
|---|
| 1251 | + reg0 = reg + 0x8000; /* BUS_IOC_BASE */ |
|---|
| 1252 | + data = (mask << (bit + 16)); |
|---|
| 1253 | + rmask = data | (data >> 16); |
|---|
| 1254 | + regmap = info->regmap_base; |
|---|
| 1255 | + ret |= regmap_update_bits(regmap, reg0, rmask, data); |
|---|
| 1256 | + } else { |
|---|
| 1257 | + u32 reg0 = 0; |
|---|
| 1258 | + |
|---|
| 1259 | + reg0 = reg + 0x4000 - 0xC; /* PMU2_IOC_BASE */ |
|---|
| 1260 | + data = (mask << (bit + 16)); |
|---|
| 1261 | + rmask = data | (data >> 16); |
|---|
| 1262 | + data |= 8 << bit; |
|---|
| 1263 | + ret = regmap_update_bits(regmap, reg0, rmask, data); |
|---|
| 1264 | + |
|---|
| 1265 | + reg0 = reg + 0x8000; /* BUS_IOC_BASE */ |
|---|
| 1266 | + data = (mask << (bit + 16)); |
|---|
| 1267 | + rmask = data | (data >> 16); |
|---|
| 1268 | + data |= (mux & mask) << bit; |
|---|
| 1269 | + regmap = info->regmap_base; |
|---|
| 1270 | + ret |= regmap_update_bits(regmap, reg0, rmask, data); |
|---|
| 1271 | + } |
|---|
| 1272 | + } else { |
|---|
| 1273 | + data = (mask << (bit + 16)); |
|---|
| 1274 | + rmask = data | (data >> 16); |
|---|
| 1275 | + data |= (mux & mask) << bit; |
|---|
| 1276 | + ret = regmap_update_bits(regmap, reg, rmask, data); |
|---|
| 1277 | + } |
|---|
| 1278 | + return ret; |
|---|
| 1279 | + } else if (bank->bank_num > 0) { |
|---|
| 1280 | + reg += 0x8000; /* BUS_IOC_BASE */ |
|---|
| 1281 | + } |
|---|
| 1282 | + } |
|---|
| 1254 | 1283 | |
|---|
| 1255 | 1284 | if (mux > mask) |
|---|
| 1256 | 1285 | return -EINVAL; |
|---|
| .. | .. |
|---|
| 1300 | 1329 | #define PX30_PULL_PINS_PER_REG 8 |
|---|
| 1301 | 1330 | #define PX30_PULL_BANK_STRIDE 16 |
|---|
| 1302 | 1331 | |
|---|
| 1303 | | -static void px30_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1304 | | - int pin_num, struct regmap **regmap, |
|---|
| 1305 | | - int *reg, u8 *bit) |
|---|
| 1332 | +static int px30_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1333 | + int pin_num, struct regmap **regmap, |
|---|
| 1334 | + int *reg, u8 *bit) |
|---|
| 1306 | 1335 | { |
|---|
| 1307 | 1336 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1308 | 1337 | |
|---|
| .. | .. |
|---|
| 1322 | 1351 | *reg += ((pin_num / PX30_PULL_PINS_PER_REG) * 4); |
|---|
| 1323 | 1352 | *bit = (pin_num % PX30_PULL_PINS_PER_REG); |
|---|
| 1324 | 1353 | *bit *= PX30_PULL_BITS_PER_PIN; |
|---|
| 1354 | + |
|---|
| 1355 | + return 0; |
|---|
| 1325 | 1356 | } |
|---|
| 1326 | 1357 | |
|---|
| 1327 | 1358 | #define PX30_DRV_PMU_OFFSET 0x20 |
|---|
| .. | .. |
|---|
| 1330 | 1361 | #define PX30_DRV_PINS_PER_REG 8 |
|---|
| 1331 | 1362 | #define PX30_DRV_BANK_STRIDE 16 |
|---|
| 1332 | 1363 | |
|---|
| 1333 | | -static void px30_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1334 | | - int pin_num, struct regmap **regmap, |
|---|
| 1335 | | - int *reg, u8 *bit) |
|---|
| 1364 | +static int px30_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1365 | + int pin_num, struct regmap **regmap, |
|---|
| 1366 | + int *reg, u8 *bit) |
|---|
| 1336 | 1367 | { |
|---|
| 1337 | 1368 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1338 | 1369 | |
|---|
| .. | .. |
|---|
| 1352 | 1383 | *reg += ((pin_num / PX30_DRV_PINS_PER_REG) * 4); |
|---|
| 1353 | 1384 | *bit = (pin_num % PX30_DRV_PINS_PER_REG); |
|---|
| 1354 | 1385 | *bit *= PX30_DRV_BITS_PER_PIN; |
|---|
| 1386 | + |
|---|
| 1387 | + return 0; |
|---|
| 1355 | 1388 | } |
|---|
| 1356 | 1389 | |
|---|
| 1357 | 1390 | #define PX30_SCHMITT_PMU_OFFSET 0x38 |
|---|
| .. | .. |
|---|
| 1385 | 1418 | return 0; |
|---|
| 1386 | 1419 | } |
|---|
| 1387 | 1420 | |
|---|
| 1421 | +#define RV1106_DRV_BITS_PER_PIN 8 |
|---|
| 1422 | +#define RV1106_DRV_PINS_PER_REG 2 |
|---|
| 1423 | +#define RV1106_DRV_GPIO0_OFFSET 0x10 |
|---|
| 1424 | +#define RV1106_DRV_GPIO1_OFFSET 0x80 |
|---|
| 1425 | +#define RV1106_DRV_GPIO2_OFFSET 0x100C0 |
|---|
| 1426 | +#define RV1106_DRV_GPIO3_OFFSET 0x20100 |
|---|
| 1427 | +#define RV1106_DRV_GPIO4_OFFSET 0x30020 |
|---|
| 1428 | + |
|---|
| 1429 | +static int rv1106_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1430 | + int pin_num, struct regmap **regmap, |
|---|
| 1431 | + int *reg, u8 *bit) |
|---|
| 1432 | +{ |
|---|
| 1433 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1434 | + |
|---|
| 1435 | + /* GPIO0_IOC is located in PMU */ |
|---|
| 1436 | + switch (bank->bank_num) { |
|---|
| 1437 | + case 0: |
|---|
| 1438 | + *regmap = info->regmap_pmu; |
|---|
| 1439 | + *reg = RV1106_DRV_GPIO0_OFFSET; |
|---|
| 1440 | + break; |
|---|
| 1441 | + |
|---|
| 1442 | + case 1: |
|---|
| 1443 | + *regmap = info->regmap_base; |
|---|
| 1444 | + *reg = RV1106_DRV_GPIO1_OFFSET; |
|---|
| 1445 | + break; |
|---|
| 1446 | + |
|---|
| 1447 | + case 2: |
|---|
| 1448 | + *regmap = info->regmap_base; |
|---|
| 1449 | + *reg = RV1106_DRV_GPIO2_OFFSET; |
|---|
| 1450 | + break; |
|---|
| 1451 | + |
|---|
| 1452 | + case 3: |
|---|
| 1453 | + *regmap = info->regmap_base; |
|---|
| 1454 | + *reg = RV1106_DRV_GPIO3_OFFSET; |
|---|
| 1455 | + break; |
|---|
| 1456 | + |
|---|
| 1457 | + case 4: |
|---|
| 1458 | + *regmap = info->regmap_base; |
|---|
| 1459 | + *reg = RV1106_DRV_GPIO4_OFFSET; |
|---|
| 1460 | + break; |
|---|
| 1461 | + |
|---|
| 1462 | + default: |
|---|
| 1463 | + dev_err(info->dev, "unsupported bank_num %d\n", bank->bank_num); |
|---|
| 1464 | + break; |
|---|
| 1465 | + } |
|---|
| 1466 | + |
|---|
| 1467 | + *reg += ((pin_num / RV1106_DRV_PINS_PER_REG) * 4); |
|---|
| 1468 | + *bit = pin_num % RV1106_DRV_PINS_PER_REG; |
|---|
| 1469 | + *bit *= RV1106_DRV_BITS_PER_PIN; |
|---|
| 1470 | + |
|---|
| 1471 | + return 0; |
|---|
| 1472 | +} |
|---|
| 1473 | + |
|---|
| 1474 | +#define RV1106_PULL_BITS_PER_PIN 2 |
|---|
| 1475 | +#define RV1106_PULL_PINS_PER_REG 8 |
|---|
| 1476 | +#define RV1106_PULL_GPIO0_OFFSET 0x38 |
|---|
| 1477 | +#define RV1106_PULL_GPIO1_OFFSET 0x1C0 |
|---|
| 1478 | +#define RV1106_PULL_GPIO2_OFFSET 0x101D0 |
|---|
| 1479 | +#define RV1106_PULL_GPIO3_OFFSET 0x201E0 |
|---|
| 1480 | +#define RV1106_PULL_GPIO4_OFFSET 0x30070 |
|---|
| 1481 | + |
|---|
| 1482 | +static int rv1106_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1483 | + int pin_num, struct regmap **regmap, |
|---|
| 1484 | + int *reg, u8 *bit) |
|---|
| 1485 | +{ |
|---|
| 1486 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1487 | + |
|---|
| 1488 | + /* GPIO0_IOC is located in PMU */ |
|---|
| 1489 | + switch (bank->bank_num) { |
|---|
| 1490 | + case 0: |
|---|
| 1491 | + *regmap = info->regmap_pmu; |
|---|
| 1492 | + *reg = RV1106_PULL_GPIO0_OFFSET; |
|---|
| 1493 | + break; |
|---|
| 1494 | + |
|---|
| 1495 | + case 1: |
|---|
| 1496 | + *regmap = info->regmap_base; |
|---|
| 1497 | + *reg = RV1106_PULL_GPIO1_OFFSET; |
|---|
| 1498 | + break; |
|---|
| 1499 | + |
|---|
| 1500 | + case 2: |
|---|
| 1501 | + *regmap = info->regmap_base; |
|---|
| 1502 | + *reg = RV1106_PULL_GPIO2_OFFSET; |
|---|
| 1503 | + break; |
|---|
| 1504 | + |
|---|
| 1505 | + case 3: |
|---|
| 1506 | + *regmap = info->regmap_base; |
|---|
| 1507 | + *reg = RV1106_PULL_GPIO3_OFFSET; |
|---|
| 1508 | + break; |
|---|
| 1509 | + |
|---|
| 1510 | + case 4: |
|---|
| 1511 | + *regmap = info->regmap_base; |
|---|
| 1512 | + *reg = RV1106_PULL_GPIO4_OFFSET; |
|---|
| 1513 | + break; |
|---|
| 1514 | + |
|---|
| 1515 | + default: |
|---|
| 1516 | + dev_err(info->dev, "unsupported bank_num %d\n", bank->bank_num); |
|---|
| 1517 | + break; |
|---|
| 1518 | + } |
|---|
| 1519 | + |
|---|
| 1520 | + *reg += ((pin_num / RV1106_PULL_PINS_PER_REG) * 4); |
|---|
| 1521 | + *bit = pin_num % RV1106_PULL_PINS_PER_REG; |
|---|
| 1522 | + *bit *= RV1106_PULL_BITS_PER_PIN; |
|---|
| 1523 | + |
|---|
| 1524 | + return 0; |
|---|
| 1525 | +} |
|---|
| 1526 | + |
|---|
| 1527 | +#define RV1106_SMT_BITS_PER_PIN 1 |
|---|
| 1528 | +#define RV1106_SMT_PINS_PER_REG 8 |
|---|
| 1529 | +#define RV1106_SMT_GPIO0_OFFSET 0x40 |
|---|
| 1530 | +#define RV1106_SMT_GPIO1_OFFSET 0x280 |
|---|
| 1531 | +#define RV1106_SMT_GPIO2_OFFSET 0x10290 |
|---|
| 1532 | +#define RV1106_SMT_GPIO3_OFFSET 0x202A0 |
|---|
| 1533 | +#define RV1106_SMT_GPIO4_OFFSET 0x300A0 |
|---|
| 1534 | + |
|---|
| 1535 | +static int rv1106_calc_schmitt_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1536 | + int pin_num, |
|---|
| 1537 | + struct regmap **regmap, |
|---|
| 1538 | + int *reg, u8 *bit) |
|---|
| 1539 | +{ |
|---|
| 1540 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1541 | + |
|---|
| 1542 | + /* GPIO0_IOC is located in PMU */ |
|---|
| 1543 | + switch (bank->bank_num) { |
|---|
| 1544 | + case 0: |
|---|
| 1545 | + *regmap = info->regmap_pmu; |
|---|
| 1546 | + *reg = RV1106_SMT_GPIO0_OFFSET; |
|---|
| 1547 | + break; |
|---|
| 1548 | + |
|---|
| 1549 | + case 1: |
|---|
| 1550 | + *regmap = info->regmap_base; |
|---|
| 1551 | + *reg = RV1106_SMT_GPIO1_OFFSET; |
|---|
| 1552 | + break; |
|---|
| 1553 | + |
|---|
| 1554 | + case 2: |
|---|
| 1555 | + *regmap = info->regmap_base; |
|---|
| 1556 | + *reg = RV1106_SMT_GPIO2_OFFSET; |
|---|
| 1557 | + break; |
|---|
| 1558 | + |
|---|
| 1559 | + case 3: |
|---|
| 1560 | + *regmap = info->regmap_base; |
|---|
| 1561 | + *reg = RV1106_SMT_GPIO3_OFFSET; |
|---|
| 1562 | + break; |
|---|
| 1563 | + |
|---|
| 1564 | + case 4: |
|---|
| 1565 | + *regmap = info->regmap_base; |
|---|
| 1566 | + *reg = RV1106_SMT_GPIO4_OFFSET; |
|---|
| 1567 | + break; |
|---|
| 1568 | + |
|---|
| 1569 | + default: |
|---|
| 1570 | + dev_err(info->dev, "unsupported bank_num %d\n", bank->bank_num); |
|---|
| 1571 | + break; |
|---|
| 1572 | + } |
|---|
| 1573 | + |
|---|
| 1574 | + *reg += ((pin_num / RV1106_SMT_PINS_PER_REG) * 4); |
|---|
| 1575 | + *bit = pin_num % RV1106_SMT_PINS_PER_REG; |
|---|
| 1576 | + *bit *= RV1106_SMT_BITS_PER_PIN; |
|---|
| 1577 | + |
|---|
| 1578 | + return 0; |
|---|
| 1579 | +} |
|---|
| 1580 | + |
|---|
| 1388 | 1581 | #define RV1108_PULL_PMU_OFFSET 0x10 |
|---|
| 1389 | 1582 | #define RV1108_PULL_OFFSET 0x110 |
|---|
| 1390 | 1583 | #define RV1108_PULL_PINS_PER_REG 8 |
|---|
| 1391 | 1584 | #define RV1108_PULL_BITS_PER_PIN 2 |
|---|
| 1392 | 1585 | #define RV1108_PULL_BANK_STRIDE 16 |
|---|
| 1393 | 1586 | |
|---|
| 1394 | | -static void rv1108_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1395 | | - int pin_num, struct regmap **regmap, |
|---|
| 1396 | | - int *reg, u8 *bit) |
|---|
| 1587 | +static int rv1108_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1588 | + int pin_num, struct regmap **regmap, |
|---|
| 1589 | + int *reg, u8 *bit) |
|---|
| 1397 | 1590 | { |
|---|
| 1398 | 1591 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1399 | 1592 | |
|---|
| .. | .. |
|---|
| 1412 | 1605 | *reg += ((pin_num / RV1108_PULL_PINS_PER_REG) * 4); |
|---|
| 1413 | 1606 | *bit = (pin_num % RV1108_PULL_PINS_PER_REG); |
|---|
| 1414 | 1607 | *bit *= RV1108_PULL_BITS_PER_PIN; |
|---|
| 1608 | + |
|---|
| 1609 | + return 0; |
|---|
| 1415 | 1610 | } |
|---|
| 1416 | 1611 | |
|---|
| 1417 | 1612 | #define RV1108_DRV_PMU_OFFSET 0x20 |
|---|
| .. | .. |
|---|
| 1420 | 1615 | #define RV1108_DRV_PINS_PER_REG 8 |
|---|
| 1421 | 1616 | #define RV1108_DRV_BANK_STRIDE 16 |
|---|
| 1422 | 1617 | |
|---|
| 1423 | | -static void rv1108_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1424 | | - int pin_num, struct regmap **regmap, |
|---|
| 1425 | | - int *reg, u8 *bit) |
|---|
| 1618 | +static int rv1108_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1619 | + int pin_num, struct regmap **regmap, |
|---|
| 1620 | + int *reg, u8 *bit) |
|---|
| 1426 | 1621 | { |
|---|
| 1427 | 1622 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1428 | 1623 | |
|---|
| .. | .. |
|---|
| 1442 | 1637 | *reg += ((pin_num / RV1108_DRV_PINS_PER_REG) * 4); |
|---|
| 1443 | 1638 | *bit = pin_num % RV1108_DRV_PINS_PER_REG; |
|---|
| 1444 | 1639 | *bit *= RV1108_DRV_BITS_PER_PIN; |
|---|
| 1640 | + |
|---|
| 1641 | + return 0; |
|---|
| 1445 | 1642 | } |
|---|
| 1446 | 1643 | |
|---|
| 1447 | 1644 | #define RV1108_SCHMITT_PMU_OFFSET 0x30 |
|---|
| .. | .. |
|---|
| 1481 | 1678 | #define RV1126_PULL_BANK_STRIDE 16 |
|---|
| 1482 | 1679 | #define RV1126_GPIO_C4_D7(p) (p >= 20 && p <= 31) /* GPIO0_C4 ~ GPIO0_D7 */ |
|---|
| 1483 | 1680 | |
|---|
| 1484 | | -static void rv1126_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1485 | | - int pin_num, struct regmap **regmap, |
|---|
| 1486 | | - int *reg, u8 *bit) |
|---|
| 1681 | +static int rv1126_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1682 | + int pin_num, struct regmap **regmap, |
|---|
| 1683 | + int *reg, u8 *bit) |
|---|
| 1487 | 1684 | { |
|---|
| 1488 | 1685 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1489 | 1686 | |
|---|
| .. | .. |
|---|
| 1495 | 1692 | *reg -= (((31 - pin_num) / RV1126_PULL_PINS_PER_REG + 1) * 4); |
|---|
| 1496 | 1693 | *bit = pin_num % RV1126_PULL_PINS_PER_REG; |
|---|
| 1497 | 1694 | *bit *= RV1126_PULL_BITS_PER_PIN; |
|---|
| 1498 | | - return; |
|---|
| 1695 | + return 0; |
|---|
| 1499 | 1696 | } |
|---|
| 1500 | 1697 | *regmap = info->regmap_pmu; |
|---|
| 1501 | 1698 | *reg = RV1126_PULL_PMU_OFFSET; |
|---|
| .. | .. |
|---|
| 1508 | 1705 | *reg += ((pin_num / RV1126_PULL_PINS_PER_REG) * 4); |
|---|
| 1509 | 1706 | *bit = (pin_num % RV1126_PULL_PINS_PER_REG); |
|---|
| 1510 | 1707 | *bit *= RV1126_PULL_BITS_PER_PIN; |
|---|
| 1708 | + |
|---|
| 1709 | + return 0; |
|---|
| 1511 | 1710 | } |
|---|
| 1512 | 1711 | |
|---|
| 1513 | 1712 | #define RV1126_DRV_PMU_OFFSET 0x20 |
|---|
| .. | .. |
|---|
| 1516 | 1715 | #define RV1126_DRV_PINS_PER_REG 4 |
|---|
| 1517 | 1716 | #define RV1126_DRV_BANK_STRIDE 32 |
|---|
| 1518 | 1717 | |
|---|
| 1519 | | -static void rv1126_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1520 | | - int pin_num, struct regmap **regmap, |
|---|
| 1521 | | - int *reg, u8 *bit) |
|---|
| 1718 | +static int rv1126_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1719 | + int pin_num, struct regmap **regmap, |
|---|
| 1720 | + int *reg, u8 *bit) |
|---|
| 1522 | 1721 | { |
|---|
| 1523 | 1722 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1524 | 1723 | |
|---|
| .. | .. |
|---|
| 1531 | 1730 | *reg -= 0x4; |
|---|
| 1532 | 1731 | *bit = pin_num % RV1126_DRV_PINS_PER_REG; |
|---|
| 1533 | 1732 | *bit *= RV1126_DRV_BITS_PER_PIN; |
|---|
| 1534 | | - return; |
|---|
| 1733 | + return 0; |
|---|
| 1535 | 1734 | } |
|---|
| 1536 | 1735 | *regmap = info->regmap_pmu; |
|---|
| 1537 | 1736 | *reg = RV1126_DRV_PMU_OFFSET; |
|---|
| .. | .. |
|---|
| 1544 | 1743 | *reg += ((pin_num / RV1126_DRV_PINS_PER_REG) * 4); |
|---|
| 1545 | 1744 | *bit = pin_num % RV1126_DRV_PINS_PER_REG; |
|---|
| 1546 | 1745 | *bit *= RV1126_DRV_BITS_PER_PIN; |
|---|
| 1746 | + |
|---|
| 1747 | + return 0; |
|---|
| 1547 | 1748 | } |
|---|
| 1548 | 1749 | |
|---|
| 1549 | 1750 | #define RV1126_SCHMITT_PMU_OFFSET 0x60 |
|---|
| .. | .. |
|---|
| 1583 | 1784 | return 0; |
|---|
| 1584 | 1785 | } |
|---|
| 1585 | 1786 | |
|---|
| 1787 | +#define RK3308_SCHMITT_PINS_PER_REG 8 |
|---|
| 1788 | +#define RK3308_SCHMITT_BANK_STRIDE 16 |
|---|
| 1789 | +#define RK3308_SCHMITT_GRF_OFFSET 0x1a0 |
|---|
| 1790 | + |
|---|
| 1791 | +static int rk3308_calc_schmitt_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1792 | + int pin_num, struct regmap **regmap, |
|---|
| 1793 | + int *reg, u8 *bit) |
|---|
| 1794 | +{ |
|---|
| 1795 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1796 | + |
|---|
| 1797 | + *regmap = info->regmap_base; |
|---|
| 1798 | + *reg = RK3308_SCHMITT_GRF_OFFSET; |
|---|
| 1799 | + |
|---|
| 1800 | + *reg += bank->bank_num * RK3308_SCHMITT_BANK_STRIDE; |
|---|
| 1801 | + *reg += ((pin_num / RK3308_SCHMITT_PINS_PER_REG) * 4); |
|---|
| 1802 | + *bit = pin_num % RK3308_SCHMITT_PINS_PER_REG; |
|---|
| 1803 | + |
|---|
| 1804 | + return 0; |
|---|
| 1805 | +} |
|---|
| 1806 | + |
|---|
| 1586 | 1807 | #define RK1808_PULL_PMU_OFFSET 0x10 |
|---|
| 1587 | 1808 | #define RK1808_PULL_GRF_OFFSET 0x80 |
|---|
| 1588 | 1809 | #define RK1808_PULL_PINS_PER_REG 8 |
|---|
| 1589 | 1810 | #define RK1808_PULL_BITS_PER_PIN 2 |
|---|
| 1590 | 1811 | #define RK1808_PULL_BANK_STRIDE 16 |
|---|
| 1591 | 1812 | |
|---|
| 1592 | | -static void rk1808_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1593 | | - int pin_num, struct regmap **regmap, |
|---|
| 1594 | | - int *reg, u8 *bit) |
|---|
| 1813 | +static int rk1808_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1814 | + int pin_num, struct regmap **regmap, |
|---|
| 1815 | + int *reg, u8 *bit) |
|---|
| 1595 | 1816 | { |
|---|
| 1596 | 1817 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1597 | 1818 | |
|---|
| .. | .. |
|---|
| 1607 | 1828 | *reg += ((pin_num / RK1808_PULL_PINS_PER_REG) * 4); |
|---|
| 1608 | 1829 | *bit = (pin_num % RK1808_PULL_PINS_PER_REG); |
|---|
| 1609 | 1830 | *bit *= RK1808_PULL_BITS_PER_PIN; |
|---|
| 1831 | + |
|---|
| 1832 | + return 0; |
|---|
| 1610 | 1833 | } |
|---|
| 1611 | 1834 | |
|---|
| 1612 | 1835 | #define RK1808_DRV_PMU_OFFSET 0x20 |
|---|
| .. | .. |
|---|
| 1615 | 1838 | #define RK1808_DRV_PINS_PER_REG 8 |
|---|
| 1616 | 1839 | #define RK1808_DRV_BANK_STRIDE 16 |
|---|
| 1617 | 1840 | |
|---|
| 1618 | | -static void rk1808_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1619 | | - int pin_num, |
|---|
| 1620 | | - struct regmap **regmap, |
|---|
| 1621 | | - int *reg, u8 *bit) |
|---|
| 1841 | +static int rk1808_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1842 | + int pin_num, |
|---|
| 1843 | + struct regmap **regmap, |
|---|
| 1844 | + int *reg, u8 *bit) |
|---|
| 1622 | 1845 | { |
|---|
| 1623 | 1846 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1624 | 1847 | |
|---|
| .. | .. |
|---|
| 1634 | 1857 | *reg += ((pin_num / RK1808_DRV_PINS_PER_REG) * 4); |
|---|
| 1635 | 1858 | *bit = pin_num % RK1808_DRV_PINS_PER_REG; |
|---|
| 1636 | 1859 | *bit *= RK1808_DRV_BITS_PER_PIN; |
|---|
| 1860 | + |
|---|
| 1861 | + return 0; |
|---|
| 1637 | 1862 | } |
|---|
| 1638 | 1863 | |
|---|
| 1639 | 1864 | #define RK1808_SR_PMU_OFFSET 0x0030 |
|---|
| .. | .. |
|---|
| 1692 | 1917 | #define RK2928_PULL_PINS_PER_REG 16 |
|---|
| 1693 | 1918 | #define RK2928_PULL_BANK_STRIDE 8 |
|---|
| 1694 | 1919 | |
|---|
| 1695 | | -static void rk2928_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1696 | | - int pin_num, struct regmap **regmap, |
|---|
| 1697 | | - int *reg, u8 *bit) |
|---|
| 1920 | +static int rk2928_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1921 | + int pin_num, struct regmap **regmap, |
|---|
| 1922 | + int *reg, u8 *bit) |
|---|
| 1698 | 1923 | { |
|---|
| 1699 | 1924 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1700 | 1925 | |
|---|
| .. | .. |
|---|
| 1704 | 1929 | *reg += (pin_num / RK2928_PULL_PINS_PER_REG) * 4; |
|---|
| 1705 | 1930 | |
|---|
| 1706 | 1931 | *bit = pin_num % RK2928_PULL_PINS_PER_REG; |
|---|
| 1932 | + |
|---|
| 1933 | + return 0; |
|---|
| 1707 | 1934 | }; |
|---|
| 1708 | 1935 | |
|---|
| 1709 | 1936 | #define RK3128_PULL_OFFSET 0x118 |
|---|
| 1710 | 1937 | |
|---|
| 1711 | | -static void rk3128_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1712 | | - int pin_num, struct regmap **regmap, |
|---|
| 1713 | | - int *reg, u8 *bit) |
|---|
| 1938 | +static int rk3128_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1939 | + int pin_num, struct regmap **regmap, |
|---|
| 1940 | + int *reg, u8 *bit) |
|---|
| 1714 | 1941 | { |
|---|
| 1715 | 1942 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1716 | 1943 | |
|---|
| .. | .. |
|---|
| 1720 | 1947 | *reg += ((pin_num / RK2928_PULL_PINS_PER_REG) * 4); |
|---|
| 1721 | 1948 | |
|---|
| 1722 | 1949 | *bit = pin_num % RK2928_PULL_PINS_PER_REG; |
|---|
| 1950 | + |
|---|
| 1951 | + return 0; |
|---|
| 1723 | 1952 | } |
|---|
| 1724 | 1953 | |
|---|
| 1725 | 1954 | #define RK3188_PULL_OFFSET 0x164 |
|---|
| .. | .. |
|---|
| 1728 | 1957 | #define RK3188_PULL_BANK_STRIDE 16 |
|---|
| 1729 | 1958 | #define RK3188_PULL_PMU_OFFSET 0x64 |
|---|
| 1730 | 1959 | |
|---|
| 1731 | | -static void rk3188_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1732 | | - int pin_num, struct regmap **regmap, |
|---|
| 1733 | | - int *reg, u8 *bit) |
|---|
| 1960 | +static int rk3188_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1961 | + int pin_num, struct regmap **regmap, |
|---|
| 1962 | + int *reg, u8 *bit) |
|---|
| 1734 | 1963 | { |
|---|
| 1735 | 1964 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1736 | 1965 | |
|---|
| .. | .. |
|---|
| 1760 | 1989 | *bit = 7 - (pin_num % RK3188_PULL_PINS_PER_REG); |
|---|
| 1761 | 1990 | *bit *= RK3188_PULL_BITS_PER_PIN; |
|---|
| 1762 | 1991 | } |
|---|
| 1992 | + |
|---|
| 1993 | + return 0; |
|---|
| 1763 | 1994 | } |
|---|
| 1764 | 1995 | |
|---|
| 1765 | 1996 | #define RK3288_PULL_OFFSET 0x140 |
|---|
| 1766 | | -static void rk3288_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1767 | | - int pin_num, struct regmap **regmap, |
|---|
| 1768 | | - int *reg, u8 *bit) |
|---|
| 1997 | +static int rk3288_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1998 | + int pin_num, struct regmap **regmap, |
|---|
| 1999 | + int *reg, u8 *bit) |
|---|
| 1769 | 2000 | { |
|---|
| 1770 | 2001 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1771 | 2002 | |
|---|
| .. | .. |
|---|
| 1789 | 2020 | *bit = (pin_num % RK3188_PULL_PINS_PER_REG); |
|---|
| 1790 | 2021 | *bit *= RK3188_PULL_BITS_PER_PIN; |
|---|
| 1791 | 2022 | } |
|---|
| 2023 | + |
|---|
| 2024 | + return 0; |
|---|
| 1792 | 2025 | } |
|---|
| 1793 | 2026 | |
|---|
| 1794 | 2027 | #define RK3288_DRV_PMU_OFFSET 0x70 |
|---|
| .. | .. |
|---|
| 1797 | 2030 | #define RK3288_DRV_PINS_PER_REG 8 |
|---|
| 1798 | 2031 | #define RK3288_DRV_BANK_STRIDE 16 |
|---|
| 1799 | 2032 | |
|---|
| 1800 | | -static void rk3288_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1801 | | - int pin_num, struct regmap **regmap, |
|---|
| 1802 | | - int *reg, u8 *bit) |
|---|
| 2033 | +static int rk3288_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2034 | + int pin_num, struct regmap **regmap, |
|---|
| 2035 | + int *reg, u8 *bit) |
|---|
| 1803 | 2036 | { |
|---|
| 1804 | 2037 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1805 | 2038 | |
|---|
| .. | .. |
|---|
| 1823 | 2056 | *bit = (pin_num % RK3288_DRV_PINS_PER_REG); |
|---|
| 1824 | 2057 | *bit *= RK3288_DRV_BITS_PER_PIN; |
|---|
| 1825 | 2058 | } |
|---|
| 2059 | + |
|---|
| 2060 | + return 0; |
|---|
| 1826 | 2061 | } |
|---|
| 1827 | 2062 | |
|---|
| 1828 | 2063 | #define RK3228_PULL_OFFSET 0x100 |
|---|
| 1829 | 2064 | |
|---|
| 1830 | | -static void rk3228_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1831 | | - int pin_num, struct regmap **regmap, |
|---|
| 1832 | | - int *reg, u8 *bit) |
|---|
| 2065 | +static int rk3228_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2066 | + int pin_num, struct regmap **regmap, |
|---|
| 2067 | + int *reg, u8 *bit) |
|---|
| 1833 | 2068 | { |
|---|
| 1834 | 2069 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1835 | 2070 | |
|---|
| .. | .. |
|---|
| 1840 | 2075 | |
|---|
| 1841 | 2076 | *bit = (pin_num % RK3188_PULL_PINS_PER_REG); |
|---|
| 1842 | 2077 | *bit *= RK3188_PULL_BITS_PER_PIN; |
|---|
| 2078 | + |
|---|
| 2079 | + return 0; |
|---|
| 1843 | 2080 | } |
|---|
| 1844 | 2081 | |
|---|
| 1845 | 2082 | #define RK3228_DRV_GRF_OFFSET 0x200 |
|---|
| 1846 | 2083 | |
|---|
| 1847 | | -static void rk3228_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1848 | | - int pin_num, struct regmap **regmap, |
|---|
| 1849 | | - int *reg, u8 *bit) |
|---|
| 2084 | +static int rk3228_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2085 | + int pin_num, struct regmap **regmap, |
|---|
| 2086 | + int *reg, u8 *bit) |
|---|
| 1850 | 2087 | { |
|---|
| 1851 | 2088 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1852 | 2089 | |
|---|
| .. | .. |
|---|
| 1857 | 2094 | |
|---|
| 1858 | 2095 | *bit = (pin_num % RK3288_DRV_PINS_PER_REG); |
|---|
| 1859 | 2096 | *bit *= RK3288_DRV_BITS_PER_PIN; |
|---|
| 2097 | + |
|---|
| 2098 | + return 0; |
|---|
| 1860 | 2099 | } |
|---|
| 1861 | 2100 | |
|---|
| 1862 | 2101 | #define RK3308_PULL_OFFSET 0xa0 |
|---|
| 1863 | 2102 | |
|---|
| 1864 | | -static void rk3308_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1865 | | - int pin_num, struct regmap **regmap, |
|---|
| 1866 | | - int *reg, u8 *bit) |
|---|
| 2103 | +static int rk3308_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2104 | + int pin_num, struct regmap **regmap, |
|---|
| 2105 | + int *reg, u8 *bit) |
|---|
| 1867 | 2106 | { |
|---|
| 1868 | 2107 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1869 | 2108 | |
|---|
| .. | .. |
|---|
| 1874 | 2113 | |
|---|
| 1875 | 2114 | *bit = (pin_num % RK3188_PULL_PINS_PER_REG); |
|---|
| 1876 | 2115 | *bit *= RK3188_PULL_BITS_PER_PIN; |
|---|
| 2116 | + |
|---|
| 2117 | + return 0; |
|---|
| 1877 | 2118 | } |
|---|
| 1878 | 2119 | |
|---|
| 1879 | 2120 | #define RK3308_DRV_GRF_OFFSET 0x100 |
|---|
| 1880 | 2121 | |
|---|
| 1881 | | -static void rk3308_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1882 | | - int pin_num, struct regmap **regmap, |
|---|
| 1883 | | - int *reg, u8 *bit) |
|---|
| 2122 | +static int rk3308_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2123 | + int pin_num, struct regmap **regmap, |
|---|
| 2124 | + int *reg, u8 *bit) |
|---|
| 1884 | 2125 | { |
|---|
| 1885 | 2126 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1886 | 2127 | |
|---|
| .. | .. |
|---|
| 1891 | 2132 | |
|---|
| 1892 | 2133 | *bit = (pin_num % RK3288_DRV_PINS_PER_REG); |
|---|
| 1893 | 2134 | *bit *= RK3288_DRV_BITS_PER_PIN; |
|---|
| 2135 | + |
|---|
| 2136 | + return 0; |
|---|
| 2137 | +} |
|---|
| 2138 | + |
|---|
| 2139 | +#define RK3308_SLEW_RATE_GRF_OFFSET 0x150 |
|---|
| 2140 | +#define RK3308_SLEW_RATE_BANK_STRIDE 16 |
|---|
| 2141 | +#define RK3308_SLEW_RATE_PINS_PER_GRF_REG 8 |
|---|
| 2142 | + |
|---|
| 2143 | +static int rk3308_calc_slew_rate_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2144 | + int pin_num, |
|---|
| 2145 | + struct regmap **regmap, |
|---|
| 2146 | + int *reg, u8 *bit) |
|---|
| 2147 | +{ |
|---|
| 2148 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2149 | + int pins_per_reg; |
|---|
| 2150 | + |
|---|
| 2151 | + *regmap = info->regmap_base; |
|---|
| 2152 | + *reg = RK3308_SLEW_RATE_GRF_OFFSET; |
|---|
| 2153 | + *reg += (bank->bank_num) * RK3308_SLEW_RATE_BANK_STRIDE; |
|---|
| 2154 | + pins_per_reg = RK3308_SLEW_RATE_PINS_PER_GRF_REG; |
|---|
| 2155 | + |
|---|
| 2156 | + *reg += ((pin_num / pins_per_reg) * 4); |
|---|
| 2157 | + *bit = pin_num % pins_per_reg; |
|---|
| 2158 | + |
|---|
| 2159 | + return 0; |
|---|
| 1894 | 2160 | } |
|---|
| 1895 | 2161 | |
|---|
| 1896 | 2162 | #define RK3368_PULL_GRF_OFFSET 0x100 |
|---|
| 1897 | 2163 | #define RK3368_PULL_PMU_OFFSET 0x10 |
|---|
| 1898 | 2164 | |
|---|
| 1899 | | -static void rk3368_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1900 | | - int pin_num, struct regmap **regmap, |
|---|
| 1901 | | - int *reg, u8 *bit) |
|---|
| 2165 | +static int rk3368_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2166 | + int pin_num, struct regmap **regmap, |
|---|
| 2167 | + int *reg, u8 *bit) |
|---|
| 1902 | 2168 | { |
|---|
| 1903 | 2169 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1904 | 2170 | |
|---|
| .. | .. |
|---|
| 1922 | 2188 | *bit = (pin_num % RK3188_PULL_PINS_PER_REG); |
|---|
| 1923 | 2189 | *bit *= RK3188_PULL_BITS_PER_PIN; |
|---|
| 1924 | 2190 | } |
|---|
| 2191 | + |
|---|
| 2192 | + return 0; |
|---|
| 1925 | 2193 | } |
|---|
| 1926 | 2194 | |
|---|
| 1927 | 2195 | #define RK3368_DRV_PMU_OFFSET 0x20 |
|---|
| 1928 | 2196 | #define RK3368_DRV_GRF_OFFSET 0x200 |
|---|
| 1929 | 2197 | |
|---|
| 1930 | | -static void rk3368_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1931 | | - int pin_num, struct regmap **regmap, |
|---|
| 1932 | | - int *reg, u8 *bit) |
|---|
| 2198 | +static int rk3368_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2199 | + int pin_num, struct regmap **regmap, |
|---|
| 2200 | + int *reg, u8 *bit) |
|---|
| 1933 | 2201 | { |
|---|
| 1934 | 2202 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1935 | 2203 | |
|---|
| .. | .. |
|---|
| 1953 | 2221 | *bit = (pin_num % RK3288_DRV_PINS_PER_REG); |
|---|
| 1954 | 2222 | *bit *= RK3288_DRV_BITS_PER_PIN; |
|---|
| 1955 | 2223 | } |
|---|
| 2224 | + |
|---|
| 2225 | + return 0; |
|---|
| 1956 | 2226 | } |
|---|
| 1957 | 2227 | |
|---|
| 1958 | 2228 | #define RK3399_PULL_GRF_OFFSET 0xe040 |
|---|
| 1959 | 2229 | #define RK3399_PULL_PMU_OFFSET 0x40 |
|---|
| 1960 | 2230 | #define RK3399_DRV_3BITS_PER_PIN 3 |
|---|
| 1961 | 2231 | |
|---|
| 1962 | | -static void rk3399_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1963 | | - int pin_num, struct regmap **regmap, |
|---|
| 1964 | | - int *reg, u8 *bit) |
|---|
| 2232 | +static int rk3399_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2233 | + int pin_num, struct regmap **regmap, |
|---|
| 2234 | + int *reg, u8 *bit) |
|---|
| 1965 | 2235 | { |
|---|
| 1966 | 2236 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1967 | 2237 | |
|---|
| .. | .. |
|---|
| 1987 | 2257 | *bit = (pin_num % RK3188_PULL_PINS_PER_REG); |
|---|
| 1988 | 2258 | *bit *= RK3188_PULL_BITS_PER_PIN; |
|---|
| 1989 | 2259 | } |
|---|
| 2260 | + |
|---|
| 2261 | + return 0; |
|---|
| 1990 | 2262 | } |
|---|
| 1991 | 2263 | |
|---|
| 1992 | | -static void rk3399_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 1993 | | - int pin_num, struct regmap **regmap, |
|---|
| 1994 | | - int *reg, u8 *bit) |
|---|
| 2264 | +static int rk3399_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2265 | + int pin_num, struct regmap **regmap, |
|---|
| 2266 | + int *reg, u8 *bit) |
|---|
| 1995 | 2267 | { |
|---|
| 1996 | 2268 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 1997 | 2269 | int drv_num = (pin_num / 8); |
|---|
| .. | .. |
|---|
| 2008 | 2280 | *bit = (pin_num % 8) * 3; |
|---|
| 2009 | 2281 | else |
|---|
| 2010 | 2282 | *bit = (pin_num % 8) * 2; |
|---|
| 2283 | + |
|---|
| 2284 | + return 0; |
|---|
| 2285 | +} |
|---|
| 2286 | + |
|---|
| 2287 | +#define RK3528_DRV_BITS_PER_PIN 8 |
|---|
| 2288 | +#define RK3528_DRV_PINS_PER_REG 2 |
|---|
| 2289 | +#define RK3528_DRV_GPIO0_OFFSET 0x100 |
|---|
| 2290 | +#define RK3528_DRV_GPIO1_OFFSET 0x20120 |
|---|
| 2291 | +#define RK3528_DRV_GPIO2_OFFSET 0x30160 |
|---|
| 2292 | +#define RK3528_DRV_GPIO3_OFFSET 0x20190 |
|---|
| 2293 | +#define RK3528_DRV_GPIO4_OFFSET 0x101C0 |
|---|
| 2294 | + |
|---|
| 2295 | +static int rk3528_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2296 | + int pin_num, struct regmap **regmap, |
|---|
| 2297 | + int *reg, u8 *bit) |
|---|
| 2298 | +{ |
|---|
| 2299 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2300 | + |
|---|
| 2301 | + *regmap = info->regmap_base; |
|---|
| 2302 | + switch (bank->bank_num) { |
|---|
| 2303 | + case 0: |
|---|
| 2304 | + *reg = RK3528_DRV_GPIO0_OFFSET; |
|---|
| 2305 | + break; |
|---|
| 2306 | + |
|---|
| 2307 | + case 1: |
|---|
| 2308 | + *reg = RK3528_DRV_GPIO1_OFFSET; |
|---|
| 2309 | + break; |
|---|
| 2310 | + |
|---|
| 2311 | + case 2: |
|---|
| 2312 | + *reg = RK3528_DRV_GPIO2_OFFSET; |
|---|
| 2313 | + break; |
|---|
| 2314 | + |
|---|
| 2315 | + case 3: |
|---|
| 2316 | + *reg = RK3528_DRV_GPIO3_OFFSET; |
|---|
| 2317 | + break; |
|---|
| 2318 | + |
|---|
| 2319 | + case 4: |
|---|
| 2320 | + *reg = RK3528_DRV_GPIO4_OFFSET; |
|---|
| 2321 | + break; |
|---|
| 2322 | + |
|---|
| 2323 | + default: |
|---|
| 2324 | + dev_err(info->dev, "unsupported bank_num %d\n", bank->bank_num); |
|---|
| 2325 | + break; |
|---|
| 2326 | + } |
|---|
| 2327 | + |
|---|
| 2328 | + *reg += ((pin_num / RK3528_DRV_PINS_PER_REG) * 4); |
|---|
| 2329 | + *bit = pin_num % RK3528_DRV_PINS_PER_REG; |
|---|
| 2330 | + *bit *= RK3528_DRV_BITS_PER_PIN; |
|---|
| 2331 | + |
|---|
| 2332 | + return 0; |
|---|
| 2333 | +} |
|---|
| 2334 | + |
|---|
| 2335 | +#define RK3528_PULL_BITS_PER_PIN 2 |
|---|
| 2336 | +#define RK3528_PULL_PINS_PER_REG 8 |
|---|
| 2337 | +#define RK3528_PULL_GPIO0_OFFSET 0x200 |
|---|
| 2338 | +#define RK3528_PULL_GPIO1_OFFSET 0x20210 |
|---|
| 2339 | +#define RK3528_PULL_GPIO2_OFFSET 0x30220 |
|---|
| 2340 | +#define RK3528_PULL_GPIO3_OFFSET 0x20230 |
|---|
| 2341 | +#define RK3528_PULL_GPIO4_OFFSET 0x10240 |
|---|
| 2342 | + |
|---|
| 2343 | +static int rk3528_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2344 | + int pin_num, struct regmap **regmap, |
|---|
| 2345 | + int *reg, u8 *bit) |
|---|
| 2346 | +{ |
|---|
| 2347 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2348 | + |
|---|
| 2349 | + *regmap = info->regmap_base; |
|---|
| 2350 | + switch (bank->bank_num) { |
|---|
| 2351 | + case 0: |
|---|
| 2352 | + *reg = RK3528_PULL_GPIO0_OFFSET; |
|---|
| 2353 | + break; |
|---|
| 2354 | + |
|---|
| 2355 | + case 1: |
|---|
| 2356 | + *reg = RK3528_PULL_GPIO1_OFFSET; |
|---|
| 2357 | + break; |
|---|
| 2358 | + |
|---|
| 2359 | + case 2: |
|---|
| 2360 | + *reg = RK3528_PULL_GPIO2_OFFSET; |
|---|
| 2361 | + break; |
|---|
| 2362 | + |
|---|
| 2363 | + case 3: |
|---|
| 2364 | + *reg = RK3528_PULL_GPIO3_OFFSET; |
|---|
| 2365 | + break; |
|---|
| 2366 | + |
|---|
| 2367 | + case 4: |
|---|
| 2368 | + *reg = RK3528_PULL_GPIO4_OFFSET; |
|---|
| 2369 | + break; |
|---|
| 2370 | + |
|---|
| 2371 | + default: |
|---|
| 2372 | + dev_err(info->dev, "unsupported bank_num %d\n", bank->bank_num); |
|---|
| 2373 | + break; |
|---|
| 2374 | + } |
|---|
| 2375 | + |
|---|
| 2376 | + *reg += ((pin_num / RK3528_PULL_PINS_PER_REG) * 4); |
|---|
| 2377 | + *bit = pin_num % RK3528_PULL_PINS_PER_REG; |
|---|
| 2378 | + *bit *= RK3528_PULL_BITS_PER_PIN; |
|---|
| 2379 | + |
|---|
| 2380 | + return 0; |
|---|
| 2381 | +} |
|---|
| 2382 | + |
|---|
| 2383 | +#define RK3528_SMT_BITS_PER_PIN 1 |
|---|
| 2384 | +#define RK3528_SMT_PINS_PER_REG 8 |
|---|
| 2385 | +#define RK3528_SMT_GPIO0_OFFSET 0x400 |
|---|
| 2386 | +#define RK3528_SMT_GPIO1_OFFSET 0x20410 |
|---|
| 2387 | +#define RK3528_SMT_GPIO2_OFFSET 0x30420 |
|---|
| 2388 | +#define RK3528_SMT_GPIO3_OFFSET 0x20430 |
|---|
| 2389 | +#define RK3528_SMT_GPIO4_OFFSET 0x10440 |
|---|
| 2390 | + |
|---|
| 2391 | +static int rk3528_calc_schmitt_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2392 | + int pin_num, |
|---|
| 2393 | + struct regmap **regmap, |
|---|
| 2394 | + int *reg, u8 *bit) |
|---|
| 2395 | +{ |
|---|
| 2396 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2397 | + |
|---|
| 2398 | + *regmap = info->regmap_base; |
|---|
| 2399 | + switch (bank->bank_num) { |
|---|
| 2400 | + case 0: |
|---|
| 2401 | + *reg = RK3528_SMT_GPIO0_OFFSET; |
|---|
| 2402 | + break; |
|---|
| 2403 | + |
|---|
| 2404 | + case 1: |
|---|
| 2405 | + *reg = RK3528_SMT_GPIO1_OFFSET; |
|---|
| 2406 | + break; |
|---|
| 2407 | + |
|---|
| 2408 | + case 2: |
|---|
| 2409 | + *reg = RK3528_SMT_GPIO2_OFFSET; |
|---|
| 2410 | + break; |
|---|
| 2411 | + |
|---|
| 2412 | + case 3: |
|---|
| 2413 | + *reg = RK3528_SMT_GPIO3_OFFSET; |
|---|
| 2414 | + break; |
|---|
| 2415 | + |
|---|
| 2416 | + case 4: |
|---|
| 2417 | + *reg = RK3528_SMT_GPIO4_OFFSET; |
|---|
| 2418 | + break; |
|---|
| 2419 | + |
|---|
| 2420 | + default: |
|---|
| 2421 | + dev_err(info->dev, "unsupported bank_num %d\n", bank->bank_num); |
|---|
| 2422 | + break; |
|---|
| 2423 | + } |
|---|
| 2424 | + |
|---|
| 2425 | + *reg += ((pin_num / RK3528_SMT_PINS_PER_REG) * 4); |
|---|
| 2426 | + *bit = pin_num % RK3528_SMT_PINS_PER_REG; |
|---|
| 2427 | + *bit *= RK3528_SMT_BITS_PER_PIN; |
|---|
| 2428 | + return 0; |
|---|
| 2429 | +} |
|---|
| 2430 | + |
|---|
| 2431 | +#define RK3562_DRV_BITS_PER_PIN 8 |
|---|
| 2432 | +#define RK3562_DRV_PINS_PER_REG 2 |
|---|
| 2433 | +#define RK3562_DRV_GPIO0_OFFSET 0x20070 |
|---|
| 2434 | +#define RK3562_DRV_GPIO1_OFFSET 0x200 |
|---|
| 2435 | +#define RK3562_DRV_GPIO2_OFFSET 0x240 |
|---|
| 2436 | +#define RK3562_DRV_GPIO3_OFFSET 0x10280 |
|---|
| 2437 | +#define RK3562_DRV_GPIO4_OFFSET 0x102C0 |
|---|
| 2438 | + |
|---|
| 2439 | +static int rk3562_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2440 | + int pin_num, struct regmap **regmap, |
|---|
| 2441 | + int *reg, u8 *bit) |
|---|
| 2442 | +{ |
|---|
| 2443 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2444 | + |
|---|
| 2445 | + *regmap = info->regmap_base; |
|---|
| 2446 | + switch (bank->bank_num) { |
|---|
| 2447 | + case 0: |
|---|
| 2448 | + *reg = RK3562_DRV_GPIO0_OFFSET; |
|---|
| 2449 | + break; |
|---|
| 2450 | + |
|---|
| 2451 | + case 1: |
|---|
| 2452 | + *reg = RK3562_DRV_GPIO1_OFFSET; |
|---|
| 2453 | + break; |
|---|
| 2454 | + |
|---|
| 2455 | + case 2: |
|---|
| 2456 | + *reg = RK3562_DRV_GPIO2_OFFSET; |
|---|
| 2457 | + break; |
|---|
| 2458 | + |
|---|
| 2459 | + case 3: |
|---|
| 2460 | + *reg = RK3562_DRV_GPIO3_OFFSET; |
|---|
| 2461 | + break; |
|---|
| 2462 | + |
|---|
| 2463 | + case 4: |
|---|
| 2464 | + *reg = RK3562_DRV_GPIO4_OFFSET; |
|---|
| 2465 | + break; |
|---|
| 2466 | + |
|---|
| 2467 | + default: |
|---|
| 2468 | + dev_err(info->dev, "unsupported bank_num %d\n", bank->bank_num); |
|---|
| 2469 | + break; |
|---|
| 2470 | + } |
|---|
| 2471 | + |
|---|
| 2472 | + *reg += ((pin_num / RK3562_DRV_PINS_PER_REG) * 4); |
|---|
| 2473 | + *bit = pin_num % RK3562_DRV_PINS_PER_REG; |
|---|
| 2474 | + *bit *= RK3562_DRV_BITS_PER_PIN; |
|---|
| 2475 | + |
|---|
| 2476 | + return 0; |
|---|
| 2477 | +} |
|---|
| 2478 | + |
|---|
| 2479 | +#define RK3562_PULL_BITS_PER_PIN 2 |
|---|
| 2480 | +#define RK3562_PULL_PINS_PER_REG 8 |
|---|
| 2481 | +#define RK3562_PULL_GPIO0_OFFSET 0x20020 |
|---|
| 2482 | +#define RK3562_PULL_GPIO1_OFFSET 0x80 |
|---|
| 2483 | +#define RK3562_PULL_GPIO2_OFFSET 0x90 |
|---|
| 2484 | +#define RK3562_PULL_GPIO3_OFFSET 0x100A0 |
|---|
| 2485 | +#define RK3562_PULL_GPIO4_OFFSET 0x100B0 |
|---|
| 2486 | + |
|---|
| 2487 | +static int rk3562_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2488 | + int pin_num, struct regmap **regmap, |
|---|
| 2489 | + int *reg, u8 *bit) |
|---|
| 2490 | +{ |
|---|
| 2491 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2492 | + |
|---|
| 2493 | + *regmap = info->regmap_base; |
|---|
| 2494 | + switch (bank->bank_num) { |
|---|
| 2495 | + case 0: |
|---|
| 2496 | + *reg = RK3562_PULL_GPIO0_OFFSET; |
|---|
| 2497 | + break; |
|---|
| 2498 | + |
|---|
| 2499 | + case 1: |
|---|
| 2500 | + *reg = RK3562_PULL_GPIO1_OFFSET; |
|---|
| 2501 | + break; |
|---|
| 2502 | + |
|---|
| 2503 | + case 2: |
|---|
| 2504 | + *reg = RK3562_PULL_GPIO2_OFFSET; |
|---|
| 2505 | + break; |
|---|
| 2506 | + |
|---|
| 2507 | + case 3: |
|---|
| 2508 | + *reg = RK3562_PULL_GPIO3_OFFSET; |
|---|
| 2509 | + break; |
|---|
| 2510 | + |
|---|
| 2511 | + case 4: |
|---|
| 2512 | + *reg = RK3562_PULL_GPIO4_OFFSET; |
|---|
| 2513 | + break; |
|---|
| 2514 | + |
|---|
| 2515 | + default: |
|---|
| 2516 | + dev_err(info->dev, "unsupported bank_num %d\n", bank->bank_num); |
|---|
| 2517 | + break; |
|---|
| 2518 | + } |
|---|
| 2519 | + |
|---|
| 2520 | + *reg += ((pin_num / RK3562_PULL_PINS_PER_REG) * 4); |
|---|
| 2521 | + *bit = pin_num % RK3562_PULL_PINS_PER_REG; |
|---|
| 2522 | + *bit *= RK3562_PULL_BITS_PER_PIN; |
|---|
| 2523 | + |
|---|
| 2524 | + return 0; |
|---|
| 2525 | +} |
|---|
| 2526 | + |
|---|
| 2527 | +#define RK3562_SMT_BITS_PER_PIN 2 |
|---|
| 2528 | +#define RK3562_SMT_PINS_PER_REG 8 |
|---|
| 2529 | +#define RK3562_SMT_GPIO0_OFFSET 0x20030 |
|---|
| 2530 | +#define RK3562_SMT_GPIO1_OFFSET 0xC0 |
|---|
| 2531 | +#define RK3562_SMT_GPIO2_OFFSET 0xD0 |
|---|
| 2532 | +#define RK3562_SMT_GPIO3_OFFSET 0x100E0 |
|---|
| 2533 | +#define RK3562_SMT_GPIO4_OFFSET 0x100F0 |
|---|
| 2534 | + |
|---|
| 2535 | +static int rk3562_calc_schmitt_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2536 | + int pin_num, |
|---|
| 2537 | + struct regmap **regmap, |
|---|
| 2538 | + int *reg, u8 *bit) |
|---|
| 2539 | +{ |
|---|
| 2540 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2541 | + |
|---|
| 2542 | + *regmap = info->regmap_base; |
|---|
| 2543 | + switch (bank->bank_num) { |
|---|
| 2544 | + case 0: |
|---|
| 2545 | + *reg = RK3562_SMT_GPIO0_OFFSET; |
|---|
| 2546 | + break; |
|---|
| 2547 | + |
|---|
| 2548 | + case 1: |
|---|
| 2549 | + *reg = RK3562_SMT_GPIO1_OFFSET; |
|---|
| 2550 | + break; |
|---|
| 2551 | + |
|---|
| 2552 | + case 2: |
|---|
| 2553 | + *reg = RK3562_SMT_GPIO2_OFFSET; |
|---|
| 2554 | + break; |
|---|
| 2555 | + |
|---|
| 2556 | + case 3: |
|---|
| 2557 | + *reg = RK3562_SMT_GPIO3_OFFSET; |
|---|
| 2558 | + break; |
|---|
| 2559 | + |
|---|
| 2560 | + case 4: |
|---|
| 2561 | + *reg = RK3562_SMT_GPIO4_OFFSET; |
|---|
| 2562 | + break; |
|---|
| 2563 | + |
|---|
| 2564 | + default: |
|---|
| 2565 | + dev_err(info->dev, "unsupported bank_num %d\n", bank->bank_num); |
|---|
| 2566 | + break; |
|---|
| 2567 | + } |
|---|
| 2568 | + |
|---|
| 2569 | + *reg += ((pin_num / RK3562_SMT_PINS_PER_REG) * 4); |
|---|
| 2570 | + *bit = pin_num % RK3562_SMT_PINS_PER_REG; |
|---|
| 2571 | + *bit *= RK3562_SMT_BITS_PER_PIN; |
|---|
| 2572 | + |
|---|
| 2573 | + return 0; |
|---|
| 2011 | 2574 | } |
|---|
| 2012 | 2575 | |
|---|
| 2013 | 2576 | #define RK3568_SR_PMU_OFFSET 0x60 |
|---|
| .. | .. |
|---|
| 2044 | 2607 | #define RK3568_PULL_PINS_PER_REG 8 |
|---|
| 2045 | 2608 | #define RK3568_PULL_BANK_STRIDE 0x10 |
|---|
| 2046 | 2609 | |
|---|
| 2047 | | -static void rk3568_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2048 | | - int pin_num, struct regmap **regmap, |
|---|
| 2049 | | - int *reg, u8 *bit) |
|---|
| 2610 | +static int rk3568_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2611 | + int pin_num, struct regmap **regmap, |
|---|
| 2612 | + int *reg, u8 *bit) |
|---|
| 2050 | 2613 | { |
|---|
| 2051 | 2614 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2052 | 2615 | |
|---|
| .. | .. |
|---|
| 2067 | 2630 | *bit = (pin_num % RK3568_PULL_PINS_PER_REG); |
|---|
| 2068 | 2631 | *bit *= RK3568_PULL_BITS_PER_PIN; |
|---|
| 2069 | 2632 | } |
|---|
| 2633 | + |
|---|
| 2634 | + return 0; |
|---|
| 2070 | 2635 | } |
|---|
| 2071 | 2636 | |
|---|
| 2072 | 2637 | #define RK3568_DRV_PMU_OFFSET 0x70 |
|---|
| .. | .. |
|---|
| 2075 | 2640 | #define RK3568_DRV_PINS_PER_REG 2 |
|---|
| 2076 | 2641 | #define RK3568_DRV_BANK_STRIDE 0x40 |
|---|
| 2077 | 2642 | |
|---|
| 2078 | | -static void rk3568_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2079 | | - int pin_num, struct regmap **regmap, |
|---|
| 2080 | | - int *reg, u8 *bit) |
|---|
| 2643 | +static int rk3568_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2644 | + int pin_num, struct regmap **regmap, |
|---|
| 2645 | + int *reg, u8 *bit) |
|---|
| 2081 | 2646 | { |
|---|
| 2082 | 2647 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2083 | 2648 | |
|---|
| .. | .. |
|---|
| 2104 | 2669 | ((bank->bank_num == 2 || bank->bank_num == 3 || bank->bank_num == 4) && |
|---|
| 2105 | 2670 | (pin_num == 7 || pin_num == 15 || pin_num == 23 || pin_num == 31))) |
|---|
| 2106 | 2671 | *bit -= RK3568_DRV_BITS_PER_PIN; |
|---|
| 2672 | + |
|---|
| 2673 | + return 0; |
|---|
| 2674 | +} |
|---|
| 2675 | + |
|---|
| 2676 | +#define RK3588_PMU1_IOC_REG (0x0000) |
|---|
| 2677 | +#define RK3588_PMU2_IOC_REG (0x4000) |
|---|
| 2678 | +#define RK3588_BUS_IOC_REG (0x8000) |
|---|
| 2679 | +#define RK3588_VCCIO1_4_IOC_REG (0x9000) |
|---|
| 2680 | +#define RK3588_VCCIO3_5_IOC_REG (0xA000) |
|---|
| 2681 | +#define RK3588_VCCIO2_IOC_REG (0xB000) |
|---|
| 2682 | +#define RK3588_VCCIO6_IOC_REG (0xC000) |
|---|
| 2683 | +#define RK3588_EMMC_IOC_REG (0xD000) |
|---|
| 2684 | + |
|---|
| 2685 | +static const u32 rk3588_ds_regs[][2] = { |
|---|
| 2686 | + {RK_GPIO0_A0, RK3588_PMU1_IOC_REG + 0x0010}, |
|---|
| 2687 | + {RK_GPIO0_A4, RK3588_PMU1_IOC_REG + 0x0014}, |
|---|
| 2688 | + {RK_GPIO0_B0, RK3588_PMU1_IOC_REG + 0x0018}, |
|---|
| 2689 | + {RK_GPIO0_B4, RK3588_PMU2_IOC_REG + 0x0014}, |
|---|
| 2690 | + {RK_GPIO0_C0, RK3588_PMU2_IOC_REG + 0x0018}, |
|---|
| 2691 | + {RK_GPIO0_C4, RK3588_PMU2_IOC_REG + 0x001C}, |
|---|
| 2692 | + {RK_GPIO0_D0, RK3588_PMU2_IOC_REG + 0x0020}, |
|---|
| 2693 | + {RK_GPIO0_D4, RK3588_PMU2_IOC_REG + 0x0024}, |
|---|
| 2694 | + {RK_GPIO1_A0, RK3588_VCCIO1_4_IOC_REG + 0x0020}, |
|---|
| 2695 | + {RK_GPIO1_A4, RK3588_VCCIO1_4_IOC_REG + 0x0024}, |
|---|
| 2696 | + {RK_GPIO1_B0, RK3588_VCCIO1_4_IOC_REG + 0x0028}, |
|---|
| 2697 | + {RK_GPIO1_B4, RK3588_VCCIO1_4_IOC_REG + 0x002C}, |
|---|
| 2698 | + {RK_GPIO1_C0, RK3588_VCCIO1_4_IOC_REG + 0x0030}, |
|---|
| 2699 | + {RK_GPIO1_C4, RK3588_VCCIO1_4_IOC_REG + 0x0034}, |
|---|
| 2700 | + {RK_GPIO1_D0, RK3588_VCCIO1_4_IOC_REG + 0x0038}, |
|---|
| 2701 | + {RK_GPIO1_D4, RK3588_VCCIO1_4_IOC_REG + 0x003C}, |
|---|
| 2702 | + {RK_GPIO2_A0, RK3588_EMMC_IOC_REG + 0x0040}, |
|---|
| 2703 | + {RK_GPIO2_A4, RK3588_VCCIO3_5_IOC_REG + 0x0044}, |
|---|
| 2704 | + {RK_GPIO2_B0, RK3588_VCCIO3_5_IOC_REG + 0x0048}, |
|---|
| 2705 | + {RK_GPIO2_B4, RK3588_VCCIO3_5_IOC_REG + 0x004C}, |
|---|
| 2706 | + {RK_GPIO2_C0, RK3588_VCCIO3_5_IOC_REG + 0x0050}, |
|---|
| 2707 | + {RK_GPIO2_C4, RK3588_VCCIO3_5_IOC_REG + 0x0054}, |
|---|
| 2708 | + {RK_GPIO2_D0, RK3588_EMMC_IOC_REG + 0x0058}, |
|---|
| 2709 | + {RK_GPIO2_D4, RK3588_EMMC_IOC_REG + 0x005C}, |
|---|
| 2710 | + {RK_GPIO3_A0, RK3588_VCCIO3_5_IOC_REG + 0x0060}, |
|---|
| 2711 | + {RK_GPIO3_A4, RK3588_VCCIO3_5_IOC_REG + 0x0064}, |
|---|
| 2712 | + {RK_GPIO3_B0, RK3588_VCCIO3_5_IOC_REG + 0x0068}, |
|---|
| 2713 | + {RK_GPIO3_B4, RK3588_VCCIO3_5_IOC_REG + 0x006C}, |
|---|
| 2714 | + {RK_GPIO3_C0, RK3588_VCCIO3_5_IOC_REG + 0x0070}, |
|---|
| 2715 | + {RK_GPIO3_C4, RK3588_VCCIO3_5_IOC_REG + 0x0074}, |
|---|
| 2716 | + {RK_GPIO3_D0, RK3588_VCCIO3_5_IOC_REG + 0x0078}, |
|---|
| 2717 | + {RK_GPIO3_D4, RK3588_VCCIO3_5_IOC_REG + 0x007C}, |
|---|
| 2718 | + {RK_GPIO4_A0, RK3588_VCCIO6_IOC_REG + 0x0080}, |
|---|
| 2719 | + {RK_GPIO4_A4, RK3588_VCCIO6_IOC_REG + 0x0084}, |
|---|
| 2720 | + {RK_GPIO4_B0, RK3588_VCCIO6_IOC_REG + 0x0088}, |
|---|
| 2721 | + {RK_GPIO4_B4, RK3588_VCCIO6_IOC_REG + 0x008C}, |
|---|
| 2722 | + {RK_GPIO4_C0, RK3588_VCCIO6_IOC_REG + 0x0090}, |
|---|
| 2723 | + {RK_GPIO4_C2, RK3588_VCCIO3_5_IOC_REG + 0x0090}, |
|---|
| 2724 | + {RK_GPIO4_C4, RK3588_VCCIO3_5_IOC_REG + 0x0094}, |
|---|
| 2725 | + {RK_GPIO4_D0, RK3588_VCCIO2_IOC_REG + 0x0098}, |
|---|
| 2726 | +}; |
|---|
| 2727 | + |
|---|
| 2728 | +static const u32 rk3588_p_regs[][2] = { |
|---|
| 2729 | + {RK_GPIO0_A0, RK3588_PMU1_IOC_REG + 0x0020}, |
|---|
| 2730 | + {RK_GPIO0_B0, RK3588_PMU1_IOC_REG + 0x0024}, |
|---|
| 2731 | + {RK_GPIO0_B5, RK3588_PMU2_IOC_REG + 0x0028}, |
|---|
| 2732 | + {RK_GPIO0_C0, RK3588_PMU2_IOC_REG + 0x002C}, |
|---|
| 2733 | + {RK_GPIO0_D0, RK3588_PMU2_IOC_REG + 0x0030}, |
|---|
| 2734 | + {RK_GPIO1_A0, RK3588_VCCIO1_4_IOC_REG + 0x0110}, |
|---|
| 2735 | + {RK_GPIO1_B0, RK3588_VCCIO1_4_IOC_REG + 0x0114}, |
|---|
| 2736 | + {RK_GPIO1_C0, RK3588_VCCIO1_4_IOC_REG + 0x0118}, |
|---|
| 2737 | + {RK_GPIO1_D0, RK3588_VCCIO1_4_IOC_REG + 0x011C}, |
|---|
| 2738 | + {RK_GPIO2_A0, RK3588_EMMC_IOC_REG + 0x0120}, |
|---|
| 2739 | + {RK_GPIO2_A4, RK3588_VCCIO3_5_IOC_REG + 0x0120}, |
|---|
| 2740 | + {RK_GPIO2_B0, RK3588_VCCIO3_5_IOC_REG + 0x0124}, |
|---|
| 2741 | + {RK_GPIO2_C0, RK3588_VCCIO3_5_IOC_REG + 0x0128}, |
|---|
| 2742 | + {RK_GPIO2_D0, RK3588_EMMC_IOC_REG + 0x012C}, |
|---|
| 2743 | + {RK_GPIO3_A0, RK3588_VCCIO3_5_IOC_REG + 0x0130}, |
|---|
| 2744 | + {RK_GPIO3_B0, RK3588_VCCIO3_5_IOC_REG + 0x0134}, |
|---|
| 2745 | + {RK_GPIO3_C0, RK3588_VCCIO3_5_IOC_REG + 0x0138}, |
|---|
| 2746 | + {RK_GPIO3_D0, RK3588_VCCIO3_5_IOC_REG + 0x013C}, |
|---|
| 2747 | + {RK_GPIO4_A0, RK3588_VCCIO6_IOC_REG + 0x0140}, |
|---|
| 2748 | + {RK_GPIO4_B0, RK3588_VCCIO6_IOC_REG + 0x0144}, |
|---|
| 2749 | + {RK_GPIO4_C0, RK3588_VCCIO6_IOC_REG + 0x0148}, |
|---|
| 2750 | + {RK_GPIO4_C2, RK3588_VCCIO3_5_IOC_REG + 0x0148}, |
|---|
| 2751 | + {RK_GPIO4_D0, RK3588_VCCIO2_IOC_REG + 0x014C}, |
|---|
| 2752 | +}; |
|---|
| 2753 | + |
|---|
| 2754 | +static const u32 rk3588_smt_regs[][2] = { |
|---|
| 2755 | + {RK_GPIO0_A0, RK3588_PMU1_IOC_REG + 0x0030}, |
|---|
| 2756 | + {RK_GPIO0_B0, RK3588_PMU1_IOC_REG + 0x0034}, |
|---|
| 2757 | + {RK_GPIO0_B5, RK3588_PMU2_IOC_REG + 0x0040}, |
|---|
| 2758 | + {RK_GPIO0_C0, RK3588_PMU2_IOC_REG + 0x0044}, |
|---|
| 2759 | + {RK_GPIO0_D0, RK3588_PMU2_IOC_REG + 0x0048}, |
|---|
| 2760 | + {RK_GPIO1_A0, RK3588_VCCIO1_4_IOC_REG + 0x0210}, |
|---|
| 2761 | + {RK_GPIO1_B0, RK3588_VCCIO1_4_IOC_REG + 0x0214}, |
|---|
| 2762 | + {RK_GPIO1_C0, RK3588_VCCIO1_4_IOC_REG + 0x0218}, |
|---|
| 2763 | + {RK_GPIO1_D0, RK3588_VCCIO1_4_IOC_REG + 0x021C}, |
|---|
| 2764 | + {RK_GPIO2_A0, RK3588_EMMC_IOC_REG + 0x0220}, |
|---|
| 2765 | + {RK_GPIO2_A4, RK3588_VCCIO3_5_IOC_REG + 0x0220}, |
|---|
| 2766 | + {RK_GPIO2_B0, RK3588_VCCIO3_5_IOC_REG + 0x0224}, |
|---|
| 2767 | + {RK_GPIO2_C0, RK3588_VCCIO3_5_IOC_REG + 0x0228}, |
|---|
| 2768 | + {RK_GPIO2_D0, RK3588_EMMC_IOC_REG + 0x022C}, |
|---|
| 2769 | + {RK_GPIO3_A0, RK3588_VCCIO3_5_IOC_REG + 0x0230}, |
|---|
| 2770 | + {RK_GPIO3_B0, RK3588_VCCIO3_5_IOC_REG + 0x0234}, |
|---|
| 2771 | + {RK_GPIO3_C0, RK3588_VCCIO3_5_IOC_REG + 0x0238}, |
|---|
| 2772 | + {RK_GPIO3_D0, RK3588_VCCIO3_5_IOC_REG + 0x023C}, |
|---|
| 2773 | + {RK_GPIO4_A0, RK3588_VCCIO6_IOC_REG + 0x0240}, |
|---|
| 2774 | + {RK_GPIO4_B0, RK3588_VCCIO6_IOC_REG + 0x0244}, |
|---|
| 2775 | + {RK_GPIO4_C0, RK3588_VCCIO6_IOC_REG + 0x0248}, |
|---|
| 2776 | + {RK_GPIO4_C2, RK3588_VCCIO3_5_IOC_REG + 0x0248}, |
|---|
| 2777 | + {RK_GPIO4_D0, RK3588_VCCIO2_IOC_REG + 0x024C}, |
|---|
| 2778 | +}; |
|---|
| 2779 | + |
|---|
| 2780 | +#define RK3588_PULL_BITS_PER_PIN 2 |
|---|
| 2781 | +#define RK3588_PULL_PINS_PER_REG 8 |
|---|
| 2782 | + |
|---|
| 2783 | +static int rk3588_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2784 | + int pin_num, struct regmap **regmap, |
|---|
| 2785 | + int *reg, u8 *bit) |
|---|
| 2786 | +{ |
|---|
| 2787 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2788 | + u8 bank_num = bank->bank_num; |
|---|
| 2789 | + u32 pin = bank_num * 32 + pin_num; |
|---|
| 2790 | + int i; |
|---|
| 2791 | + |
|---|
| 2792 | + for (i = ARRAY_SIZE(rk3588_p_regs) - 1; i >= 0; i--) { |
|---|
| 2793 | + if (pin >= rk3588_p_regs[i][0]) { |
|---|
| 2794 | + *reg = rk3588_p_regs[i][1]; |
|---|
| 2795 | + break; |
|---|
| 2796 | + } |
|---|
| 2797 | + BUG_ON(i == 0); |
|---|
| 2798 | + } |
|---|
| 2799 | + |
|---|
| 2800 | + *regmap = info->regmap_base; |
|---|
| 2801 | + *reg += ((pin - rk3588_p_regs[i][0]) / RK3588_PULL_PINS_PER_REG) * 4; |
|---|
| 2802 | + *bit = pin_num % RK3588_PULL_PINS_PER_REG; |
|---|
| 2803 | + *bit *= RK3588_PULL_BITS_PER_PIN; |
|---|
| 2804 | + |
|---|
| 2805 | + return 0; |
|---|
| 2806 | +} |
|---|
| 2807 | + |
|---|
| 2808 | +#define RK3588_DRV_BITS_PER_PIN 4 |
|---|
| 2809 | +#define RK3588_DRV_PINS_PER_REG 4 |
|---|
| 2810 | + |
|---|
| 2811 | +static int rk3588_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2812 | + int pin_num, struct regmap **regmap, |
|---|
| 2813 | + int *reg, u8 *bit) |
|---|
| 2814 | +{ |
|---|
| 2815 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2816 | + u8 bank_num = bank->bank_num; |
|---|
| 2817 | + u32 pin = bank_num * 32 + pin_num; |
|---|
| 2818 | + int i; |
|---|
| 2819 | + |
|---|
| 2820 | + for (i = ARRAY_SIZE(rk3588_ds_regs) - 1; i >= 0; i--) { |
|---|
| 2821 | + if (pin >= rk3588_ds_regs[i][0]) { |
|---|
| 2822 | + *reg = rk3588_ds_regs[i][1]; |
|---|
| 2823 | + break; |
|---|
| 2824 | + } |
|---|
| 2825 | + BUG_ON(i == 0); |
|---|
| 2826 | + } |
|---|
| 2827 | + |
|---|
| 2828 | + *regmap = info->regmap_base; |
|---|
| 2829 | + *reg += ((pin - rk3588_ds_regs[i][0]) / RK3588_DRV_PINS_PER_REG) * 4; |
|---|
| 2830 | + *bit = pin_num % RK3588_DRV_PINS_PER_REG; |
|---|
| 2831 | + *bit *= RK3588_DRV_BITS_PER_PIN; |
|---|
| 2832 | + |
|---|
| 2833 | + return 0; |
|---|
| 2834 | +} |
|---|
| 2835 | + |
|---|
| 2836 | +#define RK3588_SMT_BITS_PER_PIN 1 |
|---|
| 2837 | +#define RK3588_SMT_PINS_PER_REG 8 |
|---|
| 2838 | + |
|---|
| 2839 | +static int rk3588_calc_schmitt_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2840 | + int pin_num, |
|---|
| 2841 | + struct regmap **regmap, |
|---|
| 2842 | + int *reg, u8 *bit) |
|---|
| 2843 | +{ |
|---|
| 2844 | + struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2845 | + u8 bank_num = bank->bank_num; |
|---|
| 2846 | + u32 pin = bank_num * 32 + pin_num; |
|---|
| 2847 | + int i; |
|---|
| 2848 | + |
|---|
| 2849 | + for (i = ARRAY_SIZE(rk3588_smt_regs) - 1; i >= 0; i--) { |
|---|
| 2850 | + if (pin >= rk3588_smt_regs[i][0]) { |
|---|
| 2851 | + *reg = rk3588_smt_regs[i][1]; |
|---|
| 2852 | + break; |
|---|
| 2853 | + } |
|---|
| 2854 | + BUG_ON(i == 0); |
|---|
| 2855 | + } |
|---|
| 2856 | + |
|---|
| 2857 | + *regmap = info->regmap_base; |
|---|
| 2858 | + *reg += ((pin - rk3588_smt_regs[i][0]) / RK3588_SMT_PINS_PER_REG) * 4; |
|---|
| 2859 | + *bit = pin_num % RK3588_SMT_PINS_PER_REG; |
|---|
| 2860 | + *bit *= RK3588_SMT_BITS_PER_PIN; |
|---|
| 2861 | + |
|---|
| 2862 | + return 0; |
|---|
| 2107 | 2863 | } |
|---|
| 2108 | 2864 | |
|---|
| 2109 | 2865 | static int rockchip_perpin_drv_list[DRV_TYPE_MAX][8] = { |
|---|
| .. | .. |
|---|
| 2120 | 2876 | { |
|---|
| 2121 | 2877 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2122 | 2878 | struct rockchip_pin_ctrl *ctrl = info->ctrl; |
|---|
| 2879 | + struct device *dev = info->dev; |
|---|
| 2123 | 2880 | struct regmap *regmap; |
|---|
| 2124 | 2881 | int reg, ret; |
|---|
| 2125 | 2882 | u32 data, temp, rmask_bits; |
|---|
| 2126 | 2883 | u8 bit; |
|---|
| 2127 | 2884 | int drv_type = bank->drv[pin_num / 8].drv_type; |
|---|
| 2128 | 2885 | |
|---|
| 2129 | | - ctrl->drv_calc_reg(bank, pin_num, ®map, ®, &bit); |
|---|
| 2886 | + ret = ctrl->drv_calc_reg(bank, pin_num, ®map, ®, &bit); |
|---|
| 2887 | + if (ret) |
|---|
| 2888 | + return ret; |
|---|
| 2130 | 2889 | |
|---|
| 2131 | 2890 | switch (drv_type) { |
|---|
| 2132 | 2891 | case DRV_TYPE_IO_1V8_3V0_AUTO: |
|---|
| .. | .. |
|---|
| 2165 | 2924 | bit -= 16; |
|---|
| 2166 | 2925 | break; |
|---|
| 2167 | 2926 | default: |
|---|
| 2168 | | - dev_err(info->dev, "unsupported bit: %d for pinctrl drive type: %d\n", |
|---|
| 2927 | + dev_err(dev, "unsupported bit: %d for pinctrl drive type: %d\n", |
|---|
| 2169 | 2928 | bit, drv_type); |
|---|
| 2170 | 2929 | return -EINVAL; |
|---|
| 2171 | 2930 | } |
|---|
| .. | .. |
|---|
| 2178 | 2937 | rmask_bits = RK3288_DRV_BITS_PER_PIN; |
|---|
| 2179 | 2938 | break; |
|---|
| 2180 | 2939 | default: |
|---|
| 2181 | | - dev_err(info->dev, "unsupported pinctrl drive type: %d\n", |
|---|
| 2182 | | - drv_type); |
|---|
| 2940 | + dev_err(dev, "unsupported pinctrl drive type: %d\n", drv_type); |
|---|
| 2183 | 2941 | return -EINVAL; |
|---|
| 2184 | 2942 | } |
|---|
| 2185 | 2943 | |
|---|
| .. | .. |
|---|
| 2212 | 2970 | { |
|---|
| 2213 | 2971 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2214 | 2972 | struct rockchip_pin_ctrl *ctrl = info->ctrl; |
|---|
| 2973 | + struct device *dev = info->dev; |
|---|
| 2215 | 2974 | struct regmap *regmap; |
|---|
| 2216 | 2975 | int reg, ret, i, err; |
|---|
| 2217 | 2976 | u32 data, rmask, rmask_bits, temp; |
|---|
| 2218 | 2977 | u8 bit; |
|---|
| 2219 | 2978 | int drv_type = bank->drv[pin_num / 8].drv_type; |
|---|
| 2220 | 2979 | |
|---|
| 2221 | | - dev_dbg(info->dev, "setting drive of GPIO%d-%d to %d\n", |
|---|
| 2980 | + dev_dbg(dev, "setting drive of GPIO%d-%d to %d\n", |
|---|
| 2222 | 2981 | bank->bank_num, pin_num, strength); |
|---|
| 2223 | 2982 | |
|---|
| 2224 | | - ctrl->drv_calc_reg(bank, pin_num, ®map, ®, &bit); |
|---|
| 2225 | | - if (ctrl->type == RV1126) { |
|---|
| 2983 | + ret = ctrl->drv_calc_reg(bank, pin_num, ®map, ®, &bit); |
|---|
| 2984 | + if (ret) |
|---|
| 2985 | + return ret; |
|---|
| 2986 | + |
|---|
| 2987 | + if (ctrl->type == RV1126 || ctrl->type == RK3588) { |
|---|
| 2226 | 2988 | rmask_bits = RV1126_DRV_BITS_PER_PIN; |
|---|
| 2227 | 2989 | ret = strength; |
|---|
| 2228 | 2990 | goto config; |
|---|
| 2229 | | - } else if (ctrl->type == RK3568) { |
|---|
| 2991 | + } else if (ctrl->type == RV1106 || |
|---|
| 2992 | + ctrl->type == RK3528 || |
|---|
| 2993 | + ctrl->type == RK3562 || |
|---|
| 2994 | + ctrl->type == RK3568) { |
|---|
| 2230 | 2995 | rmask_bits = RK3568_DRV_BITS_PER_PIN; |
|---|
| 2231 | 2996 | ret = (1 << (strength + 1)) - 1; |
|---|
| 2232 | 2997 | goto config; |
|---|
| .. | .. |
|---|
| 2244 | 3009 | } |
|---|
| 2245 | 3010 | |
|---|
| 2246 | 3011 | if (ret < 0) { |
|---|
| 2247 | | - dev_err(info->dev, "unsupported driver strength %d\n", |
|---|
| 2248 | | - strength); |
|---|
| 3012 | + dev_err(dev, "unsupported driver strength %d\n", strength); |
|---|
| 2249 | 3013 | return ret; |
|---|
| 2250 | 3014 | } |
|---|
| 2251 | 3015 | |
|---|
| .. | .. |
|---|
| 2284 | 3048 | bit -= 16; |
|---|
| 2285 | 3049 | break; |
|---|
| 2286 | 3050 | default: |
|---|
| 2287 | | - dev_err(info->dev, "unsupported bit: %d for pinctrl drive type: %d\n", |
|---|
| 3051 | + dev_err(dev, "unsupported bit: %d for pinctrl drive type: %d\n", |
|---|
| 2288 | 3052 | bit, drv_type); |
|---|
| 2289 | 3053 | return -EINVAL; |
|---|
| 2290 | 3054 | } |
|---|
| .. | .. |
|---|
| 2296 | 3060 | rmask_bits = RK3288_DRV_BITS_PER_PIN; |
|---|
| 2297 | 3061 | break; |
|---|
| 2298 | 3062 | default: |
|---|
| 2299 | | - dev_err(info->dev, "unsupported pinctrl drive type: %d\n", |
|---|
| 2300 | | - drv_type); |
|---|
| 3063 | + dev_err(dev, "unsupported pinctrl drive type: %d\n", drv_type); |
|---|
| 2301 | 3064 | return -EINVAL; |
|---|
| 2302 | 3065 | } |
|---|
| 2303 | 3066 | |
|---|
| .. | .. |
|---|
| 2366 | 3129 | { |
|---|
| 2367 | 3130 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2368 | 3131 | struct rockchip_pin_ctrl *ctrl = info->ctrl; |
|---|
| 3132 | + struct device *dev = info->dev; |
|---|
| 2369 | 3133 | struct regmap *regmap; |
|---|
| 2370 | 3134 | int reg, ret, pull_type; |
|---|
| 2371 | 3135 | u8 bit; |
|---|
| .. | .. |
|---|
| 2375 | 3139 | if (ctrl->type == RK3066B) |
|---|
| 2376 | 3140 | return PIN_CONFIG_BIAS_DISABLE; |
|---|
| 2377 | 3141 | |
|---|
| 2378 | | - ctrl->pull_calc_reg(bank, pin_num, ®map, ®, &bit); |
|---|
| 3142 | + ret = ctrl->pull_calc_reg(bank, pin_num, ®map, ®, &bit); |
|---|
| 3143 | + if (ret) |
|---|
| 3144 | + return ret; |
|---|
| 2379 | 3145 | |
|---|
| 2380 | 3146 | ret = regmap_read(regmap, reg, &data); |
|---|
| 2381 | 3147 | if (ret) |
|---|
| .. | .. |
|---|
| 2388 | 3154 | ? PIN_CONFIG_BIAS_PULL_PIN_DEFAULT |
|---|
| 2389 | 3155 | : PIN_CONFIG_BIAS_DISABLE; |
|---|
| 2390 | 3156 | case PX30: |
|---|
| 3157 | + case RV1106: |
|---|
| 2391 | 3158 | case RV1108: |
|---|
| 2392 | 3159 | case RV1126: |
|---|
| 2393 | 3160 | case RK1808: |
|---|
| .. | .. |
|---|
| 2396 | 3163 | case RK3308: |
|---|
| 2397 | 3164 | case RK3368: |
|---|
| 2398 | 3165 | case RK3399: |
|---|
| 3166 | + case RK3528: |
|---|
| 3167 | + case RK3562: |
|---|
| 2399 | 3168 | case RK3568: |
|---|
| 3169 | + case RK3588: |
|---|
| 2400 | 3170 | pull_type = bank->pull_type[pin_num / 8]; |
|---|
| 2401 | 3171 | data >>= bit; |
|---|
| 2402 | 3172 | data &= (1 << RK3188_PULL_BITS_PER_PIN) - 1; |
|---|
| 2403 | 3173 | |
|---|
| 2404 | 3174 | return rockchip_pull_list[pull_type][data]; |
|---|
| 2405 | 3175 | default: |
|---|
| 2406 | | - dev_err(info->dev, "unsupported pinctrl type\n"); |
|---|
| 3176 | + dev_err(dev, "unsupported pinctrl type\n"); |
|---|
| 2407 | 3177 | return -EINVAL; |
|---|
| 2408 | 3178 | }; |
|---|
| 2409 | 3179 | } |
|---|
| .. | .. |
|---|
| 2413 | 3183 | { |
|---|
| 2414 | 3184 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2415 | 3185 | struct rockchip_pin_ctrl *ctrl = info->ctrl; |
|---|
| 3186 | + struct device *dev = info->dev; |
|---|
| 2416 | 3187 | struct regmap *regmap; |
|---|
| 2417 | 3188 | int reg, ret, i, pull_type; |
|---|
| 2418 | 3189 | u8 bit; |
|---|
| 2419 | 3190 | u32 data, rmask; |
|---|
| 2420 | 3191 | |
|---|
| 2421 | | - dev_dbg(info->dev, "setting pull of GPIO%d-%d to %d\n", |
|---|
| 2422 | | - bank->bank_num, pin_num, pull); |
|---|
| 3192 | + dev_dbg(dev, "setting pull of GPIO%d-%d to %d\n", bank->bank_num, pin_num, pull); |
|---|
| 2423 | 3193 | |
|---|
| 2424 | 3194 | /* rk3066b does support any pulls */ |
|---|
| 2425 | 3195 | if (ctrl->type == RK3066B) |
|---|
| 2426 | 3196 | return pull ? -EINVAL : 0; |
|---|
| 2427 | 3197 | |
|---|
| 2428 | | - ctrl->pull_calc_reg(bank, pin_num, ®map, ®, &bit); |
|---|
| 3198 | + ret = ctrl->pull_calc_reg(bank, pin_num, ®map, ®, &bit); |
|---|
| 3199 | + if (ret) |
|---|
| 3200 | + return ret; |
|---|
| 2429 | 3201 | |
|---|
| 2430 | 3202 | switch (ctrl->type) { |
|---|
| 2431 | 3203 | case RK2928: |
|---|
| .. | .. |
|---|
| 2436 | 3208 | ret = regmap_write(regmap, reg, data); |
|---|
| 2437 | 3209 | break; |
|---|
| 2438 | 3210 | case PX30: |
|---|
| 3211 | + case RV1106: |
|---|
| 2439 | 3212 | case RV1108: |
|---|
| 2440 | 3213 | case RV1126: |
|---|
| 2441 | 3214 | case RK1808: |
|---|
| .. | .. |
|---|
| 2444 | 3217 | case RK3308: |
|---|
| 2445 | 3218 | case RK3368: |
|---|
| 2446 | 3219 | case RK3399: |
|---|
| 3220 | + case RK3528: |
|---|
| 3221 | + case RK3562: |
|---|
| 2447 | 3222 | case RK3568: |
|---|
| 3223 | + case RK3588: |
|---|
| 2448 | 3224 | pull_type = bank->pull_type[pin_num / 8]; |
|---|
| 2449 | 3225 | ret = -EINVAL; |
|---|
| 2450 | 3226 | for (i = 0; i < ARRAY_SIZE(rockchip_pull_list[pull_type]); |
|---|
| .. | .. |
|---|
| 2455 | 3231 | } |
|---|
| 2456 | 3232 | } |
|---|
| 2457 | 3233 | /* |
|---|
| 2458 | | - * In the TRM, pull-up being 1 for everything except the GPIO0_D0-D6, |
|---|
| 3234 | + * In the TRM, pull-up being 1 for everything except the GPIO0_D3-D6, |
|---|
| 2459 | 3235 | * where that pull up value becomes 3. |
|---|
| 2460 | 3236 | */ |
|---|
| 2461 | 3237 | if (ctrl->type == RK3568 && bank->bank_num == 0 && pin_num >= 27 && pin_num <= 30) { |
|---|
| .. | .. |
|---|
| 2464 | 3240 | } |
|---|
| 2465 | 3241 | |
|---|
| 2466 | 3242 | if (ret < 0) { |
|---|
| 2467 | | - dev_err(info->dev, "unsupported pull setting %d\n", |
|---|
| 2468 | | - pull); |
|---|
| 3243 | + dev_err(dev, "unsupported pull setting %d\n", pull); |
|---|
| 2469 | 3244 | return ret; |
|---|
| 2470 | 3245 | } |
|---|
| 2471 | 3246 | |
|---|
| .. | .. |
|---|
| 2477 | 3252 | ret = regmap_update_bits(regmap, reg, rmask, data); |
|---|
| 2478 | 3253 | break; |
|---|
| 2479 | 3254 | default: |
|---|
| 2480 | | - dev_err(info->dev, "unsupported pinctrl type\n"); |
|---|
| 3255 | + dev_err(dev, "unsupported pinctrl type\n"); |
|---|
| 2481 | 3256 | return -EINVAL; |
|---|
| 2482 | 3257 | } |
|---|
| 2483 | 3258 | |
|---|
| 2484 | 3259 | return ret; |
|---|
| 2485 | | -} |
|---|
| 2486 | | - |
|---|
| 2487 | | -#define RK3308_SCHMITT_PINS_PER_REG 8 |
|---|
| 2488 | | -#define RK3308_SCHMITT_BANK_STRIDE 16 |
|---|
| 2489 | | -#define RK3308_SCHMITT_GRF_OFFSET 0x1a0 |
|---|
| 2490 | | - |
|---|
| 2491 | | -static int rk3308_calc_schmitt_reg_and_bit(struct rockchip_pin_bank *bank, |
|---|
| 2492 | | - int pin_num, |
|---|
| 2493 | | - struct regmap **regmap, |
|---|
| 2494 | | - int *reg, u8 *bit) |
|---|
| 2495 | | -{ |
|---|
| 2496 | | - struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2497 | | - |
|---|
| 2498 | | - *regmap = info->regmap_base; |
|---|
| 2499 | | - *reg = RK3308_SCHMITT_GRF_OFFSET; |
|---|
| 2500 | | - |
|---|
| 2501 | | - *reg += bank->bank_num * RK3308_SCHMITT_BANK_STRIDE; |
|---|
| 2502 | | - *reg += ((pin_num / RK3308_SCHMITT_PINS_PER_REG) * 4); |
|---|
| 2503 | | - *bit = pin_num % RK3308_SCHMITT_PINS_PER_REG; |
|---|
| 2504 | | - |
|---|
| 2505 | | - return 0; |
|---|
| 2506 | 3260 | } |
|---|
| 2507 | 3261 | |
|---|
| 2508 | 3262 | #define RK3328_SCHMITT_BITS_PER_PIN 1 |
|---|
| .. | .. |
|---|
| 2575 | 3329 | |
|---|
| 2576 | 3330 | data >>= bit; |
|---|
| 2577 | 3331 | switch (ctrl->type) { |
|---|
| 3332 | + case RK3562: |
|---|
| 2578 | 3333 | case RK3568: |
|---|
| 2579 | 3334 | return data & ((1 << RK3568_SCHMITT_BITS_PER_PIN) - 1); |
|---|
| 2580 | 3335 | default: |
|---|
| .. | .. |
|---|
| 2589 | 3344 | { |
|---|
| 2590 | 3345 | struct rockchip_pinctrl *info = bank->drvdata; |
|---|
| 2591 | 3346 | struct rockchip_pin_ctrl *ctrl = info->ctrl; |
|---|
| 3347 | + struct device *dev = info->dev; |
|---|
| 2592 | 3348 | struct regmap *regmap; |
|---|
| 2593 | 3349 | int reg, ret; |
|---|
| 2594 | 3350 | u8 bit; |
|---|
| 2595 | 3351 | u32 data, rmask; |
|---|
| 2596 | 3352 | |
|---|
| 2597 | | - dev_dbg(info->dev, "setting input schmitt of GPIO%d-%d to %d\n", |
|---|
| 3353 | + dev_dbg(dev, "setting input schmitt of GPIO%d-%d to %d\n", |
|---|
| 2598 | 3354 | bank->bank_num, pin_num, enable); |
|---|
| 2599 | 3355 | |
|---|
| 2600 | 3356 | ret = ctrl->schmitt_calc_reg(bank, pin_num, ®map, ®, &bit); |
|---|
| .. | .. |
|---|
| 2603 | 3359 | |
|---|
| 2604 | 3360 | /* enable the write to the equivalent lower bits */ |
|---|
| 2605 | 3361 | switch (ctrl->type) { |
|---|
| 3362 | + case RK3562: |
|---|
| 2606 | 3363 | case RK3568: |
|---|
| 2607 | 3364 | data = ((1 << RK3568_SCHMITT_BITS_PER_PIN) - 1) << (bit + 16); |
|---|
| 2608 | 3365 | rmask = data | (data >> 16); |
|---|
| .. | .. |
|---|
| 2737 | 3494 | struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
|---|
| 2738 | 3495 | const unsigned int *pins = info->groups[group].pins; |
|---|
| 2739 | 3496 | const struct rockchip_pin_config *data = info->groups[group].data; |
|---|
| 3497 | + struct device *dev = info->dev; |
|---|
| 2740 | 3498 | struct rockchip_pin_bank *bank; |
|---|
| 2741 | 3499 | int cnt, ret = 0; |
|---|
| 2742 | 3500 | |
|---|
| 2743 | | - dev_dbg(info->dev, "enable function %s group %s\n", |
|---|
| 3501 | + dev_dbg(dev, "enable function %s group %s\n", |
|---|
| 2744 | 3502 | info->functions[selector].name, info->groups[group].name); |
|---|
| 2745 | 3503 | |
|---|
| 2746 | 3504 | /* |
|---|
| .. | .. |
|---|
| 2788 | 3546 | case RK3066B: |
|---|
| 2789 | 3547 | return pull ? false : true; |
|---|
| 2790 | 3548 | case PX30: |
|---|
| 3549 | + case RV1106: |
|---|
| 2791 | 3550 | case RV1108: |
|---|
| 2792 | 3551 | case RV1126: |
|---|
| 2793 | 3552 | case RK1808: |
|---|
| .. | .. |
|---|
| 2796 | 3555 | case RK3308: |
|---|
| 2797 | 3556 | case RK3368: |
|---|
| 2798 | 3557 | case RK3399: |
|---|
| 3558 | + case RK3528: |
|---|
| 3559 | + case RK3562: |
|---|
| 2799 | 3560 | case RK3568: |
|---|
| 3561 | + case RK3588: |
|---|
| 2800 | 3562 | return (pull != PIN_CONFIG_BIAS_PULL_PIN_DEFAULT); |
|---|
| 2801 | 3563 | } |
|---|
| 2802 | 3564 | |
|---|
| 2803 | 3565 | return false; |
|---|
| 3566 | +} |
|---|
| 3567 | + |
|---|
| 3568 | +static int rockchip_pinconf_defer_pin(struct rockchip_pin_bank *bank, |
|---|
| 3569 | + unsigned int pin, u32 param, u32 arg) |
|---|
| 3570 | +{ |
|---|
| 3571 | + struct rockchip_pin_deferred *cfg; |
|---|
| 3572 | + |
|---|
| 3573 | + cfg = kzalloc(sizeof(*cfg), GFP_KERNEL); |
|---|
| 3574 | + if (!cfg) |
|---|
| 3575 | + return -ENOMEM; |
|---|
| 3576 | + |
|---|
| 3577 | + cfg->pin = pin; |
|---|
| 3578 | + cfg->param = param; |
|---|
| 3579 | + cfg->arg = arg; |
|---|
| 3580 | + |
|---|
| 3581 | + list_add_tail(&cfg->head, &bank->deferred_pins); |
|---|
| 3582 | + |
|---|
| 3583 | + return 0; |
|---|
| 2804 | 3584 | } |
|---|
| 2805 | 3585 | |
|---|
| 2806 | 3586 | /* set the pin config settings for a specified pin */ |
|---|
| .. | .. |
|---|
| 2818 | 3598 | for (i = 0; i < num_configs; i++) { |
|---|
| 2819 | 3599 | param = pinconf_to_config_param(configs[i]); |
|---|
| 2820 | 3600 | arg = pinconf_to_config_argument(configs[i]); |
|---|
| 3601 | + |
|---|
| 3602 | + if (param == PIN_CONFIG_OUTPUT || param == PIN_CONFIG_INPUT_ENABLE) { |
|---|
| 3603 | + /* |
|---|
| 3604 | + * Check for gpio driver not being probed yet. |
|---|
| 3605 | + * The lock makes sure that either gpio-probe has completed |
|---|
| 3606 | + * or the gpio driver hasn't probed yet. |
|---|
| 3607 | + */ |
|---|
| 3608 | + mutex_lock(&bank->deferred_lock); |
|---|
| 3609 | + if (!gpio || !gpio->direction_output) { |
|---|
| 3610 | + rc = rockchip_pinconf_defer_pin(bank, pin - bank->pin_base, param, |
|---|
| 3611 | + arg); |
|---|
| 3612 | + mutex_unlock(&bank->deferred_lock); |
|---|
| 3613 | + if (rc) |
|---|
| 3614 | + return rc; |
|---|
| 3615 | + |
|---|
| 3616 | + break; |
|---|
| 3617 | + } |
|---|
| 3618 | + mutex_unlock(&bank->deferred_lock); |
|---|
| 3619 | + } |
|---|
| 2821 | 3620 | |
|---|
| 2822 | 3621 | switch (param) { |
|---|
| 2823 | 3622 | case PIN_CONFIG_BIAS_DISABLE: |
|---|
| .. | .. |
|---|
| 2844 | 3643 | case PIN_CONFIG_OUTPUT: |
|---|
| 2845 | 3644 | rc = rockchip_set_mux(bank, pin - bank->pin_base, |
|---|
| 2846 | 3645 | RK_FUNC_GPIO); |
|---|
| 2847 | | - if (rc != RK_FUNC_GPIO) { |
|---|
| 2848 | | - dev_err(info->dev, "pin-%d fail to mux to gpio, %d\n", pin, rc); |
|---|
| 3646 | + if (rc != RK_FUNC_GPIO) |
|---|
| 2849 | 3647 | return -EINVAL; |
|---|
| 2850 | | - } |
|---|
| 2851 | 3648 | |
|---|
| 2852 | 3649 | rc = gpio->direction_output(gpio, pin - bank->pin_base, |
|---|
| 2853 | 3650 | arg); |
|---|
| .. | .. |
|---|
| 2932 | 3729 | break; |
|---|
| 2933 | 3730 | case PIN_CONFIG_OUTPUT: |
|---|
| 2934 | 3731 | rc = rockchip_get_mux(bank, pin - bank->pin_base); |
|---|
| 2935 | | - if (rc != 0) |
|---|
| 3732 | + if (rc != RK_FUNC_GPIO) |
|---|
| 2936 | 3733 | return -EINVAL; |
|---|
| 2937 | 3734 | |
|---|
| 2938 | | - /* 0 for output, 1 for input */ |
|---|
| 2939 | | - rc = gpio->get_direction(gpio, pin - bank->pin_base); |
|---|
| 2940 | | - if (rc) |
|---|
| 2941 | | - return -EINVAL; |
|---|
| 3735 | + if (!gpio || !gpio->get) { |
|---|
| 3736 | + arg = 0; |
|---|
| 3737 | + break; |
|---|
| 3738 | + } |
|---|
| 2942 | 3739 | |
|---|
| 2943 | 3740 | rc = gpio->get(gpio, pin - bank->pin_base); |
|---|
| 2944 | 3741 | if (rc < 0) |
|---|
| .. | .. |
|---|
| 2998 | 3795 | {}, |
|---|
| 2999 | 3796 | }; |
|---|
| 3000 | 3797 | |
|---|
| 3001 | | -static bool is_function_node(const struct device_node *np) |
|---|
| 3002 | | -{ |
|---|
| 3003 | | - if (of_match_node(rockchip_bank_match, np)) |
|---|
| 3004 | | - return false; |
|---|
| 3005 | | - |
|---|
| 3006 | | - if (!strncmp(np->name, "pcfg", 4)) |
|---|
| 3007 | | - return false; |
|---|
| 3008 | | - |
|---|
| 3009 | | - return true; |
|---|
| 3010 | | -} |
|---|
| 3011 | | - |
|---|
| 3012 | 3798 | static void rockchip_pinctrl_child_count(struct rockchip_pinctrl *info, |
|---|
| 3013 | 3799 | struct device_node *np) |
|---|
| 3014 | 3800 | { |
|---|
| 3015 | 3801 | struct device_node *child; |
|---|
| 3016 | 3802 | |
|---|
| 3017 | 3803 | for_each_child_of_node(np, child) { |
|---|
| 3018 | | - if (!is_function_node(child)) |
|---|
| 3804 | + if (of_match_node(rockchip_bank_match, child)) |
|---|
| 3019 | 3805 | continue; |
|---|
| 3020 | 3806 | |
|---|
| 3021 | 3807 | info->nfunctions++; |
|---|
| .. | .. |
|---|
| 3028 | 3814 | struct rockchip_pinctrl *info, |
|---|
| 3029 | 3815 | u32 index) |
|---|
| 3030 | 3816 | { |
|---|
| 3817 | + struct device *dev = info->dev; |
|---|
| 3031 | 3818 | struct rockchip_pin_bank *bank; |
|---|
| 3032 | 3819 | int size; |
|---|
| 3033 | 3820 | const __be32 *list; |
|---|
| .. | .. |
|---|
| 3035 | 3822 | int i, j; |
|---|
| 3036 | 3823 | int ret; |
|---|
| 3037 | 3824 | |
|---|
| 3038 | | - dev_dbg(info->dev, "group(%d): %pOFn\n", index, np); |
|---|
| 3825 | + dev_dbg(dev, "group(%d): %pOFn\n", index, np); |
|---|
| 3039 | 3826 | |
|---|
| 3040 | 3827 | /* Initialise group */ |
|---|
| 3041 | 3828 | grp->name = np->name; |
|---|
| .. | .. |
|---|
| 3047 | 3834 | list = of_get_property(np, "rockchip,pins", &size); |
|---|
| 3048 | 3835 | /* we do not check return since it's safe node passed down */ |
|---|
| 3049 | 3836 | size /= sizeof(*list); |
|---|
| 3050 | | - if (!size || size % 4) { |
|---|
| 3051 | | - dev_err(info->dev, "wrong pins number or pins and configs should be by 4\n"); |
|---|
| 3052 | | - return -EINVAL; |
|---|
| 3053 | | - } |
|---|
| 3837 | + if (!size || size % 4) |
|---|
| 3838 | + return dev_err_probe(dev, -EINVAL, "wrong pins number or pins and configs should be by 4\n"); |
|---|
| 3054 | 3839 | |
|---|
| 3055 | 3840 | grp->npins = size / 4; |
|---|
| 3056 | 3841 | |
|---|
| 3057 | | - grp->pins = devm_kcalloc(info->dev, grp->npins, sizeof(unsigned int), |
|---|
| 3058 | | - GFP_KERNEL); |
|---|
| 3059 | | - grp->data = devm_kcalloc(info->dev, |
|---|
| 3060 | | - grp->npins, |
|---|
| 3061 | | - sizeof(struct rockchip_pin_config), |
|---|
| 3062 | | - GFP_KERNEL); |
|---|
| 3842 | + grp->pins = devm_kcalloc(dev, grp->npins, sizeof(*grp->pins), GFP_KERNEL); |
|---|
| 3843 | + grp->data = devm_kcalloc(dev, grp->npins, sizeof(*grp->data), GFP_KERNEL); |
|---|
| 3063 | 3844 | if (!grp->pins || !grp->data) |
|---|
| 3064 | 3845 | return -ENOMEM; |
|---|
| 3065 | 3846 | |
|---|
| .. | .. |
|---|
| 3093 | 3874 | struct rockchip_pinctrl *info, |
|---|
| 3094 | 3875 | u32 index) |
|---|
| 3095 | 3876 | { |
|---|
| 3877 | + struct device *dev = info->dev; |
|---|
| 3096 | 3878 | struct device_node *child; |
|---|
| 3097 | 3879 | struct rockchip_pmx_func *func; |
|---|
| 3098 | 3880 | struct rockchip_pin_group *grp; |
|---|
| .. | .. |
|---|
| 3100 | 3882 | static u32 grp_index; |
|---|
| 3101 | 3883 | u32 i = 0; |
|---|
| 3102 | 3884 | |
|---|
| 3103 | | - dev_dbg(info->dev, "parse function(%d): %pOFn\n", index, np); |
|---|
| 3885 | + dev_dbg(dev, "parse function(%d): %pOFn\n", index, np); |
|---|
| 3104 | 3886 | |
|---|
| 3105 | 3887 | func = &info->functions[index]; |
|---|
| 3106 | 3888 | |
|---|
| .. | .. |
|---|
| 3110 | 3892 | if (func->ngroups <= 0) |
|---|
| 3111 | 3893 | return 0; |
|---|
| 3112 | 3894 | |
|---|
| 3113 | | - func->groups = devm_kcalloc(info->dev, |
|---|
| 3114 | | - func->ngroups, sizeof(char *), GFP_KERNEL); |
|---|
| 3895 | + func->groups = devm_kcalloc(dev, func->ngroups, sizeof(*func->groups), GFP_KERNEL); |
|---|
| 3115 | 3896 | if (!func->groups) |
|---|
| 3116 | 3897 | return -ENOMEM; |
|---|
| 3117 | 3898 | |
|---|
| .. | .. |
|---|
| 3139 | 3920 | |
|---|
| 3140 | 3921 | rockchip_pinctrl_child_count(info, np); |
|---|
| 3141 | 3922 | |
|---|
| 3142 | | - dev_dbg(&pdev->dev, "nfunctions = %d\n", info->nfunctions); |
|---|
| 3143 | | - dev_dbg(&pdev->dev, "ngroups = %d\n", info->ngroups); |
|---|
| 3923 | + dev_dbg(dev, "nfunctions = %d\n", info->nfunctions); |
|---|
| 3924 | + dev_dbg(dev, "ngroups = %d\n", info->ngroups); |
|---|
| 3144 | 3925 | |
|---|
| 3145 | | - info->functions = devm_kcalloc(dev, |
|---|
| 3146 | | - info->nfunctions, |
|---|
| 3147 | | - sizeof(struct rockchip_pmx_func), |
|---|
| 3148 | | - GFP_KERNEL); |
|---|
| 3926 | + info->functions = devm_kcalloc(dev, info->nfunctions, sizeof(*info->functions), GFP_KERNEL); |
|---|
| 3149 | 3927 | if (!info->functions) |
|---|
| 3150 | 3928 | return -ENOMEM; |
|---|
| 3151 | 3929 | |
|---|
| 3152 | | - info->groups = devm_kcalloc(dev, |
|---|
| 3153 | | - info->ngroups, |
|---|
| 3154 | | - sizeof(struct rockchip_pin_group), |
|---|
| 3155 | | - GFP_KERNEL); |
|---|
| 3930 | + info->groups = devm_kcalloc(dev, info->ngroups, sizeof(*info->groups), GFP_KERNEL); |
|---|
| 3156 | 3931 | if (!info->groups) |
|---|
| 3157 | 3932 | return -ENOMEM; |
|---|
| 3158 | 3933 | |
|---|
| 3159 | 3934 | i = 0; |
|---|
| 3160 | 3935 | |
|---|
| 3161 | 3936 | for_each_child_of_node(np, child) { |
|---|
| 3162 | | - if (!is_function_node(child)) |
|---|
| 3937 | + if (of_match_node(rockchip_bank_match, child)) |
|---|
| 3163 | 3938 | continue; |
|---|
| 3164 | 3939 | |
|---|
| 3165 | 3940 | ret = rockchip_pinctrl_parse_functions(child, info, i++); |
|---|
| 3166 | 3941 | if (ret) { |
|---|
| 3167 | | - dev_err(&pdev->dev, "failed to parse function\n"); |
|---|
| 3942 | + dev_err(dev, "failed to parse function\n"); |
|---|
| 3168 | 3943 | of_node_put(child); |
|---|
| 3169 | 3944 | return ret; |
|---|
| 3170 | 3945 | } |
|---|
| .. | .. |
|---|
| 3179 | 3954 | struct pinctrl_desc *ctrldesc = &info->pctl; |
|---|
| 3180 | 3955 | struct pinctrl_pin_desc *pindesc, *pdesc; |
|---|
| 3181 | 3956 | struct rockchip_pin_bank *pin_bank; |
|---|
| 3957 | + struct device *dev = &pdev->dev; |
|---|
| 3182 | 3958 | int pin, bank, ret; |
|---|
| 3183 | 3959 | int k; |
|---|
| 3184 | 3960 | |
|---|
| .. | .. |
|---|
| 3188 | 3964 | ctrldesc->pmxops = &rockchip_pmx_ops; |
|---|
| 3189 | 3965 | ctrldesc->confops = &rockchip_pinconf_ops; |
|---|
| 3190 | 3966 | |
|---|
| 3191 | | - pindesc = devm_kcalloc(&pdev->dev, |
|---|
| 3192 | | - info->ctrl->nr_pins, sizeof(*pindesc), |
|---|
| 3193 | | - GFP_KERNEL); |
|---|
| 3967 | + pindesc = devm_kcalloc(dev, info->ctrl->nr_pins, sizeof(*pindesc), GFP_KERNEL); |
|---|
| 3194 | 3968 | if (!pindesc) |
|---|
| 3195 | 3969 | return -ENOMEM; |
|---|
| 3196 | 3970 | |
|---|
| .. | .. |
|---|
| 3206 | 3980 | pin_bank->name, pin); |
|---|
| 3207 | 3981 | pdesc++; |
|---|
| 3208 | 3982 | } |
|---|
| 3983 | + |
|---|
| 3984 | + INIT_LIST_HEAD(&pin_bank->deferred_pins); |
|---|
| 3985 | + mutex_init(&pin_bank->deferred_lock); |
|---|
| 3209 | 3986 | } |
|---|
| 3210 | 3987 | |
|---|
| 3211 | 3988 | ret = rockchip_pinctrl_parse_dt(pdev, info); |
|---|
| 3212 | 3989 | if (ret) |
|---|
| 3213 | 3990 | return ret; |
|---|
| 3214 | 3991 | |
|---|
| 3215 | | - info->pctl_dev = devm_pinctrl_register(&pdev->dev, ctrldesc, info); |
|---|
| 3216 | | - if (IS_ERR(info->pctl_dev)) { |
|---|
| 3217 | | - dev_err(&pdev->dev, "could not register pinctrl driver\n"); |
|---|
| 3218 | | - return PTR_ERR(info->pctl_dev); |
|---|
| 3219 | | - } |
|---|
| 3992 | + info->pctl_dev = devm_pinctrl_register(dev, ctrldesc, info); |
|---|
| 3993 | + if (IS_ERR(info->pctl_dev)) |
|---|
| 3994 | + return dev_err_probe(dev, PTR_ERR(info->pctl_dev), "could not register pinctrl driver\n"); |
|---|
| 3220 | 3995 | |
|---|
| 3221 | 3996 | return 0; |
|---|
| 3222 | 3997 | } |
|---|
| 3223 | 3998 | |
|---|
| 3224 | 3999 | static const struct of_device_id rockchip_pinctrl_dt_match[]; |
|---|
| 3225 | | - |
|---|
| 3226 | | -/* Ctrl data specially handle */ |
|---|
| 3227 | | -static int rk3308b_ctrl_data_re_init(struct rockchip_pin_ctrl *ctrl) |
|---|
| 3228 | | -{ |
|---|
| 3229 | | - /* |
|---|
| 3230 | | - * Special for rk3308b, where we need to replace the recalced |
|---|
| 3231 | | - * and routed arrays. |
|---|
| 3232 | | - */ |
|---|
| 3233 | | - if (soc_is_rk3308b()) { |
|---|
| 3234 | | - ctrl->iomux_recalced = rk3308b_mux_recalced_data; |
|---|
| 3235 | | - ctrl->niomux_recalced = ARRAY_SIZE(rk3308b_mux_recalced_data); |
|---|
| 3236 | | - ctrl->iomux_routes = rk3308b_mux_route_data; |
|---|
| 3237 | | - ctrl->niomux_routes = ARRAY_SIZE(rk3308b_mux_route_data); |
|---|
| 3238 | | - |
|---|
| 3239 | | - } |
|---|
| 3240 | | - |
|---|
| 3241 | | - return 0; |
|---|
| 3242 | | -} |
|---|
| 3243 | | - |
|---|
| 4000 | +static struct rockchip_pin_bank rk3308bs_pin_banks[]; |
|---|
| 3244 | 4001 | static struct rockchip_pin_bank px30s_pin_banks[]; |
|---|
| 3245 | 4002 | |
|---|
| 3246 | 4003 | /* retrieve the soc specific data */ |
|---|
| .. | .. |
|---|
| 3248 | 4005 | struct rockchip_pinctrl *d, |
|---|
| 3249 | 4006 | struct platform_device *pdev) |
|---|
| 3250 | 4007 | { |
|---|
| 4008 | + struct device *dev = &pdev->dev; |
|---|
| 4009 | + struct device_node *node = dev->of_node; |
|---|
| 3251 | 4010 | const struct of_device_id *match; |
|---|
| 3252 | | - struct device_node *node = pdev->dev.of_node; |
|---|
| 3253 | 4011 | struct rockchip_pin_ctrl *ctrl; |
|---|
| 3254 | 4012 | struct rockchip_pin_bank *bank; |
|---|
| 3255 | 4013 | int grf_offs, pmu_offs, drv_grf_offs, drv_pmu_offs, i, j; |
|---|
| 3256 | 4014 | |
|---|
| 3257 | 4015 | match = of_match_node(rockchip_pinctrl_dt_match, node); |
|---|
| 3258 | 4016 | ctrl = (struct rockchip_pin_ctrl *)match->data; |
|---|
| 4017 | + if (IS_ENABLED(CONFIG_CPU_RK3308) && soc_is_rk3308bs()) |
|---|
| 4018 | + ctrl->pin_banks = rk3308bs_pin_banks; |
|---|
| 3259 | 4019 | if (IS_ENABLED(CONFIG_CPU_PX30) && soc_is_px30s()) |
|---|
| 3260 | 4020 | ctrl->pin_banks = px30s_pin_banks; |
|---|
| 3261 | | - |
|---|
| 3262 | | - /* Ctrl data re-initialize for some Socs */ |
|---|
| 3263 | | - if (ctrl->ctrl_data_re_init) { |
|---|
| 3264 | | - if (ctrl->ctrl_data_re_init(ctrl)) |
|---|
| 3265 | | - return NULL; |
|---|
| 3266 | | - } |
|---|
| 3267 | 4021 | |
|---|
| 3268 | 4022 | grf_offs = ctrl->grf_mux_offset; |
|---|
| 3269 | 4023 | pmu_offs = ctrl->pmu_mux_offset; |
|---|
| .. | .. |
|---|
| 3310 | 4064 | drv_pmu_offs : drv_grf_offs; |
|---|
| 3311 | 4065 | } |
|---|
| 3312 | 4066 | |
|---|
| 3313 | | - dev_dbg(d->dev, "bank %d, iomux %d has iom_offset 0x%x drv_offset 0x%x\n", |
|---|
| 4067 | + dev_dbg(dev, "bank %d, iomux %d has iom_offset 0x%x drv_offset 0x%x\n", |
|---|
| 3314 | 4068 | i, j, iom->offset, drv->offset); |
|---|
| 3315 | 4069 | |
|---|
| 3316 | 4070 | /* |
|---|
| .. | .. |
|---|
| 3417 | 4171 | |
|---|
| 3418 | 4172 | /* SoC data specially handle */ |
|---|
| 3419 | 4173 | |
|---|
| 3420 | | -/* rk3308b SoC data initialize */ |
|---|
| 3421 | | -#define RK3308B_GRF_SOC_CON13 0x608 |
|---|
| 3422 | | -#define RK3308B_GRF_SOC_CON15 0x610 |
|---|
| 4174 | +/* rk3308 SoC data initialize */ |
|---|
| 4175 | +#define RK3308_GRF_SOC_CON13 0x608 |
|---|
| 4176 | +#define RK3308_GRF_SOC_CON15 0x610 |
|---|
| 3423 | 4177 | |
|---|
| 3424 | | -/* RK3308B_GRF_SOC_CON13 */ |
|---|
| 3425 | | -#define RK3308B_GRF_I2C3_IOFUNC_SRC_CTRL (BIT(16 + 10) | BIT(10)) |
|---|
| 3426 | | -#define RK3308B_GRF_GPIO2A3_SEL_SRC_CTRL (BIT(16 + 7) | BIT(7)) |
|---|
| 3427 | | -#define RK3308B_GRF_GPIO2A2_SEL_SRC_CTRL (BIT(16 + 3) | BIT(3)) |
|---|
| 4178 | +/* RK3308_GRF_SOC_CON13 */ |
|---|
| 4179 | +#define RK3308_GRF_I2C3_IOFUNC_SRC_CTRL (BIT(16 + 10) | BIT(10)) |
|---|
| 4180 | +#define RK3308_GRF_GPIO2A3_SEL_SRC_CTRL (BIT(16 + 7) | BIT(7)) |
|---|
| 4181 | +#define RK3308_GRF_GPIO2A2_SEL_SRC_CTRL (BIT(16 + 3) | BIT(3)) |
|---|
| 3428 | 4182 | |
|---|
| 3429 | | -/* RK3308B_GRF_SOC_CON15 */ |
|---|
| 3430 | | -#define RK3308B_GRF_GPIO2C0_SEL_SRC_CTRL (BIT(16 + 11) | BIT(11)) |
|---|
| 3431 | | -#define RK3308B_GRF_GPIO3B3_SEL_SRC_CTRL (BIT(16 + 7) | BIT(7)) |
|---|
| 3432 | | -#define RK3308B_GRF_GPIO3B2_SEL_SRC_CTRL (BIT(16 + 3) | BIT(3)) |
|---|
| 4183 | +/* RK3308_GRF_SOC_CON15 */ |
|---|
| 4184 | +#define RK3308_GRF_GPIO2C0_SEL_SRC_CTRL (BIT(16 + 11) | BIT(11)) |
|---|
| 4185 | +#define RK3308_GRF_GPIO3B3_SEL_SRC_CTRL (BIT(16 + 7) | BIT(7)) |
|---|
| 4186 | +#define RK3308_GRF_GPIO3B2_SEL_SRC_CTRL (BIT(16 + 3) | BIT(3)) |
|---|
| 3433 | 4187 | |
|---|
| 3434 | | -static int rk3308b_soc_data_init(struct rockchip_pinctrl *info) |
|---|
| 4188 | +static int rk3308_soc_data_init(struct rockchip_pinctrl *info) |
|---|
| 3435 | 4189 | { |
|---|
| 3436 | 4190 | int ret; |
|---|
| 3437 | 4191 | |
|---|
| 3438 | 4192 | /* |
|---|
| 3439 | 4193 | * Enable the special ctrl of selected sources. |
|---|
| 3440 | 4194 | */ |
|---|
| 3441 | | - if (soc_is_rk3308b()) { |
|---|
| 3442 | | - ret = regmap_write(info->regmap_base, RK3308B_GRF_SOC_CON13, |
|---|
| 3443 | | - RK3308B_GRF_I2C3_IOFUNC_SRC_CTRL | |
|---|
| 3444 | | - RK3308B_GRF_GPIO2A3_SEL_SRC_CTRL | |
|---|
| 3445 | | - RK3308B_GRF_GPIO2A2_SEL_SRC_CTRL); |
|---|
| 3446 | | - if (ret) |
|---|
| 3447 | | - return ret; |
|---|
| 3448 | 4195 | |
|---|
| 3449 | | - ret = regmap_write(info->regmap_base, RK3308B_GRF_SOC_CON15, |
|---|
| 3450 | | - RK3308B_GRF_GPIO2C0_SEL_SRC_CTRL | |
|---|
| 3451 | | - RK3308B_GRF_GPIO3B3_SEL_SRC_CTRL | |
|---|
| 3452 | | - RK3308B_GRF_GPIO3B2_SEL_SRC_CTRL); |
|---|
| 3453 | | - if (ret) |
|---|
| 3454 | | - return ret; |
|---|
| 3455 | | - } |
|---|
| 4196 | + ret = regmap_write(info->regmap_base, RK3308_GRF_SOC_CON13, |
|---|
| 4197 | + RK3308_GRF_I2C3_IOFUNC_SRC_CTRL | |
|---|
| 4198 | + RK3308_GRF_GPIO2A3_SEL_SRC_CTRL | |
|---|
| 4199 | + RK3308_GRF_GPIO2A2_SEL_SRC_CTRL); |
|---|
| 4200 | + if (ret) |
|---|
| 4201 | + return ret; |
|---|
| 3456 | 4202 | |
|---|
| 3457 | | - return 0; |
|---|
| 4203 | + ret = regmap_write(info->regmap_base, RK3308_GRF_SOC_CON15, |
|---|
| 4204 | + RK3308_GRF_GPIO2C0_SEL_SRC_CTRL | |
|---|
| 4205 | + RK3308_GRF_GPIO3B3_SEL_SRC_CTRL | |
|---|
| 4206 | + RK3308_GRF_GPIO3B2_SEL_SRC_CTRL); |
|---|
| 4207 | + |
|---|
| 4208 | + return ret; |
|---|
| 4209 | + |
|---|
| 3458 | 4210 | } |
|---|
| 3459 | 4211 | |
|---|
| 3460 | 4212 | static int rockchip_pinctrl_probe(struct platform_device *pdev) |
|---|
| 3461 | 4213 | { |
|---|
| 3462 | 4214 | struct rockchip_pinctrl *info; |
|---|
| 3463 | 4215 | struct device *dev = &pdev->dev; |
|---|
| 4216 | + struct device_node *np = dev->of_node, *node; |
|---|
| 3464 | 4217 | struct rockchip_pin_ctrl *ctrl; |
|---|
| 3465 | | - struct device_node *np = pdev->dev.of_node, *node; |
|---|
| 3466 | 4218 | struct resource *res; |
|---|
| 3467 | 4219 | void __iomem *base; |
|---|
| 3468 | 4220 | int ret; |
|---|
| 3469 | 4221 | |
|---|
| 3470 | | - if (!dev->of_node) { |
|---|
| 3471 | | - dev_err(dev, "device tree node not found\n"); |
|---|
| 3472 | | - return -ENODEV; |
|---|
| 3473 | | - } |
|---|
| 4222 | + if (!dev->of_node) |
|---|
| 4223 | + return dev_err_probe(dev, -ENODEV, "device tree node not found\n"); |
|---|
| 3474 | 4224 | |
|---|
| 3475 | 4225 | info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL); |
|---|
| 3476 | 4226 | if (!info) |
|---|
| .. | .. |
|---|
| 3479 | 4229 | info->dev = dev; |
|---|
| 3480 | 4230 | |
|---|
| 3481 | 4231 | ctrl = rockchip_pinctrl_get_soc_data(info, pdev); |
|---|
| 3482 | | - if (!ctrl) { |
|---|
| 3483 | | - dev_err(dev, "driver data not available\n"); |
|---|
| 3484 | | - return -EINVAL; |
|---|
| 3485 | | - } |
|---|
| 4232 | + if (!ctrl) |
|---|
| 4233 | + return dev_err_probe(dev, -EINVAL, "driver data not available\n"); |
|---|
| 3486 | 4234 | info->ctrl = ctrl; |
|---|
| 3487 | 4235 | |
|---|
| 3488 | 4236 | node = of_parse_phandle(np, "rockchip,grf", 0); |
|---|
| 3489 | 4237 | if (node) { |
|---|
| 3490 | 4238 | info->regmap_base = syscon_node_to_regmap(node); |
|---|
| 4239 | + of_node_put(node); |
|---|
| 3491 | 4240 | if (IS_ERR(info->regmap_base)) |
|---|
| 3492 | 4241 | return PTR_ERR(info->regmap_base); |
|---|
| 3493 | 4242 | } else { |
|---|
| 3494 | | - res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
|---|
| 3495 | | - base = devm_ioremap_resource(&pdev->dev, res); |
|---|
| 4243 | + base = devm_platform_get_and_ioremap_resource(pdev, 0, &res); |
|---|
| 3496 | 4244 | if (IS_ERR(base)) |
|---|
| 3497 | 4245 | return PTR_ERR(base); |
|---|
| 3498 | 4246 | |
|---|
| 3499 | 4247 | rockchip_regmap_config.max_register = resource_size(res) - 4; |
|---|
| 3500 | 4248 | rockchip_regmap_config.name = "rockchip,pinctrl"; |
|---|
| 3501 | | - info->regmap_base = devm_regmap_init_mmio(&pdev->dev, base, |
|---|
| 3502 | | - &rockchip_regmap_config); |
|---|
| 4249 | + info->regmap_base = |
|---|
| 4250 | + devm_regmap_init_mmio(dev, base, &rockchip_regmap_config); |
|---|
| 3503 | 4251 | |
|---|
| 3504 | 4252 | /* to check for the old dt-bindings */ |
|---|
| 3505 | 4253 | info->reg_size = resource_size(res); |
|---|
| 3506 | 4254 | |
|---|
| 3507 | 4255 | /* Honor the old binding, with pull registers as 2nd resource */ |
|---|
| 3508 | 4256 | if (ctrl->type == RK3188 && info->reg_size < 0x200) { |
|---|
| 3509 | | - res = platform_get_resource(pdev, IORESOURCE_MEM, 1); |
|---|
| 3510 | | - base = devm_ioremap_resource(&pdev->dev, res); |
|---|
| 4257 | + base = devm_platform_get_and_ioremap_resource(pdev, 1, &res); |
|---|
| 3511 | 4258 | if (IS_ERR(base)) |
|---|
| 3512 | 4259 | return PTR_ERR(base); |
|---|
| 3513 | 4260 | |
|---|
| 3514 | | - rockchip_regmap_config.max_register = |
|---|
| 3515 | | - resource_size(res) - 4; |
|---|
| 4261 | + rockchip_regmap_config.max_register = resource_size(res) - 4; |
|---|
| 3516 | 4262 | rockchip_regmap_config.name = "rockchip,pinctrl-pull"; |
|---|
| 3517 | | - info->regmap_pull = devm_regmap_init_mmio(&pdev->dev, |
|---|
| 3518 | | - base, |
|---|
| 3519 | | - &rockchip_regmap_config); |
|---|
| 4263 | + info->regmap_pull = |
|---|
| 4264 | + devm_regmap_init_mmio(dev, base, &rockchip_regmap_config); |
|---|
| 3520 | 4265 | } |
|---|
| 3521 | 4266 | } |
|---|
| 3522 | 4267 | |
|---|
| .. | .. |
|---|
| 3524 | 4269 | node = of_parse_phandle(np, "rockchip,pmu", 0); |
|---|
| 3525 | 4270 | if (node) { |
|---|
| 3526 | 4271 | info->regmap_pmu = syscon_node_to_regmap(node); |
|---|
| 4272 | + of_node_put(node); |
|---|
| 3527 | 4273 | if (IS_ERR(info->regmap_pmu)) |
|---|
| 3528 | 4274 | return PTR_ERR(info->regmap_pmu); |
|---|
| 3529 | 4275 | } |
|---|
| 3530 | 4276 | |
|---|
| 3531 | | - /* Special handle for some Socs */ |
|---|
| 3532 | | - if (ctrl->soc_data_init) { |
|---|
| 3533 | | - ret = ctrl->soc_data_init(info); |
|---|
| 4277 | + if (IS_ENABLED(CONFIG_CPU_RK3308) && ctrl->type == RK3308) { |
|---|
| 4278 | + ret = rk3308_soc_data_init(info); |
|---|
| 3534 | 4279 | if (ret) |
|---|
| 3535 | 4280 | return ret; |
|---|
| 3536 | 4281 | } |
|---|
| .. | .. |
|---|
| 3540 | 4285 | return ret; |
|---|
| 3541 | 4286 | |
|---|
| 3542 | 4287 | platform_set_drvdata(pdev, info); |
|---|
| 4288 | + g_pctldev = info->pctl_dev; |
|---|
| 3543 | 4289 | |
|---|
| 3544 | | - ret = of_platform_populate(np, rockchip_bank_match, NULL, NULL); |
|---|
| 3545 | | - if (ret) { |
|---|
| 3546 | | - dev_err(&pdev->dev, "failed to register gpio device\n"); |
|---|
| 3547 | | - return ret; |
|---|
| 3548 | | - } |
|---|
| 4290 | + ret = of_platform_populate(np, NULL, NULL, &pdev->dev); |
|---|
| 4291 | + if (ret) |
|---|
| 4292 | + return dev_err_probe(dev, ret, "failed to register gpio device\n"); |
|---|
| 4293 | + |
|---|
| 3549 | 4294 | dev_info(dev, "probed %s\n", dev_name(dev)); |
|---|
| 3550 | 4295 | |
|---|
| 3551 | 4296 | return 0; |
|---|
| 3552 | 4297 | } |
|---|
| 4298 | + |
|---|
| 4299 | +static int rockchip_pinctrl_remove(struct platform_device *pdev) |
|---|
| 4300 | +{ |
|---|
| 4301 | + struct rockchip_pinctrl *info = platform_get_drvdata(pdev); |
|---|
| 4302 | + struct rockchip_pin_bank *bank; |
|---|
| 4303 | + struct rockchip_pin_deferred *cfg; |
|---|
| 4304 | + int i; |
|---|
| 4305 | + |
|---|
| 4306 | + g_pctldev = NULL; |
|---|
| 4307 | + of_platform_depopulate(&pdev->dev); |
|---|
| 4308 | + |
|---|
| 4309 | + for (i = 0; i < info->ctrl->nr_banks; i++) { |
|---|
| 4310 | + bank = &info->ctrl->pin_banks[i]; |
|---|
| 4311 | + |
|---|
| 4312 | + mutex_lock(&bank->deferred_lock); |
|---|
| 4313 | + while (!list_empty(&bank->deferred_pins)) { |
|---|
| 4314 | + cfg = list_first_entry(&bank->deferred_pins, |
|---|
| 4315 | + struct rockchip_pin_deferred, head); |
|---|
| 4316 | + list_del(&cfg->head); |
|---|
| 4317 | + kfree(cfg); |
|---|
| 4318 | + } |
|---|
| 4319 | + mutex_unlock(&bank->deferred_lock); |
|---|
| 4320 | + } |
|---|
| 4321 | + |
|---|
| 4322 | + return 0; |
|---|
| 4323 | +} |
|---|
| 4324 | + |
|---|
| 4325 | +static struct rockchip_pin_bank px30s_pin_banks[] __maybe_unused = { |
|---|
| 4326 | + S_PIN_BANK_FLAGS(0, 32, "gpio0", IOMUX_SOURCE_PMU, DRV_TYPE_IO_SMIC), |
|---|
| 4327 | + S_PIN_BANK_FLAGS(1, 32, "gpio1", IOMUX_WIDTH_4BIT, DRV_TYPE_IO_SMIC), |
|---|
| 4328 | + S_PIN_BANK_FLAGS(2, 32, "gpio2", IOMUX_WIDTH_4BIT, DRV_TYPE_IO_SMIC), |
|---|
| 4329 | + S_PIN_BANK_FLAGS(3, 32, "gpio3", IOMUX_WIDTH_4BIT, DRV_TYPE_IO_SMIC), |
|---|
| 4330 | +}; |
|---|
| 3553 | 4331 | |
|---|
| 3554 | 4332 | static struct rockchip_pin_bank px30_pin_banks[] = { |
|---|
| 3555 | 4333 | PIN_BANK_IOMUX_FLAGS(0, 32, "gpio0", IOMUX_SOURCE_PMU, |
|---|
| .. | .. |
|---|
| 3574 | 4352 | ), |
|---|
| 3575 | 4353 | }; |
|---|
| 3576 | 4354 | |
|---|
| 3577 | | -static struct rockchip_pin_bank px30s_pin_banks[] __maybe_unused = { |
|---|
| 3578 | | - PX30S_PIN_BANK_FLAGS(0, 32, "gpio0", IOMUX_SOURCE_PMU, DRV_TYPE_IO_SMIC), |
|---|
| 3579 | | - PX30S_PIN_BANK_FLAGS(1, 32, "gpio1", IOMUX_WIDTH_4BIT, DRV_TYPE_IO_SMIC), |
|---|
| 3580 | | - PX30S_PIN_BANK_FLAGS(2, 32, "gpio2", IOMUX_WIDTH_4BIT, DRV_TYPE_IO_SMIC), |
|---|
| 3581 | | - PX30S_PIN_BANK_FLAGS(3, 32, "gpio3", IOMUX_WIDTH_4BIT, DRV_TYPE_IO_SMIC), |
|---|
| 3582 | | -}; |
|---|
| 3583 | | - |
|---|
| 3584 | 4355 | static struct rockchip_pin_ctrl px30_pin_ctrl __maybe_unused = { |
|---|
| 3585 | 4356 | .pin_banks = px30_pin_banks, |
|---|
| 3586 | 4357 | .nr_banks = ARRAY_SIZE(px30_pin_banks), |
|---|
| .. | .. |
|---|
| 3594 | 4365 | .drv_calc_reg = px30_calc_drv_reg_and_bit, |
|---|
| 3595 | 4366 | .schmitt_calc_reg = px30_calc_schmitt_reg_and_bit, |
|---|
| 3596 | 4367 | .slew_rate_calc_reg = px30_calc_slew_rate_reg_and_bit, |
|---|
| 4368 | +}; |
|---|
| 4369 | + |
|---|
| 4370 | +static struct rockchip_pin_bank rv1106_pin_banks[] = { |
|---|
| 4371 | + PIN_BANK_IOMUX_FLAGS(0, 32, "gpio0", |
|---|
| 4372 | + IOMUX_WIDTH_4BIT | IOMUX_SOURCE_PMU, |
|---|
| 4373 | + IOMUX_WIDTH_4BIT | IOMUX_SOURCE_PMU, |
|---|
| 4374 | + IOMUX_WIDTH_4BIT | IOMUX_SOURCE_PMU, |
|---|
| 4375 | + IOMUX_WIDTH_4BIT | IOMUX_SOURCE_PMU), |
|---|
| 4376 | + PIN_BANK_IOMUX_FLAGS_OFFSET(1, 32, "gpio1", |
|---|
| 4377 | + IOMUX_WIDTH_4BIT, |
|---|
| 4378 | + IOMUX_WIDTH_4BIT, |
|---|
| 4379 | + IOMUX_WIDTH_4BIT, |
|---|
| 4380 | + IOMUX_WIDTH_4BIT, |
|---|
| 4381 | + 0, 0x08, 0x10, 0x18), |
|---|
| 4382 | + PIN_BANK_IOMUX_FLAGS_OFFSET(2, 32, "gpio2", |
|---|
| 4383 | + IOMUX_WIDTH_4BIT, |
|---|
| 4384 | + IOMUX_WIDTH_4BIT, |
|---|
| 4385 | + IOMUX_WIDTH_4BIT, |
|---|
| 4386 | + IOMUX_WIDTH_4BIT, |
|---|
| 4387 | + 0x10020, 0x10028, 0, 0), |
|---|
| 4388 | + PIN_BANK_IOMUX_FLAGS_OFFSET(3, 32, "gpio3", |
|---|
| 4389 | + IOMUX_WIDTH_4BIT, |
|---|
| 4390 | + IOMUX_WIDTH_4BIT, |
|---|
| 4391 | + IOMUX_WIDTH_4BIT, |
|---|
| 4392 | + IOMUX_WIDTH_4BIT, |
|---|
| 4393 | + 0x20040, 0x20048, 0x20050, 0x20058), |
|---|
| 4394 | + PIN_BANK_IOMUX_FLAGS_OFFSET(4, 24, "gpio4", |
|---|
| 4395 | + IOMUX_WIDTH_4BIT, |
|---|
| 4396 | + IOMUX_WIDTH_4BIT, |
|---|
| 4397 | + IOMUX_WIDTH_4BIT, |
|---|
| 4398 | + 0, |
|---|
| 4399 | + 0x30000, 0x30008, 0x30010, 0), |
|---|
| 4400 | +}; |
|---|
| 4401 | + |
|---|
| 4402 | +static struct rockchip_pin_ctrl rv1106_pin_ctrl __maybe_unused = { |
|---|
| 4403 | + .pin_banks = rv1106_pin_banks, |
|---|
| 4404 | + .nr_banks = ARRAY_SIZE(rv1106_pin_banks), |
|---|
| 4405 | + .label = "RV1106-GPIO", |
|---|
| 4406 | + .type = RV1106, |
|---|
| 4407 | + .pull_calc_reg = rv1106_calc_pull_reg_and_bit, |
|---|
| 4408 | + .drv_calc_reg = rv1106_calc_drv_reg_and_bit, |
|---|
| 4409 | + .schmitt_calc_reg = rv1106_calc_schmitt_reg_and_bit, |
|---|
| 3597 | 4410 | }; |
|---|
| 3598 | 4411 | |
|---|
| 3599 | 4412 | static struct rockchip_pin_bank rv1108_pin_banks[] = { |
|---|
| .. | .. |
|---|
| 3866 | 4679 | .drv_calc_reg = rk3288_calc_drv_reg_and_bit, |
|---|
| 3867 | 4680 | }; |
|---|
| 3868 | 4681 | |
|---|
| 4682 | +static struct rockchip_pin_bank rk3308bs_pin_banks[] __maybe_unused = { |
|---|
| 4683 | + S_PIN_BANK_FLAGS(0, 32, "gpio0", IOMUX_WIDTH_2BIT, DRV_TYPE_IO_SMIC), |
|---|
| 4684 | + S_PIN_BANK_FLAGS(1, 32, "gpio1", IOMUX_WIDTH_2BIT, DRV_TYPE_IO_SMIC), |
|---|
| 4685 | + S_PIN_BANK_FLAGS(2, 32, "gpio2", IOMUX_WIDTH_2BIT, DRV_TYPE_IO_SMIC), |
|---|
| 4686 | + S_PIN_BANK_FLAGS(3, 32, "gpio3", IOMUX_WIDTH_2BIT, DRV_TYPE_IO_SMIC), |
|---|
| 4687 | + S_PIN_BANK_FLAGS(4, 32, "gpio4", IOMUX_WIDTH_2BIT, DRV_TYPE_IO_SMIC), |
|---|
| 4688 | +}; |
|---|
| 4689 | + |
|---|
| 3869 | 4690 | static struct rockchip_pin_bank rk3308_pin_banks[] = { |
|---|
| 3870 | 4691 | PIN_BANK_IOMUX_FLAGS(0, 32, "gpio0", IOMUX_WIDTH_2BIT, |
|---|
| 3871 | 4692 | IOMUX_WIDTH_2BIT, |
|---|
| .. | .. |
|---|
| 3899 | 4720 | .niomux_recalced = ARRAY_SIZE(rk3308_mux_recalced_data), |
|---|
| 3900 | 4721 | .iomux_routes = rk3308_mux_route_data, |
|---|
| 3901 | 4722 | .niomux_routes = ARRAY_SIZE(rk3308_mux_route_data), |
|---|
| 3902 | | - .ctrl_data_re_init = rk3308b_ctrl_data_re_init, |
|---|
| 3903 | | - .soc_data_init = rk3308b_soc_data_init, |
|---|
| 3904 | 4723 | .pull_calc_reg = rk3308_calc_pull_reg_and_bit, |
|---|
| 3905 | 4724 | .drv_calc_reg = rk3308_calc_drv_reg_and_bit, |
|---|
| 3906 | 4725 | .schmitt_calc_reg = rk3308_calc_schmitt_reg_and_bit, |
|---|
| 4726 | + .slew_rate_calc_reg = rk3308_calc_slew_rate_reg_and_bit, |
|---|
| 3907 | 4727 | }; |
|---|
| 3908 | 4728 | |
|---|
| 3909 | 4729 | static struct rockchip_pin_bank rk3328_pin_banks[] = { |
|---|
| .. | .. |
|---|
| 4025 | 4845 | .drv_calc_reg = rk3399_calc_drv_reg_and_bit, |
|---|
| 4026 | 4846 | }; |
|---|
| 4027 | 4847 | |
|---|
| 4848 | +static struct rockchip_pin_bank rk3528_pin_banks[] = { |
|---|
| 4849 | + PIN_BANK_IOMUX_FLAGS_OFFSET(0, 32, "gpio0", |
|---|
| 4850 | + IOMUX_WIDTH_4BIT, |
|---|
| 4851 | + IOMUX_WIDTH_4BIT, |
|---|
| 4852 | + IOMUX_WIDTH_4BIT, |
|---|
| 4853 | + IOMUX_WIDTH_4BIT, |
|---|
| 4854 | + 0, 0, 0, 0), |
|---|
| 4855 | + PIN_BANK_IOMUX_FLAGS_OFFSET(1, 32, "gpio1", |
|---|
| 4856 | + IOMUX_WIDTH_4BIT, |
|---|
| 4857 | + IOMUX_WIDTH_4BIT, |
|---|
| 4858 | + IOMUX_WIDTH_4BIT, |
|---|
| 4859 | + IOMUX_WIDTH_4BIT, |
|---|
| 4860 | + 0x20020, 0x20028, 0x20030, 0x20038), |
|---|
| 4861 | + PIN_BANK_IOMUX_FLAGS_OFFSET(2, 32, "gpio2", |
|---|
| 4862 | + IOMUX_WIDTH_4BIT, |
|---|
| 4863 | + IOMUX_WIDTH_4BIT, |
|---|
| 4864 | + IOMUX_WIDTH_4BIT, |
|---|
| 4865 | + IOMUX_WIDTH_4BIT, |
|---|
| 4866 | + 0x30040, 0, 0, 0), |
|---|
| 4867 | + PIN_BANK_IOMUX_FLAGS_OFFSET(3, 32, "gpio3", |
|---|
| 4868 | + IOMUX_WIDTH_4BIT, |
|---|
| 4869 | + IOMUX_WIDTH_4BIT, |
|---|
| 4870 | + IOMUX_WIDTH_4BIT, |
|---|
| 4871 | + IOMUX_WIDTH_4BIT, |
|---|
| 4872 | + 0x20060, 0x20068, 0x20070, 0), |
|---|
| 4873 | + PIN_BANK_IOMUX_FLAGS_OFFSET(4, 32, "gpio4", |
|---|
| 4874 | + IOMUX_WIDTH_4BIT, |
|---|
| 4875 | + IOMUX_WIDTH_4BIT, |
|---|
| 4876 | + IOMUX_WIDTH_4BIT, |
|---|
| 4877 | + IOMUX_WIDTH_4BIT, |
|---|
| 4878 | + 0x10080, 0x10088, 0x10090, 0x10098), |
|---|
| 4879 | +}; |
|---|
| 4880 | + |
|---|
| 4881 | +static struct rockchip_pin_ctrl rk3528_pin_ctrl __maybe_unused = { |
|---|
| 4882 | + .pin_banks = rk3528_pin_banks, |
|---|
| 4883 | + .nr_banks = ARRAY_SIZE(rk3528_pin_banks), |
|---|
| 4884 | + .label = "RK3528-GPIO", |
|---|
| 4885 | + .type = RK3528, |
|---|
| 4886 | + .pull_calc_reg = rk3528_calc_pull_reg_and_bit, |
|---|
| 4887 | + .drv_calc_reg = rk3528_calc_drv_reg_and_bit, |
|---|
| 4888 | + .schmitt_calc_reg = rk3528_calc_schmitt_reg_and_bit, |
|---|
| 4889 | +}; |
|---|
| 4890 | + |
|---|
| 4891 | +static struct rockchip_pin_bank rk3562_pin_banks[] = { |
|---|
| 4892 | + PIN_BANK_IOMUX_FLAGS_OFFSET(0, 32, "gpio0", |
|---|
| 4893 | + IOMUX_WIDTH_4BIT, |
|---|
| 4894 | + IOMUX_WIDTH_4BIT, |
|---|
| 4895 | + IOMUX_WIDTH_4BIT, |
|---|
| 4896 | + IOMUX_WIDTH_4BIT, |
|---|
| 4897 | + 0x20000, 0x20008, 0x20010, 0x20018), |
|---|
| 4898 | + PIN_BANK_IOMUX_FLAGS_OFFSET(1, 32, "gpio1", |
|---|
| 4899 | + IOMUX_WIDTH_4BIT, |
|---|
| 4900 | + IOMUX_WIDTH_4BIT, |
|---|
| 4901 | + IOMUX_WIDTH_4BIT, |
|---|
| 4902 | + IOMUX_WIDTH_4BIT, |
|---|
| 4903 | + 0, 0x08, 0x10, 0x18), |
|---|
| 4904 | + PIN_BANK_IOMUX_FLAGS_OFFSET(2, 32, "gpio2", |
|---|
| 4905 | + IOMUX_WIDTH_4BIT, |
|---|
| 4906 | + IOMUX_WIDTH_4BIT, |
|---|
| 4907 | + IOMUX_WIDTH_4BIT, |
|---|
| 4908 | + IOMUX_WIDTH_4BIT, |
|---|
| 4909 | + 0x20, 0, 0, 0), |
|---|
| 4910 | + PIN_BANK_IOMUX_FLAGS_OFFSET(3, 32, "gpio3", |
|---|
| 4911 | + IOMUX_WIDTH_4BIT, |
|---|
| 4912 | + IOMUX_WIDTH_4BIT, |
|---|
| 4913 | + IOMUX_WIDTH_4BIT, |
|---|
| 4914 | + IOMUX_WIDTH_4BIT, |
|---|
| 4915 | + 0x10040, 0x10048, 0x10050, 0x10058), |
|---|
| 4916 | + PIN_BANK_IOMUX_FLAGS_OFFSET(4, 16, "gpio4", |
|---|
| 4917 | + IOMUX_WIDTH_4BIT, |
|---|
| 4918 | + IOMUX_WIDTH_4BIT, |
|---|
| 4919 | + 0, |
|---|
| 4920 | + 0, |
|---|
| 4921 | + 0x10060, 0x10068, 0, 0), |
|---|
| 4922 | +}; |
|---|
| 4923 | + |
|---|
| 4924 | +static struct rockchip_pin_ctrl rk3562_pin_ctrl __maybe_unused = { |
|---|
| 4925 | + .pin_banks = rk3562_pin_banks, |
|---|
| 4926 | + .nr_banks = ARRAY_SIZE(rk3562_pin_banks), |
|---|
| 4927 | + .label = "RK3562-GPIO", |
|---|
| 4928 | + .type = RK3562, |
|---|
| 4929 | + .pull_calc_reg = rk3562_calc_pull_reg_and_bit, |
|---|
| 4930 | + .drv_calc_reg = rk3562_calc_drv_reg_and_bit, |
|---|
| 4931 | + .schmitt_calc_reg = rk3562_calc_schmitt_reg_and_bit, |
|---|
| 4932 | +}; |
|---|
| 4933 | + |
|---|
| 4028 | 4934 | static struct rockchip_pin_bank rk3568_pin_banks[] = { |
|---|
| 4029 | 4935 | PIN_BANK_IOMUX_FLAGS(0, 32, "gpio0", IOMUX_SOURCE_PMU | IOMUX_WIDTH_4BIT, |
|---|
| 4030 | 4936 | IOMUX_SOURCE_PMU | IOMUX_WIDTH_4BIT, |
|---|
| .. | .. |
|---|
| 4065 | 4971 | .schmitt_calc_reg = rk3568_calc_schmitt_reg_and_bit, |
|---|
| 4066 | 4972 | }; |
|---|
| 4067 | 4973 | |
|---|
| 4974 | +static struct rockchip_pin_bank rk3588_pin_banks[] = { |
|---|
| 4975 | + RK3588_PIN_BANK_FLAGS(0, 32, "gpio0", |
|---|
| 4976 | + IOMUX_WIDTH_4BIT, PULL_TYPE_IO_1V8_ONLY), |
|---|
| 4977 | + RK3588_PIN_BANK_FLAGS(1, 32, "gpio1", |
|---|
| 4978 | + IOMUX_WIDTH_4BIT, PULL_TYPE_IO_1V8_ONLY), |
|---|
| 4979 | + RK3588_PIN_BANK_FLAGS(2, 32, "gpio2", |
|---|
| 4980 | + IOMUX_WIDTH_4BIT, PULL_TYPE_IO_1V8_ONLY), |
|---|
| 4981 | + RK3588_PIN_BANK_FLAGS(3, 32, "gpio3", |
|---|
| 4982 | + IOMUX_WIDTH_4BIT, PULL_TYPE_IO_1V8_ONLY), |
|---|
| 4983 | + RK3588_PIN_BANK_FLAGS(4, 32, "gpio4", |
|---|
| 4984 | + IOMUX_WIDTH_4BIT, PULL_TYPE_IO_1V8_ONLY), |
|---|
| 4985 | +}; |
|---|
| 4986 | + |
|---|
| 4987 | +static struct rockchip_pin_ctrl rk3588_pin_ctrl __maybe_unused = { |
|---|
| 4988 | + .pin_banks = rk3588_pin_banks, |
|---|
| 4989 | + .nr_banks = ARRAY_SIZE(rk3588_pin_banks), |
|---|
| 4990 | + .label = "RK3588-GPIO", |
|---|
| 4991 | + .type = RK3588, |
|---|
| 4992 | + .pull_calc_reg = rk3588_calc_pull_reg_and_bit, |
|---|
| 4993 | + .drv_calc_reg = rk3588_calc_drv_reg_and_bit, |
|---|
| 4994 | + .schmitt_calc_reg = rk3588_calc_schmitt_reg_and_bit, |
|---|
| 4995 | +}; |
|---|
| 4996 | + |
|---|
| 4068 | 4997 | static const struct of_device_id rockchip_pinctrl_dt_match[] = { |
|---|
| 4069 | 4998 | #ifdef CONFIG_CPU_PX30 |
|---|
| 4070 | 4999 | { .compatible = "rockchip,px30-pinctrl", |
|---|
| 4071 | 5000 | .data = &px30_pin_ctrl }, |
|---|
| 4072 | 5001 | #endif |
|---|
| 4073 | | -#ifdef CONFIG_CPU_RV110X |
|---|
| 5002 | +#ifdef CONFIG_CPU_RV1106 |
|---|
| 5003 | + { .compatible = "rockchip,rv1106-pinctrl", |
|---|
| 5004 | + .data = &rv1106_pin_ctrl }, |
|---|
| 5005 | +#endif |
|---|
| 5006 | +#ifdef CONFIG_CPU_RV1108 |
|---|
| 4074 | 5007 | { .compatible = "rockchip,rv1108-pinctrl", |
|---|
| 4075 | 5008 | .data = &rv1108_pin_ctrl }, |
|---|
| 4076 | 5009 | #endif |
|---|
| .. | .. |
|---|
| 4128 | 5061 | { .compatible = "rockchip,rk3399-pinctrl", |
|---|
| 4129 | 5062 | .data = &rk3399_pin_ctrl }, |
|---|
| 4130 | 5063 | #endif |
|---|
| 5064 | +#ifdef CONFIG_CPU_RK3528 |
|---|
| 5065 | + { .compatible = "rockchip,rk3528-pinctrl", |
|---|
| 5066 | + .data = &rk3528_pin_ctrl }, |
|---|
| 5067 | +#endif |
|---|
| 5068 | +#ifdef CONFIG_CPU_RK3562 |
|---|
| 5069 | + { .compatible = "rockchip,rk3562-pinctrl", |
|---|
| 5070 | + .data = &rk3562_pin_ctrl }, |
|---|
| 5071 | +#endif |
|---|
| 4131 | 5072 | #ifdef CONFIG_CPU_RK3568 |
|---|
| 4132 | 5073 | { .compatible = "rockchip,rk3568-pinctrl", |
|---|
| 4133 | 5074 | .data = &rk3568_pin_ctrl }, |
|---|
| 5075 | +#endif |
|---|
| 5076 | +#ifdef CONFIG_CPU_RK3588 |
|---|
| 5077 | + { .compatible = "rockchip,rk3588-pinctrl", |
|---|
| 5078 | + .data = &rk3588_pin_ctrl }, |
|---|
| 4134 | 5079 | #endif |
|---|
| 4135 | 5080 | {}, |
|---|
| 4136 | 5081 | }; |
|---|
| 4137 | 5082 | |
|---|
| 4138 | 5083 | static struct platform_driver rockchip_pinctrl_driver = { |
|---|
| 4139 | 5084 | .probe = rockchip_pinctrl_probe, |
|---|
| 5085 | + .remove = rockchip_pinctrl_remove, |
|---|
| 4140 | 5086 | .driver = { |
|---|
| 4141 | 5087 | .name = "rockchip-pinctrl", |
|---|
| 4142 | 5088 | .pm = &rockchip_pinctrl_dev_pm_ops, |
|---|
| .. | .. |
|---|
| 4156 | 5102 | } |
|---|
| 4157 | 5103 | module_exit(rockchip_pinctrl_drv_unregister); |
|---|
| 4158 | 5104 | |
|---|
| 5105 | +/** |
|---|
| 5106 | + * rk_iomux_set - set the rockchip iomux by pin number. |
|---|
| 5107 | + * |
|---|
| 5108 | + * @bank: the gpio bank index, from 0 to the max bank num. |
|---|
| 5109 | + * @pin: the gpio pin index, from 0 to 31. |
|---|
| 5110 | + * @mux: the pointer to store mux value. |
|---|
| 5111 | + * |
|---|
| 5112 | + * Return 0 if set success, else return error code. |
|---|
| 5113 | + */ |
|---|
| 5114 | +int rk_iomux_set(int bank, int pin, int mux) |
|---|
| 5115 | +{ |
|---|
| 5116 | + struct pinctrl_dev *pctldev = g_pctldev; |
|---|
| 5117 | + struct rockchip_pinctrl *info; |
|---|
| 5118 | + struct rockchip_pin_bank *gpio; |
|---|
| 5119 | + struct rockchip_pin_group *grp = NULL; |
|---|
| 5120 | + struct rockchip_pin_config *cfg = NULL; |
|---|
| 5121 | + int i, j, ret; |
|---|
| 5122 | + |
|---|
| 5123 | + if (!g_pctldev) |
|---|
| 5124 | + return -ENODEV; |
|---|
| 5125 | + |
|---|
| 5126 | + info = pinctrl_dev_get_drvdata(pctldev); |
|---|
| 5127 | + if (bank >= info->ctrl->nr_banks) |
|---|
| 5128 | + return -EINVAL; |
|---|
| 5129 | + |
|---|
| 5130 | + if (pin > 31 || pin < 0) |
|---|
| 5131 | + return -EINVAL; |
|---|
| 5132 | + |
|---|
| 5133 | + gpio = &info->ctrl->pin_banks[bank]; |
|---|
| 5134 | + |
|---|
| 5135 | + mutex_lock(&iomux_lock); |
|---|
| 5136 | + for (i = 0; i < info->ngroups; i++) { |
|---|
| 5137 | + grp = &info->groups[i]; |
|---|
| 5138 | + for (j = 0; j < grp->npins; i++) { |
|---|
| 5139 | + if (grp->pins[i] == (gpio->pin_base + pin)) { |
|---|
| 5140 | + cfg = grp->data; |
|---|
| 5141 | + break; |
|---|
| 5142 | + } |
|---|
| 5143 | + } |
|---|
| 5144 | + } |
|---|
| 5145 | + |
|---|
| 5146 | + ret = rockchip_set_mux(gpio, pin, mux); |
|---|
| 5147 | + if (ret) { |
|---|
| 5148 | + dev_err(info->dev, "mux GPIO%d-%d %d fail\n", bank, pin, mux); |
|---|
| 5149 | + goto out; |
|---|
| 5150 | + } |
|---|
| 5151 | + |
|---|
| 5152 | + if (cfg && (cfg->func != mux)) |
|---|
| 5153 | + cfg->func = mux; |
|---|
| 5154 | + |
|---|
| 5155 | +out: |
|---|
| 5156 | + mutex_unlock(&iomux_lock); |
|---|
| 5157 | + |
|---|
| 5158 | + return ret; |
|---|
| 5159 | +} |
|---|
| 5160 | +EXPORT_SYMBOL_GPL(rk_iomux_set); |
|---|
| 5161 | + |
|---|
| 5162 | +/** |
|---|
| 5163 | + * rk_iomux_get - get the rockchip iomux by pin number. |
|---|
| 5164 | + * |
|---|
| 5165 | + * @bank: the gpio bank index, from 0 to the max bank num. |
|---|
| 5166 | + * @pin: the gpio pin index, from 0 to 31. |
|---|
| 5167 | + * @mux: the pointer to store mux value. |
|---|
| 5168 | + * |
|---|
| 5169 | + * Return 0 if get success, else return error code. |
|---|
| 5170 | + */ |
|---|
| 5171 | +int rk_iomux_get(int bank, int pin, int *mux) |
|---|
| 5172 | +{ |
|---|
| 5173 | + struct pinctrl_dev *pctldev = g_pctldev; |
|---|
| 5174 | + struct rockchip_pinctrl *info; |
|---|
| 5175 | + struct rockchip_pin_bank *gpio; |
|---|
| 5176 | + int ret; |
|---|
| 5177 | + |
|---|
| 5178 | + if (!g_pctldev) |
|---|
| 5179 | + return -ENODEV; |
|---|
| 5180 | + if (!mux) |
|---|
| 5181 | + return -EINVAL; |
|---|
| 5182 | + |
|---|
| 5183 | + info = pinctrl_dev_get_drvdata(pctldev); |
|---|
| 5184 | + if (bank >= info->ctrl->nr_banks) |
|---|
| 5185 | + return -EINVAL; |
|---|
| 5186 | + |
|---|
| 5187 | + if (pin > 31 || pin < 0) |
|---|
| 5188 | + return -EINVAL; |
|---|
| 5189 | + |
|---|
| 5190 | + gpio = &info->ctrl->pin_banks[bank]; |
|---|
| 5191 | + |
|---|
| 5192 | + mutex_lock(&iomux_lock); |
|---|
| 5193 | + ret = rockchip_get_mux(gpio, pin); |
|---|
| 5194 | + mutex_unlock(&iomux_lock); |
|---|
| 5195 | + |
|---|
| 5196 | + *mux = ret; |
|---|
| 5197 | + |
|---|
| 5198 | + return (ret >= 0) ? 0 : ret; |
|---|
| 5199 | +} |
|---|
| 5200 | +EXPORT_SYMBOL_GPL(rk_iomux_get); |
|---|
| 5201 | + |
|---|
| 4159 | 5202 | MODULE_DESCRIPTION("ROCKCHIP Pin Controller Driver"); |
|---|
| 4160 | 5203 | MODULE_LICENSE("GPL"); |
|---|
| 4161 | 5204 | MODULE_ALIAS("platform:pinctrl-rockchip"); |
|---|