]>
Commit | Line | Data |
---|---|---|
1 | /* | |
2 | * Copyright (C) 2015 Thomas Chou <thomas@wytron.com.tw> | |
3 | * Copyright (C) 2011 Missing Link Electronics | |
4 | * Joachim Foerster <joachim@missinglinkelectronics.com> | |
5 | * | |
6 | * SPDX-License-Identifier: GPL-2.0+ | |
7 | */ | |
8 | #include <common.h> | |
9 | #include <dm.h> | |
10 | #include <errno.h> | |
11 | #include <malloc.h> | |
12 | #include <fdtdec.h> | |
13 | #include <asm/io.h> | |
14 | #include <asm/gpio.h> | |
15 | ||
16 | DECLARE_GLOBAL_DATA_PTR; | |
17 | ||
18 | struct altera_pio_regs { | |
19 | u32 data; /* Data register */ | |
20 | u32 direction; /* Direction register */ | |
21 | }; | |
22 | ||
23 | struct altera_pio_platdata { | |
24 | struct altera_pio_regs *regs; | |
25 | int gpio_count; | |
26 | const char *bank_name; | |
27 | }; | |
28 | ||
29 | static int altera_pio_direction_input(struct udevice *dev, unsigned pin) | |
30 | { | |
31 | struct altera_pio_platdata *plat = dev_get_platdata(dev); | |
32 | struct altera_pio_regs *const regs = plat->regs; | |
33 | ||
34 | clrbits_le32(®s->direction, 1 << pin); | |
35 | ||
36 | return 0; | |
37 | } | |
38 | ||
39 | static int altera_pio_direction_output(struct udevice *dev, unsigned pin, | |
40 | int val) | |
41 | { | |
42 | struct altera_pio_platdata *plat = dev_get_platdata(dev); | |
43 | struct altera_pio_regs *const regs = plat->regs; | |
44 | ||
45 | if (val) | |
46 | setbits_le32(®s->data, 1 << pin); | |
47 | else | |
48 | clrbits_le32(®s->data, 1 << pin); | |
49 | /* change the data first, then the direction. to avoid glitch */ | |
50 | setbits_le32(®s->direction, 1 << pin); | |
51 | ||
52 | return 0; | |
53 | } | |
54 | ||
55 | static int altera_pio_get_value(struct udevice *dev, unsigned pin) | |
56 | { | |
57 | struct altera_pio_platdata *plat = dev_get_platdata(dev); | |
58 | struct altera_pio_regs *const regs = plat->regs; | |
59 | ||
60 | return readl(®s->data) & (1 << pin); | |
61 | } | |
62 | ||
63 | ||
64 | static int altera_pio_set_value(struct udevice *dev, unsigned pin, int val) | |
65 | { | |
66 | struct altera_pio_platdata *plat = dev_get_platdata(dev); | |
67 | struct altera_pio_regs *const regs = plat->regs; | |
68 | ||
69 | if (val) | |
70 | setbits_le32(®s->data, 1 << pin); | |
71 | else | |
72 | clrbits_le32(®s->data, 1 << pin); | |
73 | ||
74 | return 0; | |
75 | } | |
76 | ||
77 | static int altera_pio_probe(struct udevice *dev) | |
78 | { | |
79 | struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev); | |
80 | struct altera_pio_platdata *plat = dev_get_platdata(dev); | |
81 | ||
82 | uc_priv->gpio_count = plat->gpio_count; | |
83 | uc_priv->bank_name = plat->bank_name; | |
84 | ||
85 | return 0; | |
86 | } | |
87 | ||
88 | static int altera_pio_ofdata_to_platdata(struct udevice *dev) | |
89 | { | |
90 | struct altera_pio_platdata *plat = dev_get_platdata(dev); | |
91 | ||
92 | plat->regs = map_physmem(dev_get_addr(dev), | |
93 | sizeof(struct altera_pio_regs), | |
94 | MAP_NOCACHE); | |
95 | plat->gpio_count = fdtdec_get_int(gd->fdt_blob, dev->of_offset, | |
96 | "altr,gpio-bank-width", 32); | |
97 | plat->bank_name = fdt_getprop(gd->fdt_blob, dev->of_offset, | |
98 | "gpio-bank-name", NULL); | |
99 | ||
100 | return 0; | |
101 | } | |
102 | ||
103 | static const struct dm_gpio_ops altera_pio_ops = { | |
104 | .direction_input = altera_pio_direction_input, | |
105 | .direction_output = altera_pio_direction_output, | |
106 | .get_value = altera_pio_get_value, | |
107 | .set_value = altera_pio_set_value, | |
108 | }; | |
109 | ||
110 | static const struct udevice_id altera_pio_ids[] = { | |
111 | { .compatible = "altr,pio-1.0" }, | |
112 | { } | |
113 | }; | |
114 | ||
115 | U_BOOT_DRIVER(altera_pio) = { | |
116 | .name = "altera_pio", | |
117 | .id = UCLASS_GPIO, | |
118 | .of_match = altera_pio_ids, | |
119 | .ops = &altera_pio_ops, | |
120 | .ofdata_to_platdata = altera_pio_ofdata_to_platdata, | |
121 | .platdata_auto_alloc_size = sizeof(struct altera_pio_platdata), | |
122 | .probe = altera_pio_probe, | |
123 | }; |