Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 2 | /* |
| 3 | * Copyright (C) 2012 Vikram Narayananan |
| 4 | * <vikram186@gmail.com> |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 5 | */ |
| 6 | |
| 7 | #include <common.h> |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 8 | #include <dm.h> |
Alexander Graf | fce8e5c | 2018-01-23 18:05:21 +0100 | [diff] [blame] | 9 | #include <dm/pinctrl.h> |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 10 | #include <errno.h> |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 11 | #include <asm/gpio.h> |
| 12 | #include <asm/io.h> |
Fabian Vogt | 58eb514 | 2016-09-26 14:26:43 +0200 | [diff] [blame] | 13 | #include <fdtdec.h> |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 14 | |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 15 | struct bcm2835_gpios { |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 16 | struct bcm2835_gpio_regs *reg; |
Alexander Graf | fce8e5c | 2018-01-23 18:05:21 +0100 | [diff] [blame] | 17 | struct udevice *pinctrl; |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 18 | }; |
| 19 | |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 20 | static int bcm2835_gpio_direction_input(struct udevice *dev, unsigned gpio) |
| 21 | { |
| 22 | struct bcm2835_gpios *gpios = dev_get_priv(dev); |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 23 | unsigned val; |
| 24 | |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 25 | val = readl(&gpios->reg->gpfsel[BCM2835_GPIO_FSEL_BANK(gpio)]); |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 26 | val &= ~(BCM2835_GPIO_FSEL_MASK << BCM2835_GPIO_FSEL_SHIFT(gpio)); |
| 27 | val |= (BCM2835_GPIO_INPUT << BCM2835_GPIO_FSEL_SHIFT(gpio)); |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 28 | writel(val, &gpios->reg->gpfsel[BCM2835_GPIO_FSEL_BANK(gpio)]); |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 29 | |
| 30 | return 0; |
| 31 | } |
| 32 | |
Alexander Graf | fce8e5c | 2018-01-23 18:05:21 +0100 | [diff] [blame] | 33 | static int bcm2835_gpio_direction_output(struct udevice *dev, unsigned int gpio, |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 34 | int value) |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 35 | { |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 36 | struct bcm2835_gpios *gpios = dev_get_priv(dev); |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 37 | unsigned val; |
| 38 | |
| 39 | gpio_set_value(gpio, value); |
| 40 | |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 41 | val = readl(&gpios->reg->gpfsel[BCM2835_GPIO_FSEL_BANK(gpio)]); |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 42 | val &= ~(BCM2835_GPIO_FSEL_MASK << BCM2835_GPIO_FSEL_SHIFT(gpio)); |
| 43 | val |= (BCM2835_GPIO_OUTPUT << BCM2835_GPIO_FSEL_SHIFT(gpio)); |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 44 | writel(val, &gpios->reg->gpfsel[BCM2835_GPIO_FSEL_BANK(gpio)]); |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 45 | |
| 46 | return 0; |
| 47 | } |
| 48 | |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 49 | static int bcm2835_get_value(const struct bcm2835_gpios *gpios, unsigned gpio) |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 50 | { |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 51 | unsigned val; |
| 52 | |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 53 | val = readl(&gpios->reg->gplev[BCM2835_GPIO_COMMON_BANK(gpio)]); |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 54 | |
| 55 | return (val >> BCM2835_GPIO_COMMON_SHIFT(gpio)) & 0x1; |
| 56 | } |
| 57 | |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 58 | static int bcm2835_gpio_get_value(struct udevice *dev, unsigned gpio) |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 59 | { |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 60 | const struct bcm2835_gpios *gpios = dev_get_priv(dev); |
| 61 | |
| 62 | return bcm2835_get_value(gpios, gpio); |
| 63 | } |
| 64 | |
| 65 | static int bcm2835_gpio_set_value(struct udevice *dev, unsigned gpio, |
| 66 | int value) |
| 67 | { |
| 68 | struct bcm2835_gpios *gpios = dev_get_priv(dev); |
| 69 | u32 *output_reg = value ? gpios->reg->gpset : gpios->reg->gpclr; |
Stephen Warren | 45b8ae6 | 2012-08-05 16:07:21 +0000 | [diff] [blame] | 70 | |
| 71 | writel(1 << BCM2835_GPIO_COMMON_SHIFT(gpio), |
| 72 | &output_reg[BCM2835_GPIO_COMMON_BANK(gpio)]); |
| 73 | |
| 74 | return 0; |
| 75 | } |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 76 | |
Alexander Graf | 6c68a22 | 2016-08-11 13:38:31 +0200 | [diff] [blame] | 77 | static int bcm2835_gpio_get_function(struct udevice *dev, unsigned offset) |
| 78 | { |
Alexander Graf | fce8e5c | 2018-01-23 18:05:21 +0100 | [diff] [blame] | 79 | struct bcm2835_gpios *priv = dev_get_priv(dev); |
| 80 | int funcid; |
| 81 | |
| 82 | funcid = pinctrl_get_gpio_mux(priv->pinctrl, 0, offset); |
Alexander Graf | 6c68a22 | 2016-08-11 13:38:31 +0200 | [diff] [blame] | 83 | |
| 84 | switch (funcid) { |
| 85 | case BCM2835_GPIO_OUTPUT: |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 86 | return GPIOF_OUTPUT; |
Alexander Graf | 6c68a22 | 2016-08-11 13:38:31 +0200 | [diff] [blame] | 87 | case BCM2835_GPIO_INPUT: |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 88 | return GPIOF_INPUT; |
Alexander Graf | 6c68a22 | 2016-08-11 13:38:31 +0200 | [diff] [blame] | 89 | default: |
| 90 | return GPIOF_FUNC; |
| 91 | } |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 92 | } |
| 93 | |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 94 | static const struct dm_gpio_ops gpio_bcm2835_ops = { |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 95 | .direction_input = bcm2835_gpio_direction_input, |
| 96 | .direction_output = bcm2835_gpio_direction_output, |
| 97 | .get_value = bcm2835_gpio_get_value, |
| 98 | .set_value = bcm2835_gpio_set_value, |
| 99 | .get_function = bcm2835_gpio_get_function, |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 100 | }; |
| 101 | |
| 102 | static int bcm2835_gpio_probe(struct udevice *dev) |
| 103 | { |
| 104 | struct bcm2835_gpios *gpios = dev_get_priv(dev); |
| 105 | struct bcm2835_gpio_platdata *plat = dev_get_platdata(dev); |
Simon Glass | de0977b | 2015-03-05 12:25:20 -0700 | [diff] [blame] | 106 | struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev); |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 107 | |
| 108 | uc_priv->bank_name = "GPIO"; |
| 109 | uc_priv->gpio_count = BCM2835_GPIO_COUNT; |
| 110 | gpios->reg = (struct bcm2835_gpio_regs *)plat->base; |
| 111 | |
Alexander Graf | fce8e5c | 2018-01-23 18:05:21 +0100 | [diff] [blame] | 112 | /* We know we're spawned by the pinctrl driver */ |
| 113 | gpios->pinctrl = dev->parent; |
| 114 | |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 115 | return 0; |
| 116 | } |
| 117 | |
Fabian Vogt | 58eb514 | 2016-09-26 14:26:43 +0200 | [diff] [blame] | 118 | #if CONFIG_IS_ENABLED(OF_CONTROL) |
Fabian Vogt | 58eb514 | 2016-09-26 14:26:43 +0200 | [diff] [blame] | 119 | static int bcm2835_gpio_ofdata_to_platdata(struct udevice *dev) |
| 120 | { |
| 121 | struct bcm2835_gpio_platdata *plat = dev_get_platdata(dev); |
| 122 | fdt_addr_t addr; |
| 123 | |
Simon Glass | ba1dea4 | 2017-05-17 17:18:05 -0600 | [diff] [blame] | 124 | addr = devfdt_get_addr(dev); |
Fabian Vogt | 58eb514 | 2016-09-26 14:26:43 +0200 | [diff] [blame] | 125 | if (addr == FDT_ADDR_T_NONE) |
| 126 | return -EINVAL; |
| 127 | |
| 128 | plat->base = addr; |
| 129 | return 0; |
| 130 | } |
| 131 | #endif |
| 132 | |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 133 | U_BOOT_DRIVER(gpio_bcm2835) = { |
| 134 | .name = "gpio_bcm2835", |
| 135 | .id = UCLASS_GPIO, |
Fabian Vogt | 58eb514 | 2016-09-26 14:26:43 +0200 | [diff] [blame] | 136 | .ofdata_to_platdata = of_match_ptr(bcm2835_gpio_ofdata_to_platdata), |
| 137 | .platdata_auto_alloc_size = sizeof(struct bcm2835_gpio_platdata), |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 138 | .ops = &gpio_bcm2835_ops, |
| 139 | .probe = bcm2835_gpio_probe, |
Alexander Graf | afb9907 | 2016-08-15 17:48:51 +0200 | [diff] [blame] | 140 | .flags = DM_FLAG_PRE_RELOC, |
Simon Glass | 7480762 | 2014-09-22 17:30:56 -0600 | [diff] [blame] | 141 | .priv_auto_alloc_size = sizeof(struct bcm2835_gpios), |
| 142 | }; |