1 /* $NetBSD: linux_pci.c,v 1.30 2024/06/24 21:23:53 riastradh Exp $ */
2
3 /*-
4 * Copyright (c) 2013 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to The NetBSD Foundation
8 * by Taylor R. Campbell.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 * POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 #ifdef _KERNEL_OPT
33 #include "acpica.h"
34 #include "opt_pci.h"
35 #endif
36
37 #include <sys/cdefs.h>
38 __KERNEL_RCSID(0, "$NetBSD: linux_pci.c,v 1.30 2024/06/24 21:23:53 riastradh Exp $");
39
40 #if NACPICA > 0
41 #include <dev/acpi/acpivar.h>
42 #include <dev/acpi/acpi_pci.h>
43 #endif
44
45 #include <linux/pci.h>
46
47 #include <drm/drm_agp_netbsd.h>
48
49 device_t
pci_dev_dev(struct pci_dev * pdev)50 pci_dev_dev(struct pci_dev *pdev)
51 {
52
53 return pdev->pd_dev;
54 }
55
56 void
pci_set_drvdata(struct pci_dev * pdev,void * drvdata)57 pci_set_drvdata(struct pci_dev *pdev, void *drvdata)
58 {
59 pdev->pd_drvdata = drvdata;
60 }
61
62 void *
pci_get_drvdata(struct pci_dev * pdev)63 pci_get_drvdata(struct pci_dev *pdev)
64 {
65 return pdev->pd_drvdata;
66 }
67
68 const char *
pci_name(struct pci_dev * pdev)69 pci_name(struct pci_dev *pdev)
70 {
71
72 /* XXX not sure this has the right format */
73 return device_xname(pci_dev_dev(pdev));
74 }
75
76 /*
77 * Setup enough of a parent that we can access config space.
78 * This is gross and grovels pci(4) and ppb(4) internals.
79 */
80 static struct pci_dev *
alloc_fake_parent_device(device_t parent,const struct pci_attach_args * pa)81 alloc_fake_parent_device(device_t parent, const struct pci_attach_args *pa)
82 {
83
84 if (parent == NULL || !device_is_a(parent, "pci"))
85 return NULL;
86
87 device_t pparent = device_parent(parent);
88 if (pparent == NULL || !device_is_a(pparent, "ppb"))
89 return NULL;
90
91 struct pci_softc *pcisc = device_private(parent);
92 struct ppb_softc *ppbsc = device_private(pparent);
93
94 struct pci_dev *parentdev = kmem_zalloc(sizeof(*parentdev), KM_SLEEP);
95
96 /* Copy this device's pci_attach_args{} as a base-line. */
97 struct pci_attach_args *npa = &parentdev->pd_pa;
98 *npa = *pa;
99
100 /* Now update with stuff found in parent. */
101 npa->pa_iot = pcisc->sc_iot;
102 npa->pa_memt = pcisc->sc_memt;
103 npa->pa_dmat = pcisc->sc_dmat;
104 npa->pa_dmat64 = pcisc->sc_dmat64;
105 npa->pa_pc = pcisc->sc_pc;
106 npa->pa_flags = 0; /* XXX? */
107
108 /* Copy the parent tag, and read some info about it. */
109 npa->pa_tag = ppbsc->sc_tag;
110 pcireg_t id = pci_conf_read(npa->pa_pc, npa->pa_tag, PCI_ID_REG);
111 pcireg_t subid = pci_conf_read(npa->pa_pc, npa->pa_tag,
112 PCI_SUBSYS_ID_REG);
113 pcireg_t class = pci_conf_read(npa->pa_pc, npa->pa_tag, PCI_CLASS_REG);
114
115 /*
116 * Fill in as much of pci_attach_args and pci_dev as reasonably possible.
117 * Most of this is not used currently.
118 */
119 int bus, device, function;
120 pci_decompose_tag(npa->pa_pc, npa->pa_tag, &bus, &device, &function);
121 npa->pa_device = device;
122 npa->pa_function = function;
123 npa->pa_bus = bus;
124 npa->pa_id = id;
125 npa->pa_class = class;
126 npa->pa_intrswiz = pcisc->sc_intrswiz;
127 npa->pa_intrtag = pcisc->sc_intrtag;
128 npa->pa_intrpin = PCI_INTERRUPT_PIN_NONE;
129
130 parentdev->pd_dev = parent;
131
132 parentdev->bus = NULL;
133 parentdev->devfn = device << 3 | function;
134 parentdev->vendor = PCI_VENDOR(id);
135 parentdev->device = PCI_PRODUCT(id);
136 parentdev->subsystem_vendor = PCI_SUBSYS_VENDOR(subid);
137 parentdev->subsystem_device = PCI_SUBSYS_ID(subid);
138 parentdev->revision = PCI_REVISION(class);
139 parentdev->class = __SHIFTOUT(class, 0xffffff00UL); /* ? */
140
141 return parentdev;
142 }
143
144 void
linux_pci_dev_init(struct pci_dev * pdev,device_t dev,device_t parent,const struct pci_attach_args * pa,int kludges)145 linux_pci_dev_init(struct pci_dev *pdev, device_t dev, device_t parent,
146 const struct pci_attach_args *pa, int kludges)
147 {
148 const uint32_t subsystem_id = pci_conf_read(pa->pa_pc, pa->pa_tag,
149 PCI_SUBSYS_ID_REG);
150 unsigned i;
151
152 memset(pdev, 0, sizeof(*pdev)); /* paranoia */
153
154 pdev->pd_pa = *pa;
155 pdev->pd_kludges = kludges;
156 pdev->pd_rom_vaddr = NULL;
157 pdev->pd_dev = dev;
158 #if (NACPICA > 0)
159 const int seg = pci_get_segment(pa->pa_pc);
160 pdev->pd_ad = acpi_pcidev_find(seg, pa->pa_bus,
161 pa->pa_device, pa->pa_function);
162 #else
163 pdev->pd_ad = NULL;
164 #endif
165 pdev->pd_saved_state = NULL;
166 pdev->pd_intr_handles = NULL;
167 pdev->pd_drvdata = NULL;
168 pdev->bus = kmem_zalloc(sizeof(*pdev->bus), KM_NOSLEEP);
169 pdev->bus->pb_pc = pa->pa_pc;
170 pdev->bus->pb_dev = parent;
171 pdev->bus->number = pa->pa_bus;
172 /*
173 * NetBSD doesn't have an easy "am I PCIe" or "give me PCIe speed
174 * from capability" function, but we already emulate the Linux
175 * versions that do.
176 */
177 if (pci_is_pcie(pdev)) {
178 pdev->bus->max_bus_speed = pcie_get_speed_cap(pdev);
179 } else {
180 /* XXX: Do AGP/PCI-X, etc.? */
181 pdev->bus->max_bus_speed = PCI_SPEED_UNKNOWN;
182 }
183 pdev->bus->self = alloc_fake_parent_device(parent, pa);
184 pdev->devfn = PCI_DEVFN(pa->pa_device, pa->pa_function);
185 pdev->vendor = PCI_VENDOR(pa->pa_id);
186 pdev->device = PCI_PRODUCT(pa->pa_id);
187 pdev->subsystem_vendor = PCI_SUBSYS_VENDOR(subsystem_id);
188 pdev->subsystem_device = PCI_SUBSYS_ID(subsystem_id);
189 pdev->revision = PCI_REVISION(pa->pa_class);
190 pdev->class = __SHIFTOUT(pa->pa_class, 0xffffff00UL); /* ? */
191
192 CTASSERT(__arraycount(pdev->pd_resources) == PCI_NUM_RESOURCES);
193 for (i = 0; i < PCI_NUM_RESOURCES; i++) {
194 const int reg = PCI_BAR(i);
195
196 pdev->pd_resources[i].type = pci_mapreg_type(pa->pa_pc,
197 pa->pa_tag, reg);
198 if (pci_mapreg_info(pa->pa_pc, pa->pa_tag, reg,
199 pdev->pd_resources[i].type,
200 &pdev->pd_resources[i].addr,
201 &pdev->pd_resources[i].size,
202 &pdev->pd_resources[i].flags)) {
203 pdev->pd_resources[i].addr = 0;
204 pdev->pd_resources[i].size = 0;
205 pdev->pd_resources[i].flags = 0;
206 }
207 pdev->pd_resources[i].kva = NULL;
208 pdev->pd_resources[i].mapped = false;
209 }
210 }
211
212 int
pci_find_capability(struct pci_dev * pdev,int cap)213 pci_find_capability(struct pci_dev *pdev, int cap)
214 {
215
216 return pci_get_capability(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag, cap,
217 NULL, NULL);
218 }
219
220 int
pci_read_config_dword(struct pci_dev * pdev,int reg,uint32_t * valuep)221 pci_read_config_dword(struct pci_dev *pdev, int reg, uint32_t *valuep)
222 {
223
224 KASSERT(!ISSET(reg, 3));
225 *valuep = pci_conf_read(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag, reg);
226 return 0;
227 }
228
229 int
pci_read_config_word(struct pci_dev * pdev,int reg,uint16_t * valuep)230 pci_read_config_word(struct pci_dev *pdev, int reg, uint16_t *valuep)
231 {
232
233 KASSERT(!ISSET(reg, 1));
234 *valuep = pci_conf_read(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag,
235 (reg &~ 2)) >> (8 * (reg & 2));
236 return 0;
237 }
238
239 int
pci_read_config_byte(struct pci_dev * pdev,int reg,uint8_t * valuep)240 pci_read_config_byte(struct pci_dev *pdev, int reg, uint8_t *valuep)
241 {
242
243 *valuep = pci_conf_read(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag,
244 (reg &~ 3)) >> (8 * (reg & 3));
245 return 0;
246 }
247
248 int
pci_write_config_dword(struct pci_dev * pdev,int reg,uint32_t value)249 pci_write_config_dword(struct pci_dev *pdev, int reg, uint32_t value)
250 {
251
252 KASSERT(!ISSET(reg, 3));
253 pci_conf_write(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag, reg, value);
254 return 0;
255 }
256
257 int
pci_bus_read_config_dword(struct pci_bus * bus,unsigned devfn,int reg,uint32_t * valuep)258 pci_bus_read_config_dword(struct pci_bus *bus, unsigned devfn, int reg,
259 uint32_t *valuep)
260 {
261 pcitag_t tag = pci_make_tag(bus->pb_pc, bus->number, PCI_SLOT(devfn),
262 PCI_FUNC(devfn));
263
264 KASSERT(!ISSET(reg, 1));
265 *valuep = pci_conf_read(bus->pb_pc, tag, reg & ~3) >> (8 * (reg & 3));
266 return 0;
267 }
268
269 int
pci_bus_read_config_word(struct pci_bus * bus,unsigned devfn,int reg,uint16_t * valuep)270 pci_bus_read_config_word(struct pci_bus *bus, unsigned devfn, int reg,
271 uint16_t *valuep)
272 {
273 pcitag_t tag = pci_make_tag(bus->pb_pc, bus->number, PCI_SLOT(devfn),
274 PCI_FUNC(devfn));
275
276 KASSERT(!ISSET(reg, 1));
277 *valuep = pci_conf_read(bus->pb_pc, tag, reg &~ 2) >> (8 * (reg & 2));
278 return 0;
279 }
280
281 int
pci_bus_read_config_byte(struct pci_bus * bus,unsigned devfn,int reg,uint8_t * valuep)282 pci_bus_read_config_byte(struct pci_bus *bus, unsigned devfn, int reg,
283 uint8_t *valuep)
284 {
285 pcitag_t tag = pci_make_tag(bus->pb_pc, bus->number, PCI_SLOT(devfn),
286 PCI_FUNC(devfn));
287
288 *valuep = pci_conf_read(bus->pb_pc, tag, reg &~ 3) >> (8 * (reg & 3));
289 return 0;
290 }
291
292 int
pci_bus_write_config_dword(struct pci_bus * bus,unsigned devfn,int reg,uint32_t value)293 pci_bus_write_config_dword(struct pci_bus *bus, unsigned devfn, int reg,
294 uint32_t value)
295 {
296 pcitag_t tag = pci_make_tag(bus->pb_pc, bus->number, PCI_SLOT(devfn),
297 PCI_FUNC(devfn));
298
299 KASSERT(!ISSET(reg, 3));
300 pci_conf_write(bus->pb_pc, tag, reg, value);
301 return 0;
302 }
303
304 static void
pci_rmw_config(pci_chipset_tag_t pc,pcitag_t tag,int reg,unsigned int bytes,uint32_t value)305 pci_rmw_config(pci_chipset_tag_t pc, pcitag_t tag, int reg, unsigned int bytes,
306 uint32_t value)
307 {
308 const uint32_t mask = ~((~0UL) << (8 * bytes));
309 const int reg32 = (reg &~ 3);
310 const unsigned int shift = (8 * (reg & 3));
311 uint32_t value32;
312
313 KASSERT(bytes <= 4);
314 KASSERT(!ISSET(value, ~mask));
315 value32 = pci_conf_read(pc, tag, reg32);
316 value32 &=~ (mask << shift);
317 value32 |= (value << shift);
318 pci_conf_write(pc, tag, reg32, value32);
319 }
320
321 int
pci_write_config_word(struct pci_dev * pdev,int reg,uint16_t value)322 pci_write_config_word(struct pci_dev *pdev, int reg, uint16_t value)
323 {
324
325 KASSERT(!ISSET(reg, 1));
326 pci_rmw_config(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag, reg, 2, value);
327 return 0;
328 }
329
330 int
pci_write_config_byte(struct pci_dev * pdev,int reg,uint8_t value)331 pci_write_config_byte(struct pci_dev *pdev, int reg, uint8_t value)
332 {
333
334 pci_rmw_config(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag, reg, 1, value);
335 return 0;
336 }
337
338 int
pci_bus_write_config_word(struct pci_bus * bus,unsigned devfn,int reg,uint16_t value)339 pci_bus_write_config_word(struct pci_bus *bus, unsigned devfn, int reg,
340 uint16_t value)
341 {
342 pcitag_t tag = pci_make_tag(bus->pb_pc, bus->number, PCI_SLOT(devfn),
343 PCI_FUNC(devfn));
344
345 KASSERT(!ISSET(reg, 1));
346 pci_rmw_config(bus->pb_pc, tag, reg, 2, value);
347 return 0;
348 }
349
350 int
pci_bus_write_config_byte(struct pci_bus * bus,unsigned devfn,int reg,uint8_t value)351 pci_bus_write_config_byte(struct pci_bus *bus, unsigned devfn, int reg,
352 uint8_t value)
353 {
354 pcitag_t tag = pci_make_tag(bus->pb_pc, bus->number, PCI_SLOT(devfn),
355 PCI_FUNC(devfn));
356
357 pci_rmw_config(bus->pb_pc, tag, reg, 1, value);
358 return 0;
359 }
360
361 int
pci_enable_msi(struct pci_dev * pdev)362 pci_enable_msi(struct pci_dev *pdev)
363 {
364 const struct pci_attach_args *const pa = &pdev->pd_pa;
365
366 if (pci_msi_alloc_exact(pa, &pdev->pd_intr_handles, 1))
367 return -EINVAL;
368
369 pdev->msi_enabled = 1;
370 return 0;
371 }
372
373 void
pci_disable_msi(struct pci_dev * pdev __unused)374 pci_disable_msi(struct pci_dev *pdev __unused)
375 {
376 const struct pci_attach_args *const pa = &pdev->pd_pa;
377
378 if (pdev->pd_intr_handles != NULL) {
379 pci_intr_release(pa->pa_pc, pdev->pd_intr_handles, 1);
380 pdev->pd_intr_handles = NULL;
381 }
382 pdev->msi_enabled = 0;
383 }
384
385 void
pci_set_master(struct pci_dev * pdev)386 pci_set_master(struct pci_dev *pdev)
387 {
388 pcireg_t csr;
389
390 csr = pci_conf_read(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag,
391 PCI_COMMAND_STATUS_REG);
392 csr |= PCI_COMMAND_MASTER_ENABLE;
393 pci_conf_write(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag,
394 PCI_COMMAND_STATUS_REG, csr);
395 }
396
397 void
pci_clear_master(struct pci_dev * pdev)398 pci_clear_master(struct pci_dev *pdev)
399 {
400 pcireg_t csr;
401
402 csr = pci_conf_read(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag,
403 PCI_COMMAND_STATUS_REG);
404 csr &= ~(pcireg_t)PCI_COMMAND_MASTER_ENABLE;
405 pci_conf_write(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag,
406 PCI_COMMAND_STATUS_REG, csr);
407 }
408
409 int
pcie_capability_read_dword(struct pci_dev * pdev,int reg,uint32_t * valuep)410 pcie_capability_read_dword(struct pci_dev *pdev, int reg, uint32_t *valuep)
411 {
412 pci_chipset_tag_t pc = pdev->pd_pa.pa_pc;
413 pcitag_t tag = pdev->pd_pa.pa_tag;
414 int off;
415
416 *valuep = 0;
417
418 /* Must have capabilities. */
419 if (pci_get_capability(pc, tag, PCI_CAP_PCIEXPRESS, &off, NULL) == 0)
420 return 1;
421
422 *valuep = pci_conf_read(pc, tag, off + reg);
423
424 return 0;
425 }
426
427 int
pcie_capability_read_word(struct pci_dev * pdev,int reg,uint16_t * valuep)428 pcie_capability_read_word(struct pci_dev *pdev, int reg, uint16_t *valuep)
429 {
430 pci_chipset_tag_t pc = pdev->pd_pa.pa_pc;
431 pcitag_t tag = pdev->pd_pa.pa_tag;
432 int off;
433
434 *valuep = 0;
435
436 /* Must have capabilities. */
437 if (pci_get_capability(pc, tag, PCI_CAP_PCIEXPRESS, &off, NULL) == 0)
438 return 1;
439
440 *valuep = pci_conf_read(pc, tag, off + (reg &~ 2)) >> (8 * (reg & 2));
441
442 return 0;
443 }
444
445 int
pcie_capability_write_dword(struct pci_dev * pdev,int reg,uint32_t value)446 pcie_capability_write_dword(struct pci_dev *pdev, int reg, uint32_t value)
447 {
448 pci_chipset_tag_t pc = pdev->pd_pa.pa_pc;
449 pcitag_t tag = pdev->pd_pa.pa_tag;
450 int off;
451
452 /* Must have capabilities. */
453 if (pci_get_capability(pc, tag, PCI_CAP_PCIEXPRESS, &off, NULL) == 0)
454 return 1;
455
456 pci_conf_write(pc, tag, off + reg, value);
457
458 return 0;
459 }
460
461 int
pcie_capability_write_word(struct pci_dev * pdev,int reg,uint16_t value)462 pcie_capability_write_word(struct pci_dev *pdev, int reg, uint16_t value)
463 {
464 pci_chipset_tag_t pc = pdev->pd_pa.pa_pc;
465 pcitag_t tag = pdev->pd_pa.pa_tag;
466 int off;
467
468 /* Must have capabilities. */
469 if (pci_get_capability(pc, tag, PCI_CAP_PCIEXPRESS, &off, NULL) == 0)
470 return 1;
471
472 pci_rmw_config(pc, tag, off + reg, 2, value);
473
474 return 0;
475 }
476
477 /* From PCIe 5.0 7.5.3.4 "Device Control Register" */
478 static const unsigned readrqmax[] = {
479 128,
480 256,
481 512,
482 1024,
483 2048,
484 4096,
485 };
486
487 int
pcie_get_readrq(struct pci_dev * pdev)488 pcie_get_readrq(struct pci_dev *pdev)
489 {
490 pci_chipset_tag_t pc = pdev->pd_pa.pa_pc;
491 pcitag_t tag = pdev->pd_pa.pa_tag;
492 unsigned val;
493 int off;
494
495 if (pci_get_capability(pc, tag, PCI_CAP_PCIEXPRESS, &off, NULL) == 0)
496 return -EINVAL; /* XXX NetBSD->Linux */
497
498 val = __SHIFTOUT(pci_conf_read(pc, tag, off + PCIE_DCSR),
499 PCIE_DCSR_MAX_READ_REQ);
500
501 if (val >= __arraycount(readrqmax))
502 val = 0;
503 return readrqmax[val];
504 }
505
506 int
pcie_set_readrq(struct pci_dev * pdev,int val)507 pcie_set_readrq(struct pci_dev *pdev, int val)
508 {
509 pci_chipset_tag_t pc = pdev->pd_pa.pa_pc;
510 pcitag_t tag = pdev->pd_pa.pa_tag;
511 pcireg_t reg, newval = 0;
512 unsigned i;
513 int off;
514
515 for (i = 0; i < __arraycount(readrqmax); i++) {
516 if (readrqmax[i] == val) {
517 newval = i;
518 break;
519 }
520 }
521
522 if (i == __arraycount(readrqmax))
523 return -EINVAL;
524
525 if (pci_get_capability(pc, tag, PCI_CAP_PCIEXPRESS, &off, NULL) == 0)
526 return -EINVAL; /* XXX NetBSD->Linux */
527
528 reg = pci_conf_read(pc, tag, off + PCIE_DCSR);
529 reg &= ~PCIE_DCSR_MAX_READ_REQ | (newval << 12);
530 pci_conf_write(pc, tag, off + PCIE_DCSR, reg);
531
532 return 0;
533 }
534
535 bus_addr_t
pcibios_align_resource(void * p,const struct resource * resource,bus_addr_t addr,bus_size_t size)536 pcibios_align_resource(void *p, const struct resource *resource,
537 bus_addr_t addr, bus_size_t size)
538 {
539 panic("pcibios_align_resource has accessed unaligned neurons!");
540 }
541
542 int
pci_bus_alloc_resource(struct pci_bus * bus,struct resource * resource,bus_size_t size,bus_size_t align,bus_addr_t start,int type __unused,bus_addr_t (* align_fn)(void *,const struct resource *,bus_addr_t,bus_size_t)__unused,struct pci_dev * pdev)543 pci_bus_alloc_resource(struct pci_bus *bus, struct resource *resource,
544 bus_size_t size, bus_size_t align, bus_addr_t start, int type __unused,
545 bus_addr_t (*align_fn)(void *, const struct resource *, bus_addr_t,
546 bus_size_t) __unused,
547 struct pci_dev *pdev)
548 {
549 const struct pci_attach_args *const pa = &pdev->pd_pa;
550 bus_space_tag_t bst;
551 int error;
552
553 switch (resource->flags) {
554 case IORESOURCE_MEM:
555 bst = pa->pa_memt;
556 break;
557
558 case IORESOURCE_IO:
559 bst = pa->pa_iot;
560 break;
561
562 default:
563 panic("I don't know what kind of resource you want!");
564 }
565
566 resource->r_bst = bst;
567 error = bus_space_alloc(bst, start, __type_max(bus_addr_t),
568 size, align, 0, 0, &resource->start, &resource->r_bsh);
569 if (error)
570 return error;
571
572 resource->end = start + (size - 1);
573 return 0;
574 }
575
576 struct pci_domain_bus_and_slot {
577 int domain, bus, slot;
578 };
579
580 static int
pci_match_domain_bus_and_slot(void * cookie,const struct pci_attach_args * pa)581 pci_match_domain_bus_and_slot(void *cookie, const struct pci_attach_args *pa)
582 {
583 const struct pci_domain_bus_and_slot *C = cookie;
584
585 if (pci_get_segment(pa->pa_pc) != C->domain)
586 return 0;
587 if (pa->pa_bus != C->bus)
588 return 0;
589 if (PCI_DEVFN(pa->pa_device, pa->pa_function) != C->slot)
590 return 0;
591
592 return 1;
593 }
594
595 struct pci_dev *
pci_get_domain_bus_and_slot(int domain,int bus,int slot)596 pci_get_domain_bus_and_slot(int domain, int bus, int slot)
597 {
598 struct pci_attach_args pa;
599 struct pci_domain_bus_and_slot context = {domain, bus, slot},
600 *C = &context;
601
602 if (!pci_find_device1(&pa, &pci_match_domain_bus_and_slot, C))
603 return NULL;
604
605 struct pci_dev *const pdev = kmem_zalloc(sizeof(*pdev), KM_SLEEP);
606 linux_pci_dev_init(pdev, NULL, NULL, &pa, NBPCI_KLUDGE_GET_MUMBLE);
607
608 return pdev;
609 }
610
611 void
pci_dev_put(struct pci_dev * pdev)612 pci_dev_put(struct pci_dev *pdev)
613 {
614
615 if (pdev == NULL)
616 return;
617
618 KASSERT(ISSET(pdev->pd_kludges, NBPCI_KLUDGE_GET_MUMBLE));
619 kmem_free(pdev->bus, sizeof(*pdev->bus));
620 kmem_free(pdev, sizeof(*pdev));
621 }
622
623 struct pci_get_class_state {
624 uint32_t class_subclass_interface;
625 const struct pci_dev *from;
626 };
627
628 static int
pci_get_class_match(void * cookie,const struct pci_attach_args * pa)629 pci_get_class_match(void *cookie, const struct pci_attach_args *pa)
630 {
631 struct pci_get_class_state *C = cookie;
632
633 if (C->from) {
634 if ((pci_get_segment(C->from->pd_pa.pa_pc) ==
635 pci_get_segment(pa->pa_pc)) &&
636 C->from->pd_pa.pa_bus == pa->pa_bus &&
637 C->from->pd_pa.pa_device == pa->pa_device &&
638 C->from->pd_pa.pa_function == pa->pa_function)
639 C->from = NULL;
640 return 0;
641 }
642 if (C->class_subclass_interface !=
643 (PCI_CLASS(pa->pa_class) << 16 |
644 PCI_SUBCLASS(pa->pa_class) << 8 |
645 PCI_INTERFACE(pa->pa_class)))
646 return 0;
647
648 return 1;
649 }
650
651 struct pci_dev *
pci_get_class(uint32_t class_subclass_interface,struct pci_dev * from)652 pci_get_class(uint32_t class_subclass_interface, struct pci_dev *from)
653 {
654 struct pci_get_class_state context = {class_subclass_interface, from},
655 *C = &context;
656 struct pci_attach_args pa;
657 struct pci_dev *pdev = NULL;
658
659 if (!pci_find_device1(&pa, &pci_get_class_match, C))
660 goto out;
661 pdev = kmem_zalloc(sizeof(*pdev), KM_SLEEP);
662 linux_pci_dev_init(pdev, NULL, NULL, &pa, NBPCI_KLUDGE_GET_MUMBLE);
663
664 out: if (from)
665 pci_dev_put(from);
666 return pdev;
667 }
668
669 int
pci_dev_present(const struct pci_device_id * ids)670 pci_dev_present(const struct pci_device_id *ids)
671 {
672
673 /* XXX implement me -- pci_find_device doesn't pass a cookie */
674 return 0;
675 }
676
677 void
pci_unmap_rom(struct pci_dev * pdev,void __pci_rom_iomem * vaddr __unused)678 pci_unmap_rom(struct pci_dev *pdev, void __pci_rom_iomem *vaddr __unused)
679 {
680
681 /* XXX Disable the ROM address decoder. */
682 KASSERT(ISSET(pdev->pd_kludges, NBPCI_KLUDGE_MAP_ROM));
683 KASSERT(vaddr == pdev->pd_rom_vaddr);
684 bus_space_unmap(pdev->pd_rom_bst, pdev->pd_rom_bsh, pdev->pd_rom_size);
685 pdev->pd_kludges &= ~NBPCI_KLUDGE_MAP_ROM;
686 pdev->pd_rom_vaddr = NULL;
687 }
688
689 /* XXX Whattakludge! Should move this in sys/arch/. */
690 static int
pci_map_rom_md(struct pci_dev * pdev)691 pci_map_rom_md(struct pci_dev *pdev)
692 {
693 #if defined(__i386__) || defined(__x86_64__) || defined(__ia64__)
694 const bus_addr_t rom_base = 0xc0000;
695 const bus_size_t rom_size = 0x20000;
696 bus_space_handle_t rom_bsh;
697 int error;
698
699 if (PCI_CLASS(pdev->pd_pa.pa_class) != PCI_CLASS_DISPLAY)
700 return ENXIO;
701 if (PCI_SUBCLASS(pdev->pd_pa.pa_class) != PCI_SUBCLASS_DISPLAY_VGA)
702 return ENXIO;
703 /* XXX Check whether this is the primary VGA card? */
704 error = bus_space_map(pdev->pd_pa.pa_memt, rom_base, rom_size,
705 (BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_PREFETCHABLE), &rom_bsh);
706 if (error)
707 return ENXIO;
708
709 pdev->pd_rom_bst = pdev->pd_pa.pa_memt;
710 pdev->pd_rom_bsh = rom_bsh;
711 pdev->pd_rom_size = rom_size;
712 pdev->pd_kludges |= NBPCI_KLUDGE_MAP_ROM;
713
714 return 0;
715 #else
716 return ENXIO;
717 #endif
718 }
719
720 void __pci_rom_iomem *
pci_map_rom(struct pci_dev * pdev,size_t * sizep)721 pci_map_rom(struct pci_dev *pdev, size_t *sizep)
722 {
723
724 KASSERT(!ISSET(pdev->pd_kludges, NBPCI_KLUDGE_MAP_ROM));
725
726 if (pci_mapreg_map(&pdev->pd_pa, PCI_MAPREG_ROM, PCI_MAPREG_TYPE_ROM,
727 (BUS_SPACE_MAP_PREFETCHABLE | BUS_SPACE_MAP_LINEAR),
728 &pdev->pd_rom_bst, &pdev->pd_rom_bsh, NULL, &pdev->pd_rom_size)
729 != 0)
730 goto fail_mi;
731 pdev->pd_kludges |= NBPCI_KLUDGE_MAP_ROM;
732
733 /* XXX This type is obviously wrong in general... */
734 if (pci_find_rom(&pdev->pd_pa, pdev->pd_rom_bst, pdev->pd_rom_bsh,
735 pdev->pd_rom_size, PCI_ROM_CODE_TYPE_X86,
736 &pdev->pd_rom_found_bsh, &pdev->pd_rom_found_size)) {
737 pci_unmap_rom(pdev, NULL);
738 goto fail_mi;
739 }
740 goto success;
741
742 fail_mi:
743 if (pci_map_rom_md(pdev) != 0)
744 goto fail_md;
745
746 /* XXX This type is obviously wrong in general... */
747 if (pci_find_rom(&pdev->pd_pa, pdev->pd_rom_bst, pdev->pd_rom_bsh,
748 pdev->pd_rom_size, PCI_ROM_CODE_TYPE_X86,
749 &pdev->pd_rom_found_bsh, &pdev->pd_rom_found_size)) {
750 pci_unmap_rom(pdev, NULL);
751 goto fail_md;
752 }
753
754 success:
755 KASSERT(pdev->pd_rom_found_size <= SIZE_T_MAX);
756 *sizep = pdev->pd_rom_found_size;
757 pdev->pd_rom_vaddr = bus_space_vaddr(pdev->pd_rom_bst,
758 pdev->pd_rom_found_bsh);
759 return pdev->pd_rom_vaddr;
760
761 fail_md:
762 return NULL;
763 }
764
765 void __pci_rom_iomem *
pci_platform_rom(struct pci_dev * pdev __unused,size_t * sizep)766 pci_platform_rom(struct pci_dev *pdev __unused, size_t *sizep)
767 {
768
769 *sizep = 0;
770 return NULL;
771 }
772
773 int
pci_enable_rom(struct pci_dev * pdev)774 pci_enable_rom(struct pci_dev *pdev)
775 {
776 const pci_chipset_tag_t pc = pdev->pd_pa.pa_pc;
777 const pcitag_t tag = pdev->pd_pa.pa_tag;
778 pcireg_t addr;
779 int s;
780
781 /* XXX Don't do anything if the ROM isn't there. */
782
783 s = splhigh();
784 addr = pci_conf_read(pc, tag, PCI_MAPREG_ROM);
785 addr |= PCI_MAPREG_ROM_ENABLE;
786 pci_conf_write(pc, tag, PCI_MAPREG_ROM, addr);
787 splx(s);
788
789 return 0;
790 }
791
792 void
pci_disable_rom(struct pci_dev * pdev)793 pci_disable_rom(struct pci_dev *pdev)
794 {
795 const pci_chipset_tag_t pc = pdev->pd_pa.pa_pc;
796 const pcitag_t tag = pdev->pd_pa.pa_tag;
797 pcireg_t addr;
798 int s;
799
800 s = splhigh();
801 addr = pci_conf_read(pc, tag, PCI_MAPREG_ROM);
802 addr &= ~(pcireg_t)PCI_MAPREG_ROM_ENABLE;
803 pci_conf_write(pc, tag, PCI_MAPREG_ROM, addr);
804 splx(s);
805 }
806
807 bus_addr_t
pci_resource_start(struct pci_dev * pdev,unsigned i)808 pci_resource_start(struct pci_dev *pdev, unsigned i)
809 {
810
811 if (i >= PCI_NUM_RESOURCES)
812 panic("resource %d >= max %d", i, PCI_NUM_RESOURCES);
813 return pdev->pd_resources[i].addr;
814 }
815
816 bus_size_t
pci_resource_len(struct pci_dev * pdev,unsigned i)817 pci_resource_len(struct pci_dev *pdev, unsigned i)
818 {
819
820 if (i >= PCI_NUM_RESOURCES)
821 panic("resource %d >= max %d", i, PCI_NUM_RESOURCES);
822 return pdev->pd_resources[i].size;
823 }
824
825 bus_addr_t
pci_resource_end(struct pci_dev * pdev,unsigned i)826 pci_resource_end(struct pci_dev *pdev, unsigned i)
827 {
828
829 return pci_resource_start(pdev, i) + (pci_resource_len(pdev, i) - 1);
830 }
831
832 int
pci_resource_flags(struct pci_dev * pdev,unsigned i)833 pci_resource_flags(struct pci_dev *pdev, unsigned i)
834 {
835
836 if (i >= PCI_NUM_RESOURCES)
837 panic("resource %d >= max %d", i, PCI_NUM_RESOURCES);
838 return pdev->pd_resources[i].flags;
839 }
840
841 void __pci_iomem *
pci_iomap(struct pci_dev * pdev,unsigned i,bus_size_t size)842 pci_iomap(struct pci_dev *pdev, unsigned i, bus_size_t size)
843 {
844 int error;
845
846 KASSERT(i < PCI_NUM_RESOURCES);
847 KASSERT(pdev->pd_resources[i].kva == NULL);
848
849 if (PCI_MAPREG_TYPE(pdev->pd_resources[i].type) != PCI_MAPREG_TYPE_MEM)
850 return NULL;
851 if (pdev->pd_resources[i].size < size)
852 return NULL;
853 error = bus_space_map(pdev->pd_pa.pa_memt, pdev->pd_resources[i].addr,
854 size, BUS_SPACE_MAP_LINEAR | pdev->pd_resources[i].flags,
855 &pdev->pd_resources[i].bsh);
856 if (error)
857 return NULL;
858 pdev->pd_resources[i].bst = pdev->pd_pa.pa_memt;
859 pdev->pd_resources[i].kva = bus_space_vaddr(pdev->pd_resources[i].bst,
860 pdev->pd_resources[i].bsh);
861 pdev->pd_resources[i].mapped = true;
862
863 return pdev->pd_resources[i].kva;
864 }
865
866 void
pci_iounmap(struct pci_dev * pdev,void __pci_iomem * kva)867 pci_iounmap(struct pci_dev *pdev, void __pci_iomem *kva)
868 {
869 unsigned i;
870
871 CTASSERT(__arraycount(pdev->pd_resources) == PCI_NUM_RESOURCES);
872 for (i = 0; i < PCI_NUM_RESOURCES; i++) {
873 if (pdev->pd_resources[i].kva == kva)
874 break;
875 }
876 KASSERT(i < PCI_NUM_RESOURCES);
877
878 pdev->pd_resources[i].kva = NULL;
879 bus_space_unmap(pdev->pd_resources[i].bst, pdev->pd_resources[i].bsh,
880 pdev->pd_resources[i].size);
881 }
882
883 void
pci_save_state(struct pci_dev * pdev)884 pci_save_state(struct pci_dev *pdev)
885 {
886
887 KASSERT(pdev->pd_saved_state == NULL);
888 pdev->pd_saved_state = kmem_alloc(sizeof(*pdev->pd_saved_state),
889 KM_SLEEP);
890 pci_conf_capture(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag,
891 pdev->pd_saved_state);
892 }
893
894 void
pci_restore_state(struct pci_dev * pdev)895 pci_restore_state(struct pci_dev *pdev)
896 {
897
898 KASSERT(pdev->pd_saved_state != NULL);
899 pci_conf_restore(pdev->pd_pa.pa_pc, pdev->pd_pa.pa_tag,
900 pdev->pd_saved_state);
901 kmem_free(pdev->pd_saved_state, sizeof(*pdev->pd_saved_state));
902 pdev->pd_saved_state = NULL;
903 }
904
905 bool
pci_is_pcie(struct pci_dev * pdev)906 pci_is_pcie(struct pci_dev *pdev)
907 {
908
909 return (pci_find_capability(pdev, PCI_CAP_PCIEXPRESS) != 0);
910 }
911
912 bool
pci_dma_supported(struct pci_dev * pdev,uintmax_t mask)913 pci_dma_supported(struct pci_dev *pdev, uintmax_t mask)
914 {
915
916 /* XXX Cop-out. */
917 if (mask > DMA_BIT_MASK(32))
918 return pci_dma64_available(&pdev->pd_pa);
919 else
920 return true;
921 }
922
923 bool
pci_is_thunderbolt_attached(struct pci_dev * pdev)924 pci_is_thunderbolt_attached(struct pci_dev *pdev)
925 {
926
927 /* XXX Cop-out. */
928 return false;
929 }
930
931 bool
pci_is_root_bus(struct pci_bus * bus)932 pci_is_root_bus(struct pci_bus *bus)
933 {
934
935 return bus->number == 0;
936 }
937
938 int
pci_domain_nr(struct pci_bus * bus)939 pci_domain_nr(struct pci_bus *bus)
940 {
941
942 return pci_get_segment(bus->pb_pc);
943 }
944
945 /*
946 * We explicitly rename pci_enable/disable_device so that you have to
947 * review each use of them, since NetBSD's PCI API does _not_ respect
948 * our local enablecnt here, but there are different parts of NetBSD
949 * that automatically enable/disable like PMF, so you have to decide
950 * for each one whether to call it or not.
951 */
952
953 int
linux_pci_enable_device(struct pci_dev * pdev)954 linux_pci_enable_device(struct pci_dev *pdev)
955 {
956 const struct pci_attach_args *pa = &pdev->pd_pa;
957 pcireg_t csr;
958 int s;
959
960 if (pdev->pd_enablecnt++)
961 return 0;
962
963 s = splhigh();
964 csr = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
965 /* If someone else (firmware) already enabled it, credit them. */
966 if (csr & (PCI_COMMAND_IO_ENABLE|PCI_COMMAND_MEM_ENABLE))
967 pdev->pd_enablecnt++;
968 csr |= PCI_COMMAND_IO_ENABLE;
969 csr |= PCI_COMMAND_MEM_ENABLE;
970 pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, csr);
971 splx(s);
972
973 return 0;
974 }
975
976 void
linux_pci_disable_device(struct pci_dev * pdev)977 linux_pci_disable_device(struct pci_dev *pdev)
978 {
979 const struct pci_attach_args *pa = &pdev->pd_pa;
980 pcireg_t csr;
981 int s;
982
983 if (--pdev->pd_enablecnt)
984 return;
985
986 s = splhigh();
987 csr = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
988 csr &= ~PCI_COMMAND_IO_ENABLE;
989 csr &= ~PCI_COMMAND_MEM_ENABLE;
990 pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, csr);
991 splx(s);
992 }
993
994 void
linux_pci_dev_destroy(struct pci_dev * pdev)995 linux_pci_dev_destroy(struct pci_dev *pdev)
996 {
997 unsigned i;
998
999 if (pdev->bus->self != NULL) {
1000 kmem_free(pdev->bus->self, sizeof(*pdev->bus->self));
1001 }
1002 if (pdev->bus != NULL) {
1003 kmem_free(pdev->bus, sizeof(*pdev->bus));
1004 pdev->bus = NULL;
1005 }
1006 if (ISSET(pdev->pd_kludges, NBPCI_KLUDGE_MAP_ROM)) {
1007 pci_unmap_rom(pdev, pdev->pd_rom_vaddr);
1008 pdev->pd_rom_vaddr = 0;
1009 }
1010 for (i = 0; i < __arraycount(pdev->pd_resources); i++) {
1011 if (!pdev->pd_resources[i].mapped)
1012 continue;
1013 bus_space_unmap(pdev->pd_resources[i].bst,
1014 pdev->pd_resources[i].bsh, pdev->pd_resources[i].size);
1015 }
1016
1017 /* There is no way these should be still in use. */
1018 KASSERT(pdev->pd_saved_state == NULL);
1019 KASSERT(pdev->pd_intr_handles == NULL);
1020 }
1021
1022 enum pci_bus_speed
pcie_get_speed_cap(struct pci_dev * dev)1023 pcie_get_speed_cap(struct pci_dev *dev)
1024 {
1025 pci_chipset_tag_t pc = dev->pd_pa.pa_pc;
1026 pcitag_t tag = dev->pd_pa.pa_tag;
1027 pcireg_t lcap, lcap2, xcap;
1028 int off;
1029
1030 /* Must have capabilities. */
1031 if (pci_get_capability(pc, tag, PCI_CAP_PCIEXPRESS, &off, NULL) == 0)
1032 return PCI_SPEED_UNKNOWN;
1033
1034 /* Only PCIe 3.x has LCAP2. */
1035 xcap = pci_conf_read(pc, tag, off + PCIE_XCAP);
1036 if (__SHIFTOUT(xcap, PCIE_XCAP_VER_MASK) >= 2) {
1037 lcap2 = pci_conf_read(pc, tag, off + PCIE_LCAP2);
1038 if (lcap2) {
1039 if ((lcap2 & PCIE_LCAP2_SUP_LNKS64) != 0) {
1040 return PCIE_SPEED_64_0GT;
1041 }
1042 if ((lcap2 & PCIE_LCAP2_SUP_LNKS32) != 0) {
1043 return PCIE_SPEED_32_0GT;
1044 }
1045 if ((lcap2 & PCIE_LCAP2_SUP_LNKS16) != 0) {
1046 return PCIE_SPEED_16_0GT;
1047 }
1048 if ((lcap2 & PCIE_LCAP2_SUP_LNKS8) != 0) {
1049 return PCIE_SPEED_8_0GT;
1050 }
1051 if ((lcap2 & PCIE_LCAP2_SUP_LNKS5) != 0) {
1052 return PCIE_SPEED_5_0GT;
1053 }
1054 if ((lcap2 & PCIE_LCAP2_SUP_LNKS2) != 0) {
1055 return PCIE_SPEED_2_5GT;
1056 }
1057 }
1058 }
1059
1060 lcap = pci_conf_read(pc, tag, off + PCIE_LCAP);
1061 if ((lcap & PCIE_LCAP_MAX_SPEED) == PCIE_LCAP_MAX_SPEED_64) {
1062 return PCIE_SPEED_64_0GT;
1063 }
1064 if ((lcap & PCIE_LCAP_MAX_SPEED) == PCIE_LCAP_MAX_SPEED_32) {
1065 return PCIE_SPEED_32_0GT;
1066 }
1067 if ((lcap & PCIE_LCAP_MAX_SPEED) == PCIE_LCAP_MAX_SPEED_16) {
1068 return PCIE_SPEED_16_0GT;
1069 }
1070 if ((lcap & PCIE_LCAP_MAX_SPEED) == PCIE_LCAP_MAX_SPEED_8) {
1071 return PCIE_SPEED_8_0GT;
1072 }
1073 if ((lcap & PCIE_LCAP_MAX_SPEED) == PCIE_LCAP_MAX_SPEED_5) {
1074 return PCIE_SPEED_5_0GT;
1075 }
1076 if ((lcap & PCIE_LCAP_MAX_SPEED) == PCIE_LCAP_MAX_SPEED_2) {
1077 return PCIE_SPEED_2_5GT;
1078 }
1079
1080 return PCI_SPEED_UNKNOWN;
1081 }
1082
1083 /*
1084 * This should walk the tree, it only checks this device currently.
1085 * It also does not write to limiting_dev (the only caller in drm2
1086 * currently does not use it.)
1087 */
1088 unsigned
pcie_bandwidth_available(struct pci_dev * dev,struct pci_dev ** limiting_dev,enum pci_bus_speed * speed,enum pcie_link_width * width)1089 pcie_bandwidth_available(struct pci_dev *dev,
1090 struct pci_dev **limiting_dev,
1091 enum pci_bus_speed *speed,
1092 enum pcie_link_width *width)
1093 {
1094 pci_chipset_tag_t pc = dev->pd_pa.pa_pc;
1095 pcitag_t tag = dev->pd_pa.pa_tag;
1096 pcireg_t lcsr;
1097 unsigned per_line_speed, num_lanes;
1098 int off;
1099
1100 /* Must have capabilities. */
1101 if (pci_get_capability(pc, tag, PCI_CAP_PCIEXPRESS, &off, NULL) == 0)
1102 return 0;
1103
1104 if (speed)
1105 *speed = PCI_SPEED_UNKNOWN;
1106 if (width)
1107 *width = 0;
1108
1109 lcsr = pci_conf_read(pc, tag, off + PCIE_LCSR);
1110
1111 switch (lcsr & PCIE_LCSR_NLW) {
1112 case PCIE_LCSR_NLW_X1:
1113 case PCIE_LCSR_NLW_X2:
1114 case PCIE_LCSR_NLW_X4:
1115 case PCIE_LCSR_NLW_X8:
1116 case PCIE_LCSR_NLW_X12:
1117 case PCIE_LCSR_NLW_X16:
1118 case PCIE_LCSR_NLW_X32:
1119 num_lanes = __SHIFTOUT(lcsr, PCIE_LCSR_NLW);
1120 if (width)
1121 *width = num_lanes;
1122 break;
1123 default:
1124 num_lanes = 0;
1125 break;
1126 }
1127
1128 switch (__SHIFTOUT(lcsr, PCIE_LCSR_LINKSPEED)) {
1129 case PCIE_LCSR_LINKSPEED_2:
1130 *speed = PCIE_SPEED_2_5GT;
1131 per_line_speed = 2500 * 8 / 10;
1132 break;
1133 case PCIE_LCSR_LINKSPEED_5:
1134 *speed = PCIE_SPEED_5_0GT;
1135 per_line_speed = 5000 * 8 / 10;
1136 break;
1137 case PCIE_LCSR_LINKSPEED_8:
1138 *speed = PCIE_SPEED_8_0GT;
1139 per_line_speed = 8000 * 128 / 130;
1140 break;
1141 case PCIE_LCSR_LINKSPEED_16:
1142 *speed = PCIE_SPEED_16_0GT;
1143 per_line_speed = 16000 * 128 / 130;
1144 break;
1145 case PCIE_LCSR_LINKSPEED_32:
1146 *speed = PCIE_SPEED_32_0GT;
1147 per_line_speed = 32000 * 128 / 130;
1148 break;
1149 case PCIE_LCSR_LINKSPEED_64:
1150 *speed = PCIE_SPEED_64_0GT;
1151 per_line_speed = 64000 * 128 / 130;
1152 break;
1153 default:
1154 per_line_speed = 0;
1155 }
1156
1157 return num_lanes * per_line_speed;
1158 }
1159