1
2
3
4
5
6
7
8
9
10#include <common.h>
11#include <pci.h>
12#include <asm/arch/fsl_serdes.h>
13#include <asm/io.h>
14#include <errno.h>
15#ifdef CONFIG_OF_BOARD_SETUP
16#include <linux/libfdt.h>
17#include <fdt_support.h>
18#ifdef CONFIG_ARM
19#include <asm/arch/clock.h>
20#endif
21#include "pcie_layerscape_gen4.h"
22
23#if defined(CONFIG_FSL_LSCH3) || defined(CONFIG_FSL_LSCH2)
24
25
26
27static int ls_pcie_g4_next_lut_index(struct ls_pcie_g4 *pcie)
28{
29 if (pcie->next_lut_index < PCIE_LUT_ENTRY_COUNT)
30 return pcie->next_lut_index++;
31
32 return -ENOSPC;
33}
34
35
36static int ls_pcie_g4_next_streamid(struct ls_pcie_g4 *pcie)
37{
38 int stream_id = pcie->stream_id_cur;
39
40 if (stream_id > FSL_PEX_STREAM_ID_NUM)
41 return -EINVAL;
42
43 pcie->stream_id_cur++;
44
45 return stream_id | ((pcie->idx + 1) << 11);
46}
47
48
49
50
51static void ls_pcie_g4_lut_set_mapping(struct ls_pcie_g4 *pcie, int index,
52 u32 devid, u32 streamid)
53{
54
55 lut_writel(pcie, devid << 16, PCIE_LUT_UDR(index));
56 lut_writel(pcie, streamid | PCIE_LUT_ENABLE, PCIE_LUT_LDR(index));
57}
58
59
60
61
62
63
64
65
66
67static void fdt_pcie_set_msi_map_entry(void *blob, struct ls_pcie_g4 *pcie,
68 u32 devid, u32 streamid)
69{
70 u32 *prop;
71 u32 phandle;
72 int nodeoff;
73
74#ifdef CONFIG_FSL_PCIE_COMPAT
75 nodeoff = fdt_node_offset_by_compat_reg(blob, CONFIG_FSL_PCIE_COMPAT,
76 pcie->ccsr_res.start);
77#else
78#error "No CONFIG_FSL_PCIE_COMPAT defined"
79#endif
80 if (nodeoff < 0) {
81 debug("%s: ERROR: failed to find pcie compatiable\n", __func__);
82 return;
83 }
84
85
86 prop = (u32 *)fdt_getprop(blob, nodeoff, "msi-parent", 0);
87 if (!prop) {
88 debug("\n%s: ERROR: missing msi-parent: PCIe%d\n",
89 __func__, pcie->idx);
90 return;
91 }
92 phandle = fdt32_to_cpu(*prop);
93
94
95 fdt_appendprop_u32(blob, nodeoff, "msi-map", devid);
96 fdt_appendprop_u32(blob, nodeoff, "msi-map", phandle);
97 fdt_appendprop_u32(blob, nodeoff, "msi-map", streamid);
98 fdt_appendprop_u32(blob, nodeoff, "msi-map", 1);
99}
100
101
102
103
104
105
106
107
108
109static void fdt_pcie_set_iommu_map_entry(void *blob, struct ls_pcie_g4 *pcie,
110 u32 devid, u32 streamid)
111{
112 u32 *prop;
113 u32 iommu_map[4];
114 int nodeoff;
115 int lenp;
116
117#ifdef CONFIG_FSL_PCIE_COMPAT
118 nodeoff = fdt_node_offset_by_compat_reg(blob, CONFIG_FSL_PCIE_COMPAT,
119 pcie->ccsr_res.start);
120#else
121#error "No CONFIG_FSL_PCIE_COMPAT defined"
122#endif
123 if (nodeoff < 0) {
124 debug("%s: ERROR: failed to find pcie compatiable\n", __func__);
125 return;
126 }
127
128
129 prop = fdt_getprop_w(blob, nodeoff, "iommu-map", &lenp);
130 if (!prop) {
131 debug("\n%s: ERROR: missing iommu-map: PCIe%d\n",
132 __func__, pcie->idx);
133 return;
134 }
135
136
137 iommu_map[0] = cpu_to_fdt32(devid);
138 iommu_map[1] = *++prop;
139 iommu_map[2] = cpu_to_fdt32(streamid);
140 iommu_map[3] = cpu_to_fdt32(1);
141
142 if (devid == 0)
143 fdt_setprop_inplace(blob, nodeoff, "iommu-map", iommu_map, 16);
144 else
145 fdt_appendprop(blob, nodeoff, "iommu-map", iommu_map, 16);
146}
147
148static void fdt_fixup_pcie(void *blob)
149{
150 struct udevice *dev, *bus;
151 struct ls_pcie_g4 *pcie;
152 int streamid;
153 int index;
154 pci_dev_t bdf;
155
156
157 for (pci_find_first_device(&dev); dev; pci_find_next_device(&dev)) {
158 for (bus = dev; device_is_on_pci_bus(bus);)
159 bus = bus->parent;
160 pcie = dev_get_priv(bus);
161
162 streamid = ls_pcie_g4_next_streamid(pcie);
163 if (streamid < 0) {
164 debug("ERROR: no stream ids free\n");
165 continue;
166 }
167
168 index = ls_pcie_g4_next_lut_index(pcie);
169 if (index < 0) {
170 debug("ERROR: no LUT indexes free\n");
171 continue;
172 }
173
174
175 bdf = dm_pci_get_bdf(dev) - PCI_BDF(bus->seq, 0, 0);
176
177 ls_pcie_g4_lut_set_mapping(pcie, index, bdf >> 8, streamid);
178
179 fdt_pcie_set_msi_map_entry(blob, pcie, bdf >> 8, streamid);
180
181 fdt_pcie_set_iommu_map_entry(blob, pcie, bdf >> 8, streamid);
182 }
183}
184#endif
185
186static void ft_pcie_ep_layerscape_gen4_fix(void *blob, struct ls_pcie_g4 *pcie)
187{
188 int off;
189
190 off = fdt_node_offset_by_compat_reg(blob, "fsl,lx2160a-pcie-ep",
191 pcie->ccsr_res.start);
192
193 if (off < 0) {
194 debug("%s: ERROR: failed to find pcie compatiable\n",
195 __func__);
196 return;
197 }
198
199 if (pcie->enabled && pcie->mode == PCI_HEADER_TYPE_NORMAL)
200 fdt_set_node_status(blob, off, FDT_STATUS_OKAY, 0);
201 else
202 fdt_set_node_status(blob, off, FDT_STATUS_DISABLED, 0);
203}
204
205static void ft_pcie_rc_layerscape_gen4_fix(void *blob, struct ls_pcie_g4 *pcie)
206{
207 int off;
208
209#ifdef CONFIG_FSL_PCIE_COMPAT
210 off = fdt_node_offset_by_compat_reg(blob, CONFIG_FSL_PCIE_COMPAT,
211 pcie->ccsr_res.start);
212#else
213#error "No CONFIG_FSL_PCIE_COMPAT defined"
214#endif
215 if (off < 0) {
216 debug("%s: ERROR: failed to find pcie compatiable\n", __func__);
217 return;
218 }
219
220 if (pcie->enabled && pcie->mode == PCI_HEADER_TYPE_BRIDGE)
221 fdt_set_node_status(blob, off, FDT_STATUS_OKAY, 0);
222 else
223 fdt_set_node_status(blob, off, FDT_STATUS_DISABLED, 0);
224}
225
226static void ft_pcie_layerscape_gen4_setup(void *blob, struct ls_pcie_g4 *pcie)
227{
228 ft_pcie_rc_layerscape_gen4_fix(blob, pcie);
229 ft_pcie_ep_layerscape_gen4_fix(blob, pcie);
230}
231
232
233void ft_pci_setup(void *blob, bd_t *bd)
234{
235 struct ls_pcie_g4 *pcie;
236
237 list_for_each_entry(pcie, &ls_pcie_g4_list, list)
238 ft_pcie_layerscape_gen4_setup(blob, pcie);
239
240#if defined(CONFIG_FSL_LSCH3) || defined(CONFIG_FSL_LSCH2)
241 fdt_fixup_pcie(blob);
242#endif
243}
244
245#else
246void ft_pci_setup(void *blob, bd_t *bd)
247{
248}
249#endif
250
