1
2
3
4
5
6
7
8
9#include <common.h>
10#include <dm.h>
11#include <fdtdec.h>
12#include <malloc.h>
13#include <asm/io.h>
14#include <asm/gpio.h>
15#include <dt-bindings/gpio/gpio.h>
16
17#include "da8xx_gpio.h"
18
19#if !CONFIG_IS_ENABLED(DM_GPIO)
20#include <asm/arch/hardware.h>
21#include <asm/arch/davinci_misc.h>
22
23static struct gpio_registry {
24 int is_registered;
25 char name[GPIO_NAME_SIZE];
26} gpio_registry[MAX_NUM_GPIOS];
27
28#if defined(CONFIG_SOC_DA8XX)
29#define pinmux(x) (&davinci_syscfg_regs->pinmux[x])
30
31#if defined(CONFIG_SOC_DA8XX) && !defined(CONFIG_SOC_DA850)
32static const struct pinmux_config gpio_pinmux[] = {
33 { pinmux(13), 8, 6 },
34 { pinmux(13), 8, 7 },
35 { pinmux(14), 8, 0 },
36 { pinmux(14), 8, 1 },
37 { pinmux(14), 8, 2 },
38 { pinmux(14), 8, 3 },
39 { pinmux(14), 8, 4 },
40 { pinmux(14), 8, 5 },
41 { pinmux(14), 8, 6 },
42 { pinmux(14), 8, 7 },
43 { pinmux(15), 8, 0 },
44 { pinmux(15), 8, 1 },
45 { pinmux(15), 8, 2 },
46 { pinmux(15), 8, 3 },
47 { pinmux(15), 8, 4 },
48 { pinmux(15), 8, 5 },
49 { pinmux(15), 8, 6 },
50 { pinmux(15), 8, 7 },
51 { pinmux(16), 8, 0 },
52 { pinmux(16), 8, 1 },
53 { pinmux(16), 8, 2 },
54 { pinmux(16), 8, 3 },
55 { pinmux(16), 8, 4 },
56 { pinmux(16), 8, 5 },
57 { pinmux(16), 8, 6 },
58 { pinmux(16), 8, 7 },
59 { pinmux(17), 8, 0 },
60 { pinmux(17), 8, 1 },
61 { pinmux(17), 8, 2 },
62 { pinmux(17), 8, 3 },
63 { pinmux(17), 8, 4 },
64 { pinmux(17), 8, 5 },
65 { pinmux(17), 8, 6 },
66 { pinmux(17), 8, 7 },
67 { pinmux(18), 8, 0 },
68 { pinmux(18), 8, 1 },
69 { pinmux(18), 8, 2 },
70 { pinmux(18), 8, 3 },
71 { pinmux(18), 8, 4 },
72 { pinmux(18), 8, 5 },
73 { pinmux(18), 8, 6 },
74 { pinmux(18), 8, 7 },
75 { pinmux(19), 8, 0 },
76 { pinmux(9), 8, 2 },
77 { pinmux(9), 8, 3 },
78 { pinmux(9), 8, 4 },
79 { pinmux(9), 8, 5 },
80 { pinmux(9), 8, 6 },
81 { pinmux(10), 8, 1 },
82 { pinmux(10), 8, 2 },
83 { pinmux(10), 8, 3 },
84 { pinmux(10), 8, 4 },
85 { pinmux(10), 8, 5 },
86 { pinmux(10), 8, 6 },
87 { pinmux(10), 8, 7 },
88 { pinmux(11), 8, 0 },
89 { pinmux(11), 8, 1 },
90 { pinmux(11), 8, 2 },
91 { pinmux(11), 8, 3 },
92 { pinmux(11), 8, 4 },
93 { pinmux(9), 8, 7 },
94 { pinmux(2), 8, 6 },
95 { pinmux(11), 8, 5 },
96 { pinmux(11), 8, 6 },
97 { pinmux(12), 8, 4 },
98 { pinmux(12), 8, 5 },
99 { pinmux(12), 8, 6 },
100 { pinmux(12), 8, 7 },
101 { pinmux(13), 8, 0 },
102 { pinmux(13), 8, 1 },
103 { pinmux(13), 8, 2 },
104 { pinmux(13), 8, 3 },
105 { pinmux(13), 8, 4 },
106 { pinmux(13), 8, 5 },
107 { pinmux(11), 8, 7 },
108 { pinmux(12), 8, 0 },
109 { pinmux(12), 8, 1 },
110 { pinmux(12), 8, 2 },
111 { pinmux(12), 8, 3 },
112 { pinmux(9), 8, 1 },
113 { pinmux(7), 8, 3 },
114 { pinmux(7), 8, 4 },
115 { pinmux(7), 8, 5 },
116 { pinmux(7), 8, 6 },
117 { pinmux(7), 8, 7 },
118 { pinmux(8), 8, 0 },
119 { pinmux(8), 8, 1 },
120 { pinmux(8), 8, 2 },
121 { pinmux(8), 8, 3 },
122 { pinmux(8), 8, 4 },
123 { pinmux(8), 8, 5 },
124 { pinmux(8), 8, 6 },
125 { pinmux(8), 8, 7 },
126 { pinmux(9), 8, 0 },
127 { pinmux(7), 8, 1 },
128 { pinmux(7), 8, 2 },
129 { pinmux(5), 8, 1 },
130 { pinmux(5), 8, 2 },
131 { pinmux(5), 8, 3 },
132 { pinmux(5), 8, 4 },
133 { pinmux(5), 8, 5 },
134 { pinmux(5), 8, 6 },
135 { pinmux(5), 8, 7 },
136 { pinmux(6), 8, 0 },
137 { pinmux(6), 8, 1 },
138 { pinmux(6), 8, 2 },
139 { pinmux(6), 8, 3 },
140 { pinmux(6), 8, 4 },
141 { pinmux(6), 8, 5 },
142 { pinmux(6), 8, 6 },
143 { pinmux(6), 8, 7 },
144 { pinmux(7), 8, 0 },
145 { pinmux(1), 8, 0 },
146 { pinmux(1), 8, 1 },
147 { pinmux(1), 8, 2 },
148 { pinmux(1), 8, 3 },
149 { pinmux(1), 8, 4 },
150 { pinmux(1), 8, 5 },
151 { pinmux(1), 8, 6 },
152 { pinmux(1), 8, 7 },
153 { pinmux(2), 8, 0 },
154 { pinmux(2), 8, 1 },
155 { pinmux(2), 8, 2 },
156 { pinmux(2), 8, 3 },
157 { pinmux(2), 8, 4 },
158 { pinmux(2), 8, 5 },
159 { pinmux(0), 1, 0 },
160 { pinmux(0), 1, 1 },
161};
162#else
163static const struct pinmux_config gpio_pinmux[] = {
164 { pinmux(1), 8, 7 },
165 { pinmux(1), 8, 6 },
166 { pinmux(1), 8, 5 },
167 { pinmux(1), 8, 4 },
168 { pinmux(1), 8, 3 },
169 { pinmux(1), 8, 2 },
170 { pinmux(1), 8, 1 },
171 { pinmux(1), 8, 0 },
172 { pinmux(0), 8, 7 },
173 { pinmux(0), 8, 6 },
174 { pinmux(0), 8, 5 },
175 { pinmux(0), 8, 4 },
176 { pinmux(0), 8, 3 },
177 { pinmux(0), 8, 2 },
178 { pinmux(0), 8, 1 },
179 { pinmux(0), 8, 0 },
180 { pinmux(4), 8, 7 },
181 { pinmux(4), 8, 6 },
182 { pinmux(4), 8, 5 },
183 { pinmux(4), 8, 4 },
184 { pinmux(4), 8, 3 },
185 { pinmux(4), 8, 2 },
186 { pinmux(4), 4, 1 },
187 { pinmux(4), 4, 0 },
188 { pinmux(3), 4, 0 },
189 { pinmux(2), 4, 6 },
190 { pinmux(2), 4, 5 },
191 { pinmux(2), 4, 4 },
192 { pinmux(2), 4, 3 },
193 { pinmux(2), 4, 2 },
194 { pinmux(2), 4, 1 },
195 { pinmux(2), 8, 0 },
196 { pinmux(6), 8, 7 },
197 { pinmux(6), 8, 6 },
198 { pinmux(6), 8, 5 },
199 { pinmux(6), 8, 4 },
200 { pinmux(6), 8, 3 },
201 { pinmux(6), 8, 2 },
202 { pinmux(6), 8, 1 },
203 { pinmux(6), 8, 0 },
204 { pinmux(5), 8, 7 },
205 { pinmux(5), 8, 6 },
206 { pinmux(5), 8, 5 },
207 { pinmux(5), 8, 4 },
208 { pinmux(5), 8, 3 },
209 { pinmux(5), 8, 2 },
210 { pinmux(5), 8, 1 },
211 { pinmux(5), 8, 0 },
212 { pinmux(8), 8, 7 },
213 { pinmux(8), 8, 6 },
214 { pinmux(8), 8, 5 },
215 { pinmux(8), 8, 4 },
216 { pinmux(8), 8, 3 },
217 { pinmux(8), 8, 2 },
218 { pinmux(8), 8, 1 },
219 { pinmux(8), 8, 0 },
220 { pinmux(7), 8, 7 },
221 { pinmux(7), 8, 6 },
222 { pinmux(7), 8, 5 },
223 { pinmux(7), 8, 4 },
224 { pinmux(7), 8, 3 },
225 { pinmux(7), 8, 2 },
226 { pinmux(7), 8, 1 },
227 { pinmux(7), 8, 0 },
228 { pinmux(10), 8, 7 },
229 { pinmux(10), 8, 6 },
230 { pinmux(10), 8, 5 },
231 { pinmux(10), 8, 4 },
232 { pinmux(10), 8, 3 },
233 { pinmux(10), 8, 2 },
234 { pinmux(10), 8, 1 },
235 { pinmux(10), 8, 0 },
236 { pinmux(9), 8, 7 },
237 { pinmux(9), 8, 6 },
238 { pinmux(9), 8, 5 },
239 { pinmux(9), 8, 4 },
240 { pinmux(9), 8, 3 },
241 { pinmux(9), 8, 2 },
242 { pinmux(9), 8, 1 },
243 { pinmux(9), 8, 0 },
244 { pinmux(12), 8, 7 },
245 { pinmux(12), 8, 6 },
246 { pinmux(12), 8, 5 },
247 { pinmux(12), 8, 4 },
248 { pinmux(12), 8, 3 },
249 { pinmux(12), 8, 2 },
250 { pinmux(12), 8, 1 },
251 { pinmux(12), 8, 0 },
252 { pinmux(11), 8, 7 },
253 { pinmux(11), 8, 6 },
254 { pinmux(11), 8, 5 },
255 { pinmux(11), 8, 4 },
256 { pinmux(11), 8, 3 },
257 { pinmux(11), 8, 2 },
258 { pinmux(11), 8, 1 },
259 { pinmux(11), 8, 0 },
260 { pinmux(19), 8, 6 },
261 { pinmux(19), 8, 5 },
262 { pinmux(19), 8, 4 },
263 { pinmux(19), 8, 3 },
264 { pinmux(19), 8, 2 },
265 { pinmux(16), 8, 1 },
266 { pinmux(14), 8, 1 },
267 { pinmux(14), 8, 0 },
268 { pinmux(13), 8, 7 },
269 { pinmux(13), 8, 6 },
270 { pinmux(13), 8, 5 },
271 { pinmux(13), 8, 4 },
272 { pinmux(13), 8, 3 },
273 { pinmux(13), 8, 2 },
274 { pinmux(13), 8, 1 },
275 { pinmux(13), 8, 0 },
276 { pinmux(18), 8, 1 },
277 { pinmux(18), 8, 0 },
278 { pinmux(17), 8, 7 },
279 { pinmux(17), 8, 6 },
280 { pinmux(17), 8, 5 },
281 { pinmux(17), 8, 4 },
282 { pinmux(17), 8, 3 },
283 { pinmux(17), 8, 2 },
284 { pinmux(17), 8, 1 },
285 { pinmux(17), 8, 0 },
286 { pinmux(16), 8, 7 },
287 { pinmux(16), 8, 6 },
288 { pinmux(16), 8, 5 },
289 { pinmux(16), 8, 4 },
290 { pinmux(16), 8, 3 },
291 { pinmux(16), 8, 2 },
292 { pinmux(19), 8, 0 },
293 { pinmux(3), 4, 7 },
294 { pinmux(3), 4, 6 },
295 { pinmux(3), 4, 5 },
296 { pinmux(3), 4, 4 },
297 { pinmux(3), 4, 3 },
298 { pinmux(3), 4, 2 },
299 { pinmux(2), 4, 7 },
300 { pinmux(19), 8, 1 },
301 { pinmux(19), 8, 0 },
302 { pinmux(18), 8, 7 },
303 { pinmux(18), 8, 6 },
304 { pinmux(18), 8, 5 },
305 { pinmux(18), 8, 4 },
306 { pinmux(18), 8, 3 },
307 { pinmux(18), 8, 2 },
308};
309#endif
310#else
311#define davinci_configure_pin_mux(a, b)
312#endif
313
314int gpio_request(unsigned int gpio, const char *label)
315{
316 if (gpio >= MAX_NUM_GPIOS)
317 return -1;
318
319 if (gpio_registry[gpio].is_registered)
320 return -1;
321
322 gpio_registry[gpio].is_registered = 1;
323 strncpy(gpio_registry[gpio].name, label, GPIO_NAME_SIZE);
324 gpio_registry[gpio].name[GPIO_NAME_SIZE - 1] = 0;
325
326 davinci_configure_pin_mux(&gpio_pinmux[gpio], 1);
327
328 return 0;
329}
330
331int gpio_free(unsigned int gpio)
332{
333 if (gpio >= MAX_NUM_GPIOS)
334 return -1;
335
336 if (!gpio_registry[gpio].is_registered)
337 return -1;
338
339 gpio_registry[gpio].is_registered = 0;
340 gpio_registry[gpio].name[0] = '\0';
341
342 return 0;
343}
344#endif
345
346static int _gpio_direction_input(struct davinci_gpio *bank, unsigned int gpio)
347{
348 setbits_le32(&bank->dir, 1U << GPIO_BIT(gpio));
349 return 0;
350}
351
352static int _gpio_get_value(struct davinci_gpio *bank, unsigned int gpio)
353{
354 unsigned int ip;
355 ip = in_le32(&bank->in_data) & (1U << GPIO_BIT(gpio));
356 return ip ? 1 : 0;
357}
358
359static int _gpio_set_value(struct davinci_gpio *bank, unsigned int gpio, int value)
360{
361 if (value)
362 bank->set_data = 1U << GPIO_BIT(gpio);
363 else
364 bank->clr_data = 1U << GPIO_BIT(gpio);
365
366 return 0;
367}
368
369static int _gpio_get_dir(struct davinci_gpio *bank, unsigned int gpio)
370{
371 return in_le32(&bank->dir) & (1U << GPIO_BIT(gpio));
372}
373
374static int _gpio_direction_output(struct davinci_gpio *bank, unsigned int gpio,
375 int value)
376{
377 clrbits_le32(&bank->dir, 1U << GPIO_BIT(gpio));
378 _gpio_set_value(bank, gpio, value);
379 return 0;
380}
381
382#if !CONFIG_IS_ENABLED(DM_GPIO)
383
384void gpio_info(void)
385{
386 unsigned int gpio, dir, val;
387 struct davinci_gpio *bank;
388
389 for (gpio = 0; gpio < MAX_NUM_GPIOS; ++gpio) {
390 bank = GPIO_BANK(gpio);
391 dir = _gpio_get_dir(bank, gpio);
392 val = gpio_get_value(gpio);
393
394 printf("% 4d: %s: %d [%c] %s\n",
395 gpio, dir ? " in" : "out", val,
396 gpio_registry[gpio].is_registered ? 'x' : ' ',
397 gpio_registry[gpio].name);
398 }
399}
400
401int gpio_direction_input(unsigned int gpio)
402{
403 struct davinci_gpio *bank;
404
405 bank = GPIO_BANK(gpio);
406 return _gpio_direction_input(bank, gpio);
407}
408
409int gpio_direction_output(unsigned int gpio, int value)
410{
411 struct davinci_gpio *bank;
412
413 bank = GPIO_BANK(gpio);
414 return _gpio_direction_output(bank, gpio, value);
415}
416
417int gpio_get_value(unsigned int gpio)
418{
419 struct davinci_gpio *bank;
420
421 bank = GPIO_BANK(gpio);
422 return _gpio_get_value(bank, gpio);
423}
424
425int gpio_set_value(unsigned int gpio, int value)
426{
427 struct davinci_gpio *bank;
428
429 bank = GPIO_BANK(gpio);
430 return _gpio_set_value(bank, gpio, value);
431}
432
433#else
434
435static struct davinci_gpio *davinci_get_gpio_bank(struct udevice *dev, unsigned int offset)
436{
437 struct davinci_gpio_bank *bank = dev_get_priv(dev);
438 unsigned long addr;
439
440
441
442
443
444
445
446 addr = ((unsigned long)(struct davinci_gpio *)bank->base) +
447 0x10 + (0x28 * (offset >> 5));
448 return (struct davinci_gpio *)addr;
449}
450
451static int davinci_gpio_direction_input(struct udevice *dev, unsigned int offset)
452{
453 struct davinci_gpio *base = davinci_get_gpio_bank(dev, offset);
454
455
456
457
458 _gpio_direction_input(base, (offset & 0x1f));
459 return 0;
460}
461
462static int davinci_gpio_direction_output(struct udevice *dev, unsigned int offset,
463 int value)
464{
465 struct davinci_gpio *base = davinci_get_gpio_bank(dev, offset);
466
467 _gpio_direction_output(base, (offset & 0x1f), value);
468 return 0;
469}
470
471static int davinci_gpio_get_value(struct udevice *dev, unsigned int offset)
472{
473 struct davinci_gpio *base = davinci_get_gpio_bank(dev, offset);
474
475 return _gpio_get_value(base, (offset & 0x1f));
476}
477
478static int davinci_gpio_set_value(struct udevice *dev, unsigned int offset,
479 int value)
480{
481 struct davinci_gpio *base = davinci_get_gpio_bank(dev, offset);
482
483 _gpio_set_value(base, (offset & 0x1f), value);
484
485 return 0;
486}
487
488static int davinci_gpio_get_function(struct udevice *dev, unsigned int offset)
489{
490 unsigned int dir;
491 struct davinci_gpio *base = davinci_get_gpio_bank(dev, offset);
492
493 dir = _gpio_get_dir(base, offset);
494
495 if (dir)
496 return GPIOF_INPUT;
497
498 return GPIOF_OUTPUT;
499}
500
501static int davinci_gpio_xlate(struct udevice *dev, struct gpio_desc *desc,
502 struct ofnode_phandle_args *args)
503{
504 desc->offset = args->args[0];
505
506 if (args->args[1] & GPIO_ACTIVE_LOW)
507 desc->flags = GPIOD_ACTIVE_LOW;
508 else
509 desc->flags = 0;
510 return 0;
511}
512
513static const struct dm_gpio_ops gpio_davinci_ops = {
514 .direction_input = davinci_gpio_direction_input,
515 .direction_output = davinci_gpio_direction_output,
516 .get_value = davinci_gpio_get_value,
517 .set_value = davinci_gpio_set_value,
518 .get_function = davinci_gpio_get_function,
519 .xlate = davinci_gpio_xlate,
520};
521
522static int davinci_gpio_probe(struct udevice *dev)
523{
524 struct davinci_gpio_bank *bank = dev_get_priv(dev);
525 struct davinci_gpio_platdata *plat = dev_get_platdata(dev);
526 struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
527 const void *fdt = gd->fdt_blob;
528 int node = dev_of_offset(dev);
529
530 uc_priv->bank_name = plat->port_name;
531 uc_priv->gpio_count = fdtdec_get_int(fdt, node, "ti,ngpio", -1);
532 bank->base = (struct davinci_gpio *)plat->base;
533 return 0;
534}
535
536static const struct udevice_id davinci_gpio_ids[] = {
537 { .compatible = "ti,dm6441-gpio" },
538 { .compatible = "ti,k2g-gpio" },
539 { .compatible = "ti,keystone-gpio" },
540 { }
541};
542
543static int davinci_gpio_ofdata_to_platdata(struct udevice *dev)
544{
545 struct davinci_gpio_platdata *plat = dev_get_platdata(dev);
546 fdt_addr_t addr;
547
548 addr = devfdt_get_addr(dev);
549 if (addr == FDT_ADDR_T_NONE)
550 return -EINVAL;
551
552 plat->base = addr;
553 return 0;
554}
555
556U_BOOT_DRIVER(gpio_davinci) = {
557 .name = "gpio_davinci",
558 .id = UCLASS_GPIO,
559 .ops = &gpio_davinci_ops,
560 .ofdata_to_platdata = of_match_ptr(davinci_gpio_ofdata_to_platdata),
561 .of_match = davinci_gpio_ids,
562 .bind = dm_scan_fdt_dev,
563 .platdata_auto_alloc_size = sizeof(struct davinci_gpio_platdata),
564 .probe = davinci_gpio_probe,
565 .priv_auto_alloc_size = sizeof(struct davinci_gpio_bank),
566};
567
568#endif
569