xref: /rk3399_rockchip-uboot/drivers/gpio/gpio-uclass.c (revision 5395ac06d271209f5904a9da4392a3d8dad7597e)
196495d90SSimon Glass /*
296495d90SSimon Glass  * Copyright (c) 2013 Google, Inc
396495d90SSimon Glass  *
496495d90SSimon Glass  * SPDX-License-Identifier:	GPL-2.0+
596495d90SSimon Glass  */
696495d90SSimon Glass 
796495d90SSimon Glass #include <common.h>
896495d90SSimon Glass #include <dm.h>
97e044b9aSHeiko Schocher #include <dm/device-internal.h>
107e044b9aSHeiko Schocher #include <dm/lists.h>
117e044b9aSHeiko Schocher #include <dm/uclass-internal.h>
126c880b77SEric Nelson #include <dt-bindings/gpio/gpio.h>
1396495d90SSimon Glass #include <errno.h>
140dac4d51SSimon Glass #include <fdtdec.h>
15b892d127SSimon Glass #include <malloc.h>
1696495d90SSimon Glass #include <asm/gpio.h>
1784b8bf6dSMasahiro Yamada #include <linux/bug.h>
18fe1ef503SSimon Glass #include <linux/ctype.h>
1996495d90SSimon Glass 
203669e0e7SSimon Glass DECLARE_GLOBAL_DATA_PTR;
213669e0e7SSimon Glass 
2296495d90SSimon Glass /**
2396495d90SSimon Glass  * gpio_to_device() - Convert global GPIO number to device, number
2496495d90SSimon Glass  *
2596495d90SSimon Glass  * Convert the GPIO number to an entry in the list of GPIOs
2696495d90SSimon Glass  * or GPIO blocks registered with the GPIO controller. Returns
2796495d90SSimon Glass  * entry on success, NULL on error.
28ae7123f8SSimon Glass  *
29ae7123f8SSimon Glass  * @gpio:	The numeric representation of the GPIO
30ae7123f8SSimon Glass  * @desc:	Returns description (desc->flags will always be 0)
31ae7123f8SSimon Glass  * @return 0 if found, -ENOENT if not found
3296495d90SSimon Glass  */
gpio_to_device(unsigned int gpio,struct gpio_desc * desc)33ae7123f8SSimon Glass static int gpio_to_device(unsigned int gpio, struct gpio_desc *desc)
3496495d90SSimon Glass {
3596495d90SSimon Glass 	struct gpio_dev_priv *uc_priv;
3654c5d08aSHeiko Schocher 	struct udevice *dev;
3796495d90SSimon Glass 
38*5395ac06SMichal Suchanek 	for (uclass_first_device(UCLASS_GPIO, &dev);
3996495d90SSimon Glass 	     dev;
40*5395ac06SMichal Suchanek 	     uclass_next_device(&dev)) {
41e564f054SSimon Glass 		uc_priv = dev_get_uclass_priv(dev);
4296495d90SSimon Glass 		if (gpio >= uc_priv->gpio_base &&
4396495d90SSimon Glass 		    gpio < uc_priv->gpio_base + uc_priv->gpio_count) {
44ae7123f8SSimon Glass 			desc->dev = dev;
45ae7123f8SSimon Glass 			desc->offset = gpio - uc_priv->gpio_base;
46ae7123f8SSimon Glass 			desc->flags = 0;
4796495d90SSimon Glass 			return 0;
4896495d90SSimon Glass 		}
4996495d90SSimon Glass 	}
5096495d90SSimon Glass 
5196495d90SSimon Glass 	/* No such GPIO */
52*5395ac06SMichal Suchanek 	return -ENOENT;
5396495d90SSimon Glass }
5496495d90SSimon Glass 
dm_gpio_lookup_name(const char * name,struct gpio_desc * desc)5532ec1598SSimon Glass int dm_gpio_lookup_name(const char *name, struct gpio_desc *desc)
5696495d90SSimon Glass {
57fe1ef503SSimon Glass 	struct gpio_dev_priv *uc_priv = NULL;
5854c5d08aSHeiko Schocher 	struct udevice *dev;
59fe1ef503SSimon Glass 	ulong offset;
60fe1ef503SSimon Glass 	int numeric;
6196495d90SSimon Glass 
62fe1ef503SSimon Glass 	numeric = isdigit(*name) ? simple_strtoul(name, NULL, 10) : -1;
63*5395ac06SMichal Suchanek 	for (uclass_first_device(UCLASS_GPIO, &dev);
6496495d90SSimon Glass 	     dev;
65*5395ac06SMichal Suchanek 	     uclass_next_device(&dev)) {
6696495d90SSimon Glass 		int len;
6796495d90SSimon Glass 
68e564f054SSimon Glass 		uc_priv = dev_get_uclass_priv(dev);
69fe1ef503SSimon Glass 		if (numeric != -1) {
70fe1ef503SSimon Glass 			offset = numeric - uc_priv->gpio_base;
71fe1ef503SSimon Glass 			/* Allow GPIOs to be numbered from 0 */
7275897910STom Rini 			if (offset < uc_priv->gpio_count)
73fe1ef503SSimon Glass 				break;
74fe1ef503SSimon Glass 		}
75fe1ef503SSimon Glass 
7696495d90SSimon Glass 		len = uc_priv->bank_name ? strlen(uc_priv->bank_name) : 0;
7796495d90SSimon Glass 
78939cda5bSSimon Glass 		if (!strncasecmp(name, uc_priv->bank_name, len)) {
79fe1ef503SSimon Glass 			if (!strict_strtoul(name + len, 10, &offset))
80fe1ef503SSimon Glass 				break;
81fe1ef503SSimon Glass 		}
82fe1ef503SSimon Glass 	}
83fe1ef503SSimon Glass 
84fe1ef503SSimon Glass 	if (!dev)
85*5395ac06SMichal Suchanek 		return -EINVAL;
86fe1ef503SSimon Glass 
8732ec1598SSimon Glass 	desc->dev = dev;
8832ec1598SSimon Glass 	desc->offset = offset;
8932ec1598SSimon Glass 
9032ec1598SSimon Glass 	return 0;
9132ec1598SSimon Glass }
9232ec1598SSimon Glass 
gpio_lookup_name(const char * name,struct udevice ** devp,unsigned int * offsetp,unsigned int * gpiop)9332ec1598SSimon Glass int gpio_lookup_name(const char *name, struct udevice **devp,
9432ec1598SSimon Glass 		     unsigned int *offsetp, unsigned int *gpiop)
9532ec1598SSimon Glass {
9632ec1598SSimon Glass 	struct gpio_desc desc;
9732ec1598SSimon Glass 	int ret;
9832ec1598SSimon Glass 
9996495d90SSimon Glass 	if (devp)
10032ec1598SSimon Glass 		*devp = NULL;
10132ec1598SSimon Glass 	ret = dm_gpio_lookup_name(name, &desc);
10232ec1598SSimon Glass 	if (ret)
10332ec1598SSimon Glass 		return ret;
10432ec1598SSimon Glass 
10532ec1598SSimon Glass 	if (devp)
10632ec1598SSimon Glass 		*devp = desc.dev;
10796495d90SSimon Glass 	if (offsetp)
10832ec1598SSimon Glass 		*offsetp = desc.offset;
10932ec1598SSimon Glass 	if (gpiop) {
11032ec1598SSimon Glass 		struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(desc.dev);
11132ec1598SSimon Glass 
11232ec1598SSimon Glass 		*gpiop = uc_priv->gpio_base + desc.offset;
11332ec1598SSimon Glass 	}
11496495d90SSimon Glass 
115fe1ef503SSimon Glass 	return 0;
11696495d90SSimon Glass }
11796495d90SSimon Glass 
gpio_xlate_offs_flags(struct udevice * dev,struct gpio_desc * desc,struct ofnode_phandle_args * args)1183a57123eSSimon Glass int gpio_xlate_offs_flags(struct udevice *dev, struct gpio_desc *desc,
1193a57123eSSimon Glass 			  struct ofnode_phandle_args *args)
1206c880b77SEric Nelson {
1216c880b77SEric Nelson 	if (args->args_count < 1)
1226c880b77SEric Nelson 		return -EINVAL;
1236c880b77SEric Nelson 
1246c880b77SEric Nelson 	desc->offset = args->args[0];
1256c880b77SEric Nelson 
1266c880b77SEric Nelson 	if (args->args_count < 2)
1276c880b77SEric Nelson 		return 0;
1286c880b77SEric Nelson 
1296c880b77SEric Nelson 	if (args->args[1] & GPIO_ACTIVE_LOW)
1306c880b77SEric Nelson 		desc->flags = GPIOD_ACTIVE_LOW;
1316c880b77SEric Nelson 
1326c880b77SEric Nelson 	return 0;
1336c880b77SEric Nelson }
1346c880b77SEric Nelson 
gpio_find_and_xlate(struct gpio_desc * desc,struct ofnode_phandle_args * args)1353669e0e7SSimon Glass static int gpio_find_and_xlate(struct gpio_desc *desc,
1363a57123eSSimon Glass 			       struct ofnode_phandle_args *args)
1370dac4d51SSimon Glass {
1380dac4d51SSimon Glass 	struct dm_gpio_ops *ops = gpio_get_ops(desc->dev);
1390dac4d51SSimon Glass 
1406c880b77SEric Nelson 	if (ops->xlate)
1416c880b77SEric Nelson 		return ops->xlate(desc->dev, desc, args);
1420dac4d51SSimon Glass 	else
1436c880b77SEric Nelson 		return gpio_xlate_offs_flags(desc->dev, desc, args);
1440dac4d51SSimon Glass }
1450dac4d51SSimon Glass 
14625cd3b96SHeiko Schocher #if defined(CONFIG_GPIO_HOG)
1477e044b9aSHeiko Schocher 
1487e044b9aSHeiko Schocher struct gpio_hog_priv {
1497e044b9aSHeiko Schocher 	struct gpio_desc gpiod;
1507e044b9aSHeiko Schocher };
1517e044b9aSHeiko Schocher 
1527e044b9aSHeiko Schocher struct gpio_hog_data {
1537e044b9aSHeiko Schocher 	int gpiod_flags;
1547e044b9aSHeiko Schocher 	int value;
1557e044b9aSHeiko Schocher 	u32 val[2];
1567e044b9aSHeiko Schocher };
1577e044b9aSHeiko Schocher 
gpio_hog_ofdata_to_platdata(struct udevice * dev)1587e044b9aSHeiko Schocher static int gpio_hog_ofdata_to_platdata(struct udevice *dev)
1597e044b9aSHeiko Schocher {
1607e044b9aSHeiko Schocher 	struct gpio_hog_data *plat = dev_get_platdata(dev);
1617e044b9aSHeiko Schocher 	const char *nodename;
1627e044b9aSHeiko Schocher 	int ret;
1637e044b9aSHeiko Schocher 
1647e044b9aSHeiko Schocher 	plat->value = 0;
1657e044b9aSHeiko Schocher 	if (dev_read_bool(dev, "input")) {
1667e044b9aSHeiko Schocher 		plat->gpiod_flags = GPIOD_IS_IN;
1677e044b9aSHeiko Schocher 	} else if (dev_read_bool(dev, "output-high")) {
1687e044b9aSHeiko Schocher 		plat->value = 1;
1697e044b9aSHeiko Schocher 		plat->gpiod_flags = GPIOD_IS_OUT;
1707e044b9aSHeiko Schocher 	} else if (dev_read_bool(dev, "output-low")) {
1717e044b9aSHeiko Schocher 		plat->gpiod_flags = GPIOD_IS_OUT;
1727e044b9aSHeiko Schocher 	} else {
1737e044b9aSHeiko Schocher 		printf("%s: missing gpio-hog state.\n", __func__);
1747e044b9aSHeiko Schocher 		return -EINVAL;
1757e044b9aSHeiko Schocher 	}
1767e044b9aSHeiko Schocher 	ret = dev_read_u32_array(dev, "gpios", plat->val, 2);
1777e044b9aSHeiko Schocher 	if (ret) {
1787e044b9aSHeiko Schocher 		printf("%s: wrong gpios property, 2 values needed %d\n",
1797e044b9aSHeiko Schocher 		       __func__, ret);
1807e044b9aSHeiko Schocher 		return ret;
1817e044b9aSHeiko Schocher 	}
1827e044b9aSHeiko Schocher 	nodename = dev_read_string(dev, "line-name");
18325cd3b96SHeiko Schocher 	if (nodename)
1847e044b9aSHeiko Schocher 		device_set_name(dev, nodename);
1857e044b9aSHeiko Schocher 
1867e044b9aSHeiko Schocher 	return 0;
1877e044b9aSHeiko Schocher }
1887e044b9aSHeiko Schocher 
gpio_hog_probe(struct udevice * dev)1897e044b9aSHeiko Schocher static int gpio_hog_probe(struct udevice *dev)
1907e044b9aSHeiko Schocher {
1917e044b9aSHeiko Schocher 	struct gpio_hog_data *plat = dev_get_platdata(dev);
1927e044b9aSHeiko Schocher 	struct gpio_hog_priv *priv = dev_get_priv(dev);
1937e044b9aSHeiko Schocher 	int ret;
1947e044b9aSHeiko Schocher 
1957e044b9aSHeiko Schocher 	ret = gpio_dev_request_index(dev->parent, dev->name, "gpio-hog",
1967e044b9aSHeiko Schocher 				     plat->val[0], plat->gpiod_flags,
1977e044b9aSHeiko Schocher 				     plat->val[1], &priv->gpiod);
1987e044b9aSHeiko Schocher 	if (ret < 0) {
1997e044b9aSHeiko Schocher 		debug("%s: node %s could not get gpio.\n", __func__,
2007e044b9aSHeiko Schocher 		      dev->name);
2017e044b9aSHeiko Schocher 		return ret;
2027e044b9aSHeiko Schocher 	}
20325cd3b96SHeiko Schocher 
20425cd3b96SHeiko Schocher 	if (plat->gpiod_flags == GPIOD_IS_OUT) {
20525cd3b96SHeiko Schocher 		ret = dm_gpio_set_value(&priv->gpiod, plat->value);
20625cd3b96SHeiko Schocher 		if (ret < 0) {
20725cd3b96SHeiko Schocher 			debug("%s: node %s could not set gpio.\n", __func__,
20825cd3b96SHeiko Schocher 			      dev->name);
20925cd3b96SHeiko Schocher 			return ret;
21025cd3b96SHeiko Schocher 		}
21125cd3b96SHeiko Schocher 	}
2127e044b9aSHeiko Schocher 
2137e044b9aSHeiko Schocher 	return 0;
2147e044b9aSHeiko Schocher }
2157e044b9aSHeiko Schocher 
gpio_hog_probe_all(void)2167e044b9aSHeiko Schocher int gpio_hog_probe_all(void)
2177e044b9aSHeiko Schocher {
2187e044b9aSHeiko Schocher 	struct udevice *dev;
2197e044b9aSHeiko Schocher 	int ret;
22025cd3b96SHeiko Schocher 	int retval = 0;
2217e044b9aSHeiko Schocher 
2227e044b9aSHeiko Schocher 	for (uclass_find_first_device(UCLASS_NOP, &dev);
2237e044b9aSHeiko Schocher 	     dev;
2247e044b9aSHeiko Schocher 	     uclass_find_next_device(&dev)) {
2257e044b9aSHeiko Schocher 		if (dev->driver == DM_GET_DRIVER(gpio_hog)) {
2267e044b9aSHeiko Schocher 			ret = device_probe(dev);
22725cd3b96SHeiko Schocher 			if (ret) {
22825cd3b96SHeiko Schocher 				printf("Failed to probe device %s err: %d\n",
22925cd3b96SHeiko Schocher 				       dev->name, ret);
23025cd3b96SHeiko Schocher 				retval = ret;
23125cd3b96SHeiko Schocher 			}
2327e044b9aSHeiko Schocher 		}
2337e044b9aSHeiko Schocher 	}
2347e044b9aSHeiko Schocher 
23525cd3b96SHeiko Schocher 	return retval;
2367e044b9aSHeiko Schocher }
2377e044b9aSHeiko Schocher 
gpio_hog_lookup_name(const char * name,struct gpio_desc ** desc)23825cd3b96SHeiko Schocher int gpio_hog_lookup_name(const char *name, struct gpio_desc **desc)
2397e044b9aSHeiko Schocher {
2407e044b9aSHeiko Schocher 	struct udevice *dev;
2417e044b9aSHeiko Schocher 
24225cd3b96SHeiko Schocher 	*desc = NULL;
2437e044b9aSHeiko Schocher 	gpio_hog_probe_all();
2447e044b9aSHeiko Schocher 	if (!uclass_get_device_by_name(UCLASS_NOP, name, &dev)) {
2457e044b9aSHeiko Schocher 		struct gpio_hog_priv *priv = dev_get_priv(dev);
2467e044b9aSHeiko Schocher 
24725cd3b96SHeiko Schocher 		*desc = &priv->gpiod;
24825cd3b96SHeiko Schocher 		return 0;
2497e044b9aSHeiko Schocher 	}
2507e044b9aSHeiko Schocher 
25125cd3b96SHeiko Schocher 	return -ENODEV;
2527e044b9aSHeiko Schocher }
2537e044b9aSHeiko Schocher 
2547e044b9aSHeiko Schocher U_BOOT_DRIVER(gpio_hog) = {
2557e044b9aSHeiko Schocher 	.name	= "gpio_hog",
2567e044b9aSHeiko Schocher 	.id	= UCLASS_NOP,
2577e044b9aSHeiko Schocher 	.ofdata_to_platdata = gpio_hog_ofdata_to_platdata,
2587e044b9aSHeiko Schocher 	.probe = gpio_hog_probe,
2597e044b9aSHeiko Schocher 	.priv_auto_alloc_size = sizeof(struct gpio_hog_priv),
2607e044b9aSHeiko Schocher 	.platdata_auto_alloc_size = sizeof(struct gpio_hog_data),
2617e044b9aSHeiko Schocher };
2627e044b9aSHeiko Schocher #else
gpio_hog_lookup_name(const char * name,struct gpio_desc ** desc)26325cd3b96SHeiko Schocher int gpio_hog_lookup_name(const char *name, struct gpio_desc **desc)
2647e044b9aSHeiko Schocher {
26525cd3b96SHeiko Schocher 	return 0;
2667e044b9aSHeiko Schocher }
2677e044b9aSHeiko Schocher #endif
2687e044b9aSHeiko Schocher 
dm_gpio_request(struct gpio_desc * desc,const char * label)269efa677fbSSimon Glass int dm_gpio_request(struct gpio_desc *desc, const char *label)
270ae7123f8SSimon Glass {
271ae7123f8SSimon Glass 	struct udevice *dev = desc->dev;
272ae7123f8SSimon Glass 	struct gpio_dev_priv *uc_priv;
273ae7123f8SSimon Glass 	char *str;
274ae7123f8SSimon Glass 	int ret;
275ae7123f8SSimon Glass 
276e564f054SSimon Glass 	uc_priv = dev_get_uclass_priv(dev);
277ae7123f8SSimon Glass 	if (uc_priv->name[desc->offset])
278ae7123f8SSimon Glass 		return -EBUSY;
279ae7123f8SSimon Glass 	str = strdup(label);
280ae7123f8SSimon Glass 	if (!str)
281ae7123f8SSimon Glass 		return -ENOMEM;
282ae7123f8SSimon Glass 	if (gpio_get_ops(dev)->request) {
283ae7123f8SSimon Glass 		ret = gpio_get_ops(dev)->request(dev, desc->offset, label);
284ae7123f8SSimon Glass 		if (ret) {
285ae7123f8SSimon Glass 			free(str);
286ae7123f8SSimon Glass 			return ret;
287ae7123f8SSimon Glass 		}
288ae7123f8SSimon Glass 	}
289ae7123f8SSimon Glass 	uc_priv->name[desc->offset] = str;
290ae7123f8SSimon Glass 
291ae7123f8SSimon Glass 	return 0;
292ae7123f8SSimon Glass }
293ae7123f8SSimon Glass 
dm_gpio_requestf(struct gpio_desc * desc,const char * fmt,...)2943669e0e7SSimon Glass static int dm_gpio_requestf(struct gpio_desc *desc, const char *fmt, ...)
2953669e0e7SSimon Glass {
2964dc5259aSSimon Glass #if !defined(CONFIG_SPL_BUILD) || !defined(CONFIG_USE_TINY_PRINTF)
2973669e0e7SSimon Glass 	va_list args;
2983669e0e7SSimon Glass 	char buf[40];
2993669e0e7SSimon Glass 
3003669e0e7SSimon Glass 	va_start(args, fmt);
3013669e0e7SSimon Glass 	vscnprintf(buf, sizeof(buf), fmt, args);
3023669e0e7SSimon Glass 	va_end(args);
3033669e0e7SSimon Glass 	return dm_gpio_request(desc, buf);
3044dc5259aSSimon Glass #else
3054dc5259aSSimon Glass 	return dm_gpio_request(desc, fmt);
3064dc5259aSSimon Glass #endif
3073669e0e7SSimon Glass }
3083669e0e7SSimon Glass 
30996495d90SSimon Glass /**
31096495d90SSimon Glass  * gpio_request() - [COMPAT] Request GPIO
31196495d90SSimon Glass  * gpio:	GPIO number
31296495d90SSimon Glass  * label:	Name for the requested GPIO
31396495d90SSimon Glass  *
314b892d127SSimon Glass  * The label is copied and allocated so the caller does not need to keep
315b892d127SSimon Glass  * the pointer around.
316b892d127SSimon Glass  *
31796495d90SSimon Glass  * This function implements the API that's compatible with current
31896495d90SSimon Glass  * GPIO API used in U-Boot. The request is forwarded to particular
31996495d90SSimon Glass  * GPIO driver. Returns 0 on success, negative value on error.
32096495d90SSimon Glass  */
gpio_request(unsigned gpio,const char * label)32196495d90SSimon Glass int gpio_request(unsigned gpio, const char *label)
32296495d90SSimon Glass {
323ae7123f8SSimon Glass 	struct gpio_desc desc;
32496495d90SSimon Glass 	int ret;
32596495d90SSimon Glass 
326ae7123f8SSimon Glass 	ret = gpio_to_device(gpio, &desc);
32796495d90SSimon Glass 	if (ret)
32896495d90SSimon Glass 		return ret;
32996495d90SSimon Glass 
330ae7123f8SSimon Glass 	return dm_gpio_request(&desc, label);
33196495d90SSimon Glass }
33296495d90SSimon Glass 
33396495d90SSimon Glass /**
334d44f597bSSimon Glass  * gpio_requestf() - [COMPAT] Request GPIO
335d44f597bSSimon Glass  * @gpio:	GPIO number
336d44f597bSSimon Glass  * @fmt:	Format string for the requested GPIO
337d44f597bSSimon Glass  * @...:	Arguments for the printf() format string
338d44f597bSSimon Glass  *
339d44f597bSSimon Glass  * This function implements the API that's compatible with current
340d44f597bSSimon Glass  * GPIO API used in U-Boot. The request is forwarded to particular
341d44f597bSSimon Glass  * GPIO driver. Returns 0 on success, negative value on error.
342d44f597bSSimon Glass  */
gpio_requestf(unsigned gpio,const char * fmt,...)343d44f597bSSimon Glass int gpio_requestf(unsigned gpio, const char *fmt, ...)
344d44f597bSSimon Glass {
3454dc5259aSSimon Glass #if !defined(CONFIG_SPL_BUILD) || !defined(CONFIG_USE_TINY_PRINTF)
346d44f597bSSimon Glass 	va_list args;
347d44f597bSSimon Glass 	char buf[40];
348d44f597bSSimon Glass 
349d44f597bSSimon Glass 	va_start(args, fmt);
350d44f597bSSimon Glass 	vscnprintf(buf, sizeof(buf), fmt, args);
351d44f597bSSimon Glass 	va_end(args);
352d44f597bSSimon Glass 	return gpio_request(gpio, buf);
3534dc5259aSSimon Glass #else
3544dc5259aSSimon Glass 	return gpio_request(gpio, fmt);
3554dc5259aSSimon Glass #endif
356d44f597bSSimon Glass }
357d44f597bSSimon Glass 
_dm_gpio_free(struct udevice * dev,uint offset)358ae7123f8SSimon Glass int _dm_gpio_free(struct udevice *dev, uint offset)
35996495d90SSimon Glass {
360b892d127SSimon Glass 	struct gpio_dev_priv *uc_priv;
36196495d90SSimon Glass 	int ret;
36296495d90SSimon Glass 
363e564f054SSimon Glass 	uc_priv = dev_get_uclass_priv(dev);
364b892d127SSimon Glass 	if (!uc_priv->name[offset])
365b892d127SSimon Glass 		return -ENXIO;
366b892d127SSimon Glass 	if (gpio_get_ops(dev)->free) {
367b892d127SSimon Glass 		ret = gpio_get_ops(dev)->free(dev, offset);
368b892d127SSimon Glass 		if (ret)
369b892d127SSimon Glass 			return ret;
370b892d127SSimon Glass 	}
371b892d127SSimon Glass 
372b892d127SSimon Glass 	free(uc_priv->name[offset]);
373b892d127SSimon Glass 	uc_priv->name[offset] = NULL;
374b892d127SSimon Glass 
37596495d90SSimon Glass 	return 0;
376b892d127SSimon Glass }
377b892d127SSimon Glass 
378ae7123f8SSimon Glass /**
379ae7123f8SSimon Glass  * gpio_free() - [COMPAT] Relinquish GPIO
380ae7123f8SSimon Glass  * gpio:	GPIO number
381ae7123f8SSimon Glass  *
382ae7123f8SSimon Glass  * This function implements the API that's compatible with current
383ae7123f8SSimon Glass  * GPIO API used in U-Boot. The request is forwarded to particular
384ae7123f8SSimon Glass  * GPIO driver. Returns 0 on success, negative value on error.
385ae7123f8SSimon Glass  */
gpio_free(unsigned gpio)386ae7123f8SSimon Glass int gpio_free(unsigned gpio)
387b892d127SSimon Glass {
388ae7123f8SSimon Glass 	struct gpio_desc desc;
389ae7123f8SSimon Glass 	int ret;
390b892d127SSimon Glass 
391ae7123f8SSimon Glass 	ret = gpio_to_device(gpio, &desc);
392ae7123f8SSimon Glass 	if (ret)
393ae7123f8SSimon Glass 		return ret;
394ae7123f8SSimon Glass 
395ae7123f8SSimon Glass 	return _dm_gpio_free(desc.dev, desc.offset);
396ae7123f8SSimon Glass }
397ae7123f8SSimon Glass 
check_reserved(const struct gpio_desc * desc,const char * func)39817c43f1aSSimon Glass static int check_reserved(const struct gpio_desc *desc, const char *func)
399ae7123f8SSimon Glass {
400eca48665SSimon Glass 	struct gpio_dev_priv *uc_priv;
401ae7123f8SSimon Glass 
402eca48665SSimon Glass 	if (!dm_gpio_is_valid(desc))
403eca48665SSimon Glass 		return -ENOENT;
404eca48665SSimon Glass 
405eca48665SSimon Glass 	uc_priv = dev_get_uclass_priv(desc->dev);
406ae7123f8SSimon Glass 	if (!uc_priv->name[desc->offset]) {
407b892d127SSimon Glass 		printf("%s: %s: error: gpio %s%d not reserved\n",
408ae7123f8SSimon Glass 		       desc->dev->name, func,
409ae7123f8SSimon Glass 		       uc_priv->bank_name ? uc_priv->bank_name : "",
410ae7123f8SSimon Glass 		       desc->offset);
411b892d127SSimon Glass 		return -EBUSY;
412b892d127SSimon Glass 	}
413b892d127SSimon Glass 
414b892d127SSimon Glass 	return 0;
41596495d90SSimon Glass }
41696495d90SSimon Glass 
41796495d90SSimon Glass /**
41896495d90SSimon Glass  * gpio_direction_input() - [COMPAT] Set GPIO direction to input
41996495d90SSimon Glass  * gpio:	GPIO number
42096495d90SSimon Glass  *
42196495d90SSimon Glass  * This function implements the API that's compatible with current
42296495d90SSimon Glass  * GPIO API used in U-Boot. The request is forwarded to particular
42396495d90SSimon Glass  * GPIO driver. Returns 0 on success, negative value on error.
42496495d90SSimon Glass  */
gpio_direction_input(unsigned gpio)42596495d90SSimon Glass int gpio_direction_input(unsigned gpio)
42696495d90SSimon Glass {
427ae7123f8SSimon Glass 	struct gpio_desc desc;
42896495d90SSimon Glass 	int ret;
42996495d90SSimon Glass 
430ae7123f8SSimon Glass 	ret = gpio_to_device(gpio, &desc);
43196495d90SSimon Glass 	if (ret)
43296495d90SSimon Glass 		return ret;
433ae7123f8SSimon Glass 	ret = check_reserved(&desc, "dir_input");
434ae7123f8SSimon Glass 	if (ret)
435ae7123f8SSimon Glass 		return ret;
43696495d90SSimon Glass 
437ae7123f8SSimon Glass 	return gpio_get_ops(desc.dev)->direction_input(desc.dev, desc.offset);
43896495d90SSimon Glass }
43996495d90SSimon Glass 
44096495d90SSimon Glass /**
44196495d90SSimon Glass  * gpio_direction_output() - [COMPAT] Set GPIO direction to output and set value
44296495d90SSimon Glass  * gpio:	GPIO number
44396495d90SSimon Glass  * value:	Logical value to be set on the GPIO pin
44496495d90SSimon Glass  *
44596495d90SSimon Glass  * This function implements the API that's compatible with current
44696495d90SSimon Glass  * GPIO API used in U-Boot. The request is forwarded to particular
44796495d90SSimon Glass  * GPIO driver. Returns 0 on success, negative value on error.
44896495d90SSimon Glass  */
gpio_direction_output(unsigned gpio,int value)44996495d90SSimon Glass int gpio_direction_output(unsigned gpio, int value)
45096495d90SSimon Glass {
451ae7123f8SSimon Glass 	struct gpio_desc desc;
45296495d90SSimon Glass 	int ret;
45396495d90SSimon Glass 
454ae7123f8SSimon Glass 	ret = gpio_to_device(gpio, &desc);
45596495d90SSimon Glass 	if (ret)
45696495d90SSimon Glass 		return ret;
457ae7123f8SSimon Glass 	ret = check_reserved(&desc, "dir_output");
458ae7123f8SSimon Glass 	if (ret)
459ae7123f8SSimon Glass 		return ret;
46096495d90SSimon Glass 
461ae7123f8SSimon Glass 	return gpio_get_ops(desc.dev)->direction_output(desc.dev,
462ae7123f8SSimon Glass 							desc.offset, value);
463ae7123f8SSimon Glass }
464ae7123f8SSimon Glass 
dm_gpio_get_value(const struct gpio_desc * desc)46517c43f1aSSimon Glass int dm_gpio_get_value(const struct gpio_desc *desc)
466ae7123f8SSimon Glass {
467ae7123f8SSimon Glass 	int value;
468ae7123f8SSimon Glass 	int ret;
469ae7123f8SSimon Glass 
470ae7123f8SSimon Glass 	ret = check_reserved(desc, "get_value");
471ae7123f8SSimon Glass 	if (ret)
472ae7123f8SSimon Glass 		return ret;
473ae7123f8SSimon Glass 
474ae7123f8SSimon Glass 	value = gpio_get_ops(desc->dev)->get_value(desc->dev, desc->offset);
475ae7123f8SSimon Glass 
476ae7123f8SSimon Glass 	return desc->flags & GPIOD_ACTIVE_LOW ? !value : value;
477ae7123f8SSimon Glass }
478ae7123f8SSimon Glass 
dm_gpio_set_value(const struct gpio_desc * desc,int value)47917c43f1aSSimon Glass int dm_gpio_set_value(const struct gpio_desc *desc, int value)
480ae7123f8SSimon Glass {
481ae7123f8SSimon Glass 	int ret;
482ae7123f8SSimon Glass 
483ae7123f8SSimon Glass 	ret = check_reserved(desc, "set_value");
484ae7123f8SSimon Glass 	if (ret)
485ae7123f8SSimon Glass 		return ret;
486ae7123f8SSimon Glass 
487ae7123f8SSimon Glass 	if (desc->flags & GPIOD_ACTIVE_LOW)
488ae7123f8SSimon Glass 		value = !value;
489ae7123f8SSimon Glass 	gpio_get_ops(desc->dev)->set_value(desc->dev, desc->offset, value);
490ae7123f8SSimon Glass 	return 0;
491ae7123f8SSimon Glass }
492ae7123f8SSimon Glass 
dm_gpio_get_open_drain(struct gpio_desc * desc)49353ecdfb9Smario.six@gdsys.cc int dm_gpio_get_open_drain(struct gpio_desc *desc)
49453ecdfb9Smario.six@gdsys.cc {
49553ecdfb9Smario.six@gdsys.cc 	struct dm_gpio_ops *ops = gpio_get_ops(desc->dev);
49653ecdfb9Smario.six@gdsys.cc 	int ret;
49753ecdfb9Smario.six@gdsys.cc 
49853ecdfb9Smario.six@gdsys.cc 	ret = check_reserved(desc, "get_open_drain");
49953ecdfb9Smario.six@gdsys.cc 	if (ret)
50053ecdfb9Smario.six@gdsys.cc 		return ret;
50153ecdfb9Smario.six@gdsys.cc 
50253ecdfb9Smario.six@gdsys.cc 	if (ops->set_open_drain)
50353ecdfb9Smario.six@gdsys.cc 		return ops->get_open_drain(desc->dev, desc->offset);
50453ecdfb9Smario.six@gdsys.cc 	else
50553ecdfb9Smario.six@gdsys.cc 		return -ENOSYS;
50653ecdfb9Smario.six@gdsys.cc }
50753ecdfb9Smario.six@gdsys.cc 
dm_gpio_set_open_drain(struct gpio_desc * desc,int value)50853ecdfb9Smario.six@gdsys.cc int dm_gpio_set_open_drain(struct gpio_desc *desc, int value)
50953ecdfb9Smario.six@gdsys.cc {
51053ecdfb9Smario.six@gdsys.cc 	struct dm_gpio_ops *ops = gpio_get_ops(desc->dev);
51153ecdfb9Smario.six@gdsys.cc 	int ret;
51253ecdfb9Smario.six@gdsys.cc 
51353ecdfb9Smario.six@gdsys.cc 	ret = check_reserved(desc, "set_open_drain");
51453ecdfb9Smario.six@gdsys.cc 	if (ret)
51553ecdfb9Smario.six@gdsys.cc 		return ret;
51653ecdfb9Smario.six@gdsys.cc 
51753ecdfb9Smario.six@gdsys.cc 	if (ops->set_open_drain)
51853ecdfb9Smario.six@gdsys.cc 		ret = ops->set_open_drain(desc->dev, desc->offset, value);
51953ecdfb9Smario.six@gdsys.cc 	else
52053ecdfb9Smario.six@gdsys.cc 		return 0; /* feature not supported -> ignore setting */
52153ecdfb9Smario.six@gdsys.cc 
52253ecdfb9Smario.six@gdsys.cc 	return ret;
52353ecdfb9Smario.six@gdsys.cc }
52453ecdfb9Smario.six@gdsys.cc 
dm_gpio_set_dir_flags(struct gpio_desc * desc,ulong flags)525ae7123f8SSimon Glass int dm_gpio_set_dir_flags(struct gpio_desc *desc, ulong flags)
526ae7123f8SSimon Glass {
527ae7123f8SSimon Glass 	struct udevice *dev = desc->dev;
528ae7123f8SSimon Glass 	struct dm_gpio_ops *ops = gpio_get_ops(dev);
529ae7123f8SSimon Glass 	int ret;
530ae7123f8SSimon Glass 
531ae7123f8SSimon Glass 	ret = check_reserved(desc, "set_dir");
532ae7123f8SSimon Glass 	if (ret)
533ae7123f8SSimon Glass 		return ret;
534ae7123f8SSimon Glass 
535ae7123f8SSimon Glass 	if (flags & GPIOD_IS_OUT) {
536ae7123f8SSimon Glass 		int value = flags & GPIOD_IS_OUT_ACTIVE ? 1 : 0;
537ae7123f8SSimon Glass 
538ae7123f8SSimon Glass 		if (flags & GPIOD_ACTIVE_LOW)
539ae7123f8SSimon Glass 			value = !value;
540ae7123f8SSimon Glass 		ret = ops->direction_output(dev, desc->offset, value);
541ae7123f8SSimon Glass 	} else  if (flags & GPIOD_IS_IN) {
542ae7123f8SSimon Glass 		ret = ops->direction_input(dev, desc->offset);
543ae7123f8SSimon Glass 	}
544ae7123f8SSimon Glass 	if (ret)
545ae7123f8SSimon Glass 		return ret;
546ae7123f8SSimon Glass 	/*
547ae7123f8SSimon Glass 	 * Update desc->flags here, so that GPIO_ACTIVE_LOW is honoured in
548ae7123f8SSimon Glass 	 * futures
549ae7123f8SSimon Glass 	 */
550ae7123f8SSimon Glass 	desc->flags = flags;
551ae7123f8SSimon Glass 
552ae7123f8SSimon Glass 	return 0;
553ae7123f8SSimon Glass }
554ae7123f8SSimon Glass 
dm_gpio_set_dir(struct gpio_desc * desc)555ae7123f8SSimon Glass int dm_gpio_set_dir(struct gpio_desc *desc)
556ae7123f8SSimon Glass {
557ae7123f8SSimon Glass 	return dm_gpio_set_dir_flags(desc, desc->flags);
55896495d90SSimon Glass }
55996495d90SSimon Glass 
56096495d90SSimon Glass /**
56196495d90SSimon Glass  * gpio_get_value() - [COMPAT] Sample GPIO pin and return it's value
56296495d90SSimon Glass  * gpio:	GPIO number
56396495d90SSimon Glass  *
56496495d90SSimon Glass  * This function implements the API that's compatible with current
56596495d90SSimon Glass  * GPIO API used in U-Boot. The request is forwarded to particular
56696495d90SSimon Glass  * GPIO driver. Returns the value of the GPIO pin, or negative value
56796495d90SSimon Glass  * on error.
56896495d90SSimon Glass  */
gpio_get_value(unsigned gpio)56996495d90SSimon Glass int gpio_get_value(unsigned gpio)
57096495d90SSimon Glass {
57196495d90SSimon Glass 	int ret;
57296495d90SSimon Glass 
573ae7123f8SSimon Glass 	struct gpio_desc desc;
574ae7123f8SSimon Glass 
575ae7123f8SSimon Glass 	ret = gpio_to_device(gpio, &desc);
57696495d90SSimon Glass 	if (ret)
57796495d90SSimon Glass 		return ret;
578ae7123f8SSimon Glass 	return dm_gpio_get_value(&desc);
57996495d90SSimon Glass }
58096495d90SSimon Glass 
58196495d90SSimon Glass /**
58296495d90SSimon Glass  * gpio_set_value() - [COMPAT] Configure logical value on GPIO pin
58396495d90SSimon Glass  * gpio:	GPIO number
58496495d90SSimon Glass  * value:	Logical value to be set on the GPIO pin.
58596495d90SSimon Glass  *
58696495d90SSimon Glass  * This function implements the API that's compatible with current
58796495d90SSimon Glass  * GPIO API used in U-Boot. The request is forwarded to particular
58896495d90SSimon Glass  * GPIO driver. Returns 0 on success, negative value on error.
58996495d90SSimon Glass  */
gpio_set_value(unsigned gpio,int value)59096495d90SSimon Glass int gpio_set_value(unsigned gpio, int value)
59196495d90SSimon Glass {
592ae7123f8SSimon Glass 	struct gpio_desc desc;
59396495d90SSimon Glass 	int ret;
59496495d90SSimon Glass 
595ae7123f8SSimon Glass 	ret = gpio_to_device(gpio, &desc);
59696495d90SSimon Glass 	if (ret)
59796495d90SSimon Glass 		return ret;
598ae7123f8SSimon Glass 	return dm_gpio_set_value(&desc, value);
59996495d90SSimon Glass }
60096495d90SSimon Glass 
gpio_get_bank_info(struct udevice * dev,int * bit_count)60154c5d08aSHeiko Schocher const char *gpio_get_bank_info(struct udevice *dev, int *bit_count)
60296495d90SSimon Glass {
60396495d90SSimon Glass 	struct gpio_dev_priv *priv;
60496495d90SSimon Glass 
60596495d90SSimon Glass 	/* Must be called on an active device */
606e564f054SSimon Glass 	priv = dev_get_uclass_priv(dev);
60796495d90SSimon Glass 	assert(priv);
60896495d90SSimon Glass 
60996495d90SSimon Glass 	*bit_count = priv->gpio_count;
61096495d90SSimon Glass 	return priv->bank_name;
61196495d90SSimon Glass }
61296495d90SSimon Glass 
6136449a506SSimon Glass static const char * const gpio_function[GPIOF_COUNT] = {
6146449a506SSimon Glass 	"input",
6156449a506SSimon Glass 	"output",
6166449a506SSimon Glass 	"unused",
6176449a506SSimon Glass 	"unknown",
6186449a506SSimon Glass 	"func",
6196449a506SSimon Glass };
6206449a506SSimon Glass 
get_function(struct udevice * dev,int offset,bool skip_unused,const char ** namep)621fb07f97dSMasahiro Yamada static int get_function(struct udevice *dev, int offset, bool skip_unused,
6226449a506SSimon Glass 			const char **namep)
6236449a506SSimon Glass {
624e564f054SSimon Glass 	struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
6256449a506SSimon Glass 	struct dm_gpio_ops *ops = gpio_get_ops(dev);
6266449a506SSimon Glass 
6276449a506SSimon Glass 	BUILD_BUG_ON(GPIOF_COUNT != ARRAY_SIZE(gpio_function));
6286449a506SSimon Glass 	if (!device_active(dev))
6296449a506SSimon Glass 		return -ENODEV;
6306449a506SSimon Glass 	if (offset < 0 || offset >= uc_priv->gpio_count)
6316449a506SSimon Glass 		return -EINVAL;
6326449a506SSimon Glass 	if (namep)
6336449a506SSimon Glass 		*namep = uc_priv->name[offset];
6346449a506SSimon Glass 	if (skip_unused && !uc_priv->name[offset])
6356449a506SSimon Glass 		return GPIOF_UNUSED;
6366449a506SSimon Glass 	if (ops->get_function) {
6376449a506SSimon Glass 		int ret;
6386449a506SSimon Glass 
6396449a506SSimon Glass 		ret = ops->get_function(dev, offset);
6406449a506SSimon Glass 		if (ret < 0)
6416449a506SSimon Glass 			return ret;
6426449a506SSimon Glass 		if (ret >= ARRAY_SIZE(gpio_function))
6436449a506SSimon Glass 			return -ENODATA;
6446449a506SSimon Glass 		return ret;
6456449a506SSimon Glass 	}
6466449a506SSimon Glass 
6476449a506SSimon Glass 	return GPIOF_UNKNOWN;
6486449a506SSimon Glass }
6496449a506SSimon Glass 
gpio_get_function(struct udevice * dev,int offset,const char ** namep)6506449a506SSimon Glass int gpio_get_function(struct udevice *dev, int offset, const char **namep)
6516449a506SSimon Glass {
6526449a506SSimon Glass 	return get_function(dev, offset, true, namep);
6536449a506SSimon Glass }
6546449a506SSimon Glass 
gpio_get_raw_function(struct udevice * dev,int offset,const char ** namep)6556449a506SSimon Glass int gpio_get_raw_function(struct udevice *dev, int offset, const char **namep)
6566449a506SSimon Glass {
6576449a506SSimon Glass 	return get_function(dev, offset, false, namep);
6586449a506SSimon Glass }
6596449a506SSimon Glass 
gpio_get_status(struct udevice * dev,int offset,char * buf,int buffsize)6600757535aSSimon Glass int gpio_get_status(struct udevice *dev, int offset, char *buf, int buffsize)
6610757535aSSimon Glass {
6620757535aSSimon Glass 	struct dm_gpio_ops *ops = gpio_get_ops(dev);
6630757535aSSimon Glass 	struct gpio_dev_priv *priv;
6640757535aSSimon Glass 	char *str = buf;
6650757535aSSimon Glass 	int func;
6660757535aSSimon Glass 	int ret;
6670757535aSSimon Glass 	int len;
6680757535aSSimon Glass 
6690757535aSSimon Glass 	BUILD_BUG_ON(GPIOF_COUNT != ARRAY_SIZE(gpio_function));
6700757535aSSimon Glass 
6710757535aSSimon Glass 	*buf = 0;
672e564f054SSimon Glass 	priv = dev_get_uclass_priv(dev);
6730757535aSSimon Glass 	ret = gpio_get_raw_function(dev, offset, NULL);
6740757535aSSimon Glass 	if (ret < 0)
6750757535aSSimon Glass 		return ret;
6760757535aSSimon Glass 	func = ret;
6770757535aSSimon Glass 	len = snprintf(str, buffsize, "%s%d: %s",
6780757535aSSimon Glass 		       priv->bank_name ? priv->bank_name : "",
6790757535aSSimon Glass 		       offset, gpio_function[func]);
6800757535aSSimon Glass 	if (func == GPIOF_INPUT || func == GPIOF_OUTPUT ||
6810757535aSSimon Glass 	    func == GPIOF_UNUSED) {
6820757535aSSimon Glass 		const char *label;
6830757535aSSimon Glass 		bool used;
6840757535aSSimon Glass 
6850757535aSSimon Glass 		ret = ops->get_value(dev, offset);
6860757535aSSimon Glass 		if (ret < 0)
6870757535aSSimon Glass 			return ret;
6880757535aSSimon Glass 		used = gpio_get_function(dev, offset, &label) != GPIOF_UNUSED;
6890757535aSSimon Glass 		snprintf(str + len, buffsize - len, ": %d [%c]%s%s",
6900757535aSSimon Glass 			 ret,
6910757535aSSimon Glass 			 used ? 'x' : ' ',
6920757535aSSimon Glass 			 used ? " " : "",
6930757535aSSimon Glass 			 label ? label : "");
6940757535aSSimon Glass 	}
6950757535aSSimon Glass 
6960757535aSSimon Glass 	return 0;
6970757535aSSimon Glass }
6980757535aSSimon Glass 
gpio_claim_vector(const int * gpio_num_array,const char * fmt)699962f5cafSSimon Glass int gpio_claim_vector(const int *gpio_num_array, const char *fmt)
700962f5cafSSimon Glass {
701962f5cafSSimon Glass 	int i, ret;
702962f5cafSSimon Glass 	int gpio;
703962f5cafSSimon Glass 
704962f5cafSSimon Glass 	for (i = 0; i < 32; i++) {
705962f5cafSSimon Glass 		gpio = gpio_num_array[i];
706962f5cafSSimon Glass 		if (gpio == -1)
707962f5cafSSimon Glass 			break;
708962f5cafSSimon Glass 		ret = gpio_requestf(gpio, fmt, i);
709962f5cafSSimon Glass 		if (ret)
710962f5cafSSimon Glass 			goto err;
711962f5cafSSimon Glass 		ret = gpio_direction_input(gpio);
712962f5cafSSimon Glass 		if (ret) {
713962f5cafSSimon Glass 			gpio_free(gpio);
714962f5cafSSimon Glass 			goto err;
715962f5cafSSimon Glass 		}
716962f5cafSSimon Glass 	}
717962f5cafSSimon Glass 
718962f5cafSSimon Glass 	return 0;
719962f5cafSSimon Glass err:
720962f5cafSSimon Glass 	for (i--; i >= 0; i--)
721962f5cafSSimon Glass 		gpio_free(gpio_num_array[i]);
722962f5cafSSimon Glass 
723962f5cafSSimon Glass 	return ret;
724962f5cafSSimon Glass }
725962f5cafSSimon Glass 
726e5901c94SSimon Glass /*
727e5901c94SSimon Glass  * get a number comprised of multiple GPIO values. gpio_num_array points to
728e5901c94SSimon Glass  * the array of gpio pin numbers to scan, terminated by -1.
729e5901c94SSimon Glass  */
gpio_get_values_as_int(const int * gpio_list)730962f5cafSSimon Glass int gpio_get_values_as_int(const int *gpio_list)
731e5901c94SSimon Glass {
732e5901c94SSimon Glass 	int gpio;
733e5901c94SSimon Glass 	unsigned bitmask = 1;
734e5901c94SSimon Glass 	unsigned vector = 0;
735962f5cafSSimon Glass 	int ret;
736e5901c94SSimon Glass 
737e5901c94SSimon Glass 	while (bitmask &&
738962f5cafSSimon Glass 	       ((gpio = *gpio_list++) != -1)) {
739962f5cafSSimon Glass 		ret = gpio_get_value(gpio);
740962f5cafSSimon Glass 		if (ret < 0)
741962f5cafSSimon Glass 			return ret;
742962f5cafSSimon Glass 		else if (ret)
743e5901c94SSimon Glass 			vector |= bitmask;
744e5901c94SSimon Glass 		bitmask <<= 1;
745e5901c94SSimon Glass 	}
746962f5cafSSimon Glass 
747e5901c94SSimon Glass 	return vector;
748e5901c94SSimon Glass }
749e5901c94SSimon Glass 
dm_gpio_get_values_as_int(const struct gpio_desc * desc_list,int count)75017c43f1aSSimon Glass int dm_gpio_get_values_as_int(const struct gpio_desc *desc_list, int count)
751bbf24780SSimon Glass {
752bbf24780SSimon Glass 	unsigned bitmask = 1;
753bbf24780SSimon Glass 	unsigned vector = 0;
754bbf24780SSimon Glass 	int ret, i;
755bbf24780SSimon Glass 
756bbf24780SSimon Glass 	for (i = 0; i < count; i++) {
757bbf24780SSimon Glass 		ret = dm_gpio_get_value(&desc_list[i]);
758bbf24780SSimon Glass 		if (ret < 0)
759bbf24780SSimon Glass 			return ret;
760bbf24780SSimon Glass 		else if (ret)
761bbf24780SSimon Glass 			vector |= bitmask;
762bbf24780SSimon Glass 		bitmask <<= 1;
763bbf24780SSimon Glass 	}
764bbf24780SSimon Glass 
765bbf24780SSimon Glass 	return vector;
766bbf24780SSimon Glass }
767bbf24780SSimon Glass 
76825cd3b96SHeiko Schocher /**
76925cd3b96SHeiko Schocher  * gpio_request_tail: common work for requesting a gpio.
77025cd3b96SHeiko Schocher  *
77125cd3b96SHeiko Schocher  * ret:		return value from previous work in function which calls
77225cd3b96SHeiko Schocher  *		this function.
77325cd3b96SHeiko Schocher  *		This seems bogus (why calling this function instead not
77425cd3b96SHeiko Schocher  *		calling it and end caller function instead?).
77525cd3b96SHeiko Schocher  *		Because on error in caller function we want to set some
77625cd3b96SHeiko Schocher  *		default values in gpio desc and have a common error
77725cd3b96SHeiko Schocher  *		debug message, which provides this function.
77825cd3b96SHeiko Schocher  * nodename:	Name of node for which gpio gets requested
77925cd3b96SHeiko Schocher  *		used for gpio label name.
78025cd3b96SHeiko Schocher  * args:	pointer to output arguments structure
78125cd3b96SHeiko Schocher  * list_name:	Name of GPIO list
78225cd3b96SHeiko Schocher  *		used for gpio label name.
78325cd3b96SHeiko Schocher  * index:	gpio index in gpio list
78425cd3b96SHeiko Schocher  *		used for gpio label name.
78525cd3b96SHeiko Schocher  * desc:	pointer to gpio descriptor, filled from this
78625cd3b96SHeiko Schocher  *		function.
78725cd3b96SHeiko Schocher  * flags:	gpio flags to use.
78825cd3b96SHeiko Schocher  * add_index:	should index added to gpio label name
78925cd3b96SHeiko Schocher  * gpio_dev:	pointer to gpio device from which the gpio
79025cd3b96SHeiko Schocher  *		will be requested. If NULL try to get the
79125cd3b96SHeiko Schocher  *		gpio device with uclass_get_device_by_ofnode()
79225cd3b96SHeiko Schocher  *
79325cd3b96SHeiko Schocher  * return:	In error case this function sets default values in
79425cd3b96SHeiko Schocher  *		gpio descriptor, also emmits a debug message.
79525cd3b96SHeiko Schocher  *		On success it returns 0 else the error code from
79625cd3b96SHeiko Schocher  *		function calls, or the error code passed through
79725cd3b96SHeiko Schocher  *		ret to this function.
79825cd3b96SHeiko Schocher  *
79925cd3b96SHeiko Schocher  */
gpio_request_tail(int ret,const char * nodename,struct ofnode_phandle_args * args,const char * list_name,int index,struct gpio_desc * desc,int flags,bool add_index,struct udevice * gpio_dev)8007e044b9aSHeiko Schocher static int gpio_request_tail(int ret, const char *nodename,
8013a57123eSSimon Glass 			     struct ofnode_phandle_args *args,
8023669e0e7SSimon Glass 			     const char *list_name, int index,
8037e044b9aSHeiko Schocher 			     struct gpio_desc *desc, int flags,
80425cd3b96SHeiko Schocher 			     bool add_index, struct udevice *gpio_dev)
8053669e0e7SSimon Glass {
80625cd3b96SHeiko Schocher 	desc->dev = gpio_dev;
8073669e0e7SSimon Glass 	desc->offset = 0;
8086c880b77SEric Nelson 	desc->flags = 0;
8093a57123eSSimon Glass 	if (ret)
8103669e0e7SSimon Glass 		goto err;
8113669e0e7SSimon Glass 
8127e044b9aSHeiko Schocher 	if (!desc->dev) {
8133a57123eSSimon Glass 		ret = uclass_get_device_by_ofnode(UCLASS_GPIO, args->node,
8143669e0e7SSimon Glass 						  &desc->dev);
8153669e0e7SSimon Glass 		if (ret) {
81625cd3b96SHeiko Schocher 			debug("%s: uclass_get_device_by_ofnode failed\n",
81725cd3b96SHeiko Schocher 			      __func__);
8183669e0e7SSimon Glass 			goto err;
8193669e0e7SSimon Glass 		}
8207e044b9aSHeiko Schocher 	}
8213a57123eSSimon Glass 	ret = gpio_find_and_xlate(desc, args);
8223669e0e7SSimon Glass 	if (ret) {
8233669e0e7SSimon Glass 		debug("%s: gpio_find_and_xlate failed\n", __func__);
8243669e0e7SSimon Glass 		goto err;
8253669e0e7SSimon Glass 	}
8263669e0e7SSimon Glass 	ret = dm_gpio_requestf(desc, add_index ? "%s.%s%d" : "%s.%s",
8277e044b9aSHeiko Schocher 			       nodename, list_name, index);
8283669e0e7SSimon Glass 	if (ret) {
8293669e0e7SSimon Glass 		debug("%s: dm_gpio_requestf failed\n", __func__);
8303669e0e7SSimon Glass 		goto err;
8313669e0e7SSimon Glass 	}
8323669e0e7SSimon Glass 	ret = dm_gpio_set_dir_flags(desc, flags | desc->flags);
8333669e0e7SSimon Glass 	if (ret) {
8343669e0e7SSimon Glass 		debug("%s: dm_gpio_set_dir failed\n", __func__);
8353669e0e7SSimon Glass 		goto err;
8363669e0e7SSimon Glass 	}
8373669e0e7SSimon Glass 
8383669e0e7SSimon Glass 	return 0;
8393669e0e7SSimon Glass err:
8403669e0e7SSimon Glass 	debug("%s: Node '%s', property '%s', failed to request GPIO index %d: %d\n",
8417e044b9aSHeiko Schocher 	      __func__, nodename, list_name, index, ret);
8423669e0e7SSimon Glass 	return ret;
8433669e0e7SSimon Glass }
8443669e0e7SSimon Glass 
_gpio_request_by_name_nodev(ofnode node,const char * list_name,int index,struct gpio_desc * desc,int flags,bool add_index)845150c5afeSSimon Glass static int _gpio_request_by_name_nodev(ofnode node, const char *list_name,
846150c5afeSSimon Glass 				       int index, struct gpio_desc *desc,
847150c5afeSSimon Glass 				       int flags, bool add_index)
8483a57123eSSimon Glass {
8493a57123eSSimon Glass 	struct ofnode_phandle_args args;
8503a57123eSSimon Glass 	int ret;
8513a57123eSSimon Glass 
852150c5afeSSimon Glass 	ret = ofnode_parse_phandle_with_args(node, list_name, "#gpio-cells", 0,
853150c5afeSSimon Glass 					     index, &args);
8543a57123eSSimon Glass 
8557e044b9aSHeiko Schocher 	return gpio_request_tail(ret, ofnode_get_name(node), &args, list_name,
8567e044b9aSHeiko Schocher 				 index, desc, flags, add_index, NULL);
8573a57123eSSimon Glass }
8583a57123eSSimon Glass 
gpio_request_by_name_nodev(ofnode node,const char * list_name,int index,struct gpio_desc * desc,int flags)859150c5afeSSimon Glass int gpio_request_by_name_nodev(ofnode node, const char *list_name, int index,
8603669e0e7SSimon Glass 			       struct gpio_desc *desc, int flags)
8613669e0e7SSimon Glass {
862150c5afeSSimon Glass 	return _gpio_request_by_name_nodev(node, list_name, index, desc, flags,
863150c5afeSSimon Glass 					   index > 0);
8643669e0e7SSimon Glass }
8653669e0e7SSimon Glass 
gpio_request_by_name(struct udevice * dev,const char * list_name,int index,struct gpio_desc * desc,int flags)8663669e0e7SSimon Glass int gpio_request_by_name(struct udevice *dev, const char *list_name, int index,
8673669e0e7SSimon Glass 			 struct gpio_desc *desc, int flags)
8683669e0e7SSimon Glass {
869150c5afeSSimon Glass 	struct ofnode_phandle_args args;
8707e044b9aSHeiko Schocher 	ofnode node;
871150c5afeSSimon Glass 	int ret;
872150c5afeSSimon Glass 
873150c5afeSSimon Glass 	ret = dev_read_phandle_with_args(dev, list_name, "#gpio-cells", 0,
874150c5afeSSimon Glass 					 index, &args);
8757e044b9aSHeiko Schocher 	node = dev_ofnode(dev);
8767e044b9aSHeiko Schocher 	return gpio_request_tail(ret, ofnode_get_name(node), &args, list_name,
8777e044b9aSHeiko Schocher 				 index, desc, flags, index > 0, NULL);
8783669e0e7SSimon Glass }
8793669e0e7SSimon Glass 
gpio_request_list_by_name_nodev(ofnode node,const char * list_name,struct gpio_desc * desc,int max_count,int flags)880150c5afeSSimon Glass int gpio_request_list_by_name_nodev(ofnode node, const char *list_name,
8813669e0e7SSimon Glass 				    struct gpio_desc *desc, int max_count,
8823669e0e7SSimon Glass 				    int flags)
8833669e0e7SSimon Glass {
8843669e0e7SSimon Glass 	int count;
8853669e0e7SSimon Glass 	int ret;
8863669e0e7SSimon Glass 
8872984e7a1SPrzemyslaw Marczak 	for (count = 0; count < max_count; count++) {
888150c5afeSSimon Glass 		ret = _gpio_request_by_name_nodev(node, list_name, count,
8893669e0e7SSimon Glass 						  &desc[count], flags, true);
8903669e0e7SSimon Glass 		if (ret == -ENOENT)
8913669e0e7SSimon Glass 			break;
8923669e0e7SSimon Glass 		else if (ret)
8933669e0e7SSimon Glass 			goto err;
8943669e0e7SSimon Glass 	}
8953669e0e7SSimon Glass 
8963669e0e7SSimon Glass 	/* We ran out of GPIOs in the list */
8973669e0e7SSimon Glass 	return count;
8983669e0e7SSimon Glass 
8993669e0e7SSimon Glass err:
9003669e0e7SSimon Glass 	gpio_free_list_nodev(desc, count - 1);
9013669e0e7SSimon Glass 
9023669e0e7SSimon Glass 	return ret;
9033669e0e7SSimon Glass }
9043669e0e7SSimon Glass 
gpio_request_list_by_name(struct udevice * dev,const char * list_name,struct gpio_desc * desc,int max_count,int flags)9053669e0e7SSimon Glass int gpio_request_list_by_name(struct udevice *dev, const char *list_name,
9063669e0e7SSimon Glass 			      struct gpio_desc *desc, int max_count,
9073669e0e7SSimon Glass 			      int flags)
9083669e0e7SSimon Glass {
9093669e0e7SSimon Glass 	/*
9103669e0e7SSimon Glass 	 * This isn't ideal since we don't use dev->name in the debug()
9113669e0e7SSimon Glass 	 * calls in gpio_request_by_name(), but we can do this until
9123669e0e7SSimon Glass 	 * gpio_request_list_by_name_nodev() can be dropped.
9133669e0e7SSimon Glass 	 */
914150c5afeSSimon Glass 	return gpio_request_list_by_name_nodev(dev_ofnode(dev), list_name, desc,
915150c5afeSSimon Glass 					       max_count, flags);
9163669e0e7SSimon Glass }
9173669e0e7SSimon Glass 
gpio_get_list_count(struct udevice * dev,const char * list_name)9183669e0e7SSimon Glass int gpio_get_list_count(struct udevice *dev, const char *list_name)
9193669e0e7SSimon Glass {
9203669e0e7SSimon Glass 	int ret;
9213669e0e7SSimon Glass 
922e160f7d4SSimon Glass 	ret = fdtdec_parse_phandle_with_args(gd->fdt_blob, dev_of_offset(dev),
9233669e0e7SSimon Glass 					     list_name, "#gpio-cells", 0, -1,
9243669e0e7SSimon Glass 					     NULL);
9253669e0e7SSimon Glass 	if (ret) {
9263669e0e7SSimon Glass 		debug("%s: Node '%s', property '%s', GPIO count failed: %d\n",
9273669e0e7SSimon Glass 		      __func__, dev->name, list_name, ret);
9283669e0e7SSimon Glass 	}
9293669e0e7SSimon Glass 
9303669e0e7SSimon Glass 	return ret;
9313669e0e7SSimon Glass }
9323669e0e7SSimon Glass 
dm_gpio_free(struct udevice * dev,struct gpio_desc * desc)9333669e0e7SSimon Glass int dm_gpio_free(struct udevice *dev, struct gpio_desc *desc)
9343669e0e7SSimon Glass {
9353669e0e7SSimon Glass 	/* For now, we don't do any checking of dev */
9363669e0e7SSimon Glass 	return _dm_gpio_free(desc->dev, desc->offset);
9373669e0e7SSimon Glass }
9383669e0e7SSimon Glass 
gpio_free_list(struct udevice * dev,struct gpio_desc * desc,int count)9393669e0e7SSimon Glass int gpio_free_list(struct udevice *dev, struct gpio_desc *desc, int count)
9403669e0e7SSimon Glass {
9413669e0e7SSimon Glass 	int i;
9423669e0e7SSimon Glass 
9433669e0e7SSimon Glass 	/* For now, we don't do any checking of dev */
9443669e0e7SSimon Glass 	for (i = 0; i < count; i++)
9453669e0e7SSimon Glass 		dm_gpio_free(dev, &desc[i]);
9463669e0e7SSimon Glass 
9473669e0e7SSimon Glass 	return 0;
9483669e0e7SSimon Glass }
9493669e0e7SSimon Glass 
gpio_free_list_nodev(struct gpio_desc * desc,int count)9503669e0e7SSimon Glass int gpio_free_list_nodev(struct gpio_desc *desc, int count)
9513669e0e7SSimon Glass {
9523669e0e7SSimon Glass 	return gpio_free_list(NULL, desc, count);
9533669e0e7SSimon Glass }
9543669e0e7SSimon Glass 
95596495d90SSimon Glass /* We need to renumber the GPIOs when any driver is probed/removed */
gpio_renumber(struct udevice * removed_dev)956b892d127SSimon Glass static int gpio_renumber(struct udevice *removed_dev)
95796495d90SSimon Glass {
95896495d90SSimon Glass 	struct gpio_dev_priv *uc_priv;
95954c5d08aSHeiko Schocher 	struct udevice *dev;
96096495d90SSimon Glass 	struct uclass *uc;
96196495d90SSimon Glass 	unsigned base;
96296495d90SSimon Glass 	int ret;
96396495d90SSimon Glass 
96496495d90SSimon Glass 	ret = uclass_get(UCLASS_GPIO, &uc);
96596495d90SSimon Glass 	if (ret)
96696495d90SSimon Glass 		return ret;
96796495d90SSimon Glass 
96896495d90SSimon Glass 	/* Ensure that we have a base for each bank */
96996495d90SSimon Glass 	base = 0;
97096495d90SSimon Glass 	uclass_foreach_dev(dev, uc) {
971b892d127SSimon Glass 		if (device_active(dev) && dev != removed_dev) {
972e564f054SSimon Glass 			uc_priv = dev_get_uclass_priv(dev);
97396495d90SSimon Glass 			uc_priv->gpio_base = base;
97496495d90SSimon Glass 			base += uc_priv->gpio_count;
97596495d90SSimon Glass 		}
97696495d90SSimon Glass 	}
97796495d90SSimon Glass 
97896495d90SSimon Glass 	return 0;
97996495d90SSimon Glass }
98096495d90SSimon Glass 
gpio_get_number(const struct gpio_desc * desc)98117c43f1aSSimon Glass int gpio_get_number(const struct gpio_desc *desc)
98256a71f89SSimon Glass {
98356a71f89SSimon Glass 	struct udevice *dev = desc->dev;
98456a71f89SSimon Glass 	struct gpio_dev_priv *uc_priv;
98556a71f89SSimon Glass 
98656a71f89SSimon Glass 	if (!dev)
98756a71f89SSimon Glass 		return -1;
98856a71f89SSimon Glass 	uc_priv = dev->uclass_priv;
98956a71f89SSimon Glass 
99056a71f89SSimon Glass 	return uc_priv->gpio_base + desc->offset;
99156a71f89SSimon Glass }
99256a71f89SSimon Glass 
gpio_post_probe(struct udevice * dev)99354c5d08aSHeiko Schocher static int gpio_post_probe(struct udevice *dev)
99496495d90SSimon Glass {
995e564f054SSimon Glass 	struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
996b892d127SSimon Glass 
997b892d127SSimon Glass 	uc_priv->name = calloc(uc_priv->gpio_count, sizeof(char *));
998b892d127SSimon Glass 	if (!uc_priv->name)
999b892d127SSimon Glass 		return -ENOMEM;
1000b892d127SSimon Glass 
1001b892d127SSimon Glass 	return gpio_renumber(NULL);
100296495d90SSimon Glass }
100396495d90SSimon Glass 
gpio_pre_remove(struct udevice * dev)100454c5d08aSHeiko Schocher static int gpio_pre_remove(struct udevice *dev)
100596495d90SSimon Glass {
1006e564f054SSimon Glass 	struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
1007b892d127SSimon Glass 	int i;
1008b892d127SSimon Glass 
1009b892d127SSimon Glass 	for (i = 0; i < uc_priv->gpio_count; i++) {
1010b892d127SSimon Glass 		if (uc_priv->name[i])
1011b892d127SSimon Glass 			free(uc_priv->name[i]);
1012b892d127SSimon Glass 	}
1013b892d127SSimon Glass 	free(uc_priv->name);
1014b892d127SSimon Glass 
1015b892d127SSimon Glass 	return gpio_renumber(dev);
101696495d90SSimon Glass }
101796495d90SSimon Glass 
gpio_dev_request_index(struct udevice * dev,const char * nodename,char * list_name,int index,int flags,int dtflags,struct gpio_desc * desc)10187e044b9aSHeiko Schocher int gpio_dev_request_index(struct udevice *dev, const char *nodename,
10197e044b9aSHeiko Schocher 			   char *list_name, int index, int flags,
10207e044b9aSHeiko Schocher 			   int dtflags, struct gpio_desc *desc)
10217e044b9aSHeiko Schocher {
10227e044b9aSHeiko Schocher 	struct ofnode_phandle_args args;
10237e044b9aSHeiko Schocher 
10247e044b9aSHeiko Schocher 	args.node =  ofnode_null();
10257e044b9aSHeiko Schocher 	args.args_count = 2;
10267e044b9aSHeiko Schocher 	args.args[0] = index;
10277e044b9aSHeiko Schocher 	args.args[1] = dtflags;
10287e044b9aSHeiko Schocher 
10297e044b9aSHeiko Schocher 	return gpio_request_tail(0, nodename, &args, list_name, index, desc,
10307e044b9aSHeiko Schocher 				 flags, 0, dev);
10317e044b9aSHeiko Schocher }
10327e044b9aSHeiko Schocher 
gpio_post_bind(struct udevice * dev)10337e044b9aSHeiko Schocher static int gpio_post_bind(struct udevice *dev)
10347e044b9aSHeiko Schocher {
10357e044b9aSHeiko Schocher 	struct udevice *child;
10367e044b9aSHeiko Schocher 	ofnode node;
10377e044b9aSHeiko Schocher 
103825cd3b96SHeiko Schocher 	if (IS_ENABLED(CONFIG_GPIO_HOG)) {
10397e044b9aSHeiko Schocher 		dev_for_each_subnode(node, dev) {
10407e044b9aSHeiko Schocher 			if (ofnode_read_bool(node, "gpio-hog")) {
10417e044b9aSHeiko Schocher 				const char *name = ofnode_get_name(node);
104225cd3b96SHeiko Schocher 				int ret;
10437e044b9aSHeiko Schocher 
104425cd3b96SHeiko Schocher 				ret = device_bind_driver_to_node(dev,
104525cd3b96SHeiko Schocher 								 "gpio_hog",
104625cd3b96SHeiko Schocher 								 name, node,
104725cd3b96SHeiko Schocher 								 &child);
104825cd3b96SHeiko Schocher 				if (ret)
104925cd3b96SHeiko Schocher 					return ret;
10507e044b9aSHeiko Schocher 			}
10517e044b9aSHeiko Schocher 		}
105225cd3b96SHeiko Schocher 	}
10537e044b9aSHeiko Schocher 	return 0;
10547e044b9aSHeiko Schocher }
10557e044b9aSHeiko Schocher 
105696495d90SSimon Glass UCLASS_DRIVER(gpio) = {
105796495d90SSimon Glass 	.id		= UCLASS_GPIO,
105896495d90SSimon Glass 	.name		= "gpio",
10597e0ce50bSJoseph Chen #ifndef CONFIG_GPIO_NO_UC_FLAG_SEQ_ALIAS
1060ae89bb0dSBhuvanchandra DV 	.flags		= DM_UC_FLAG_SEQ_ALIAS,
10617e0ce50bSJoseph Chen #endif
106296495d90SSimon Glass 	.post_probe	= gpio_post_probe,
10637e044b9aSHeiko Schocher 	.post_bind	= gpio_post_bind,
106496495d90SSimon Glass 	.pre_remove	= gpio_pre_remove,
106596495d90SSimon Glass 	.per_device_auto_alloc_size = sizeof(struct gpio_dev_priv),
106696495d90SSimon Glass };
1067