| // SPDX-License-Identifier: GPL-2.0 |
| // |
| // Copyright (C) 2026 Linaro Inc. |
| // Author: AKASHI takahiro <takahiro.akashi@linaro.org> |
| |
| #include <linux/errno.h> |
| #include <linux/gpio/driver.h> |
| #include <linux/mod_devicetable.h> |
| #include <linux/module.h> |
| #include <linux/pinctrl/consumer.h> |
| #include <linux/platform_device.h> |
| #include <linux/types.h> |
| |
| #include "gpiolib.h" |
| |
| static int pin_control_gpio_get_direction(struct gpio_chip *gc, unsigned int offset) |
| { |
| unsigned long config; |
| int ret; |
| |
| config = PIN_CONFIG_OUTPUT_ENABLE; |
| ret = pinctrl_gpio_get_config(gc, offset, &config); |
| if (ret) |
| return ret; |
| if (config) |
| return GPIO_LINE_DIRECTION_OUT; |
| |
| return GPIO_LINE_DIRECTION_IN; |
| } |
| |
| static int pin_control_gpio_direction_output(struct gpio_chip *chip, |
| unsigned int offset, int val) |
| { |
| return pinctrl_gpio_direction_output(chip, offset); |
| } |
| |
| static int pin_control_gpio_get(struct gpio_chip *chip, unsigned int offset) |
| { |
| unsigned long config; |
| int ret; |
| |
| config = PIN_CONFIG_LEVEL; |
| ret = pinctrl_gpio_get_config(chip, offset, &config); |
| if (ret) |
| return ret; |
| |
| return !!config; |
| } |
| |
| static int pin_control_gpio_set(struct gpio_chip *chip, unsigned int offset, |
| int val) |
| { |
| unsigned long config; |
| |
| config = pinconf_to_config_packed(PIN_CONFIG_LEVEL, val); |
| return pinctrl_gpio_set_config(chip, offset, config); |
| } |
| |
| static int pin_control_gpio_probe(struct platform_device *pdev) |
| { |
| struct device *dev = &pdev->dev; |
| struct gpio_chip *chip; |
| |
| chip = devm_kzalloc(dev, sizeof(*chip), GFP_KERNEL); |
| if (!chip) |
| return -ENOMEM; |
| |
| chip->label = dev_name(dev); |
| chip->parent = dev; |
| chip->base = -1; |
| |
| chip->request = gpiochip_generic_request; |
| chip->free = gpiochip_generic_free; |
| chip->get_direction = pin_control_gpio_get_direction; |
| chip->direction_input = pinctrl_gpio_direction_input; |
| chip->direction_output = pin_control_gpio_direction_output; |
| chip->get = pin_control_gpio_get; |
| chip->set = pin_control_gpio_set; |
| chip->set_config = gpiochip_generic_config; |
| |
| return devm_gpiochip_add_data(dev, chip, NULL); |
| } |
| |
| static const struct of_device_id pin_control_gpio_match[] = { |
| { .compatible = "scmi-pinctrl-gpio" }, |
| { /* sentinel */ } |
| }; |
| MODULE_DEVICE_TABLE(of, pin_control_gpio_match); |
| |
| static struct platform_driver pin_control_gpio_driver = { |
| .probe = pin_control_gpio_probe, |
| .driver = { |
| .name = "pin-control-gpio", |
| .of_match_table = pin_control_gpio_match, |
| }, |
| }; |
| module_platform_driver(pin_control_gpio_driver); |
| |
| MODULE_AUTHOR("AKASHI Takahiro <takahiro.akashi@linaro.org>"); |
| MODULE_DESCRIPTION("Pinctrl based GPIO driver"); |
| MODULE_LICENSE("GPL"); |