drivers/pinctrl/pinctrl-as3722.c

   1 /*
   2  * ams AS3722 pin control and GPIO driver.
   3  *
   4  * Copyright (c) 2013, NVIDIA Corporation.
   5  *
   6  * Author: Laxman Dewangan <ldewangan@nvidia.com>
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation version 2.
  11  *
  12  * This program is distributed "as is" WITHOUT ANY WARRANTY of any kind,
  13  * whether express or implied; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  15  * General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
  20  * 02111-1307, USA
  21  */
  22
  23 #include <linux/delay.h>
  24 #include <linux/gpio.h>
  25 #include <linux/kernel.h>
  26 #include <linux/module.h>
  27 #include <linux/mfd/as3722.h>
  28 #include <linux/of.h>
  29 #include <linux/of_device.h>
  30 #include <linux/platform_device.h>
  31 #include <linux/pinctrl/consumer.h>
  32 #include <linux/pinctrl/machine.h>
  33 #include <linux/pinctrl/pinctrl.h>
  34 #include <linux/pinctrl/pinconf-generic.h>
  35 #include <linux/pinctrl/pinconf.h>
  36 #include <linux/pinctrl/pinmux.h>
  37 #include <linux/pm.h>
  38 #include <linux/slab.h>
  39
  40 #include "core.h"
  41 #include "pinconf.h"
  42 #include "pinctrl-utils.h"
  43
  44 #define AS3722_PIN_GPIO0                0
  45 #define AS3722_PIN_GPIO1                1
  46 #define AS3722_PIN_GPIO2                2
  47 #define AS3722_PIN_GPIO3                3
  48 #define AS3722_PIN_GPIO4                4
  49 #define AS3722_PIN_GPIO5                5
  50 #define AS3722_PIN_GPIO6                6
  51 #define AS3722_PIN_GPIO7                7
  52 #define AS3722_PIN_NUM                  (AS3722_PIN_GPIO7 + 1)
  53
  54 #define AS3722_GPIO_MODE_PULL_UP           BIT(PIN_CONFIG_BIAS_PULL_UP)
  55 #define AS3722_GPIO_MODE_PULL_DOWN         BIT(PIN_CONFIG_BIAS_PULL_DOWN)
  56 #define AS3722_GPIO_MODE_HIGH_IMPED        BIT(PIN_CONFIG_BIAS_HIGH_IMPEDANCE)
  57 #define AS3722_GPIO_MODE_OPEN_DRAIN        BIT(PIN_CONFIG_DRIVE_OPEN_DRAIN)
  58
  59 struct as3722_pin_function {
  60         const char *name;
  61         const char * const *groups;
  62         unsigned ngroups;
  63         int mux_option;
  64 };
  65
  66 struct as3722_gpio_pin_control {
  67         unsigned mode_prop;
  68         int io_function;
  69 };
  70
  71 struct as3722_pingroup {
  72         const char *name;
  73         const unsigned pins[1];
  74         unsigned npins;
  75 };
  76
  77 struct as3722_pctrl_info {
  78         struct device *dev;
  79         struct pinctrl_dev *pctl;
  80         struct as3722 *as3722;
  81         struct gpio_chip gpio_chip;
  82         int pins_current_opt[AS3722_PIN_NUM];
  83         const struct as3722_pin_function *functions;
  84         unsigned num_functions;
  85         const struct as3722_pingroup *pin_groups;
  86         int num_pin_groups;
  87         const struct pinctrl_pin_desc *pins;
  88         unsigned num_pins;
  89         struct as3722_gpio_pin_control gpio_control[AS3722_PIN_NUM];
  90 };
  91
  92 static const struct pinctrl_pin_desc as3722_pins_desc[] = {
  93         PINCTRL_PIN(AS3722_PIN_GPIO0, "gpio0"),
  94         PINCTRL_PIN(AS3722_PIN_GPIO1, "gpio1"),
  95         PINCTRL_PIN(AS3722_PIN_GPIO2, "gpio2"),
  96         PINCTRL_PIN(AS3722_PIN_GPIO3, "gpio3"),
  97         PINCTRL_PIN(AS3722_PIN_GPIO4, "gpio4"),
  98         PINCTRL_PIN(AS3722_PIN_GPIO5, "gpio5"),
  99         PINCTRL_PIN(AS3722_PIN_GPIO6, "gpio6"),
 100         PINCTRL_PIN(AS3722_PIN_GPIO7, "gpio7"),
 101 };
 102
 103 static const char * const gpio_groups[] = {
 104         "gpio0",
 105         "gpio1",
 106         "gpio2",
 107         "gpio3",
 108         "gpio4",
 109         "gpio5",
 110         "gpio6",
 111         "gpio7",
 112 };
 113
 114 enum as3722_pinmux_option {
 115         AS3722_PINMUX_GPIO                      = 0,
 116         AS3722_PINMUX_INTERRUPT_OUT             = 1,
 117         AS3722_PINMUX_VSUB_VBAT_UNDEB_LOW_OUT   = 2,
 118         AS3722_PINMUX_GPIO_INTERRUPT            = 3,
 119         AS3722_PINMUX_PWM_INPUT                 = 4,
 120         AS3722_PINMUX_VOLTAGE_IN_STBY           = 5,
 121         AS3722_PINMUX_OC_PG_SD0                 = 6,
 122         AS3722_PINMUX_PG_OUT                    = 7,
 123         AS3722_PINMUX_CLK32K_OUT                = 8,
 124         AS3722_PINMUX_WATCHDOG_INPUT            = 9,
 125         AS3722_PINMUX_SOFT_RESET_IN             = 11,
 126         AS3722_PINMUX_PWM_OUTPUT                = 12,
 127         AS3722_PINMUX_VSUB_VBAT_LOW_DEB_OUT     = 13,
 128         AS3722_PINMUX_OC_PG_SD6                 = 14,
 129 };
 130
 131 #define FUNCTION_GROUP(fname, mux)                      \
 132         {                                               \
 133                 .name = #fname,                         \
 134                 .groups = gpio_groups,                  \
 135                 .ngroups = ARRAY_SIZE(gpio_groups),     \
 136                 .mux_option = AS3722_PINMUX_##mux,      \
 137         }
 138
 139 static const struct as3722_pin_function as3722_pin_function[] = {
 140         FUNCTION_GROUP(gpio, GPIO),
 141         FUNCTION_GROUP(interrupt-out, INTERRUPT_OUT),
 142         FUNCTION_GROUP(gpio-in-interrupt, GPIO_INTERRUPT),
 143         FUNCTION_GROUP(vsup-vbat-low-undebounce-out, VSUB_VBAT_UNDEB_LOW_OUT),
 144         FUNCTION_GROUP(vsup-vbat-low-debounce-out, VSUB_VBAT_LOW_DEB_OUT),
 145         FUNCTION_GROUP(voltage-in-standby, VOLTAGE_IN_STBY),
 146         FUNCTION_GROUP(oc-pg-sd0, OC_PG_SD0),
 147         FUNCTION_GROUP(oc-pg-sd6, OC_PG_SD6),
 148         FUNCTION_GROUP(powergood-out, PG_OUT),
 149         FUNCTION_GROUP(pwm-in, PWM_INPUT),
 150         FUNCTION_GROUP(pwm-out, PWM_OUTPUT),
 151         FUNCTION_GROUP(clk32k-out, CLK32K_OUT),
 152         FUNCTION_GROUP(watchdog-in, WATCHDOG_INPUT),
 153         FUNCTION_GROUP(soft-reset-in, SOFT_RESET_IN),
 154 };
 155
 156 #define AS3722_PINGROUP(pg_name, pin_id) \
 157         {                                                               \
 158                 .name = #pg_name,                                       \
 159                 .pins = {AS3722_PIN_##pin_id},                          \
 160                 .npins = 1,                                             \
 161         }
 162
 163 static const struct as3722_pingroup as3722_pingroups[] = {
 164         AS3722_PINGROUP(gpio0,  GPIO0),
 165         AS3722_PINGROUP(gpio1,  GPIO1),
 166         AS3722_PINGROUP(gpio2,  GPIO2),
 167         AS3722_PINGROUP(gpio3,  GPIO3),
 168         AS3722_PINGROUP(gpio4,  GPIO4),
 169         AS3722_PINGROUP(gpio5,  GPIO5),
 170         AS3722_PINGROUP(gpio6,  GPIO6),
 171         AS3722_PINGROUP(gpio7,  GPIO7),
 172 };
 173
 174 static int as3722_pinctrl_get_groups_count(struct pinctrl_dev *pctldev)
 175 {
 176         struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
 177
 178         return as_pci->num_pin_groups;
 179 }
 180
 181 static const char *as3722_pinctrl_get_group_name(struct pinctrl_dev *pctldev,
 182                 unsigned group)
 183 {
 184         struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
 185
 186         return as_pci->pin_groups[group].name;
 187 }
 188
 189 static int as3722_pinctrl_get_group_pins(struct pinctrl_dev *pctldev,
 190                 unsigned group, const unsigned **pins, unsigned *num_pins)
 191 {
 192         struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
 193
 194         *pins = as_pci->pin_groups[group].pins;
 195         *num_pins = as_pci->pin_groups[group].npins;
 196         return 0;
 197 }
 198
 199 static const struct pinctrl_ops as3722_pinctrl_ops = {
 200         .get_groups_count = as3722_pinctrl_get_groups_count,
 201         .get_group_name = as3722_pinctrl_get_group_name,
 202         .get_group_pins = as3722_pinctrl_get_group_pins,
 203         .dt_node_to_map = pinconf_generic_dt_node_to_map_pin,
 204         .dt_free_map = pinctrl_utils_dt_free_map,
 205 };
 206
 207 static int as3722_pinctrl_get_funcs_count(struct pinctrl_dev *pctldev)
 208 {
 209         struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
 210
 211         return as_pci->num_functions;
 212 }
 213
 214 static const char *as3722_pinctrl_get_func_name(struct pinctrl_dev *pctldev,
 215                         unsigned function)
 216 {
 217         struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
 218
 219         return as_pci->functions[function].name;
 220 }
 221
 222 static int as3722_pinctrl_get_func_groups(struct pinctrl_dev *pctldev,
 223                 unsigned function, const char * const **groups,
 224                 unsigned * const num_groups)
 225 {
 226         struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
 227
 228         *groups = as_pci->functions[function].groups;
 229         *num_groups = as_pci->functions[function].ngroups;
 230         return 0;
 231 }
 232
 233 static int as3722_pinctrl_set(struct pinctrl_dev *pctldev, unsigned function,
 234                 unsigned group)
 235 {
 236         struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
 237         int gpio_cntr_reg = AS3722_GPIOn_CONTROL_REG(group);
 238         u8 val = AS3722_GPIO_IOSF_VAL(as_pci->functions[function].mux_option);
 239         int ret;
 240
 241         dev_dbg(as_pci->dev, "%s(): GPIO %u pin to function %u and val %u\n",
 242                 __func__, group, function, val);
 243
 244         ret = as3722_update_bits(as_pci->as3722, gpio_cntr_reg,
 245                         AS3722_GPIO_IOSF_MASK, val);
 246         if (ret < 0) {
 247                 dev_err(as_pci->dev, "GPIO%d_CTRL_REG update failed %d\n",
 248                         group, ret);
 249                 return ret;
 250         }
 251         as_pci->gpio_control[group].io_function = function;
 252
 253         switch (val) {
 254         case AS3722_GPIO_IOSF_SD0_OUT:
 255         case AS3722_GPIO_IOSF_PWR_GOOD_OUT:
 256         case AS3722_GPIO_IOSF_Q32K_OUT:
 257         case AS3722_GPIO_IOSF_PWM_OUT:
 258         case AS3722_GPIO_IOSF_SD6_LOW_VOLT_LOW:
 259                 ret = as3722_update_bits(as_pci->as3722, gpio_cntr_reg,
 260                         AS3722_GPIO_MODE_MASK, AS3722_GPIO_MODE_OUTPUT_VDDH);
 261                 if (ret < 0) {
 262                         dev_err(as_pci->dev, "GPIO%d_CTRL update failed %d\n",
 263                                 group, ret);
 264                         return ret;
 265                 }
 266                 as_pci->gpio_control[group].mode_prop =
 267                                 AS3722_GPIO_MODE_OUTPUT_VDDH;
 268                 break;
 269         default:
 270                 break;
 271         }
 272         return ret;
 273 }
 274
 275 static int as3722_pinctrl_gpio_get_mode(unsigned gpio_mode_prop, bool input)
 276 {
 277         if (gpio_mode_prop & AS3722_GPIO_MODE_HIGH_IMPED)
 278                 return -EINVAL;
 279
 280         if (gpio_mode_prop & AS3722_GPIO_MODE_OPEN_DRAIN) {
 281                 if (gpio_mode_prop & AS3722_GPIO_MODE_PULL_UP)
 282                         return AS3722_GPIO_MODE_IO_OPEN_DRAIN_PULL_UP;
 283                 return AS3722_GPIO_MODE_IO_OPEN_DRAIN;
 284         }
 285         if (input) {
 286                 if (gpio_mode_prop & AS3722_GPIO_MODE_PULL_UP)
 287                         return AS3722_GPIO_MODE_INPUT_PULL_UP;
 288                 else if (gpio_mode_prop & AS3722_GPIO_MODE_PULL_DOWN)
 289                         return AS3722_GPIO_MODE_INPUT_PULL_DOWN;
 290                 return AS3722_GPIO_MODE_INPUT;
 291         }
 292         if (gpio_mode_prop & AS3722_GPIO_MODE_PULL_DOWN)
 293                 return AS3722_GPIO_MODE_OUTPUT_VDDL;
 294         return AS3722_GPIO_MODE_OUTPUT_VDDH;
 295 }
 296
 297 static int as3722_pinctrl_gpio_request_enable(struct pinctrl_dev *pctldev,
 298                 struct pinctrl_gpio_range *range, unsigned offset)
 299 {
 300         struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
 301
 302         if (as_pci->gpio_control[offset].io_function)
 303                 return -EBUSY;
 304         return 0;
 305 }
 306
 307 static int as3722_pinctrl_gpio_set_direction(struct pinctrl_dev *pctldev,
 308                 struct pinctrl_gpio_range *range, unsigned offset, bool input)
 309 {
 310         struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
 311         struct as3722 *as3722 = as_pci->as3722;
 312         int mode;
 313
 314         mode = as3722_pinctrl_gpio_get_mode(
 315                         as_pci->gpio_control[offset].mode_prop, input);
 316         if (mode < 0) {
 317                 dev_err(as_pci->dev, "%s direction for GPIO %d not supported\n",
 318                         (input) ? "Input" : "Output", offset);
 319                 return mode;
 320         }
 321
 322         return as3722_update_bits(as3722, AS3722_GPIOn_CONTROL_REG(offset),
 323                                 AS3722_GPIO_MODE_MASK, mode);
 324 }
 325
 326 static const struct pinmux_ops as3722_pinmux_ops = {
 327         .get_functions_count    = as3722_pinctrl_get_funcs_count,
 328         .get_function_name      = as3722_pinctrl_get_func_name,
 329         .get_function_groups    = as3722_pinctrl_get_func_groups,
 330         .set_mux                = as3722_pinctrl_set,
 331         .gpio_request_enable    = as3722_pinctrl_gpio_request_enable,
 332         .gpio_set_direction     = as3722_pinctrl_gpio_set_direction,
 333 };
 334
 335 static int as3722_pinconf_get(struct pinctrl_dev *pctldev,
 336                         unsigned pin, unsigned long *config)
 337 {
 338         struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
 339         enum pin_config_param param = pinconf_to_config_param(*config);
 340         int arg = 0;
 341         u16 prop;
 342
 343         switch (param) {
 344         case PIN_CONFIG_BIAS_DISABLE:
 345                 prop = AS3722_GPIO_MODE_PULL_UP |
 346                                 AS3722_GPIO_MODE_PULL_DOWN;
 347                 if (!(as_pci->gpio_control[pin].mode_prop & prop))
 348                         arg = 1;
 349                 prop = 0;
 350                 break;
 351
 352         case PIN_CONFIG_BIAS_PULL_UP:
 353                 prop = AS3722_GPIO_MODE_PULL_UP;
 354                 break;
 355
 356         case PIN_CONFIG_BIAS_PULL_DOWN:
 357                 prop = AS3722_GPIO_MODE_PULL_DOWN;
 358                 break;
 359
 360         case PIN_CONFIG_DRIVE_OPEN_DRAIN:
 361                 prop = AS3722_GPIO_MODE_OPEN_DRAIN;
 362                 break;
 363
 364         case PIN_CONFIG_BIAS_HIGH_IMPEDANCE:
 365                 prop = AS3722_GPIO_MODE_HIGH_IMPED;
 366                 break;
 367
 368         default:
 369                 dev_err(as_pci->dev, "Properties not supported\n");
 370                 return -ENOTSUPP;
 371         }
 372
 373         if (as_pci->gpio_control[pin].mode_prop & prop)
 374                 arg = 1;
 375
 376         *config = pinconf_to_config_packed(param, (u16)arg);
 377         return 0;
 378 }
 379
 380 static int as3722_pinconf_set(struct pinctrl_dev *pctldev,
 381                         unsigned pin, unsigned long *configs,
 382                         unsigned num_configs)
 383 {
 384         struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
 385         enum pin_config_param param;
 386         int mode_prop;
 387         int i;
 388
 389         for (i = 0; i < num_configs; i++) {
 390                 param = pinconf_to_config_param(configs[i]);
 391                 mode_prop = as_pci->gpio_control[pin].mode_prop;
 392
 393                 switch (param) {
 394                 case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT:
 395                         break;
 396
 397                 case PIN_CONFIG_BIAS_DISABLE:
 398                         mode_prop &= ~(AS3722_GPIO_MODE_PULL_UP |
 399                                         AS3722_GPIO_MODE_PULL_DOWN);
 400                         break;
 401                 case PIN_CONFIG_BIAS_PULL_UP:
 402                         mode_prop |= AS3722_GPIO_MODE_PULL_UP;
 403                         break;
 404
 405                 case PIN_CONFIG_BIAS_PULL_DOWN:
 406                         mode_prop |= AS3722_GPIO_MODE_PULL_DOWN;
 407                         break;
 408
 409                 case PIN_CONFIG_BIAS_HIGH_IMPEDANCE:
 410                         mode_prop |= AS3722_GPIO_MODE_HIGH_IMPED;
 411                         break;
 412
 413                 case PIN_CONFIG_DRIVE_OPEN_DRAIN:
 414                         mode_prop |= AS3722_GPIO_MODE_OPEN_DRAIN;
 415                         break;
 416
 417                 default:
 418                         dev_err(as_pci->dev, "Properties not supported\n");
 419                         return -ENOTSUPP;
 420                 }
 421
 422                 as_pci->gpio_control[pin].mode_prop = mode_prop;
 423         }
 424         return 0;
 425 }
 426
 427 static const struct pinconf_ops as3722_pinconf_ops = {
 428         .pin_config_get = as3722_pinconf_get,
 429         .pin_config_set = as3722_pinconf_set,
 430 };
 431
 432 static struct pinctrl_desc as3722_pinctrl_desc = {
 433         .pctlops = &as3722_pinctrl_ops,
 434         .pmxops = &as3722_pinmux_ops,
 435         .confops = &as3722_pinconf_ops,
 436         .owner = THIS_MODULE,
 437 };
 438
 439 static int as3722_gpio_get(struct gpio_chip *chip, unsigned offset)
 440 {
 441         struct as3722_pctrl_info *as_pci = gpiochip_get_data(chip);
 442         struct as3722 *as3722 = as_pci->as3722;
 443         int ret;
 444         u32 reg;
 445         u32 control;
 446         u32 val;
 447         int mode;
 448         int invert_enable;
 449
 450         ret = as3722_read(as3722, AS3722_GPIOn_CONTROL_REG(offset), &control);
 451         if (ret < 0) {
 452                 dev_err(as_pci->dev,
 453                         "GPIO_CONTROL%d_REG read failed: %d\n", offset, ret);
 454                 return ret;
 455         }
 456
 457         invert_enable = !!(control & AS3722_GPIO_INV);
 458         mode = control & AS3722_GPIO_MODE_MASK;
 459         switch (mode) {
 460         case AS3722_GPIO_MODE_INPUT:
 461         case AS3722_GPIO_MODE_INPUT_PULL_UP:
 462         case AS3722_GPIO_MODE_INPUT_PULL_DOWN:
 463         case AS3722_GPIO_MODE_IO_OPEN_DRAIN:
 464         case AS3722_GPIO_MODE_IO_OPEN_DRAIN_PULL_UP:
 465                 reg = AS3722_GPIO_SIGNAL_IN_REG;
 466                 break;
 467         case AS3722_GPIO_MODE_OUTPUT_VDDH:
 468         case AS3722_GPIO_MODE_OUTPUT_VDDL:
 469                 reg = AS3722_GPIO_SIGNAL_OUT_REG;
 470                 break;
 471         default:
 472                 return -EINVAL;
 473         }
 474
 475         ret = as3722_read(as3722, reg, &val);
 476         if (ret < 0) {
 477                 dev_err(as_pci->dev,
 478                         "GPIO_SIGNAL_IN_REG read failed: %d\n", ret);
 479                 return ret;
 480         }
 481
 482         val = !!(val & AS3722_GPIOn_SIGNAL(offset));
 483         return (invert_enable) ? !val : val;
 484 }
 485
 486 static void as3722_gpio_set(struct gpio_chip *chip, unsigned offset,
 487                 int value)
 488 {
 489         struct as3722_pctrl_info *as_pci = gpiochip_get_data(chip);
 490         struct as3722 *as3722 = as_pci->as3722;
 491         int en_invert;
 492         u32 val;
 493         int ret;
 494
 495         ret = as3722_read(as3722, AS3722_GPIOn_CONTROL_REG(offset), &val);
 496         if (ret < 0) {
 497                 dev_err(as_pci->dev,
 498                         "GPIO_CONTROL%d_REG read failed: %d\n", offset, ret);
 499                 return;
 500         }
 501         en_invert = !!(val & AS3722_GPIO_INV);
 502
 503         if (value)
 504                 val = (en_invert) ? 0 : AS3722_GPIOn_SIGNAL(offset);
 505         else
 506                 val = (en_invert) ? AS3722_GPIOn_SIGNAL(offset) : 0;
 507
 508         ret = as3722_update_bits(as3722, AS3722_GPIO_SIGNAL_OUT_REG,
 509                         AS3722_GPIOn_SIGNAL(offset), val);
 510         if (ret < 0)
 511                 dev_err(as_pci->dev,
 512                         "GPIO_SIGNAL_OUT_REG update failed: %d\n", ret);
 513 }
 514
 515 static int as3722_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
 516 {
 517         return pinctrl_gpio_direction_input(chip->base + offset);
 518 }
 519
 520 static int as3722_gpio_direction_output(struct gpio_chip *chip,
 521                 unsigned offset, int value)
 522 {
 523         as3722_gpio_set(chip, offset, value);
 524         return pinctrl_gpio_direction_output(chip->base + offset);
 525 }
 526
 527 static int as3722_gpio_to_irq(struct gpio_chip *chip, unsigned offset)
 528 {
 529         struct as3722_pctrl_info *as_pci = gpiochip_get_data(chip);
 530
 531         return as3722_irq_get_virq(as_pci->as3722, offset);
 532 }
 533
 534 static const struct gpio_chip as3722_gpio_chip = {
 535         .label                  = "as3722-gpio",
 536         .owner                  = THIS_MODULE,
 537         .request                = gpiochip_generic_request,
 538         .free                   = gpiochip_generic_free,
 539         .get                    = as3722_gpio_get,
 540         .set                    = as3722_gpio_set,
 541         .direction_input        = as3722_gpio_direction_input,
 542         .direction_output       = as3722_gpio_direction_output,
 543         .to_irq                 = as3722_gpio_to_irq,
 544         .can_sleep              = true,
 545         .ngpio                  = AS3722_PIN_NUM,
 546         .base                   = -1,
 547 };
 548
 549 static int as3722_pinctrl_probe(struct platform_device *pdev)
 550 {
 551         struct as3722_pctrl_info *as_pci;
 552         int ret;
 553
 554         as_pci = devm_kzalloc(&pdev->dev, sizeof(*as_pci), GFP_KERNEL);
 555         if (!as_pci)
 556                 return -ENOMEM;
 557
 558         as_pci->dev = &pdev->dev;
 559         as_pci->dev->of_node = pdev->dev.parent->of_node;
 560         as_pci->as3722 = dev_get_drvdata(pdev->dev.parent);
 561         platform_set_drvdata(pdev, as_pci);
 562
 563         as_pci->pins = as3722_pins_desc;
 564         as_pci->num_pins = ARRAY_SIZE(as3722_pins_desc);
 565         as_pci->functions = as3722_pin_function;
 566         as_pci->num_functions = ARRAY_SIZE(as3722_pin_function);
 567         as_pci->pin_groups = as3722_pingroups;
 568         as_pci->num_pin_groups = ARRAY_SIZE(as3722_pingroups);
 569         as3722_pinctrl_desc.name = dev_name(&pdev->dev);
 570         as3722_pinctrl_desc.pins = as3722_pins_desc;
 571         as3722_pinctrl_desc.npins = ARRAY_SIZE(as3722_pins_desc);
 572         as_pci->pctl = pinctrl_register(&as3722_pinctrl_desc,
 573                                         &pdev->dev, as_pci);
 574         if (IS_ERR(as_pci->pctl)) {
 575                 dev_err(&pdev->dev, "Couldn't register pinctrl driver\n");
 576                 return PTR_ERR(as_pci->pctl);
 577         }
 578
 579         as_pci->gpio_chip = as3722_gpio_chip;
 580         as_pci->gpio_chip.parent = &pdev->dev;
 581         as_pci->gpio_chip.of_node = pdev->dev.parent->of_node;
 582         ret = gpiochip_add_data(&as_pci->gpio_chip, as_pci);
 583         if (ret < 0) {
 584                 dev_err(&pdev->dev, "Couldn't register gpiochip, %d\n", ret);
 585                 goto fail_chip_add;
 586         }
 587
 588         ret = gpiochip_add_pin_range(&as_pci->gpio_chip, dev_name(&pdev->dev),
 589                                 0, 0, AS3722_PIN_NUM);
 590         if (ret < 0) {
 591                 dev_err(&pdev->dev, "Couldn't add pin range, %d\n", ret);
 592                 goto fail_range_add;
 593         }
 594
 595         return 0;
 596
 597 fail_range_add:
 598         gpiochip_remove(&as_pci->gpio_chip);
 599 fail_chip_add:
 600         pinctrl_unregister(as_pci->pctl);
 601         return ret;
 602 }
 603
 604 static int as3722_pinctrl_remove(struct platform_device *pdev)
 605 {
 606         struct as3722_pctrl_info *as_pci = platform_get_drvdata(pdev);
 607
 608         gpiochip_remove(&as_pci->gpio_chip);
 609         pinctrl_unregister(as_pci->pctl);
 610         return 0;
 611 }
 612
 613 static const struct of_device_id as3722_pinctrl_of_match[] = {
 614         { .compatible = "ams,as3722-pinctrl", },
 615         { },
 616 };
 617 MODULE_DEVICE_TABLE(of, as3722_pinctrl_of_match);
 618
 619 static struct platform_driver as3722_pinctrl_driver = {
 620         .driver = {
 621                 .name = "as3722-pinctrl",
 622                 .of_match_table = as3722_pinctrl_of_match,
 623         },
 624         .probe = as3722_pinctrl_probe,
 625         .remove = as3722_pinctrl_remove,
 626 };
 627 module_platform_driver(as3722_pinctrl_driver);
 628
 629 MODULE_ALIAS("platform:as3722-pinctrl");
 630 MODULE_DESCRIPTION("AS3722 pin control and GPIO driver");
 631 MODULE_AUTHOR("Laxman Dewangan<ldewangan@nvidia.com>");
 632 MODULE_LICENSE("GPL v2");