]>
Commit | Line | Data |
---|---|---|
a7294aba | 1 | /* |
e809e747 | 2 | * Copyright 2017 NXP |
a7294aba HZ |
3 | * Copyright 2014-2015 Freescale Semiconductor, Inc. |
4 | * Layerscape PCIe driver | |
5 | * | |
6 | * SPDX-License-Identifier: GPL-2.0+ | |
7 | */ | |
8 | ||
9 | #include <common.h> | |
10 | #include <pci.h> | |
11 | #include <asm/arch/fsl_serdes.h> | |
12 | #include <asm/io.h> | |
13 | #include <errno.h> | |
14 | #ifdef CONFIG_OF_BOARD_SETUP | |
15 | #include <libfdt.h> | |
16 | #include <fdt_support.h> | |
6e2941d7 SG |
17 | #ifdef CONFIG_ARM |
18 | #include <asm/arch/clock.h> | |
19 | #endif | |
a7294aba HZ |
20 | #include "pcie_layerscape.h" |
21 | ||
47d17362 | 22 | #if defined(CONFIG_FSL_LSCH3) || defined(CONFIG_FSL_LSCH2) |
a7294aba HZ |
23 | /* |
24 | * Return next available LUT index. | |
25 | */ | |
26 | static int ls_pcie_next_lut_index(struct ls_pcie *pcie) | |
27 | { | |
28 | if (pcie->next_lut_index < PCIE_LUT_ENTRY_COUNT) | |
29 | return pcie->next_lut_index++; | |
30 | else | |
31 | return -ENOSPC; /* LUT is full */ | |
32 | } | |
33 | ||
34 | /* returns the next available streamid for pcie, -errno if failed */ | |
35 | static int ls_pcie_next_streamid(void) | |
36 | { | |
37 | static int next_stream_id = FSL_PEX_STREAM_ID_START; | |
38 | ||
39 | if (next_stream_id > FSL_PEX_STREAM_ID_END) | |
40 | return -EINVAL; | |
41 | ||
42 | return next_stream_id++; | |
43 | } | |
a7294aba | 44 | |
80afc63f ML |
45 | static void lut_writel(struct ls_pcie *pcie, unsigned int value, |
46 | unsigned int offset) | |
47 | { | |
48 | if (pcie->big_endian) | |
49 | out_be32(pcie->lut + offset, value); | |
50 | else | |
51 | out_le32(pcie->lut + offset, value); | |
52 | } | |
53 | ||
54 | /* | |
55 | * Program a single LUT entry | |
56 | */ | |
57 | static void ls_pcie_lut_set_mapping(struct ls_pcie *pcie, int index, u32 devid, | |
58 | u32 streamid) | |
59 | { | |
60 | /* leave mask as all zeroes, want to match all bits */ | |
61 | lut_writel(pcie, devid << 16, PCIE_LUT_UDR(index)); | |
62 | lut_writel(pcie, streamid | PCIE_LUT_ENABLE, PCIE_LUT_LDR(index)); | |
63 | } | |
64 | ||
65 | /* | |
66 | * An msi-map is a property to be added to the pci controller | |
67 | * node. It is a table, where each entry consists of 4 fields | |
68 | * e.g.: | |
69 | * | |
70 | * msi-map = <[devid] [phandle-to-msi-ctrl] [stream-id] [count] | |
71 | * [devid] [phandle-to-msi-ctrl] [stream-id] [count]>; | |
72 | */ | |
73 | static void fdt_pcie_set_msi_map_entry(void *blob, struct ls_pcie *pcie, | |
74 | u32 devid, u32 streamid) | |
75 | { | |
76 | u32 *prop; | |
77 | u32 phandle; | |
78 | int nodeoffset; | |
0aaa1a90 HZ |
79 | uint svr; |
80 | char *compat = NULL; | |
80afc63f ML |
81 | |
82 | /* find pci controller node */ | |
83 | nodeoffset = fdt_node_offset_by_compat_reg(blob, "fsl,ls-pcie", | |
84 | pcie->dbi_res.start); | |
85 | if (nodeoffset < 0) { | |
19538f30 | 86 | #ifdef CONFIG_FSL_PCIE_COMPAT /* Compatible with older version of dts node */ |
0aaa1a90 HZ |
87 | svr = (get_svr() >> SVR_VAR_PER_SHIFT) & 0xFFFFFE; |
88 | if (svr == SVR_LS2088A || svr == SVR_LS2084A || | |
e809e747 PJ |
89 | svr == SVR_LS2048A || svr == SVR_LS2044A || |
90 | svr == SVR_LS2081A || svr == SVR_LS2041A) | |
0aaa1a90 HZ |
91 | compat = "fsl,ls2088a-pcie"; |
92 | else | |
93 | compat = CONFIG_FSL_PCIE_COMPAT; | |
94 | if (compat) | |
95 | nodeoffset = fdt_node_offset_by_compat_reg(blob, | |
96 | compat, pcie->dbi_res.start); | |
97 | #endif | |
80afc63f ML |
98 | if (nodeoffset < 0) |
99 | return; | |
80afc63f ML |
100 | } |
101 | ||
102 | /* get phandle to MSI controller */ | |
103 | prop = (u32 *)fdt_getprop(blob, nodeoffset, "msi-parent", 0); | |
104 | if (prop == NULL) { | |
105 | debug("\n%s: ERROR: missing msi-parent: PCIe%d\n", | |
106 | __func__, pcie->idx); | |
107 | return; | |
108 | } | |
109 | phandle = fdt32_to_cpu(*prop); | |
110 | ||
111 | /* set one msi-map row */ | |
112 | fdt_appendprop_u32(blob, nodeoffset, "msi-map", devid); | |
113 | fdt_appendprop_u32(blob, nodeoffset, "msi-map", phandle); | |
114 | fdt_appendprop_u32(blob, nodeoffset, "msi-map", streamid); | |
115 | fdt_appendprop_u32(blob, nodeoffset, "msi-map", 1); | |
116 | } | |
117 | ||
78be6222 BB |
118 | /* |
119 | * An iommu-map is a property to be added to the pci controller | |
120 | * node. It is a table, where each entry consists of 4 fields | |
121 | * e.g.: | |
122 | * | |
123 | * iommu-map = <[devid] [phandle-to-iommu-ctrl] [stream-id] [count] | |
124 | * [devid] [phandle-to-iommu-ctrl] [stream-id] [count]>; | |
125 | */ | |
126 | static void fdt_pcie_set_iommu_map_entry(void *blob, struct ls_pcie *pcie, | |
127 | u32 devid, u32 streamid) | |
128 | { | |
129 | u32 *prop; | |
130 | u32 iommu_map[4]; | |
131 | int nodeoffset; | |
132 | int lenp; | |
133 | ||
134 | /* find pci controller node */ | |
135 | nodeoffset = fdt_node_offset_by_compat_reg(blob, "fsl,ls-pcie", | |
136 | pcie->dbi_res.start); | |
137 | if (nodeoffset < 0) { | |
138 | #ifdef CONFIG_FSL_PCIE_COMPAT /* Compatible with older version of dts node */ | |
139 | nodeoffset = fdt_node_offset_by_compat_reg(blob, | |
140 | CONFIG_FSL_PCIE_COMPAT, pcie->dbi_res.start); | |
141 | if (nodeoffset < 0) | |
142 | return; | |
143 | #else | |
144 | return; | |
145 | #endif | |
146 | } | |
147 | ||
148 | /* get phandle to iommu controller */ | |
149 | prop = fdt_getprop_w(blob, nodeoffset, "iommu-map", &lenp); | |
150 | if (prop == NULL) { | |
151 | debug("\n%s: ERROR: missing iommu-map: PCIe%d\n", | |
152 | __func__, pcie->idx); | |
153 | return; | |
154 | } | |
155 | ||
156 | /* set iommu-map row */ | |
157 | iommu_map[0] = cpu_to_fdt32(devid); | |
158 | iommu_map[1] = *++prop; | |
159 | iommu_map[2] = cpu_to_fdt32(streamid); | |
160 | iommu_map[3] = cpu_to_fdt32(1); | |
161 | ||
162 | if (devid == 0) { | |
163 | fdt_setprop_inplace(blob, nodeoffset, "iommu-map", | |
164 | iommu_map, 16); | |
165 | } else { | |
166 | fdt_appendprop(blob, nodeoffset, "iommu-map", iommu_map, 16); | |
167 | } | |
168 | } | |
169 | ||
80afc63f ML |
170 | static void fdt_fixup_pcie(void *blob) |
171 | { | |
172 | struct udevice *dev, *bus; | |
173 | struct ls_pcie *pcie; | |
174 | int streamid; | |
175 | int index; | |
176 | pci_dev_t bdf; | |
177 | ||
178 | /* Scan all known buses */ | |
179 | for (pci_find_first_device(&dev); | |
180 | dev; | |
181 | pci_find_next_device(&dev)) { | |
182 | for (bus = dev; device_is_on_pci_bus(bus);) | |
183 | bus = bus->parent; | |
184 | pcie = dev_get_priv(bus); | |
185 | ||
186 | streamid = ls_pcie_next_streamid(); | |
187 | if (streamid < 0) { | |
188 | debug("ERROR: no stream ids free\n"); | |
189 | continue; | |
190 | } | |
191 | ||
192 | index = ls_pcie_next_lut_index(pcie); | |
193 | if (index < 0) { | |
194 | debug("ERROR: no LUT indexes free\n"); | |
195 | continue; | |
196 | } | |
197 | ||
198 | /* the DT fixup must be relative to the hose first_busno */ | |
199 | bdf = dm_pci_get_bdf(dev) - PCI_BDF(bus->seq, 0, 0); | |
200 | /* map PCI b.d.f to streamID in LUT */ | |
201 | ls_pcie_lut_set_mapping(pcie, index, bdf >> 8, | |
202 | streamid); | |
203 | /* update msi-map in device tree */ | |
204 | fdt_pcie_set_msi_map_entry(blob, pcie, bdf >> 8, | |
205 | streamid); | |
78be6222 BB |
206 | /* update iommu-map in device tree */ |
207 | fdt_pcie_set_iommu_map_entry(blob, pcie, bdf >> 8, | |
208 | streamid); | |
80afc63f ML |
209 | } |
210 | } | |
211 | #endif | |
212 | ||
213 | static void ft_pcie_ls_setup(void *blob, struct ls_pcie *pcie) | |
214 | { | |
215 | int off; | |
0aaa1a90 HZ |
216 | uint svr; |
217 | char *compat = NULL; | |
80afc63f ML |
218 | |
219 | off = fdt_node_offset_by_compat_reg(blob, "fsl,ls-pcie", | |
220 | pcie->dbi_res.start); | |
221 | if (off < 0) { | |
19538f30 | 222 | #ifdef CONFIG_FSL_PCIE_COMPAT /* Compatible with older version of dts node */ |
0aaa1a90 HZ |
223 | svr = (get_svr() >> SVR_VAR_PER_SHIFT) & 0xFFFFFE; |
224 | if (svr == SVR_LS2088A || svr == SVR_LS2084A || | |
e809e747 PJ |
225 | svr == SVR_LS2048A || svr == SVR_LS2044A || |
226 | svr == SVR_LS2081A || svr == SVR_LS2041A) | |
0aaa1a90 HZ |
227 | compat = "fsl,ls2088a-pcie"; |
228 | else | |
229 | compat = CONFIG_FSL_PCIE_COMPAT; | |
230 | if (compat) | |
231 | off = fdt_node_offset_by_compat_reg(blob, | |
232 | compat, pcie->dbi_res.start); | |
233 | #endif | |
80afc63f ML |
234 | if (off < 0) |
235 | return; | |
80afc63f ML |
236 | } |
237 | ||
238 | if (pcie->enabled) | |
239 | fdt_set_node_status(blob, off, FDT_STATUS_OKAY, 0); | |
240 | else | |
241 | fdt_set_node_status(blob, off, FDT_STATUS_DISABLED, 0); | |
242 | } | |
243 | ||
244 | /* Fixup Kernel DT for PCIe */ | |
245 | void ft_pci_setup(void *blob, bd_t *bd) | |
246 | { | |
247 | struct ls_pcie *pcie; | |
248 | ||
249 | list_for_each_entry(pcie, &ls_pcie_list, list) | |
250 | ft_pcie_ls_setup(blob, pcie); | |
251 | ||
47d17362 | 252 | #if defined(CONFIG_FSL_LSCH3) || defined(CONFIG_FSL_LSCH2) |
80afc63f ML |
253 | fdt_fixup_pcie(blob); |
254 | #endif | |
255 | } | |
80afc63f | 256 | |
a7294aba HZ |
257 | #else /* !CONFIG_OF_BOARD_SETUP */ |
258 | void ft_pci_setup(void *blob, bd_t *bd) | |
259 | { | |
260 | } | |
261 | #endif |