123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637 |
- /*
- * ams AS3722 pin control and GPIO driver.
- *
- * Copyright (c) 2013, NVIDIA Corporation.
- *
- * Author: Laxman Dewangan <ldewangan@nvidia.com>
- *
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License as
- * published by the Free Software Foundation version 2.
- *
- * This program is distributed "as is" WITHOUT ANY WARRANTY of any kind,
- * whether express or implied; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
- * General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
- * 02111-1307, USA
- */
- #include <linux/delay.h>
- #include <linux/gpio.h>
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/mfd/as3722.h>
- #include <linux/of.h>
- #include <linux/of_device.h>
- #include <linux/platform_device.h>
- #include <linux/pinctrl/consumer.h>
- #include <linux/pinctrl/machine.h>
- #include <linux/pinctrl/pinctrl.h>
- #include <linux/pinctrl/pinconf-generic.h>
- #include <linux/pinctrl/pinconf.h>
- #include <linux/pinctrl/pinmux.h>
- #include <linux/pm.h>
- #include <linux/slab.h>
- #include "core.h"
- #include "pinconf.h"
- #include "pinctrl-utils.h"
- #define AS3722_PIN_GPIO0 0
- #define AS3722_PIN_GPIO1 1
- #define AS3722_PIN_GPIO2 2
- #define AS3722_PIN_GPIO3 3
- #define AS3722_PIN_GPIO4 4
- #define AS3722_PIN_GPIO5 5
- #define AS3722_PIN_GPIO6 6
- #define AS3722_PIN_GPIO7 7
- #define AS3722_PIN_NUM (AS3722_PIN_GPIO7 + 1)
- #define AS3722_GPIO_MODE_PULL_UP BIT(PIN_CONFIG_BIAS_PULL_UP)
- #define AS3722_GPIO_MODE_PULL_DOWN BIT(PIN_CONFIG_BIAS_PULL_DOWN)
- #define AS3722_GPIO_MODE_HIGH_IMPED BIT(PIN_CONFIG_BIAS_HIGH_IMPEDANCE)
- #define AS3722_GPIO_MODE_OPEN_DRAIN BIT(PIN_CONFIG_DRIVE_OPEN_DRAIN)
- struct as3722_pin_function {
- const char *name;
- const char * const *groups;
- unsigned ngroups;
- int mux_option;
- };
- struct as3722_gpio_pin_control {
- unsigned mode_prop;
- int io_function;
- };
- struct as3722_pingroup {
- const char *name;
- const unsigned pins[1];
- unsigned npins;
- };
- struct as3722_pctrl_info {
- struct device *dev;
- struct pinctrl_dev *pctl;
- struct as3722 *as3722;
- struct gpio_chip gpio_chip;
- int pins_current_opt[AS3722_PIN_NUM];
- const struct as3722_pin_function *functions;
- unsigned num_functions;
- const struct as3722_pingroup *pin_groups;
- int num_pin_groups;
- const struct pinctrl_pin_desc *pins;
- unsigned num_pins;
- struct as3722_gpio_pin_control gpio_control[AS3722_PIN_NUM];
- };
- static const struct pinctrl_pin_desc as3722_pins_desc[] = {
- PINCTRL_PIN(AS3722_PIN_GPIO0, "gpio0"),
- PINCTRL_PIN(AS3722_PIN_GPIO1, "gpio1"),
- PINCTRL_PIN(AS3722_PIN_GPIO2, "gpio2"),
- PINCTRL_PIN(AS3722_PIN_GPIO3, "gpio3"),
- PINCTRL_PIN(AS3722_PIN_GPIO4, "gpio4"),
- PINCTRL_PIN(AS3722_PIN_GPIO5, "gpio5"),
- PINCTRL_PIN(AS3722_PIN_GPIO6, "gpio6"),
- PINCTRL_PIN(AS3722_PIN_GPIO7, "gpio7"),
- };
- static const char * const gpio_groups[] = {
- "gpio0",
- "gpio1",
- "gpio2",
- "gpio3",
- "gpio4",
- "gpio5",
- "gpio6",
- "gpio7",
- };
- enum as3722_pinmux_option {
- AS3722_PINMUX_GPIO = 0,
- AS3722_PINMUX_INTERRUPT_OUT = 1,
- AS3722_PINMUX_VSUB_VBAT_UNDEB_LOW_OUT = 2,
- AS3722_PINMUX_GPIO_INTERRUPT = 3,
- AS3722_PINMUX_PWM_INPUT = 4,
- AS3722_PINMUX_VOLTAGE_IN_STBY = 5,
- AS3722_PINMUX_OC_PG_SD0 = 6,
- AS3722_PINMUX_PG_OUT = 7,
- AS3722_PINMUX_CLK32K_OUT = 8,
- AS3722_PINMUX_WATCHDOG_INPUT = 9,
- AS3722_PINMUX_SOFT_RESET_IN = 11,
- AS3722_PINMUX_PWM_OUTPUT = 12,
- AS3722_PINMUX_VSUB_VBAT_LOW_DEB_OUT = 13,
- AS3722_PINMUX_OC_PG_SD6 = 14,
- };
- #define FUNCTION_GROUP(fname, mux) \
- { \
- .name = #fname, \
- .groups = gpio_groups, \
- .ngroups = ARRAY_SIZE(gpio_groups), \
- .mux_option = AS3722_PINMUX_##mux, \
- }
- static const struct as3722_pin_function as3722_pin_function[] = {
- FUNCTION_GROUP(gpio, GPIO),
- FUNCTION_GROUP(interrupt-out, INTERRUPT_OUT),
- FUNCTION_GROUP(gpio-in-interrupt, GPIO_INTERRUPT),
- FUNCTION_GROUP(vsup-vbat-low-undebounce-out, VSUB_VBAT_UNDEB_LOW_OUT),
- FUNCTION_GROUP(vsup-vbat-low-debounce-out, VSUB_VBAT_LOW_DEB_OUT),
- FUNCTION_GROUP(voltage-in-standby, VOLTAGE_IN_STBY),
- FUNCTION_GROUP(oc-pg-sd0, OC_PG_SD0),
- FUNCTION_GROUP(oc-pg-sd6, OC_PG_SD6),
- FUNCTION_GROUP(powergood-out, PG_OUT),
- FUNCTION_GROUP(pwm-in, PWM_INPUT),
- FUNCTION_GROUP(pwm-out, PWM_OUTPUT),
- FUNCTION_GROUP(clk32k-out, CLK32K_OUT),
- FUNCTION_GROUP(watchdog-in, WATCHDOG_INPUT),
- FUNCTION_GROUP(soft-reset-in, SOFT_RESET_IN),
- };
- #define AS3722_PINGROUP(pg_name, pin_id) \
- { \
- .name = #pg_name, \
- .pins = {AS3722_PIN_##pin_id}, \
- .npins = 1, \
- }
- static const struct as3722_pingroup as3722_pingroups[] = {
- AS3722_PINGROUP(gpio0, GPIO0),
- AS3722_PINGROUP(gpio1, GPIO1),
- AS3722_PINGROUP(gpio2, GPIO2),
- AS3722_PINGROUP(gpio3, GPIO3),
- AS3722_PINGROUP(gpio4, GPIO4),
- AS3722_PINGROUP(gpio5, GPIO5),
- AS3722_PINGROUP(gpio6, GPIO6),
- AS3722_PINGROUP(gpio7, GPIO7),
- };
- static int as3722_pinctrl_get_groups_count(struct pinctrl_dev *pctldev)
- {
- struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
- return as_pci->num_pin_groups;
- }
- static const char *as3722_pinctrl_get_group_name(struct pinctrl_dev *pctldev,
- unsigned group)
- {
- struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
- return as_pci->pin_groups[group].name;
- }
- static int as3722_pinctrl_get_group_pins(struct pinctrl_dev *pctldev,
- unsigned group, const unsigned **pins, unsigned *num_pins)
- {
- struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
- *pins = as_pci->pin_groups[group].pins;
- *num_pins = as_pci->pin_groups[group].npins;
- return 0;
- }
- static const struct pinctrl_ops as3722_pinctrl_ops = {
- .get_groups_count = as3722_pinctrl_get_groups_count,
- .get_group_name = as3722_pinctrl_get_group_name,
- .get_group_pins = as3722_pinctrl_get_group_pins,
- .dt_node_to_map = pinconf_generic_dt_node_to_map_pin,
- .dt_free_map = pinctrl_utils_dt_free_map,
- };
- static int as3722_pinctrl_get_funcs_count(struct pinctrl_dev *pctldev)
- {
- struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
- return as_pci->num_functions;
- }
- static const char *as3722_pinctrl_get_func_name(struct pinctrl_dev *pctldev,
- unsigned function)
- {
- struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
- return as_pci->functions[function].name;
- }
- static int as3722_pinctrl_get_func_groups(struct pinctrl_dev *pctldev,
- unsigned function, const char * const **groups,
- unsigned * const num_groups)
- {
- struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
- *groups = as_pci->functions[function].groups;
- *num_groups = as_pci->functions[function].ngroups;
- return 0;
- }
- static int as3722_pinctrl_set(struct pinctrl_dev *pctldev, unsigned function,
- unsigned group)
- {
- struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
- int gpio_cntr_reg = AS3722_GPIOn_CONTROL_REG(group);
- u8 val = AS3722_GPIO_IOSF_VAL(as_pci->functions[function].mux_option);
- int ret;
- dev_dbg(as_pci->dev, "%s(): GPIO %u pin to function %u and val %u\n",
- __func__, group, function, val);
- ret = as3722_update_bits(as_pci->as3722, gpio_cntr_reg,
- AS3722_GPIO_IOSF_MASK, val);
- if (ret < 0) {
- dev_err(as_pci->dev, "GPIO%d_CTRL_REG update failed %d\n",
- group, ret);
- return ret;
- }
- as_pci->gpio_control[group].io_function = function;
- switch (val) {
- case AS3722_GPIO_IOSF_SD0_OUT:
- case AS3722_GPIO_IOSF_PWR_GOOD_OUT:
- case AS3722_GPIO_IOSF_Q32K_OUT:
- case AS3722_GPIO_IOSF_PWM_OUT:
- case AS3722_GPIO_IOSF_SD6_LOW_VOLT_LOW:
- ret = as3722_update_bits(as_pci->as3722, gpio_cntr_reg,
- AS3722_GPIO_MODE_MASK, AS3722_GPIO_MODE_OUTPUT_VDDH);
- if (ret < 0) {
- dev_err(as_pci->dev, "GPIO%d_CTRL update failed %d\n",
- group, ret);
- return ret;
- }
- as_pci->gpio_control[group].mode_prop =
- AS3722_GPIO_MODE_OUTPUT_VDDH;
- break;
- default:
- break;
- }
- return ret;
- }
- static int as3722_pinctrl_gpio_get_mode(unsigned gpio_mode_prop, bool input)
- {
- if (gpio_mode_prop & AS3722_GPIO_MODE_HIGH_IMPED)
- return -EINVAL;
- if (gpio_mode_prop & AS3722_GPIO_MODE_OPEN_DRAIN) {
- if (gpio_mode_prop & AS3722_GPIO_MODE_PULL_UP)
- return AS3722_GPIO_MODE_IO_OPEN_DRAIN_PULL_UP;
- return AS3722_GPIO_MODE_IO_OPEN_DRAIN;
- }
- if (input) {
- if (gpio_mode_prop & AS3722_GPIO_MODE_PULL_UP)
- return AS3722_GPIO_MODE_INPUT_PULL_UP;
- else if (gpio_mode_prop & AS3722_GPIO_MODE_PULL_DOWN)
- return AS3722_GPIO_MODE_INPUT_PULL_DOWN;
- return AS3722_GPIO_MODE_INPUT;
- }
- if (gpio_mode_prop & AS3722_GPIO_MODE_PULL_DOWN)
- return AS3722_GPIO_MODE_OUTPUT_VDDL;
- return AS3722_GPIO_MODE_OUTPUT_VDDH;
- }
- static int as3722_pinctrl_gpio_request_enable(struct pinctrl_dev *pctldev,
- struct pinctrl_gpio_range *range, unsigned offset)
- {
- struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
- if (as_pci->gpio_control[offset].io_function)
- return -EBUSY;
- return 0;
- }
- static int as3722_pinctrl_gpio_set_direction(struct pinctrl_dev *pctldev,
- struct pinctrl_gpio_range *range, unsigned offset, bool input)
- {
- struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
- struct as3722 *as3722 = as_pci->as3722;
- int mode;
- mode = as3722_pinctrl_gpio_get_mode(
- as_pci->gpio_control[offset].mode_prop, input);
- if (mode < 0) {
- dev_err(as_pci->dev, "%s direction for GPIO %d not supported\n",
- (input) ? "Input" : "Output", offset);
- return mode;
- }
- return as3722_update_bits(as3722, AS3722_GPIOn_CONTROL_REG(offset),
- AS3722_GPIO_MODE_MASK, mode);
- }
- static const struct pinmux_ops as3722_pinmux_ops = {
- .get_functions_count = as3722_pinctrl_get_funcs_count,
- .get_function_name = as3722_pinctrl_get_func_name,
- .get_function_groups = as3722_pinctrl_get_func_groups,
- .set_mux = as3722_pinctrl_set,
- .gpio_request_enable = as3722_pinctrl_gpio_request_enable,
- .gpio_set_direction = as3722_pinctrl_gpio_set_direction,
- };
- static int as3722_pinconf_get(struct pinctrl_dev *pctldev,
- unsigned pin, unsigned long *config)
- {
- struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
- enum pin_config_param param = pinconf_to_config_param(*config);
- int arg = 0;
- u16 prop;
- switch (param) {
- case PIN_CONFIG_BIAS_DISABLE:
- prop = AS3722_GPIO_MODE_PULL_UP |
- AS3722_GPIO_MODE_PULL_DOWN;
- if (!(as_pci->gpio_control[pin].mode_prop & prop))
- arg = 1;
- prop = 0;
- break;
- case PIN_CONFIG_BIAS_PULL_UP:
- prop = AS3722_GPIO_MODE_PULL_UP;
- break;
- case PIN_CONFIG_BIAS_PULL_DOWN:
- prop = AS3722_GPIO_MODE_PULL_DOWN;
- break;
- case PIN_CONFIG_DRIVE_OPEN_DRAIN:
- prop = AS3722_GPIO_MODE_OPEN_DRAIN;
- break;
- case PIN_CONFIG_BIAS_HIGH_IMPEDANCE:
- prop = AS3722_GPIO_MODE_HIGH_IMPED;
- break;
- default:
- dev_err(as_pci->dev, "Properties not supported\n");
- return -ENOTSUPP;
- }
- if (as_pci->gpio_control[pin].mode_prop & prop)
- arg = 1;
- *config = pinconf_to_config_packed(param, (u16)arg);
- return 0;
- }
- static int as3722_pinconf_set(struct pinctrl_dev *pctldev,
- unsigned pin, unsigned long *configs,
- unsigned num_configs)
- {
- struct as3722_pctrl_info *as_pci = pinctrl_dev_get_drvdata(pctldev);
- enum pin_config_param param;
- int mode_prop;
- int i;
- for (i = 0; i < num_configs; i++) {
- param = pinconf_to_config_param(configs[i]);
- mode_prop = as_pci->gpio_control[pin].mode_prop;
- switch (param) {
- case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT:
- break;
- case PIN_CONFIG_BIAS_DISABLE:
- mode_prop &= ~(AS3722_GPIO_MODE_PULL_UP |
- AS3722_GPIO_MODE_PULL_DOWN);
- break;
- case PIN_CONFIG_BIAS_PULL_UP:
- mode_prop |= AS3722_GPIO_MODE_PULL_UP;
- break;
- case PIN_CONFIG_BIAS_PULL_DOWN:
- mode_prop |= AS3722_GPIO_MODE_PULL_DOWN;
- break;
- case PIN_CONFIG_BIAS_HIGH_IMPEDANCE:
- mode_prop |= AS3722_GPIO_MODE_HIGH_IMPED;
- break;
- case PIN_CONFIG_DRIVE_OPEN_DRAIN:
- mode_prop |= AS3722_GPIO_MODE_OPEN_DRAIN;
- break;
- default:
- dev_err(as_pci->dev, "Properties not supported\n");
- return -ENOTSUPP;
- }
- as_pci->gpio_control[pin].mode_prop = mode_prop;
- }
- return 0;
- }
- static const struct pinconf_ops as3722_pinconf_ops = {
- .pin_config_get = as3722_pinconf_get,
- .pin_config_set = as3722_pinconf_set,
- };
- static struct pinctrl_desc as3722_pinctrl_desc = {
- .pctlops = &as3722_pinctrl_ops,
- .pmxops = &as3722_pinmux_ops,
- .confops = &as3722_pinconf_ops,
- .owner = THIS_MODULE,
- };
- static inline struct as3722_pctrl_info *to_as_pci(struct gpio_chip *chip)
- {
- return container_of(chip, struct as3722_pctrl_info, gpio_chip);
- }
- static int as3722_gpio_get(struct gpio_chip *chip, unsigned offset)
- {
- struct as3722_pctrl_info *as_pci = to_as_pci(chip);
- struct as3722 *as3722 = as_pci->as3722;
- int ret;
- u32 reg;
- u32 control;
- u32 val;
- int mode;
- int invert_enable;
- ret = as3722_read(as3722, AS3722_GPIOn_CONTROL_REG(offset), &control);
- if (ret < 0) {
- dev_err(as_pci->dev,
- "GPIO_CONTROL%d_REG read failed: %d\n", offset, ret);
- return ret;
- }
- invert_enable = !!(control & AS3722_GPIO_INV);
- mode = control & AS3722_GPIO_MODE_MASK;
- switch (mode) {
- case AS3722_GPIO_MODE_INPUT:
- case AS3722_GPIO_MODE_INPUT_PULL_UP:
- case AS3722_GPIO_MODE_INPUT_PULL_DOWN:
- case AS3722_GPIO_MODE_IO_OPEN_DRAIN:
- case AS3722_GPIO_MODE_IO_OPEN_DRAIN_PULL_UP:
- reg = AS3722_GPIO_SIGNAL_IN_REG;
- break;
- case AS3722_GPIO_MODE_OUTPUT_VDDH:
- case AS3722_GPIO_MODE_OUTPUT_VDDL:
- reg = AS3722_GPIO_SIGNAL_OUT_REG;
- break;
- default:
- return -EINVAL;
- }
- ret = as3722_read(as3722, reg, &val);
- if (ret < 0) {
- dev_err(as_pci->dev,
- "GPIO_SIGNAL_IN_REG read failed: %d\n", ret);
- return ret;
- }
- val = !!(val & AS3722_GPIOn_SIGNAL(offset));
- return (invert_enable) ? !val : val;
- }
- static void as3722_gpio_set(struct gpio_chip *chip, unsigned offset,
- int value)
- {
- struct as3722_pctrl_info *as_pci = to_as_pci(chip);
- struct as3722 *as3722 = as_pci->as3722;
- int en_invert;
- u32 val;
- int ret;
- ret = as3722_read(as3722, AS3722_GPIOn_CONTROL_REG(offset), &val);
- if (ret < 0) {
- dev_err(as_pci->dev,
- "GPIO_CONTROL%d_REG read failed: %d\n", offset, ret);
- return;
- }
- en_invert = !!(val & AS3722_GPIO_INV);
- if (value)
- val = (en_invert) ? 0 : AS3722_GPIOn_SIGNAL(offset);
- else
- val = (en_invert) ? AS3722_GPIOn_SIGNAL(offset) : 0;
- ret = as3722_update_bits(as3722, AS3722_GPIO_SIGNAL_OUT_REG,
- AS3722_GPIOn_SIGNAL(offset), val);
- if (ret < 0)
- dev_err(as_pci->dev,
- "GPIO_SIGNAL_OUT_REG update failed: %d\n", ret);
- }
- static int as3722_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
- {
- return pinctrl_gpio_direction_input(chip->base + offset);
- }
- static int as3722_gpio_direction_output(struct gpio_chip *chip,
- unsigned offset, int value)
- {
- as3722_gpio_set(chip, offset, value);
- return pinctrl_gpio_direction_output(chip->base + offset);
- }
- static int as3722_gpio_to_irq(struct gpio_chip *chip, unsigned offset)
- {
- struct as3722_pctrl_info *as_pci = to_as_pci(chip);
- return as3722_irq_get_virq(as_pci->as3722, offset);
- }
- static const struct gpio_chip as3722_gpio_chip = {
- .label = "as3722-gpio",
- .owner = THIS_MODULE,
- .request = gpiochip_generic_request,
- .free = gpiochip_generic_free,
- .get = as3722_gpio_get,
- .set = as3722_gpio_set,
- .direction_input = as3722_gpio_direction_input,
- .direction_output = as3722_gpio_direction_output,
- .to_irq = as3722_gpio_to_irq,
- .can_sleep = true,
- .ngpio = AS3722_PIN_NUM,
- .base = -1,
- };
- static int as3722_pinctrl_probe(struct platform_device *pdev)
- {
- struct as3722_pctrl_info *as_pci;
- int ret;
- as_pci = devm_kzalloc(&pdev->dev, sizeof(*as_pci), GFP_KERNEL);
- if (!as_pci)
- return -ENOMEM;
- as_pci->dev = &pdev->dev;
- as_pci->dev->of_node = pdev->dev.parent->of_node;
- as_pci->as3722 = dev_get_drvdata(pdev->dev.parent);
- platform_set_drvdata(pdev, as_pci);
- as_pci->pins = as3722_pins_desc;
- as_pci->num_pins = ARRAY_SIZE(as3722_pins_desc);
- as_pci->functions = as3722_pin_function;
- as_pci->num_functions = ARRAY_SIZE(as3722_pin_function);
- as_pci->pin_groups = as3722_pingroups;
- as_pci->num_pin_groups = ARRAY_SIZE(as3722_pingroups);
- as3722_pinctrl_desc.name = dev_name(&pdev->dev);
- as3722_pinctrl_desc.pins = as3722_pins_desc;
- as3722_pinctrl_desc.npins = ARRAY_SIZE(as3722_pins_desc);
- as_pci->pctl = pinctrl_register(&as3722_pinctrl_desc,
- &pdev->dev, as_pci);
- if (IS_ERR(as_pci->pctl)) {
- dev_err(&pdev->dev, "Couldn't register pinctrl driver\n");
- return PTR_ERR(as_pci->pctl);
- }
- as_pci->gpio_chip = as3722_gpio_chip;
- as_pci->gpio_chip.dev = &pdev->dev;
- as_pci->gpio_chip.of_node = pdev->dev.parent->of_node;
- ret = gpiochip_add(&as_pci->gpio_chip);
- if (ret < 0) {
- dev_err(&pdev->dev, "Couldn't register gpiochip, %d\n", ret);
- goto fail_chip_add;
- }
- ret = gpiochip_add_pin_range(&as_pci->gpio_chip, dev_name(&pdev->dev),
- 0, 0, AS3722_PIN_NUM);
- if (ret < 0) {
- dev_err(&pdev->dev, "Couldn't add pin range, %d\n", ret);
- goto fail_range_add;
- }
- return 0;
- fail_range_add:
- gpiochip_remove(&as_pci->gpio_chip);
- fail_chip_add:
- pinctrl_unregister(as_pci->pctl);
- return ret;
- }
- static int as3722_pinctrl_remove(struct platform_device *pdev)
- {
- struct as3722_pctrl_info *as_pci = platform_get_drvdata(pdev);
- gpiochip_remove(&as_pci->gpio_chip);
- pinctrl_unregister(as_pci->pctl);
- return 0;
- }
- static const struct of_device_id as3722_pinctrl_of_match[] = {
- { .compatible = "ams,as3722-pinctrl", },
- { },
- };
- MODULE_DEVICE_TABLE(of, as3722_pinctrl_of_match);
- static struct platform_driver as3722_pinctrl_driver = {
- .driver = {
- .name = "as3722-pinctrl",
- .of_match_table = as3722_pinctrl_of_match,
- },
- .probe = as3722_pinctrl_probe,
- .remove = as3722_pinctrl_remove,
- };
- module_platform_driver(as3722_pinctrl_driver);
- MODULE_ALIAS("platform:as3722-pinctrl");
- MODULE_DESCRIPTION("AS3722 pin control and GPIO driver");
- MODULE_AUTHOR("Laxman Dewangan<ldewangan@nvidia.com>");
- MODULE_LICENSE("GPL v2");
|