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