1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
28d30fcd9SSimon Glass /*
38d30fcd9SSimon Glass * Copyright (c) 2011 The Chromium OS Authors.
48d30fcd9SSimon Glass */
58d30fcd9SSimon Glass
68d30fcd9SSimon Glass #include <common.h>
7e2d8a714SSimon Glass #include <dm.h>
8e2d8a714SSimon Glass #include <fdtdec.h>
9e2d8a714SSimon Glass #include <malloc.h>
108d30fcd9SSimon Glass #include <asm/gpio.h>
113a57123eSSimon Glass #include <dm/of.h>
123669e0e7SSimon Glass #include <dt-bindings/gpio/gpio.h>
138d30fcd9SSimon Glass
148d30fcd9SSimon Glass /* Flags for each GPIO */
158d30fcd9SSimon Glass #define GPIOF_OUTPUT (1 << 0) /* Currently set as an output */
168d30fcd9SSimon Glass #define GPIOF_HIGH (1 << 1) /* Currently set high */
17743268f5Smario.six@gdsys.cc #define GPIOF_ODR (1 << 2) /* Currently set to open drain mode */
188d30fcd9SSimon Glass
198d30fcd9SSimon Glass struct gpio_state {
208d30fcd9SSimon Glass const char *label; /* label given by requester */
218d30fcd9SSimon Glass u8 flags; /* flags (GPIOF_...) */
228d30fcd9SSimon Glass };
238d30fcd9SSimon Glass
248d30fcd9SSimon Glass /* Access routines for GPIO state */
get_gpio_flags(struct udevice * dev,unsigned offset)2554c5d08aSHeiko Schocher static u8 *get_gpio_flags(struct udevice *dev, unsigned offset)
268d30fcd9SSimon Glass {
27e564f054SSimon Glass struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
28e2d8a714SSimon Glass struct gpio_state *state = dev_get_priv(dev);
29e2d8a714SSimon Glass
30e2d8a714SSimon Glass if (offset >= uc_priv->gpio_count) {
318d30fcd9SSimon Glass static u8 invalid_flags;
32e2d8a714SSimon Glass printf("sandbox_gpio: error: invalid gpio %u\n", offset);
338d30fcd9SSimon Glass return &invalid_flags;
348d30fcd9SSimon Glass }
358d30fcd9SSimon Glass
36e2d8a714SSimon Glass return &state[offset].flags;
378d30fcd9SSimon Glass }
388d30fcd9SSimon Glass
get_gpio_flag(struct udevice * dev,unsigned offset,int flag)3954c5d08aSHeiko Schocher static int get_gpio_flag(struct udevice *dev, unsigned offset, int flag)
408d30fcd9SSimon Glass {
41e2d8a714SSimon Glass return (*get_gpio_flags(dev, offset) & flag) != 0;
428d30fcd9SSimon Glass }
438d30fcd9SSimon Glass
set_gpio_flag(struct udevice * dev,unsigned offset,int flag,int value)4454c5d08aSHeiko Schocher static int set_gpio_flag(struct udevice *dev, unsigned offset, int flag,
45e2d8a714SSimon Glass int value)
468d30fcd9SSimon Glass {
47e2d8a714SSimon Glass u8 *gpio = get_gpio_flags(dev, offset);
488d30fcd9SSimon Glass
498d30fcd9SSimon Glass if (value)
508d30fcd9SSimon Glass *gpio |= flag;
518d30fcd9SSimon Glass else
528d30fcd9SSimon Glass *gpio &= ~flag;
538d30fcd9SSimon Glass
548d30fcd9SSimon Glass return 0;
558d30fcd9SSimon Glass }
568d30fcd9SSimon Glass
578d30fcd9SSimon Glass /*
588d30fcd9SSimon Glass * Back-channel sandbox-internal-only access to GPIO state
598d30fcd9SSimon Glass */
608d30fcd9SSimon Glass
sandbox_gpio_get_value(struct udevice * dev,unsigned offset)6154c5d08aSHeiko Schocher int sandbox_gpio_get_value(struct udevice *dev, unsigned offset)
628d30fcd9SSimon Glass {
63e2d8a714SSimon Glass if (get_gpio_flag(dev, offset, GPIOF_OUTPUT))
64e2d8a714SSimon Glass debug("sandbox_gpio: get_value on output gpio %u\n", offset);
65e2d8a714SSimon Glass return get_gpio_flag(dev, offset, GPIOF_HIGH);
668d30fcd9SSimon Glass }
678d30fcd9SSimon Glass
sandbox_gpio_set_value(struct udevice * dev,unsigned offset,int value)6854c5d08aSHeiko Schocher int sandbox_gpio_set_value(struct udevice *dev, unsigned offset, int value)
698d30fcd9SSimon Glass {
70e2d8a714SSimon Glass return set_gpio_flag(dev, offset, GPIOF_HIGH, value);
718d30fcd9SSimon Glass }
728d30fcd9SSimon Glass
sandbox_gpio_get_open_drain(struct udevice * dev,unsigned offset)73743268f5Smario.six@gdsys.cc int sandbox_gpio_get_open_drain(struct udevice *dev, unsigned offset)
74743268f5Smario.six@gdsys.cc {
75743268f5Smario.six@gdsys.cc return get_gpio_flag(dev, offset, GPIOF_ODR);
76743268f5Smario.six@gdsys.cc }
77743268f5Smario.six@gdsys.cc
sandbox_gpio_set_open_drain(struct udevice * dev,unsigned offset,int value)78743268f5Smario.six@gdsys.cc int sandbox_gpio_set_open_drain(struct udevice *dev, unsigned offset, int value)
79743268f5Smario.six@gdsys.cc {
80743268f5Smario.six@gdsys.cc return set_gpio_flag(dev, offset, GPIOF_ODR, value);
81743268f5Smario.six@gdsys.cc }
82743268f5Smario.six@gdsys.cc
sandbox_gpio_get_direction(struct udevice * dev,unsigned offset)8354c5d08aSHeiko Schocher int sandbox_gpio_get_direction(struct udevice *dev, unsigned offset)
848d30fcd9SSimon Glass {
85e2d8a714SSimon Glass return get_gpio_flag(dev, offset, GPIOF_OUTPUT);
868d30fcd9SSimon Glass }
878d30fcd9SSimon Glass
sandbox_gpio_set_direction(struct udevice * dev,unsigned offset,int output)8854c5d08aSHeiko Schocher int sandbox_gpio_set_direction(struct udevice *dev, unsigned offset, int output)
898d30fcd9SSimon Glass {
90e2d8a714SSimon Glass return set_gpio_flag(dev, offset, GPIOF_OUTPUT, output);
918d30fcd9SSimon Glass }
928d30fcd9SSimon Glass
938d30fcd9SSimon Glass /*
948d30fcd9SSimon Glass * These functions implement the public interface within U-Boot
958d30fcd9SSimon Glass */
968d30fcd9SSimon Glass
97e2d8a714SSimon Glass /* set GPIO port 'offset' as an input */
sb_gpio_direction_input(struct udevice * dev,unsigned offset)9854c5d08aSHeiko Schocher static int sb_gpio_direction_input(struct udevice *dev, unsigned offset)
998d30fcd9SSimon Glass {
100e2d8a714SSimon Glass debug("%s: offset:%u\n", __func__, offset);
1018d30fcd9SSimon Glass
102e2d8a714SSimon Glass return sandbox_gpio_set_direction(dev, offset, 0);
1038d30fcd9SSimon Glass }
1048d30fcd9SSimon Glass
105e2d8a714SSimon Glass /* set GPIO port 'offset' as an output, with polarity 'value' */
sb_gpio_direction_output(struct udevice * dev,unsigned offset,int value)10654c5d08aSHeiko Schocher static int sb_gpio_direction_output(struct udevice *dev, unsigned offset,
107e2d8a714SSimon Glass int value)
1088d30fcd9SSimon Glass {
109e2d8a714SSimon Glass debug("%s: offset:%u, value = %d\n", __func__, offset, value);
1108d30fcd9SSimon Glass
111e2d8a714SSimon Glass return sandbox_gpio_set_direction(dev, offset, 1) |
112e2d8a714SSimon Glass sandbox_gpio_set_value(dev, offset, value);
1138d30fcd9SSimon Glass }
1148d30fcd9SSimon Glass
115e2d8a714SSimon Glass /* read GPIO IN value of port 'offset' */
sb_gpio_get_value(struct udevice * dev,unsigned offset)11654c5d08aSHeiko Schocher static int sb_gpio_get_value(struct udevice *dev, unsigned offset)
1178d30fcd9SSimon Glass {
118e2d8a714SSimon Glass debug("%s: offset:%u\n", __func__, offset);
1198d30fcd9SSimon Glass
120e2d8a714SSimon Glass return sandbox_gpio_get_value(dev, offset);
1218d30fcd9SSimon Glass }
1228d30fcd9SSimon Glass
123e2d8a714SSimon Glass /* write GPIO OUT value to port 'offset' */
sb_gpio_set_value(struct udevice * dev,unsigned offset,int value)12454c5d08aSHeiko Schocher static int sb_gpio_set_value(struct udevice *dev, unsigned offset, int value)
1258d30fcd9SSimon Glass {
126e2d8a714SSimon Glass debug("%s: offset:%u, value = %d\n", __func__, offset, value);
1278d30fcd9SSimon Glass
128e2d8a714SSimon Glass if (!sandbox_gpio_get_direction(dev, offset)) {
129e2d8a714SSimon Glass printf("sandbox_gpio: error: set_value on input gpio %u\n",
130e2d8a714SSimon Glass offset);
1318d30fcd9SSimon Glass return -1;
1328d30fcd9SSimon Glass }
1338d30fcd9SSimon Glass
134e2d8a714SSimon Glass return sandbox_gpio_set_value(dev, offset, value);
1358d30fcd9SSimon Glass }
1368d30fcd9SSimon Glass
137743268f5Smario.six@gdsys.cc /* read GPIO ODR value of port 'offset' */
sb_gpio_get_open_drain(struct udevice * dev,unsigned offset)138743268f5Smario.six@gdsys.cc static int sb_gpio_get_open_drain(struct udevice *dev, unsigned offset)
139743268f5Smario.six@gdsys.cc {
140743268f5Smario.six@gdsys.cc debug("%s: offset:%u\n", __func__, offset);
141743268f5Smario.six@gdsys.cc
142743268f5Smario.six@gdsys.cc return sandbox_gpio_get_open_drain(dev, offset);
143743268f5Smario.six@gdsys.cc }
144743268f5Smario.six@gdsys.cc
145743268f5Smario.six@gdsys.cc /* write GPIO ODR value to port 'offset' */
sb_gpio_set_open_drain(struct udevice * dev,unsigned offset,int value)146743268f5Smario.six@gdsys.cc static int sb_gpio_set_open_drain(struct udevice *dev, unsigned offset, int value)
147743268f5Smario.six@gdsys.cc {
148743268f5Smario.six@gdsys.cc debug("%s: offset:%u, value = %d\n", __func__, offset, value);
149743268f5Smario.six@gdsys.cc
150743268f5Smario.six@gdsys.cc if (!sandbox_gpio_get_direction(dev, offset)) {
151743268f5Smario.six@gdsys.cc printf("sandbox_gpio: error: set_open_drain on input gpio %u\n",
152743268f5Smario.six@gdsys.cc offset);
153743268f5Smario.six@gdsys.cc return -1;
154743268f5Smario.six@gdsys.cc }
155743268f5Smario.six@gdsys.cc
156743268f5Smario.six@gdsys.cc return sandbox_gpio_set_open_drain(dev, offset, value);
157743268f5Smario.six@gdsys.cc }
158743268f5Smario.six@gdsys.cc
sb_gpio_get_function(struct udevice * dev,unsigned offset)159699ea960SSimon Glass static int sb_gpio_get_function(struct udevice *dev, unsigned offset)
160699ea960SSimon Glass {
161699ea960SSimon Glass if (get_gpio_flag(dev, offset, GPIOF_OUTPUT))
162699ea960SSimon Glass return GPIOF_OUTPUT;
163699ea960SSimon Glass return GPIOF_INPUT;
164699ea960SSimon Glass }
165699ea960SSimon Glass
sb_gpio_xlate(struct udevice * dev,struct gpio_desc * desc,struct ofnode_phandle_args * args)1663669e0e7SSimon Glass static int sb_gpio_xlate(struct udevice *dev, struct gpio_desc *desc,
1673a57123eSSimon Glass struct ofnode_phandle_args *args)
1683669e0e7SSimon Glass {
1693669e0e7SSimon Glass desc->offset = args->args[0];
1703669e0e7SSimon Glass if (args->args_count < 2)
1713669e0e7SSimon Glass return 0;
1723669e0e7SSimon Glass if (args->args[1] & GPIO_ACTIVE_LOW)
1733669e0e7SSimon Glass desc->flags |= GPIOD_ACTIVE_LOW;
1743669e0e7SSimon Glass if (args->args[1] & 2)
1753669e0e7SSimon Glass desc->flags |= GPIOD_IS_IN;
1763669e0e7SSimon Glass if (args->args[1] & 4)
1773669e0e7SSimon Glass desc->flags |= GPIOD_IS_OUT;
1783669e0e7SSimon Glass if (args->args[1] & 8)
1793669e0e7SSimon Glass desc->flags |= GPIOD_IS_OUT_ACTIVE;
1803669e0e7SSimon Glass
1813669e0e7SSimon Glass return 0;
1823669e0e7SSimon Glass }
1833669e0e7SSimon Glass
184e2d8a714SSimon Glass static const struct dm_gpio_ops gpio_sandbox_ops = {
185e2d8a714SSimon Glass .direction_input = sb_gpio_direction_input,
186e2d8a714SSimon Glass .direction_output = sb_gpio_direction_output,
187e2d8a714SSimon Glass .get_value = sb_gpio_get_value,
188e2d8a714SSimon Glass .set_value = sb_gpio_set_value,
189743268f5Smario.six@gdsys.cc .get_open_drain = sb_gpio_get_open_drain,
190743268f5Smario.six@gdsys.cc .set_open_drain = sb_gpio_set_open_drain,
191699ea960SSimon Glass .get_function = sb_gpio_get_function,
1923669e0e7SSimon Glass .xlate = sb_gpio_xlate,
193e2d8a714SSimon Glass };
194e2d8a714SSimon Glass
sandbox_gpio_ofdata_to_platdata(struct udevice * dev)19554c5d08aSHeiko Schocher static int sandbox_gpio_ofdata_to_platdata(struct udevice *dev)
196e2d8a714SSimon Glass {
197e564f054SSimon Glass struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
198e2d8a714SSimon Glass
199995b60b5SSimon Glass uc_priv->gpio_count = dev_read_u32_default(dev, "sandbox,gpio-count",
200995b60b5SSimon Glass 0);
20195795ad6SSimon Glass uc_priv->bank_name = dev_read_string(dev, "gpio-bank-name");
202e2d8a714SSimon Glass
203e2d8a714SSimon Glass return 0;
2048d30fcd9SSimon Glass }
205e2d8a714SSimon Glass
gpio_sandbox_probe(struct udevice * dev)20654c5d08aSHeiko Schocher static int gpio_sandbox_probe(struct udevice *dev)
207e2d8a714SSimon Glass {
208e564f054SSimon Glass struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
209e2d8a714SSimon Glass
21095795ad6SSimon Glass if (!dev_of_valid(dev))
211e2d8a714SSimon Glass /* Tell the uclass how many GPIOs we have */
212e2d8a714SSimon Glass uc_priv->gpio_count = CONFIG_SANDBOX_GPIO_COUNT;
213e2d8a714SSimon Glass
214e2d8a714SSimon Glass dev->priv = calloc(sizeof(struct gpio_state), uc_priv->gpio_count);
215e2d8a714SSimon Glass
216e2d8a714SSimon Glass return 0;
217e2d8a714SSimon Glass }
218e2d8a714SSimon Glass
gpio_sandbox_remove(struct udevice * dev)21962cb89d5SSimon Glass static int gpio_sandbox_remove(struct udevice *dev)
22062cb89d5SSimon Glass {
22162cb89d5SSimon Glass free(dev->priv);
22262cb89d5SSimon Glass
22362cb89d5SSimon Glass return 0;
22462cb89d5SSimon Glass }
22562cb89d5SSimon Glass
226ae7f4513SSimon Glass static const struct udevice_id sandbox_gpio_ids[] = {
227e2d8a714SSimon Glass { .compatible = "sandbox,gpio" },
228e2d8a714SSimon Glass { }
229e2d8a714SSimon Glass };
230e2d8a714SSimon Glass
231e2d8a714SSimon Glass U_BOOT_DRIVER(gpio_sandbox) = {
232e2d8a714SSimon Glass .name = "gpio_sandbox",
233e2d8a714SSimon Glass .id = UCLASS_GPIO,
234e2d8a714SSimon Glass .of_match = sandbox_gpio_ids,
235e2d8a714SSimon Glass .ofdata_to_platdata = sandbox_gpio_ofdata_to_platdata,
236e2d8a714SSimon Glass .probe = gpio_sandbox_probe,
23762cb89d5SSimon Glass .remove = gpio_sandbox_remove,
238e2d8a714SSimon Glass .ops = &gpio_sandbox_ops,
239e2d8a714SSimon Glass };
240