1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (C) 2017 Álvaro Fernández Rojas <noltari@gmail.com>
4 *
5 * Derived from linux/arch/mips/bcm63xx/gpio.c:
6 * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr>
7 * Copyright (C) 2008-2011 Florian Fainelli <florian@openwrt.org>
8 */
9
10 #include <common.h>
11 #include <dm.h>
12 #include <errno.h>
13 #include <asm/gpio.h>
14 #include <asm/io.h>
15
16 struct bcm6345_gpio_priv {
17 void __iomem *reg_dirout;
18 void __iomem *reg_data;
19 };
20
bcm6345_gpio_get_value(struct udevice * dev,unsigned offset)21 static int bcm6345_gpio_get_value(struct udevice *dev, unsigned offset)
22 {
23 struct bcm6345_gpio_priv *priv = dev_get_priv(dev);
24
25 return !!(readl_be(priv->reg_data) & BIT(offset));
26 }
27
bcm6345_gpio_set_value(struct udevice * dev,unsigned offset,int value)28 static int bcm6345_gpio_set_value(struct udevice *dev, unsigned offset,
29 int value)
30 {
31 struct bcm6345_gpio_priv *priv = dev_get_priv(dev);
32
33 if (value)
34 setbits_be32(priv->reg_data, BIT(offset));
35 else
36 clrbits_be32(priv->reg_data, BIT(offset));
37
38 return 0;
39 }
40
bcm6345_gpio_set_direction(void __iomem * dirout,unsigned offset,bool input)41 static int bcm6345_gpio_set_direction(void __iomem *dirout, unsigned offset,
42 bool input)
43 {
44 if (input)
45 clrbits_be32(dirout, BIT(offset));
46 else
47 setbits_be32(dirout, BIT(offset));
48
49 return 0;
50 }
51
bcm6345_gpio_direction_input(struct udevice * dev,unsigned offset)52 static int bcm6345_gpio_direction_input(struct udevice *dev, unsigned offset)
53 {
54 struct bcm6345_gpio_priv *priv = dev_get_priv(dev);
55
56 return bcm6345_gpio_set_direction(priv->reg_dirout, offset, 1);
57 }
58
bcm6345_gpio_direction_output(struct udevice * dev,unsigned offset,int value)59 static int bcm6345_gpio_direction_output(struct udevice *dev, unsigned offset,
60 int value)
61 {
62 struct bcm6345_gpio_priv *priv = dev_get_priv(dev);
63
64 bcm6345_gpio_set_value(dev, offset, value);
65
66 return bcm6345_gpio_set_direction(priv->reg_dirout, offset, 0);
67 }
68
bcm6345_gpio_get_function(struct udevice * dev,unsigned offset)69 static int bcm6345_gpio_get_function(struct udevice *dev, unsigned offset)
70 {
71 struct bcm6345_gpio_priv *priv = dev_get_priv(dev);
72
73 if (readl_be(priv->reg_dirout) & BIT(offset))
74 return GPIOF_OUTPUT;
75 else
76 return GPIOF_INPUT;
77 }
78
79 static const struct dm_gpio_ops bcm6345_gpio_ops = {
80 .direction_input = bcm6345_gpio_direction_input,
81 .direction_output = bcm6345_gpio_direction_output,
82 .get_value = bcm6345_gpio_get_value,
83 .set_value = bcm6345_gpio_set_value,
84 .get_function = bcm6345_gpio_get_function,
85 };
86
bcm6345_gpio_probe(struct udevice * dev)87 static int bcm6345_gpio_probe(struct udevice *dev)
88 {
89 struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
90 struct bcm6345_gpio_priv *priv = dev_get_priv(dev);
91
92 priv->reg_dirout = dev_remap_addr_index(dev, 0);
93 if (!priv->reg_dirout)
94 return -EINVAL;
95
96 priv->reg_data = dev_remap_addr_index(dev, 1);
97 if (!priv->reg_data)
98 return -EINVAL;
99
100 uc_priv->gpio_count = dev_read_u32_default(dev, "ngpios", 32);
101 uc_priv->bank_name = dev->name;
102
103 return 0;
104 }
105
106 static const struct udevice_id bcm6345_gpio_ids[] = {
107 { .compatible = "brcm,bcm6345-gpio" },
108 { /* sentinel */ }
109 };
110
111 U_BOOT_DRIVER(bcm6345_gpio) = {
112 .name = "bcm6345-gpio",
113 .id = UCLASS_GPIO,
114 .of_match = bcm6345_gpio_ids,
115 .ops = &bcm6345_gpio_ops,
116 .priv_auto_alloc_size = sizeof(struct bcm6345_gpio_priv),
117 .probe = bcm6345_gpio_probe,
118 };
119