Commit | Line | Data |
---|---|---|
86b8e7d6 MV |
1 | // SPDX-License-Identifier: GPL-2.0+ |
2 | /* | |
3 | * Copyright (C) 2019 Marek Vasut <marek.vasut@gmail.com> | |
4 | */ | |
5 | ||
6 | #include <common.h> | |
7 | #include <clk.h> | |
8 | #include <dm.h> | |
9 | #include <errno.h> | |
401d1c4f | 10 | #include <asm/global_data.h> |
86b8e7d6 MV |
11 | #include <asm/gpio.h> |
12 | #include <asm/io.h> | |
cd93d625 | 13 | #include <linux/bitops.h> |
86b8e7d6 MV |
14 | |
15 | #define P(bank) (0x0000 + (bank) * 4) | |
16 | #define PSR(bank) (0x0100 + (bank) * 4) | |
17 | #define PPR(bank) (0x0200 + (bank) * 4) | |
18 | #define PM(bank) (0x0300 + (bank) * 4) | |
19 | #define PMC(bank) (0x0400 + (bank) * 4) | |
20 | #define PFC(bank) (0x0500 + (bank) * 4) | |
21 | #define PFCE(bank) (0x0600 + (bank) * 4) | |
22 | #define PNOT(bank) (0x0700 + (bank) * 4) | |
23 | #define PMSR(bank) (0x0800 + (bank) * 4) | |
24 | #define PMCSR(bank) (0x0900 + (bank) * 4) | |
25 | #define PFCAE(bank) (0x0A00 + (bank) * 4) | |
26 | #define PIBC(bank) (0x4000 + (bank) * 4) | |
27 | #define PBDC(bank) (0x4100 + (bank) * 4) | |
28 | #define PIPC(bank) (0x4200 + (bank) * 4) | |
29 | ||
30 | #define RZA1_MAX_GPIO_PER_BANK 16 | |
31 | ||
32 | DECLARE_GLOBAL_DATA_PTR; | |
33 | ||
34 | struct r7s72100_gpio_priv { | |
35 | void __iomem *regs; | |
36 | int bank; | |
37 | }; | |
38 | ||
39 | static int r7s72100_gpio_get_value(struct udevice *dev, unsigned offset) | |
40 | { | |
41 | struct r7s72100_gpio_priv *priv = dev_get_priv(dev); | |
42 | ||
43 | return !!(readw(priv->regs + PPR(priv->bank)) & BIT(offset)); | |
44 | } | |
45 | ||
46 | static int r7s72100_gpio_set_value(struct udevice *dev, unsigned line, | |
47 | int value) | |
48 | { | |
49 | struct r7s72100_gpio_priv *priv = dev_get_priv(dev); | |
50 | ||
51 | writel(BIT(line + 16) | (value ? BIT(line) : 0), | |
52 | priv->regs + PSR(priv->bank)); | |
53 | ||
54 | return 0; | |
55 | } | |
56 | ||
57 | static void r7s72100_gpio_set_direction(struct udevice *dev, unsigned line, | |
58 | bool output) | |
59 | { | |
60 | struct r7s72100_gpio_priv *priv = dev_get_priv(dev); | |
61 | ||
62 | writel(BIT(line + 16), priv->regs + PMCSR(priv->bank)); | |
63 | writel(BIT(line + 16) | (output ? 0 : BIT(line)), | |
64 | priv->regs + PMSR(priv->bank)); | |
65 | ||
66 | clrsetbits_le16(priv->regs + PIBC(priv->bank), BIT(line), | |
67 | output ? 0 : BIT(line)); | |
68 | } | |
69 | ||
70 | static int r7s72100_gpio_direction_input(struct udevice *dev, unsigned offset) | |
71 | { | |
72 | r7s72100_gpio_set_direction(dev, offset, false); | |
73 | return 0; | |
74 | } | |
75 | ||
76 | static int r7s72100_gpio_direction_output(struct udevice *dev, unsigned offset, | |
77 | int value) | |
78 | { | |
79 | /* write GPIO value to output before selecting output mode of pin */ | |
80 | r7s72100_gpio_set_value(dev, offset, value); | |
81 | r7s72100_gpio_set_direction(dev, offset, true); | |
82 | ||
83 | return 0; | |
84 | } | |
85 | ||
86 | static int r7s72100_gpio_get_function(struct udevice *dev, unsigned offset) | |
87 | { | |
88 | struct r7s72100_gpio_priv *priv = dev_get_priv(dev); | |
89 | ||
90 | if (readw(priv->regs + PM(priv->bank)) & BIT(offset)) | |
91 | return GPIOF_INPUT; | |
92 | else | |
93 | return GPIOF_OUTPUT; | |
94 | } | |
95 | ||
96 | static const struct dm_gpio_ops r7s72100_gpio_ops = { | |
97 | .direction_input = r7s72100_gpio_direction_input, | |
98 | .direction_output = r7s72100_gpio_direction_output, | |
99 | .get_value = r7s72100_gpio_get_value, | |
100 | .set_value = r7s72100_gpio_set_value, | |
101 | .get_function = r7s72100_gpio_get_function, | |
102 | }; | |
103 | ||
104 | static int r7s72100_gpio_probe(struct udevice *dev) | |
105 | { | |
106 | struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev); | |
107 | struct r7s72100_gpio_priv *priv = dev_get_priv(dev); | |
108 | struct fdtdec_phandle_args args; | |
109 | int node = dev_of_offset(dev); | |
110 | int ret; | |
111 | ||
112 | fdt_addr_t addr_base; | |
113 | ||
114 | uc_priv->bank_name = dev->name; | |
115 | dev = dev_get_parent(dev); | |
2548493a | 116 | addr_base = dev_read_addr(dev); |
86b8e7d6 MV |
117 | if (addr_base == FDT_ADDR_T_NONE) |
118 | return -EINVAL; | |
119 | ||
120 | priv->regs = (void __iomem *)addr_base; | |
121 | ||
122 | ret = fdtdec_parse_phandle_with_args(gd->fdt_blob, node, "gpio-ranges", | |
123 | NULL, 3, 0, &args); | |
124 | priv->bank = ret == 0 ? (args.args[1] / RZA1_MAX_GPIO_PER_BANK) : -1; | |
125 | uc_priv->gpio_count = ret == 0 ? args.args[2] : RZA1_MAX_GPIO_PER_BANK; | |
126 | ||
127 | return 0; | |
128 | } | |
129 | ||
130 | U_BOOT_DRIVER(r7s72100_gpio) = { | |
131 | .name = "r7s72100-gpio", | |
132 | .id = UCLASS_GPIO, | |
133 | .ops = &r7s72100_gpio_ops, | |
41575d8e | 134 | .priv_auto = sizeof(struct r7s72100_gpio_priv), |
86b8e7d6 MV |
135 | .probe = r7s72100_gpio_probe, |
136 | }; |