xref: /OK3568_Linux_fs/kernel/arch/mips/pci/pci-ar724x.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  *  Atheros AR724X PCI host controller driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  *  Copyright (C) 2011 René Bolldorf <xsecute@googlemail.com>
6*4882a593Smuzhiyun  *  Copyright (C) 2009-2011 Gabor Juhos <juhosg@openwrt.org>
7*4882a593Smuzhiyun  */
8*4882a593Smuzhiyun 
9*4882a593Smuzhiyun #include <linux/irq.h>
10*4882a593Smuzhiyun #include <linux/pci.h>
11*4882a593Smuzhiyun #include <linux/init.h>
12*4882a593Smuzhiyun #include <linux/delay.h>
13*4882a593Smuzhiyun #include <linux/platform_device.h>
14*4882a593Smuzhiyun #include <asm/mach-ath79/ath79.h>
15*4882a593Smuzhiyun #include <asm/mach-ath79/ar71xx_regs.h>
16*4882a593Smuzhiyun 
17*4882a593Smuzhiyun #define AR724X_PCI_REG_APP		0x00
18*4882a593Smuzhiyun #define AR724X_PCI_REG_RESET		0x18
19*4882a593Smuzhiyun #define AR724X_PCI_REG_INT_STATUS	0x4c
20*4882a593Smuzhiyun #define AR724X_PCI_REG_INT_MASK		0x50
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun #define AR724X_PCI_APP_LTSSM_ENABLE	BIT(0)
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun #define AR724X_PCI_RESET_LINK_UP	BIT(0)
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun #define AR724X_PCI_INT_DEV0		BIT(14)
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun #define AR724X_PCI_IRQ_COUNT		1
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun #define AR7240_BAR0_WAR_VALUE	0xffff
31*4882a593Smuzhiyun 
32*4882a593Smuzhiyun #define AR724X_PCI_CMD_INIT	(PCI_COMMAND_MEMORY |		\
33*4882a593Smuzhiyun 				 PCI_COMMAND_MASTER |		\
34*4882a593Smuzhiyun 				 PCI_COMMAND_INVALIDATE |	\
35*4882a593Smuzhiyun 				 PCI_COMMAND_PARITY |		\
36*4882a593Smuzhiyun 				 PCI_COMMAND_SERR |		\
37*4882a593Smuzhiyun 				 PCI_COMMAND_FAST_BACK)
38*4882a593Smuzhiyun 
39*4882a593Smuzhiyun struct ar724x_pci_controller {
40*4882a593Smuzhiyun 	void __iomem *devcfg_base;
41*4882a593Smuzhiyun 	void __iomem *ctrl_base;
42*4882a593Smuzhiyun 	void __iomem *crp_base;
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun 	int irq;
45*4882a593Smuzhiyun 	int irq_base;
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun 	bool link_up;
48*4882a593Smuzhiyun 	bool bar0_is_cached;
49*4882a593Smuzhiyun 	u32  bar0_value;
50*4882a593Smuzhiyun 
51*4882a593Smuzhiyun 	struct pci_controller pci_controller;
52*4882a593Smuzhiyun 	struct resource io_res;
53*4882a593Smuzhiyun 	struct resource mem_res;
54*4882a593Smuzhiyun };
55*4882a593Smuzhiyun 
ar724x_pci_check_link(struct ar724x_pci_controller * apc)56*4882a593Smuzhiyun static inline bool ar724x_pci_check_link(struct ar724x_pci_controller *apc)
57*4882a593Smuzhiyun {
58*4882a593Smuzhiyun 	u32 reset;
59*4882a593Smuzhiyun 
60*4882a593Smuzhiyun 	reset = __raw_readl(apc->ctrl_base + AR724X_PCI_REG_RESET);
61*4882a593Smuzhiyun 	return reset & AR724X_PCI_RESET_LINK_UP;
62*4882a593Smuzhiyun }
63*4882a593Smuzhiyun 
64*4882a593Smuzhiyun static inline struct ar724x_pci_controller *
pci_bus_to_ar724x_controller(struct pci_bus * bus)65*4882a593Smuzhiyun pci_bus_to_ar724x_controller(struct pci_bus *bus)
66*4882a593Smuzhiyun {
67*4882a593Smuzhiyun 	struct pci_controller *hose;
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun 	hose = (struct pci_controller *) bus->sysdata;
70*4882a593Smuzhiyun 	return container_of(hose, struct ar724x_pci_controller, pci_controller);
71*4882a593Smuzhiyun }
72*4882a593Smuzhiyun 
ar724x_pci_local_write(struct ar724x_pci_controller * apc,int where,int size,u32 value)73*4882a593Smuzhiyun static int ar724x_pci_local_write(struct ar724x_pci_controller *apc,
74*4882a593Smuzhiyun 				  int where, int size, u32 value)
75*4882a593Smuzhiyun {
76*4882a593Smuzhiyun 	void __iomem *base;
77*4882a593Smuzhiyun 	u32 data;
78*4882a593Smuzhiyun 	int s;
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun 	WARN_ON(where & (size - 1));
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun 	if (!apc->link_up)
83*4882a593Smuzhiyun 		return PCIBIOS_DEVICE_NOT_FOUND;
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun 	base = apc->crp_base;
86*4882a593Smuzhiyun 	data = __raw_readl(base + (where & ~3));
87*4882a593Smuzhiyun 
88*4882a593Smuzhiyun 	switch (size) {
89*4882a593Smuzhiyun 	case 1:
90*4882a593Smuzhiyun 		s = ((where & 3) * 8);
91*4882a593Smuzhiyun 		data &= ~(0xff << s);
92*4882a593Smuzhiyun 		data |= ((value & 0xff) << s);
93*4882a593Smuzhiyun 		break;
94*4882a593Smuzhiyun 	case 2:
95*4882a593Smuzhiyun 		s = ((where & 2) * 8);
96*4882a593Smuzhiyun 		data &= ~(0xffff << s);
97*4882a593Smuzhiyun 		data |= ((value & 0xffff) << s);
98*4882a593Smuzhiyun 		break;
99*4882a593Smuzhiyun 	case 4:
100*4882a593Smuzhiyun 		data = value;
101*4882a593Smuzhiyun 		break;
102*4882a593Smuzhiyun 	default:
103*4882a593Smuzhiyun 		return PCIBIOS_BAD_REGISTER_NUMBER;
104*4882a593Smuzhiyun 	}
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun 	__raw_writel(data, base + (where & ~3));
107*4882a593Smuzhiyun 	/* flush write */
108*4882a593Smuzhiyun 	__raw_readl(base + (where & ~3));
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun 	return PCIBIOS_SUCCESSFUL;
111*4882a593Smuzhiyun }
112*4882a593Smuzhiyun 
ar724x_pci_read(struct pci_bus * bus,unsigned int devfn,int where,int size,uint32_t * value)113*4882a593Smuzhiyun static int ar724x_pci_read(struct pci_bus *bus, unsigned int devfn, int where,
114*4882a593Smuzhiyun 			    int size, uint32_t *value)
115*4882a593Smuzhiyun {
116*4882a593Smuzhiyun 	struct ar724x_pci_controller *apc;
117*4882a593Smuzhiyun 	void __iomem *base;
118*4882a593Smuzhiyun 	u32 data;
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun 	apc = pci_bus_to_ar724x_controller(bus);
121*4882a593Smuzhiyun 	if (!apc->link_up)
122*4882a593Smuzhiyun 		return PCIBIOS_DEVICE_NOT_FOUND;
123*4882a593Smuzhiyun 
124*4882a593Smuzhiyun 	if (devfn)
125*4882a593Smuzhiyun 		return PCIBIOS_DEVICE_NOT_FOUND;
126*4882a593Smuzhiyun 
127*4882a593Smuzhiyun 	base = apc->devcfg_base;
128*4882a593Smuzhiyun 	data = __raw_readl(base + (where & ~3));
129*4882a593Smuzhiyun 
130*4882a593Smuzhiyun 	switch (size) {
131*4882a593Smuzhiyun 	case 1:
132*4882a593Smuzhiyun 		if (where & 1)
133*4882a593Smuzhiyun 			data >>= 8;
134*4882a593Smuzhiyun 		if (where & 2)
135*4882a593Smuzhiyun 			data >>= 16;
136*4882a593Smuzhiyun 		data &= 0xff;
137*4882a593Smuzhiyun 		break;
138*4882a593Smuzhiyun 	case 2:
139*4882a593Smuzhiyun 		if (where & 2)
140*4882a593Smuzhiyun 			data >>= 16;
141*4882a593Smuzhiyun 		data &= 0xffff;
142*4882a593Smuzhiyun 		break;
143*4882a593Smuzhiyun 	case 4:
144*4882a593Smuzhiyun 		break;
145*4882a593Smuzhiyun 	default:
146*4882a593Smuzhiyun 		return PCIBIOS_BAD_REGISTER_NUMBER;
147*4882a593Smuzhiyun 	}
148*4882a593Smuzhiyun 
149*4882a593Smuzhiyun 	if (where == PCI_BASE_ADDRESS_0 && size == 4 &&
150*4882a593Smuzhiyun 	    apc->bar0_is_cached) {
151*4882a593Smuzhiyun 		/* use the cached value */
152*4882a593Smuzhiyun 		*value = apc->bar0_value;
153*4882a593Smuzhiyun 	} else {
154*4882a593Smuzhiyun 		*value = data;
155*4882a593Smuzhiyun 	}
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun 	return PCIBIOS_SUCCESSFUL;
158*4882a593Smuzhiyun }
159*4882a593Smuzhiyun 
ar724x_pci_write(struct pci_bus * bus,unsigned int devfn,int where,int size,uint32_t value)160*4882a593Smuzhiyun static int ar724x_pci_write(struct pci_bus *bus, unsigned int devfn, int where,
161*4882a593Smuzhiyun 			     int size, uint32_t value)
162*4882a593Smuzhiyun {
163*4882a593Smuzhiyun 	struct ar724x_pci_controller *apc;
164*4882a593Smuzhiyun 	void __iomem *base;
165*4882a593Smuzhiyun 	u32 data;
166*4882a593Smuzhiyun 	int s;
167*4882a593Smuzhiyun 
168*4882a593Smuzhiyun 	apc = pci_bus_to_ar724x_controller(bus);
169*4882a593Smuzhiyun 	if (!apc->link_up)
170*4882a593Smuzhiyun 		return PCIBIOS_DEVICE_NOT_FOUND;
171*4882a593Smuzhiyun 
172*4882a593Smuzhiyun 	if (devfn)
173*4882a593Smuzhiyun 		return PCIBIOS_DEVICE_NOT_FOUND;
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun 	if (soc_is_ar7240() && where == PCI_BASE_ADDRESS_0 && size == 4) {
176*4882a593Smuzhiyun 		if (value != 0xffffffff) {
177*4882a593Smuzhiyun 			/*
178*4882a593Smuzhiyun 			 * WAR for a hw issue. If the BAR0 register of the
179*4882a593Smuzhiyun 			 * device is set to the proper base address, the
180*4882a593Smuzhiyun 			 * memory space of the device is not accessible.
181*4882a593Smuzhiyun 			 *
182*4882a593Smuzhiyun 			 * Cache the intended value so it can be read back,
183*4882a593Smuzhiyun 			 * and write a SoC specific constant value to the
184*4882a593Smuzhiyun 			 * BAR0 register in order to make the device memory
185*4882a593Smuzhiyun 			 * accessible.
186*4882a593Smuzhiyun 			 */
187*4882a593Smuzhiyun 			apc->bar0_is_cached = true;
188*4882a593Smuzhiyun 			apc->bar0_value = value;
189*4882a593Smuzhiyun 
190*4882a593Smuzhiyun 			value = AR7240_BAR0_WAR_VALUE;
191*4882a593Smuzhiyun 		} else {
192*4882a593Smuzhiyun 			apc->bar0_is_cached = false;
193*4882a593Smuzhiyun 		}
194*4882a593Smuzhiyun 	}
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun 	base = apc->devcfg_base;
197*4882a593Smuzhiyun 	data = __raw_readl(base + (where & ~3));
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun 	switch (size) {
200*4882a593Smuzhiyun 	case 1:
201*4882a593Smuzhiyun 		s = ((where & 3) * 8);
202*4882a593Smuzhiyun 		data &= ~(0xff << s);
203*4882a593Smuzhiyun 		data |= ((value & 0xff) << s);
204*4882a593Smuzhiyun 		break;
205*4882a593Smuzhiyun 	case 2:
206*4882a593Smuzhiyun 		s = ((where & 2) * 8);
207*4882a593Smuzhiyun 		data &= ~(0xffff << s);
208*4882a593Smuzhiyun 		data |= ((value & 0xffff) << s);
209*4882a593Smuzhiyun 		break;
210*4882a593Smuzhiyun 	case 4:
211*4882a593Smuzhiyun 		data = value;
212*4882a593Smuzhiyun 		break;
213*4882a593Smuzhiyun 	default:
214*4882a593Smuzhiyun 		return PCIBIOS_BAD_REGISTER_NUMBER;
215*4882a593Smuzhiyun 	}
216*4882a593Smuzhiyun 
217*4882a593Smuzhiyun 	__raw_writel(data, base + (where & ~3));
218*4882a593Smuzhiyun 	/* flush write */
219*4882a593Smuzhiyun 	__raw_readl(base + (where & ~3));
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun 	return PCIBIOS_SUCCESSFUL;
222*4882a593Smuzhiyun }
223*4882a593Smuzhiyun 
224*4882a593Smuzhiyun static struct pci_ops ar724x_pci_ops = {
225*4882a593Smuzhiyun 	.read	= ar724x_pci_read,
226*4882a593Smuzhiyun 	.write	= ar724x_pci_write,
227*4882a593Smuzhiyun };
228*4882a593Smuzhiyun 
ar724x_pci_irq_handler(struct irq_desc * desc)229*4882a593Smuzhiyun static void ar724x_pci_irq_handler(struct irq_desc *desc)
230*4882a593Smuzhiyun {
231*4882a593Smuzhiyun 	struct ar724x_pci_controller *apc;
232*4882a593Smuzhiyun 	void __iomem *base;
233*4882a593Smuzhiyun 	u32 pending;
234*4882a593Smuzhiyun 
235*4882a593Smuzhiyun 	apc = irq_desc_get_handler_data(desc);
236*4882a593Smuzhiyun 	base = apc->ctrl_base;
237*4882a593Smuzhiyun 
238*4882a593Smuzhiyun 	pending = __raw_readl(base + AR724X_PCI_REG_INT_STATUS) &
239*4882a593Smuzhiyun 		  __raw_readl(base + AR724X_PCI_REG_INT_MASK);
240*4882a593Smuzhiyun 
241*4882a593Smuzhiyun 	if (pending & AR724X_PCI_INT_DEV0)
242*4882a593Smuzhiyun 		generic_handle_irq(apc->irq_base + 0);
243*4882a593Smuzhiyun 
244*4882a593Smuzhiyun 	else
245*4882a593Smuzhiyun 		spurious_interrupt();
246*4882a593Smuzhiyun }
247*4882a593Smuzhiyun 
ar724x_pci_irq_unmask(struct irq_data * d)248*4882a593Smuzhiyun static void ar724x_pci_irq_unmask(struct irq_data *d)
249*4882a593Smuzhiyun {
250*4882a593Smuzhiyun 	struct ar724x_pci_controller *apc;
251*4882a593Smuzhiyun 	void __iomem *base;
252*4882a593Smuzhiyun 	int offset;
253*4882a593Smuzhiyun 	u32 t;
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun 	apc = irq_data_get_irq_chip_data(d);
256*4882a593Smuzhiyun 	base = apc->ctrl_base;
257*4882a593Smuzhiyun 	offset = apc->irq_base - d->irq;
258*4882a593Smuzhiyun 
259*4882a593Smuzhiyun 	switch (offset) {
260*4882a593Smuzhiyun 	case 0:
261*4882a593Smuzhiyun 		t = __raw_readl(base + AR724X_PCI_REG_INT_MASK);
262*4882a593Smuzhiyun 		__raw_writel(t | AR724X_PCI_INT_DEV0,
263*4882a593Smuzhiyun 			     base + AR724X_PCI_REG_INT_MASK);
264*4882a593Smuzhiyun 		/* flush write */
265*4882a593Smuzhiyun 		__raw_readl(base + AR724X_PCI_REG_INT_MASK);
266*4882a593Smuzhiyun 	}
267*4882a593Smuzhiyun }
268*4882a593Smuzhiyun 
ar724x_pci_irq_mask(struct irq_data * d)269*4882a593Smuzhiyun static void ar724x_pci_irq_mask(struct irq_data *d)
270*4882a593Smuzhiyun {
271*4882a593Smuzhiyun 	struct ar724x_pci_controller *apc;
272*4882a593Smuzhiyun 	void __iomem *base;
273*4882a593Smuzhiyun 	int offset;
274*4882a593Smuzhiyun 	u32 t;
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 	apc = irq_data_get_irq_chip_data(d);
277*4882a593Smuzhiyun 	base = apc->ctrl_base;
278*4882a593Smuzhiyun 	offset = apc->irq_base - d->irq;
279*4882a593Smuzhiyun 
280*4882a593Smuzhiyun 	switch (offset) {
281*4882a593Smuzhiyun 	case 0:
282*4882a593Smuzhiyun 		t = __raw_readl(base + AR724X_PCI_REG_INT_MASK);
283*4882a593Smuzhiyun 		__raw_writel(t & ~AR724X_PCI_INT_DEV0,
284*4882a593Smuzhiyun 			     base + AR724X_PCI_REG_INT_MASK);
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 		/* flush write */
287*4882a593Smuzhiyun 		__raw_readl(base + AR724X_PCI_REG_INT_MASK);
288*4882a593Smuzhiyun 
289*4882a593Smuzhiyun 		t = __raw_readl(base + AR724X_PCI_REG_INT_STATUS);
290*4882a593Smuzhiyun 		__raw_writel(t | AR724X_PCI_INT_DEV0,
291*4882a593Smuzhiyun 			     base + AR724X_PCI_REG_INT_STATUS);
292*4882a593Smuzhiyun 
293*4882a593Smuzhiyun 		/* flush write */
294*4882a593Smuzhiyun 		__raw_readl(base + AR724X_PCI_REG_INT_STATUS);
295*4882a593Smuzhiyun 	}
296*4882a593Smuzhiyun }
297*4882a593Smuzhiyun 
298*4882a593Smuzhiyun static struct irq_chip ar724x_pci_irq_chip = {
299*4882a593Smuzhiyun 	.name		= "AR724X PCI ",
300*4882a593Smuzhiyun 	.irq_mask	= ar724x_pci_irq_mask,
301*4882a593Smuzhiyun 	.irq_unmask	= ar724x_pci_irq_unmask,
302*4882a593Smuzhiyun 	.irq_mask_ack	= ar724x_pci_irq_mask,
303*4882a593Smuzhiyun };
304*4882a593Smuzhiyun 
ar724x_pci_irq_init(struct ar724x_pci_controller * apc,int id)305*4882a593Smuzhiyun static void ar724x_pci_irq_init(struct ar724x_pci_controller *apc,
306*4882a593Smuzhiyun 				int id)
307*4882a593Smuzhiyun {
308*4882a593Smuzhiyun 	void __iomem *base;
309*4882a593Smuzhiyun 	int i;
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun 	base = apc->ctrl_base;
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 	__raw_writel(0, base + AR724X_PCI_REG_INT_MASK);
314*4882a593Smuzhiyun 	__raw_writel(0, base + AR724X_PCI_REG_INT_STATUS);
315*4882a593Smuzhiyun 
316*4882a593Smuzhiyun 	apc->irq_base = ATH79_PCI_IRQ_BASE + (id * AR724X_PCI_IRQ_COUNT);
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun 	for (i = apc->irq_base;
319*4882a593Smuzhiyun 	     i < apc->irq_base + AR724X_PCI_IRQ_COUNT; i++) {
320*4882a593Smuzhiyun 		irq_set_chip_and_handler(i, &ar724x_pci_irq_chip,
321*4882a593Smuzhiyun 					 handle_level_irq);
322*4882a593Smuzhiyun 		irq_set_chip_data(i, apc);
323*4882a593Smuzhiyun 	}
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 	irq_set_chained_handler_and_data(apc->irq, ar724x_pci_irq_handler,
326*4882a593Smuzhiyun 					 apc);
327*4882a593Smuzhiyun }
328*4882a593Smuzhiyun 
ar724x_pci_hw_init(struct ar724x_pci_controller * apc)329*4882a593Smuzhiyun static void ar724x_pci_hw_init(struct ar724x_pci_controller *apc)
330*4882a593Smuzhiyun {
331*4882a593Smuzhiyun 	u32 ppl, app;
332*4882a593Smuzhiyun 	int wait = 0;
333*4882a593Smuzhiyun 
334*4882a593Smuzhiyun 	/* deassert PCIe host controller and PCIe PHY reset */
335*4882a593Smuzhiyun 	ath79_device_reset_clear(AR724X_RESET_PCIE);
336*4882a593Smuzhiyun 	ath79_device_reset_clear(AR724X_RESET_PCIE_PHY);
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	/* remove the reset of the PCIE PLL */
339*4882a593Smuzhiyun 	ppl = ath79_pll_rr(AR724X_PLL_REG_PCIE_CONFIG);
340*4882a593Smuzhiyun 	ppl &= ~AR724X_PLL_REG_PCIE_CONFIG_PPL_RESET;
341*4882a593Smuzhiyun 	ath79_pll_wr(AR724X_PLL_REG_PCIE_CONFIG, ppl);
342*4882a593Smuzhiyun 
343*4882a593Smuzhiyun 	/* deassert bypass for the PCIE PLL */
344*4882a593Smuzhiyun 	ppl = ath79_pll_rr(AR724X_PLL_REG_PCIE_CONFIG);
345*4882a593Smuzhiyun 	ppl &= ~AR724X_PLL_REG_PCIE_CONFIG_PPL_BYPASS;
346*4882a593Smuzhiyun 	ath79_pll_wr(AR724X_PLL_REG_PCIE_CONFIG, ppl);
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun 	/* set PCIE Application Control to ready */
349*4882a593Smuzhiyun 	app = __raw_readl(apc->ctrl_base + AR724X_PCI_REG_APP);
350*4882a593Smuzhiyun 	app |= AR724X_PCI_APP_LTSSM_ENABLE;
351*4882a593Smuzhiyun 	__raw_writel(app, apc->ctrl_base + AR724X_PCI_REG_APP);
352*4882a593Smuzhiyun 
353*4882a593Smuzhiyun 	/* wait up to 100ms for PHY link up */
354*4882a593Smuzhiyun 	do {
355*4882a593Smuzhiyun 		mdelay(10);
356*4882a593Smuzhiyun 		wait++;
357*4882a593Smuzhiyun 	} while (wait < 10 && !ar724x_pci_check_link(apc));
358*4882a593Smuzhiyun }
359*4882a593Smuzhiyun 
ar724x_pci_probe(struct platform_device * pdev)360*4882a593Smuzhiyun static int ar724x_pci_probe(struct platform_device *pdev)
361*4882a593Smuzhiyun {
362*4882a593Smuzhiyun 	struct ar724x_pci_controller *apc;
363*4882a593Smuzhiyun 	struct resource *res;
364*4882a593Smuzhiyun 	int id;
365*4882a593Smuzhiyun 
366*4882a593Smuzhiyun 	id = pdev->id;
367*4882a593Smuzhiyun 	if (id == -1)
368*4882a593Smuzhiyun 		id = 0;
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun 	apc = devm_kzalloc(&pdev->dev, sizeof(struct ar724x_pci_controller),
371*4882a593Smuzhiyun 			    GFP_KERNEL);
372*4882a593Smuzhiyun 	if (!apc)
373*4882a593Smuzhiyun 		return -ENOMEM;
374*4882a593Smuzhiyun 
375*4882a593Smuzhiyun 	apc->ctrl_base = devm_platform_ioremap_resource_byname(pdev, "ctrl_base");
376*4882a593Smuzhiyun 	if (IS_ERR(apc->ctrl_base))
377*4882a593Smuzhiyun 		return PTR_ERR(apc->ctrl_base);
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun 	apc->devcfg_base = devm_platform_ioremap_resource_byname(pdev, "cfg_base");
380*4882a593Smuzhiyun 	if (IS_ERR(apc->devcfg_base))
381*4882a593Smuzhiyun 		return PTR_ERR(apc->devcfg_base);
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun 	apc->crp_base = devm_platform_ioremap_resource_byname(pdev, "crp_base");
384*4882a593Smuzhiyun 	if (IS_ERR(apc->crp_base))
385*4882a593Smuzhiyun 		return PTR_ERR(apc->crp_base);
386*4882a593Smuzhiyun 
387*4882a593Smuzhiyun 	apc->irq = platform_get_irq(pdev, 0);
388*4882a593Smuzhiyun 	if (apc->irq < 0)
389*4882a593Smuzhiyun 		return -EINVAL;
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun 	res = platform_get_resource_byname(pdev, IORESOURCE_IO, "io_base");
392*4882a593Smuzhiyun 	if (!res)
393*4882a593Smuzhiyun 		return -EINVAL;
394*4882a593Smuzhiyun 
395*4882a593Smuzhiyun 	apc->io_res.parent = res;
396*4882a593Smuzhiyun 	apc->io_res.name = "PCI IO space";
397*4882a593Smuzhiyun 	apc->io_res.start = res->start;
398*4882a593Smuzhiyun 	apc->io_res.end = res->end;
399*4882a593Smuzhiyun 	apc->io_res.flags = IORESOURCE_IO;
400*4882a593Smuzhiyun 
401*4882a593Smuzhiyun 	res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mem_base");
402*4882a593Smuzhiyun 	if (!res)
403*4882a593Smuzhiyun 		return -EINVAL;
404*4882a593Smuzhiyun 
405*4882a593Smuzhiyun 	apc->mem_res.parent = res;
406*4882a593Smuzhiyun 	apc->mem_res.name = "PCI memory space";
407*4882a593Smuzhiyun 	apc->mem_res.start = res->start;
408*4882a593Smuzhiyun 	apc->mem_res.end = res->end;
409*4882a593Smuzhiyun 	apc->mem_res.flags = IORESOURCE_MEM;
410*4882a593Smuzhiyun 
411*4882a593Smuzhiyun 	apc->pci_controller.pci_ops = &ar724x_pci_ops;
412*4882a593Smuzhiyun 	apc->pci_controller.io_resource = &apc->io_res;
413*4882a593Smuzhiyun 	apc->pci_controller.mem_resource = &apc->mem_res;
414*4882a593Smuzhiyun 
415*4882a593Smuzhiyun 	/*
416*4882a593Smuzhiyun 	 * Do the full PCIE Root Complex Initialization Sequence if the PCIe
417*4882a593Smuzhiyun 	 * host controller is in reset.
418*4882a593Smuzhiyun 	 */
419*4882a593Smuzhiyun 	if (ath79_reset_rr(AR724X_RESET_REG_RESET_MODULE) & AR724X_RESET_PCIE)
420*4882a593Smuzhiyun 		ar724x_pci_hw_init(apc);
421*4882a593Smuzhiyun 
422*4882a593Smuzhiyun 	apc->link_up = ar724x_pci_check_link(apc);
423*4882a593Smuzhiyun 	if (!apc->link_up)
424*4882a593Smuzhiyun 		dev_warn(&pdev->dev, "PCIe link is down\n");
425*4882a593Smuzhiyun 
426*4882a593Smuzhiyun 	ar724x_pci_irq_init(apc, id);
427*4882a593Smuzhiyun 
428*4882a593Smuzhiyun 	ar724x_pci_local_write(apc, PCI_COMMAND, 4, AR724X_PCI_CMD_INIT);
429*4882a593Smuzhiyun 
430*4882a593Smuzhiyun 	register_pci_controller(&apc->pci_controller);
431*4882a593Smuzhiyun 
432*4882a593Smuzhiyun 	return 0;
433*4882a593Smuzhiyun }
434*4882a593Smuzhiyun 
435*4882a593Smuzhiyun static struct platform_driver ar724x_pci_driver = {
436*4882a593Smuzhiyun 	.probe = ar724x_pci_probe,
437*4882a593Smuzhiyun 	.driver = {
438*4882a593Smuzhiyun 		.name = "ar724x-pci",
439*4882a593Smuzhiyun 	},
440*4882a593Smuzhiyun };
441*4882a593Smuzhiyun 
ar724x_pci_init(void)442*4882a593Smuzhiyun static int __init ar724x_pci_init(void)
443*4882a593Smuzhiyun {
444*4882a593Smuzhiyun 	return platform_driver_register(&ar724x_pci_driver);
445*4882a593Smuzhiyun }
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun postcore_initcall(ar724x_pci_init);
448