Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 | // SPDX-License-Identifier: GPL-2.0+ /* Copyright (C) 2019 Stephan Gerhold */ #include <dm.h> #include <asm/gpio.h> #include <asm/io.h> struct nmk_gpio_regs { u32 dat; /* data */ u32 dats; /* data set */ u32 datc; /* data clear */ u32 pdis; /* pull disable */ u32 dir; /* direction */ u32 dirs; /* direction set */ u32 dirc; /* direction clear */ u32 slpm; /* sleep mode */ u32 afsla; /* alternate function select A */ u32 afslb; /* alternate function select B */ u32 lowemi; /* low EMI mode */ }; struct nmk_gpio { struct nmk_gpio_regs *regs; }; static int nmk_gpio_get_value(struct udevice *dev, unsigned offset) { struct nmk_gpio *priv = dev_get_priv(dev); return !!(readl(&priv->regs->dat) & BIT(offset)); } static int nmk_gpio_set_value(struct udevice *dev, unsigned offset, int value) { struct nmk_gpio *priv = dev_get_priv(dev); if (value) writel(BIT(offset), &priv->regs->dats); else writel(BIT(offset), &priv->regs->datc); return 0; } static int nmk_gpio_get_function(struct udevice *dev, unsigned offset) { struct nmk_gpio *priv = dev_get_priv(dev); if (readl(&priv->regs->afsla) & BIT(offset) || readl(&priv->regs->afslb) & BIT(offset)) return GPIOF_FUNC; if (readl(&priv->regs->dir) & BIT(offset)) return GPIOF_OUTPUT; else return GPIOF_INPUT; } static int nmk_gpio_direction_input(struct udevice *dev, unsigned offset) { struct nmk_gpio *priv = dev_get_priv(dev); writel(BIT(offset), &priv->regs->dirc); return 0; } static int nmk_gpio_direction_output(struct udevice *dev, unsigned offset, int value) { struct nmk_gpio *priv = dev_get_priv(dev); writel(BIT(offset), &priv->regs->dirs); return nmk_gpio_set_value(dev, offset, value); } static const struct dm_gpio_ops nmk_gpio_ops = { .get_value = nmk_gpio_get_value, .set_value = nmk_gpio_set_value, .get_function = nmk_gpio_get_function, .direction_input = nmk_gpio_direction_input, .direction_output = nmk_gpio_direction_output, }; static int nmk_gpio_probe(struct udevice *dev) { struct nmk_gpio *priv = dev_get_priv(dev); struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev); char buf[20]; u32 bank; int ret; priv->regs = dev_read_addr_ptr(dev); if (!priv->regs) return -EINVAL; ret = dev_read_u32(dev, "gpio-bank", &bank); if (ret < 0) { printf("nmk_gpio(%s): Failed to read gpio-bank\n", dev->name); return ret; } sprintf(buf, "nmk%u-gpio", bank); uc_priv->bank_name = strdup(buf); if (!uc_priv->bank_name) return -ENOMEM; uc_priv->gpio_count = sizeof(priv->regs->dat) * BITS_PER_BYTE; return 0; } static const struct udevice_id nmk_gpio_ids[] = { { .compatible = "st,nomadik-gpio" }, { } }; U_BOOT_DRIVER(gpio_nmk) = { .name = "nmk_gpio", .id = UCLASS_GPIO, .of_match = nmk_gpio_ids, .probe = nmk_gpio_probe, .ops = &nmk_gpio_ops, .priv_auto = sizeof(struct nmk_gpio), }; |