linux/drivers/pinctrl/pinctrl-artpec6.c
<<
>>
Prefs
   1/*
   2 * Driver for the Axis ARTPEC-6 pin controller
   3 *
   4 * Author: Chris Paterson <chris.paterson@linux.pieboy.co.uk>
   5 *
   6 * This file is licensed under the terms of the GNU General Public
   7 * License version 2. This program is licensed "as is" without any
   8 * warranty of any kind, whether express or implied.
   9 */
  10
  11#include <linux/device.h>
  12#include <linux/err.h>
  13#include <linux/init.h>
  14#include <linux/io.h>
  15#include <linux/of.h>
  16#include <linux/platform_device.h>
  17#include <linux/pinctrl/pinctrl.h>
  18#include <linux/pinctrl/pinconf-generic.h>
  19#include <linux/pinctrl/pinconf.h>
  20#include <linux/pinctrl/pinmux.h>
  21#include <linux/slab.h>
  22#include "core.h"
  23#include "pinconf.h"
  24#include "pinctrl-utils.h"
  25
  26#define ARTPEC6_LAST_PIN        97      /* 97 pins in pinmux */
  27#define ARTPEC6_MAX_MUXABLE     35      /* Last pin with muxable function */
  28
  29/* Pinmux control register bit definitions */
  30#define ARTPEC6_PINMUX_UDC0_MASK        0x00000001
  31#define ARTPEC6_PINMUX_UDC0_SHIFT       0
  32#define ARTPEC6_PINMUX_UDC1_MASK        0x00000002
  33#define ARTPEC6_PINMUX_UDC1_SHIFT       1
  34#define ARTPEC6_PINMUX_DRV_MASK         0x00000060
  35#define ARTPEC6_PINMUX_DRV_SHIFT        5
  36#define ARTPEC6_PINMUX_SEL_MASK         0x00003000
  37#define ARTPEC6_PINMUX_SEL_SHIFT        12
  38
  39/* Pinmux configurations */
  40#define ARTPEC6_CONFIG_0                0
  41#define ARTPEC6_CONFIG_1                1
  42#define ARTPEC6_CONFIG_2                2
  43#define ARTPEC6_CONFIG_3                3
  44
  45/* Pin drive strength options */
  46#define ARTPEC6_DRIVE_4mA               4
  47#define ARTPEC6_DRIVE_4mA_SET           0
  48#define ARTPEC6_DRIVE_6mA               6
  49#define ARTPEC6_DRIVE_6mA_SET           1
  50#define ARTPEC6_DRIVE_8mA               8
  51#define ARTPEC6_DRIVE_8mA_SET           2
  52#define ARTPEC6_DRIVE_9mA               9
  53#define ARTPEC6_DRIVE_9mA_SET           3
  54
  55struct artpec6_pmx {
  56        struct device                   *dev;
  57        struct pinctrl_dev              *pctl;
  58        void __iomem                    *base;
  59        struct pinctrl_pin_desc         *pins;
  60        unsigned int                    num_pins;
  61        const struct artpec6_pin_group  *pin_groups;
  62        unsigned int                    num_pin_groups;
  63        const struct artpec6_pmx_func   *functions;
  64        unsigned int                    num_functions;
  65};
  66
  67struct artpec6_pin_group {
  68        const char         *name;
  69        const unsigned int *pins;
  70        const unsigned int num_pins;
  71        unsigned char      config;
  72};
  73
  74struct artpec6_pmx_func {
  75        const char         *name;
  76        const char * const *groups;
  77        const unsigned int num_groups;
  78};
  79
  80/* pins */
  81static struct pinctrl_pin_desc artpec6_pins[] = {
  82        PINCTRL_PIN(0, "GPIO0"),
  83        PINCTRL_PIN(1, "GPIO1"),
  84        PINCTRL_PIN(2, "GPIO2"),
  85        PINCTRL_PIN(3, "GPIO3"),
  86        PINCTRL_PIN(4, "GPIO4"),
  87        PINCTRL_PIN(5, "GPIO5"),
  88        PINCTRL_PIN(6, "GPIO6"),
  89        PINCTRL_PIN(7, "GPIO7"),
  90        PINCTRL_PIN(8, "GPIO8"),
  91        PINCTRL_PIN(9, "GPIO9"),
  92        PINCTRL_PIN(10, "GPIO10"),
  93        PINCTRL_PIN(11, "GPIO11"),
  94        PINCTRL_PIN(12, "GPIO12"),
  95        PINCTRL_PIN(13, "GPIO13"),
  96        PINCTRL_PIN(14, "GPIO14"),
  97        PINCTRL_PIN(15, "GPIO15"),
  98        PINCTRL_PIN(16, "GPIO16"),
  99        PINCTRL_PIN(17, "GPIO17"),
 100        PINCTRL_PIN(18, "GPIO18"),
 101        PINCTRL_PIN(19, "GPIO19"),
 102        PINCTRL_PIN(20, "GPIO20"),
 103        PINCTRL_PIN(21, "GPIO21"),
 104        PINCTRL_PIN(22, "GPIO22"),
 105        PINCTRL_PIN(23, "GPIO23"),
 106        PINCTRL_PIN(24, "GPIO24"),
 107        PINCTRL_PIN(25, "GPIO25"),
 108        PINCTRL_PIN(26, "GPIO26"),
 109        PINCTRL_PIN(27, "GPIO27"),
 110        PINCTRL_PIN(28, "GPIO28"),
 111        PINCTRL_PIN(29, "GPIO29"),
 112        PINCTRL_PIN(30, "GPIO30"),
 113        PINCTRL_PIN(31, "GPIO31"),
 114        PINCTRL_PIN(32, "UART3_TXD"),
 115        PINCTRL_PIN(33, "UART3_RXD"),
 116        PINCTRL_PIN(34, "UART3_RTS"),
 117        PINCTRL_PIN(35, "UART3_CTS"),
 118        PINCTRL_PIN(36, "NF_ALE"),
 119        PINCTRL_PIN(37, "NF_CE0_N"),
 120        PINCTRL_PIN(38, "NF_CE1_N"),
 121        PINCTRL_PIN(39, "NF_CLE"),
 122        PINCTRL_PIN(40, "NF_RE_N"),
 123        PINCTRL_PIN(41, "NF_WE_N"),
 124        PINCTRL_PIN(42, "NF_WP0_N"),
 125        PINCTRL_PIN(43, "NF_WP1_N"),
 126        PINCTRL_PIN(44, "NF_IO0"),
 127        PINCTRL_PIN(45, "NF_IO1"),
 128        PINCTRL_PIN(46, "NF_IO2"),
 129        PINCTRL_PIN(47, "NF_IO3"),
 130        PINCTRL_PIN(48, "NF_IO4"),
 131        PINCTRL_PIN(49, "NF_IO5"),
 132        PINCTRL_PIN(50, "NF_IO6"),
 133        PINCTRL_PIN(51, "NF_IO7"),
 134        PINCTRL_PIN(52, "NF_RB0_N"),
 135        PINCTRL_PIN(53, "SDIO0_CLK"),
 136        PINCTRL_PIN(54, "SDIO0_CMD"),
 137        PINCTRL_PIN(55, "SDIO0_DAT0"),
 138        PINCTRL_PIN(56, "SDIO0_DAT1"),
 139        PINCTRL_PIN(57, "SDIO0_DAT2"),
 140        PINCTRL_PIN(58, "SDIO0_DAT3"),
 141        PINCTRL_PIN(59, "SDI0_CD"),
 142        PINCTRL_PIN(60, "SDI0_WP"),
 143        PINCTRL_PIN(61, "SDIO1_CLK"),
 144        PINCTRL_PIN(62, "SDIO1_CMD"),
 145        PINCTRL_PIN(63, "SDIO1_DAT0"),
 146        PINCTRL_PIN(64, "SDIO1_DAT1"),
 147        PINCTRL_PIN(65, "SDIO1_DAT2"),
 148        PINCTRL_PIN(66, "SDIO1_DAT3"),
 149        PINCTRL_PIN(67, "SDIO1_CD"),
 150        PINCTRL_PIN(68, "SDIO1_WP"),
 151        PINCTRL_PIN(69, "GBE_REFCLk"),
 152        PINCTRL_PIN(70, "GBE_GTX_CLK"),
 153        PINCTRL_PIN(71, "GBE_TX_CLK"),
 154        PINCTRL_PIN(72, "GBE_TX_EN"),
 155        PINCTRL_PIN(73, "GBE_TX_ER"),
 156        PINCTRL_PIN(74, "GBE_TXD0"),
 157        PINCTRL_PIN(75, "GBE_TXD1"),
 158        PINCTRL_PIN(76, "GBE_TXD2"),
 159        PINCTRL_PIN(77, "GBE_TXD3"),
 160        PINCTRL_PIN(78, "GBE_TXD4"),
 161        PINCTRL_PIN(79, "GBE_TXD5"),
 162        PINCTRL_PIN(80, "GBE_TXD6"),
 163        PINCTRL_PIN(81, "GBE_TXD7"),
 164        PINCTRL_PIN(82, "GBE_RX_CLK"),
 165        PINCTRL_PIN(83, "GBE_RX_DV"),
 166        PINCTRL_PIN(84, "GBE_RX_ER"),
 167        PINCTRL_PIN(85, "GBE_RXD0"),
 168        PINCTRL_PIN(86, "GBE_RXD1"),
 169        PINCTRL_PIN(87, "GBE_RXD2"),
 170        PINCTRL_PIN(88, "GBE_RXD3"),
 171        PINCTRL_PIN(89, "GBE_RXD4"),
 172        PINCTRL_PIN(90, "GBE_RXD5"),
 173        PINCTRL_PIN(91, "GBE_RXD6"),
 174        PINCTRL_PIN(92, "GBE_RXD7"),
 175        PINCTRL_PIN(93, "GBE_CRS"),
 176        PINCTRL_PIN(94, "GBE_COL"),
 177        PINCTRL_PIN(95, "GBE_MDC"),
 178        PINCTRL_PIN(96, "GBE_MDIO"),
 179};
 180
 181static const unsigned int cpuclkout_pins0[] = { 0 };
 182static const unsigned int udlclkout_pins0[] = { 1 };
 183static const unsigned int i2c1_pins0[] = { 2, 3 };
 184static const unsigned int i2c2_pins0[] = { 4, 5 };
 185static const unsigned int i2c3_pins0[] = { 6, 7 };
 186static const unsigned int i2s0_pins0[] = { 8, 9, 10, 11 };
 187static const unsigned int i2s1_pins0[] = { 12, 13, 14, 15 };
 188static const unsigned int i2srefclk_pins0[] = { 19 };
 189static const unsigned int spi0_pins0[] = { 12, 13, 14, 15 };
 190static const unsigned int spi1_pins0[] = { 16, 17, 18, 19 };
 191static const unsigned int pciedebug_pins0[] = { 12, 13, 14, 15 };
 192static const unsigned int uart0_pins0[] = { 16, 17, 18, 19, 20,
 193                                            21, 22, 23, 24, 25 };
 194static const unsigned int uart0_pins1[] = { 20, 21, 22, 23 };
 195static const unsigned int uart1_pins0[] = { 24, 25, 26, 27 };
 196static const unsigned int uart2_pins0[] = { 26, 27, 28, 29, 30,
 197                                            31, 32, 33, 34, 35 };
 198static const unsigned int uart2_pins1[] = { 28, 29, 30, 31 };
 199static const unsigned int uart3_pins0[] = { 32, 33, 34, 35 };
 200static const unsigned int uart4_pins0[] = { 20, 21, 22, 23 };
 201static const unsigned int uart5_pins0[] = { 28, 29, 30, 31 };
 202static const unsigned int nand_pins0[]  = { 36, 37, 38, 39, 40, 41,
 203                                            42, 43, 44, 45, 46, 47,
 204                                            48, 49, 50, 51, 52 };
 205static const unsigned int sdio0_pins0[] = { 53, 54, 55, 56, 57, 58, 59, 60 };
 206static const unsigned int sdio1_pins0[] = { 61, 62, 63, 64, 65, 66, 67, 68 };
 207static const unsigned int ethernet_pins0[]  = { 69, 70, 71, 72, 73, 74, 75,
 208                                                76, 77, 78, 79, 80, 81, 82,
 209                                                83, 84, 85, 86, 87, 88, 89,
 210                                                90, 91, 92, 93, 94, 95, 96 };
 211
 212static const struct artpec6_pin_group artpec6_pin_groups[] = {
 213        {
 214                .name = "cpuclkoutgrp0",
 215                .pins = cpuclkout_pins0,
 216                .num_pins = ARRAY_SIZE(cpuclkout_pins0),
 217                .config = ARTPEC6_CONFIG_1,
 218        },
 219        {
 220                .name = "udlclkoutgrp0",
 221                .pins = udlclkout_pins0,
 222                .num_pins = ARRAY_SIZE(udlclkout_pins0),
 223                .config = ARTPEC6_CONFIG_1,
 224        },
 225        {
 226                .name = "i2c1grp0",
 227                .pins = i2c1_pins0,
 228                .num_pins = ARRAY_SIZE(i2c1_pins0),
 229                .config = ARTPEC6_CONFIG_1,
 230        },
 231        {
 232                .name = "i2c2grp0",
 233                .pins = i2c2_pins0,
 234                .num_pins = ARRAY_SIZE(i2c2_pins0),
 235                .config = ARTPEC6_CONFIG_1,
 236        },
 237        {
 238                .name = "i2c3grp0",
 239                .pins = i2c3_pins0,
 240                .num_pins = ARRAY_SIZE(i2c3_pins0),
 241                .config = ARTPEC6_CONFIG_1,
 242        },
 243        {
 244                .name = "i2s0grp0",
 245                .pins = i2s0_pins0,
 246                .num_pins = ARRAY_SIZE(i2s0_pins0),
 247                .config = ARTPEC6_CONFIG_1,
 248        },
 249        {
 250                .name = "i2s1grp0",
 251                .pins = i2s1_pins0,
 252                .num_pins = ARRAY_SIZE(i2s1_pins0),
 253                .config = ARTPEC6_CONFIG_1,
 254        },
 255        {
 256                .name = "i2srefclkgrp0",
 257                .pins = i2srefclk_pins0,
 258                .num_pins = ARRAY_SIZE(i2srefclk_pins0),
 259                .config = ARTPEC6_CONFIG_3,
 260        },
 261        {
 262                .name = "spi0grp0",
 263                .pins = spi0_pins0,
 264                .num_pins = ARRAY_SIZE(spi0_pins0),
 265                .config = ARTPEC6_CONFIG_2,
 266        },
 267        {
 268                .name = "spi1grp0",
 269                .pins = spi1_pins0,
 270                .num_pins = ARRAY_SIZE(spi1_pins0),
 271                .config = ARTPEC6_CONFIG_2,
 272        },
 273        {
 274                .name = "pciedebuggrp0",
 275                .pins = pciedebug_pins0,
 276                .num_pins = ARRAY_SIZE(pciedebug_pins0),
 277                .config = ARTPEC6_CONFIG_3,
 278        },
 279        {
 280                .name = "uart0grp0",    /* All pins. */
 281                .pins = uart0_pins0,
 282                .num_pins = ARRAY_SIZE(uart0_pins0),
 283                .config = ARTPEC6_CONFIG_1,
 284        },
 285        {
 286                .name = "uart0grp1",    /* RX/TX and RTS/CTS */
 287                .pins = uart0_pins1,
 288                .num_pins = ARRAY_SIZE(uart0_pins1),
 289                .config = ARTPEC6_CONFIG_1,
 290        },
 291        {
 292                .name = "uart0grp2",    /* Only RX/TX pins. */
 293                .pins = uart0_pins1,
 294                .num_pins = ARRAY_SIZE(uart0_pins1) - 2,
 295                .config = ARTPEC6_CONFIG_1,
 296        },
 297        {
 298                .name = "uart1grp0",    /* RX/TX and RTS/CTS */
 299                .pins = uart1_pins0,
 300                .num_pins = ARRAY_SIZE(uart1_pins0),
 301                .config = ARTPEC6_CONFIG_2,
 302        },
 303        {
 304                .name = "uart1grp1",    /* Only RX/TX pins. */
 305                .pins = uart1_pins0,
 306                .num_pins = 2,
 307                .config = ARTPEC6_CONFIG_2,
 308        },
 309        {
 310                .name = "uart2grp0",    /* Full pinout */
 311                .pins = uart2_pins0,
 312                .num_pins = ARRAY_SIZE(uart2_pins0),
 313                .config = ARTPEC6_CONFIG_1,
 314        },
 315        {
 316                .name = "uart2grp1",    /* RX/TX and RTS/CTS */
 317                .pins = uart2_pins1,
 318                .num_pins = ARRAY_SIZE(uart2_pins1),
 319                .config = ARTPEC6_CONFIG_1,
 320        },
 321        {
 322                .name = "uart2grp2",    /* Only RX/TX */
 323                .pins = uart2_pins1,
 324                .num_pins = 2,
 325                .config = ARTPEC6_CONFIG_1,
 326        },
 327        {
 328                .name = "uart3grp0",    /* RX/TX and CTS/RTS */
 329                .pins = uart3_pins0,
 330                .num_pins = ARRAY_SIZE(uart3_pins0),
 331                .config = ARTPEC6_CONFIG_0,
 332        },
 333        {
 334                .name = "uart3grp1",    /* Only RX/TX */
 335                .pins = uart3_pins0,
 336                .num_pins = ARRAY_SIZE(uart3_pins0),
 337                .config = ARTPEC6_CONFIG_0,
 338        },
 339        {
 340                .name = "uart4grp0",
 341                .pins = uart4_pins0,
 342                .num_pins = ARRAY_SIZE(uart4_pins0),
 343                .config = ARTPEC6_CONFIG_2,
 344        },
 345        {
 346                .name = "uart5grp0",    /* TX/RX and RTS/CTS */
 347                .pins = uart5_pins0,
 348                .num_pins = ARRAY_SIZE(uart5_pins0),
 349                .config = ARTPEC6_CONFIG_2,
 350        },
 351        {
 352                .name = "uart5grp1",    /* Only TX/RX */
 353                .pins = uart5_pins0,
 354                .num_pins = 2,
 355                .config = ARTPEC6_CONFIG_2,
 356        },
 357        {
 358                .name = "uart5nocts",   /* TX/RX/RTS */
 359                .pins = uart5_pins0,
 360                .num_pins = ARRAY_SIZE(uart5_pins0) - 1,
 361                .config = ARTPEC6_CONFIG_2,
 362        },
 363        {
 364                .name = "nandgrp0",
 365                .pins = nand_pins0,
 366                .num_pins = ARRAY_SIZE(nand_pins0),
 367                .config = ARTPEC6_CONFIG_0,
 368        },
 369        {
 370                .name = "sdio0grp0",
 371                .pins = sdio0_pins0,
 372                .num_pins = ARRAY_SIZE(sdio0_pins0),
 373                .config = ARTPEC6_CONFIG_0,
 374        },
 375        {
 376                .name = "sdio1grp0",
 377                .pins = sdio1_pins0,
 378                .num_pins = ARRAY_SIZE(sdio1_pins0),
 379                .config = ARTPEC6_CONFIG_0,
 380        },
 381        {
 382                .name = "ethernetgrp0",
 383                .pins = ethernet_pins0,
 384                .num_pins = ARRAY_SIZE(ethernet_pins0),
 385                .config = ARTPEC6_CONFIG_0,
 386        },
 387};
 388
 389struct pin_register {
 390        unsigned int start;
 391        unsigned int end;
 392        unsigned int reg_base;
 393};
 394
 395/*
 396 * The register map has two holes where the pin number
 397 * no longer fits directly with the register offset.
 398 * This table allows us to map this easily.
 399 */
 400static const struct pin_register pin_register[] = {
 401        { 0, 35, 0x0 },         /* 0x0 - 0x8c */
 402        { 36, 52, 0x100 },      /* 0x100 - 0x140 */
 403        { 53, 96, 0x180 },      /* 0x180 - 0x22c */
 404};
 405
 406static unsigned int artpec6_pmx_reg_offset(unsigned int pin)
 407{
 408        int i;
 409
 410        for (i = 0; i < ARRAY_SIZE(pin_register); i++) {
 411                if (pin <= pin_register[i].end) {
 412                        return (pin - pin_register[i].start) * 4 +
 413                                pin_register[i].reg_base;
 414                }
 415        }
 416        /*
 417         * Anything we return here is wrong, but we can only
 418         * get here if pin is outside registered range.
 419         */
 420        pr_err("%s: Impossible pin %d\n", __func__, pin);
 421        return 0;
 422}
 423
 424static int artpec6_get_groups_count(struct pinctrl_dev *pctldev)
 425{
 426        return ARRAY_SIZE(artpec6_pin_groups);
 427}
 428
 429static const char *artpec6_get_group_name(struct pinctrl_dev *pctldev,
 430                                          unsigned int group)
 431{
 432        return artpec6_pin_groups[group].name;
 433}
 434
 435static int artpec6_get_group_pins(struct pinctrl_dev *pctldev,
 436                                  unsigned int group,
 437                                  const unsigned int **pins,
 438                                  unsigned int *num_pins)
 439{
 440        *pins = (unsigned int *)artpec6_pin_groups[group].pins;
 441        *num_pins = artpec6_pin_groups[group].num_pins;
 442        return 0;
 443}
 444
 445static int artpec6_pconf_drive_mA_to_field(unsigned int mA)
 446{
 447        switch (mA) {
 448        case ARTPEC6_DRIVE_4mA:
 449                return ARTPEC6_DRIVE_4mA_SET;
 450        case ARTPEC6_DRIVE_6mA:
 451                return ARTPEC6_DRIVE_6mA_SET;
 452        case ARTPEC6_DRIVE_8mA:
 453                return ARTPEC6_DRIVE_8mA_SET;
 454        case ARTPEC6_DRIVE_9mA:
 455                return ARTPEC6_DRIVE_9mA_SET;
 456        default:
 457                return -EINVAL;
 458        }
 459}
 460
 461static unsigned int artpec6_pconf_drive_field_to_mA(int field)
 462{
 463        switch (field) {
 464        case ARTPEC6_DRIVE_4mA_SET:
 465                return ARTPEC6_DRIVE_4mA;
 466        case ARTPEC6_DRIVE_6mA_SET:
 467                return ARTPEC6_DRIVE_6mA;
 468        case ARTPEC6_DRIVE_8mA_SET:
 469                return ARTPEC6_DRIVE_8mA;
 470        case ARTPEC6_DRIVE_9mA_SET:
 471                return ARTPEC6_DRIVE_9mA;
 472        default:
 473                /* Shouldn't happen */
 474                return 0;
 475        }
 476}
 477
 478static const struct pinctrl_ops artpec6_pctrl_ops = {
 479        .get_group_pins         = artpec6_get_group_pins,
 480        .get_groups_count       = artpec6_get_groups_count,
 481        .get_group_name         = artpec6_get_group_name,
 482        .dt_node_to_map         = pinconf_generic_dt_node_to_map_all,
 483        .dt_free_map            = pinctrl_utils_free_map,
 484};
 485
 486static const char * const gpiogrps[] = {
 487        "cpuclkoutgrp0", "udlclkoutgrp0", "i2c1grp0", "i2c2grp0",
 488        "i2c3grp0", "i2s0grp0", "i2s1grp0", "i2srefclkgrp0",
 489        "spi0grp0", "spi1grp0", "pciedebuggrp0", "uart0grp0",
 490        "uart0grp1", "uart0grp2", "uart1grp0", "uart1grp1",
 491        "uart2grp0", "uart2grp1", "uart2grp2", "uart4grp0", "uart5grp0",
 492        "uart5grp1", "uart5nocts",
 493};
 494static const char * const cpuclkoutgrps[] = { "cpuclkoutgrp0" };
 495static const char * const udlclkoutgrps[] = { "udlclkoutgrp0" };
 496static const char * const i2c1grps[]      = { "i2c1grp0" };
 497static const char * const i2c2grps[]      = { "i2c2grp0" };
 498static const char * const i2c3grps[]      = { "i2c3grp0" };
 499static const char * const i2s0grps[]      = { "i2s0grp0" };
 500static const char * const i2s1grps[]      = { "i2s1grp0" };
 501static const char * const i2srefclkgrps[] = { "i2srefclkgrp0" };
 502static const char * const spi0grps[]      = { "spi0grp0" };
 503static const char * const spi1grps[]      = { "spi1grp0" };
 504static const char * const pciedebuggrps[] = { "pciedebuggrp0" };
 505static const char * const uart0grps[]     = { "uart0grp0", "uart0grp1",
 506                                              "uart0grp2" };
 507static const char * const uart1grps[]     = { "uart1grp0", "uart1grp1" };
 508static const char * const uart2grps[]     = { "uart2grp0", "uart2grp1",
 509                                              "uart2grp2" };
 510static const char * const uart3grps[]     = { "uart3grp0" };
 511static const char * const uart4grps[]     = { "uart4grp0", "uart4grp1" };
 512static const char * const uart5grps[]     = { "uart5grp0", "uart5grp1",
 513                                              "uart5nocts" };
 514static const char * const nandgrps[]      = { "nandgrp0" };
 515static const char * const sdio0grps[]     = { "sdio0grp0" };
 516static const char * const sdio1grps[]     = { "sdio1grp0" };
 517static const char * const ethernetgrps[]  = { "ethernetgrp0" };
 518
 519static const struct artpec6_pmx_func artpec6_pmx_functions[] = {
 520        {
 521                .name = "gpio",
 522                .groups = gpiogrps,
 523                .num_groups = ARRAY_SIZE(gpiogrps),
 524        },
 525        {
 526                .name = "cpuclkout",
 527                .groups = cpuclkoutgrps,
 528                .num_groups = ARRAY_SIZE(cpuclkoutgrps),
 529        },
 530        {
 531                .name = "udlclkout",
 532                .groups = udlclkoutgrps,
 533                .num_groups = ARRAY_SIZE(udlclkoutgrps),
 534        },
 535        {
 536                .name = "i2c1",
 537                .groups = i2c1grps,
 538                .num_groups = ARRAY_SIZE(i2c1grps),
 539        },
 540        {
 541                .name = "i2c2",
 542                .groups = i2c2grps,
 543                .num_groups = ARRAY_SIZE(i2c2grps),
 544        },
 545        {
 546                .name = "i2c3",
 547                .groups = i2c3grps,
 548                .num_groups = ARRAY_SIZE(i2c3grps),
 549        },
 550        {
 551                .name = "i2s0",
 552                .groups = i2s0grps,
 553                .num_groups = ARRAY_SIZE(i2s0grps),
 554        },
 555        {
 556                .name = "i2s1",
 557                .groups = i2s1grps,
 558                .num_groups = ARRAY_SIZE(i2s1grps),
 559        },
 560        {
 561                .name = "i2srefclk",
 562                .groups = i2srefclkgrps,
 563                .num_groups = ARRAY_SIZE(i2srefclkgrps),
 564        },
 565        {
 566                .name = "spi0",
 567                .groups = spi0grps,
 568                .num_groups = ARRAY_SIZE(spi0grps),
 569        },
 570        {
 571                .name = "spi1",
 572                .groups = spi1grps,
 573                .num_groups = ARRAY_SIZE(spi1grps),
 574        },
 575        {
 576                .name = "pciedebug",
 577                .groups = pciedebuggrps,
 578                .num_groups = ARRAY_SIZE(pciedebuggrps),
 579        },
 580        {
 581                .name = "uart0",
 582                .groups = uart0grps,
 583                .num_groups = ARRAY_SIZE(uart0grps),
 584        },
 585        {
 586                .name = "uart1",
 587                .groups = uart1grps,
 588                .num_groups = ARRAY_SIZE(uart1grps),
 589        },
 590        {
 591                .name = "uart2",
 592                .groups = uart2grps,
 593                .num_groups = ARRAY_SIZE(uart2grps),
 594        },
 595        {
 596                .name = "uart3",
 597                .groups = uart3grps,
 598                .num_groups = ARRAY_SIZE(uart3grps),
 599        },
 600        {
 601                .name = "uart4",
 602                .groups = uart4grps,
 603                .num_groups = ARRAY_SIZE(uart4grps),
 604        },
 605        {
 606                .name = "uart5",
 607                .groups = uart5grps,
 608                .num_groups = ARRAY_SIZE(uart5grps),
 609        },
 610        {
 611                .name = "nand",
 612                .groups = nandgrps,
 613                .num_groups = ARRAY_SIZE(nandgrps),
 614        },
 615        {
 616                .name = "sdio0",
 617                .groups = sdio0grps,
 618                .num_groups = ARRAY_SIZE(sdio0grps),
 619        },
 620        {
 621                .name = "sdio1",
 622                .groups = sdio1grps,
 623                .num_groups = ARRAY_SIZE(sdio1grps),
 624        },
 625        {
 626                .name = "ethernet",
 627                .groups = ethernetgrps,
 628                .num_groups = ARRAY_SIZE(ethernetgrps),
 629        },
 630};
 631
 632static int artpec6_pmx_get_functions_count(struct pinctrl_dev *pctldev)
 633{
 634        return ARRAY_SIZE(artpec6_pmx_functions);
 635}
 636
 637static const char *artpec6_pmx_get_fname(struct pinctrl_dev *pctldev,
 638                                         unsigned int function)
 639{
 640        return artpec6_pmx_functions[function].name;
 641}
 642
 643static int artpec6_pmx_get_fgroups(struct pinctrl_dev *pctldev,
 644                                   unsigned int function,
 645                                   const char * const **groups,
 646                                   unsigned int * const num_groups)
 647{
 648        *groups = artpec6_pmx_functions[function].groups;
 649        *num_groups = artpec6_pmx_functions[function].num_groups;
 650        return 0;
 651}
 652
 653static void artpec6_pmx_select_func(struct pinctrl_dev *pctldev,
 654                                    unsigned int function, unsigned int group,
 655                                    bool enable)
 656{
 657        unsigned int regval, val;
 658        unsigned int reg;
 659        int i;
 660        struct artpec6_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
 661
 662        for (i = 0; i < artpec6_pin_groups[group].num_pins; i++) {
 663                /*
 664                 * Registers for pins above a ARTPEC6_MAX_MUXABLE
 665                 * do not have a SEL field and are always selected.
 666                 */
 667                if (artpec6_pin_groups[group].pins[i] > ARTPEC6_MAX_MUXABLE)
 668                        continue;
 669
 670                if (!strcmp(artpec6_pmx_get_fname(pctldev, function), "gpio")) {
 671                        /* GPIO is always config 0 */
 672                        val = ARTPEC6_CONFIG_0 << ARTPEC6_PINMUX_SEL_SHIFT;
 673                } else {
 674                        if (enable)
 675                                val = artpec6_pin_groups[group].config
 676                                        << ARTPEC6_PINMUX_SEL_SHIFT;
 677                        else
 678                                val = ARTPEC6_CONFIG_0
 679                                        << ARTPEC6_PINMUX_SEL_SHIFT;
 680                }
 681
 682                reg = artpec6_pmx_reg_offset(artpec6_pin_groups[group].pins[i]);
 683
 684                regval = readl(pmx->base + reg);
 685                regval &= ~ARTPEC6_PINMUX_SEL_MASK;
 686                regval |= val;
 687                writel(regval, pmx->base + reg);
 688        }
 689}
 690
 691int artpec6_pmx_enable(struct pinctrl_dev *pctldev, unsigned int function,
 692                       unsigned int group)
 693{
 694        struct artpec6_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
 695
 696        dev_dbg(pmx->dev, "enabling %s function for pin group %s\n",
 697                artpec6_pmx_get_fname(pctldev, function),
 698                artpec6_get_group_name(pctldev, group));
 699
 700        artpec6_pmx_select_func(pctldev, function, group, true);
 701
 702        return 0;
 703}
 704
 705void artpec6_pmx_disable(struct pinctrl_dev *pctldev, unsigned int function,
 706                         unsigned int group)
 707{
 708        struct artpec6_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
 709
 710        dev_dbg(pmx->dev, "disabling %s function for pin group %s\n",
 711                artpec6_pmx_get_fname(pctldev, function),
 712                artpec6_get_group_name(pctldev, group));
 713
 714        artpec6_pmx_select_func(pctldev, function, group, false);
 715}
 716
 717static int artpec6_pmx_request_gpio(struct pinctrl_dev *pctldev,
 718                                    struct pinctrl_gpio_range *range,
 719                                    unsigned int pin)
 720{
 721        struct artpec6_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
 722        unsigned int reg = artpec6_pmx_reg_offset(pin);
 723        u32 val;
 724
 725        if (pin >= 32)
 726                return -EINVAL;
 727
 728        val = readl_relaxed(pmx->base + reg);
 729        val &= ~ARTPEC6_PINMUX_SEL_MASK;
 730        val |= ARTPEC6_CONFIG_0 << ARTPEC6_PINMUX_SEL_SHIFT;
 731        writel_relaxed(val, pmx->base + reg);
 732
 733        return 0;
 734}
 735
 736static const struct pinmux_ops artpec6_pmx_ops = {
 737        .get_functions_count    = artpec6_pmx_get_functions_count,
 738        .get_function_name      = artpec6_pmx_get_fname,
 739        .get_function_groups    = artpec6_pmx_get_fgroups,
 740        .set_mux                = artpec6_pmx_enable,
 741        .gpio_request_enable = artpec6_pmx_request_gpio,
 742};
 743
 744static int artpec6_pconf_get(struct pinctrl_dev *pctldev, unsigned int pin,
 745                             unsigned long *config)
 746{
 747        struct artpec6_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
 748        enum pin_config_param param = pinconf_to_config_param(*config);
 749        unsigned int regval;
 750
 751        /* Check for valid pin */
 752        if (pin >= pmx->num_pins) {
 753                dev_dbg(pmx->dev, "pinconf is not supported for pin %s\n",
 754                        pmx->pins[pin].name);
 755                return -ENOTSUPP;
 756        }
 757
 758        dev_dbg(pmx->dev, "getting configuration for pin %s\n",
 759                pmx->pins[pin].name);
 760
 761        /* Read pin register values */
 762        regval = readl(pmx->base + artpec6_pmx_reg_offset(pin));
 763
 764        /* If valid, get configuration for parameter */
 765        switch (param) {
 766        case PIN_CONFIG_BIAS_DISABLE:
 767                if (!(regval & ARTPEC6_PINMUX_UDC1_MASK))
 768                        return -EINVAL;
 769                break;
 770
 771        case PIN_CONFIG_BIAS_PULL_UP:
 772        case PIN_CONFIG_BIAS_PULL_DOWN:
 773                if (regval & ARTPEC6_PINMUX_UDC1_MASK)
 774                        return -EINVAL;
 775
 776                regval = regval & ARTPEC6_PINMUX_UDC0_MASK;
 777                if ((param == PIN_CONFIG_BIAS_PULL_UP && !regval) ||
 778                    (param == PIN_CONFIG_BIAS_PULL_DOWN && regval))
 779                        return -EINVAL;
 780                break;
 781        case PIN_CONFIG_DRIVE_STRENGTH:
 782                regval = (regval & ARTPEC6_PINMUX_DRV_MASK)
 783                        >> ARTPEC6_PINMUX_DRV_SHIFT;
 784                regval = artpec6_pconf_drive_field_to_mA(regval);
 785                *config = pinconf_to_config_packed(param, regval);
 786                break;
 787        default:
 788                return -ENOTSUPP;
 789        }
 790
 791        return 0;
 792}
 793
 794/*
 795 * Valid combinations of param and arg:
 796 *
 797 * param                     arg
 798 * PIN_CONFIG_BIAS_DISABLE:   x (disable bias)
 799 * PIN_CONFIG_BIAS_PULL_UP:   1 (pull up bias + enable)
 800 * PIN_CONFIG_BIAS_PULL_DOWN: 1 (pull down bias + enable)
 801 * PIN_CONFIG_DRIVE_STRENGTH: x (4mA, 6mA, 8mA, 9mA)
 802 *
 803 * All other args are invalid. All other params are not supported.
 804 */
 805static int artpec6_pconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
 806                             unsigned long *configs, unsigned int num_configs)
 807{
 808        struct artpec6_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);
 809        enum pin_config_param param;
 810        unsigned int arg;
 811        unsigned int regval;
 812        unsigned int *reg;
 813        int i;
 814
 815        /* Check for valid pin */
 816        if (pin >= pmx->num_pins) {
 817                dev_dbg(pmx->dev, "pinconf is not supported for pin %s\n",
 818                        pmx->pins[pin].name);
 819                return -ENOTSUPP;
 820        }
 821
 822        dev_dbg(pmx->dev, "setting configuration for pin %s\n",
 823                pmx->pins[pin].name);
 824
 825        reg = pmx->base + artpec6_pmx_reg_offset(pin);
 826
 827        /* For each config */
 828        for (i = 0; i < num_configs; i++) {
 829                int drive;
 830
 831                param = pinconf_to_config_param(configs[i]);
 832                arg = pinconf_to_config_argument(configs[i]);
 833
 834                switch (param) {
 835                case PIN_CONFIG_BIAS_DISABLE:
 836                        regval = readl(reg);
 837                        regval |= (1 << ARTPEC6_PINMUX_UDC1_SHIFT);
 838                        writel(regval, reg);
 839                        break;
 840
 841                case PIN_CONFIG_BIAS_PULL_UP:
 842                        if (arg != 1) {
 843                                dev_dbg(pctldev->dev, "%s: arg %u out of range\n",
 844                                        __func__, arg);
 845                                return -EINVAL;
 846                        }
 847
 848                        regval = readl(reg);
 849                        regval |= (arg << ARTPEC6_PINMUX_UDC0_SHIFT);
 850                        regval &= ~ARTPEC6_PINMUX_UDC1_MASK; /* Enable */
 851                        writel(regval, reg);
 852                        break;
 853
 854                case PIN_CONFIG_BIAS_PULL_DOWN:
 855                        if (arg != 1) {
 856                                dev_dbg(pctldev->dev, "%s: arg %u out of range\n",
 857                                        __func__, arg);
 858                                return -EINVAL;
 859                        }
 860
 861                        regval = readl(reg);
 862                        regval &= ~(arg << ARTPEC6_PINMUX_UDC0_SHIFT);
 863                        regval &= ~ARTPEC6_PINMUX_UDC1_MASK; /* Enable */
 864                        writel(regval, reg);
 865                        break;
 866
 867                case PIN_CONFIG_DRIVE_STRENGTH:
 868                        drive = artpec6_pconf_drive_mA_to_field(arg);
 869                        if (drive < 0) {
 870                                dev_dbg(pctldev->dev, "%s: arg %u out of range\n",
 871                                        __func__, arg);
 872                                return -EINVAL;
 873                        }
 874
 875                        regval = readl(reg);
 876                        regval &= ~ARTPEC6_PINMUX_DRV_MASK;
 877                        regval |= (drive << ARTPEC6_PINMUX_DRV_SHIFT);
 878                        writel(regval, reg);
 879                        break;
 880
 881                default:
 882                        dev_dbg(pmx->dev, "parameter not supported\n");
 883                        return -ENOTSUPP;
 884                }
 885        }
 886
 887        return 0;
 888}
 889
 890static int artpec6_pconf_group_set(struct pinctrl_dev *pctldev,
 891                                   unsigned int group, unsigned long *configs,
 892                                   unsigned int num_configs)
 893{
 894        unsigned int num_pins, current_pin;
 895        int ret;
 896
 897        dev_dbg(pctldev->dev, "setting group %s configuration\n",
 898                artpec6_get_group_name(pctldev, group));
 899
 900        num_pins = artpec6_pin_groups[group].num_pins;
 901
 902        for (current_pin = 0; current_pin < num_pins; current_pin++) {
 903                ret = artpec6_pconf_set(pctldev,
 904                                artpec6_pin_groups[group].pins[current_pin],
 905                                configs, num_configs);
 906
 907                if (ret < 0)
 908                        return ret;
 909        }
 910
 911        return 0;
 912}
 913
 914static const struct pinconf_ops artpec6_pconf_ops = {
 915        .is_generic             = true,
 916        .pin_config_get         = artpec6_pconf_get,
 917        .pin_config_set         = artpec6_pconf_set,
 918        .pin_config_group_set   = artpec6_pconf_group_set,
 919};
 920
 921static struct pinctrl_desc artpec6_desc = {
 922        .name    = "artpec6-pinctrl",
 923        .owner   = THIS_MODULE,
 924        .pins    = artpec6_pins,
 925        .npins   = ARRAY_SIZE(artpec6_pins),
 926        .pctlops = &artpec6_pctrl_ops,
 927        .pmxops  = &artpec6_pmx_ops,
 928        .confops = &artpec6_pconf_ops,
 929};
 930
 931/* The reset values say 4mA, but we want 8mA as default. */
 932static void artpec6_pmx_reset(struct artpec6_pmx *pmx)
 933{
 934        void __iomem *base = pmx->base;
 935        int i;
 936
 937        for (i = 0; i < ARTPEC6_LAST_PIN; i++) {
 938                u32 val;
 939
 940                val = readl_relaxed(base + artpec6_pmx_reg_offset(i));
 941                val &= ~ARTPEC6_PINMUX_DRV_MASK;
 942                val |= ARTPEC6_DRIVE_8mA_SET << ARTPEC6_PINMUX_DRV_SHIFT;
 943                writel_relaxed(val, base + artpec6_pmx_reg_offset(i));
 944        }
 945}
 946
 947static int artpec6_pmx_probe(struct platform_device *pdev)
 948{
 949        struct artpec6_pmx *pmx;
 950        struct resource *res;
 951
 952        pmx = devm_kzalloc(&pdev->dev, sizeof(*pmx), GFP_KERNEL);
 953        if (!pmx)
 954                return -ENOMEM;
 955
 956        pmx->dev = &pdev->dev;
 957
 958        res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 959        pmx->base = devm_ioremap_resource(&pdev->dev, res);
 960
 961        if (IS_ERR(pmx->base))
 962                return PTR_ERR(pmx->base);
 963
 964        artpec6_pmx_reset(pmx);
 965
 966        pmx->pins           = artpec6_pins;
 967        pmx->num_pins       = ARRAY_SIZE(artpec6_pins);
 968        pmx->functions      = artpec6_pmx_functions;
 969        pmx->num_functions  = ARRAY_SIZE(artpec6_pmx_functions);
 970        pmx->pin_groups     = artpec6_pin_groups;
 971        pmx->num_pin_groups = ARRAY_SIZE(artpec6_pin_groups);
 972        pmx->pctl           = pinctrl_register(&artpec6_desc, &pdev->dev, pmx);
 973
 974        if (IS_ERR(pmx->pctl)) {
 975                dev_err(&pdev->dev, "could not register pinctrl driver\n");
 976                return PTR_ERR(pmx->pctl);
 977        }
 978
 979        platform_set_drvdata(pdev, pmx);
 980
 981        dev_info(&pdev->dev, "initialised Axis ARTPEC-6 pinctrl driver\n");
 982
 983        return 0;
 984}
 985
 986static int artpec6_pmx_remove(struct platform_device *pdev)
 987{
 988        struct artpec6_pmx *pmx = platform_get_drvdata(pdev);
 989
 990        pinctrl_unregister(pmx->pctl);
 991
 992        return 0;
 993}
 994
 995static const struct of_device_id artpec6_pinctrl_match[] = {
 996        { .compatible = "axis,artpec6-pinctrl" },
 997        {},
 998};
 999
1000static struct platform_driver artpec6_pmx_driver = {
1001        .driver = {
1002                .name = "artpec6-pinctrl",
1003                .of_match_table = artpec6_pinctrl_match,
1004        },
1005        .probe = artpec6_pmx_probe,
1006        .remove = artpec6_pmx_remove,
1007};
1008
1009static int __init artpec6_pmx_init(void)
1010{
1011        return platform_driver_register(&artpec6_pmx_driver);
1012}
1013arch_initcall(artpec6_pmx_init);
1014