• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * Synopsys Designware PCIe host controller driver
3  *
4  * Copyright (C) 2013 Samsung Electronics Co., Ltd.
5  *		http://www.samsung.com
6  *
7  * Author: Jingoo Han <jg1.han@samsung.com>
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License version 2 as
11  * published by the Free Software Foundation.
12  */
13 
14 #include <linux/irq.h>
15 #include <linux/irqdomain.h>
16 #include <linux/kernel.h>
17 #include <linux/module.h>
18 #include <linux/msi.h>
19 #include <linux/of_address.h>
20 #include <linux/of_pci.h>
21 #include <linux/pci.h>
22 #include <linux/pci_regs.h>
23 #include <linux/platform_device.h>
24 #include <linux/types.h>
25 
26 #include "pcie-designware.h"
27 
28 /* Synopsis specific PCIE configuration registers */
29 #define PCIE_PORT_LINK_CONTROL		0x710
30 #define PORT_LINK_MODE_MASK		(0x3f << 16)
31 #define PORT_LINK_MODE_1_LANES		(0x1 << 16)
32 #define PORT_LINK_MODE_2_LANES		(0x3 << 16)
33 #define PORT_LINK_MODE_4_LANES		(0x7 << 16)
34 
35 #define PCIE_LINK_WIDTH_SPEED_CONTROL	0x80C
36 #define PORT_LOGIC_SPEED_CHANGE		(0x1 << 17)
37 #define PORT_LOGIC_LINK_WIDTH_MASK	(0x1ff << 8)
38 #define PORT_LOGIC_LINK_WIDTH_1_LANES	(0x1 << 8)
39 #define PORT_LOGIC_LINK_WIDTH_2_LANES	(0x2 << 8)
40 #define PORT_LOGIC_LINK_WIDTH_4_LANES	(0x4 << 8)
41 
42 #define PCIE_MSI_ADDR_LO		0x820
43 #define PCIE_MSI_ADDR_HI		0x824
44 #define PCIE_MSI_INTR0_ENABLE		0x828
45 #define PCIE_MSI_INTR0_MASK		0x82C
46 #define PCIE_MSI_INTR0_STATUS		0x830
47 
48 #define PCIE_ATU_VIEWPORT		0x900
49 #define PCIE_ATU_REGION_INBOUND		(0x1 << 31)
50 #define PCIE_ATU_REGION_OUTBOUND	(0x0 << 31)
51 #define PCIE_ATU_REGION_INDEX1		(0x1 << 0)
52 #define PCIE_ATU_REGION_INDEX0		(0x0 << 0)
53 #define PCIE_ATU_CR1			0x904
54 #define PCIE_ATU_TYPE_MEM		(0x0 << 0)
55 #define PCIE_ATU_TYPE_IO		(0x2 << 0)
56 #define PCIE_ATU_TYPE_CFG0		(0x4 << 0)
57 #define PCIE_ATU_TYPE_CFG1		(0x5 << 0)
58 #define PCIE_ATU_CR2			0x908
59 #define PCIE_ATU_ENABLE			(0x1 << 31)
60 #define PCIE_ATU_BAR_MODE_ENABLE	(0x1 << 30)
61 #define PCIE_ATU_LOWER_BASE		0x90C
62 #define PCIE_ATU_UPPER_BASE		0x910
63 #define PCIE_ATU_LIMIT			0x914
64 #define PCIE_ATU_LOWER_TARGET		0x918
65 #define PCIE_ATU_BUS(x)			(((x) & 0xff) << 24)
66 #define PCIE_ATU_DEV(x)			(((x) & 0x1f) << 19)
67 #define PCIE_ATU_FUNC(x)		(((x) & 0x7) << 16)
68 #define PCIE_ATU_UPPER_TARGET		0x91C
69 
70 static struct hw_pci dw_pci;
71 
72 static unsigned long global_io_offset;
73 
sys_to_pcie(struct pci_sys_data * sys)74 static inline struct pcie_port *sys_to_pcie(struct pci_sys_data *sys)
75 {
76 	BUG_ON(!sys->private_data);
77 
78 	return sys->private_data;
79 }
80 
dw_pcie_cfg_read(void __iomem * addr,int where,int size,u32 * val)81 int dw_pcie_cfg_read(void __iomem *addr, int where, int size, u32 *val)
82 {
83 	*val = readl(addr);
84 
85 	if (size == 1)
86 		*val = (*val >> (8 * (where & 3))) & 0xff;
87 	else if (size == 2)
88 		*val = (*val >> (8 * (where & 3))) & 0xffff;
89 	else if (size != 4)
90 		return PCIBIOS_BAD_REGISTER_NUMBER;
91 
92 	return PCIBIOS_SUCCESSFUL;
93 }
94 
dw_pcie_cfg_write(void __iomem * addr,int where,int size,u32 val)95 int dw_pcie_cfg_write(void __iomem *addr, int where, int size, u32 val)
96 {
97 	if (size == 4)
98 		writel(val, addr);
99 	else if (size == 2)
100 		writew(val, addr + (where & 2));
101 	else if (size == 1)
102 		writeb(val, addr + (where & 3));
103 	else
104 		return PCIBIOS_BAD_REGISTER_NUMBER;
105 
106 	return PCIBIOS_SUCCESSFUL;
107 }
108 
dw_pcie_readl_rc(struct pcie_port * pp,u32 reg,u32 * val)109 static inline void dw_pcie_readl_rc(struct pcie_port *pp, u32 reg, u32 *val)
110 {
111 	if (pp->ops->readl_rc)
112 		pp->ops->readl_rc(pp, pp->dbi_base + reg, val);
113 	else
114 		*val = readl(pp->dbi_base + reg);
115 }
116 
dw_pcie_writel_rc(struct pcie_port * pp,u32 val,u32 reg)117 static inline void dw_pcie_writel_rc(struct pcie_port *pp, u32 val, u32 reg)
118 {
119 	if (pp->ops->writel_rc)
120 		pp->ops->writel_rc(pp, val, pp->dbi_base + reg);
121 	else
122 		writel(val, pp->dbi_base + reg);
123 }
124 
dw_pcie_rd_own_conf(struct pcie_port * pp,int where,int size,u32 * val)125 static int dw_pcie_rd_own_conf(struct pcie_port *pp, int where, int size,
126 			       u32 *val)
127 {
128 	int ret;
129 
130 	if (pp->ops->rd_own_conf)
131 		ret = pp->ops->rd_own_conf(pp, where, size, val);
132 	else
133 		ret = dw_pcie_cfg_read(pp->dbi_base + (where & ~0x3), where,
134 				size, val);
135 
136 	return ret;
137 }
138 
dw_pcie_wr_own_conf(struct pcie_port * pp,int where,int size,u32 val)139 static int dw_pcie_wr_own_conf(struct pcie_port *pp, int where, int size,
140 			       u32 val)
141 {
142 	int ret;
143 
144 	if (pp->ops->wr_own_conf)
145 		ret = pp->ops->wr_own_conf(pp, where, size, val);
146 	else
147 		ret = dw_pcie_cfg_write(pp->dbi_base + (where & ~0x3), where,
148 				size, val);
149 
150 	return ret;
151 }
152 
153 static struct irq_chip dw_msi_irq_chip = {
154 	.name = "PCI-MSI",
155 	.irq_enable = unmask_msi_irq,
156 	.irq_disable = mask_msi_irq,
157 	.irq_mask = mask_msi_irq,
158 	.irq_unmask = unmask_msi_irq,
159 };
160 
161 /* MSI int handler */
dw_handle_msi_irq(struct pcie_port * pp)162 irqreturn_t dw_handle_msi_irq(struct pcie_port *pp)
163 {
164 	unsigned long val;
165 	int i, pos, irq;
166 	irqreturn_t ret = IRQ_NONE;
167 
168 	for (i = 0; i < MAX_MSI_CTRLS; i++) {
169 		dw_pcie_rd_own_conf(pp, PCIE_MSI_INTR0_STATUS + i * 12, 4,
170 				(u32 *)&val);
171 		if (val) {
172 			ret = IRQ_HANDLED;
173 			pos = 0;
174 			while ((pos = find_next_bit(&val, 32, pos)) != 32) {
175 				irq = irq_find_mapping(pp->irq_domain,
176 						i * 32 + pos);
177 				dw_pcie_wr_own_conf(pp,
178 						PCIE_MSI_INTR0_STATUS + i * 12,
179 						4, 1 << pos);
180 				generic_handle_irq(irq);
181 				pos++;
182 			}
183 		}
184 	}
185 
186 	return ret;
187 }
188 
dw_pcie_msi_init(struct pcie_port * pp)189 void dw_pcie_msi_init(struct pcie_port *pp)
190 {
191 	pp->msi_data = __get_free_pages(GFP_KERNEL, 0);
192 
193 	/* program the msi_data */
194 	dw_pcie_wr_own_conf(pp, PCIE_MSI_ADDR_LO, 4,
195 			virt_to_phys((void *)pp->msi_data));
196 	dw_pcie_wr_own_conf(pp, PCIE_MSI_ADDR_HI, 4, 0);
197 }
198 
dw_pcie_msi_clear_irq(struct pcie_port * pp,int irq)199 static void dw_pcie_msi_clear_irq(struct pcie_port *pp, int irq)
200 {
201 	unsigned int res, bit, val;
202 
203 	res = (irq / 32) * 12;
204 	bit = irq % 32;
205 	dw_pcie_rd_own_conf(pp, PCIE_MSI_INTR0_ENABLE + res, 4, &val);
206 	val &= ~(1 << bit);
207 	dw_pcie_wr_own_conf(pp, PCIE_MSI_INTR0_ENABLE + res, 4, val);
208 }
209 
clear_irq_range(struct pcie_port * pp,unsigned int irq_base,unsigned int nvec,unsigned int pos)210 static void clear_irq_range(struct pcie_port *pp, unsigned int irq_base,
211 			    unsigned int nvec, unsigned int pos)
212 {
213 	unsigned int i;
214 
215 	for (i = 0; i < nvec; i++) {
216 		irq_set_msi_desc_off(irq_base, i, NULL);
217 		/* Disable corresponding interrupt on MSI controller */
218 		if (pp->ops->msi_clear_irq)
219 			pp->ops->msi_clear_irq(pp, pos + i);
220 		else
221 			dw_pcie_msi_clear_irq(pp, pos + i);
222 	}
223 
224 	bitmap_release_region(pp->msi_irq_in_use, pos, order_base_2(nvec));
225 }
226 
dw_pcie_msi_set_irq(struct pcie_port * pp,int irq)227 static void dw_pcie_msi_set_irq(struct pcie_port *pp, int irq)
228 {
229 	unsigned int res, bit, val;
230 
231 	res = (irq / 32) * 12;
232 	bit = irq % 32;
233 	dw_pcie_rd_own_conf(pp, PCIE_MSI_INTR0_ENABLE + res, 4, &val);
234 	val |= 1 << bit;
235 	dw_pcie_wr_own_conf(pp, PCIE_MSI_INTR0_ENABLE + res, 4, val);
236 }
237 
assign_irq(int no_irqs,struct msi_desc * desc,int * pos)238 static int assign_irq(int no_irqs, struct msi_desc *desc, int *pos)
239 {
240 	int irq, pos0, i;
241 	struct pcie_port *pp = sys_to_pcie(desc->dev->bus->sysdata);
242 
243 	pos0 = bitmap_find_free_region(pp->msi_irq_in_use, MAX_MSI_IRQS,
244 				       order_base_2(no_irqs));
245 	if (pos0 < 0)
246 		goto no_valid_irq;
247 
248 	irq = irq_find_mapping(pp->irq_domain, pos0);
249 	if (!irq)
250 		goto no_valid_irq;
251 
252 	/*
253 	 * irq_create_mapping (called from dw_pcie_host_init) pre-allocates
254 	 * descs so there is no need to allocate descs here. We can therefore
255 	 * assume that if irq_find_mapping above returns non-zero, then the
256 	 * descs are also successfully allocated.
257 	 */
258 
259 	for (i = 0; i < no_irqs; i++) {
260 		if (irq_set_msi_desc_off(irq, i, desc) != 0) {
261 			clear_irq_range(pp, irq, i, pos0);
262 			goto no_valid_irq;
263 		}
264 		/*Enable corresponding interrupt in MSI interrupt controller */
265 		if (pp->ops->msi_set_irq)
266 			pp->ops->msi_set_irq(pp, pos0 + i);
267 		else
268 			dw_pcie_msi_set_irq(pp, pos0 + i);
269 	}
270 
271 	*pos = pos0;
272 	return irq;
273 
274 no_valid_irq:
275 	*pos = pos0;
276 	return -ENOSPC;
277 }
278 
dw_msi_setup_irq(struct msi_chip * chip,struct pci_dev * pdev,struct msi_desc * desc)279 static int dw_msi_setup_irq(struct msi_chip *chip, struct pci_dev *pdev,
280 			struct msi_desc *desc)
281 {
282 	int irq, pos;
283 	struct msi_msg msg;
284 	struct pcie_port *pp = sys_to_pcie(pdev->bus->sysdata);
285 
286 	if (desc->msi_attrib.is_msix)
287 		return -EINVAL;
288 
289 	irq = assign_irq(1, desc, &pos);
290 	if (irq < 0)
291 		return irq;
292 
293 	if (pp->ops->get_msi_addr)
294 		msg.address_lo = pp->ops->get_msi_addr(pp);
295 	else
296 		msg.address_lo = virt_to_phys((void *)pp->msi_data);
297 	msg.address_hi = 0x0;
298 
299 	if (pp->ops->get_msi_data)
300 		msg.data = pp->ops->get_msi_data(pp, pos);
301 	else
302 		msg.data = pos;
303 
304 	write_msi_msg(irq, &msg);
305 
306 	return 0;
307 }
308 
dw_msi_teardown_irq(struct msi_chip * chip,unsigned int irq)309 static void dw_msi_teardown_irq(struct msi_chip *chip, unsigned int irq)
310 {
311 	struct irq_data *data = irq_get_irq_data(irq);
312 	struct msi_desc *msi = irq_data_get_msi(data);
313 	struct pcie_port *pp = sys_to_pcie(msi->dev->bus->sysdata);
314 
315 	clear_irq_range(pp, irq, 1, data->hwirq);
316 }
317 
318 static struct msi_chip dw_pcie_msi_chip = {
319 	.setup_irq = dw_msi_setup_irq,
320 	.teardown_irq = dw_msi_teardown_irq,
321 };
322 
dw_pcie_link_up(struct pcie_port * pp)323 int dw_pcie_link_up(struct pcie_port *pp)
324 {
325 	if (pp->ops->link_up)
326 		return pp->ops->link_up(pp);
327 	else
328 		return 0;
329 }
330 
dw_pcie_msi_map(struct irq_domain * domain,unsigned int irq,irq_hw_number_t hwirq)331 static int dw_pcie_msi_map(struct irq_domain *domain, unsigned int irq,
332 			irq_hw_number_t hwirq)
333 {
334 	irq_set_chip_and_handler(irq, &dw_msi_irq_chip, handle_simple_irq);
335 	irq_set_chip_data(irq, domain->host_data);
336 	set_irq_flags(irq, IRQF_VALID);
337 
338 	return 0;
339 }
340 
341 static const struct irq_domain_ops msi_domain_ops = {
342 	.map = dw_pcie_msi_map,
343 };
344 
dw_pcie_host_init(struct pcie_port * pp)345 int dw_pcie_host_init(struct pcie_port *pp)
346 {
347 	struct device_node *np = pp->dev->of_node;
348 	struct platform_device *pdev = to_platform_device(pp->dev);
349 	struct of_pci_range range;
350 	struct of_pci_range_parser parser;
351 	struct resource *cfg_res;
352 	u32 val, na, ns;
353 	const __be32 *addrp;
354 	int i, index, ret;
355 
356 	/* Find the address cell size and the number of cells in order to get
357 	 * the untranslated address.
358 	 */
359 	of_property_read_u32(np, "#address-cells", &na);
360 	ns = of_n_size_cells(np);
361 
362 	cfg_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "config");
363 	if (cfg_res) {
364 		pp->cfg0_size = resource_size(cfg_res)/2;
365 		pp->cfg1_size = resource_size(cfg_res)/2;
366 		pp->cfg0_base = cfg_res->start;
367 		pp->cfg1_base = cfg_res->start + pp->cfg0_size;
368 
369 		/* Find the untranslated configuration space address */
370 		index = of_property_match_string(np, "reg-names", "config");
371 		addrp = of_get_address(np, index, NULL, NULL);
372 		pp->cfg0_mod_base = of_read_number(addrp, ns);
373 		pp->cfg1_mod_base = pp->cfg0_mod_base + pp->cfg0_size;
374 	} else {
375 		dev_err(pp->dev, "missing *config* reg space\n");
376 	}
377 
378 	if (of_pci_range_parser_init(&parser, np)) {
379 		dev_err(pp->dev, "missing ranges property\n");
380 		return -EINVAL;
381 	}
382 
383 	/* Get the I/O and memory ranges from DT */
384 	for_each_of_pci_range(&parser, &range) {
385 		unsigned long restype = range.flags & IORESOURCE_TYPE_BITS;
386 		if (restype == IORESOURCE_IO) {
387 			of_pci_range_to_resource(&range, np, &pp->io);
388 			pp->io.name = "I/O";
389 			pp->io.start = max_t(resource_size_t,
390 					     PCIBIOS_MIN_IO,
391 					     range.pci_addr + global_io_offset);
392 			pp->io.end = min_t(resource_size_t,
393 					   IO_SPACE_LIMIT,
394 					   range.pci_addr + range.size
395 					   + global_io_offset - 1);
396 			pp->io_size = resource_size(&pp->io);
397 			pp->io_bus_addr = range.pci_addr;
398 			pp->io_base = range.cpu_addr;
399 
400 			/* Find the untranslated IO space address */
401 			pp->io_mod_base = of_read_number(parser.range -
402 							 parser.np + na, ns);
403 		}
404 		if (restype == IORESOURCE_MEM) {
405 			of_pci_range_to_resource(&range, np, &pp->mem);
406 			pp->mem.name = "MEM";
407 			pp->mem_size = resource_size(&pp->mem);
408 			pp->mem_bus_addr = range.pci_addr;
409 
410 			/* Find the untranslated MEM space address */
411 			pp->mem_mod_base = of_read_number(parser.range -
412 							  parser.np + na, ns);
413 		}
414 		if (restype == 0) {
415 			of_pci_range_to_resource(&range, np, &pp->cfg);
416 			pp->cfg0_size = resource_size(&pp->cfg)/2;
417 			pp->cfg1_size = resource_size(&pp->cfg)/2;
418 			pp->cfg0_base = pp->cfg.start;
419 			pp->cfg1_base = pp->cfg.start + pp->cfg0_size;
420 
421 			/* Find the untranslated configuration space address */
422 			pp->cfg0_mod_base = of_read_number(parser.range -
423 							   parser.np + na, ns);
424 			pp->cfg1_mod_base = pp->cfg0_mod_base +
425 					    pp->cfg0_size;
426 		}
427 	}
428 
429 	ret = of_pci_parse_bus_range(np, &pp->busn);
430 	if (ret < 0) {
431 		pp->busn.name = np->name;
432 		pp->busn.start = 0;
433 		pp->busn.end = 0xff;
434 		pp->busn.flags = IORESOURCE_BUS;
435 		dev_dbg(pp->dev, "failed to parse bus-range property: %d, using default %pR\n",
436 			ret, &pp->busn);
437 	}
438 
439 	if (!pp->dbi_base) {
440 		pp->dbi_base = devm_ioremap(pp->dev, pp->cfg.start,
441 					resource_size(&pp->cfg));
442 		if (!pp->dbi_base) {
443 			dev_err(pp->dev, "error with ioremap\n");
444 			return -ENOMEM;
445 		}
446 	}
447 
448 	pp->mem_base = pp->mem.start;
449 
450 	if (!pp->va_cfg0_base) {
451 		pp->va_cfg0_base = devm_ioremap(pp->dev, pp->cfg0_base,
452 						pp->cfg0_size);
453 		if (!pp->va_cfg0_base) {
454 			dev_err(pp->dev, "error with ioremap in function\n");
455 			return -ENOMEM;
456 		}
457 	}
458 
459 	if (!pp->va_cfg1_base) {
460 		pp->va_cfg1_base = devm_ioremap(pp->dev, pp->cfg1_base,
461 						pp->cfg1_size);
462 		if (!pp->va_cfg1_base) {
463 			dev_err(pp->dev, "error with ioremap\n");
464 			return -ENOMEM;
465 		}
466 	}
467 
468 	if (of_property_read_u32(np, "num-lanes", &pp->lanes)) {
469 		dev_err(pp->dev, "Failed to parse the number of lanes\n");
470 		return -EINVAL;
471 	}
472 
473 	if (IS_ENABLED(CONFIG_PCI_MSI)) {
474 		if (!pp->ops->msi_host_init) {
475 			pp->irq_domain = irq_domain_add_linear(pp->dev->of_node,
476 						MAX_MSI_IRQS, &msi_domain_ops,
477 						&dw_pcie_msi_chip);
478 			if (!pp->irq_domain) {
479 				dev_err(pp->dev, "irq domain init failed\n");
480 				return -ENXIO;
481 			}
482 
483 			for (i = 0; i < MAX_MSI_IRQS; i++)
484 				irq_create_mapping(pp->irq_domain, i);
485 		} else {
486 			ret = pp->ops->msi_host_init(pp, &dw_pcie_msi_chip);
487 			if (ret < 0)
488 				return ret;
489 		}
490 	}
491 
492 	if (pp->ops->host_init)
493 		pp->ops->host_init(pp);
494 
495 	dw_pcie_wr_own_conf(pp, PCI_BASE_ADDRESS_0, 4, 0);
496 
497 	/* program correct class for RC */
498 	dw_pcie_wr_own_conf(pp, PCI_CLASS_DEVICE, 2, PCI_CLASS_BRIDGE_PCI);
499 
500 	dw_pcie_rd_own_conf(pp, PCIE_LINK_WIDTH_SPEED_CONTROL, 4, &val);
501 	val |= PORT_LOGIC_SPEED_CHANGE;
502 	dw_pcie_wr_own_conf(pp, PCIE_LINK_WIDTH_SPEED_CONTROL, 4, val);
503 
504 	dw_pci.nr_controllers = 1;
505 	dw_pci.private_data = (void **)&pp;
506 
507 	pci_common_init_dev(pp->dev, &dw_pci);
508 #ifdef CONFIG_PCI_DOMAINS
509 	dw_pci.domain++;
510 #endif
511 
512 	return 0;
513 }
514 
dw_pcie_prog_viewport_cfg0(struct pcie_port * pp,u32 busdev)515 static void dw_pcie_prog_viewport_cfg0(struct pcie_port *pp, u32 busdev)
516 {
517 	/* Program viewport 0 : OUTBOUND : CFG0 */
518 	dw_pcie_writel_rc(pp, PCIE_ATU_REGION_OUTBOUND | PCIE_ATU_REGION_INDEX0,
519 			  PCIE_ATU_VIEWPORT);
520 	dw_pcie_writel_rc(pp, pp->cfg0_mod_base, PCIE_ATU_LOWER_BASE);
521 	dw_pcie_writel_rc(pp, (pp->cfg0_mod_base >> 32), PCIE_ATU_UPPER_BASE);
522 	dw_pcie_writel_rc(pp, pp->cfg0_mod_base + pp->cfg0_size - 1,
523 			  PCIE_ATU_LIMIT);
524 	dw_pcie_writel_rc(pp, busdev, PCIE_ATU_LOWER_TARGET);
525 	dw_pcie_writel_rc(pp, 0, PCIE_ATU_UPPER_TARGET);
526 	dw_pcie_writel_rc(pp, PCIE_ATU_TYPE_CFG0, PCIE_ATU_CR1);
527 	dw_pcie_writel_rc(pp, PCIE_ATU_ENABLE, PCIE_ATU_CR2);
528 }
529 
dw_pcie_prog_viewport_cfg1(struct pcie_port * pp,u32 busdev)530 static void dw_pcie_prog_viewport_cfg1(struct pcie_port *pp, u32 busdev)
531 {
532 	/* Program viewport 1 : OUTBOUND : CFG1 */
533 	dw_pcie_writel_rc(pp, PCIE_ATU_REGION_OUTBOUND | PCIE_ATU_REGION_INDEX1,
534 			  PCIE_ATU_VIEWPORT);
535 	dw_pcie_writel_rc(pp, PCIE_ATU_TYPE_CFG1, PCIE_ATU_CR1);
536 	dw_pcie_writel_rc(pp, pp->cfg1_mod_base, PCIE_ATU_LOWER_BASE);
537 	dw_pcie_writel_rc(pp, (pp->cfg1_mod_base >> 32), PCIE_ATU_UPPER_BASE);
538 	dw_pcie_writel_rc(pp, pp->cfg1_mod_base + pp->cfg1_size - 1,
539 			  PCIE_ATU_LIMIT);
540 	dw_pcie_writel_rc(pp, busdev, PCIE_ATU_LOWER_TARGET);
541 	dw_pcie_writel_rc(pp, 0, PCIE_ATU_UPPER_TARGET);
542 	dw_pcie_writel_rc(pp, PCIE_ATU_ENABLE, PCIE_ATU_CR2);
543 }
544 
dw_pcie_prog_viewport_mem_outbound(struct pcie_port * pp)545 static void dw_pcie_prog_viewport_mem_outbound(struct pcie_port *pp)
546 {
547 	/* Program viewport 0 : OUTBOUND : MEM */
548 	dw_pcie_writel_rc(pp, PCIE_ATU_REGION_OUTBOUND | PCIE_ATU_REGION_INDEX0,
549 			  PCIE_ATU_VIEWPORT);
550 	dw_pcie_writel_rc(pp, PCIE_ATU_TYPE_MEM, PCIE_ATU_CR1);
551 	dw_pcie_writel_rc(pp, pp->mem_mod_base, PCIE_ATU_LOWER_BASE);
552 	dw_pcie_writel_rc(pp, (pp->mem_mod_base >> 32), PCIE_ATU_UPPER_BASE);
553 	dw_pcie_writel_rc(pp, pp->mem_mod_base + pp->mem_size - 1,
554 			  PCIE_ATU_LIMIT);
555 	dw_pcie_writel_rc(pp, pp->mem_bus_addr, PCIE_ATU_LOWER_TARGET);
556 	dw_pcie_writel_rc(pp, upper_32_bits(pp->mem_bus_addr),
557 			  PCIE_ATU_UPPER_TARGET);
558 	dw_pcie_writel_rc(pp, PCIE_ATU_ENABLE, PCIE_ATU_CR2);
559 }
560 
dw_pcie_prog_viewport_io_outbound(struct pcie_port * pp)561 static void dw_pcie_prog_viewport_io_outbound(struct pcie_port *pp)
562 {
563 	/* Program viewport 1 : OUTBOUND : IO */
564 	dw_pcie_writel_rc(pp, PCIE_ATU_REGION_OUTBOUND | PCIE_ATU_REGION_INDEX1,
565 			  PCIE_ATU_VIEWPORT);
566 	dw_pcie_writel_rc(pp, PCIE_ATU_TYPE_IO, PCIE_ATU_CR1);
567 	dw_pcie_writel_rc(pp, pp->io_mod_base, PCIE_ATU_LOWER_BASE);
568 	dw_pcie_writel_rc(pp, (pp->io_mod_base >> 32), PCIE_ATU_UPPER_BASE);
569 	dw_pcie_writel_rc(pp, pp->io_mod_base + pp->io_size - 1,
570 			  PCIE_ATU_LIMIT);
571 	dw_pcie_writel_rc(pp, pp->io_bus_addr, PCIE_ATU_LOWER_TARGET);
572 	dw_pcie_writel_rc(pp, upper_32_bits(pp->io_bus_addr),
573 			  PCIE_ATU_UPPER_TARGET);
574 	dw_pcie_writel_rc(pp, PCIE_ATU_ENABLE, PCIE_ATU_CR2);
575 }
576 
dw_pcie_rd_other_conf(struct pcie_port * pp,struct pci_bus * bus,u32 devfn,int where,int size,u32 * val)577 static int dw_pcie_rd_other_conf(struct pcie_port *pp, struct pci_bus *bus,
578 		u32 devfn, int where, int size, u32 *val)
579 {
580 	int ret = PCIBIOS_SUCCESSFUL;
581 	u32 address, busdev;
582 
583 	busdev = PCIE_ATU_BUS(bus->number) | PCIE_ATU_DEV(PCI_SLOT(devfn)) |
584 		 PCIE_ATU_FUNC(PCI_FUNC(devfn));
585 	address = where & ~0x3;
586 
587 	if (bus->parent->number == pp->root_bus_nr) {
588 		dw_pcie_prog_viewport_cfg0(pp, busdev);
589 		ret = dw_pcie_cfg_read(pp->va_cfg0_base + address, where, size,
590 				val);
591 		dw_pcie_prog_viewport_mem_outbound(pp);
592 	} else {
593 		dw_pcie_prog_viewport_cfg1(pp, busdev);
594 		ret = dw_pcie_cfg_read(pp->va_cfg1_base + address, where, size,
595 				val);
596 		dw_pcie_prog_viewport_io_outbound(pp);
597 	}
598 
599 	return ret;
600 }
601 
dw_pcie_wr_other_conf(struct pcie_port * pp,struct pci_bus * bus,u32 devfn,int where,int size,u32 val)602 static int dw_pcie_wr_other_conf(struct pcie_port *pp, struct pci_bus *bus,
603 		u32 devfn, int where, int size, u32 val)
604 {
605 	int ret = PCIBIOS_SUCCESSFUL;
606 	u32 address, busdev;
607 
608 	busdev = PCIE_ATU_BUS(bus->number) | PCIE_ATU_DEV(PCI_SLOT(devfn)) |
609 		 PCIE_ATU_FUNC(PCI_FUNC(devfn));
610 	address = where & ~0x3;
611 
612 	if (bus->parent->number == pp->root_bus_nr) {
613 		dw_pcie_prog_viewport_cfg0(pp, busdev);
614 		ret = dw_pcie_cfg_write(pp->va_cfg0_base + address, where, size,
615 				val);
616 		dw_pcie_prog_viewport_mem_outbound(pp);
617 	} else {
618 		dw_pcie_prog_viewport_cfg1(pp, busdev);
619 		ret = dw_pcie_cfg_write(pp->va_cfg1_base + address, where, size,
620 				val);
621 		dw_pcie_prog_viewport_io_outbound(pp);
622 	}
623 
624 	return ret;
625 }
626 
dw_pcie_valid_config(struct pcie_port * pp,struct pci_bus * bus,int dev)627 static int dw_pcie_valid_config(struct pcie_port *pp,
628 				struct pci_bus *bus, int dev)
629 {
630 	/* If there is no link, then there is no device */
631 	if (bus->number != pp->root_bus_nr) {
632 		if (!dw_pcie_link_up(pp))
633 			return 0;
634 	}
635 
636 	/* access only one slot on each root port */
637 	if (bus->number == pp->root_bus_nr && dev > 0)
638 		return 0;
639 
640 	/*
641 	 * do not read more than one device on the bus directly attached
642 	 * to RC's (Virtual Bridge's) DS side.
643 	 */
644 	if (bus->primary == pp->root_bus_nr && dev > 0)
645 		return 0;
646 
647 	return 1;
648 }
649 
dw_pcie_rd_conf(struct pci_bus * bus,u32 devfn,int where,int size,u32 * val)650 static int dw_pcie_rd_conf(struct pci_bus *bus, u32 devfn, int where,
651 			int size, u32 *val)
652 {
653 	struct pcie_port *pp = sys_to_pcie(bus->sysdata);
654 	int ret;
655 
656 	if (dw_pcie_valid_config(pp, bus, PCI_SLOT(devfn)) == 0) {
657 		*val = 0xffffffff;
658 		return PCIBIOS_DEVICE_NOT_FOUND;
659 	}
660 
661 	if (bus->number != pp->root_bus_nr)
662 		if (pp->ops->rd_other_conf)
663 			ret = pp->ops->rd_other_conf(pp, bus, devfn,
664 						where, size, val);
665 		else
666 			ret = dw_pcie_rd_other_conf(pp, bus, devfn,
667 						where, size, val);
668 	else
669 		ret = dw_pcie_rd_own_conf(pp, where, size, val);
670 
671 	return ret;
672 }
673 
dw_pcie_wr_conf(struct pci_bus * bus,u32 devfn,int where,int size,u32 val)674 static int dw_pcie_wr_conf(struct pci_bus *bus, u32 devfn,
675 			int where, int size, u32 val)
676 {
677 	struct pcie_port *pp = sys_to_pcie(bus->sysdata);
678 	int ret;
679 
680 	if (dw_pcie_valid_config(pp, bus, PCI_SLOT(devfn)) == 0)
681 		return PCIBIOS_DEVICE_NOT_FOUND;
682 
683 	if (bus->number != pp->root_bus_nr)
684 		if (pp->ops->wr_other_conf)
685 			ret = pp->ops->wr_other_conf(pp, bus, devfn,
686 						where, size, val);
687 		else
688 			ret = dw_pcie_wr_other_conf(pp, bus, devfn,
689 						where, size, val);
690 	else
691 		ret = dw_pcie_wr_own_conf(pp, where, size, val);
692 
693 	return ret;
694 }
695 
696 static struct pci_ops dw_pcie_ops = {
697 	.read = dw_pcie_rd_conf,
698 	.write = dw_pcie_wr_conf,
699 };
700 
dw_pcie_setup(int nr,struct pci_sys_data * sys)701 static int dw_pcie_setup(int nr, struct pci_sys_data *sys)
702 {
703 	struct pcie_port *pp;
704 
705 	pp = sys_to_pcie(sys);
706 
707 	if (global_io_offset < SZ_1M && pp->io_size > 0) {
708 		sys->io_offset = global_io_offset - pp->io_bus_addr;
709 		pci_ioremap_io(global_io_offset, pp->io_base);
710 		global_io_offset += SZ_64K;
711 		pci_add_resource_offset(&sys->resources, &pp->io,
712 					sys->io_offset);
713 	}
714 
715 	sys->mem_offset = pp->mem.start - pp->mem_bus_addr;
716 	pci_add_resource_offset(&sys->resources, &pp->mem, sys->mem_offset);
717 	pci_add_resource(&sys->resources, &pp->busn);
718 
719 	return 1;
720 }
721 
dw_pcie_scan_bus(int nr,struct pci_sys_data * sys)722 static struct pci_bus *dw_pcie_scan_bus(int nr, struct pci_sys_data *sys)
723 {
724 	struct pci_bus *bus;
725 	struct pcie_port *pp = sys_to_pcie(sys);
726 
727 	pp->root_bus_nr = sys->busnr;
728 	bus = pci_create_root_bus(pp->dev, sys->busnr,
729 				  &dw_pcie_ops, sys, &sys->resources);
730 	if (!bus)
731 		return NULL;
732 
733 	pci_scan_child_bus(bus);
734 
735 	if (bus && pp->ops->scan_bus)
736 		pp->ops->scan_bus(pp);
737 
738 	return bus;
739 }
740 
dw_pcie_map_irq(const struct pci_dev * dev,u8 slot,u8 pin)741 static int dw_pcie_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
742 {
743 	struct pcie_port *pp = sys_to_pcie(dev->bus->sysdata);
744 	int irq;
745 
746 	irq = of_irq_parse_and_map_pci(dev, slot, pin);
747 	if (!irq)
748 		irq = pp->irq;
749 
750 	return irq;
751 }
752 
dw_pcie_add_bus(struct pci_bus * bus)753 static void dw_pcie_add_bus(struct pci_bus *bus)
754 {
755 	if (IS_ENABLED(CONFIG_PCI_MSI)) {
756 		struct pcie_port *pp = sys_to_pcie(bus->sysdata);
757 
758 		dw_pcie_msi_chip.dev = pp->dev;
759 		bus->msi = &dw_pcie_msi_chip;
760 	}
761 }
762 
763 static struct hw_pci dw_pci = {
764 	.setup		= dw_pcie_setup,
765 	.scan		= dw_pcie_scan_bus,
766 	.map_irq	= dw_pcie_map_irq,
767 	.add_bus	= dw_pcie_add_bus,
768 };
769 
dw_pcie_setup_rc(struct pcie_port * pp)770 void dw_pcie_setup_rc(struct pcie_port *pp)
771 {
772 	u32 val;
773 	u32 membase;
774 	u32 memlimit;
775 
776 	/* set the number of lanes */
777 	dw_pcie_readl_rc(pp, PCIE_PORT_LINK_CONTROL, &val);
778 	val &= ~PORT_LINK_MODE_MASK;
779 	switch (pp->lanes) {
780 	case 1:
781 		val |= PORT_LINK_MODE_1_LANES;
782 		break;
783 	case 2:
784 		val |= PORT_LINK_MODE_2_LANES;
785 		break;
786 	case 4:
787 		val |= PORT_LINK_MODE_4_LANES;
788 		break;
789 	}
790 	dw_pcie_writel_rc(pp, val, PCIE_PORT_LINK_CONTROL);
791 
792 	/* set link width speed control register */
793 	dw_pcie_readl_rc(pp, PCIE_LINK_WIDTH_SPEED_CONTROL, &val);
794 	val &= ~PORT_LOGIC_LINK_WIDTH_MASK;
795 	switch (pp->lanes) {
796 	case 1:
797 		val |= PORT_LOGIC_LINK_WIDTH_1_LANES;
798 		break;
799 	case 2:
800 		val |= PORT_LOGIC_LINK_WIDTH_2_LANES;
801 		break;
802 	case 4:
803 		val |= PORT_LOGIC_LINK_WIDTH_4_LANES;
804 		break;
805 	}
806 	dw_pcie_writel_rc(pp, val, PCIE_LINK_WIDTH_SPEED_CONTROL);
807 
808 	/* setup RC BARs */
809 	dw_pcie_writel_rc(pp, 0x00000004, PCI_BASE_ADDRESS_0);
810 	dw_pcie_writel_rc(pp, 0x00000000, PCI_BASE_ADDRESS_1);
811 
812 	/* setup interrupt pins */
813 	dw_pcie_readl_rc(pp, PCI_INTERRUPT_LINE, &val);
814 	val &= 0xffff00ff;
815 	val |= 0x00000100;
816 	dw_pcie_writel_rc(pp, val, PCI_INTERRUPT_LINE);
817 
818 	/* setup bus numbers */
819 	dw_pcie_readl_rc(pp, PCI_PRIMARY_BUS, &val);
820 	val &= 0xff000000;
821 	val |= 0x00010100;
822 	dw_pcie_writel_rc(pp, val, PCI_PRIMARY_BUS);
823 
824 	/* setup memory base, memory limit */
825 	membase = ((u32)pp->mem_base & 0xfff00000) >> 16;
826 	memlimit = (pp->mem_size + (u32)pp->mem_base) & 0xfff00000;
827 	val = memlimit | membase;
828 	dw_pcie_writel_rc(pp, val, PCI_MEMORY_BASE);
829 
830 	/* setup command register */
831 	dw_pcie_readl_rc(pp, PCI_COMMAND, &val);
832 	val &= 0xffff0000;
833 	val |= PCI_COMMAND_IO | PCI_COMMAND_MEMORY |
834 		PCI_COMMAND_MASTER | PCI_COMMAND_SERR;
835 	dw_pcie_writel_rc(pp, val, PCI_COMMAND);
836 }
837 
838 MODULE_AUTHOR("Jingoo Han <jg1.han@samsung.com>");
839 MODULE_DESCRIPTION("Designware PCIe host controller driver");
840 MODULE_LICENSE("GPL v2");
841