Linux Audio

Check our new training course

Loading...
Note: File does not exist in v3.1.
  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * Copyright (C) 2015, 2016 Cavium, Inc.
  4 */
  5
  6#include <linux/kernel.h>
  7#include <linux/init.h>
  8#include <linux/ioport.h>
  9#include <linux/of_pci.h>
 10#include <linux/of.h>
 11#include <linux/pci-ecam.h>
 12#include <linux/platform_device.h>
 13
 14#if defined(CONFIG_PCI_HOST_THUNDER_ECAM) || (defined(CONFIG_ACPI) && defined(CONFIG_PCI_QUIRKS))
 15
 16static void set_val(u32 v, int where, int size, u32 *val)
 17{
 18	int shift = (where & 3) * 8;
 19
 20	pr_debug("set_val %04x: %08x\n", (unsigned)(where & ~3), v);
 21	v >>= shift;
 22	if (size == 1)
 23		v &= 0xff;
 24	else if (size == 2)
 25		v &= 0xffff;
 26	*val = v;
 27}
 28
 29static int handle_ea_bar(u32 e0, int bar, struct pci_bus *bus,
 30			 unsigned int devfn, int where, int size, u32 *val)
 31{
 32	void __iomem *addr;
 33	u32 v;
 34
 35	/* Entries are 16-byte aligned; bits[2,3] select word in entry */
 36	int where_a = where & 0xc;
 37
 38	if (where_a == 0) {
 39		set_val(e0, where, size, val);
 40		return PCIBIOS_SUCCESSFUL;
 41	}
 42	if (where_a == 0x4) {
 43		addr = bus->ops->map_bus(bus, devfn, bar); /* BAR 0 */
 44		if (!addr) {
 45			*val = ~0;
 46			return PCIBIOS_DEVICE_NOT_FOUND;
 47		}
 48		v = readl(addr);
 49		v &= ~0xf;
 50		v |= 2; /* EA entry-1. Base-L */
 51		set_val(v, where, size, val);
 52		return PCIBIOS_SUCCESSFUL;
 53	}
 54	if (where_a == 0x8) {
 55		u32 barl_orig;
 56		u32 barl_rb;
 57
 58		addr = bus->ops->map_bus(bus, devfn, bar); /* BAR 0 */
 59		if (!addr) {
 60			*val = ~0;
 61			return PCIBIOS_DEVICE_NOT_FOUND;
 62		}
 63		barl_orig = readl(addr + 0);
 64		writel(0xffffffff, addr + 0);
 65		barl_rb = readl(addr + 0);
 66		writel(barl_orig, addr + 0);
 67		/* zeros in unsettable bits */
 68		v = ~barl_rb & ~3;
 69		v |= 0xc; /* EA entry-2. Offset-L */
 70		set_val(v, where, size, val);
 71		return PCIBIOS_SUCCESSFUL;
 72	}
 73	if (where_a == 0xc) {
 74		addr = bus->ops->map_bus(bus, devfn, bar + 4); /* BAR 1 */
 75		if (!addr) {
 76			*val = ~0;
 77			return PCIBIOS_DEVICE_NOT_FOUND;
 78		}
 79		v = readl(addr); /* EA entry-3. Base-H */
 80		set_val(v, where, size, val);
 81		return PCIBIOS_SUCCESSFUL;
 82	}
 83	return PCIBIOS_DEVICE_NOT_FOUND;
 84}
 85
 86static int thunder_ecam_p2_config_read(struct pci_bus *bus, unsigned int devfn,
 87				       int where, int size, u32 *val)
 88{
 89	struct pci_config_window *cfg = bus->sysdata;
 90	int where_a = where & ~3;
 91	void __iomem *addr;
 92	u32 node_bits;
 93	u32 v;
 94
 95	/* EA Base[63:32] may be missing some bits ... */
 96	switch (where_a) {
 97	case 0xa8:
 98	case 0xbc:
 99	case 0xd0:
100	case 0xe4:
101		break;
102	default:
103		return pci_generic_config_read(bus, devfn, where, size, val);
104	}
105
106	addr = bus->ops->map_bus(bus, devfn, where_a);
107	if (!addr) {
108		*val = ~0;
109		return PCIBIOS_DEVICE_NOT_FOUND;
110	}
111
112	v = readl(addr);
113
114	/*
115	 * Bit 44 of the 64-bit Base must match the same bit in
116	 * the config space access window.  Since we are working with
117	 * the high-order 32 bits, shift everything down by 32 bits.
118	 */
119	node_bits = (cfg->res.start >> 32) & (1 << 12);
120
121	v |= node_bits;
122	set_val(v, where, size, val);
123
124	return PCIBIOS_SUCCESSFUL;
125}
126
127static int thunder_ecam_config_read(struct pci_bus *bus, unsigned int devfn,
128				    int where, int size, u32 *val)
129{
130	u32 v;
131	u32 vendor_device;
132	u32 class_rev;
133	void __iomem *addr;
134	int cfg_type;
135	int where_a = where & ~3;
136
137	addr = bus->ops->map_bus(bus, devfn, 0xc);
138	if (!addr) {
139		*val = ~0;
140		return PCIBIOS_DEVICE_NOT_FOUND;
141	}
142
143	v = readl(addr);
144
145	/* Check for non type-00 header */
146	cfg_type = (v >> 16) & 0x7f;
147
148	addr = bus->ops->map_bus(bus, devfn, 8);
149	if (!addr) {
150		*val = ~0;
151		return PCIBIOS_DEVICE_NOT_FOUND;
152	}
153
154	class_rev = readl(addr);
155	if (class_rev == 0xffffffff)
156		goto no_emulation;
157
158	if ((class_rev & 0xff) >= 8) {
159		/* Pass-2 handling */
160		if (cfg_type)
161			goto no_emulation;
162		return thunder_ecam_p2_config_read(bus, devfn, where,
163						   size, val);
164	}
165
166	/*
167	 * All BARs have fixed addresses specified by the EA
168	 * capability; they must return zero on read.
169	 */
170	if (cfg_type == 0 &&
171	    ((where >= 0x10 && where < 0x2c) ||
172	     (where >= 0x1a4 && where < 0x1bc))) {
173		/* BAR or SR-IOV BAR */
174		*val = 0;
175		return PCIBIOS_SUCCESSFUL;
176	}
177
178	addr = bus->ops->map_bus(bus, devfn, 0);
179	if (!addr) {
180		*val = ~0;
181		return PCIBIOS_DEVICE_NOT_FOUND;
182	}
183
184	vendor_device = readl(addr);
185	if (vendor_device == 0xffffffff)
186		goto no_emulation;
187
188	pr_debug("%04x:%04x - Fix pass#: %08x, where: %03x, devfn: %03x\n",
189		 vendor_device & 0xffff, vendor_device >> 16, class_rev,
190		 (unsigned) where, devfn);
191
192	/* Check for non type-00 header */
193	if (cfg_type == 0) {
194		bool has_msix;
195		bool is_nic = (vendor_device == 0xa01e177d);
196		bool is_tns = (vendor_device == 0xa01f177d);
197
198		addr = bus->ops->map_bus(bus, devfn, 0x70);
199		if (!addr) {
200			*val = ~0;
201			return PCIBIOS_DEVICE_NOT_FOUND;
202		}
203		/* E_CAP */
204		v = readl(addr);
205		has_msix = (v & 0xff00) != 0;
206
207		if (!has_msix && where_a == 0x70) {
208			v |= 0xbc00; /* next capability is EA at 0xbc */
209			set_val(v, where, size, val);
210			return PCIBIOS_SUCCESSFUL;
211		}
212		if (where_a == 0xb0) {
213			addr = bus->ops->map_bus(bus, devfn, where_a);
214			if (!addr) {
215				*val = ~0;
216				return PCIBIOS_DEVICE_NOT_FOUND;
217			}
218			v = readl(addr);
219			if (v & 0xff00)
220				pr_err("Bad MSIX cap header: %08x\n", v);
221			v |= 0xbc00; /* next capability is EA at 0xbc */
222			set_val(v, where, size, val);
223			return PCIBIOS_SUCCESSFUL;
224		}
225		if (where_a == 0xbc) {
226			if (is_nic)
227				v = 0x40014; /* EA last in chain, 4 entries */
228			else if (is_tns)
229				v = 0x30014; /* EA last in chain, 3 entries */
230			else if (has_msix)
231				v = 0x20014; /* EA last in chain, 2 entries */
232			else
233				v = 0x10014; /* EA last in chain, 1 entry */
234			set_val(v, where, size, val);
235			return PCIBIOS_SUCCESSFUL;
236		}
237		if (where_a >= 0xc0 && where_a < 0xd0)
238			/* EA entry-0. PP=0, BAR0 Size:3 */
239			return handle_ea_bar(0x80ff0003,
240					     0x10, bus, devfn, where,
241					     size, val);
242		if (where_a >= 0xd0 && where_a < 0xe0 && has_msix)
243			 /* EA entry-1. PP=0, BAR4 Size:3 */
244			return handle_ea_bar(0x80ff0043,
245					     0x20, bus, devfn, where,
246					     size, val);
247		if (where_a >= 0xe0 && where_a < 0xf0 && is_tns)
248			/* EA entry-2. PP=0, BAR2, Size:3 */
249			return handle_ea_bar(0x80ff0023,
250					     0x18, bus, devfn, where,
251					     size, val);
252		if (where_a >= 0xe0 && where_a < 0xf0 && is_nic)
253			/* EA entry-2. PP=4, VF_BAR0 (9), Size:3 */
254			return handle_ea_bar(0x80ff0493,
255					     0x1a4, bus, devfn, where,
256					     size, val);
257		if (where_a >= 0xf0 && where_a < 0x100 && is_nic)
258			/* EA entry-3. PP=4, VF_BAR4 (d), Size:3 */
259			return handle_ea_bar(0x80ff04d3,
260					     0x1b4, bus, devfn, where,
261					     size, val);
262	} else if (cfg_type == 1) {
263		bool is_rsl_bridge = devfn == 0x08;
264		bool is_rad_bridge = devfn == 0xa0;
265		bool is_zip_bridge = devfn == 0xa8;
266		bool is_dfa_bridge = devfn == 0xb0;
267		bool is_nic_bridge = devfn == 0x10;
268
269		if (where_a == 0x70) {
270			addr = bus->ops->map_bus(bus, devfn, where_a);
271			if (!addr) {
272				*val = ~0;
273				return PCIBIOS_DEVICE_NOT_FOUND;
274			}
275			v = readl(addr);
276			if (v & 0xff00)
277				pr_err("Bad PCIe cap header: %08x\n", v);
278			v |= 0xbc00; /* next capability is EA at 0xbc */
279			set_val(v, where, size, val);
280			return PCIBIOS_SUCCESSFUL;
281		}
282		if (where_a == 0xbc) {
283			if (is_nic_bridge)
284				v = 0x10014; /* EA last in chain, 1 entry */
285			else
286				v = 0x00014; /* EA last in chain, no entries */
287			set_val(v, where, size, val);
288			return PCIBIOS_SUCCESSFUL;
289		}
290		if (where_a == 0xc0) {
291			if (is_rsl_bridge || is_nic_bridge)
292				v = 0x0101; /* subordinate:secondary = 1:1 */
293			else if (is_rad_bridge)
294				v = 0x0202; /* subordinate:secondary = 2:2 */
295			else if (is_zip_bridge)
296				v = 0x0303; /* subordinate:secondary = 3:3 */
297			else if (is_dfa_bridge)
298				v = 0x0404; /* subordinate:secondary = 4:4 */
299			set_val(v, where, size, val);
300			return PCIBIOS_SUCCESSFUL;
301		}
302		if (where_a == 0xc4 && is_nic_bridge) {
303			/* Enabled, not-Write, SP=ff, PP=05, BEI=6, ES=4 */
304			v = 0x80ff0564;
305			set_val(v, where, size, val);
306			return PCIBIOS_SUCCESSFUL;
307		}
308		if (where_a == 0xc8 && is_nic_bridge) {
309			v = 0x00000002; /* Base-L 64-bit */
310			set_val(v, where, size, val);
311			return PCIBIOS_SUCCESSFUL;
312		}
313		if (where_a == 0xcc && is_nic_bridge) {
314			v = 0xfffffffe; /* MaxOffset-L 64-bit */
315			set_val(v, where, size, val);
316			return PCIBIOS_SUCCESSFUL;
317		}
318		if (where_a == 0xd0 && is_nic_bridge) {
319			v = 0x00008430; /* NIC Base-H */
320			set_val(v, where, size, val);
321			return PCIBIOS_SUCCESSFUL;
322		}
323		if (where_a == 0xd4 && is_nic_bridge) {
324			v = 0x0000000f; /* MaxOffset-H */
325			set_val(v, where, size, val);
326			return PCIBIOS_SUCCESSFUL;
327		}
328	}
329no_emulation:
330	return pci_generic_config_read(bus, devfn, where, size, val);
331}
332
333static int thunder_ecam_config_write(struct pci_bus *bus, unsigned int devfn,
334				     int where, int size, u32 val)
335{
336	/*
337	 * All BARs have fixed addresses; ignore BAR writes so they
338	 * don't get corrupted.
339	 */
340	if ((where >= 0x10 && where < 0x2c) ||
341	    (where >= 0x1a4 && where < 0x1bc))
342		/* BAR or SR-IOV BAR */
343		return PCIBIOS_SUCCESSFUL;
344
345	return pci_generic_config_write(bus, devfn, where, size, val);
346}
347
348const struct pci_ecam_ops pci_thunder_ecam_ops = {
349	.bus_shift	= 20,
350	.pci_ops	= {
351		.map_bus        = pci_ecam_map_bus,
352		.read           = thunder_ecam_config_read,
353		.write          = thunder_ecam_config_write,
354	}
355};
356
357#ifdef CONFIG_PCI_HOST_THUNDER_ECAM
358
359static const struct of_device_id thunder_ecam_of_match[] = {
360	{
361		.compatible = "cavium,pci-host-thunder-ecam",
362		.data = &pci_thunder_ecam_ops,
363	},
364	{ },
365};
366
367static struct platform_driver thunder_ecam_driver = {
368	.driver = {
369		.name = KBUILD_MODNAME,
370		.of_match_table = thunder_ecam_of_match,
371		.suppress_bind_attrs = true,
372	},
373	.probe = pci_host_common_probe,
374};
375builtin_platform_driver(thunder_ecam_driver);
376
377#endif
378#endif