linux/drivers/gpio/gpio-usbio.c

249 lines
6.5 KiB
C

// SPDX-License-Identifier: GPL-2.0
/*
* Copyright (c) 2025 Intel Corporation.
* Copyright (c) 2025 Red Hat, Inc.
*/
#include <linux/acpi.h>
#include <linux/auxiliary_bus.h>
#include <linux/cleanup.h>
#include <linux/device.h>
#include <linux/gpio/driver.h>
#include <linux/mutex.h>
#include <linux/types.h>
#include <linux/usb/usbio.h>
struct usbio_gpio_bank {
u8 config[USBIO_GPIOSPERBANK];
u32 bitmap;
};
struct usbio_gpio {
struct mutex config_mutex; /* Protects banks[x].config */
struct usbio_gpio_bank banks[USBIO_MAX_GPIOBANKS];
struct gpio_chip gc;
struct auxiliary_device *adev;
};
static const struct acpi_device_id usbio_gpio_acpi_hids[] = {
{ "INTC1007" }, /* MTL */
{ "INTC10B2" }, /* ARL */
{ "INTC10B5" }, /* LNL */
{ "INTC10D1" }, /* MTL-CVF */
{ "INTC10E2" }, /* PTL */
{ }
};
static void usbio_gpio_get_bank_and_pin(struct gpio_chip *gc, unsigned int offset,
struct usbio_gpio_bank **bank_ret,
unsigned int *pin_ret)
{
struct usbio_gpio *gpio = gpiochip_get_data(gc);
struct device *dev = &gpio->adev->dev;
struct usbio_gpio_bank *bank;
unsigned int pin;
bank = &gpio->banks[offset / USBIO_GPIOSPERBANK];
pin = offset % USBIO_GPIOSPERBANK;
if (~bank->bitmap & BIT(pin)) {
/* The FW bitmap sometimes is invalid, warn and continue */
dev_warn_once(dev, FW_BUG "GPIO %u is not in FW pins bitmap\n", offset);
}
*bank_ret = bank;
*pin_ret = pin;
}
static int usbio_gpio_get_direction(struct gpio_chip *gc, unsigned int offset)
{
struct usbio_gpio_bank *bank;
unsigned int pin;
u8 cfg;
usbio_gpio_get_bank_and_pin(gc, offset, &bank, &pin);
cfg = bank->config[pin] & USBIO_GPIO_PINMOD_MASK;
return (cfg == USBIO_GPIO_PINMOD_OUTPUT) ?
GPIO_LINE_DIRECTION_OUT : GPIO_LINE_DIRECTION_IN;
}
static int usbio_gpio_get(struct gpio_chip *gc, unsigned int offset)
{
struct usbio_gpio *gpio = gpiochip_get_data(gc);
struct usbio_gpio_bank *bank;
struct usbio_gpio_rw gbuf;
unsigned int pin;
int ret;
usbio_gpio_get_bank_and_pin(gc, offset, &bank, &pin);
gbuf.bankid = offset / USBIO_GPIOSPERBANK;
gbuf.pincount = 1;
gbuf.pin = pin;
ret = usbio_control_msg(gpio->adev, USBIO_PKTTYPE_GPIO, USBIO_GPIOCMD_READ,
&gbuf, sizeof(gbuf) - sizeof(gbuf.value),
&gbuf, sizeof(gbuf));
if (ret != sizeof(gbuf))
return (ret < 0) ? ret : -EPROTO;
return (le32_to_cpu(gbuf.value) >> pin) & 1;
}
static int usbio_gpio_set(struct gpio_chip *gc, unsigned int offset, int value)
{
struct usbio_gpio *gpio = gpiochip_get_data(gc);
struct usbio_gpio_bank *bank;
struct usbio_gpio_rw gbuf;
unsigned int pin;
usbio_gpio_get_bank_and_pin(gc, offset, &bank, &pin);
gbuf.bankid = offset / USBIO_GPIOSPERBANK;
gbuf.pincount = 1;
gbuf.pin = pin;
gbuf.value = cpu_to_le32(value << pin);
return usbio_control_msg(gpio->adev, USBIO_PKTTYPE_GPIO, USBIO_GPIOCMD_WRITE,
&gbuf, sizeof(gbuf), NULL, 0);
}
static int usbio_gpio_update_config(struct gpio_chip *gc, unsigned int offset,
u8 mask, u8 value)
{
struct usbio_gpio *gpio = gpiochip_get_data(gc);
struct usbio_gpio_bank *bank;
struct usbio_gpio_init gbuf;
unsigned int pin;
usbio_gpio_get_bank_and_pin(gc, offset, &bank, &pin);
guard(mutex)(&gpio->config_mutex);
bank->config[pin] &= ~mask;
bank->config[pin] |= value;
gbuf.bankid = offset / USBIO_GPIOSPERBANK;
gbuf.config = bank->config[pin];
gbuf.pincount = 1;
gbuf.pin = pin;
return usbio_control_msg(gpio->adev, USBIO_PKTTYPE_GPIO, USBIO_GPIOCMD_INIT,
&gbuf, sizeof(gbuf), NULL, 0);
}
static int usbio_gpio_direction_input(struct gpio_chip *gc, unsigned int offset)
{
return usbio_gpio_update_config(gc, offset, USBIO_GPIO_PINMOD_MASK,
USBIO_GPIO_SET_PINMOD(USBIO_GPIO_PINMOD_INPUT));
}
static int usbio_gpio_direction_output(struct gpio_chip *gc,
unsigned int offset, int value)
{
int ret;
ret = usbio_gpio_update_config(gc, offset, USBIO_GPIO_PINMOD_MASK,
USBIO_GPIO_SET_PINMOD(USBIO_GPIO_PINMOD_OUTPUT));
if (ret)
return ret;
return usbio_gpio_set(gc, offset, value);
}
static int usbio_gpio_set_config(struct gpio_chip *gc, unsigned int offset,
unsigned long config)
{
u8 value;
switch (pinconf_to_config_param(config)) {
case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT:
value = USBIO_GPIO_SET_PINCFG(USBIO_GPIO_PINCFG_DEFAULT);
break;
case PIN_CONFIG_BIAS_PULL_UP:
value = USBIO_GPIO_SET_PINCFG(USBIO_GPIO_PINCFG_PULLUP);
break;
case PIN_CONFIG_BIAS_PULL_DOWN:
value = USBIO_GPIO_SET_PINCFG(USBIO_GPIO_PINCFG_PULLDOWN);
break;
case PIN_CONFIG_DRIVE_PUSH_PULL:
value = USBIO_GPIO_SET_PINCFG(USBIO_GPIO_PINCFG_PUSHPULL);
break;
default:
return -ENOTSUPP;
}
return usbio_gpio_update_config(gc, offset, USBIO_GPIO_PINCFG_MASK, value);
}
static int usbio_gpio_probe(struct auxiliary_device *adev,
const struct auxiliary_device_id *adev_id)
{
struct usbio_gpio_bank_desc *bank_desc;
struct device *dev = &adev->dev;
struct usbio_gpio *gpio;
int bank, ret;
bank_desc = dev_get_platdata(dev);
if (!bank_desc)
return -EINVAL;
gpio = devm_kzalloc(dev, sizeof(*gpio), GFP_KERNEL);
if (!gpio)
return -ENOMEM;
ret = devm_mutex_init(dev, &gpio->config_mutex);
if (ret)
return ret;
gpio->adev = adev;
usbio_acpi_bind(gpio->adev, usbio_gpio_acpi_hids);
for (bank = 0; bank < USBIO_MAX_GPIOBANKS && bank_desc[bank].bmap; bank++)
gpio->banks[bank].bitmap = le32_to_cpu(bank_desc[bank].bmap);
gpio->gc.label = ACPI_COMPANION(dev) ?
acpi_dev_name(ACPI_COMPANION(dev)) : dev_name(dev);
gpio->gc.parent = dev;
gpio->gc.owner = THIS_MODULE;
gpio->gc.get_direction = usbio_gpio_get_direction;
gpio->gc.direction_input = usbio_gpio_direction_input;
gpio->gc.direction_output = usbio_gpio_direction_output;
gpio->gc.get = usbio_gpio_get;
gpio->gc.set = usbio_gpio_set;
gpio->gc.set_config = usbio_gpio_set_config;
gpio->gc.base = -1;
gpio->gc.ngpio = bank * USBIO_GPIOSPERBANK;
gpio->gc.can_sleep = true;
ret = devm_gpiochip_add_data(dev, &gpio->gc, gpio);
if (ret)
return ret;
if (has_acpi_companion(dev))
acpi_dev_clear_dependencies(ACPI_COMPANION(dev));
return 0;
}
static const struct auxiliary_device_id usbio_gpio_id_table[] = {
{ "usbio.usbio-gpio" },
{ }
};
MODULE_DEVICE_TABLE(auxiliary, usbio_gpio_id_table);
static struct auxiliary_driver usbio_gpio_driver = {
.name = USBIO_GPIO_CLIENT,
.probe = usbio_gpio_probe,
.id_table = usbio_gpio_id_table
};
module_auxiliary_driver(usbio_gpio_driver);
MODULE_DESCRIPTION("Intel USBIO GPIO driver");
MODULE_AUTHOR("Israel Cepeda <israel.a.cepeda.lopez@intel.com>");
MODULE_AUTHOR("Hans de Goede <hansg@kernel.org>");
MODULE_LICENSE("GPL");
MODULE_IMPORT_NS("USBIO");