mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-23 20:53:53 +08:00
2ca78d23a7
Clean up properly if pci_set_consistent_dma_mask() fails. Signed-off-by: Jason Gunthorpe <jgunthorpe@obsidianresearch.com> Signed-off-by: Roland Dreier <rolandd@cisco.com>
745 lines
20 KiB
C
745 lines
20 KiB
C
/*
|
|
* Copyright (c) 2008, 2009 QLogic Corporation. All rights reserved.
|
|
*
|
|
* This software is available to you under a choice of one of two
|
|
* licenses. You may choose to be licensed under the terms of the GNU
|
|
* General Public License (GPL) Version 2, available from the file
|
|
* COPYING in the main directory of this source tree, or the
|
|
* OpenIB.org BSD license below:
|
|
*
|
|
* Redistribution and use in source and binary forms, with or
|
|
* without modification, are permitted provided that the following
|
|
* conditions are met:
|
|
*
|
|
* - Redistributions of source code must retain the above
|
|
* copyright notice, this list of conditions and the following
|
|
* disclaimer.
|
|
*
|
|
* - Redistributions in binary form must reproduce the above
|
|
* copyright notice, this list of conditions and the following
|
|
* disclaimer in the documentation and/or other materials
|
|
* provided with the distribution.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
|
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
|
|
* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
|
|
* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
|
|
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
* SOFTWARE.
|
|
*/
|
|
|
|
#include <linux/pci.h>
|
|
#include <linux/io.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/vmalloc.h>
|
|
#include <linux/aer.h>
|
|
|
|
#include "qib.h"
|
|
|
|
/*
|
|
* This file contains PCIe utility routines that are common to the
|
|
* various QLogic InfiniPath adapters
|
|
*/
|
|
|
|
/*
|
|
* Code to adjust PCIe capabilities.
|
|
* To minimize the change footprint, we call it
|
|
* from qib_pcie_params, which every chip-specific
|
|
* file calls, even though this violates some
|
|
* expectations of harmlessness.
|
|
*/
|
|
static int qib_tune_pcie_caps(struct qib_devdata *);
|
|
static int qib_tune_pcie_coalesce(struct qib_devdata *);
|
|
|
|
/*
|
|
* Do all the common PCIe setup and initialization.
|
|
* devdata is not yet allocated, and is not allocated until after this
|
|
* routine returns success. Therefore qib_dev_err() can't be used for error
|
|
* printing.
|
|
*/
|
|
int qib_pcie_init(struct pci_dev *pdev, const struct pci_device_id *ent)
|
|
{
|
|
int ret;
|
|
|
|
ret = pci_enable_device(pdev);
|
|
if (ret) {
|
|
/*
|
|
* This can happen (in theory) iff:
|
|
* We did a chip reset, and then failed to reprogram the
|
|
* BAR, or the chip reset due to an internal error. We then
|
|
* unloaded the driver and reloaded it.
|
|
*
|
|
* Both reset cases set the BAR back to initial state. For
|
|
* the latter case, the AER sticky error bit at offset 0x718
|
|
* should be set, but the Linux kernel doesn't yet know
|
|
* about that, it appears. If the original BAR was retained
|
|
* in the kernel data structures, this may be OK.
|
|
*/
|
|
qib_early_err(&pdev->dev, "pci enable failed: error %d\n",
|
|
-ret);
|
|
goto done;
|
|
}
|
|
|
|
ret = pci_request_regions(pdev, QIB_DRV_NAME);
|
|
if (ret) {
|
|
qib_devinfo(pdev, "pci_request_regions fails: err %d\n", -ret);
|
|
goto bail;
|
|
}
|
|
|
|
ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(64));
|
|
if (ret) {
|
|
/*
|
|
* If the 64 bit setup fails, try 32 bit. Some systems
|
|
* do not setup 64 bit maps on systems with 2GB or less
|
|
* memory installed.
|
|
*/
|
|
ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
|
|
if (ret) {
|
|
qib_devinfo(pdev, "Unable to set DMA mask: %d\n", ret);
|
|
goto bail;
|
|
}
|
|
ret = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
|
|
} else
|
|
ret = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64));
|
|
if (ret) {
|
|
qib_early_err(&pdev->dev,
|
|
"Unable to set DMA consistent mask: %d\n", ret);
|
|
goto bail;
|
|
}
|
|
|
|
pci_set_master(pdev);
|
|
ret = pci_enable_pcie_error_reporting(pdev);
|
|
if (ret) {
|
|
qib_early_err(&pdev->dev,
|
|
"Unable to enable pcie error reporting: %d\n",
|
|
ret);
|
|
ret = 0;
|
|
}
|
|
goto done;
|
|
|
|
bail:
|
|
pci_disable_device(pdev);
|
|
pci_release_regions(pdev);
|
|
done:
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Do remaining PCIe setup, once dd is allocated, and save away
|
|
* fields required to re-initialize after a chip reset, or for
|
|
* various other purposes
|
|
*/
|
|
int qib_pcie_ddinit(struct qib_devdata *dd, struct pci_dev *pdev,
|
|
const struct pci_device_id *ent)
|
|
{
|
|
unsigned long len;
|
|
resource_size_t addr;
|
|
|
|
dd->pcidev = pdev;
|
|
pci_set_drvdata(pdev, dd);
|
|
|
|
addr = pci_resource_start(pdev, 0);
|
|
len = pci_resource_len(pdev, 0);
|
|
|
|
#if defined(__powerpc__)
|
|
/* There isn't a generic way to specify writethrough mappings */
|
|
dd->kregbase = __ioremap(addr, len, _PAGE_NO_CACHE | _PAGE_WRITETHRU);
|
|
#else
|
|
dd->kregbase = ioremap_nocache(addr, len);
|
|
#endif
|
|
|
|
if (!dd->kregbase)
|
|
return -ENOMEM;
|
|
|
|
dd->kregend = (u64 __iomem *)((void __iomem *) dd->kregbase + len);
|
|
dd->physaddr = addr; /* used for io_remap, etc. */
|
|
|
|
/*
|
|
* Save BARs to rewrite after device reset. Save all 64 bits of
|
|
* BAR, just in case.
|
|
*/
|
|
dd->pcibar0 = addr;
|
|
dd->pcibar1 = addr >> 32;
|
|
dd->deviceid = ent->device; /* save for later use */
|
|
dd->vendorid = ent->vendor;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Do PCIe cleanup, after chip-specific cleanup, etc. Just prior
|
|
* to releasing the dd memory.
|
|
* void because none of the core pcie cleanup returns are void
|
|
*/
|
|
void qib_pcie_ddcleanup(struct qib_devdata *dd)
|
|
{
|
|
u64 __iomem *base = (void __iomem *) dd->kregbase;
|
|
|
|
dd->kregbase = NULL;
|
|
iounmap(base);
|
|
if (dd->piobase)
|
|
iounmap(dd->piobase);
|
|
if (dd->userbase)
|
|
iounmap(dd->userbase);
|
|
if (dd->piovl15base)
|
|
iounmap(dd->piovl15base);
|
|
|
|
pci_disable_device(dd->pcidev);
|
|
pci_release_regions(dd->pcidev);
|
|
|
|
pci_set_drvdata(dd->pcidev, NULL);
|
|
}
|
|
|
|
static void qib_msix_setup(struct qib_devdata *dd, int pos, u32 *msixcnt,
|
|
struct msix_entry *msix_entry)
|
|
{
|
|
int ret;
|
|
u32 tabsize = 0;
|
|
u16 msix_flags;
|
|
|
|
pci_read_config_word(dd->pcidev, pos + PCI_MSIX_FLAGS, &msix_flags);
|
|
tabsize = 1 + (msix_flags & PCI_MSIX_FLAGS_QSIZE);
|
|
if (tabsize > *msixcnt)
|
|
tabsize = *msixcnt;
|
|
ret = pci_enable_msix(dd->pcidev, msix_entry, tabsize);
|
|
if (ret > 0) {
|
|
tabsize = ret;
|
|
ret = pci_enable_msix(dd->pcidev, msix_entry, tabsize);
|
|
}
|
|
if (ret) {
|
|
qib_dev_err(dd, "pci_enable_msix %d vectors failed: %d, "
|
|
"falling back to INTx\n", tabsize, ret);
|
|
tabsize = 0;
|
|
}
|
|
*msixcnt = tabsize;
|
|
|
|
if (ret)
|
|
qib_enable_intx(dd->pcidev);
|
|
|
|
}
|
|
|
|
/**
|
|
* We save the msi lo and hi values, so we can restore them after
|
|
* chip reset (the kernel PCI infrastructure doesn't yet handle that
|
|
* correctly.
|
|
*/
|
|
static int qib_msi_setup(struct qib_devdata *dd, int pos)
|
|
{
|
|
struct pci_dev *pdev = dd->pcidev;
|
|
u16 control;
|
|
int ret;
|
|
|
|
ret = pci_enable_msi(pdev);
|
|
if (ret)
|
|
qib_dev_err(dd, "pci_enable_msi failed: %d, "
|
|
"interrupts may not work\n", ret);
|
|
/* continue even if it fails, we may still be OK... */
|
|
|
|
pci_read_config_dword(pdev, pos + PCI_MSI_ADDRESS_LO,
|
|
&dd->msi_lo);
|
|
pci_read_config_dword(pdev, pos + PCI_MSI_ADDRESS_HI,
|
|
&dd->msi_hi);
|
|
pci_read_config_word(pdev, pos + PCI_MSI_FLAGS, &control);
|
|
/* now save the data (vector) info */
|
|
pci_read_config_word(pdev, pos + ((control & PCI_MSI_FLAGS_64BIT)
|
|
? 12 : 8),
|
|
&dd->msi_data);
|
|
return ret;
|
|
}
|
|
|
|
int qib_pcie_params(struct qib_devdata *dd, u32 minw, u32 *nent,
|
|
struct msix_entry *entry)
|
|
{
|
|
u16 linkstat, speed;
|
|
int pos = 0, pose, ret = 1;
|
|
|
|
pose = pci_find_capability(dd->pcidev, PCI_CAP_ID_EXP);
|
|
if (!pose) {
|
|
qib_dev_err(dd, "Can't find PCI Express capability!\n");
|
|
/* set up something... */
|
|
dd->lbus_width = 1;
|
|
dd->lbus_speed = 2500; /* Gen1, 2.5GHz */
|
|
goto bail;
|
|
}
|
|
|
|
pos = pci_find_capability(dd->pcidev, PCI_CAP_ID_MSIX);
|
|
if (nent && *nent && pos) {
|
|
qib_msix_setup(dd, pos, nent, entry);
|
|
ret = 0; /* did it, either MSIx or INTx */
|
|
} else {
|
|
pos = pci_find_capability(dd->pcidev, PCI_CAP_ID_MSI);
|
|
if (pos)
|
|
ret = qib_msi_setup(dd, pos);
|
|
else
|
|
qib_dev_err(dd, "No PCI MSI or MSIx capability!\n");
|
|
}
|
|
if (!pos)
|
|
qib_enable_intx(dd->pcidev);
|
|
|
|
pci_read_config_word(dd->pcidev, pose + PCI_EXP_LNKSTA, &linkstat);
|
|
/*
|
|
* speed is bits 0-3, linkwidth is bits 4-8
|
|
* no defines for them in headers
|
|
*/
|
|
speed = linkstat & 0xf;
|
|
linkstat >>= 4;
|
|
linkstat &= 0x1f;
|
|
dd->lbus_width = linkstat;
|
|
|
|
switch (speed) {
|
|
case 1:
|
|
dd->lbus_speed = 2500; /* Gen1, 2.5GHz */
|
|
break;
|
|
case 2:
|
|
dd->lbus_speed = 5000; /* Gen1, 5GHz */
|
|
break;
|
|
default: /* not defined, assume gen1 */
|
|
dd->lbus_speed = 2500;
|
|
break;
|
|
}
|
|
|
|
/*
|
|
* Check against expected pcie width and complain if "wrong"
|
|
* on first initialization, not afterwards (i.e., reset).
|
|
*/
|
|
if (minw && linkstat < minw)
|
|
qib_dev_err(dd,
|
|
"PCIe width %u (x%u HCA), performance reduced\n",
|
|
linkstat, minw);
|
|
|
|
qib_tune_pcie_caps(dd);
|
|
|
|
qib_tune_pcie_coalesce(dd);
|
|
|
|
bail:
|
|
/* fill in string, even on errors */
|
|
snprintf(dd->lbus_info, sizeof(dd->lbus_info),
|
|
"PCIe,%uMHz,x%u\n", dd->lbus_speed, dd->lbus_width);
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Setup pcie interrupt stuff again after a reset. I'd like to just call
|
|
* pci_enable_msi() again for msi, but when I do that,
|
|
* the MSI enable bit doesn't get set in the command word, and
|
|
* we switch to to a different interrupt vector, which is confusing,
|
|
* so I instead just do it all inline. Perhaps somehow can tie this
|
|
* into the PCIe hotplug support at some point
|
|
*/
|
|
int qib_reinit_intr(struct qib_devdata *dd)
|
|
{
|
|
int pos;
|
|
u16 control;
|
|
int ret = 0;
|
|
|
|
/* If we aren't using MSI, don't restore it */
|
|
if (!dd->msi_lo)
|
|
goto bail;
|
|
|
|
pos = pci_find_capability(dd->pcidev, PCI_CAP_ID_MSI);
|
|
if (!pos) {
|
|
qib_dev_err(dd, "Can't find MSI capability, "
|
|
"can't restore MSI settings\n");
|
|
ret = 0;
|
|
/* nothing special for MSIx, just MSI */
|
|
goto bail;
|
|
}
|
|
pci_write_config_dword(dd->pcidev, pos + PCI_MSI_ADDRESS_LO,
|
|
dd->msi_lo);
|
|
pci_write_config_dword(dd->pcidev, pos + PCI_MSI_ADDRESS_HI,
|
|
dd->msi_hi);
|
|
pci_read_config_word(dd->pcidev, pos + PCI_MSI_FLAGS, &control);
|
|
if (!(control & PCI_MSI_FLAGS_ENABLE)) {
|
|
control |= PCI_MSI_FLAGS_ENABLE;
|
|
pci_write_config_word(dd->pcidev, pos + PCI_MSI_FLAGS,
|
|
control);
|
|
}
|
|
/* now rewrite the data (vector) info */
|
|
pci_write_config_word(dd->pcidev, pos +
|
|
((control & PCI_MSI_FLAGS_64BIT) ? 12 : 8),
|
|
dd->msi_data);
|
|
ret = 1;
|
|
bail:
|
|
if (!ret && (dd->flags & QIB_HAS_INTX)) {
|
|
qib_enable_intx(dd->pcidev);
|
|
ret = 1;
|
|
}
|
|
|
|
/* and now set the pci master bit again */
|
|
pci_set_master(dd->pcidev);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Disable msi interrupt if enabled, and clear msi_lo.
|
|
* This is used primarily for the fallback to INTx, but
|
|
* is also used in reinit after reset, and during cleanup.
|
|
*/
|
|
void qib_nomsi(struct qib_devdata *dd)
|
|
{
|
|
dd->msi_lo = 0;
|
|
pci_disable_msi(dd->pcidev);
|
|
}
|
|
|
|
/*
|
|
* Same as qib_nosmi, but for MSIx.
|
|
*/
|
|
void qib_nomsix(struct qib_devdata *dd)
|
|
{
|
|
pci_disable_msix(dd->pcidev);
|
|
}
|
|
|
|
/*
|
|
* Similar to pci_intx(pdev, 1), except that we make sure
|
|
* msi(x) is off.
|
|
*/
|
|
void qib_enable_intx(struct pci_dev *pdev)
|
|
{
|
|
u16 cw, new;
|
|
int pos;
|
|
|
|
/* first, turn on INTx */
|
|
pci_read_config_word(pdev, PCI_COMMAND, &cw);
|
|
new = cw & ~PCI_COMMAND_INTX_DISABLE;
|
|
if (new != cw)
|
|
pci_write_config_word(pdev, PCI_COMMAND, new);
|
|
|
|
pos = pci_find_capability(pdev, PCI_CAP_ID_MSI);
|
|
if (pos) {
|
|
/* then turn off MSI */
|
|
pci_read_config_word(pdev, pos + PCI_MSI_FLAGS, &cw);
|
|
new = cw & ~PCI_MSI_FLAGS_ENABLE;
|
|
if (new != cw)
|
|
pci_write_config_word(pdev, pos + PCI_MSI_FLAGS, new);
|
|
}
|
|
pos = pci_find_capability(pdev, PCI_CAP_ID_MSIX);
|
|
if (pos) {
|
|
/* then turn off MSIx */
|
|
pci_read_config_word(pdev, pos + PCI_MSIX_FLAGS, &cw);
|
|
new = cw & ~PCI_MSIX_FLAGS_ENABLE;
|
|
if (new != cw)
|
|
pci_write_config_word(pdev, pos + PCI_MSIX_FLAGS, new);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* These two routines are helper routines for the device reset code
|
|
* to move all the pcie code out of the chip-specific driver code.
|
|
*/
|
|
void qib_pcie_getcmd(struct qib_devdata *dd, u16 *cmd, u8 *iline, u8 *cline)
|
|
{
|
|
pci_read_config_word(dd->pcidev, PCI_COMMAND, cmd);
|
|
pci_read_config_byte(dd->pcidev, PCI_INTERRUPT_LINE, iline);
|
|
pci_read_config_byte(dd->pcidev, PCI_CACHE_LINE_SIZE, cline);
|
|
}
|
|
|
|
void qib_pcie_reenable(struct qib_devdata *dd, u16 cmd, u8 iline, u8 cline)
|
|
{
|
|
int r;
|
|
r = pci_write_config_dword(dd->pcidev, PCI_BASE_ADDRESS_0,
|
|
dd->pcibar0);
|
|
if (r)
|
|
qib_dev_err(dd, "rewrite of BAR0 failed: %d\n", r);
|
|
r = pci_write_config_dword(dd->pcidev, PCI_BASE_ADDRESS_1,
|
|
dd->pcibar1);
|
|
if (r)
|
|
qib_dev_err(dd, "rewrite of BAR1 failed: %d\n", r);
|
|
/* now re-enable memory access, and restore cosmetic settings */
|
|
pci_write_config_word(dd->pcidev, PCI_COMMAND, cmd);
|
|
pci_write_config_byte(dd->pcidev, PCI_INTERRUPT_LINE, iline);
|
|
pci_write_config_byte(dd->pcidev, PCI_CACHE_LINE_SIZE, cline);
|
|
r = pci_enable_device(dd->pcidev);
|
|
if (r)
|
|
qib_dev_err(dd, "pci_enable_device failed after "
|
|
"reset: %d\n", r);
|
|
}
|
|
|
|
/* code to adjust PCIe capabilities. */
|
|
|
|
static int fld2val(int wd, int mask)
|
|
{
|
|
int lsbmask;
|
|
|
|
if (!mask)
|
|
return 0;
|
|
wd &= mask;
|
|
lsbmask = mask ^ (mask & (mask - 1));
|
|
wd /= lsbmask;
|
|
return wd;
|
|
}
|
|
|
|
static int val2fld(int wd, int mask)
|
|
{
|
|
int lsbmask;
|
|
|
|
if (!mask)
|
|
return 0;
|
|
lsbmask = mask ^ (mask & (mask - 1));
|
|
wd *= lsbmask;
|
|
return wd;
|
|
}
|
|
|
|
static int qib_pcie_coalesce;
|
|
module_param_named(pcie_coalesce, qib_pcie_coalesce, int, S_IRUGO);
|
|
MODULE_PARM_DESC(pcie_coalesce, "tune PCIe colescing on some Intel chipsets");
|
|
|
|
/*
|
|
* Enable PCIe completion and data coalescing, on Intel 5x00 and 7300
|
|
* chipsets. This is known to be unsafe for some revisions of some
|
|
* of these chipsets, with some BIOS settings, and enabling it on those
|
|
* systems may result in the system crashing, and/or data corruption.
|
|
*/
|
|
static int qib_tune_pcie_coalesce(struct qib_devdata *dd)
|
|
{
|
|
int r;
|
|
struct pci_dev *parent;
|
|
int ppos;
|
|
u16 devid;
|
|
u32 mask, bits, val;
|
|
|
|
if (!qib_pcie_coalesce)
|
|
return 0;
|
|
|
|
/* Find out supported and configured values for parent (root) */
|
|
parent = dd->pcidev->bus->self;
|
|
if (parent->bus->parent) {
|
|
qib_devinfo(dd->pcidev, "Parent not root\n");
|
|
return 1;
|
|
}
|
|
ppos = pci_find_capability(parent, PCI_CAP_ID_EXP);
|
|
if (!ppos)
|
|
return 1;
|
|
if (parent->vendor != 0x8086)
|
|
return 1;
|
|
|
|
/*
|
|
* - bit 12: Max_rdcmp_Imt_EN: need to set to 1
|
|
* - bit 11: COALESCE_FORCE: need to set to 0
|
|
* - bit 10: COALESCE_EN: need to set to 1
|
|
* (but limitations on some on some chipsets)
|
|
*
|
|
* On the Intel 5000, 5100, and 7300 chipsets, there is
|
|
* also: - bit 25:24: COALESCE_MODE, need to set to 0
|
|
*/
|
|
devid = parent->device;
|
|
if (devid >= 0x25e2 && devid <= 0x25fa) {
|
|
u8 rev;
|
|
|
|
/* 5000 P/V/X/Z */
|
|
pci_read_config_byte(parent, PCI_REVISION_ID, &rev);
|
|
if (rev <= 0xb2)
|
|
bits = 1U << 10;
|
|
else
|
|
bits = 7U << 10;
|
|
mask = (3U << 24) | (7U << 10);
|
|
} else if (devid >= 0x65e2 && devid <= 0x65fa) {
|
|
/* 5100 */
|
|
bits = 1U << 10;
|
|
mask = (3U << 24) | (7U << 10);
|
|
} else if (devid >= 0x4021 && devid <= 0x402e) {
|
|
/* 5400 */
|
|
bits = 7U << 10;
|
|
mask = 7U << 10;
|
|
} else if (devid >= 0x3604 && devid <= 0x360a) {
|
|
/* 7300 */
|
|
bits = 7U << 10;
|
|
mask = (3U << 24) | (7U << 10);
|
|
} else {
|
|
/* not one of the chipsets that we know about */
|
|
return 1;
|
|
}
|
|
pci_read_config_dword(parent, 0x48, &val);
|
|
val &= ~mask;
|
|
val |= bits;
|
|
r = pci_write_config_dword(parent, 0x48, val);
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* BIOS may not set PCIe bus-utilization parameters for best performance.
|
|
* Check and optionally adjust them to maximize our throughput.
|
|
*/
|
|
static int qib_pcie_caps;
|
|
module_param_named(pcie_caps, qib_pcie_caps, int, S_IRUGO);
|
|
MODULE_PARM_DESC(pcie_caps, "Max PCIe tuning: Payload (4lsb), ReadReq (D4..7)");
|
|
|
|
static int qib_tune_pcie_caps(struct qib_devdata *dd)
|
|
{
|
|
int ret = 1; /* Assume the worst */
|
|
struct pci_dev *parent;
|
|
int ppos, epos;
|
|
u16 pcaps, pctl, ecaps, ectl;
|
|
int rc_sup, ep_sup;
|
|
int rc_cur, ep_cur;
|
|
|
|
/* Find out supported and configured values for parent (root) */
|
|
parent = dd->pcidev->bus->self;
|
|
if (parent->bus->parent) {
|
|
qib_devinfo(dd->pcidev, "Parent not root\n");
|
|
goto bail;
|
|
}
|
|
ppos = pci_find_capability(parent, PCI_CAP_ID_EXP);
|
|
if (ppos) {
|
|
pci_read_config_word(parent, ppos + PCI_EXP_DEVCAP, &pcaps);
|
|
pci_read_config_word(parent, ppos + PCI_EXP_DEVCTL, &pctl);
|
|
} else
|
|
goto bail;
|
|
/* Find out supported and configured values for endpoint (us) */
|
|
epos = pci_find_capability(dd->pcidev, PCI_CAP_ID_EXP);
|
|
if (epos) {
|
|
pci_read_config_word(dd->pcidev, epos + PCI_EXP_DEVCAP, &ecaps);
|
|
pci_read_config_word(dd->pcidev, epos + PCI_EXP_DEVCTL, &ectl);
|
|
} else
|
|
goto bail;
|
|
ret = 0;
|
|
/* Find max payload supported by root, endpoint */
|
|
rc_sup = fld2val(pcaps, PCI_EXP_DEVCAP_PAYLOAD);
|
|
ep_sup = fld2val(ecaps, PCI_EXP_DEVCAP_PAYLOAD);
|
|
if (rc_sup > ep_sup)
|
|
rc_sup = ep_sup;
|
|
|
|
rc_cur = fld2val(pctl, PCI_EXP_DEVCTL_PAYLOAD);
|
|
ep_cur = fld2val(ectl, PCI_EXP_DEVCTL_PAYLOAD);
|
|
|
|
/* If Supported greater than limit in module param, limit it */
|
|
if (rc_sup > (qib_pcie_caps & 7))
|
|
rc_sup = qib_pcie_caps & 7;
|
|
/* If less than (allowed, supported), bump root payload */
|
|
if (rc_sup > rc_cur) {
|
|
rc_cur = rc_sup;
|
|
pctl = (pctl & ~PCI_EXP_DEVCTL_PAYLOAD) |
|
|
val2fld(rc_cur, PCI_EXP_DEVCTL_PAYLOAD);
|
|
pci_write_config_word(parent, ppos + PCI_EXP_DEVCTL, pctl);
|
|
}
|
|
/* If less than (allowed, supported), bump endpoint payload */
|
|
if (rc_sup > ep_cur) {
|
|
ep_cur = rc_sup;
|
|
ectl = (ectl & ~PCI_EXP_DEVCTL_PAYLOAD) |
|
|
val2fld(ep_cur, PCI_EXP_DEVCTL_PAYLOAD);
|
|
pci_write_config_word(dd->pcidev, epos + PCI_EXP_DEVCTL, ectl);
|
|
}
|
|
|
|
/*
|
|
* Now the Read Request size.
|
|
* No field for max supported, but PCIe spec limits it to 4096,
|
|
* which is code '5' (log2(4096) - 7)
|
|
*/
|
|
rc_sup = 5;
|
|
if (rc_sup > ((qib_pcie_caps >> 4) & 7))
|
|
rc_sup = (qib_pcie_caps >> 4) & 7;
|
|
rc_cur = fld2val(pctl, PCI_EXP_DEVCTL_READRQ);
|
|
ep_cur = fld2val(ectl, PCI_EXP_DEVCTL_READRQ);
|
|
|
|
if (rc_sup > rc_cur) {
|
|
rc_cur = rc_sup;
|
|
pctl = (pctl & ~PCI_EXP_DEVCTL_READRQ) |
|
|
val2fld(rc_cur, PCI_EXP_DEVCTL_READRQ);
|
|
pci_write_config_word(parent, ppos + PCI_EXP_DEVCTL, pctl);
|
|
}
|
|
if (rc_sup > ep_cur) {
|
|
ep_cur = rc_sup;
|
|
ectl = (ectl & ~PCI_EXP_DEVCTL_READRQ) |
|
|
val2fld(ep_cur, PCI_EXP_DEVCTL_READRQ);
|
|
pci_write_config_word(dd->pcidev, epos + PCI_EXP_DEVCTL, ectl);
|
|
}
|
|
bail:
|
|
return ret;
|
|
}
|
|
/* End of PCIe capability tuning */
|
|
|
|
/*
|
|
* From here through qib_pci_err_handler definition is invoked via
|
|
* PCI error infrastructure, registered via pci
|
|
*/
|
|
static pci_ers_result_t
|
|
qib_pci_error_detected(struct pci_dev *pdev, pci_channel_state_t state)
|
|
{
|
|
struct qib_devdata *dd = pci_get_drvdata(pdev);
|
|
pci_ers_result_t ret = PCI_ERS_RESULT_RECOVERED;
|
|
|
|
switch (state) {
|
|
case pci_channel_io_normal:
|
|
qib_devinfo(pdev, "State Normal, ignoring\n");
|
|
break;
|
|
|
|
case pci_channel_io_frozen:
|
|
qib_devinfo(pdev, "State Frozen, requesting reset\n");
|
|
pci_disable_device(pdev);
|
|
ret = PCI_ERS_RESULT_NEED_RESET;
|
|
break;
|
|
|
|
case pci_channel_io_perm_failure:
|
|
qib_devinfo(pdev, "State Permanent Failure, disabling\n");
|
|
if (dd) {
|
|
/* no more register accesses! */
|
|
dd->flags &= ~QIB_PRESENT;
|
|
qib_disable_after_error(dd);
|
|
}
|
|
/* else early, or other problem */
|
|
ret = PCI_ERS_RESULT_DISCONNECT;
|
|
break;
|
|
|
|
default: /* shouldn't happen */
|
|
qib_devinfo(pdev, "QIB PCI errors detected (state %d)\n",
|
|
state);
|
|
break;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static pci_ers_result_t
|
|
qib_pci_mmio_enabled(struct pci_dev *pdev)
|
|
{
|
|
u64 words = 0U;
|
|
struct qib_devdata *dd = pci_get_drvdata(pdev);
|
|
pci_ers_result_t ret = PCI_ERS_RESULT_RECOVERED;
|
|
|
|
if (dd && dd->pport) {
|
|
words = dd->f_portcntr(dd->pport, QIBPORTCNTR_WORDRCV);
|
|
if (words == ~0ULL)
|
|
ret = PCI_ERS_RESULT_NEED_RESET;
|
|
}
|
|
qib_devinfo(pdev, "QIB mmio_enabled function called, "
|
|
"read wordscntr %Lx, returning %d\n", words, ret);
|
|
return ret;
|
|
}
|
|
|
|
static pci_ers_result_t
|
|
qib_pci_slot_reset(struct pci_dev *pdev)
|
|
{
|
|
qib_devinfo(pdev, "QIB link_reset function called, ignored\n");
|
|
return PCI_ERS_RESULT_CAN_RECOVER;
|
|
}
|
|
|
|
static pci_ers_result_t
|
|
qib_pci_link_reset(struct pci_dev *pdev)
|
|
{
|
|
qib_devinfo(pdev, "QIB link_reset function called, ignored\n");
|
|
return PCI_ERS_RESULT_CAN_RECOVER;
|
|
}
|
|
|
|
static void
|
|
qib_pci_resume(struct pci_dev *pdev)
|
|
{
|
|
struct qib_devdata *dd = pci_get_drvdata(pdev);
|
|
qib_devinfo(pdev, "QIB resume function called\n");
|
|
pci_cleanup_aer_uncorrect_error_status(pdev);
|
|
/*
|
|
* Running jobs will fail, since it's asynchronous
|
|
* unlike sysfs-requested reset. Better than
|
|
* doing nothing.
|
|
*/
|
|
qib_init(dd, 1); /* same as re-init after reset */
|
|
}
|
|
|
|
struct pci_error_handlers qib_pci_err_handler = {
|
|
.error_detected = qib_pci_error_detected,
|
|
.mmio_enabled = qib_pci_mmio_enabled,
|
|
.link_reset = qib_pci_link_reset,
|
|
.slot_reset = qib_pci_slot_reset,
|
|
.resume = qib_pci_resume,
|
|
};
|