123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537 |
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * Copyright (C) 2018, STMicroelectronics - All Rights Reserved
- *
- * Driver for STMicroelectronics Multi-Function eXpander (STMFX) GPIO expander
- * based on Linux driver : pinctrl/pinctrl-stmfx.c
- */
- #include <common.h>
- #include <dm.h>
- #include <i2c.h>
- #include <asm/gpio.h>
- #include <dm/device.h>
- #include <dm/device-internal.h>
- #include <dm/device_compat.h>
- #include <dm/lists.h>
- #include <dm/pinctrl.h>
- #include <linux/bitfield.h>
- #include <linux/bitops.h>
- #include <linux/delay.h>
- #include <power/regulator.h>
- /* STMFX pins = GPIO[15:0] + aGPIO[7:0] */
- #define STMFX_MAX_GPIO 16
- #define STMFX_MAX_AGPIO 8
- /* General */
- #define STMFX_REG_CHIP_ID 0x00 /* R */
- #define STMFX_REG_FW_VERSION_MSB 0x01 /* R */
- #define STMFX_REG_FW_VERSION_LSB 0x02 /* R */
- #define STMFX_REG_SYS_CTRL 0x40 /* RW */
- /* MFX boot time is around 10ms, so after reset, we have to wait this delay */
- #define STMFX_BOOT_TIME_MS 10
- /* GPIOs expander */
- /* GPIO_STATE1 0x10, GPIO_STATE2 0x11, GPIO_STATE3 0x12 */
- #define STMFX_REG_GPIO_STATE 0x10 /* R */
- /* GPIO_DIR1 0x60, GPIO_DIR2 0x61, GPIO_DIR3 0x63 */
- #define STMFX_REG_GPIO_DIR 0x60 /* RW */
- /* GPIO_TYPE1 0x64, GPIO_TYPE2 0x65, GPIO_TYPE3 0x66 */
- #define STMFX_REG_GPIO_TYPE 0x64 /* RW */
- /* GPIO_PUPD1 0x68, GPIO_PUPD2 0x69, GPIO_PUPD3 0x6A */
- #define STMFX_REG_GPIO_PUPD 0x68 /* RW */
- /* GPO_SET1 0x6C, GPO_SET2 0x6D, GPO_SET3 0x6E */
- #define STMFX_REG_GPO_SET 0x6C /* RW */
- /* GPO_CLR1 0x70, GPO_CLR2 0x71, GPO_CLR3 0x72 */
- #define STMFX_REG_GPO_CLR 0x70 /* RW */
- /* STMFX_REG_CHIP_ID bitfields */
- #define STMFX_REG_CHIP_ID_MASK GENMASK(7, 0)
- /* STMFX_REG_SYS_CTRL bitfields */
- #define STMFX_REG_SYS_CTRL_GPIO_EN BIT(0)
- #define STMFX_REG_SYS_CTRL_ALTGPIO_EN BIT(3)
- #define STMFX_REG_SYS_CTRL_SWRST BIT(7)
- #define NR_GPIO_REGS 3
- #define NR_GPIOS_PER_REG 8
- #define get_reg(offset) ((offset) / NR_GPIOS_PER_REG)
- #define get_shift(offset) ((offset) % NR_GPIOS_PER_REG)
- #define get_mask(offset) (BIT(get_shift(offset)))
- struct stmfx_pinctrl {
- struct udevice *gpio;
- };
- static int stmfx_read(struct udevice *dev, uint offset)
- {
- return dm_i2c_reg_read(dev_get_parent(dev), offset);
- }
- static int stmfx_write(struct udevice *dev, uint offset, unsigned int val)
- {
- return dm_i2c_reg_write(dev_get_parent(dev), offset, val);
- }
- static int stmfx_read_reg(struct udevice *dev, u8 reg_base, uint offset)
- {
- u8 reg = reg_base + get_reg(offset);
- u32 mask = get_mask(offset);
- int ret;
- ret = stmfx_read(dev, reg);
- if (ret < 0)
- return ret;
- return ret < 0 ? ret : !!(ret & mask);
- }
- static int stmfx_write_reg(struct udevice *dev, u8 reg_base, uint offset,
- uint val)
- {
- u8 reg = reg_base + get_reg(offset);
- u32 mask = get_mask(offset);
- int ret;
- ret = stmfx_read(dev, reg);
- if (ret < 0)
- return ret;
- ret = (ret & ~mask) | (val ? mask : 0);
- return stmfx_write(dev, reg, ret);
- }
- static int stmfx_conf_set_pupd(struct udevice *dev, unsigned int offset,
- uint pupd)
- {
- return stmfx_write_reg(dev, STMFX_REG_GPIO_PUPD, offset, pupd);
- }
- static int stmfx_conf_get_pupd(struct udevice *dev, unsigned int offset)
- {
- return stmfx_read_reg(dev, STMFX_REG_GPIO_PUPD, offset);
- }
- static int stmfx_conf_set_type(struct udevice *dev, unsigned int offset,
- uint type)
- {
- return stmfx_write_reg(dev, STMFX_REG_GPIO_TYPE, offset, type);
- }
- static int stmfx_conf_get_type(struct udevice *dev, unsigned int offset)
- {
- return stmfx_read_reg(dev, STMFX_REG_GPIO_TYPE, offset);
- }
- static int stmfx_gpio_get(struct udevice *dev, unsigned int offset)
- {
- return stmfx_read_reg(dev, STMFX_REG_GPIO_STATE, offset);
- }
- static int stmfx_gpio_set(struct udevice *dev, unsigned int offset, int value)
- {
- u32 reg = value ? STMFX_REG_GPO_SET : STMFX_REG_GPO_CLR;
- u32 mask = get_mask(offset);
- return stmfx_write(dev, reg + get_reg(offset), mask);
- }
- static int stmfx_gpio_get_function(struct udevice *dev, unsigned int offset)
- {
- int ret = stmfx_read_reg(dev, STMFX_REG_GPIO_DIR, offset);
- if (ret < 0)
- return ret;
- /* On stmfx, gpio pins direction is (0)input, (1)output. */
- return ret ? GPIOF_OUTPUT : GPIOF_INPUT;
- }
- static int stmfx_gpio_direction_input(struct udevice *dev, unsigned int offset)
- {
- return stmfx_write_reg(dev, STMFX_REG_GPIO_DIR, offset, 0);
- }
- static int stmfx_gpio_direction_output(struct udevice *dev,
- unsigned int offset, int value)
- {
- int ret = stmfx_gpio_set(dev, offset, value);
- if (ret < 0)
- return ret;
- return stmfx_write_reg(dev, STMFX_REG_GPIO_DIR, offset, 1);
- }
- static int stmfx_gpio_set_dir_flags(struct udevice *dev, unsigned int offset,
- ulong flags)
- {
- int ret = -ENOTSUPP;
- if (flags & GPIOD_IS_OUT) {
- if (flags & GPIOD_OPEN_SOURCE)
- return -ENOTSUPP;
- if (flags & GPIOD_OPEN_DRAIN)
- ret = stmfx_conf_set_type(dev, offset, 0);
- else /* PUSH-PULL */
- ret = stmfx_conf_set_type(dev, offset, 1);
- if (ret)
- return ret;
- ret = stmfx_gpio_direction_output(dev, offset,
- GPIOD_FLAGS_OUTPUT(flags));
- } else if (flags & GPIOD_IS_IN) {
- ret = stmfx_gpio_direction_input(dev, offset);
- if (ret)
- return ret;
- if (flags & GPIOD_PULL_UP) {
- ret = stmfx_conf_set_type(dev, offset, 1);
- if (ret)
- return ret;
- ret = stmfx_conf_set_pupd(dev, offset, 1);
- } else if (flags & GPIOD_PULL_DOWN) {
- ret = stmfx_conf_set_type(dev, offset, 1);
- if (ret)
- return ret;
- ret = stmfx_conf_set_pupd(dev, offset, 0);
- }
- }
- return ret;
- }
- static int stmfx_gpio_get_dir_flags(struct udevice *dev, unsigned int offset,
- ulong *flags)
- {
- ulong dir_flags = 0;
- int ret;
- if (stmfx_gpio_get_function(dev, offset) == GPIOF_OUTPUT) {
- dir_flags |= GPIOD_IS_OUT;
- ret = stmfx_conf_get_type(dev, offset);
- if (ret < 0)
- return ret;
- if (ret == 0)
- dir_flags |= GPIOD_OPEN_DRAIN;
- /* 1 = push-pull (default), open source not supported */
- ret = stmfx_gpio_get(dev, offset);
- if (ret < 0)
- return ret;
- if (ret)
- dir_flags |= GPIOD_IS_OUT_ACTIVE;
- } else {
- dir_flags |= GPIOD_IS_IN;
- ret = stmfx_conf_get_type(dev, offset);
- if (ret < 0)
- return ret;
- if (ret == 1) {
- ret = stmfx_conf_get_pupd(dev, offset);
- if (ret < 0)
- return ret;
- if (ret == 1)
- dir_flags |= GPIOD_PULL_UP;
- else
- dir_flags |= GPIOD_PULL_DOWN;
- }
- }
- *flags = dir_flags;
- return 0;
- }
- static int stmfx_gpio_probe(struct udevice *dev)
- {
- struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
- struct ofnode_phandle_args args;
- u8 sys_ctrl;
- uc_priv->bank_name = "stmfx";
- uc_priv->gpio_count = STMFX_MAX_GPIO + STMFX_MAX_AGPIO;
- if (!dev_read_phandle_with_args(dev, "gpio-ranges",
- NULL, 3, 0, &args)) {
- uc_priv->gpio_count = args.args[2];
- }
- /* enable GPIO function */
- sys_ctrl = STMFX_REG_SYS_CTRL_GPIO_EN;
- if (uc_priv->gpio_count > STMFX_MAX_GPIO)
- sys_ctrl |= STMFX_REG_SYS_CTRL_ALTGPIO_EN;
- stmfx_write(dev, STMFX_REG_SYS_CTRL, sys_ctrl);
- return 0;
- }
- static const struct dm_gpio_ops stmfx_gpio_ops = {
- .set_value = stmfx_gpio_set,
- .get_value = stmfx_gpio_get,
- .get_function = stmfx_gpio_get_function,
- .direction_input = stmfx_gpio_direction_input,
- .direction_output = stmfx_gpio_direction_output,
- .set_dir_flags = stmfx_gpio_set_dir_flags,
- .get_dir_flags = stmfx_gpio_get_dir_flags,
- };
- U_BOOT_DRIVER(stmfx_gpio) = {
- .name = "stmfx-gpio",
- .id = UCLASS_GPIO,
- .probe = stmfx_gpio_probe,
- .ops = &stmfx_gpio_ops,
- };
- #if CONFIG_IS_ENABLED(PINCONF)
- static const struct pinconf_param stmfx_pinctrl_conf_params[] = {
- { "bias-disable", PIN_CONFIG_BIAS_DISABLE, 0 },
- { "bias-pull-up", PIN_CONFIG_BIAS_PULL_UP, 0 },
- { "bias-pull-pin-default", PIN_CONFIG_BIAS_PULL_PIN_DEFAULT, 0 },
- { "bias-pull-down", PIN_CONFIG_BIAS_PULL_DOWN, 0 },
- { "drive-open-drain", PIN_CONFIG_DRIVE_OPEN_DRAIN, 0 },
- { "drive-push-pull", PIN_CONFIG_DRIVE_PUSH_PULL, 0 },
- { "output-high", PIN_CONFIG_OUTPUT, 1 },
- { "output-low", PIN_CONFIG_OUTPUT, 0 },
- };
- static int stmfx_pinctrl_conf_set(struct udevice *dev, unsigned int pin,
- unsigned int param, unsigned int arg)
- {
- int ret, dir;
- struct stmfx_pinctrl *plat = dev_get_platdata(dev);
- dir = stmfx_gpio_get_function(plat->gpio, pin);
- if (dir < 0)
- return dir;
- switch (param) {
- case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT:
- case PIN_CONFIG_BIAS_DISABLE:
- case PIN_CONFIG_DRIVE_PUSH_PULL:
- ret = stmfx_conf_set_type(dev, pin, 0);
- break;
- case PIN_CONFIG_BIAS_PULL_DOWN:
- ret = stmfx_conf_set_type(dev, pin, 1);
- if (ret)
- return ret;
- ret = stmfx_conf_set_pupd(dev, pin, 0);
- break;
- case PIN_CONFIG_BIAS_PULL_UP:
- ret = stmfx_conf_set_type(dev, pin, 1);
- if (ret)
- return ret;
- ret = stmfx_conf_set_pupd(dev, pin, 1);
- break;
- case PIN_CONFIG_DRIVE_OPEN_DRAIN:
- ret = stmfx_conf_set_type(dev, pin, 1);
- break;
- case PIN_CONFIG_OUTPUT:
- ret = stmfx_gpio_direction_output(plat->gpio, pin, arg);
- break;
- default:
- return -ENOTSUPP;
- }
- return ret;
- }
- #endif
- static int stmfx_pinctrl_get_pins_count(struct udevice *dev)
- {
- struct stmfx_pinctrl *plat = dev_get_platdata(dev);
- struct gpio_dev_priv *uc_priv;
- uc_priv = dev_get_uclass_priv(plat->gpio);
- return uc_priv->gpio_count;
- }
- /*
- * STMFX pins[15:0] are called "stmfx_gpio[15:0]"
- * and STMFX pins[23:16] are called "stmfx_agpio[7:0]"
- */
- #define MAX_PIN_NAME_LEN 7
- static char pin_name[MAX_PIN_NAME_LEN];
- static const char *stmfx_pinctrl_get_pin_name(struct udevice *dev,
- unsigned int selector)
- {
- if (selector < STMFX_MAX_GPIO)
- snprintf(pin_name, MAX_PIN_NAME_LEN, "stmfx_gpio%u", selector);
- else
- snprintf(pin_name, MAX_PIN_NAME_LEN, "stmfx_agpio%u", selector - 16);
- return pin_name;
- }
- static const char *stmfx_pinctrl_get_pin_conf(struct udevice *dev,
- unsigned int pin, int func)
- {
- int pupd, type;
- type = stmfx_conf_get_type(dev, pin);
- if (type < 0)
- return "";
- if (func == GPIOF_OUTPUT) {
- if (type)
- return "drive-open-drain";
- else
- return ""; /* default: push-pull*/
- }
- if (!type)
- return ""; /* default: bias-disable*/
- pupd = stmfx_conf_get_pupd(dev, pin);
- if (pupd < 0)
- return "";
- if (pupd)
- return "bias-pull-up";
- else
- return "bias-pull-down";
- }
- static int stmfx_pinctrl_get_pin_muxing(struct udevice *dev,
- unsigned int selector,
- char *buf, int size)
- {
- struct stmfx_pinctrl *plat = dev_get_platdata(dev);
- int func;
- func = stmfx_gpio_get_function(plat->gpio, selector);
- if (func < 0)
- return func;
- snprintf(buf, size, "%s ", func == GPIOF_INPUT ? "input" : "output");
- strncat(buf, stmfx_pinctrl_get_pin_conf(dev, selector, func), size);
- return 0;
- }
- static int stmfx_pinctrl_bind(struct udevice *dev)
- {
- struct stmfx_pinctrl *plat = dev_get_platdata(dev);
- /* subnode name is not explicit: use father name */
- device_set_name(dev, dev->parent->name);
- return device_bind_driver_to_node(dev->parent,
- "stmfx-gpio", dev->parent->name,
- dev_ofnode(dev), &plat->gpio);
- };
- static int stmfx_pinctrl_probe(struct udevice *dev)
- {
- struct stmfx_pinctrl *plat = dev_get_platdata(dev);
- return device_probe(plat->gpio);
- };
- const struct pinctrl_ops stmfx_pinctrl_ops = {
- .get_pins_count = stmfx_pinctrl_get_pins_count,
- .get_pin_name = stmfx_pinctrl_get_pin_name,
- .set_state = pinctrl_generic_set_state,
- .get_pin_muxing = stmfx_pinctrl_get_pin_muxing,
- #if CONFIG_IS_ENABLED(PINCONF)
- .pinconf_set = stmfx_pinctrl_conf_set,
- .pinconf_num_params = ARRAY_SIZE(stmfx_pinctrl_conf_params),
- .pinconf_params = stmfx_pinctrl_conf_params,
- #endif
- };
- static const struct udevice_id stmfx_pinctrl_match[] = {
- { .compatible = "st,stmfx-0300-pinctrl", },
- };
- U_BOOT_DRIVER(stmfx_pinctrl) = {
- .name = "stmfx-pinctrl",
- .id = UCLASS_PINCTRL,
- .of_match = of_match_ptr(stmfx_pinctrl_match),
- .bind = stmfx_pinctrl_bind,
- .probe = stmfx_pinctrl_probe,
- .ops = &stmfx_pinctrl_ops,
- .platdata_auto_alloc_size = sizeof(struct stmfx_pinctrl),
- };
- static int stmfx_chip_init(struct udevice *dev)
- {
- u8 id;
- u8 version[2];
- int ret;
- struct dm_i2c_chip *chip = dev_get_parent_platdata(dev);
- ret = dm_i2c_reg_read(dev, STMFX_REG_CHIP_ID);
- if (ret < 0) {
- dev_err(dev, "error reading chip id: %d\n", ret);
- return ret;
- }
- id = (u8)ret;
- /*
- * Check that ID is the complement of the I2C address:
- * STMFX I2C address follows the 7-bit format (MSB), that's why
- * client->addr is shifted.
- *
- * STMFX_I2C_ADDR| STMFX | Linux
- * input pin | I2C device address | I2C device address
- *---------------------------------------------------------
- * 0 | b: 1000 010x h:0x84 | 0x42
- * 1 | b: 1000 011x h:0x86 | 0x43
- */
- if (FIELD_GET(STMFX_REG_CHIP_ID_MASK, ~id) != (chip->chip_addr << 1)) {
- dev_err(dev, "unknown chip id: %#x\n", id);
- return -EINVAL;
- }
- ret = dm_i2c_read(dev, STMFX_REG_FW_VERSION_MSB,
- version, sizeof(version));
- if (ret) {
- dev_err(dev, "error reading fw version: %d\n", ret);
- return ret;
- }
- dev_info(dev, "STMFX id: %#x, fw version: %x.%02x\n",
- id, version[0], version[1]);
- ret = dm_i2c_reg_read(dev, STMFX_REG_SYS_CTRL);
- if (ret < 0)
- return ret;
- ret = dm_i2c_reg_write(dev, STMFX_REG_SYS_CTRL,
- ret | STMFX_REG_SYS_CTRL_SWRST);
- if (ret)
- return ret;
- mdelay(STMFX_BOOT_TIME_MS);
- return ret;
- }
- static int stmfx_probe(struct udevice *dev)
- {
- struct udevice *vdd;
- int ret;
- ret = device_get_supply_regulator(dev, "vdd-supply", &vdd);
- if (ret && ret != -ENOENT) {
- dev_err(dev, "vdd regulator error:%d\n", ret);
- return ret;
- }
- if (!ret) {
- ret = regulator_set_enable(vdd, true);
- if (ret) {
- dev_err(dev, "vdd enable failed: %d\n", ret);
- return ret;
- }
- }
- return stmfx_chip_init(dev);
- }
- static const struct udevice_id stmfx_match[] = {
- { .compatible = "st,stmfx-0300", },
- };
- U_BOOT_DRIVER(stmfx) = {
- .name = "stmfx",
- .id = UCLASS_I2C_GENERIC,
- .of_match = of_match_ptr(stmfx_match),
- .probe = stmfx_probe,
- .bind = dm_scan_fdt_dev,
- };
|