• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Synopsys DesignWare PCIe host controller driver
4  *
5  * Copyright (C) 2013 Samsung Electronics Co., Ltd.
6  *		https://www.samsung.com
7  *
8  * Author: Jingoo Han <jg1.han@samsung.com>
9  */
10 
11 #include <linux/delay.h>
12 #include <linux/of.h>
13 #include <linux/of_platform.h>
14 #include <linux/types.h>
15 
16 #include "../../pci.h"
17 #include "pcie-designware.h"
18 
19 /*
20  * These interfaces resemble the pci_find_*capability() interfaces, but these
21  * are for configuring host controllers, which are bridges *to* PCI devices but
22  * are not PCI devices themselves.
23  */
__dw_pcie_find_next_cap(struct dw_pcie * pci,u8 cap_ptr,u8 cap)24 static u8 __dw_pcie_find_next_cap(struct dw_pcie *pci, u8 cap_ptr,
25 				  u8 cap)
26 {
27 	u8 cap_id, next_cap_ptr;
28 	u16 reg;
29 
30 	if (!cap_ptr)
31 		return 0;
32 
33 	reg = dw_pcie_readw_dbi(pci, cap_ptr);
34 	cap_id = (reg & 0x00ff);
35 
36 	if (cap_id > PCI_CAP_ID_MAX)
37 		return 0;
38 
39 	if (cap_id == cap)
40 		return cap_ptr;
41 
42 	next_cap_ptr = (reg & 0xff00) >> 8;
43 	return __dw_pcie_find_next_cap(pci, next_cap_ptr, cap);
44 }
45 
dw_pcie_find_capability(struct dw_pcie * pci,u8 cap)46 u8 dw_pcie_find_capability(struct dw_pcie *pci, u8 cap)
47 {
48 	u8 next_cap_ptr;
49 	u16 reg;
50 
51 	reg = dw_pcie_readw_dbi(pci, PCI_CAPABILITY_LIST);
52 	next_cap_ptr = (reg & 0x00ff);
53 
54 	return __dw_pcie_find_next_cap(pci, next_cap_ptr, cap);
55 }
56 EXPORT_SYMBOL_GPL(dw_pcie_find_capability);
57 
dw_pcie_find_next_ext_capability(struct dw_pcie * pci,u16 start,u8 cap)58 static u16 dw_pcie_find_next_ext_capability(struct dw_pcie *pci, u16 start,
59 					    u8 cap)
60 {
61 	u32 header;
62 	int ttl;
63 	int pos = PCI_CFG_SPACE_SIZE;
64 
65 	/* minimum 8 bytes per capability */
66 	ttl = (PCI_CFG_SPACE_EXP_SIZE - PCI_CFG_SPACE_SIZE) / 8;
67 
68 	if (start)
69 		pos = start;
70 
71 	header = dw_pcie_readl_dbi(pci, pos);
72 	/*
73 	 * If we have no capabilities, this is indicated by cap ID,
74 	 * cap version and next pointer all being 0.
75 	 */
76 	if (header == 0)
77 		return 0;
78 
79 	while (ttl-- > 0) {
80 		if (PCI_EXT_CAP_ID(header) == cap && pos != start)
81 			return pos;
82 
83 		pos = PCI_EXT_CAP_NEXT(header);
84 		if (pos < PCI_CFG_SPACE_SIZE)
85 			break;
86 
87 		header = dw_pcie_readl_dbi(pci, pos);
88 	}
89 
90 	return 0;
91 }
92 
dw_pcie_find_ext_capability(struct dw_pcie * pci,u8 cap)93 u16 dw_pcie_find_ext_capability(struct dw_pcie *pci, u8 cap)
94 {
95 	return dw_pcie_find_next_ext_capability(pci, 0, cap);
96 }
97 EXPORT_SYMBOL_GPL(dw_pcie_find_ext_capability);
98 
dw_pcie_read(void __iomem * addr,int size,u32 * val)99 int dw_pcie_read(void __iomem *addr, int size, u32 *val)
100 {
101 	if (!IS_ALIGNED((uintptr_t)addr, size)) {
102 		*val = 0;
103 		return PCIBIOS_BAD_REGISTER_NUMBER;
104 	}
105 
106 	if (size == 4) {
107 		*val = readl(addr);
108 	} else if (size == 2) {
109 		*val = readw(addr);
110 	} else if (size == 1) {
111 		*val = readb(addr);
112 	} else {
113 		*val = 0;
114 		return PCIBIOS_BAD_REGISTER_NUMBER;
115 	}
116 
117 	return PCIBIOS_SUCCESSFUL;
118 }
119 EXPORT_SYMBOL_GPL(dw_pcie_read);
120 
dw_pcie_write(void __iomem * addr,int size,u32 val)121 int dw_pcie_write(void __iomem *addr, int size, u32 val)
122 {
123 	if (!IS_ALIGNED((uintptr_t)addr, size))
124 		return PCIBIOS_BAD_REGISTER_NUMBER;
125 
126 	if (size == 4)
127 		writel(val, addr);
128 	else if (size == 2)
129 		writew(val, addr);
130 	else if (size == 1)
131 		writeb(val, addr);
132 	else
133 		return PCIBIOS_BAD_REGISTER_NUMBER;
134 
135 	return PCIBIOS_SUCCESSFUL;
136 }
137 EXPORT_SYMBOL_GPL(dw_pcie_write);
138 
dw_pcie_read_dbi(struct dw_pcie * pci,u32 reg,size_t size)139 u32 dw_pcie_read_dbi(struct dw_pcie *pci, u32 reg, size_t size)
140 {
141 	int ret;
142 	u32 val;
143 
144 	if (pci->ops->read_dbi)
145 		return pci->ops->read_dbi(pci, pci->dbi_base, reg, size);
146 
147 	ret = dw_pcie_read(pci->dbi_base + reg, size, &val);
148 	if (ret)
149 		dev_err(pci->dev, "Read DBI address failed\n");
150 
151 	return val;
152 }
153 EXPORT_SYMBOL_GPL(dw_pcie_read_dbi);
154 
dw_pcie_write_dbi(struct dw_pcie * pci,u32 reg,size_t size,u32 val)155 void dw_pcie_write_dbi(struct dw_pcie *pci, u32 reg, size_t size, u32 val)
156 {
157 	int ret;
158 
159 	if (pci->ops->write_dbi) {
160 		pci->ops->write_dbi(pci, pci->dbi_base, reg, size, val);
161 		return;
162 	}
163 
164 	ret = dw_pcie_write(pci->dbi_base + reg, size, val);
165 	if (ret)
166 		dev_err(pci->dev, "Write DBI address failed\n");
167 }
168 EXPORT_SYMBOL_GPL(dw_pcie_write_dbi);
169 
dw_pcie_write_dbi2(struct dw_pcie * pci,u32 reg,size_t size,u32 val)170 void dw_pcie_write_dbi2(struct dw_pcie *pci, u32 reg, size_t size, u32 val)
171 {
172 	int ret;
173 
174 	if (pci->ops->write_dbi2) {
175 		pci->ops->write_dbi2(pci, pci->dbi_base2, reg, size, val);
176 		return;
177 	}
178 
179 	ret = dw_pcie_write(pci->dbi_base2 + reg, size, val);
180 	if (ret)
181 		dev_err(pci->dev, "write DBI address failed\n");
182 }
183 
dw_pcie_readl_atu(struct dw_pcie * pci,u32 reg)184 static u32 dw_pcie_readl_atu(struct dw_pcie *pci, u32 reg)
185 {
186 	int ret;
187 	u32 val;
188 
189 	if (pci->ops->read_dbi)
190 		return pci->ops->read_dbi(pci, pci->atu_base, reg, 4);
191 
192 	ret = dw_pcie_read(pci->atu_base + reg, 4, &val);
193 	if (ret)
194 		dev_err(pci->dev, "Read ATU address failed\n");
195 
196 	return val;
197 }
198 
dw_pcie_writel_atu(struct dw_pcie * pci,u32 reg,u32 val)199 static void dw_pcie_writel_atu(struct dw_pcie *pci, u32 reg, u32 val)
200 {
201 	int ret;
202 
203 	if (pci->ops->write_dbi) {
204 		pci->ops->write_dbi(pci, pci->atu_base, reg, 4, val);
205 		return;
206 	}
207 
208 	ret = dw_pcie_write(pci->atu_base + reg, 4, val);
209 	if (ret)
210 		dev_err(pci->dev, "Write ATU address failed\n");
211 }
212 
dw_pcie_readl_ob_unroll(struct dw_pcie * pci,u32 index,u32 reg)213 static u32 dw_pcie_readl_ob_unroll(struct dw_pcie *pci, u32 index, u32 reg)
214 {
215 	u32 offset = PCIE_GET_ATU_OUTB_UNR_REG_OFFSET(index);
216 
217 	return dw_pcie_readl_atu(pci, offset + reg);
218 }
219 
dw_pcie_writel_ob_unroll(struct dw_pcie * pci,u32 index,u32 reg,u32 val)220 static void dw_pcie_writel_ob_unroll(struct dw_pcie *pci, u32 index, u32 reg,
221 				     u32 val)
222 {
223 	u32 offset = PCIE_GET_ATU_OUTB_UNR_REG_OFFSET(index);
224 
225 	dw_pcie_writel_atu(pci, offset + reg, val);
226 }
227 
dw_pcie_prog_outbound_atu_unroll(struct dw_pcie * pci,u8 func_no,int index,int type,u64 cpu_addr,u64 pci_addr,u32 size)228 static void dw_pcie_prog_outbound_atu_unroll(struct dw_pcie *pci, u8 func_no,
229 					     int index, int type,
230 					     u64 cpu_addr, u64 pci_addr,
231 					     u32 size)
232 {
233 	u32 retries, val;
234 	u64 limit_addr = cpu_addr + size - 1;
235 
236 	dw_pcie_writel_ob_unroll(pci, index, PCIE_ATU_UNR_LOWER_BASE,
237 				 lower_32_bits(cpu_addr));
238 	dw_pcie_writel_ob_unroll(pci, index, PCIE_ATU_UNR_UPPER_BASE,
239 				 upper_32_bits(cpu_addr));
240 	dw_pcie_writel_ob_unroll(pci, index, PCIE_ATU_UNR_LOWER_LIMIT,
241 				 lower_32_bits(limit_addr));
242 	dw_pcie_writel_ob_unroll(pci, index, PCIE_ATU_UNR_UPPER_LIMIT,
243 				 upper_32_bits(limit_addr));
244 	dw_pcie_writel_ob_unroll(pci, index, PCIE_ATU_UNR_LOWER_TARGET,
245 				 lower_32_bits(pci_addr));
246 	dw_pcie_writel_ob_unroll(pci, index, PCIE_ATU_UNR_UPPER_TARGET,
247 				 upper_32_bits(pci_addr));
248 	dw_pcie_writel_ob_unroll(pci, index, PCIE_ATU_UNR_REGION_CTRL1,
249 				 type | PCIE_ATU_FUNC_NUM(func_no));
250 	dw_pcie_writel_ob_unroll(pci, index, PCIE_ATU_UNR_REGION_CTRL2,
251 				 PCIE_ATU_ENABLE);
252 
253 	/*
254 	 * Make sure ATU enable takes effect before any subsequent config
255 	 * and I/O accesses.
256 	 */
257 	for (retries = 0; retries < LINK_WAIT_MAX_IATU_RETRIES; retries++) {
258 		val = dw_pcie_readl_ob_unroll(pci, index,
259 					      PCIE_ATU_UNR_REGION_CTRL2);
260 		if (val & PCIE_ATU_ENABLE)
261 			return;
262 
263 		mdelay(LINK_WAIT_IATU);
264 	}
265 	dev_err(pci->dev, "Outbound iATU is not being enabled\n");
266 }
267 
__dw_pcie_prog_outbound_atu(struct dw_pcie * pci,u8 func_no,int index,int type,u64 cpu_addr,u64 pci_addr,u32 size)268 static void __dw_pcie_prog_outbound_atu(struct dw_pcie *pci, u8 func_no,
269 					int index, int type, u64 cpu_addr,
270 					u64 pci_addr, u32 size)
271 {
272 	u32 retries, val;
273 
274 	if (pci->ops->cpu_addr_fixup)
275 		cpu_addr = pci->ops->cpu_addr_fixup(pci, cpu_addr);
276 
277 	if (pci->iatu_unroll_enabled) {
278 		dw_pcie_prog_outbound_atu_unroll(pci, func_no, index, type,
279 						 cpu_addr, pci_addr, size);
280 		return;
281 	}
282 
283 	dw_pcie_writel_dbi(pci, PCIE_ATU_VIEWPORT,
284 			   PCIE_ATU_REGION_OUTBOUND | index);
285 	dw_pcie_writel_dbi(pci, PCIE_ATU_LOWER_BASE,
286 			   lower_32_bits(cpu_addr));
287 	dw_pcie_writel_dbi(pci, PCIE_ATU_UPPER_BASE,
288 			   upper_32_bits(cpu_addr));
289 	dw_pcie_writel_dbi(pci, PCIE_ATU_LIMIT,
290 			   lower_32_bits(cpu_addr + size - 1));
291 	dw_pcie_writel_dbi(pci, PCIE_ATU_LOWER_TARGET,
292 			   lower_32_bits(pci_addr));
293 	dw_pcie_writel_dbi(pci, PCIE_ATU_UPPER_TARGET,
294 			   upper_32_bits(pci_addr));
295 	dw_pcie_writel_dbi(pci, PCIE_ATU_CR1, type |
296 			   PCIE_ATU_FUNC_NUM(func_no));
297 	dw_pcie_writel_dbi(pci, PCIE_ATU_CR2, PCIE_ATU_ENABLE);
298 
299 	/*
300 	 * Make sure ATU enable takes effect before any subsequent config
301 	 * and I/O accesses.
302 	 */
303 	for (retries = 0; retries < LINK_WAIT_MAX_IATU_RETRIES; retries++) {
304 		val = dw_pcie_readl_dbi(pci, PCIE_ATU_CR2);
305 		if (val & PCIE_ATU_ENABLE)
306 			return;
307 
308 		mdelay(LINK_WAIT_IATU);
309 	}
310 	dev_err(pci->dev, "Outbound iATU is not being enabled\n");
311 }
312 
dw_pcie_prog_outbound_atu(struct dw_pcie * pci,int index,int type,u64 cpu_addr,u64 pci_addr,u32 size)313 void dw_pcie_prog_outbound_atu(struct dw_pcie *pci, int index, int type,
314 			       u64 cpu_addr, u64 pci_addr, u32 size)
315 {
316 	__dw_pcie_prog_outbound_atu(pci, 0, index, type,
317 				    cpu_addr, pci_addr, size);
318 }
319 
dw_pcie_prog_ep_outbound_atu(struct dw_pcie * pci,u8 func_no,int index,int type,u64 cpu_addr,u64 pci_addr,u32 size)320 void dw_pcie_prog_ep_outbound_atu(struct dw_pcie *pci, u8 func_no, int index,
321 				  int type, u64 cpu_addr, u64 pci_addr,
322 				  u32 size)
323 {
324 	__dw_pcie_prog_outbound_atu(pci, func_no, index, type,
325 				    cpu_addr, pci_addr, size);
326 }
327 
dw_pcie_readl_ib_unroll(struct dw_pcie * pci,u32 index,u32 reg)328 static u32 dw_pcie_readl_ib_unroll(struct dw_pcie *pci, u32 index, u32 reg)
329 {
330 	u32 offset = PCIE_GET_ATU_INB_UNR_REG_OFFSET(index);
331 
332 	return dw_pcie_readl_atu(pci, offset + reg);
333 }
334 
dw_pcie_writel_ib_unroll(struct dw_pcie * pci,u32 index,u32 reg,u32 val)335 static void dw_pcie_writel_ib_unroll(struct dw_pcie *pci, u32 index, u32 reg,
336 				     u32 val)
337 {
338 	u32 offset = PCIE_GET_ATU_INB_UNR_REG_OFFSET(index);
339 
340 	dw_pcie_writel_atu(pci, offset + reg, val);
341 }
342 
dw_pcie_prog_inbound_atu_unroll(struct dw_pcie * pci,u8 func_no,int index,int bar,u64 cpu_addr,enum dw_pcie_as_type as_type)343 static int dw_pcie_prog_inbound_atu_unroll(struct dw_pcie *pci, u8 func_no,
344 					   int index, int bar, u64 cpu_addr,
345 					   enum dw_pcie_as_type as_type)
346 {
347 	int type;
348 	u32 retries, val;
349 
350 	dw_pcie_writel_ib_unroll(pci, index, PCIE_ATU_UNR_LOWER_TARGET,
351 				 lower_32_bits(cpu_addr));
352 	dw_pcie_writel_ib_unroll(pci, index, PCIE_ATU_UNR_UPPER_TARGET,
353 				 upper_32_bits(cpu_addr));
354 
355 	switch (as_type) {
356 	case DW_PCIE_AS_MEM:
357 		type = PCIE_ATU_TYPE_MEM;
358 		break;
359 	case DW_PCIE_AS_IO:
360 		type = PCIE_ATU_TYPE_IO;
361 		break;
362 	default:
363 		return -EINVAL;
364 	}
365 
366 	dw_pcie_writel_ib_unroll(pci, index, PCIE_ATU_UNR_REGION_CTRL1, type |
367 				 PCIE_ATU_FUNC_NUM(func_no));
368 	dw_pcie_writel_ib_unroll(pci, index, PCIE_ATU_UNR_REGION_CTRL2,
369 				 PCIE_ATU_FUNC_NUM_MATCH_EN |
370 				 PCIE_ATU_ENABLE |
371 				 PCIE_ATU_BAR_MODE_ENABLE | (bar << 8));
372 
373 	/*
374 	 * Make sure ATU enable takes effect before any subsequent config
375 	 * and I/O accesses.
376 	 */
377 	for (retries = 0; retries < LINK_WAIT_MAX_IATU_RETRIES; retries++) {
378 		val = dw_pcie_readl_ib_unroll(pci, index,
379 					      PCIE_ATU_UNR_REGION_CTRL2);
380 		if (val & PCIE_ATU_ENABLE)
381 			return 0;
382 
383 		mdelay(LINK_WAIT_IATU);
384 	}
385 	dev_err(pci->dev, "Inbound iATU is not being enabled\n");
386 
387 	return -EBUSY;
388 }
389 
dw_pcie_prog_inbound_atu(struct dw_pcie * pci,u8 func_no,int index,int bar,u64 cpu_addr,enum dw_pcie_as_type as_type)390 int dw_pcie_prog_inbound_atu(struct dw_pcie *pci, u8 func_no, int index,
391 			     int bar, u64 cpu_addr,
392 			     enum dw_pcie_as_type as_type)
393 {
394 	int type;
395 	u32 retries, val;
396 
397 	if (pci->iatu_unroll_enabled)
398 		return dw_pcie_prog_inbound_atu_unroll(pci, func_no, index, bar,
399 						       cpu_addr, as_type);
400 
401 	dw_pcie_writel_dbi(pci, PCIE_ATU_VIEWPORT, PCIE_ATU_REGION_INBOUND |
402 			   index);
403 	dw_pcie_writel_dbi(pci, PCIE_ATU_LOWER_TARGET, lower_32_bits(cpu_addr));
404 	dw_pcie_writel_dbi(pci, PCIE_ATU_UPPER_TARGET, upper_32_bits(cpu_addr));
405 
406 	switch (as_type) {
407 	case DW_PCIE_AS_MEM:
408 		type = PCIE_ATU_TYPE_MEM;
409 		break;
410 	case DW_PCIE_AS_IO:
411 		type = PCIE_ATU_TYPE_IO;
412 		break;
413 	default:
414 		return -EINVAL;
415 	}
416 
417 	dw_pcie_writel_dbi(pci, PCIE_ATU_CR1, type |
418 			   PCIE_ATU_FUNC_NUM(func_no));
419 	dw_pcie_writel_dbi(pci, PCIE_ATU_CR2, PCIE_ATU_ENABLE |
420 			   PCIE_ATU_FUNC_NUM_MATCH_EN |
421 			   PCIE_ATU_BAR_MODE_ENABLE | (bar << 8));
422 
423 	/*
424 	 * Make sure ATU enable takes effect before any subsequent config
425 	 * and I/O accesses.
426 	 */
427 	for (retries = 0; retries < LINK_WAIT_MAX_IATU_RETRIES; retries++) {
428 		val = dw_pcie_readl_dbi(pci, PCIE_ATU_CR2);
429 		if (val & PCIE_ATU_ENABLE)
430 			return 0;
431 
432 		mdelay(LINK_WAIT_IATU);
433 	}
434 	dev_err(pci->dev, "Inbound iATU is not being enabled\n");
435 
436 	return -EBUSY;
437 }
438 
dw_pcie_disable_atu(struct dw_pcie * pci,int index,enum dw_pcie_region_type type)439 void dw_pcie_disable_atu(struct dw_pcie *pci, int index,
440 			 enum dw_pcie_region_type type)
441 {
442 	u32 region;
443 
444 	switch (type) {
445 	case DW_PCIE_REGION_INBOUND:
446 		region = PCIE_ATU_REGION_INBOUND;
447 		break;
448 	case DW_PCIE_REGION_OUTBOUND:
449 		region = PCIE_ATU_REGION_OUTBOUND;
450 		break;
451 	default:
452 		return;
453 	}
454 
455 	if (pci->iatu_unroll_enabled) {
456 		if (region == PCIE_ATU_REGION_INBOUND) {
457 			dw_pcie_writel_ib_unroll(pci, index, PCIE_ATU_UNR_REGION_CTRL2,
458 						 ~(u32)PCIE_ATU_ENABLE);
459 		} else {
460 			dw_pcie_writel_ob_unroll(pci, index, PCIE_ATU_UNR_REGION_CTRL2,
461 						 ~(u32)PCIE_ATU_ENABLE);
462 		}
463 	} else {
464 		dw_pcie_writel_dbi(pci, PCIE_ATU_VIEWPORT, region | index);
465 		dw_pcie_writel_dbi(pci, PCIE_ATU_CR2, ~(u32)PCIE_ATU_ENABLE);
466 	}
467 }
468 
dw_pcie_wait_for_link(struct dw_pcie * pci)469 int dw_pcie_wait_for_link(struct dw_pcie *pci)
470 {
471 	int retries;
472 
473 	/* Check if the link is up or not */
474 	for (retries = 0; retries < LINK_WAIT_MAX_RETRIES; retries++) {
475 		if (dw_pcie_link_up(pci)) {
476 			dev_info(pci->dev, "Link up\n");
477 			return 0;
478 		}
479 		usleep_range(LINK_WAIT_USLEEP_MIN, LINK_WAIT_USLEEP_MAX);
480 	}
481 
482 	dev_info(pci->dev, "Phy link never came up\n");
483 
484 	return -ETIMEDOUT;
485 }
486 EXPORT_SYMBOL_GPL(dw_pcie_wait_for_link);
487 
dw_pcie_link_up(struct dw_pcie * pci)488 int dw_pcie_link_up(struct dw_pcie *pci)
489 {
490 	u32 val;
491 
492 	if (pci->ops->link_up)
493 		return pci->ops->link_up(pci);
494 
495 	val = readl(pci->dbi_base + PCIE_PORT_DEBUG1);
496 	return ((val & PCIE_PORT_DEBUG1_LINK_UP) &&
497 		(!(val & PCIE_PORT_DEBUG1_LINK_IN_TRAINING)));
498 }
499 
dw_pcie_upconfig_setup(struct dw_pcie * pci)500 void dw_pcie_upconfig_setup(struct dw_pcie *pci)
501 {
502 	u32 val;
503 
504 	val = dw_pcie_readl_dbi(pci, PCIE_PORT_MULTI_LANE_CTRL);
505 	val |= PORT_MLTI_UPCFG_SUPPORT;
506 	dw_pcie_writel_dbi(pci, PCIE_PORT_MULTI_LANE_CTRL, val);
507 }
508 EXPORT_SYMBOL_GPL(dw_pcie_upconfig_setup);
509 
dw_pcie_link_set_max_speed(struct dw_pcie * pci,u32 link_gen)510 static void dw_pcie_link_set_max_speed(struct dw_pcie *pci, u32 link_gen)
511 {
512 	u32 cap, ctrl2, link_speed;
513 	u8 offset = dw_pcie_find_capability(pci, PCI_CAP_ID_EXP);
514 
515 	cap = dw_pcie_readl_dbi(pci, offset + PCI_EXP_LNKCAP);
516 	ctrl2 = dw_pcie_readl_dbi(pci, offset + PCI_EXP_LNKCTL2);
517 	ctrl2 &= ~PCI_EXP_LNKCTL2_TLS;
518 
519 	switch (pcie_link_speed[link_gen]) {
520 	case PCIE_SPEED_2_5GT:
521 		link_speed = PCI_EXP_LNKCTL2_TLS_2_5GT;
522 		break;
523 	case PCIE_SPEED_5_0GT:
524 		link_speed = PCI_EXP_LNKCTL2_TLS_5_0GT;
525 		break;
526 	case PCIE_SPEED_8_0GT:
527 		link_speed = PCI_EXP_LNKCTL2_TLS_8_0GT;
528 		break;
529 	case PCIE_SPEED_16_0GT:
530 		link_speed = PCI_EXP_LNKCTL2_TLS_16_0GT;
531 		break;
532 	default:
533 		/* Use hardware capability */
534 		link_speed = FIELD_GET(PCI_EXP_LNKCAP_SLS, cap);
535 		ctrl2 &= ~PCI_EXP_LNKCTL2_HASD;
536 		break;
537 	}
538 
539 	dw_pcie_writel_dbi(pci, offset + PCI_EXP_LNKCTL2, ctrl2 | link_speed);
540 
541 	cap &= ~((u32)PCI_EXP_LNKCAP_SLS);
542 	dw_pcie_writel_dbi(pci, offset + PCI_EXP_LNKCAP, cap | link_speed);
543 
544 }
545 
dw_pcie_iatu_unroll_enabled(struct dw_pcie * pci)546 static u8 dw_pcie_iatu_unroll_enabled(struct dw_pcie *pci)
547 {
548 	u32 val;
549 
550 	val = dw_pcie_readl_dbi(pci, PCIE_ATU_VIEWPORT);
551 	if (val == 0xffffffff)
552 		return 1;
553 
554 	return 0;
555 }
556 
dw_pcie_setup(struct dw_pcie * pci)557 void dw_pcie_setup(struct dw_pcie *pci)
558 {
559 	u32 val;
560 	struct device *dev = pci->dev;
561 	struct device_node *np = dev->of_node;
562 	struct platform_device *pdev = to_platform_device(dev);
563 
564 	if (pci->version >= 0x480A || (!pci->version &&
565 				       dw_pcie_iatu_unroll_enabled(pci))) {
566 		pci->iatu_unroll_enabled = true;
567 		if (!pci->atu_base)
568 			pci->atu_base =
569 			    devm_platform_ioremap_resource_byname(pdev, "atu");
570 		if (IS_ERR(pci->atu_base))
571 			pci->atu_base = pci->dbi_base + DEFAULT_DBI_ATU_OFFSET;
572 	}
573 	dev_dbg(pci->dev, "iATU unroll: %s\n", pci->iatu_unroll_enabled ?
574 		"enabled" : "disabled");
575 
576 	if (pci->link_gen > 0)
577 		dw_pcie_link_set_max_speed(pci, pci->link_gen);
578 
579 	/* Configure Gen1 N_FTS */
580 	if (pci->n_fts[0]) {
581 		val = dw_pcie_readl_dbi(pci, PCIE_PORT_AFR);
582 		val &= ~(PORT_AFR_N_FTS_MASK | PORT_AFR_CC_N_FTS_MASK);
583 		val |= PORT_AFR_N_FTS(pci->n_fts[0]);
584 		val |= PORT_AFR_CC_N_FTS(pci->n_fts[0]);
585 		dw_pcie_writel_dbi(pci, PCIE_PORT_AFR, val);
586 	}
587 
588 	/* Configure Gen2+ N_FTS */
589 	if (pci->n_fts[1]) {
590 		val = dw_pcie_readl_dbi(pci, PCIE_LINK_WIDTH_SPEED_CONTROL);
591 		val &= ~PORT_LOGIC_N_FTS_MASK;
592 		val |= pci->n_fts[1];
593 		dw_pcie_writel_dbi(pci, PCIE_LINK_WIDTH_SPEED_CONTROL, val);
594 	}
595 
596 	val = dw_pcie_readl_dbi(pci, PCIE_PORT_LINK_CONTROL);
597 	val &= ~PORT_LINK_FAST_LINK_MODE;
598 	val |= PORT_LINK_DLL_LINK_EN;
599 	dw_pcie_writel_dbi(pci, PCIE_PORT_LINK_CONTROL, val);
600 
601 	if (of_property_read_bool(np, "snps,enable-cdm-check")) {
602 		val = dw_pcie_readl_dbi(pci, PCIE_PL_CHK_REG_CONTROL_STATUS);
603 		val |= PCIE_PL_CHK_REG_CHK_REG_CONTINUOUS |
604 		       PCIE_PL_CHK_REG_CHK_REG_START;
605 		dw_pcie_writel_dbi(pci, PCIE_PL_CHK_REG_CONTROL_STATUS, val);
606 	}
607 
608 	of_property_read_u32(np, "num-lanes", &pci->num_lanes);
609 	if (!pci->num_lanes) {
610 		dev_dbg(pci->dev, "Using h/w default number of lanes\n");
611 		return;
612 	}
613 
614 	/* Set the number of lanes */
615 	val &= ~PORT_LINK_FAST_LINK_MODE;
616 	val &= ~PORT_LINK_MODE_MASK;
617 	switch (pci->num_lanes) {
618 	case 1:
619 		val |= PORT_LINK_MODE_1_LANES;
620 		break;
621 	case 2:
622 		val |= PORT_LINK_MODE_2_LANES;
623 		break;
624 	case 4:
625 		val |= PORT_LINK_MODE_4_LANES;
626 		break;
627 	case 8:
628 		val |= PORT_LINK_MODE_8_LANES;
629 		break;
630 	default:
631 		dev_err(pci->dev, "num-lanes %u: invalid value\n", pci->num_lanes);
632 		return;
633 	}
634 	dw_pcie_writel_dbi(pci, PCIE_PORT_LINK_CONTROL, val);
635 
636 	/* Set link width speed control register */
637 	val = dw_pcie_readl_dbi(pci, PCIE_LINK_WIDTH_SPEED_CONTROL);
638 	val &= ~PORT_LOGIC_LINK_WIDTH_MASK;
639 	switch (pci->num_lanes) {
640 	case 1:
641 		val |= PORT_LOGIC_LINK_WIDTH_1_LANES;
642 		break;
643 	case 2:
644 		val |= PORT_LOGIC_LINK_WIDTH_2_LANES;
645 		break;
646 	case 4:
647 		val |= PORT_LOGIC_LINK_WIDTH_4_LANES;
648 		break;
649 	case 8:
650 		val |= PORT_LOGIC_LINK_WIDTH_8_LANES;
651 		break;
652 	}
653 	dw_pcie_writel_dbi(pci, PCIE_LINK_WIDTH_SPEED_CONTROL, val);
654 }
655