2 * Copyright (C) 2018 Alexander Graf <agraf@suse.de>
4 * Based on drivers/pinctrl/mvebu/pinctrl-mvebu.c and
5 * drivers/gpio/bcm2835_gpio.c
7 * This driver gets instantiated by the GPIO driver, because both devices
8 * share the same device node.
10 * SPDX-License-Identifier: GPL-2.0
11 * https://spdx.org/licenses
18 #include <dm/pinctrl.h>
20 #include <dm/device-internal.h>
22 #include <asm/system.h>
26 struct bcm283x_pinctrl_priv {
30 #define MAX_PINS_PER_BANK 16
32 static void bcm2835_gpio_set_func_id(struct udevice *dev, unsigned int gpio,
35 struct bcm283x_pinctrl_priv *priv = dev_get_priv(dev);
39 reg_offset = BCM2835_GPIO_FSEL_BANK(gpio);
40 field_offset = BCM2835_GPIO_FSEL_SHIFT(gpio);
42 clrsetbits_le32(&priv->base_reg[reg_offset],
43 BCM2835_GPIO_FSEL_MASK << field_offset,
44 (func & BCM2835_GPIO_FSEL_MASK) << field_offset);
47 static int bcm2835_gpio_get_func_id(struct udevice *dev, unsigned int gpio)
49 struct bcm283x_pinctrl_priv *priv = dev_get_priv(dev);
52 val = readl(&priv->base_reg[BCM2835_GPIO_FSEL_BANK(gpio)]);
54 return (val >> BCM2835_GPIO_FSEL_SHIFT(gpio) & BCM2835_GPIO_FSEL_MASK);
58 * bcm283x_pinctrl_set_state: configure pin functions.
59 * @dev: the pinctrl device to be configured.
60 * @config: the state to be configured.
61 * @return: 0 in success
63 int bcm283x_pinctrl_set_state(struct udevice *dev, struct udevice *config)
65 u32 pin_arr[MAX_PINS_PER_BANK];
67 int i, len, pin_count = 0;
69 if (!dev_read_prop(config, "brcm,pins", &len) || !len ||
70 len & 0x3 || dev_read_u32_array(config, "brcm,pins", pin_arr,
72 debug("Failed reading pins array for pinconfig %s (%d)\n",
77 pin_count = len / sizeof(u32);
79 function = dev_read_u32_default(config, "brcm,function", -1);
81 debug("Failed reading function for pinconfig %s (%d)\n",
82 config->name, function);
86 for (i = 0; i < pin_count; i++)
87 bcm2835_gpio_set_func_id(dev, pin_arr[i], function);
92 static int bcm283x_pinctrl_get_gpio_mux(struct udevice *dev, int banknum,
98 return bcm2835_gpio_get_func_id(dev, index);
101 static const struct udevice_id bcm2835_pinctrl_id[] = {
102 {.compatible = "brcm,bcm2835-gpio"},
106 int bcm283x_pinctl_probe(struct udevice *dev)
108 struct bcm283x_pinctrl_priv *priv;
110 struct udevice *pdev;
112 priv = dev_get_priv(dev);
114 debug("%s: Failed to get private\n", __func__);
118 priv->base_reg = dev_read_addr_ptr(dev);
119 if (priv->base_reg == (void *)FDT_ADDR_T_NONE) {
120 debug("%s: Failed to get base address\n", __func__);
124 /* Create GPIO device as well */
125 ret = device_bind(dev, lists_driver_lookup_name("gpio_bcm2835"),
126 "gpio_bcm2835", NULL, dev_of_offset(dev), &pdev);
129 * While we really want the pinctrl driver to work to make
130 * devices go where they should go, the GPIO controller is
131 * not quite as crucial as it's only rarely used, so don't
134 printf("Failed to bind GPIO driver\n");
140 static struct pinctrl_ops bcm283x_pinctrl_ops = {
141 .set_state = bcm283x_pinctrl_set_state,
142 .get_gpio_mux = bcm283x_pinctrl_get_gpio_mux,
145 U_BOOT_DRIVER(pinctrl_bcm283x) = {
146 .name = "bcm283x_pinctrl",
147 .id = UCLASS_PINCTRL,
148 .of_match = of_match_ptr(bcm2835_pinctrl_id),
149 .priv_auto_alloc_size = sizeof(struct bcm283x_pinctrl_priv),
150 .ops = &bcm283x_pinctrl_ops,
151 .probe = bcm283x_pinctl_probe