blob: 7825714e8003c0e92573c11673013de58034e909 [file] [log] [blame]
Peng Fand665eb62017-02-22 16:21:45 +08001/*
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
17DECLARE_GLOBAL_DATA_PTR;
18
19enum imx_rgpio2p_direction {
20 IMX_RGPIO2P_DIRECTION_IN,
21 IMX_RGPIO2P_DIRECTION_OUT,
22};
23
24#define GPIO_PER_BANK 32
25
26struct imx_rgpio2p_data {
27 struct gpio_regs *regs;
28};
29
30struct imx_rgpio2p_plat {
31 int bank_index;
32 struct gpio_regs *regs;
33};
34
35static 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
44static 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
61static 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
70static int imx_rgpio2p_bank_get_value(struct gpio_regs *regs, int offset)
71{
72 return (readl(&regs->gpio_pdir) >> offset) & 0x01;
73}
74
75static 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
85static 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
99static 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
106static 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
116static 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
127static 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
135static 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
155static 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
Simon Glassa821c4a2017-05-17 17:18:05 -0600169 addr = devfdt_get_addr_index(dev, 1);
Peng Fand665eb62017-02-22 16:21:45 +0800170 if (addr == FDT_ADDR_T_NONE)
Simon Glass7c843192017-09-17 16:54:53 -0600171 return -EINVAL;
Peng Fand665eb62017-02-22 16:21:45 +0800172
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.
Simon Glass4d686042017-09-17 16:54:52 -0600178 *
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.
Peng Fand665eb62017-02-22 16:21:45 +0800183 */
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
196static const struct udevice_id imx_rgpio2p_ids[] = {
197 { .compatible = "fsl,imx7ulp-gpio" },
198 { }
199};
200
201U_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)
212static 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
221U_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