forked from ~ljy/RK356X_SDK_RELEASE
blame | history | patch | commit | commitdiff
hc
2023-12-09 b22da3d8526a935aa31e086e63f60ff3246cb61c 
 kernel/drivers/pci/controller/pcie-rcar.c
....@@ -1,182 +1,29 @@
11 // SPDX-License-Identifier: GPL-2.0
22 /*
33  * PCIe driver for Renesas R-Car SoCs
4
- *  Copyright (C) 2014 Renesas Electronics Europe Ltd
5
- *
6
- * Based on:
7
- *  arch/sh/drivers/pci/pcie-sh7786.c
8
- *  arch/sh/drivers/pci/ops-sh7786.c
9
- *  Copyright (C) 2009 - 2011  Paul Mundt
4
+ *  Copyright (C) 2014-2020 Renesas Electronics Europe Ltd
105  *
116  * Author: Phil Edworthy <phil.edworthy@renesas.com>
127  */
138 
14
-#include <linux/bitops.h>
15
-#include <linux/clk.h>
169 #include <linux/delay.h>
17
-#include <linux/interrupt.h>
18
-#include <linux/irq.h>
19
-#include <linux/irqdomain.h>
20
-#include <linux/kernel.h>
21
-#include <linux/init.h>
22
-#include <linux/msi.h>
23
-#include <linux/of_address.h>
24
-#include <linux/of_irq.h>
25
-#include <linux/of_pci.h>
26
-#include <linux/of_platform.h>
2710 #include <linux/pci.h>
28
-#include <linux/phy/phy.h>
29
-#include <linux/platform_device.h>
30
-#include <linux/pm_runtime.h>
31
-#include <linux/slab.h>
3211 
33
-#include "../pci.h"
12
+#include "pcie-rcar.h"
3413 
35
-#define PCIECAR			0x000010
36
-#define PCIECCTLR		0x000018
37
-#define  CONFIG_SEND_ENABLE	BIT(31)
38
-#define  TYPE0			(0 << 8)
39
-#define  TYPE1			BIT(8)
40
-#define PCIECDR			0x000020
41
-#define PCIEMSR			0x000028
42
-#define PCIEINTXR		0x000400
43
-#define PCIEPHYSR		0x0007f0
44
-#define  PHYRDY			BIT(0)
45
-#define PCIEMSITXR		0x000840
46
-
47
-/* Transfer control */
48
-#define PCIETCTLR		0x02000
49
-#define  DL_DOWN		BIT(3)
50
-#define  CFINIT			1
51
-#define PCIETSTR		0x02004
52
-#define  DATA_LINK_ACTIVE	1
53
-#define PCIEERRFR		0x02020
54
-#define  UNSUPPORTED_REQUEST	BIT(4)
55
-#define PCIEMSIFR		0x02044
56
-#define PCIEMSIALR		0x02048
57
-#define  MSIFE			1
58
-#define PCIEMSIAUR		0x0204c
59
-#define PCIEMSIIER		0x02050
60
-
61
-/* root port address */
62
-#define PCIEPRAR(x)		(0x02080 + ((x) * 0x4))
63
-
64
-/* local address reg & mask */
65
-#define PCIELAR(x)		(0x02200 + ((x) * 0x20))
66
-#define PCIELAMR(x)		(0x02208 + ((x) * 0x20))
67
-#define  LAM_PREFETCH		BIT(3)
68
-#define  LAM_64BIT		BIT(2)
69
-#define  LAR_ENABLE		BIT(1)
70
-
71
-/* PCIe address reg & mask */
72
-#define PCIEPALR(x)		(0x03400 + ((x) * 0x20))
73
-#define PCIEPAUR(x)		(0x03404 + ((x) * 0x20))
74
-#define PCIEPAMR(x)		(0x03408 + ((x) * 0x20))
75
-#define PCIEPTCTLR(x)		(0x0340c + ((x) * 0x20))
76
-#define  PAR_ENABLE		BIT(31)
77
-#define  IO_SPACE		BIT(8)
78
-
79
-/* Configuration */
80
-#define PCICONF(x)		(0x010000 + ((x) * 0x4))
81
-#define PMCAP(x)		(0x010040 + ((x) * 0x4))
82
-#define EXPCAP(x)		(0x010070 + ((x) * 0x4))
83
-#define VCCAP(x)		(0x010100 + ((x) * 0x4))
84
-
85
-/* link layer */
86
-#define IDSETR1			0x011004
87
-#define TLCTLR			0x011048
88
-#define MACSR			0x011054
89
-#define  SPCHGFIN		BIT(4)
90
-#define  SPCHGFAIL		BIT(6)
91
-#define  SPCHGSUC		BIT(7)
92
-#define  LINK_SPEED		(0xf << 16)
93
-#define  LINK_SPEED_2_5GTS	(1 << 16)
94
-#define  LINK_SPEED_5_0GTS	(2 << 16)
95
-#define MACCTLR			0x011058
96
-#define  MACCTLR_NFTS_MASK	GENMASK(23, 16)	/* The name is from SH7786 */
97
-#define  SPEED_CHANGE		BIT(24)
98
-#define  SCRAMBLE_DISABLE	BIT(27)
99
-#define  LTSMDIS		BIT(31)
100
-#define  MACCTLR_INIT_VAL	(LTSMDIS | MACCTLR_NFTS_MASK)
101
-#define PMSR			0x01105c
102
-#define MACS2R			0x011078
103
-#define MACCGSPSETR		0x011084
104
-#define  SPCNGRSN		BIT(31)
105
-
106
-/* R-Car H1 PHY */
107
-#define H1_PCIEPHYADRR		0x04000c
108
-#define  WRITE_CMD		BIT(16)
109
-#define  PHY_ACK		BIT(24)
110
-#define  RATE_POS		12
111
-#define  LANE_POS		8
112
-#define  ADR_POS		0
113
-#define H1_PCIEPHYDOUTR		0x040014
114
-
115
-/* R-Car Gen2 PHY */
116
-#define GEN2_PCIEPHYADDR	0x780
117
-#define GEN2_PCIEPHYDATA	0x784
118
-#define GEN2_PCIEPHYCTRL	0x78c
119
-
120
-#define INT_PCI_MSI_NR		32
121
-
122
-#define RCONF(x)		(PCICONF(0) + (x))
123
-#define RPMCAP(x)		(PMCAP(0) + (x))
124
-#define REXPCAP(x)		(EXPCAP(0) + (x))
125
-#define RVCCAP(x)		(VCCAP(0) + (x))
126
-
127
-#define PCIE_CONF_BUS(b)	(((b) & 0xff) << 24)
128
-#define PCIE_CONF_DEV(d)	(((d) & 0x1f) << 19)
129
-#define PCIE_CONF_FUNC(f)	(((f) & 0x7) << 16)
130
-
131
-#define RCAR_PCI_MAX_RESOURCES	4
132
-#define MAX_NR_INBOUND_MAPS	6
133
-
134
-struct rcar_msi {
135
-	DECLARE_BITMAP(used, INT_PCI_MSI_NR);
136
-	struct irq_domain *domain;
137
-	struct msi_controller chip;
138
-	unsigned long pages;
139
-	struct mutex lock;
140
-	int irq1;
141
-	int irq2;
142
-};
143
-
144
-static inline struct rcar_msi *to_rcar_msi(struct msi_controller *chip)
145
-{
146
-	return container_of(chip, struct rcar_msi, chip);
147
-}
148
-
149
-/* Structure representing the PCIe interface */
150
-struct rcar_pcie {
151
-	struct device		*dev;
152
-	struct phy		*phy;
153
-	void __iomem		*base;
154
-	struct list_head	resources;
155
-	int			root_bus_nr;
156
-	struct clk		*bus_clk;
157
-	struct			rcar_msi msi;
158
-};
159
-
160
-static void rcar_pci_write_reg(struct rcar_pcie *pcie, unsigned long val,
161
-			       unsigned long reg)
14
+void rcar_pci_write_reg(struct rcar_pcie *pcie, u32 val, unsigned int reg)
16215 {
16316 	writel(val, pcie->base + reg);
16417 }
16518 
166
-static unsigned long rcar_pci_read_reg(struct rcar_pcie *pcie,
167
-				       unsigned long reg)
19
+u32 rcar_pci_read_reg(struct rcar_pcie *pcie, unsigned int reg)
16820 {
16921 	return readl(pcie->base + reg);
17022 }
17123 
172
-enum {
173
-	RCAR_PCI_ACCESS_READ,
174
-	RCAR_PCI_ACCESS_WRITE,
175
-};
176
-
177
-static void rcar_rmw32(struct rcar_pcie *pcie, int where, u32 mask, u32 data)
24
+void rcar_rmw32(struct rcar_pcie *pcie, int where, u32 mask, u32 data)
17825 {
179
-	int shift = 8 * (where & 3);
26
+	unsigned int shift = BITS_PER_BYTE * (where & 3);
18027 	u32 val = rcar_pci_read_reg(pcie, where & ~3);
18128 
18229 	val &= ~(mask << shift);
....@@ -184,163 +31,42 @@
18431 	rcar_pci_write_reg(pcie, val, where & ~3);
18532 }
18633 
187
-static u32 rcar_read_conf(struct rcar_pcie *pcie, int where)
34
+int rcar_pcie_wait_for_phyrdy(struct rcar_pcie *pcie)
18835 {
189
-	int shift = 8 * (where & 3);
190
-	u32 val = rcar_pci_read_reg(pcie, where & ~3);
36
+	unsigned int timeout = 10;
19137 
192
-	return val >> shift;
193
-}
38
+	while (timeout--) {
39
+		if (rcar_pci_read_reg(pcie, PCIEPHYSR) & PHYRDY)
40
+			return 0;
19441 
195
-/* Serialization is provided by 'pci_lock' in drivers/pci/access.c */
196
-static int rcar_pcie_config_access(struct rcar_pcie *pcie,
197
-		unsigned char access_type, struct pci_bus *bus,
198
-		unsigned int devfn, int where, u32 *data)
199
-{
200
-	int dev, func, reg, index;
201
-
202
-	dev = PCI_SLOT(devfn);
203
-	func = PCI_FUNC(devfn);
204
-	reg = where & ~3;
205
-	index = reg / 4;
206
-
207
-	/*
208
-	 * While each channel has its own memory-mapped extended config
209
-	 * space, it's generally only accessible when in endpoint mode.
210
-	 * When in root complex mode, the controller is unable to target
211
-	 * itself with either type 0 or type 1 accesses, and indeed, any
212
-	 * controller initiated target transfer to its own config space
213
-	 * result in a completer abort.
214
-	 *
215
-	 * Each channel effectively only supports a single device, but as
216
-	 * the same channel <-> device access works for any PCI_SLOT()
217
-	 * value, we cheat a bit here and bind the controller's config
218
-	 * space to devfn 0 in order to enable self-enumeration. In this
219
-	 * case the regular ECAR/ECDR path is sidelined and the mangled
220
-	 * config access itself is initiated as an internal bus transaction.
221
-	 */
222
-	if (pci_is_root_bus(bus)) {
223
-		if (dev != 0)
224
-			return PCIBIOS_DEVICE_NOT_FOUND;
225
-
226
-		if (access_type == RCAR_PCI_ACCESS_READ) {
227
-			*data = rcar_pci_read_reg(pcie, PCICONF(index));
228
-		} else {
229
-			/* Keep an eye out for changes to the root bus number */
230
-			if (pci_is_root_bus(bus) && (reg == PCI_PRIMARY_BUS))
231
-				pcie->root_bus_nr = *data & 0xff;
232
-
233
-			rcar_pci_write_reg(pcie, *data, PCICONF(index));
234
-		}
235
-
236
-		return PCIBIOS_SUCCESSFUL;
42
+		msleep(5);
23743 	}
23844 
239
-	if (pcie->root_bus_nr < 0)
240
-		return PCIBIOS_DEVICE_NOT_FOUND;
241
-
242
-	/* Clear errors */
243
-	rcar_pci_write_reg(pcie, rcar_pci_read_reg(pcie, PCIEERRFR), PCIEERRFR);
244
-
245
-	/* Set the PIO address */
246
-	rcar_pci_write_reg(pcie, PCIE_CONF_BUS(bus->number) |
247
-		PCIE_CONF_DEV(dev) | PCIE_CONF_FUNC(func) | reg, PCIECAR);
248
-
249
-	/* Enable the configuration access */
250
-	if (bus->parent->number == pcie->root_bus_nr)
251
-		rcar_pci_write_reg(pcie, CONFIG_SEND_ENABLE | TYPE0, PCIECCTLR);
252
-	else
253
-		rcar_pci_write_reg(pcie, CONFIG_SEND_ENABLE | TYPE1, PCIECCTLR);
254
-
255
-	/* Check for errors */
256
-	if (rcar_pci_read_reg(pcie, PCIEERRFR) & UNSUPPORTED_REQUEST)
257
-		return PCIBIOS_DEVICE_NOT_FOUND;
258
-
259
-	/* Check for master and target aborts */
260
-	if (rcar_read_conf(pcie, RCONF(PCI_STATUS)) &
261
-		(PCI_STATUS_REC_MASTER_ABORT | PCI_STATUS_REC_TARGET_ABORT))
262
-		return PCIBIOS_DEVICE_NOT_FOUND;
263
-
264
-	if (access_type == RCAR_PCI_ACCESS_READ)
265
-		*data = rcar_pci_read_reg(pcie, PCIECDR);
266
-	else
267
-		rcar_pci_write_reg(pcie, *data, PCIECDR);
268
-
269
-	/* Disable the configuration access */
270
-	rcar_pci_write_reg(pcie, 0, PCIECCTLR);
271
-
272
-	return PCIBIOS_SUCCESSFUL;
45
+	return -ETIMEDOUT;
27346 }
27447 
275
-static int rcar_pcie_read_conf(struct pci_bus *bus, unsigned int devfn,
276
-			       int where, int size, u32 *val)
48
+int rcar_pcie_wait_for_dl(struct rcar_pcie *pcie)
27749 {
278
-	struct rcar_pcie *pcie = bus->sysdata;
279
-	int ret;
50
+	unsigned int timeout = 10000;
28051 
281
-	ret = rcar_pcie_config_access(pcie, RCAR_PCI_ACCESS_READ,
282
-				      bus, devfn, where, val);
283
-	if (ret != PCIBIOS_SUCCESSFUL) {
284
-		*val = 0xffffffff;
285
-		return ret;
52
+	while (timeout--) {
53
+		if ((rcar_pci_read_reg(pcie, PCIETSTR) & DATA_LINK_ACTIVE))
54
+			return 0;
55
+
56
+		udelay(5);
57
+		cpu_relax();
28658 	}
28759 
288
-	if (size == 1)
289
-		*val = (*val >> (8 * (where & 3))) & 0xff;
290
-	else if (size == 2)
291
-		*val = (*val >> (8 * (where & 2))) & 0xffff;
292
-
293
-	dev_dbg(&bus->dev, "pcie-config-read: bus=%3d devfn=0x%04x where=0x%04x size=%d val=0x%08lx\n",
294
-		bus->number, devfn, where, size, (unsigned long)*val);
295
-
296
-	return ret;
60
+	return -ETIMEDOUT;
29761 }
29862 
299
-/* Serialization is provided by 'pci_lock' in drivers/pci/access.c */
300
-static int rcar_pcie_write_conf(struct pci_bus *bus, unsigned int devfn,
301
-				int where, int size, u32 val)
302
-{
303
-	struct rcar_pcie *pcie = bus->sysdata;
304
-	int shift, ret;
305
-	u32 data;
306
-
307
-	ret = rcar_pcie_config_access(pcie, RCAR_PCI_ACCESS_READ,
308
-				      bus, devfn, where, &data);
309
-	if (ret != PCIBIOS_SUCCESSFUL)
310
-		return ret;
311
-
312
-	dev_dbg(&bus->dev, "pcie-config-write: bus=%3d devfn=0x%04x where=0x%04x size=%d val=0x%08lx\n",
313
-		bus->number, devfn, where, size, (unsigned long)val);
314
-
315
-	if (size == 1) {
316
-		shift = 8 * (where & 3);
317
-		data &= ~(0xff << shift);
318
-		data |= ((val & 0xff) << shift);
319
-	} else if (size == 2) {
320
-		shift = 8 * (where & 2);
321
-		data &= ~(0xffff << shift);
322
-		data |= ((val & 0xffff) << shift);
323
-	} else
324
-		data = val;
325
-
326
-	ret = rcar_pcie_config_access(pcie, RCAR_PCI_ACCESS_WRITE,
327
-				      bus, devfn, where, &data);
328
-
329
-	return ret;
330
-}
331
-
332
-static struct pci_ops rcar_pcie_ops = {
333
-	.read	= rcar_pcie_read_conf,
334
-	.write	= rcar_pcie_write_conf,
335
-};
336
-
337
-static void rcar_pcie_setup_window(int win, struct rcar_pcie *pcie,
338
-				   struct resource_entry *window)
63
+void rcar_pcie_set_outbound(struct rcar_pcie *pcie, int win,
64
+			    struct resource_entry *window)
33965 {
34066 	/* Setup PCIe address space mappings for each resource */
341
-	resource_size_t size;
342
-	resource_size_t res_start;
34367 	struct resource *res = window->res;
68
+	resource_size_t res_start;
69
+	resource_size_t size;
34470 	u32 mask;
34571 
34672 	rcar_pci_write_reg(pcie, 0x00000000, PCIEPTCTLR(win));
....@@ -350,7 +76,10 @@
35076 	 * keeps things pretty simple.
35177 	 */
35278 	size = resource_size(res);
353
-	mask = (roundup_pow_of_two(size) / SZ_128) - 1;
79
+	if (size > 128)
80
+		mask = (roundup_pow_of_two(size) / SZ_128) - 1;
81
+	else
82
+		mask = 0x0;
35483 	rcar_pci_write_reg(pcie, mask << 7, PCIEPAMR(win));
35584 
35685 	if (res->flags & IORESOURCE_IO)
....@@ -370,895 +99,22 @@
37099 	rcar_pci_write_reg(pcie, mask, PCIEPTCTLR(win));
371100 }
372101 
373
-static int rcar_pcie_setup(struct list_head *resource, struct rcar_pcie *pci)
374
-{
375
-	struct resource_entry *win;
376
-	int i = 0;
377
-
378
-	/* Setup PCI resources */
379
-	resource_list_for_each_entry(win, &pci->resources) {
380
-		struct resource *res = win->res;
381
-
382
-		if (!res->flags)
383
-			continue;
384
-
385
-		switch (resource_type(res)) {
386
-		case IORESOURCE_IO:
387
-		case IORESOURCE_MEM:
388
-			rcar_pcie_setup_window(i, pci, win);
389
-			i++;
390
-			break;
391
-		case IORESOURCE_BUS:
392
-			pci->root_bus_nr = res->start;
393
-			break;
394
-		default:
395
-			continue;
396
-		}
397
-
398
-		pci_add_resource(resource, res);
399
-	}
400
-
401
-	return 1;
402
-}
403
-
404
-static void rcar_pcie_force_speedup(struct rcar_pcie *pcie)
405
-{
406
-	struct device *dev = pcie->dev;
407
-	unsigned int timeout = 1000;
408
-	u32 macsr;
409
-
410
-	if ((rcar_pci_read_reg(pcie, MACS2R) & LINK_SPEED) != LINK_SPEED_5_0GTS)
411
-		return;
412
-
413
-	if (rcar_pci_read_reg(pcie, MACCTLR) & SPEED_CHANGE) {
414
-		dev_err(dev, "Speed change already in progress\n");
415
-		return;
416
-	}
417
-
418
-	macsr = rcar_pci_read_reg(pcie, MACSR);
419
-	if ((macsr & LINK_SPEED) == LINK_SPEED_5_0GTS)
420
-		goto done;
421
-
422
-	/* Set target link speed to 5.0 GT/s */
423
-	rcar_rmw32(pcie, EXPCAP(12), PCI_EXP_LNKSTA_CLS,
424
-		   PCI_EXP_LNKSTA_CLS_5_0GB);
425
-
426
-	/* Set speed change reason as intentional factor */
427
-	rcar_rmw32(pcie, MACCGSPSETR, SPCNGRSN, 0);
428
-
429
-	/* Clear SPCHGFIN, SPCHGSUC, and SPCHGFAIL */
430
-	if (macsr & (SPCHGFIN | SPCHGSUC | SPCHGFAIL))
431
-		rcar_pci_write_reg(pcie, macsr, MACSR);
432
-
433
-	/* Start link speed change */
434
-	rcar_rmw32(pcie, MACCTLR, SPEED_CHANGE, SPEED_CHANGE);
435
-
436
-	while (timeout--) {
437
-		macsr = rcar_pci_read_reg(pcie, MACSR);
438
-		if (macsr & SPCHGFIN) {
439
-			/* Clear the interrupt bits */
440
-			rcar_pci_write_reg(pcie, macsr, MACSR);
441
-
442
-			if (macsr & SPCHGFAIL)
443
-				dev_err(dev, "Speed change failed\n");
444
-
445
-			goto done;
446
-		}
447
-
448
-		msleep(1);
449
-	}
450
-
451
-	dev_err(dev, "Speed change timed out\n");
452
-
453
-done:
454
-	dev_info(dev, "Current link speed is %s GT/s\n",
455
-		 (macsr & LINK_SPEED) == LINK_SPEED_5_0GTS ? "5" : "2.5");
456
-}
457
-
458
-static int rcar_pcie_enable(struct rcar_pcie *pcie)
459
-{
460
-	struct device *dev = pcie->dev;
461
-	struct pci_host_bridge *bridge = pci_host_bridge_from_priv(pcie);
462
-	struct pci_bus *bus, *child;
463
-	int ret;
464
-
465
-	/* Try setting 5 GT/s link speed */
466
-	rcar_pcie_force_speedup(pcie);
467
-
468
-	rcar_pcie_setup(&bridge->windows, pcie);
469
-
470
-	pci_add_flags(PCI_REASSIGN_ALL_BUS);
471
-
472
-	bridge->dev.parent = dev;
473
-	bridge->sysdata = pcie;
474
-	bridge->busnr = pcie->root_bus_nr;
475
-	bridge->ops = &rcar_pcie_ops;
476
-	bridge->map_irq = of_irq_parse_and_map_pci;
477
-	bridge->swizzle_irq = pci_common_swizzle;
478
-	if (IS_ENABLED(CONFIG_PCI_MSI))
479
-		bridge->msi = &pcie->msi.chip;
480
-
481
-	ret = pci_scan_root_bus_bridge(bridge);
482
-	if (ret < 0)
483
-		return ret;
484
-
485
-	bus = bridge->bus;
486
-
487
-	pci_bus_size_bridges(bus);
488
-	pci_bus_assign_resources(bus);
489
-
490
-	list_for_each_entry(child, &bus->children, node)
491
-		pcie_bus_configure_settings(child);
492
-
493
-	pci_bus_add_devices(bus);
494
-
495
-	return 0;
496
-}
497
-
498
-static int phy_wait_for_ack(struct rcar_pcie *pcie)
499
-{
500
-	struct device *dev = pcie->dev;
501
-	unsigned int timeout = 100;
502
-
503
-	while (timeout--) {
504
-		if (rcar_pci_read_reg(pcie, H1_PCIEPHYADRR) & PHY_ACK)
505
-			return 0;
506
-
507
-		udelay(100);
508
-	}
509
-
510
-	dev_err(dev, "Access to PCIe phy timed out\n");
511
-
512
-	return -ETIMEDOUT;
513
-}
514
-
515
-static void phy_write_reg(struct rcar_pcie *pcie,
516
-				 unsigned int rate, unsigned int addr,
517
-				 unsigned int lane, unsigned int data)
518
-{
519
-	unsigned long phyaddr;
520
-
521
-	phyaddr = WRITE_CMD |
522
-		((rate & 1) << RATE_POS) |
523
-		((lane & 0xf) << LANE_POS) |
524
-		((addr & 0xff) << ADR_POS);
525
-
526
-	/* Set write data */
527
-	rcar_pci_write_reg(pcie, data, H1_PCIEPHYDOUTR);
528
-	rcar_pci_write_reg(pcie, phyaddr, H1_PCIEPHYADRR);
529
-
530
-	/* Ignore errors as they will be dealt with if the data link is down */
531
-	phy_wait_for_ack(pcie);
532
-
533
-	/* Clear command */
534
-	rcar_pci_write_reg(pcie, 0, H1_PCIEPHYDOUTR);
535
-	rcar_pci_write_reg(pcie, 0, H1_PCIEPHYADRR);
536
-
537
-	/* Ignore errors as they will be dealt with if the data link is down */
538
-	phy_wait_for_ack(pcie);
539
-}
540
-
541
-static int rcar_pcie_wait_for_phyrdy(struct rcar_pcie *pcie)
542
-{
543
-	unsigned int timeout = 10;
544
-
545
-	while (timeout--) {
546
-		if (rcar_pci_read_reg(pcie, PCIEPHYSR) & PHYRDY)
547
-			return 0;
548
-
549
-		msleep(5);
550
-	}
551
-
552
-	return -ETIMEDOUT;
553
-}
554
-
555
-static int rcar_pcie_wait_for_dl(struct rcar_pcie *pcie)
556
-{
557
-	unsigned int timeout = 10000;
558
-
559
-	while (timeout--) {
560
-		if ((rcar_pci_read_reg(pcie, PCIETSTR) & DATA_LINK_ACTIVE))
561
-			return 0;
562
-
563
-		udelay(5);
564
-		cpu_relax();
565
-	}
566
-
567
-	return -ETIMEDOUT;
568
-}
569
-
570
-static int rcar_pcie_hw_init(struct rcar_pcie *pcie)
571
-{
572
-	int err;
573
-
574
-	/* Begin initialization */
575
-	rcar_pci_write_reg(pcie, 0, PCIETCTLR);
576
-
577
-	/* Set mode */
578
-	rcar_pci_write_reg(pcie, 1, PCIEMSR);
579
-
580
-	err = rcar_pcie_wait_for_phyrdy(pcie);
581
-	if (err)
582
-		return err;
583
-
584
-	/*
585
-	 * Initial header for port config space is type 1, set the device
586
-	 * class to match. Hardware takes care of propagating the IDSETR
587
-	 * settings, so there is no need to bother with a quirk.
588
-	 */
589
-	rcar_pci_write_reg(pcie, PCI_CLASS_BRIDGE_PCI << 16, IDSETR1);
590
-
591
-	/*
592
-	 * Setup Secondary Bus Number & Subordinate Bus Number, even though
593
-	 * they aren't used, to avoid bridge being detected as broken.
594
-	 */
595
-	rcar_rmw32(pcie, RCONF(PCI_SECONDARY_BUS), 0xff, 1);
596
-	rcar_rmw32(pcie, RCONF(PCI_SUBORDINATE_BUS), 0xff, 1);
597
-
598
-	/* Initialize default capabilities. */
599
-	rcar_rmw32(pcie, REXPCAP(0), 0xff, PCI_CAP_ID_EXP);
600
-	rcar_rmw32(pcie, REXPCAP(PCI_EXP_FLAGS),
601
-		PCI_EXP_FLAGS_TYPE, PCI_EXP_TYPE_ROOT_PORT << 4);
602
-	rcar_rmw32(pcie, RCONF(PCI_HEADER_TYPE), 0x7f,
603
-		PCI_HEADER_TYPE_BRIDGE);
604
-
605
-	/* Enable data link layer active state reporting */
606
-	rcar_rmw32(pcie, REXPCAP(PCI_EXP_LNKCAP), PCI_EXP_LNKCAP_DLLLARC,
607
-		PCI_EXP_LNKCAP_DLLLARC);
608
-
609
-	/* Write out the physical slot number = 0 */
610
-	rcar_rmw32(pcie, REXPCAP(PCI_EXP_SLTCAP), PCI_EXP_SLTCAP_PSN, 0);
611
-
612
-	/* Set the completion timer timeout to the maximum 50ms. */
613
-	rcar_rmw32(pcie, TLCTLR + 1, 0x3f, 50);
614
-
615
-	/* Terminate list of capabilities (Next Capability Offset=0) */
616
-	rcar_rmw32(pcie, RVCCAP(0), 0xfff00000, 0);
617
-
618
-	/* Enable MSI */
619
-	if (IS_ENABLED(CONFIG_PCI_MSI))
620
-		rcar_pci_write_reg(pcie, 0x801f0000, PCIEMSITXR);
621
-
622
-	rcar_pci_write_reg(pcie, MACCTLR_INIT_VAL, MACCTLR);
623
-
624
-	/* Finish initialization - establish a PCI Express link */
625
-	rcar_pci_write_reg(pcie, CFINIT, PCIETCTLR);
626
-
627
-	/* This will timeout if we don't have a link. */
628
-	err = rcar_pcie_wait_for_dl(pcie);
629
-	if (err)
630
-		return err;
631
-
632
-	/* Enable INTx interrupts */
633
-	rcar_rmw32(pcie, PCIEINTXR, 0, 0xF << 8);
634
-
635
-	wmb();
636
-
637
-	return 0;
638
-}
639
-
640
-static int rcar_pcie_phy_init_h1(struct rcar_pcie *pcie)
641
-{
642
-	/* Initialize the phy */
643
-	phy_write_reg(pcie, 0, 0x42, 0x1, 0x0EC34191);
644
-	phy_write_reg(pcie, 1, 0x42, 0x1, 0x0EC34180);
645
-	phy_write_reg(pcie, 0, 0x43, 0x1, 0x00210188);
646
-	phy_write_reg(pcie, 1, 0x43, 0x1, 0x00210188);
647
-	phy_write_reg(pcie, 0, 0x44, 0x1, 0x015C0014);
648
-	phy_write_reg(pcie, 1, 0x44, 0x1, 0x015C0014);
649
-	phy_write_reg(pcie, 1, 0x4C, 0x1, 0x786174A0);
650
-	phy_write_reg(pcie, 1, 0x4D, 0x1, 0x048000BB);
651
-	phy_write_reg(pcie, 0, 0x51, 0x1, 0x079EC062);
652
-	phy_write_reg(pcie, 0, 0x52, 0x1, 0x20000000);
653
-	phy_write_reg(pcie, 1, 0x52, 0x1, 0x20000000);
654
-	phy_write_reg(pcie, 1, 0x56, 0x1, 0x00003806);
655
-
656
-	phy_write_reg(pcie, 0, 0x60, 0x1, 0x004B03A5);
657
-	phy_write_reg(pcie, 0, 0x64, 0x1, 0x3F0F1F0F);
658
-	phy_write_reg(pcie, 0, 0x66, 0x1, 0x00008000);
659
-
660
-	return 0;
661
-}
662
-
663
-static int rcar_pcie_phy_init_gen2(struct rcar_pcie *pcie)
102
+void rcar_pcie_set_inbound(struct rcar_pcie *pcie, u64 cpu_addr,
103
+			   u64 pci_addr, u64 flags, int idx, bool host)
664104 {
665105 	/*
666
-	 * These settings come from the R-Car Series, 2nd Generation User's
667
-	 * Manual, section 50.3.1 (2) Initialization of the physical layer.
106
+	 * Set up 64-bit inbound regions as the range parser doesn't
107
+	 * distinguish between 32 and 64-bit types.
668108 	 */
669
-	rcar_pci_write_reg(pcie, 0x000f0030, GEN2_PCIEPHYADDR);
670
-	rcar_pci_write_reg(pcie, 0x00381203, GEN2_PCIEPHYDATA);
671
-	rcar_pci_write_reg(pcie, 0x00000001, GEN2_PCIEPHYCTRL);
672
-	rcar_pci_write_reg(pcie, 0x00000006, GEN2_PCIEPHYCTRL);
673
-
674
-	rcar_pci_write_reg(pcie, 0x000f0054, GEN2_PCIEPHYADDR);
675
-	/* The following value is for DC connection, no termination resistor */
676
-	rcar_pci_write_reg(pcie, 0x13802007, GEN2_PCIEPHYDATA);
677
-	rcar_pci_write_reg(pcie, 0x00000001, GEN2_PCIEPHYCTRL);
678
-	rcar_pci_write_reg(pcie, 0x00000006, GEN2_PCIEPHYCTRL);
679
-
680
-	return 0;
681
-}
682
-
683
-static int rcar_pcie_phy_init_gen3(struct rcar_pcie *pcie)
684
-{
685
-	int err;
686
-
687
-	err = phy_init(pcie->phy);
688
-	if (err)
689
-		return err;
690
-
691
-	err = phy_power_on(pcie->phy);
692
-	if (err)
693
-		phy_exit(pcie->phy);
694
-
695
-	return err;
696
-}
697
-
698
-static int rcar_msi_alloc(struct rcar_msi *chip)
699
-{
700
-	int msi;
701
-
702
-	mutex_lock(&chip->lock);
703
-
704
-	msi = find_first_zero_bit(chip->used, INT_PCI_MSI_NR);
705
-	if (msi < INT_PCI_MSI_NR)
706
-		set_bit(msi, chip->used);
707
-	else
708
-		msi = -ENOSPC;
709
-
710
-	mutex_unlock(&chip->lock);
711
-
712
-	return msi;
713
-}
714
-
715
-static int rcar_msi_alloc_region(struct rcar_msi *chip, int no_irqs)
716
-{
717
-	int msi;
718
-
719
-	mutex_lock(&chip->lock);
720
-	msi = bitmap_find_free_region(chip->used, INT_PCI_MSI_NR,
721
-				      order_base_2(no_irqs));
722
-	mutex_unlock(&chip->lock);
723
-
724
-	return msi;
725
-}
726
-
727
-static void rcar_msi_free(struct rcar_msi *chip, unsigned long irq)
728
-{
729
-	mutex_lock(&chip->lock);
730
-	clear_bit(irq, chip->used);
731
-	mutex_unlock(&chip->lock);
732
-}
733
-
734
-static irqreturn_t rcar_pcie_msi_irq(int irq, void *data)
735
-{
736
-	struct rcar_pcie *pcie = data;
737
-	struct rcar_msi *msi = &pcie->msi;
738
-	struct device *dev = pcie->dev;
739
-	unsigned long reg;
740
-
741
-	reg = rcar_pci_read_reg(pcie, PCIEMSIFR);
742
-
743
-	/* MSI & INTx share an interrupt - we only handle MSI here */
744
-	if (!reg)
745
-		return IRQ_NONE;
746
-
747
-	while (reg) {
748
-		unsigned int index = find_first_bit(&reg, 32);
749
-		unsigned int irq;
750
-
751
-		/* clear the interrupt */
752
-		rcar_pci_write_reg(pcie, 1 << index, PCIEMSIFR);
753
-
754
-		irq = irq_find_mapping(msi->domain, index);
755
-		if (irq) {
756
-			if (test_bit(index, msi->used))
757
-				generic_handle_irq(irq);
758
-			else
759
-				dev_info(dev, "unhandled MSI\n");
760
-		} else {
761
-			/* Unknown MSI, just clear it */
762
-			dev_dbg(dev, "unexpected MSI\n");
763
-		}
764
-
765
-		/* see if there's any more pending in this vector */
766
-		reg = rcar_pci_read_reg(pcie, PCIEMSIFR);
767
-	}
768
-
769
-	return IRQ_HANDLED;
770
-}
771
-
772
-static int rcar_msi_setup_irq(struct msi_controller *chip, struct pci_dev *pdev,
773
-			      struct msi_desc *desc)
774
-{
775
-	struct rcar_msi *msi = to_rcar_msi(chip);
776
-	struct rcar_pcie *pcie = container_of(chip, struct rcar_pcie, msi.chip);
777
-	struct msi_msg msg;
778
-	unsigned int irq;
779
-	int hwirq;
780
-
781
-	hwirq = rcar_msi_alloc(msi);
782
-	if (hwirq < 0)
783
-		return hwirq;
784
-
785
-	irq = irq_find_mapping(msi->domain, hwirq);
786
-	if (!irq) {
787
-		rcar_msi_free(msi, hwirq);
788
-		return -EINVAL;
789
-	}
790
-
791
-	irq_set_msi_desc(irq, desc);
792
-
793
-	msg.address_lo = rcar_pci_read_reg(pcie, PCIEMSIALR) & ~MSIFE;
794
-	msg.address_hi = rcar_pci_read_reg(pcie, PCIEMSIAUR);
795
-	msg.data = hwirq;
796
-
797
-	pci_write_msi_msg(irq, &msg);
798
-
799
-	return 0;
800
-}
801
-
802
-static int rcar_msi_setup_irqs(struct msi_controller *chip,
803
-			       struct pci_dev *pdev, int nvec, int type)
804
-{
805
-	struct rcar_pcie *pcie = container_of(chip, struct rcar_pcie, msi.chip);
806
-	struct rcar_msi *msi = to_rcar_msi(chip);
807
-	struct msi_desc *desc;
808
-	struct msi_msg msg;
809
-	unsigned int irq;
810
-	int hwirq;
811
-	int i;
812
-
813
-	/* MSI-X interrupts are not supported */
814
-	if (type == PCI_CAP_ID_MSIX)
815
-		return -EINVAL;
816
-
817
-	WARN_ON(!list_is_singular(&pdev->dev.msi_list));
818
-	desc = list_entry(pdev->dev.msi_list.next, struct msi_desc, list);
819
-
820
-	hwirq = rcar_msi_alloc_region(msi, nvec);
821
-	if (hwirq < 0)
822
-		return -ENOSPC;
823
-
824
-	irq = irq_find_mapping(msi->domain, hwirq);
825
-	if (!irq)
826
-		return -ENOSPC;
827
-
828
-	for (i = 0; i < nvec; i++) {
829
-		/*
830
-		 * irq_create_mapping() called from rcar_pcie_probe() pre-
831
-		 * allocates descs,  so there is no need to allocate descs here.
832
-		 * We can therefore assume that if irq_find_mapping() above
833
-		 * returns non-zero, then the descs are also successfully
834
-		 * allocated.
835
-		 */
836
-		if (irq_set_msi_desc_off(irq, i, desc)) {
837
-			/* TODO: clear */
838
-			return -EINVAL;
839
-		}
840
-	}
841
-
842
-	desc->nvec_used = nvec;
843
-	desc->msi_attrib.multiple = order_base_2(nvec);
844
-
845
-	msg.address_lo = rcar_pci_read_reg(pcie, PCIEMSIALR) & ~MSIFE;
846
-	msg.address_hi = rcar_pci_read_reg(pcie, PCIEMSIAUR);
847
-	msg.data = hwirq;
848
-
849
-	pci_write_msi_msg(irq, &msg);
850
-
851
-	return 0;
852
-}
853
-
854
-static void rcar_msi_teardown_irq(struct msi_controller *chip, unsigned int irq)
855
-{
856
-	struct rcar_msi *msi = to_rcar_msi(chip);
857
-	struct irq_data *d = irq_get_irq_data(irq);
858
-
859
-	rcar_msi_free(msi, d->hwirq);
860
-}
861
-
862
-static struct irq_chip rcar_msi_irq_chip = {
863
-	.name = "R-Car PCIe MSI",
864
-	.irq_enable = pci_msi_unmask_irq,
865
-	.irq_disable = pci_msi_mask_irq,
866
-	.irq_mask = pci_msi_mask_irq,
867
-	.irq_unmask = pci_msi_unmask_irq,
868
-};
869
-
870
-static int rcar_msi_map(struct irq_domain *domain, unsigned int irq,
871
-			irq_hw_number_t hwirq)
872
-{
873
-	irq_set_chip_and_handler(irq, &rcar_msi_irq_chip, handle_simple_irq);
874
-	irq_set_chip_data(irq, domain->host_data);
875
-
876
-	return 0;
877
-}
878
-
879
-static const struct irq_domain_ops msi_domain_ops = {
880
-	.map = rcar_msi_map,
881
-};
882
-
883
-static void rcar_pcie_unmap_msi(struct rcar_pcie *pcie)
884
-{
885
-	struct rcar_msi *msi = &pcie->msi;
886
-	int i, irq;
887
-
888
-	for (i = 0; i < INT_PCI_MSI_NR; i++) {
889
-		irq = irq_find_mapping(msi->domain, i);
890
-		if (irq > 0)
891
-			irq_dispose_mapping(irq);
892
-	}
893
-
894
-	irq_domain_remove(msi->domain);
895
-}
896
-
897
-static int rcar_pcie_enable_msi(struct rcar_pcie *pcie)
898
-{
899
-	struct device *dev = pcie->dev;
900
-	struct rcar_msi *msi = &pcie->msi;
901
-	phys_addr_t base;
902
-	int err, i;
903
-
904
-	mutex_init(&msi->lock);
905
-
906
-	msi->chip.dev = dev;
907
-	msi->chip.setup_irq = rcar_msi_setup_irq;
908
-	msi->chip.setup_irqs = rcar_msi_setup_irqs;
909
-	msi->chip.teardown_irq = rcar_msi_teardown_irq;
910
-
911
-	msi->domain = irq_domain_add_linear(dev->of_node, INT_PCI_MSI_NR,
912
-					    &msi_domain_ops, &msi->chip);
913
-	if (!msi->domain) {
914
-		dev_err(dev, "failed to create IRQ domain\n");
915
-		return -ENOMEM;
916
-	}
917
-
918
-	for (i = 0; i < INT_PCI_MSI_NR; i++)
919
-		irq_create_mapping(msi->domain, i);
920
-
921
-	/* Two irqs are for MSI, but they are also used for non-MSI irqs */
922
-	err = devm_request_irq(dev, msi->irq1, rcar_pcie_msi_irq,
923
-			       IRQF_SHARED | IRQF_NO_THREAD,
924
-			       rcar_msi_irq_chip.name, pcie);
925
-	if (err < 0) {
926
-		dev_err(dev, "failed to request IRQ: %d\n", err);
927
-		goto err;
928
-	}
929
-
930
-	err = devm_request_irq(dev, msi->irq2, rcar_pcie_msi_irq,
931
-			       IRQF_SHARED | IRQF_NO_THREAD,
932
-			       rcar_msi_irq_chip.name, pcie);
933
-	if (err < 0) {
934
-		dev_err(dev, "failed to request IRQ: %d\n", err);
935
-		goto err;
936
-	}
937
-
938
-	/* setup MSI data target */
939
-	msi->pages = __get_free_pages(GFP_KERNEL, 0);
940
-	if (!msi->pages) {
941
-		err = -ENOMEM;
942
-		goto err;
943
-	}
944
-	base = virt_to_phys((void *)msi->pages);
945
-
946
-	rcar_pci_write_reg(pcie, lower_32_bits(base) | MSIFE, PCIEMSIALR);
947
-	rcar_pci_write_reg(pcie, upper_32_bits(base), PCIEMSIAUR);
948
-
949
-	/* enable all MSI interrupts */
950
-	rcar_pci_write_reg(pcie, 0xffffffff, PCIEMSIIER);
951
-
952
-	return 0;
953
-
954
-err:
955
-	rcar_pcie_unmap_msi(pcie);
956
-	return err;
957
-}
958
-
959
-static void rcar_pcie_teardown_msi(struct rcar_pcie *pcie)
960
-{
961
-	struct rcar_msi *msi = &pcie->msi;
962
-
963
-	/* Disable all MSI interrupts */
964
-	rcar_pci_write_reg(pcie, 0, PCIEMSIIER);
965
-
966
-	/* Disable address decoding of the MSI interrupt, MSIFE */
967
-	rcar_pci_write_reg(pcie, 0, PCIEMSIALR);
968
-
969
-	free_pages(msi->pages, 0);
970
-
971
-	rcar_pcie_unmap_msi(pcie);
972
-}
973
-
974
-static int rcar_pcie_get_resources(struct rcar_pcie *pcie)
975
-{
976
-	struct device *dev = pcie->dev;
977
-	struct resource res;
978
-	int err, i;
979
-
980
-	pcie->phy = devm_phy_optional_get(dev, "pcie");
981
-	if (IS_ERR(pcie->phy))
982
-		return PTR_ERR(pcie->phy);
983
-
984
-	err = of_address_to_resource(dev->of_node, 0, &res);
985
-	if (err)
986
-		return err;
987
-
988
-	pcie->base = devm_ioremap_resource(dev, &res);
989
-	if (IS_ERR(pcie->base))
990
-		return PTR_ERR(pcie->base);
991
-
992
-	pcie->bus_clk = devm_clk_get(dev, "pcie_bus");
993
-	if (IS_ERR(pcie->bus_clk)) {
994
-		dev_err(dev, "cannot get pcie bus clock\n");
995
-		return PTR_ERR(pcie->bus_clk);
996
-	}
997
-
998
-	i = irq_of_parse_and_map(dev->of_node, 0);
999
-	if (!i) {
1000
-		dev_err(dev, "cannot get platform resources for msi interrupt\n");
1001
-		err = -ENOENT;
1002
-		goto err_irq1;
1003
-	}
1004
-	pcie->msi.irq1 = i;
1005
-
1006
-	i = irq_of_parse_and_map(dev->of_node, 1);
1007
-	if (!i) {
1008
-		dev_err(dev, "cannot get platform resources for msi interrupt\n");
1009
-		err = -ENOENT;
1010
-		goto err_irq2;
1011
-	}
1012
-	pcie->msi.irq2 = i;
1013
-
1014
-	return 0;
1015
-
1016
-err_irq2:
1017
-	irq_dispose_mapping(pcie->msi.irq1);
1018
-err_irq1:
1019
-	return err;
1020
-}
1021
-
1022
-static int rcar_pcie_inbound_ranges(struct rcar_pcie *pcie,
1023
-				    struct of_pci_range *range,
1024
-				    int *index)
1025
-{
1026
-	u64 restype = range->flags;
1027
-	u64 cpu_addr = range->cpu_addr;
1028
-	u64 cpu_end = range->cpu_addr + range->size;
1029
-	u64 pci_addr = range->pci_addr;
1030
-	u32 flags = LAM_64BIT | LAR_ENABLE;
1031
-	u64 mask;
1032
-	u64 size;
1033
-	int idx = *index;
1034
-
1035
-	if (restype & IORESOURCE_PREFETCH)
1036
-		flags |= LAM_PREFETCH;
1037
-
1038
-	/*
1039
-	 * If the size of the range is larger than the alignment of the start
1040
-	 * address, we have to use multiple entries to perform the mapping.
1041
-	 */
1042
-	if (cpu_addr > 0) {
1043
-		unsigned long nr_zeros = __ffs64(cpu_addr);
1044
-		u64 alignment = 1ULL << nr_zeros;
1045
-
1046
-		size = min(range->size, alignment);
1047
-	} else {
1048
-		size = range->size;
1049
-	}
1050
-	/* Hardware supports max 4GiB inbound region */
1051
-	size = min(size, 1ULL << 32);
1052
-
1053
-	mask = roundup_pow_of_two(size) - 1;
1054
-	mask &= ~0xf;
1055
-
1056
-	while (cpu_addr < cpu_end) {
1057
-		/*
1058
-		 * Set up 64-bit inbound regions as the range parser doesn't
1059
-		 * distinguish between 32 and 64-bit types.
1060
-		 */
109
+	if (host)
1061110 		rcar_pci_write_reg(pcie, lower_32_bits(pci_addr),
1062111 				   PCIEPRAR(idx));
1063
-		rcar_pci_write_reg(pcie, lower_32_bits(cpu_addr), PCIELAR(idx));
1064
-		rcar_pci_write_reg(pcie, lower_32_bits(mask) | flags,
1065
-				   PCIELAMR(idx));
112
+	rcar_pci_write_reg(pcie, lower_32_bits(cpu_addr), PCIELAR(idx));
113
+	rcar_pci_write_reg(pcie, flags, PCIELAMR(idx));
1066114 
115
+	if (host)
1067116 		rcar_pci_write_reg(pcie, upper_32_bits(pci_addr),
1068117 				   PCIEPRAR(idx + 1));
1069
-		rcar_pci_write_reg(pcie, upper_32_bits(cpu_addr),
1070
-				   PCIELAR(idx + 1));
1071
-		rcar_pci_write_reg(pcie, 0, PCIELAMR(idx + 1));
1072
-
1073
-		pci_addr += size;
1074
-		cpu_addr += size;
1075
-		idx += 2;
1076
-
1077
-		if (idx > MAX_NR_INBOUND_MAPS) {
1078
-			dev_err(pcie->dev, "Failed to map inbound regions!\n");
1079
-			return -EINVAL;
1080
-		}
1081
-	}
1082
-	*index = idx;
1083
-
1084
-	return 0;
118
+	rcar_pci_write_reg(pcie, upper_32_bits(cpu_addr), PCIELAR(idx + 1));
119
+	rcar_pci_write_reg(pcie, 0, PCIELAMR(idx + 1));
1085120 }
1086
-
1087
-static int rcar_pcie_parse_map_dma_ranges(struct rcar_pcie *pcie,
1088
-					  struct device_node *np)
1089
-{
1090
-	struct of_pci_range range;
1091
-	struct of_pci_range_parser parser;
1092
-	int index = 0;
1093
-	int err;
1094
-
1095
-	if (of_pci_dma_range_parser_init(&parser, np))
1096
-		return -EINVAL;
1097
-
1098
-	/* Get the dma-ranges from DT */
1099
-	for_each_of_pci_range(&parser, &range) {
1100
-		u64 end = range.cpu_addr + range.size - 1;
1101
-
1102
-		dev_dbg(pcie->dev, "0x%08x 0x%016llx..0x%016llx -> 0x%016llx\n",
1103
-			range.flags, range.cpu_addr, end, range.pci_addr);
1104
-
1105
-		err = rcar_pcie_inbound_ranges(pcie, &range, &index);
1106
-		if (err)
1107
-			return err;
1108
-	}
1109
-
1110
-	return 0;
1111
-}
1112
-
1113
-static const struct of_device_id rcar_pcie_of_match[] = {
1114
-	{ .compatible = "renesas,pcie-r8a7779",
1115
-	  .data = rcar_pcie_phy_init_h1 },
1116
-	{ .compatible = "renesas,pcie-r8a7790",
1117
-	  .data = rcar_pcie_phy_init_gen2 },
1118
-	{ .compatible = "renesas,pcie-r8a7791",
1119
-	  .data = rcar_pcie_phy_init_gen2 },
1120
-	{ .compatible = "renesas,pcie-rcar-gen2",
1121
-	  .data = rcar_pcie_phy_init_gen2 },
1122
-	{ .compatible = "renesas,pcie-r8a7795",
1123
-	  .data = rcar_pcie_phy_init_gen3 },
1124
-	{ .compatible = "renesas,pcie-rcar-gen3",
1125
-	  .data = rcar_pcie_phy_init_gen3 },
1126
-	{},
1127
-};
1128
-
1129
-static int rcar_pcie_probe(struct platform_device *pdev)
1130
-{
1131
-	struct device *dev = &pdev->dev;
1132
-	struct rcar_pcie *pcie;
1133
-	unsigned int data;
1134
-	int err;
1135
-	int (*phy_init_fn)(struct rcar_pcie *);
1136
-	struct pci_host_bridge *bridge;
1137
-
1138
-	bridge = pci_alloc_host_bridge(sizeof(*pcie));
1139
-	if (!bridge)
1140
-		return -ENOMEM;
1141
-
1142
-	pcie = pci_host_bridge_priv(bridge);
1143
-
1144
-	pcie->dev = dev;
1145
-	platform_set_drvdata(pdev, pcie);
1146
-
1147
-	err = pci_parse_request_of_pci_ranges(dev, &pcie->resources, NULL);
1148
-	if (err)
1149
-		goto err_free_bridge;
1150
-
1151
-	pm_runtime_enable(pcie->dev);
1152
-	err = pm_runtime_get_sync(pcie->dev);
1153
-	if (err < 0) {
1154
-		dev_err(pcie->dev, "pm_runtime_get_sync failed\n");
1155
-		goto err_pm_disable;
1156
-	}
1157
-
1158
-	err = rcar_pcie_get_resources(pcie);
1159
-	if (err < 0) {
1160
-		dev_err(dev, "failed to request resources: %d\n", err);
1161
-		goto err_pm_put;
1162
-	}
1163
-
1164
-	err = clk_prepare_enable(pcie->bus_clk);
1165
-	if (err) {
1166
-		dev_err(dev, "failed to enable bus clock: %d\n", err);
1167
-		goto err_unmap_msi_irqs;
1168
-	}
1169
-
1170
-	err = rcar_pcie_parse_map_dma_ranges(pcie, dev->of_node);
1171
-	if (err)
1172
-		goto err_clk_disable;
1173
-
1174
-	phy_init_fn = of_device_get_match_data(dev);
1175
-	err = phy_init_fn(pcie);
1176
-	if (err) {
1177
-		dev_err(dev, "failed to init PCIe PHY\n");
1178
-		goto err_clk_disable;
1179
-	}
1180
-
1181
-	/* Failure to get a link might just be that no cards are inserted */
1182
-	if (rcar_pcie_hw_init(pcie)) {
1183
-		dev_info(dev, "PCIe link down\n");
1184
-		err = -ENODEV;
1185
-		goto err_phy_shutdown;
1186
-	}
1187
-
1188
-	data = rcar_pci_read_reg(pcie, MACSR);
1189
-	dev_info(dev, "PCIe x%d: link up\n", (data >> 20) & 0x3f);
1190
-
1191
-	if (IS_ENABLED(CONFIG_PCI_MSI)) {
1192
-		err = rcar_pcie_enable_msi(pcie);
1193
-		if (err < 0) {
1194
-			dev_err(dev,
1195
-				"failed to enable MSI support: %d\n",
1196
-				err);
1197
-			goto err_phy_shutdown;
1198
-		}
1199
-	}
1200
-
1201
-	err = rcar_pcie_enable(pcie);
1202
-	if (err)
1203
-		goto err_msi_teardown;
1204
-
1205
-	return 0;
1206
-
1207
-err_msi_teardown:
1208
-	if (IS_ENABLED(CONFIG_PCI_MSI))
1209
-		rcar_pcie_teardown_msi(pcie);
1210
-
1211
-err_phy_shutdown:
1212
-	if (pcie->phy) {
1213
-		phy_power_off(pcie->phy);
1214
-		phy_exit(pcie->phy);
1215
-	}
1216
-
1217
-err_clk_disable:
1218
-	clk_disable_unprepare(pcie->bus_clk);
1219
-
1220
-err_unmap_msi_irqs:
1221
-	irq_dispose_mapping(pcie->msi.irq2);
1222
-	irq_dispose_mapping(pcie->msi.irq1);
1223
-
1224
-err_pm_put:
1225
-	pm_runtime_put(dev);
1226
-
1227
-err_pm_disable:
1228
-	pm_runtime_disable(dev);
1229
-	pci_free_resource_list(&pcie->resources);
1230
-
1231
-err_free_bridge:
1232
-	pci_free_host_bridge(bridge);
1233
-
1234
-	return err;
1235
-}
1236
-
1237
-static int rcar_pcie_resume_noirq(struct device *dev)
1238
-{
1239
-	struct rcar_pcie *pcie = dev_get_drvdata(dev);
1240
-
1241
-	if (rcar_pci_read_reg(pcie, PMSR) &&
1242
-	    !(rcar_pci_read_reg(pcie, PCIETCTLR) & DL_DOWN))
1243
-		return 0;
1244
-
1245
-	/* Re-establish the PCIe link */
1246
-	rcar_pci_write_reg(pcie, MACCTLR_INIT_VAL, MACCTLR);
1247
-	rcar_pci_write_reg(pcie, CFINIT, PCIETCTLR);
1248
-	return rcar_pcie_wait_for_dl(pcie);
1249
-}
1250
-
1251
-static const struct dev_pm_ops rcar_pcie_pm_ops = {
1252
-	.resume_noirq = rcar_pcie_resume_noirq,
1253
-};
1254
-
1255
-static struct platform_driver rcar_pcie_driver = {
1256
-	.driver = {
1257
-		.name = "rcar-pcie",
1258
-		.of_match_table = rcar_pcie_of_match,
1259
-		.pm = &rcar_pcie_pm_ops,
1260
-		.suppress_bind_attrs = true,
1261
-	},
1262
-	.probe = rcar_pcie_probe,
1263
-};
1264
-builtin_platform_driver(rcar_pcie_driver);