mirror of
https://github.com/torvalds/linux.git
synced 2026-05-12 16:18:45 +02:00
The FPC202 dual port controller has 20 regular GPIO lines and 8 special GPIO lines with LED features. Each one of these "LED GPIOs" can output PWM and blink signals. Add support for the eight special-purpose GPIO lines to the existing FPC202 driver's GPIO support. Add support for registering led-class devices on these GPIO lines. Signed-off-by: Romain Gantois <romain.gantois@bootlin.com> Link: https://patch.msgid.link/20260331-fpc202-leds-v3-3-74b173537d42@bootlin.com Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
740 lines
19 KiB
C
740 lines
19 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* ti_fpc202.c - FPC202 Dual Port Controller driver
|
|
*
|
|
* Copyright (C) 2024 Bootlin
|
|
*
|
|
*/
|
|
|
|
#include <linux/cleanup.h>
|
|
#include <linux/device/devres.h>
|
|
#include <linux/err.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/i2c-atr.h>
|
|
#include <linux/gpio/consumer.h>
|
|
#include <linux/gpio/driver.h>
|
|
#include <linux/gpio/machine.h>
|
|
#include <linux/leds.h>
|
|
#include <linux/module.h>
|
|
#include <linux/math.h>
|
|
#include <linux/types.h>
|
|
|
|
#define FPC202_NUM_PORTS 2
|
|
#define FPC202_ALIASES_PER_PORT 2
|
|
|
|
/*
|
|
* GPIO: port mapping
|
|
*
|
|
* 0: P0_S0_IN_A
|
|
* 1: P0_S1_IN_A
|
|
* 2: P1_S0_IN_A
|
|
* 3: P1_S1_IN_A
|
|
* 4: P0_S0_IN_B
|
|
* ...
|
|
* 8: P0_S0_IN_C
|
|
* ...
|
|
* 12: P0_S0_OUT_A
|
|
* ...
|
|
* 16: P0_S0_OUT_B
|
|
* ...
|
|
* 19: P1_S1_OUT_B
|
|
*
|
|
* Ports with optional LED control:
|
|
*
|
|
* 20: P0_S0_OUT_C (P0_S0_LED1)
|
|
* ...
|
|
* 23: P1_S1_OUT_C (P1_S1_LED1)
|
|
* 24: P0_S0_OUT_D (P0_S0_LED2
|
|
* ...
|
|
* 27: P1_S1_OUT_D (P1_S1_LED2)
|
|
*
|
|
*/
|
|
|
|
#define FPC202_GPIO_COUNT 28
|
|
#define FPC202_GPIO_P0_S0_IN_B 4
|
|
#define FPC202_GPIO_P0_S0_OUT_A 12
|
|
#define FPC202_GPIO_P0_S0_OUT_C 20
|
|
#define FPC202_GPIO_P0_S0_OUT_D 24
|
|
|
|
#define FPC202_REG_IN_A_INT 0x6
|
|
#define FPC202_REG_IN_C_IN_B 0x7
|
|
#define FPC202_REG_OUT_A_OUT_B 0x8
|
|
#define FPC202_REG_OUT_C_OUT_D 0x9
|
|
|
|
#define FPC202_REG_OUT_A_OUT_B_VAL 0xa
|
|
|
|
#define FPC202_LED_COUNT 8
|
|
|
|
/* There are four LED GPIO mode registers which manage two GPIOs each. */
|
|
#define FPC202_REG_LED_MODE(offset) (0x1a + 0x20 * ((offset) % 4))
|
|
|
|
/* LED1 GPIOs (*_OUT_C) are configured in bits 1:0, LED2 GPIOs (*_OUT_D) in bits 3:2. */
|
|
#define FPC202_LED_MODE_SHIFT(offset) ((offset) < FPC202_GPIO_P0_S0_OUT_D ? 0 : 2)
|
|
#define FPC202_LED_MODE_MASK(offset) (GENMASK(1, 0) << FPC202_LED_MODE_SHIFT(offset))
|
|
|
|
/* There is one PWM control register for each GPIO LED */
|
|
#define FPC202_REG_LED_PWM(offset) \
|
|
(((offset) < FPC202_GPIO_P0_S0_OUT_D ? 0x14 : 0x15) + 0x20 * ((offset) % 4))
|
|
|
|
/* There are two blink delay registers (on/off time) for each GPIO LED */
|
|
#define FPC202_REG_LED_BLINK_ON(offset) \
|
|
(((offset) < FPC202_GPIO_P0_S0_OUT_D ? 0x16 : 0x18) + 0x20 * ((offset) % 4))
|
|
#define FPC202_REG_LED_BLINK_OFF(offset) (FPC202_REG_LED_BLINK_ON(offset) + 1)
|
|
|
|
/* The actual hardware precision is 2.5ms but since the LED API doesn't handle sub-millisecond
|
|
* timesteps this is rounded up to 5ms
|
|
*/
|
|
#define FPC202_LED_BLINK_PRECISION 5UL
|
|
|
|
#define FPC202_LED_MAX_BRIGHTNESS 255
|
|
|
|
#define FPC202_REG_MOD_DEV(port, dev) (0xb4 + ((port) * 4) + (dev))
|
|
#define FPC202_REG_AUX_DEV(port, dev) (0xb6 + ((port) * 4) + (dev))
|
|
|
|
/*
|
|
* The FPC202 doesn't support turning off address translation on a single port.
|
|
* So just set an invalid I2C address as the translation target when no client
|
|
* address is attached.
|
|
*/
|
|
#define FPC202_REG_DEV_INVALID 0
|
|
|
|
/* Even aliases are assigned to device 0 and odd aliases to device 1 */
|
|
#define fpc202_dev_num_from_alias(alias) ((alias) % 2)
|
|
|
|
enum fpc202_led_mode {
|
|
FPC202_LED_MODE_OFF = 0,
|
|
FPC202_LED_MODE_ON = 1,
|
|
FPC202_LED_MODE_PWM = 2,
|
|
FPC202_LED_MODE_BLINK = 3,
|
|
};
|
|
|
|
struct fpc202_led {
|
|
int offset;
|
|
struct led_classdev led_cdev;
|
|
struct fpc202_priv *priv;
|
|
struct gpio_desc *gpio;
|
|
enum fpc202_led_mode mode;
|
|
};
|
|
|
|
struct fpc202_priv {
|
|
struct i2c_client *client;
|
|
struct i2c_atr *atr;
|
|
struct gpio_desc *en_gpio;
|
|
struct gpio_chip gpio;
|
|
struct fpc202_led leds[FPC202_LED_COUNT];
|
|
|
|
/* Lock REG_MOD/AUX_DEV and addr_caches during attach/detach */
|
|
struct mutex reg_dev_lock;
|
|
|
|
/* Lock LED mode select register during accesses */
|
|
struct mutex led_mode_lock;
|
|
|
|
/* Cached device addresses for both ports and their devices */
|
|
u8 addr_caches[2][2];
|
|
|
|
/* Keep track of which ports were probed */
|
|
DECLARE_BITMAP(probed_ports, FPC202_NUM_PORTS);
|
|
};
|
|
|
|
static void fpc202_fill_alias_table(struct i2c_client *client, u16 *aliases, int port_id)
|
|
{
|
|
u16 first_alias;
|
|
int i;
|
|
|
|
/*
|
|
* There is a predefined list of aliases for each FPC202 I2C
|
|
* self-address. This allows daisy-chained FPC202 units to
|
|
* automatically take on different sets of aliases.
|
|
* Each port of an FPC202 unit is assigned two aliases from this list.
|
|
*/
|
|
first_alias = 0x10 + 4 * port_id + 8 * ((u16)client->addr - 2);
|
|
|
|
for (i = 0; i < FPC202_ALIASES_PER_PORT; i++)
|
|
aliases[i] = first_alias + i;
|
|
}
|
|
|
|
static int fpc202_gpio_get_dir(int offset)
|
|
{
|
|
return offset < FPC202_GPIO_P0_S0_OUT_A ? GPIO_LINE_DIRECTION_IN : GPIO_LINE_DIRECTION_OUT;
|
|
}
|
|
|
|
static int fpc202_gpio_has_led_caps(int offset)
|
|
{
|
|
return offset >= FPC202_GPIO_P0_S0_OUT_C;
|
|
}
|
|
|
|
static int fpc202_read(struct fpc202_priv *priv, u8 reg)
|
|
{
|
|
int val;
|
|
|
|
val = i2c_smbus_read_byte_data(priv->client, reg);
|
|
return val;
|
|
}
|
|
|
|
static int fpc202_write(struct fpc202_priv *priv, u8 reg, u8 value)
|
|
{
|
|
return i2c_smbus_write_byte_data(priv->client, reg, value);
|
|
}
|
|
|
|
static void fpc202_set_enable(struct fpc202_priv *priv, int enable)
|
|
{
|
|
if (!priv->en_gpio)
|
|
return;
|
|
|
|
gpiod_set_value(priv->en_gpio, enable);
|
|
}
|
|
|
|
static int fpc202_led_mode_write(struct fpc202_priv *priv,
|
|
int offset,
|
|
enum fpc202_led_mode mode)
|
|
{
|
|
u8 val, reg = FPC202_REG_LED_MODE(offset);
|
|
int ret;
|
|
|
|
guard(mutex)(&priv->led_mode_lock);
|
|
|
|
ret = fpc202_read(priv, reg);
|
|
if (ret < 0) {
|
|
dev_err(&priv->client->dev, "failed to read LED mode %d! err %d\n",
|
|
offset, ret);
|
|
return ret;
|
|
}
|
|
|
|
val = (u8)ret & ~FPC202_LED_MODE_MASK(offset);
|
|
val |= mode << FPC202_LED_MODE_SHIFT(offset);
|
|
|
|
return fpc202_write(priv, reg, val);
|
|
}
|
|
|
|
static int fpc202_led_mode_set(struct fpc202_led *led, enum fpc202_led_mode mode)
|
|
{
|
|
struct fpc202_priv *priv = led->priv;
|
|
|
|
led->mode = mode;
|
|
|
|
return fpc202_led_mode_write(priv, led->offset, mode);
|
|
}
|
|
|
|
static int fpc202_gpio_set(struct gpio_chip *chip, unsigned int offset,
|
|
int value)
|
|
{
|
|
struct fpc202_priv *priv = gpiochip_get_data(chip);
|
|
int ret;
|
|
u8 val;
|
|
|
|
if (fpc202_gpio_has_led_caps(offset)) {
|
|
ret = fpc202_led_mode_write(priv, offset,
|
|
value ? FPC202_LED_MODE_ON : FPC202_LED_MODE_OFF);
|
|
if (ret < 0)
|
|
dev_err(&priv->client->dev, "Failed to set GPIO %d LED mode! err %d\n",
|
|
offset, ret);
|
|
|
|
return ret;
|
|
}
|
|
|
|
ret = fpc202_read(priv, FPC202_REG_OUT_A_OUT_B_VAL);
|
|
if (ret < 0) {
|
|
dev_err(&priv->client->dev, "Failed to set GPIO %d value! err %d\n", offset, ret);
|
|
return ret;
|
|
}
|
|
|
|
val = (u8)ret;
|
|
|
|
if (value)
|
|
val |= BIT(offset - FPC202_GPIO_P0_S0_OUT_A);
|
|
else
|
|
val &= ~BIT(offset - FPC202_GPIO_P0_S0_OUT_A);
|
|
|
|
return fpc202_write(priv, FPC202_REG_OUT_A_OUT_B_VAL, val);
|
|
}
|
|
|
|
static int fpc202_gpio_get(struct gpio_chip *chip, unsigned int offset)
|
|
{
|
|
struct fpc202_priv *priv = gpiochip_get_data(chip);
|
|
u8 reg, bit;
|
|
int ret;
|
|
|
|
if (offset < FPC202_GPIO_P0_S0_IN_B) {
|
|
reg = FPC202_REG_IN_A_INT;
|
|
bit = BIT(4 + offset);
|
|
} else if (offset < FPC202_GPIO_P0_S0_OUT_A) {
|
|
reg = FPC202_REG_IN_C_IN_B;
|
|
bit = BIT(offset - FPC202_GPIO_P0_S0_IN_B);
|
|
} else if (!fpc202_gpio_has_led_caps(offset)) {
|
|
reg = FPC202_REG_OUT_A_OUT_B_VAL;
|
|
bit = BIT(offset - FPC202_GPIO_P0_S0_OUT_A);
|
|
} else {
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
ret = fpc202_read(priv, reg);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return !!(((u8)ret) & bit);
|
|
}
|
|
|
|
static int fpc202_gpio_direction_input(struct gpio_chip *chip, unsigned int offset)
|
|
{
|
|
if (fpc202_gpio_get_dir(offset) == GPIO_LINE_DIRECTION_OUT)
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int fpc202_gpio_direction_output(struct gpio_chip *chip, unsigned int offset,
|
|
int value)
|
|
{
|
|
struct fpc202_priv *priv = gpiochip_get_data(chip);
|
|
u8 reg, val, bit;
|
|
int ret;
|
|
|
|
if (fpc202_gpio_get_dir(offset) == GPIO_LINE_DIRECTION_IN)
|
|
return -EINVAL;
|
|
|
|
fpc202_gpio_set(chip, offset, value);
|
|
|
|
if (fpc202_gpio_has_led_caps(offset)) {
|
|
reg = FPC202_REG_OUT_C_OUT_D;
|
|
bit = BIT(offset - FPC202_GPIO_P0_S0_OUT_C);
|
|
} else {
|
|
reg = FPC202_REG_OUT_A_OUT_B;
|
|
bit = BIT(offset - FPC202_GPIO_P0_S0_OUT_A);
|
|
}
|
|
|
|
ret = fpc202_read(priv, reg);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
val = (u8)ret | bit;
|
|
|
|
return fpc202_write(priv, reg, val);
|
|
}
|
|
|
|
/*
|
|
* Set the translation table entry associated with a port and device number.
|
|
*
|
|
* Each downstream port of the FPC202 has two fixed aliases corresponding to
|
|
* device numbers 0 and 1. If one of these aliases is found in an incoming I2C
|
|
* transfer, it will be translated to the address given by the corresponding
|
|
* translation table entry.
|
|
*/
|
|
static int fpc202_write_dev_addr(struct fpc202_priv *priv, u32 port_id, int dev_num, u16 addr)
|
|
{
|
|
int ret, reg_mod, reg_aux;
|
|
u8 val;
|
|
|
|
guard(mutex)(&priv->reg_dev_lock);
|
|
|
|
reg_mod = FPC202_REG_MOD_DEV(port_id, dev_num);
|
|
reg_aux = FPC202_REG_AUX_DEV(port_id, dev_num);
|
|
val = addr & 0x7f;
|
|
|
|
ret = fpc202_write(priv, reg_mod, val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/*
|
|
* The FPC202 datasheet is unclear about the role of the AUX registers.
|
|
* Empirically, writing to them as well seems to be necessary for
|
|
* address translation to function properly.
|
|
*/
|
|
ret = fpc202_write(priv, reg_aux, val);
|
|
|
|
priv->addr_caches[port_id][dev_num] = val;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int fpc202_attach_addr(struct i2c_atr *atr, u32 chan_id,
|
|
u16 addr, u16 alias)
|
|
{
|
|
struct fpc202_priv *priv = i2c_atr_get_driver_data(atr);
|
|
|
|
dev_dbg(&priv->client->dev, "attaching address 0x%02x to alias 0x%02x\n", addr, alias);
|
|
|
|
return fpc202_write_dev_addr(priv, chan_id, fpc202_dev_num_from_alias(alias), addr);
|
|
}
|
|
|
|
static void fpc202_detach_addr(struct i2c_atr *atr, u32 chan_id,
|
|
u16 addr)
|
|
{
|
|
struct fpc202_priv *priv = i2c_atr_get_driver_data(atr);
|
|
int dev_num, val;
|
|
|
|
for (dev_num = 0; dev_num < 2; dev_num++) {
|
|
mutex_lock(&priv->reg_dev_lock);
|
|
|
|
val = priv->addr_caches[chan_id][dev_num];
|
|
|
|
mutex_unlock(&priv->reg_dev_lock);
|
|
|
|
if (val == (addr & 0x7f)) {
|
|
fpc202_write_dev_addr(priv, chan_id, dev_num, FPC202_REG_DEV_INVALID);
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
|
|
static const struct i2c_atr_ops fpc202_atr_ops = {
|
|
.attach_addr = fpc202_attach_addr,
|
|
.detach_addr = fpc202_detach_addr,
|
|
};
|
|
|
|
static struct fpc202_led *fpc202_cdev_to_led(struct led_classdev *cdev)
|
|
{
|
|
return container_of(cdev, struct fpc202_led, led_cdev);
|
|
}
|
|
|
|
static struct fpc202_led *fpc202_led_get(struct fpc202_priv *priv, int offset)
|
|
{
|
|
return &priv->leds[offset - FPC202_GPIO_P0_S0_OUT_C];
|
|
}
|
|
|
|
static int fpc202_led_blink_set(struct led_classdev *cdev,
|
|
unsigned long *delay_on,
|
|
unsigned long *delay_off)
|
|
{
|
|
struct fpc202_led *led = fpc202_cdev_to_led(cdev);
|
|
struct fpc202_priv *priv = led->priv;
|
|
unsigned long val;
|
|
int ret;
|
|
|
|
if (*delay_on == 0 && *delay_off == 0) {
|
|
*delay_on = 250;
|
|
*delay_off = 250;
|
|
} else {
|
|
if (*delay_on % FPC202_LED_BLINK_PRECISION)
|
|
*delay_on = roundup(*delay_on, FPC202_LED_BLINK_PRECISION);
|
|
|
|
if (*delay_off % FPC202_LED_BLINK_PRECISION)
|
|
*delay_off = roundup(*delay_off, FPC202_LED_BLINK_PRECISION);
|
|
}
|
|
|
|
/* Multiply the duration by two, since the actual precision is 2.5ms not 5ms*/
|
|
val = 2 * (*delay_on / FPC202_LED_BLINK_PRECISION);
|
|
if (val > 255) {
|
|
val = 255;
|
|
*delay_on = (val / 2) * FPC202_LED_BLINK_PRECISION;
|
|
}
|
|
|
|
ret = fpc202_write(priv, FPC202_REG_LED_BLINK_ON(led->offset), val);
|
|
if (ret) {
|
|
dev_err(&priv->client->dev,
|
|
"Failed to set blink on duration for LED %d, err %d\n",
|
|
led->offset, ret);
|
|
return ret;
|
|
}
|
|
|
|
val = 2 * (*delay_off / FPC202_LED_BLINK_PRECISION);
|
|
if (val > 255) {
|
|
val = 255;
|
|
*delay_off = (val / 2) * FPC202_LED_BLINK_PRECISION;
|
|
}
|
|
|
|
ret = fpc202_write(priv, FPC202_REG_LED_BLINK_OFF(led->offset), val);
|
|
if (ret) {
|
|
dev_err(&priv->client->dev,
|
|
"Failed to set blink off duration for LED %d, err %d\n",
|
|
led->offset, ret);
|
|
return ret;
|
|
}
|
|
|
|
return fpc202_led_mode_set(led, FPC202_LED_MODE_BLINK);
|
|
}
|
|
|
|
static enum led_brightness fpc202_led_brightness_get(struct led_classdev *cdev)
|
|
{
|
|
struct fpc202_led *led = fpc202_cdev_to_led(cdev);
|
|
|
|
if (led->mode == FPC202_LED_MODE_OFF)
|
|
return LED_OFF;
|
|
|
|
return LED_ON;
|
|
}
|
|
|
|
static int fpc202_led_brightness_set(struct led_classdev *cdev,
|
|
enum led_brightness brightness)
|
|
{
|
|
struct fpc202_led *led = fpc202_cdev_to_led(cdev);
|
|
struct fpc202_priv *priv = led->priv;
|
|
int ret;
|
|
|
|
if (!brightness)
|
|
return fpc202_led_mode_set(led, FPC202_LED_MODE_OFF);
|
|
|
|
if (led->mode != FPC202_LED_MODE_BLINK) {
|
|
if (brightness == FPC202_LED_MAX_BRIGHTNESS)
|
|
return fpc202_led_mode_set(led, FPC202_LED_MODE_ON);
|
|
|
|
ret = fpc202_led_mode_set(led, FPC202_LED_MODE_PWM);
|
|
if (ret) {
|
|
dev_err(&priv->client->dev, "Failed to set LED %d mode, err %d\n",
|
|
led->offset, ret);
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
return fpc202_write(priv, FPC202_REG_LED_PWM(led->offset), brightness);
|
|
}
|
|
|
|
static int fpc202_register_led(struct fpc202_priv *priv, int offset,
|
|
struct device_node *led_handle)
|
|
{
|
|
struct fpc202_led *led = fpc202_led_get(priv, offset);
|
|
struct device *dev = &priv->client->dev;
|
|
struct led_init_data init_data = { };
|
|
int ret = 0;
|
|
|
|
led->priv = priv;
|
|
led->offset = offset;
|
|
led->led_cdev.max_brightness = FPC202_LED_MAX_BRIGHTNESS;
|
|
led->led_cdev.brightness_set_blocking = fpc202_led_brightness_set;
|
|
led->led_cdev.brightness_get = fpc202_led_brightness_get;
|
|
led->led_cdev.blink_set = fpc202_led_blink_set;
|
|
|
|
init_data.fwnode = of_fwnode_handle(led_handle);
|
|
init_data.default_label = NULL;
|
|
init_data.devicename = NULL;
|
|
init_data.devname_mandatory = false;
|
|
|
|
ret = fpc202_led_mode_set(led, FPC202_LED_MODE_OFF);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to set LED %d mode, err %d\n", offset, ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = devm_led_classdev_register_ext(dev, &led->led_cdev, &init_data);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to register LED %d cdev, err %d\n", offset, ret);
|
|
return ret;
|
|
}
|
|
|
|
/* Claim corresponding GPIO line so that it cannot be interfered with */
|
|
led->gpio = gpiochip_request_own_desc(&priv->gpio, offset, led->led_cdev.name,
|
|
GPIO_ACTIVE_HIGH, GPIOD_ASIS);
|
|
if (IS_ERR(led->gpio)) {
|
|
ret = PTR_ERR(led->gpio);
|
|
dev_err(dev, "Failed to register LED %d cdev, err %d\n", offset, ret);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int fpc202_register_leds(struct fpc202_priv *priv)
|
|
{
|
|
struct device *dev = &priv->client->dev;
|
|
int offset, ret = 0;
|
|
|
|
if (!devres_open_group(dev, fpc202_register_leds, GFP_KERNEL))
|
|
return -ENOMEM;
|
|
|
|
for_each_child_of_node_scoped(dev->of_node, led_handle) {
|
|
ret = of_property_read_u32(led_handle, "reg", &offset);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to read 'reg' property of child node, err %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
if (offset < FPC202_GPIO_P0_S0_OUT_C || offset > FPC202_GPIO_COUNT)
|
|
continue;
|
|
|
|
ret = fpc202_register_led(priv, offset, led_handle);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to register LED %d, err %d\n", offset,
|
|
ret);
|
|
goto free_own_gpios;
|
|
}
|
|
}
|
|
|
|
devres_close_group(dev, fpc202_register_leds);
|
|
|
|
return 0;
|
|
|
|
free_own_gpios:
|
|
for (offset = 0; offset < FPC202_LED_COUNT; offset++)
|
|
if (priv->leds[offset].gpio)
|
|
gpiochip_free_own_desc(priv->leds[offset].gpio);
|
|
return ret;
|
|
}
|
|
|
|
static int fpc202_probe_port(struct fpc202_priv *priv, struct device_node *i2c_handle, int port_id)
|
|
{
|
|
u16 aliases[FPC202_ALIASES_PER_PORT] = { };
|
|
struct device *dev = &priv->client->dev;
|
|
struct i2c_atr_adap_desc desc = { };
|
|
int ret = 0;
|
|
|
|
desc.chan_id = port_id;
|
|
desc.parent = dev;
|
|
desc.bus_handle = of_fwnode_handle(i2c_handle);
|
|
desc.num_aliases = FPC202_ALIASES_PER_PORT;
|
|
|
|
fpc202_fill_alias_table(priv->client, aliases, port_id);
|
|
desc.aliases = aliases;
|
|
|
|
ret = i2c_atr_add_adapter(priv->atr, &desc);
|
|
if (ret)
|
|
return ret;
|
|
|
|
set_bit(port_id, priv->probed_ports);
|
|
|
|
ret = fpc202_write_dev_addr(priv, port_id, 0, FPC202_REG_DEV_INVALID);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return fpc202_write_dev_addr(priv, port_id, 1, FPC202_REG_DEV_INVALID);
|
|
}
|
|
|
|
static void fpc202_remove_port(struct fpc202_priv *priv, int port_id)
|
|
{
|
|
i2c_atr_del_adapter(priv->atr, port_id);
|
|
clear_bit(port_id, priv->probed_ports);
|
|
}
|
|
|
|
static int fpc202_probe(struct i2c_client *client)
|
|
{
|
|
struct device *dev = &client->dev;
|
|
struct fpc202_priv *priv;
|
|
int ret, port_id, led_id;
|
|
|
|
priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
|
|
if (!priv)
|
|
return -ENOMEM;
|
|
|
|
mutex_init(&priv->reg_dev_lock);
|
|
mutex_init(&priv->led_mode_lock);
|
|
|
|
priv->client = client;
|
|
i2c_set_clientdata(client, priv);
|
|
|
|
priv->en_gpio = devm_gpiod_get_optional(dev, "enable", GPIOD_OUT_HIGH);
|
|
if (IS_ERR(priv->en_gpio)) {
|
|
ret = PTR_ERR(priv->en_gpio);
|
|
dev_err(dev, "failed to fetch enable GPIO! err %d\n", ret);
|
|
goto destroy_mutex;
|
|
}
|
|
|
|
priv->gpio.label = "gpio-fpc202";
|
|
priv->gpio.base = -1;
|
|
priv->gpio.direction_input = fpc202_gpio_direction_input;
|
|
priv->gpio.direction_output = fpc202_gpio_direction_output;
|
|
priv->gpio.set = fpc202_gpio_set;
|
|
priv->gpio.get = fpc202_gpio_get;
|
|
priv->gpio.ngpio = FPC202_GPIO_COUNT;
|
|
priv->gpio.parent = dev;
|
|
priv->gpio.owner = THIS_MODULE;
|
|
|
|
ret = gpiochip_add_data(&priv->gpio, priv);
|
|
if (ret) {
|
|
priv->gpio.parent = NULL;
|
|
dev_err(dev, "failed to add gpiochip err %d\n", ret);
|
|
goto disable_gpio;
|
|
}
|
|
|
|
priv->atr = i2c_atr_new(client->adapter, dev, &fpc202_atr_ops, 2, 0);
|
|
if (IS_ERR(priv->atr)) {
|
|
ret = PTR_ERR(priv->atr);
|
|
dev_err(dev, "failed to create i2c atr err %d\n", ret);
|
|
goto disable_gpio;
|
|
}
|
|
|
|
i2c_atr_set_driver_data(priv->atr, priv);
|
|
|
|
ret = fpc202_register_leds(priv);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to register LEDs, err %d\n", ret);
|
|
goto delete_atr;
|
|
}
|
|
|
|
bitmap_zero(priv->probed_ports, FPC202_NUM_PORTS);
|
|
|
|
for_each_child_of_node_scoped(dev->of_node, i2c_handle) {
|
|
ret = of_property_read_u32(i2c_handle, "reg", &port_id);
|
|
if (ret) {
|
|
if (ret == -EINVAL)
|
|
continue;
|
|
|
|
dev_err(dev, "failed to read 'reg' property of child node, err %d\n", ret);
|
|
goto unregister_chans;
|
|
}
|
|
|
|
if (port_id >= FPC202_NUM_PORTS)
|
|
continue;
|
|
|
|
ret = fpc202_probe_port(priv, i2c_handle, port_id);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to probe port %d, err %d\n", port_id, ret);
|
|
goto unregister_chans;
|
|
}
|
|
}
|
|
|
|
goto out;
|
|
|
|
unregister_chans:
|
|
for_each_set_bit(port_id, priv->probed_ports, FPC202_NUM_PORTS)
|
|
fpc202_remove_port(priv, port_id);
|
|
|
|
for (led_id = 0; led_id < FPC202_LED_COUNT; led_id++)
|
|
if (priv->leds[led_id].gpio)
|
|
gpiochip_free_own_desc(priv->leds[led_id].gpio);
|
|
|
|
devres_release_group(&client->dev, fpc202_register_leds);
|
|
delete_atr:
|
|
i2c_atr_delete(priv->atr);
|
|
disable_gpio:
|
|
fpc202_set_enable(priv, 0);
|
|
gpiochip_remove(&priv->gpio);
|
|
destroy_mutex:
|
|
mutex_destroy(&priv->led_mode_lock);
|
|
mutex_destroy(&priv->reg_dev_lock);
|
|
out:
|
|
return ret;
|
|
}
|
|
|
|
static void fpc202_remove(struct i2c_client *client)
|
|
{
|
|
struct fpc202_priv *priv = i2c_get_clientdata(client);
|
|
int port_id, led_id;
|
|
|
|
for_each_set_bit(port_id, priv->probed_ports, FPC202_NUM_PORTS)
|
|
fpc202_remove_port(priv, port_id);
|
|
|
|
for (led_id = 0; led_id < FPC202_LED_COUNT; led_id++)
|
|
if (priv->leds[led_id].gpio)
|
|
gpiochip_free_own_desc(priv->leds[led_id].gpio);
|
|
|
|
/* Release led devices early so that blink handlers don't trigger. */
|
|
devres_release_group(&client->dev, fpc202_register_leds);
|
|
|
|
mutex_destroy(&priv->led_mode_lock);
|
|
mutex_destroy(&priv->reg_dev_lock);
|
|
|
|
i2c_atr_delete(priv->atr);
|
|
|
|
fpc202_set_enable(priv, 0);
|
|
gpiochip_remove(&priv->gpio);
|
|
}
|
|
|
|
static const struct of_device_id fpc202_of_match[] = {
|
|
{ .compatible = "ti,fpc202" },
|
|
{}
|
|
};
|
|
MODULE_DEVICE_TABLE(of, fpc202_of_match);
|
|
|
|
static struct i2c_driver fpc202_driver = {
|
|
.driver = {
|
|
.name = "fpc202",
|
|
.of_match_table = fpc202_of_match,
|
|
},
|
|
.probe = fpc202_probe,
|
|
.remove = fpc202_remove,
|
|
};
|
|
|
|
module_i2c_driver(fpc202_driver);
|
|
|
|
MODULE_AUTHOR("Romain Gantois <romain.gantois@bootlin.com>");
|
|
MODULE_DESCRIPTION("TI FPC202 Dual Port Controller driver");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_IMPORT_NS("I2C_ATR");
|