]> git.sur5r.net Git - u-boot/blob - drivers/gpio/imx_rgpio2p.c
Merge git://git.denx.de/u-boot-usb
[u-boot] / drivers / gpio / imx_rgpio2p.c
1 /*
2  * Copyright 2016 Freescale Semiconductor, Inc.
3  *
4  * RGPIO2P driver for the Freescale i.MX7ULP.
5  *
6  * SPDX-License-Identifier:     GPL-2.0+
7  */
8
9 #include <common.h>
10 #include <dm.h>
11 #include <errno.h>
12 #include <fdtdec.h>
13 #include <asm/gpio.h>
14 #include <asm/io.h>
15 #include <malloc.h>
16
17 DECLARE_GLOBAL_DATA_PTR;
18
19 enum imx_rgpio2p_direction {
20         IMX_RGPIO2P_DIRECTION_IN,
21         IMX_RGPIO2P_DIRECTION_OUT,
22 };
23
24 #define GPIO_PER_BANK                   32
25
26 struct imx_rgpio2p_data {
27         struct gpio_regs *regs;
28 };
29
30 struct imx_rgpio2p_plat {
31         int bank_index;
32         struct gpio_regs *regs;
33 };
34
35 static int imx_rgpio2p_is_output(struct gpio_regs *regs, int offset)
36 {
37         u32 val;
38
39         val = readl(&regs->gpio_pddr);
40
41         return val & (1 << offset) ? 1 : 0;
42 }
43
44 static void imx_rgpio2p_bank_direction(struct gpio_regs *regs, int offset,
45                                     enum imx_rgpio2p_direction direction)
46 {
47         u32 l;
48
49         l = readl(&regs->gpio_pddr);
50
51         switch (direction) {
52         case IMX_RGPIO2P_DIRECTION_OUT:
53                 l |= 1 << offset;
54                 break;
55         case IMX_RGPIO2P_DIRECTION_IN:
56                 l &= ~(1 << offset);
57         }
58         writel(l, &regs->gpio_pddr);
59 }
60
61 static void imx_rgpio2p_bank_set_value(struct gpio_regs *regs, int offset,
62                                     int value)
63 {
64         if (value)
65                 writel((1 << offset), &regs->gpio_psor);
66         else
67                 writel((1 << offset), &regs->gpio_pcor);
68 }
69
70 static int imx_rgpio2p_bank_get_value(struct gpio_regs *regs, int offset)
71 {
72         return (readl(&regs->gpio_pdir) >> offset) & 0x01;
73 }
74
75 static int  imx_rgpio2p_direction_input(struct udevice *dev, unsigned offset)
76 {
77         struct imx_rgpio2p_data *bank = dev_get_priv(dev);
78
79         /* Configure GPIO direction as input. */
80         imx_rgpio2p_bank_direction(bank->regs, offset, IMX_RGPIO2P_DIRECTION_IN);
81
82         return 0;
83 }
84
85 static int imx_rgpio2p_direction_output(struct udevice *dev, unsigned offset,
86                                        int value)
87 {
88         struct imx_rgpio2p_data *bank = dev_get_priv(dev);
89
90         /* Configure GPIO output value. */
91         imx_rgpio2p_bank_set_value(bank->regs, offset, value);
92
93         /* Configure GPIO direction as output. */
94         imx_rgpio2p_bank_direction(bank->regs, offset, IMX_RGPIO2P_DIRECTION_OUT);
95
96         return 0;
97 }
98
99 static int imx_rgpio2p_get_value(struct udevice *dev, unsigned offset)
100 {
101         struct imx_rgpio2p_data *bank = dev_get_priv(dev);
102
103         return imx_rgpio2p_bank_get_value(bank->regs, offset);
104 }
105
106 static int imx_rgpio2p_set_value(struct udevice *dev, unsigned offset,
107                                  int value)
108 {
109         struct imx_rgpio2p_data *bank = dev_get_priv(dev);
110
111         imx_rgpio2p_bank_set_value(bank->regs, offset, value);
112
113         return 0;
114 }
115
116 static int imx_rgpio2p_get_function(struct udevice *dev, unsigned offset)
117 {
118         struct imx_rgpio2p_data *bank = dev_get_priv(dev);
119
120         /* GPIOF_FUNC is not implemented yet */
121         if (imx_rgpio2p_is_output(bank->regs, offset))
122                 return GPIOF_OUTPUT;
123         else
124                 return GPIOF_INPUT;
125 }
126
127 static const struct dm_gpio_ops imx_rgpio2p_ops = {
128         .direction_input        = imx_rgpio2p_direction_input,
129         .direction_output       = imx_rgpio2p_direction_output,
130         .get_value              = imx_rgpio2p_get_value,
131         .set_value              = imx_rgpio2p_set_value,
132         .get_function           = imx_rgpio2p_get_function,
133 };
134
135 static int imx_rgpio2p_probe(struct udevice *dev)
136 {
137         struct imx_rgpio2p_data *bank = dev_get_priv(dev);
138         struct imx_rgpio2p_plat *plat = dev_get_platdata(dev);
139         struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
140         int banknum;
141         char name[18], *str;
142
143         banknum = plat->bank_index;
144         sprintf(name, "GPIO%d_", banknum + 1);
145         str = strdup(name);
146         if (!str)
147                 return -ENOMEM;
148         uc_priv->bank_name = str;
149         uc_priv->gpio_count = GPIO_PER_BANK;
150         bank->regs = plat->regs;
151
152         return 0;
153 }
154
155 static int imx_rgpio2p_bind(struct udevice *dev)
156 {
157         struct imx_rgpio2p_plat *plat = dev->platdata;
158         fdt_addr_t addr;
159
160         /*
161          * If platdata already exsits, directly return.
162          * Actually only when DT is not supported, platdata
163          * is statically initialized in U_BOOT_DEVICES.Here
164          * will return.
165          */
166         if (plat)
167                 return 0;
168
169         addr = devfdt_get_addr_index(dev, 1);
170         if (addr == FDT_ADDR_T_NONE)
171                 return -EINVAL;
172
173         /*
174          * TODO:
175          * When every board is converted to driver model and DT is supported,
176          * this can be done by auto-alloc feature, but not using calloc
177          * to alloc memory for platdata.
178          *
179          * For example imx_rgpio2p_plat uses platform data rather than device
180          * tree.
181          *
182          * NOTE: DO NOT COPY this code if you are using device tree.
183          */
184         plat = calloc(1, sizeof(*plat));
185         if (!plat)
186                 return -ENOMEM;
187
188         plat->regs = (struct gpio_regs *)addr;
189         plat->bank_index = dev->req_seq;
190         dev->platdata = plat;
191
192         return 0;
193 }
194
195
196 static const struct udevice_id imx_rgpio2p_ids[] = {
197         { .compatible = "fsl,imx7ulp-gpio" },
198         { }
199 };
200
201 U_BOOT_DRIVER(imx_rgpio2p) = {
202         .name   = "imx_rgpio2p",
203         .id     = UCLASS_GPIO,
204         .ops    = &imx_rgpio2p_ops,
205         .probe  = imx_rgpio2p_probe,
206         .priv_auto_alloc_size = sizeof(struct imx_rgpio2p_plat),
207         .of_match = imx_rgpio2p_ids,
208         .bind   = imx_rgpio2p_bind,
209 };
210
211 #if !CONFIG_IS_ENABLED(OF_CONTROL)
212 static const struct imx_rgpio2p_plat imx_plat[] = {
213         { 0, (struct gpio_regs *)RGPIO2P_GPIO1_BASE_ADDR },
214         { 1, (struct gpio_regs *)RGPIO2P_GPIO2_BASE_ADDR },
215         { 2, (struct gpio_regs *)RGPIO2P_GPIO3_BASE_ADDR },
216         { 3, (struct gpio_regs *)RGPIO2P_GPIO4_BASE_ADDR },
217         { 4, (struct gpio_regs *)RGPIO2P_GPIO5_BASE_ADDR },
218         { 5, (struct gpio_regs *)RGPIO2P_GPIO6_BASE_ADDR },
219 };
220
221 U_BOOT_DEVICES(imx_rgpio2ps) = {
222         { "imx_rgpio2p", &imx_plat[0] },
223         { "imx_rgpio2p", &imx_plat[1] },
224         { "imx_rgpio2p", &imx_plat[2] },
225         { "imx_rgpio2p", &imx_plat[3] },
226         { "imx_rgpio2p", &imx_plat[4] },
227         { "imx_rgpio2p", &imx_plat[5] },
228 };
229 #endif