/*
 * Copyright (c) 2006, 2007, 2008, 2009, 2010 QLogic Corporation.
 * All rights reserved.
 * Copyright (c) 2003, 2004, 2005, 2006 PathScale, Inc. 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.
 */
/*
 * This file contains all of the code that is specific to the
 * QLogic_IB 7220 chip (except that specific to the SerDes)
 */

#include <linux/interrupt.h>
#include <linux/pci.h>
#include <linux/delay.h>
#include <linux/module.h>
#include <linux/io.h>
#include <rdma/ib_verbs.h>

#include "qib.h"
#include "qib_7220.h"

static void qib_setup_7220_setextled(struct qib_pportdata *, u32);
static void qib_7220_handle_hwerrors(struct qib_devdata *, char *, size_t);
static void sendctrl_7220_mod(struct qib_pportdata *ppd, u32 op);
static u32 qib_7220_iblink_state(u64);
static u8 qib_7220_phys_portstate(u64);
static void qib_sdma_update_7220_tail(struct qib_pportdata *, u16);
static void qib_set_ib_7220_lstate(struct qib_pportdata *, u16, u16);

/*
 * This file contains almost all the chip-specific register information and
 * access functions for the QLogic QLogic_IB 7220 PCI-Express chip, with the
 * exception of SerDes support, which in in qib_sd7220.c.
 */

/* Below uses machine-generated qib_chipnum_regs.h file */
#define KREG_IDX(regname) (QIB_7220_##regname##_OFFS / sizeof(u64))

/* Use defines to tie machine-generated names to lower-case names */
#define kr_control KREG_IDX(Control)
#define kr_counterregbase KREG_IDX(CntrRegBase)
#define kr_errclear KREG_IDX(ErrClear)
#define kr_errmask KREG_IDX(ErrMask)
#define kr_errstatus KREG_IDX(ErrStatus)
#define kr_extctrl KREG_IDX(EXTCtrl)
#define kr_extstatus KREG_IDX(EXTStatus)
#define kr_gpio_clear KREG_IDX(GPIOClear)
#define kr_gpio_mask KREG_IDX(GPIOMask)
#define kr_gpio_out KREG_IDX(GPIOOut)
#define kr_gpio_status KREG_IDX(GPIOStatus)
#define kr_hrtbt_guid KREG_IDX(HRTBT_GUID)
#define kr_hwdiagctrl KREG_IDX(HwDiagCtrl)
#define kr_hwerrclear KREG_IDX(HwErrClear)
#define kr_hwerrmask KREG_IDX(HwErrMask)
#define kr_hwerrstatus KREG_IDX(HwErrStatus)
#define kr_ibcctrl KREG_IDX(IBCCtrl)
#define kr_ibcddrctrl KREG_IDX(IBCDDRCtrl)
#define kr_ibcddrstatus KREG_IDX(IBCDDRStatus)
#define kr_ibcstatus KREG_IDX(IBCStatus)
#define kr_ibserdesctrl KREG_IDX(IBSerDesCtrl)
#define kr_intclear KREG_IDX(IntClear)
#define kr_intmask KREG_IDX(IntMask)
#define kr_intstatus KREG_IDX(IntStatus)
#define kr_ncmodectrl KREG_IDX(IBNCModeCtrl)
#define kr_palign KREG_IDX(PageAlign)
#define kr_partitionkey KREG_IDX(RcvPartitionKey)
#define kr_portcnt KREG_IDX(PortCnt)
#define kr_rcvbthqp KREG_IDX(RcvBTHQP)
#define kr_rcvctrl KREG_IDX(RcvCtrl)
#define kr_rcvegrbase KREG_IDX(RcvEgrBase)
#define kr_rcvegrcnt KREG_IDX(RcvEgrCnt)
#define kr_rcvhdrcnt KREG_IDX(RcvHdrCnt)
#define kr_rcvhdrentsize KREG_IDX(RcvHdrEntSize)
#define kr_rcvhdrsize KREG_IDX(RcvHdrSize)
#define kr_rcvpktledcnt KREG_IDX(RcvPktLEDCnt)
#define kr_rcvtidbase KREG_IDX(RcvTIDBase)
#define kr_rcvtidcnt KREG_IDX(RcvTIDCnt)
#define kr_revision KREG_IDX(Revision)
#define kr_scratch KREG_IDX(Scratch)
#define kr_sendbuffererror KREG_IDX(SendBufErr0)
#define kr_sendctrl KREG_IDX(SendCtrl)
#define kr_senddmabase KREG_IDX(SendDmaBase)
#define kr_senddmabufmask0 KREG_IDX(SendDmaBufMask0)
#define kr_senddmabufmask1 (KREG_IDX(SendDmaBufMask0) + 1)
#define kr_senddmabufmask2 (KREG_IDX(SendDmaBufMask0) + 2)
#define kr_senddmahead KREG_IDX(SendDmaHead)
#define kr_senddmaheadaddr KREG_IDX(SendDmaHeadAddr)
#define kr_senddmalengen KREG_IDX(SendDmaLenGen)
#define kr_senddmastatus KREG_IDX(SendDmaStatus)
#define kr_senddmatail KREG_IDX(SendDmaTail)
#define kr_sendpioavailaddr KREG_IDX(SendBufAvailAddr)
#define kr_sendpiobufbase KREG_IDX(SendBufBase)
#define kr_sendpiobufcnt KREG_IDX(SendBufCnt)
#define kr_sendpiosize KREG_IDX(SendBufSize)
#define kr_sendregbase KREG_IDX(SendRegBase)
#define kr_userregbase KREG_IDX(UserRegBase)
#define kr_xgxs_cfg KREG_IDX(XGXSCfg)

/* These must only be written via qib_write_kreg_ctxt() */
#define kr_rcvhdraddr KREG_IDX(RcvHdrAddr0)
#define kr_rcvhdrtailaddr KREG_IDX(RcvHdrTailAddr0)


#define CREG_IDX(regname) ((QIB_7220_##regname##_OFFS - \
                        QIB_7220_LBIntCnt_OFFS) / sizeof(u64))

#define cr_badformat CREG_IDX(RxVersionErrCnt)
#define cr_erricrc CREG_IDX(RxICRCErrCnt)
#define cr_errlink CREG_IDX(RxLinkMalformCnt)
#define cr_errlpcrc CREG_IDX(RxLPCRCErrCnt)
#define cr_errpkey CREG_IDX(RxPKeyMismatchCnt)
#define cr_rcvflowctrl_err CREG_IDX(RxFlowCtrlViolCnt)
#define cr_err_rlen CREG_IDX(RxLenErrCnt)
#define cr_errslen CREG_IDX(TxLenErrCnt)
#define cr_errtidfull CREG_IDX(RxTIDFullErrCnt)
#define cr_errtidvalid CREG_IDX(RxTIDValidErrCnt)
#define cr_errvcrc CREG_IDX(RxVCRCErrCnt)
#define cr_ibstatuschange CREG_IDX(IBStatusChangeCnt)
#define cr_lbint CREG_IDX(LBIntCnt)
#define cr_invalidrlen CREG_IDX(RxMaxMinLenErrCnt)
#define cr_invalidslen CREG_IDX(TxMaxMinLenErrCnt)
#define cr_lbflowstall CREG_IDX(LBFlowStallCnt)
#define cr_pktrcv CREG_IDX(RxDataPktCnt)
#define cr_pktrcvflowctrl CREG_IDX(RxFlowPktCnt)
#define cr_pktsend CREG_IDX(TxDataPktCnt)
#define cr_pktsendflow CREG_IDX(TxFlowPktCnt)
#define cr_portovfl CREG_IDX(RxP0HdrEgrOvflCnt)
#define cr_rcvebp CREG_IDX(RxEBPCnt)
#define cr_rcvovfl CREG_IDX(RxBufOvflCnt)
#define cr_senddropped CREG_IDX(TxDroppedPktCnt)
#define cr_sendstall CREG_IDX(TxFlowStallCnt)
#define cr_sendunderrun CREG_IDX(TxUnderrunCnt)
#define cr_wordrcv CREG_IDX(RxDwordCnt)
#define cr_wordsend CREG_IDX(TxDwordCnt)
#define cr_txunsupvl CREG_IDX(TxUnsupVLErrCnt)
#define cr_rxdroppkt CREG_IDX(RxDroppedPktCnt)
#define cr_iblinkerrrecov CREG_IDX(IBLinkErrRecoveryCnt)
#define cr_iblinkdown CREG_IDX(IBLinkDownedCnt)
#define cr_ibsymbolerr CREG_IDX(IBSymbolErrCnt)
#define cr_vl15droppedpkt CREG_IDX(RxVL15DroppedPktCnt)
#define cr_rxotherlocalphyerr CREG_IDX(RxOtherLocalPhyErrCnt)
#define cr_excessbufferovfl CREG_IDX(ExcessBufferOvflCnt)
#define cr_locallinkintegrityerr CREG_IDX(LocalLinkIntegrityErrCnt)
#define cr_rxvlerr CREG_IDX(RxVlErrCnt)
#define cr_rxdlidfltr CREG_IDX(RxDlidFltrCnt)
#define cr_psstat CREG_IDX(PSStat)
#define cr_psstart CREG_IDX(PSStart)
#define cr_psinterval CREG_IDX(PSInterval)
#define cr_psrcvdatacount CREG_IDX(PSRcvDataCount)
#define cr_psrcvpktscount CREG_IDX(PSRcvPktsCount)
#define cr_psxmitdatacount CREG_IDX(PSXmitDataCount)
#define cr_psxmitpktscount CREG_IDX(PSXmitPktsCount)
#define cr_psxmitwaitcount CREG_IDX(PSXmitWaitCount)
#define cr_txsdmadesc CREG_IDX(TxSDmaDescCnt)
#define cr_pcieretrydiag CREG_IDX(PcieRetryBufDiagQwordCnt)

#define SYM_RMASK(regname, fldname) ((u64)              \
        QIB_7220_##regname##_##fldname##_RMASK)
#define SYM_MASK(regname, fldname) ((u64)               \
        QIB_7220_##regname##_##fldname##_RMASK <<       \
         QIB_7220_##regname##_##fldname##_LSB)
#define SYM_LSB(regname, fldname) (QIB_7220_##regname##_##fldname##_LSB)
#define SYM_FIELD(value, regname, fldname) ((u64) \
        (((value) >> SYM_LSB(regname, fldname)) & \
         SYM_RMASK(regname, fldname)))
#define ERR_MASK(fldname) SYM_MASK(ErrMask, fldname##Mask)
#define HWE_MASK(fldname) SYM_MASK(HwErrMask, fldname##Mask)

/* ibcctrl bits */
#define QLOGIC_IB_IBCC_LINKINITCMD_DISABLE 1
/* cycle through TS1/TS2 till OK */
#define QLOGIC_IB_IBCC_LINKINITCMD_POLL 2
/* wait for TS1, then go on */
#define QLOGIC_IB_IBCC_LINKINITCMD_SLEEP 3
#define QLOGIC_IB_IBCC_LINKINITCMD_SHIFT 16

#define QLOGIC_IB_IBCC_LINKCMD_DOWN 1           /* move to 0x11 */
#define QLOGIC_IB_IBCC_LINKCMD_ARMED 2          /* move to 0x21 */
#define QLOGIC_IB_IBCC_LINKCMD_ACTIVE 3 /* move to 0x31 */

#define BLOB_7220_IBCHG 0x81

/*
 * We could have a single register get/put routine, that takes a group type,
 * but this is somewhat clearer and cleaner.  It also gives us some error
 * checking.  64 bit register reads should always work, but are inefficient
 * on opteron (the northbridge always generates 2 separate HT 32 bit reads),
 * so we use kreg32 wherever possible.  User register and counter register
 * reads are always 32 bit reads, so only one form of those routines.
 */

/**
 * qib_read_ureg32 - read 32-bit virtualized per-context register
 * @dd: device
 * @regno: register number
 * @ctxt: context number
 *
 * Return the contents of a register that is virtualized to be per context.
 * Returns -1 on errors (not distinguishable from valid contents at
 * runtime; we may add a separate error variable at some point).
 */
static inline u32 qib_read_ureg32(const struct qib_devdata *dd,
                                  enum qib_ureg regno, int ctxt)
{
        if (!dd->kregbase || !(dd->flags & QIB_PRESENT))
                return 0;

        if (dd->userbase)
                return readl(regno + (u64 __iomem *)
                             ((char __iomem *)dd->userbase +
                              dd->ureg_align * ctxt));
        else
                return readl(regno + (u64 __iomem *)
                             (dd->uregbase +
                              (char __iomem *)dd->kregbase +
                              dd->ureg_align * ctxt));
}

/**
 * qib_write_ureg - write 32-bit virtualized per-context register
 * @dd: device
 * @regno: register number
 * @value: value
 * @ctxt: context
 *
 * Write the contents of a register that is virtualized to be per context.
 */
static inline void qib_write_ureg(const struct qib_devdata *dd,
                                  enum qib_ureg regno, u64 value, int ctxt)
{
        u64 __iomem *ubase;

        if (dd->userbase)
                ubase = (u64 __iomem *)
                        ((char __iomem *) dd->userbase +
                         dd->ureg_align * ctxt);
        else
                ubase = (u64 __iomem *)
                        (dd->uregbase +
                         (char __iomem *) dd->kregbase +
                         dd->ureg_align * ctxt);

        if (dd->kregbase && (dd->flags & QIB_PRESENT))
                writeq(value, &ubase[regno]);
}

/**
 * qib_write_kreg_ctxt - write a device's per-ctxt 64-bit kernel register
 * @dd: the qlogic_ib device
 * @regno: the register number to write
 * @ctxt: the context containing the register
 * @value: the value to write
 */
static inline void qib_write_kreg_ctxt(const struct qib_devdata *dd,
                                       const u16 regno, unsigned ctxt,
                                       u64 value)
{
        qib_write_kreg(dd, regno + ctxt, value);
}

static inline void write_7220_creg(const struct qib_devdata *dd,
                                   u16 regno, u64 value)
{
        if (dd->cspec->cregbase && (dd->flags & QIB_PRESENT))
                writeq(value, &dd->cspec->cregbase[regno]);
}

static inline u64 read_7220_creg(const struct qib_devdata *dd, u16 regno)
{
        if (!dd->cspec->cregbase || !(dd->flags & QIB_PRESENT))
                return 0;
        return readq(&dd->cspec->cregbase[regno]);
}

static inline u32 read_7220_creg32(const struct qib_devdata *dd, u16 regno)
{
        if (!dd->cspec->cregbase || !(dd->flags & QIB_PRESENT))
                return 0;
        return readl(&dd->cspec->cregbase[regno]);
}

/* kr_revision bits */
#define QLOGIC_IB_R_EMULATORREV_MASK ((1ULL << 22) - 1)
#define QLOGIC_IB_R_EMULATORREV_SHIFT 40

/* kr_control bits */
#define QLOGIC_IB_C_RESET (1U << 7)

/* kr_intstatus, kr_intclear, kr_intmask bits */
#define QLOGIC_IB_I_RCVURG_MASK ((1ULL << 17) - 1)
#define QLOGIC_IB_I_RCVURG_SHIFT 32
#define QLOGIC_IB_I_RCVAVAIL_MASK ((1ULL << 17) - 1)
#define QLOGIC_IB_I_RCVAVAIL_SHIFT 0
#define QLOGIC_IB_I_SERDESTRIMDONE (1ULL << 27)

#define QLOGIC_IB_C_FREEZEMODE 0x00000002
#define QLOGIC_IB_C_LINKENABLE 0x00000004

#define QLOGIC_IB_I_SDMAINT             0x8000000000000000ULL
#define QLOGIC_IB_I_SDMADISABLED        0x4000000000000000ULL
#define QLOGIC_IB_I_ERROR               0x0000000080000000ULL
#define QLOGIC_IB_I_SPIOSENT            0x0000000040000000ULL
#define QLOGIC_IB_I_SPIOBUFAVAIL        0x0000000020000000ULL
#define QLOGIC_IB_I_GPIO                0x0000000010000000ULL

/* variables for sanity checking interrupt and errors */
#define QLOGIC_IB_I_BITSEXTANT \
                (QLOGIC_IB_I_SDMAINT | QLOGIC_IB_I_SDMADISABLED | \
                (QLOGIC_IB_I_RCVURG_MASK << QLOGIC_IB_I_RCVURG_SHIFT) | \
                (QLOGIC_IB_I_RCVAVAIL_MASK << \
                 QLOGIC_IB_I_RCVAVAIL_SHIFT) | \
                QLOGIC_IB_I_ERROR | QLOGIC_IB_I_SPIOSENT | \
                QLOGIC_IB_I_SPIOBUFAVAIL | QLOGIC_IB_I_GPIO | \
                QLOGIC_IB_I_SERDESTRIMDONE)

#define IB_HWE_BITSEXTANT \
               (HWE_MASK(RXEMemParityErr) | \
                HWE_MASK(TXEMemParityErr) | \
                (QLOGIC_IB_HWE_PCIEMEMPARITYERR_MASK <<  \
                 QLOGIC_IB_HWE_PCIEMEMPARITYERR_SHIFT) | \
                QLOGIC_IB_HWE_PCIE1PLLFAILED | \
                QLOGIC_IB_HWE_PCIE0PLLFAILED | \
                QLOGIC_IB_HWE_PCIEPOISONEDTLP | \
                QLOGIC_IB_HWE_PCIECPLTIMEOUT | \
                QLOGIC_IB_HWE_PCIEBUSPARITYXTLH | \
                QLOGIC_IB_HWE_PCIEBUSPARITYXADM | \
                QLOGIC_IB_HWE_PCIEBUSPARITYRADM | \
                HWE_MASK(PowerOnBISTFailed) |     \
                QLOGIC_IB_HWE_COREPLL_FBSLIP | \
                QLOGIC_IB_HWE_COREPLL_RFSLIP | \
                QLOGIC_IB_HWE_SERDESPLLFAILED | \
                HWE_MASK(IBCBusToSPCParityErr) | \
                HWE_MASK(IBCBusFromSPCParityErr) | \
                QLOGIC_IB_HWE_PCIECPLDATAQUEUEERR | \
                QLOGIC_IB_HWE_PCIECPLHDRQUEUEERR | \
                QLOGIC_IB_HWE_SDMAMEMREADERR | \
                QLOGIC_IB_HWE_CLK_UC_PLLNOTLOCKED | \
                QLOGIC_IB_HWE_PCIESERDESQ0PCLKNOTDETECT | \
                QLOGIC_IB_HWE_PCIESERDESQ1PCLKNOTDETECT | \
                QLOGIC_IB_HWE_PCIESERDESQ2PCLKNOTDETECT | \
                QLOGIC_IB_HWE_PCIESERDESQ3PCLKNOTDETECT | \
                QLOGIC_IB_HWE_DDSRXEQMEMORYPARITYERR | \
                QLOGIC_IB_HWE_IB_UC_MEMORYPARITYERR | \
                QLOGIC_IB_HWE_PCIE_UC_OCT0MEMORYPARITYERR | \
                QLOGIC_IB_HWE_PCIE_UC_OCT1MEMORYPARITYERR)

#define IB_E_BITSEXTANT                                                 \
        (ERR_MASK(RcvFormatErr) | ERR_MASK(RcvVCRCErr) |                \
         ERR_MASK(RcvICRCErr) | ERR_MASK(RcvMinPktLenErr) |             \
         ERR_MASK(RcvMaxPktLenErr) | ERR_MASK(RcvLongPktLenErr) |       \
         ERR_MASK(RcvShortPktLenErr) | ERR_MASK(RcvUnexpectedCharErr) | \
         ERR_MASK(RcvUnsupportedVLErr) | ERR_MASK(RcvEBPErr) |          \
         ERR_MASK(RcvIBFlowErr) | ERR_MASK(RcvBadVersionErr) |          \
         ERR_MASK(RcvEgrFullErr) | ERR_MASK(RcvHdrFullErr) |            \
         ERR_MASK(RcvBadTidErr) | ERR_MASK(RcvHdrLenErr) |              \
         ERR_MASK(RcvHdrErr) | ERR_MASK(RcvIBLostLinkErr) |             \
         ERR_MASK(SendSpecialTriggerErr) |                              \
         ERR_MASK(SDmaDisabledErr) | ERR_MASK(SendMinPktLenErr) |       \
         ERR_MASK(SendMaxPktLenErr) | ERR_MASK(SendUnderRunErr) |       \
         ERR_MASK(SendPktLenErr) | ERR_MASK(SendDroppedSmpPktErr) |     \
         ERR_MASK(SendDroppedDataPktErr) |                              \
         ERR_MASK(SendPioArmLaunchErr) |                                \
         ERR_MASK(SendUnexpectedPktNumErr) |                            \
         ERR_MASK(SendUnsupportedVLErr) | ERR_MASK(SendBufMisuseErr) |  \
         ERR_MASK(SDmaGenMismatchErr) | ERR_MASK(SDmaOutOfBoundErr) |   \
         ERR_MASK(SDmaTailOutOfBoundErr) | ERR_MASK(SDmaBaseErr) |      \
         ERR_MASK(SDma1stDescErr) | ERR_MASK(SDmaRpyTagErr) |           \
         ERR_MASK(SDmaDwEnErr) | ERR_MASK(SDmaMissingDwErr) |           \
         ERR_MASK(SDmaUnexpDataErr) |                                   \
         ERR_MASK(IBStatusChanged) | ERR_MASK(InvalidAddrErr) |         \
         ERR_MASK(ResetNegated) | ERR_MASK(HardwareErr) |               \
         ERR_MASK(SDmaDescAddrMisalignErr) |                            \
         ERR_MASK(InvalidEEPCmd))

/* kr_hwerrclear, kr_hwerrmask, kr_hwerrstatus, bits */
#define QLOGIC_IB_HWE_PCIEMEMPARITYERR_MASK  0x00000000000000ffULL
#define QLOGIC_IB_HWE_PCIEMEMPARITYERR_SHIFT 0
#define QLOGIC_IB_HWE_PCIEPOISONEDTLP      0x0000000010000000ULL
#define QLOGIC_IB_HWE_PCIECPLTIMEOUT       0x0000000020000000ULL
#define QLOGIC_IB_HWE_PCIEBUSPARITYXTLH    0x0000000040000000ULL
#define QLOGIC_IB_HWE_PCIEBUSPARITYXADM    0x0000000080000000ULL
#define QLOGIC_IB_HWE_PCIEBUSPARITYRADM    0x0000000100000000ULL
#define QLOGIC_IB_HWE_COREPLL_FBSLIP       0x0080000000000000ULL
#define QLOGIC_IB_HWE_COREPLL_RFSLIP       0x0100000000000000ULL
#define QLOGIC_IB_HWE_PCIE1PLLFAILED       0x0400000000000000ULL
#define QLOGIC_IB_HWE_PCIE0PLLFAILED       0x0800000000000000ULL
#define QLOGIC_IB_HWE_SERDESPLLFAILED      0x1000000000000000ULL
/* specific to this chip */
#define QLOGIC_IB_HWE_PCIECPLDATAQUEUEERR         0x0000000000000040ULL
#define QLOGIC_IB_HWE_PCIECPLHDRQUEUEERR          0x0000000000000080ULL
#define QLOGIC_IB_HWE_SDMAMEMREADERR              0x0000000010000000ULL
#define QLOGIC_IB_HWE_CLK_UC_PLLNOTLOCKED          0x2000000000000000ULL
#define QLOGIC_IB_HWE_PCIESERDESQ0PCLKNOTDETECT   0x0100000000000000ULL
#define QLOGIC_IB_HWE_PCIESERDESQ1PCLKNOTDETECT   0x0200000000000000ULL
#define QLOGIC_IB_HWE_PCIESERDESQ2PCLKNOTDETECT   0x0400000000000000ULL
#define QLOGIC_IB_HWE_PCIESERDESQ3PCLKNOTDETECT   0x0800000000000000ULL
#define QLOGIC_IB_HWE_DDSRXEQMEMORYPARITYERR       0x0000008000000000ULL
#define QLOGIC_IB_HWE_IB_UC_MEMORYPARITYERR        0x0000004000000000ULL
#define QLOGIC_IB_HWE_PCIE_UC_OCT0MEMORYPARITYERR 0x0000001000000000ULL
#define QLOGIC_IB_HWE_PCIE_UC_OCT1MEMORYPARITYERR 0x0000002000000000ULL

#define IBA7220_IBCC_LINKCMD_SHIFT 19

/* kr_ibcddrctrl bits */
#define IBA7220_IBC_DLIDLMC_MASK        0xFFFFFFFFUL
#define IBA7220_IBC_DLIDLMC_SHIFT       32

#define IBA7220_IBC_HRTBT_MASK  (SYM_RMASK(IBCDDRCtrl, HRTBT_AUTO) | \
                                 SYM_RMASK(IBCDDRCtrl, HRTBT_ENB))
#define IBA7220_IBC_HRTBT_SHIFT SYM_LSB(IBCDDRCtrl, HRTBT_ENB)

#define IBA7220_IBC_LANE_REV_SUPPORTED (1<<8)
#define IBA7220_IBC_LREV_MASK   1
#define IBA7220_IBC_LREV_SHIFT  8
#define IBA7220_IBC_RXPOL_MASK  1
#define IBA7220_IBC_RXPOL_SHIFT 7
#define IBA7220_IBC_WIDTH_SHIFT 5
#define IBA7220_IBC_WIDTH_MASK  0x3
#define IBA7220_IBC_WIDTH_1X_ONLY       (0 << IBA7220_IBC_WIDTH_SHIFT)
#define IBA7220_IBC_WIDTH_4X_ONLY       (1 << IBA7220_IBC_WIDTH_SHIFT)
#define IBA7220_IBC_WIDTH_AUTONEG       (2 << IBA7220_IBC_WIDTH_SHIFT)
#define IBA7220_IBC_SPEED_AUTONEG       (1 << 1)
#define IBA7220_IBC_SPEED_SDR           (1 << 2)
#define IBA7220_IBC_SPEED_DDR           (1 << 3)
#define IBA7220_IBC_SPEED_AUTONEG_MASK  (0x7 << 1)
#define IBA7220_IBC_IBTA_1_2_MASK       (1)

/* kr_ibcddrstatus */
/* link latency shift is 0, don't bother defining */
#define IBA7220_DDRSTAT_LINKLAT_MASK    0x3ffffff

/* kr_extstatus bits */
#define QLOGIC_IB_EXTS_FREQSEL 0x2
#define QLOGIC_IB_EXTS_SERDESSEL 0x4
#define QLOGIC_IB_EXTS_MEMBIST_ENDTEST     0x0000000000004000
#define QLOGIC_IB_EXTS_MEMBIST_DISABLED    0x0000000000008000

/* kr_xgxsconfig bits */
#define QLOGIC_IB_XGXS_RESET          0x5ULL
#define QLOGIC_IB_XGXS_FC_SAFE        (1ULL << 63)

/* kr_rcvpktledcnt */
#define IBA7220_LEDBLINK_ON_SHIFT 32 /* 4ns period on after packet */
#define IBA7220_LEDBLINK_OFF_SHIFT 0 /* 4ns period off before next on */

#define _QIB_GPIO_SDA_NUM 1
#define _QIB_GPIO_SCL_NUM 0
#define QIB_TWSI_EEPROM_DEV 0xA2 /* All Production 7220 cards. */
#define QIB_TWSI_TEMP_DEV 0x98

/* HW counter clock is at 4nsec */
#define QIB_7220_PSXMITWAIT_CHECK_RATE 4000

#define IBA7220_R_INTRAVAIL_SHIFT 17
#define IBA7220_R_PKEY_DIS_SHIFT 34
#define IBA7220_R_TAILUPD_SHIFT 35
#define IBA7220_R_CTXTCFG_SHIFT 36

#define IBA7220_HDRHEAD_PKTINT_SHIFT 32 /* interrupt cnt in upper 32 bits */

/*
 * the size bits give us 2^N, in KB units.  0 marks as invalid,
 * and 7 is reserved.  We currently use only 2KB and 4KB
 */
#define IBA7220_TID_SZ_SHIFT 37 /* shift to 3bit size selector */
#define IBA7220_TID_SZ_2K (1UL << IBA7220_TID_SZ_SHIFT) /* 2KB */
#define IBA7220_TID_SZ_4K (2UL << IBA7220_TID_SZ_SHIFT) /* 4KB */
#define IBA7220_TID_PA_SHIFT 11U /* TID addr in chip stored w/o low bits */
#define PBC_7220_VL15_SEND (1ULL << 63) /* pbc; VL15, no credit check */
#define PBC_7220_VL15_SEND_CTRL (1ULL << 31) /* control version of same */

#define AUTONEG_TRIES 5 /* sequential retries to negotiate DDR */

/* packet rate matching delay multiplier */
static u8 rate_to_delay[2][2] = {
        /* 1x, 4x */
        {   8, 2 }, /* SDR */
        {   4, 1 }  /* DDR */
};

static u8 ib_rate_to_delay[IB_RATE_120_GBPS + 1] = {
        [IB_RATE_2_5_GBPS] = 8,
        [IB_RATE_5_GBPS] = 4,
        [IB_RATE_10_GBPS] = 2,
        [IB_RATE_20_GBPS] = 1
};

#define IBA7220_LINKSPEED_SHIFT SYM_LSB(IBCStatus, LinkSpeedActive)
#define IBA7220_LINKWIDTH_SHIFT SYM_LSB(IBCStatus, LinkWidthActive)

/* link training states, from IBC */
#define IB_7220_LT_STATE_DISABLED        0x00
#define IB_7220_LT_STATE_LINKUP          0x01
#define IB_7220_LT_STATE_POLLACTIVE      0x02
#define IB_7220_LT_STATE_POLLQUIET       0x03
#define IB_7220_LT_STATE_SLEEPDELAY      0x04
#define IB_7220_LT_STATE_SLEEPQUIET      0x05
#define IB_7220_LT_STATE_CFGDEBOUNCE     0x08
#define IB_7220_LT_STATE_CFGRCVFCFG      0x09
#define IB_7220_LT_STATE_CFGWAITRMT      0x0a
#define IB_7220_LT_STATE_CFGIDLE 0x0b
#define IB_7220_LT_STATE_RECOVERRETRAIN  0x0c
#define IB_7220_LT_STATE_RECOVERWAITRMT  0x0e
#define IB_7220_LT_STATE_RECOVERIDLE     0x0f

/* link state machine states from IBC */
#define IB_7220_L_STATE_DOWN             0x0
#define IB_7220_L_STATE_INIT             0x1
#define IB_7220_L_STATE_ARM              0x2
#define IB_7220_L_STATE_ACTIVE           0x3
#define IB_7220_L_STATE_ACT_DEFER        0x4

static const u8 qib_7220_physportstate[0x20] = {
        [IB_7220_LT_STATE_DISABLED] = IB_PHYSPORTSTATE_DISABLED,
        [IB_7220_LT_STATE_LINKUP] = IB_PHYSPORTSTATE_LINKUP,
        [IB_7220_LT_STATE_POLLACTIVE] = IB_PHYSPORTSTATE_POLL,
        [IB_7220_LT_STATE_POLLQUIET] = IB_PHYSPORTSTATE_POLL,
        [IB_7220_LT_STATE_SLEEPDELAY] = IB_PHYSPORTSTATE_SLEEP,
        [IB_7220_LT_STATE_SLEEPQUIET] = IB_PHYSPORTSTATE_SLEEP,
        [IB_7220_LT_STATE_CFGDEBOUNCE] =
                IB_PHYSPORTSTATE_CFG_TRAIN,
        [IB_7220_LT_STATE_CFGRCVFCFG] =
                IB_PHYSPORTSTATE_CFG_TRAIN,
        [IB_7220_LT_STATE_CFGWAITRMT] =
                IB_PHYSPORTSTATE_CFG_TRAIN,
        [IB_7220_LT_STATE_CFGIDLE] = IB_PHYSPORTSTATE_CFG_TRAIN,
        [IB_7220_LT_STATE_RECOVERRETRAIN] =
                IB_PHYSPORTSTATE_LINK_ERR_RECOVER,
        [IB_7220_LT_STATE_RECOVERWAITRMT] =
                IB_PHYSPORTSTATE_LINK_ERR_RECOVER,
        [IB_7220_LT_STATE_RECOVERIDLE] =
                IB_PHYSPORTSTATE_LINK_ERR_RECOVER,
        [0x10] = IB_PHYSPORTSTATE_CFG_TRAIN,
        [0x11] = IB_PHYSPORTSTATE_CFG_TRAIN,
        [0x12] = IB_PHYSPORTSTATE_CFG_TRAIN,
        [0x13] = IB_PHYSPORTSTATE_CFG_TRAIN,
        [0x14] = IB_PHYSPORTSTATE_CFG_TRAIN,
        [0x15] = IB_PHYSPORTSTATE_CFG_TRAIN,
        [0x16] = IB_PHYSPORTSTATE_CFG_TRAIN,
        [0x17] = IB_PHYSPORTSTATE_CFG_TRAIN
};

int qib_special_trigger;
module_param_named(special_trigger, qib_special_trigger, int, S_IRUGO);
MODULE_PARM_DESC(special_trigger, "Enable SpecialTrigger arm/launch");

#define IBCBUSFRSPCPARITYERR HWE_MASK(IBCBusFromSPCParityErr)
#define IBCBUSTOSPCPARITYERR HWE_MASK(IBCBusToSPCParityErr)

#define SYM_MASK_BIT(regname, fldname, bit) ((u64) \
        (1ULL << (SYM_LSB(regname, fldname) + (bit))))

#define TXEMEMPARITYERR_PIOBUF \
        SYM_MASK_BIT(HwErrMask, TXEMemParityErrMask, 0)
#define TXEMEMPARITYERR_PIOPBC \
        SYM_MASK_BIT(HwErrMask, TXEMemParityErrMask, 1)
#define TXEMEMPARITYERR_PIOLAUNCHFIFO \
        SYM_MASK_BIT(HwErrMask, TXEMemParityErrMask, 2)

#define RXEMEMPARITYERR_RCVBUF \
        SYM_MASK_BIT(HwErrMask, RXEMemParityErrMask, 0)
#define RXEMEMPARITYERR_LOOKUPQ \
        SYM_MASK_BIT(HwErrMask, RXEMemParityErrMask, 1)
#define RXEMEMPARITYERR_EXPTID \
        SYM_MASK_BIT(HwErrMask, RXEMemParityErrMask, 2)
#define RXEMEMPARITYERR_EAGERTID \
        SYM_MASK_BIT(HwErrMask, RXEMemParityErrMask, 3)
#define RXEMEMPARITYERR_FLAGBUF \
        SYM_MASK_BIT(HwErrMask, RXEMemParityErrMask, 4)
#define RXEMEMPARITYERR_DATAINFO \
        SYM_MASK_BIT(HwErrMask, RXEMemParityErrMask, 5)
#define RXEMEMPARITYERR_HDRINFO \
        SYM_MASK_BIT(HwErrMask, RXEMemParityErrMask, 6)

/* 7220 specific hardware errors... */
static const struct qib_hwerror_msgs qib_7220_hwerror_msgs[] = {
        /* generic hardware errors */
        QLOGIC_IB_HWE_MSG(IBCBUSFRSPCPARITYERR, "QIB2IB Parity"),
        QLOGIC_IB_HWE_MSG(IBCBUSTOSPCPARITYERR, "IB2QIB Parity"),

        QLOGIC_IB_HWE_MSG(TXEMEMPARITYERR_PIOBUF,
                          "TXE PIOBUF Memory Parity"),
        QLOGIC_IB_HWE_MSG(TXEMEMPARITYERR_PIOPBC,
                          "TXE PIOPBC Memory Parity"),
        QLOGIC_IB_HWE_MSG(TXEMEMPARITYERR_PIOLAUNCHFIFO,
                          "TXE PIOLAUNCHFIFO Memory Parity"),

        QLOGIC_IB_HWE_MSG(RXEMEMPARITYERR_RCVBUF,
                          "RXE RCVBUF Memory Parity"),
        QLOGIC_IB_HWE_MSG(RXEMEMPARITYERR_LOOKUPQ,
                          "RXE LOOKUPQ Memory Parity"),
        QLOGIC_IB_HWE_MSG(RXEMEMPARITYERR_EAGERTID,
                          "RXE EAGERTID Memory Parity"),
        QLOGIC_IB_HWE_MSG(RXEMEMPARITYERR_EXPTID,
                          "RXE EXPTID Memory Parity"),
        QLOGIC_IB_HWE_MSG(RXEMEMPARITYERR_FLAGBUF,
                          "RXE FLAGBUF Memory Parity"),
        QLOGIC_IB_HWE_MSG(RXEMEMPARITYERR_DATAINFO,
                          "RXE DATAINFO Memory Parity"),
        QLOGIC_IB_HWE_MSG(RXEMEMPARITYERR_HDRINFO,
                          "RXE HDRINFO Memory Parity"),

        /* chip-specific hardware errors */
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIEPOISONEDTLP,
                          "PCIe Poisoned TLP"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIECPLTIMEOUT,
                          "PCIe completion timeout"),
        /*
         * In practice, it's unlikely wthat we'll see PCIe PLL, or bus
         * parity or memory parity error failures, because most likely we
         * won't be able to talk to the core of the chip.  Nonetheless, we
         * might see them, if they are in parts of the PCIe core that aren't
         * essential.
         */
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIE1PLLFAILED,
                          "PCIePLL1"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIE0PLLFAILED,
                          "PCIePLL0"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIEBUSPARITYXTLH,
                          "PCIe XTLH core parity"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIEBUSPARITYXADM,
                          "PCIe ADM TX core parity"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIEBUSPARITYRADM,
                          "PCIe ADM RX core parity"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_SERDESPLLFAILED,
                          "SerDes PLL"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIECPLDATAQUEUEERR,
                          "PCIe cpl header queue"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIECPLHDRQUEUEERR,
                          "PCIe cpl data queue"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_SDMAMEMREADERR,
                          "Send DMA memory read"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_CLK_UC_PLLNOTLOCKED,
                          "uC PLL clock not locked"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIESERDESQ0PCLKNOTDETECT,
                          "PCIe serdes Q0 no clock"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIESERDESQ1PCLKNOTDETECT,
                          "PCIe serdes Q1 no clock"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIESERDESQ2PCLKNOTDETECT,
                          "PCIe serdes Q2 no clock"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIESERDESQ3PCLKNOTDETECT,
                          "PCIe serdes Q3 no clock"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_DDSRXEQMEMORYPARITYERR,
                          "DDS RXEQ memory parity"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_IB_UC_MEMORYPARITYERR,
                          "IB uC memory parity"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIE_UC_OCT0MEMORYPARITYERR,
                          "PCIe uC oct0 memory parity"),
        QLOGIC_IB_HWE_MSG(QLOGIC_IB_HWE_PCIE_UC_OCT1MEMORYPARITYERR,
                          "PCIe uC oct1 memory parity"),
};

#define RXE_PARITY (RXEMEMPARITYERR_EAGERTID|RXEMEMPARITYERR_EXPTID)

#define QLOGIC_IB_E_PKTERRS (\
                ERR_MASK(SendPktLenErr) |                               \
                ERR_MASK(SendDroppedDataPktErr) |                       \
                ERR_MASK(RcvVCRCErr) |                                  \
                ERR_MASK(RcvICRCErr) |                                  \
                ERR_MASK(RcvShortPktLenErr) |                           \
                ERR_MASK(RcvEBPErr))

/* Convenience for decoding Send DMA errors */
#define QLOGIC_IB_E_SDMAERRS ( \
                ERR_MASK(SDmaGenMismatchErr) |                          \
                ERR_MASK(SDmaOutOfBoundErr) |                           \
                ERR_MASK(SDmaTailOutOfBoundErr) | ERR_MASK(SDmaBaseErr) | \
                ERR_MASK(SDma1stDescErr) | ERR_MASK(SDmaRpyTagErr) |    \
                ERR_MASK(SDmaDwEnErr) | ERR_MASK(SDmaMissingDwErr) |    \
                ERR_MASK(SDmaUnexpDataErr) |                            \
                ERR_MASK(SDmaDescAddrMisalignErr) |                     \
                ERR_MASK(SDmaDisabledErr) |                             \
                ERR_MASK(SendBufMisuseErr))

/* These are all rcv-related errors which we want to count for stats */
#define E_SUM_PKTERRS \
        (ERR_MASK(RcvHdrLenErr) | ERR_MASK(RcvBadTidErr) |              \
         ERR_MASK(RcvBadVersionErr) | ERR_MASK(RcvHdrErr) |             \
         ERR_MASK(RcvLongPktLenErr) | ERR_MASK(RcvShortPktLenErr) |     \
         ERR_MASK(RcvMaxPktLenErr) | ERR_MASK(RcvMinPktLenErr) |        \
         ERR_MASK(RcvFormatErr) | ERR_MASK(RcvUnsupportedVLErr) |       \
         ERR_MASK(RcvUnexpectedCharErr) | ERR_MASK(RcvEBPErr))

/* These are all send-related errors which we want to count for stats */
#define E_SUM_ERRS \
        (ERR_MASK(SendPioArmLaunchErr) | ERR_MASK(SendUnexpectedPktNumErr) | \
         ERR_MASK(SendDroppedDataPktErr) | ERR_MASK(SendDroppedSmpPktErr) | \
         ERR_MASK(SendMaxPktLenErr) | ERR_MASK(SendUnsupportedVLErr) |  \
         ERR_MASK(SendMinPktLenErr) | ERR_MASK(SendPktLenErr) |         \
         ERR_MASK(InvalidAddrErr))

/*
 * this is similar to E_SUM_ERRS, but can't ignore armlaunch, don't ignore
 * errors not related to freeze and cancelling buffers.  Can't ignore
 * armlaunch because could get more while still cleaning up, and need
 * to cancel those as they happen.
 */
#define E_SPKT_ERRS_IGNORE \
        (ERR_MASK(SendDroppedDataPktErr) | ERR_MASK(SendDroppedSmpPktErr) | \
         ERR_MASK(SendMaxPktLenErr) | ERR_MASK(SendMinPktLenErr) |      \
         ERR_MASK(SendPktLenErr))

/*
 * these are errors that can occur when the link changes state while
 * a packet is being sent or received.  This doesn't cover things
 * like EBP or VCRC that can be the result of a sending having the
 * link change state, so we receive a "known bad" packet.
 */
#define E_SUM_LINK_PKTERRS \
        (ERR_MASK(SendDroppedDataPktErr) | ERR_MASK(SendDroppedSmpPktErr) | \
         ERR_MASK(SendMinPktLenErr) | ERR_MASK(SendPktLenErr) |         \
         ERR_MASK(RcvShortPktLenErr) | ERR_MASK(RcvMinPktLenErr) |      \
         ERR_MASK(RcvUnexpectedCharErr))

static void autoneg_7220_work(struct work_struct *);
static u32 __iomem *qib_7220_getsendbuf(struct qib_pportdata *, u64, u32 *);

/*
 * Called when we might have an error that is specific to a particular
 * PIO buffer, and may need to cancel that buffer, so it can be re-used.
 * because we don't need to force the update of pioavail.
 */
static void qib_disarm_7220_senderrbufs(struct qib_pportdata *ppd)
{
        unsigned long sbuf[3];
        struct qib_devdata *dd = ppd->dd;

        /*
         * It's possible that sendbuffererror could have bits set; might
         * have already done this as a result of hardware error handling.
         */
        /* read these before writing errorclear */
        sbuf[0] = qib_read_kreg64(dd, kr_sendbuffererror);
        sbuf[1] = qib_read_kreg64(dd, kr_sendbuffererror + 1);
        sbuf[2] = qib_read_kreg64(dd, kr_sendbuffererror + 2);

        if (sbuf[0] || sbuf[1] || sbuf[2])
                qib_disarm_piobufs_set(dd, sbuf,
                                       dd->piobcnt2k + dd->piobcnt4k);
}

static void qib_7220_txe_recover(struct qib_devdata *dd)
{
        qib_devinfo(dd->pcidev, "Recovering from TXE PIO parity error\n");
        qib_disarm_7220_senderrbufs(dd->pport);
}

/*
 * This is called with interrupts disabled and sdma_lock held.
 */
static void qib_7220_sdma_sendctrl(struct qib_pportdata *ppd, unsigned op)
{
        struct qib_devdata *dd = ppd->dd;
        u64 set_sendctrl = 0;
        u64 clr_sendctrl = 0;

        if (op & QIB_SDMA_SENDCTRL_OP_ENABLE)
                set_sendctrl |= SYM_MASK(SendCtrl, SDmaEnable);
        else
                clr_sendctrl |= SYM_MASK(SendCtrl, SDmaEnable);

        if (op & QIB_SDMA_SENDCTRL_OP_INTENABLE)
                set_sendctrl |= SYM_MASK(SendCtrl, SDmaIntEnable);
        else
                clr_sendctrl |= SYM_MASK(SendCtrl, SDmaIntEnable);

        if (op & QIB_SDMA_SENDCTRL_OP_HALT)
                set_sendctrl |= SYM_MASK(SendCtrl, SDmaHalt);
        else
                clr_sendctrl |= SYM_MASK(SendCtrl, SDmaHalt);

        spin_lock(&dd->sendctrl_lock);

        dd->sendctrl |= set_sendctrl;
        dd->sendctrl &= ~clr_sendctrl;

        qib_write_kreg(dd, kr_sendctrl, dd->sendctrl);
        qib_write_kreg(dd, kr_scratch, 0);

        spin_unlock(&dd->sendctrl_lock);
}

static void qib_decode_7220_sdma_errs(struct qib_pportdata *ppd,
                                      u64 err, char *buf, size_t blen)
{
        static const struct {
                u64 err;
                const char *msg;
        } errs[] = {
                { ERR_MASK(SDmaGenMismatchErr),
                  "SDmaGenMismatch" },
                { ERR_MASK(SDmaOutOfBoundErr),
                  "SDmaOutOfBound" },
                { ERR_MASK(SDmaTailOutOfBoundErr),
                  "SDmaTailOutOfBound" },
                { ERR_MASK(SDmaBaseErr),
                  "SDmaBase" },
                { ERR_MASK(SDma1stDescErr),
                  "SDma1stDesc" },
                { ERR_MASK(SDmaRpyTagErr),
                  "SDmaRpyTag" },
                { ERR_MASK(SDmaDwEnErr),
                  "SDmaDwEn" },
                { ERR_MASK(SDmaMissingDwErr),
                  "SDmaMissingDw" },
                { ERR_MASK(SDmaUnexpDataErr),
                  "SDmaUnexpData" },
                { ERR_MASK(SDmaDescAddrMisalignErr),
                  "SDmaDescAddrMisalign" },
                { ERR_MASK(SendBufMisuseErr),
                  "SendBufMisuse" },
                { ERR_MASK(SDmaDisabledErr),
                  "SDmaDisabled" },
        };
        int i;
        size_t bidx = 0;

        for (i = 0; i < ARRAY_SIZE(errs); i++) {
                if (err & errs[i].err)
                        bidx += scnprintf(buf + bidx, blen - bidx,
                                         "%s ", errs[i].msg);
        }
}

/*
 * This is called as part of link down clean up so disarm and flush
 * all send buffers so that SMP packets can be sent.
 */
static void qib_7220_sdma_hw_clean_up(struct qib_pportdata *ppd)
{
        /* This will trigger the Abort interrupt */
        sendctrl_7220_mod(ppd, QIB_SENDCTRL_DISARM_ALL | QIB_SENDCTRL_FLUSH |
                          QIB_SENDCTRL_AVAIL_BLIP);
        ppd->dd->upd_pio_shadow  = 1; /* update our idea of what's busy */
}

static void qib_sdma_7220_setlengen(struct qib_pportdata *ppd)
{
        /*
         * Set SendDmaLenGen and clear and set
         * the MSB of the generation count to enable generation checking
         * and load the internal generation counter.
         */
        qib_write_kreg(ppd->dd, kr_senddmalengen, ppd->sdma_descq_cnt);
        qib_write_kreg(ppd->dd, kr_senddmalengen,
                       ppd->sdma_descq_cnt |
                       (1ULL << QIB_7220_SendDmaLenGen_Generation_MSB));
}

static void qib_7220_sdma_hw_start_up(struct qib_pportdata *ppd)
{
        qib_sdma_7220_setlengen(ppd);
        qib_sdma_update_7220_tail(ppd, 0); /* Set SendDmaTail */
        ppd->sdma_head_dma[0] = 0;
}

#define DISABLES_SDMA (                                                 \
                ERR_MASK(SDmaDisabledErr) |                             \
                ERR_MASK(SDmaBaseErr) |                                 \
                ERR_MASK(SDmaTailOutOfBoundErr) |                       \
                ERR_MASK(SDmaOutOfBoundErr) |                           \
                ERR_MASK(SDma1stDescErr) |                              \
                ERR_MASK(SDmaRpyTagErr) |                               \
                ERR_MASK(SDmaGenMismatchErr) |                          \
                ERR_MASK(SDmaDescAddrMisalignErr) |                     \
                ERR_MASK(SDmaMissingDwErr) |                            \
                ERR_MASK(SDmaDwEnErr))

static void sdma_7220_errors(struct qib_pportdata *ppd, u64 errs)
{
        unsigned long flags;
        struct qib_devdata *dd = ppd->dd;
        char *msg;

        errs &= QLOGIC_IB_E_SDMAERRS;

        msg = dd->cspec->sdmamsgbuf;
        qib_decode_7220_sdma_errs(ppd, errs, msg, sizeof dd->cspec->sdmamsgbuf);
        spin_lock_irqsave(&ppd->sdma_lock, flags);

        if (errs & ERR_MASK(SendBufMisuseErr)) {
                unsigned long sbuf[3];

                sbuf[0] = qib_read_kreg64(dd, kr_sendbuffererror);
                sbuf[1] = qib_read_kreg64(dd, kr_sendbuffererror + 1);
                sbuf[2] = qib_read_kreg64(dd, kr_sendbuffererror + 2);

                qib_dev_err(ppd->dd,
                            "IB%u:%u SendBufMisuse: %04lx %016lx %016lx\n",
                            ppd->dd->unit, ppd->port, sbuf[2], sbuf[1],
                            sbuf[0]);
        }

        if (errs & ERR_MASK(SDmaUnexpDataErr))
                qib_dev_err(dd, "IB%u:%u SDmaUnexpData\n", ppd->dd->unit,
                            ppd->port);

        switch (ppd->sdma_state.current_state) {
        case qib_sdma_state_s00_hw_down:
                /* not expecting any interrupts */
                break;

        case qib_sdma_state_s10_hw_start_up_wait:
                /* handled in intr path */
                break;

        case qib_sdma_state_s20_idle:
                /* not expecting any interrupts */
                break;

        case qib_sdma_state_s30_sw_clean_up_wait:
                /* not expecting any interrupts */
                break;

        case qib_sdma_state_s40_hw_clean_up_wait:
                if (errs & ERR_MASK(SDmaDisabledErr))
                        __qib_sdma_process_event(ppd,
                                qib_sdma_event_e50_hw_cleaned);
                break;

        case qib_sdma_state_s50_hw_halt_wait:
                /* handled in intr path */
                break;

        case qib_sdma_state_s99_running:
                if (errs & DISABLES_SDMA)
                        __qib_sdma_process_event(ppd,
                                qib_sdma_event_e7220_err_halted);
                break;
        }

        spin_unlock_irqrestore(&ppd->sdma_lock, flags);
}

/*
 * Decode the error status into strings, deciding whether to always
 * print * it or not depending on "normal packet errors" vs everything
 * else.   Return 1 if "real" errors, otherwise 0 if only packet
 * errors, so caller can decide what to print with the string.
 */
static int qib_decode_7220_err(struct qib_devdata *dd, char *buf, size_t blen,
                               u64 err)
{
        int iserr = 1;

        *buf = '\0';
        if (err & QLOGIC_IB_E_PKTERRS) {
                if (!(err & ~QLOGIC_IB_E_PKTERRS))
                        iserr = 0;
                if ((err & ERR_MASK(RcvICRCErr)) &&
                    !(err & (ERR_MASK(RcvVCRCErr) | ERR_MASK(RcvEBPErr))))
                        strlcat(buf, "CRC ", blen);
                if (!iserr)
                        goto done;
        }
        if (err & ERR_MASK(RcvHdrLenErr))
                strlcat(buf, "rhdrlen ", blen);
        if (err & ERR_MASK(RcvBadTidErr))
                strlcat(buf, "rbadtid ", blen);
        if (err & ERR_MASK(RcvBadVersionErr))
                strlcat(buf, "rbadversion ", blen);
        if (err & ERR_MASK(RcvHdrErr))
                strlcat(buf, "rhdr ", blen);
        if (err & ERR_MASK(SendSpecialTriggerErr))
                strlcat(buf, "sendspecialtrigger ", blen);
        if (err & ERR_MASK(RcvLongPktLenErr))
                strlcat(buf, "rlongpktlen ", blen);
        if (err & ERR_MASK(RcvMaxPktLenErr))
                strlcat(buf, "rmaxpktlen ", blen);
        if (err & ERR_MASK(RcvMinPktLenErr))
                strlcat(buf, "rminpktlen ", blen);
        if (err & ERR_MASK(SendMinPktLenErr))
                strlcat(buf, "sminpktlen ", blen);

        if (err & ERR_MASK(RcvFormatErr))
                strlcat(buf, "rformaterr ", blen);
        if (err & ERR_MASK(RcvUnsupportedVLErr))
                strlcat(buf, "runsupvl ", blen);
        if (err & ERR_MASK(RcvUnexpectedCharErr))
                strlcat(buf, "runexpchar ", blen);
        if (err & ERR_MASK(RcvIBFlowErr))
                strlcat(buf, "ribflow ", blen);
        if (err & ERR_MASK(SendUnderRunErr))
                strlcat(buf, "sunderrun ", blen);
        if (err & ERR_MASK(SendPioArmLaunchErr))
                strlcat(buf, "spioarmlaunch ", blen);
        if (err & ERR_MASK(SendUnexpectedPktNumErr))
                strlcat(buf, "sunexperrpktnum ", blen);
        if (err & ERR_MASK(SendDroppedSmpPktErr))
                strlcat(buf, "sdroppedsmppkt ", blen);
        if (err & ERR_MASK(SendMaxPktLenErr))
                strlcat(buf, "smaxpktlen ", blen);
        if (err & ERR_MASK(SendUnsupportedVLErr))
                strlcat(buf, "sunsupVL ", blen);
        if (err & ERR_MASK(InvalidAddrErr))
                strlcat(buf, "invalidaddr ", blen);
        if (err & ERR_MASK(RcvEgrFullErr))
                strlcat(buf, "rcvegrfull ", blen);
        if (err & ERR_MASK(RcvHdrFullErr))
                strlcat(buf, "rcvhdrfull ", blen);
        if (err & ERR_MASK(IBStatusChanged))
                strlcat(buf, "ibcstatuschg ", blen);
        if (err & ERR_MASK(RcvIBLostLinkErr))
                strlcat(buf, "riblostlink ", blen);
        if (err & ERR_MASK(HardwareErr))
                strlcat(buf, "hardware ", blen);
        if (err & ERR_MASK(ResetNegated))
                strlcat(buf, "reset ", blen);
        if (err & QLOGIC_IB_E_SDMAERRS)
                qib_decode_7220_sdma_errs(dd->pport, err, buf, blen);
        if (err & ERR_MASK(InvalidEEPCmd))
                strlcat(buf, "invalideepromcmd ", blen);
done:
        return iserr;
}

static void reenable_7220_chase(unsigned long opaque)
{
        struct qib_pportdata *ppd = (struct qib_pportdata *)opaque;
        ppd->cpspec->chase_timer.expires = 0;
        qib_set_ib_7220_lstate(ppd, QLOGIC_IB_IBCC_LINKCMD_DOWN,
                QLOGIC_IB_IBCC_LINKINITCMD_POLL);
}

static void handle_7220_chase(struct qib_pportdata *ppd, u64 ibcst)
{
        u8 ibclt;
        unsigned long tnow;

        ibclt = (u8)SYM_FIELD(ibcst, IBCStatus, LinkTrainingState);

        /*
         * Detect and handle the state chase issue, where we can
         * get stuck if we are unlucky on timing on both sides of
         * the link.   If we are, we disable, set a timer, and
         * then re-enable.
         */
        switch (ibclt) {
        case IB_7220_LT_STATE_CFGRCVFCFG:
        case IB_7220_LT_STATE_CFGWAITRMT:
        case IB_7220_LT_STATE_TXREVLANES:
        case IB_7220_LT_STATE_CFGENH:
                tnow = jiffies;
                if (ppd->cpspec->chase_end &&
                    time_after(tnow, ppd->cpspec->chase_end)) {
                        ppd->cpspec->chase_end = 0;
                        qib_set_ib_7220_lstate(ppd,
                                QLOGIC_IB_IBCC_LINKCMD_DOWN,
                                QLOGIC_IB_IBCC_LINKINITCMD_DISABLE);
                        ppd->cpspec->chase_timer.expires = jiffies +
                                QIB_CHASE_DIS_TIME;
                        add_timer(&ppd->cpspec->chase_timer);
                } else if (!ppd->cpspec->chase_end)
                        ppd->cpspec->chase_end = tnow + QIB_CHASE_TIME;
                break;

        default:
                ppd->cpspec->chase_end = 0;
                break;
        }
}

static void handle_7220_errors(struct qib_devdata *dd, u64 errs)
{
        char *msg;
        u64 ignore_this_time = 0;
        u64 iserr = 0;
        int log_idx;
        struct qib_pportdata *ppd = dd->pport;
        u64 mask;

        /* don't report errors that are masked */
        errs &= dd->cspec->errormask;
        msg = dd->cspec->emsgbuf;

        /* do these first, they are most important */
        if (errs & ERR_MASK(HardwareErr))
                qib_7220_handle_hwerrors(dd, msg, sizeof dd->cspec->emsgbuf);
        else
                for (log_idx = 0; log_idx < QIB_EEP_LOG_CNT; ++log_idx)
                        if (errs & dd->eep_st_masks[log_idx].errs_to_log)
                                qib_inc_eeprom_err(dd, log_idx, 1);

        if (errs & QLOGIC_IB_E_SDMAERRS)
                sdma_7220_errors(ppd, errs);

        if (errs & ~IB_E_BITSEXTANT)
                qib_dev_err(dd,
                        "error interrupt with unknown errors %llx set\n",
                        (unsigned long long) (errs & ~IB_E_BITSEXTANT));

        if (errs & E_SUM_ERRS) {
                qib_disarm_7220_senderrbufs(ppd);
                if ((errs & E_SUM_LINK_PKTERRS) &&
                    !(ppd->lflags & QIBL_LINKACTIVE)) {
                        /*
                         * This can happen when trying to bring the link
                         * up, but the IB link changes state at the "wrong"
                         * time. The IB logic then complains that the packet
                         * isn't valid.  We don't want to confuse people, so
                         * we just don't print them, except at debug
                         */
                        ignore_this_time = errs & E_SUM_LINK_PKTERRS;
                }
        } else if ((errs & E_SUM_LINK_PKTERRS) &&
                   !(ppd->lflags & QIBL_LINKACTIVE)) {
                /*
                 * This can happen when SMA is trying to bring the link
                 * up, but the IB link changes state at the "wrong" time.
                 * The IB logic then complains that the packet isn't
                 * valid.  We don't want to confuse people, so we just
                 * don't print them, except at debug
                 */
                ignore_this_time = errs & E_SUM_LINK_PKTERRS;
        }

        qib_write_kreg(dd, kr_errclear, errs);

        errs &= ~ignore_this_time;
        if (!errs)
                goto done;

        /*
         * The ones we mask off are handled specially below
         * or above.  Also mask SDMADISABLED by default as it
         * is too chatty.
         */
        mask = ERR_MASK(IBStatusChanged) |
                ERR_MASK(RcvEgrFullErr) | ERR_MASK(RcvHdrFullErr) |
                ERR_MASK(HardwareErr) | ERR_MASK(SDmaDisabledErr);

        qib_decode_7220_err(dd, msg, sizeof dd->cspec->emsgbuf, errs & ~mask);

        if (errs & E_SUM_PKTERRS)
                qib_stats.sps_rcverrs++;
        if (errs & E_SUM_ERRS)
                qib_stats.sps_txerrs++;
        iserr = errs & ~(E_SUM_PKTERRS | QLOGIC_IB_E_PKTERRS |
                         ERR_MASK(SDmaDisabledErr));

        if (errs & ERR_MASK(IBStatusChanged)) {
                u64 ibcs;

                ibcs = qib_read_kreg64(dd, kr_ibcstatus);
                if (!(ppd->lflags & QIBL_IB_AUTONEG_INPROG))
                        handle_7220_chase(ppd, ibcs);

                /* Update our picture of width and speed from chip */
                ppd->link_width_active =
                        ((ibcs >> IBA7220_LINKWIDTH_SHIFT) & 1) ?
                            IB_WIDTH_4X : IB_WIDTH_1X;
                ppd->link_speed_active =
                        ((ibcs >> IBA7220_LINKSPEED_SHIFT) & 1) ?
                            QIB_IB_DDR : QIB_IB_SDR;

                /*
                 * Since going into a recovery state causes the link state
                 * to go down and since recovery is transitory, it is better
                 * if we "miss" ever seeing the link training state go into
                 * recovery (i.e., ignore this transition for link state
                 * special handling purposes) without updating lastibcstat.
                 */
                if (qib_7220_phys_portstate(ibcs) !=
                                            IB_PHYSPORTSTATE_LINK_ERR_RECOVER)
                        qib_handle_e_ibstatuschanged(ppd, ibcs);
        }

        if (errs & ERR_MASK(ResetNegated)) {
                qib_dev_err(dd,
                        "Got reset, requires re-init (unload and reload driver)\n");
                dd->flags &= ~QIB_INITTED;  /* needs re-init */
                /* mark as having had error */
                *dd->devstatusp |= QIB_STATUS_HWERROR;
                *dd->pport->statusp &= ~QIB_STATUS_IB_CONF;
        }

        if (*msg && iserr)
                qib_dev_porterr(dd, ppd->port, "%s error\n", msg);

        if (ppd->state_wanted & ppd->lflags)
                wake_up_interruptible(&ppd->state_wait);

        /*
         * If there were hdrq or egrfull errors, wake up any processes
         * waiting in poll.  We used to try to check which contexts had
         * the overflow, but given the cost of that and the chip reads
         * to support it, it's better to just wake everybody up if we
         * get an overflow; waiters can poll again if it's not them.
         */
        if (errs & (ERR_MASK(RcvEgrFullErr) | ERR_MASK(RcvHdrFullErr))) {
                qib_handle_urcv(dd, ~0U);
                if (errs & ERR_MASK(RcvEgrFullErr))
                        qib_stats.sps_buffull++;
                else
                        qib_stats.sps_hdrfull++;
        }
done:
        return;
}

/* enable/disable chip from delivering interrupts */
static void qib_7220_set_intr_state(struct qib_devdata *dd, u32 enable)
{
        if (enable) {
                if (dd->flags & QIB_BADINTR)
                        return;
                qib_write_kreg(dd, kr_intmask, ~0ULL);
                /* force re-interrupt of any pending interrupts. */
                qib_write_kreg(dd, kr_intclear, 0ULL);
        } else
                qib_write_kreg(dd, kr_intmask, 0ULL);
}

/*
 * Try to cleanup as much as possible for anything that might have gone
 * wrong while in freeze mode, such as pio buffers being written by user
 * processes (causing armlaunch), send errors due to going into freeze mode,
 * etc., and try to avoid causing extra interrupts while doing so.
 * Forcibly update the in-memory pioavail register copies after cleanup
 * because the chip won't do it while in freeze mode (the register values
 * themselves are kept correct).
 * Make sure that we don't lose any important interrupts by using the chip
 * feature that says that writing 0 to a bit in *clear that is set in
 * *status will cause an interrupt to be generated again (if allowed by
 * the *mask value).
 * This is in chip-specific code because of all of the register accesses,
 * even though the details are similar on most chips.
 */
static void qib_7220_clear_freeze(struct qib_devdata *dd)
{
        /* disable error interrupts, to avoid confusion */
        qib_write_kreg(dd, kr_errmask, 0ULL);

        /* also disable interrupts; errormask is sometimes overwriten */
        qib_7220_set_intr_state(dd, 0);

        qib_cancel_sends(dd->pport);

        /* clear the freeze, and be sure chip saw it */
        qib_write_kreg(dd, kr_control, dd->control);
        qib_read_kreg32(dd, kr_scratch);

        /* force in-memory update now we are out of freeze */
        qib_force_pio_avail_update(dd);

        /*
         * force new interrupt if any hwerr, error or interrupt bits are
         * still set, and clear "safe" send packet errors related to freeze
         * and cancelling sends.  Re-enable error interrupts before possible
         * force of re-interrupt on pending interrupts.
         */
        qib_write_kreg(dd, kr_hwerrclear, 0ULL);
        qib_write_kreg(dd, kr_errclear, E_SPKT_ERRS_IGNORE);
        qib_write_kreg(dd, kr_errmask, dd->cspec->errormask);
        qib_7220_set_intr_state(dd, 1);
}

/**
 * qib_7220_handle_hwerrors - display hardware errors.
 * @dd: the qlogic_ib device
 * @msg: the output buffer
 * @msgl: the size of the output buffer
 *
 * Use same msg buffer as regular errors to avoid excessive stack
 * use.  Most hardware errors are catastrophic, but for right now,
 * we'll print them and continue.  We reuse the same message buffer as
 * handle_7220_errors() to avoid excessive stack usage.
 */
static void qib_7220_handle_hwerrors(struct qib_devdata *dd, char *msg,
                                     size_t msgl)
{
        u64 hwerrs;
        u32 bits, ctrl;
        int isfatal = 0;
        char *bitsmsg;
        int log_idx;

        hwerrs = qib_read_kreg64(dd, kr_hwerrstatus);
        if (!hwerrs)
                goto bail;
        if (hwerrs == ~0ULL) {
                qib_dev_err(dd,
                        "Read of hardware error status failed (all bits set); ignoring\n");
                goto bail;
        }
        qib_stats.sps_hwerrs++;

        /*
         * Always clear the error status register, except MEMBISTFAIL,
         * regardless of whether we continue or stop using the chip.
         * We want that set so we know it failed, even across driver reload.
         * We'll still ignore it in the hwerrmask.  We do this partly for
         * diagnostics, but also for support.
         */
        qib_write_kreg(dd, kr_hwerrclear,
                       hwerrs & ~HWE_MASK(PowerOnBISTFailed));

        hwerrs &= dd->cspec->hwerrmask;

        /* We log some errors to EEPROM, check if we have any of those. */
        for (log_idx = 0; log_idx < QIB_EEP_LOG_CNT; ++log_idx)
                if (hwerrs & dd->eep_st_masks[log_idx].hwerrs_to_log)
                        qib_inc_eeprom_err(dd, log_idx, 1);
        if (hwerrs & ~(TXEMEMPARITYERR_PIOBUF | TXEMEMPARITYERR_PIOPBC |
                       RXE_PARITY))
                qib_devinfo(dd->pcidev,
                        "Hardware error: hwerr=0x%llx (cleared)\n",
                        (unsigned long long) hwerrs);

        if (hwerrs & ~IB_HWE_BITSEXTANT)
                qib_dev_err(dd,
                        "hwerror interrupt with unknown errors %llx set\n",
                        (unsigned long long) (hwerrs & ~IB_HWE_BITSEXTANT));

        if (hwerrs & QLOGIC_IB_HWE_IB_UC_MEMORYPARITYERR)
                qib_sd7220_clr_ibpar(dd);

        ctrl = qib_read_kreg32(dd, kr_control);
        if ((ctrl & QLOGIC_IB_C_FREEZEMODE) && !dd->diag_client) {
                /*
                 * Parity errors in send memory are recoverable by h/w
                 * just do housekeeping, exit freeze mode and continue.
                 */
                if (hwerrs & (TXEMEMPARITYERR_PIOBUF |
                              TXEMEMPARITYERR_PIOPBC)) {
                        qib_7220_txe_recover(dd);
                        hwerrs &= ~(TXEMEMPARITYERR_PIOBUF |
                                    TXEMEMPARITYERR_PIOPBC);
                }
                if (hwerrs)
                        isfatal = 1;
                else
                        qib_7220_clear_freeze(dd);
        }

        *msg = '\0';

        if (hwerrs & HWE_MASK(PowerOnBISTFailed)) {
                isfatal = 1;
                strlcat(msg,
                        "[Memory BIST test failed, InfiniPath hardware unusable]",
                        msgl);
                /* ignore from now on, so disable until driver reloaded */
                dd->cspec->hwerrmask &= ~HWE_MASK(PowerOnBISTFailed);
                qib_write_kreg(dd, kr_hwerrmask, dd->cspec->hwerrmask);
        }

        qib_format_hwerrors(hwerrs, qib_7220_hwerror_msgs,
                            ARRAY_SIZE(qib_7220_hwerror_msgs), msg, msgl);

        bitsmsg = dd->cspec->bitsmsgbuf;
        if (hwerrs & (QLOGIC_IB_HWE_PCIEMEMPARITYERR_MASK <<
                      QLOGIC_IB_HWE_PCIEMEMPARITYERR_SHIFT)) {
                bits = (u32) ((hwerrs >>
                               QLOGIC_IB_HWE_PCIEMEMPARITYERR_SHIFT) &
                              QLOGIC_IB_HWE_PCIEMEMPARITYERR_MASK);
                snprintf(bitsmsg, sizeof dd->cspec->bitsmsgbuf,
                         "[PCIe Mem Parity Errs %x] ", bits);
                strlcat(msg, bitsmsg, msgl);
        }

#define _QIB_PLL_FAIL (QLOGIC_IB_HWE_COREPLL_FBSLIP |   \
                         QLOGIC_IB_HWE_COREPLL_RFSLIP)

        if (hwerrs & _QIB_PLL_FAIL) {
                isfatal = 1;
                snprintf(bitsmsg, sizeof dd->cspec->bitsmsgbuf,
                         "[PLL failed (%llx), InfiniPath hardware unusable]",
                         (unsigned long long) hwerrs & _QIB_PLL_FAIL);
                strlcat(msg, bitsmsg, msgl);
                /* ignore from now on, so disable until driver reloaded */
                dd->cspec->hwerrmask &= ~(hwerrs & _QIB_PLL_FAIL);
                qib_write_kreg(dd, kr_hwerrmask, dd->cspec->hwerrmask);
        }

        if (hwerrs & QLOGIC_IB_HWE_SERDESPLLFAILED) {
                /*
                 * If it occurs, it is left masked since the eternal
                 * interface is unused.
                 */
                dd->cspec->hwerrmask &= ~QLOGIC_IB_HWE_SERDESPLLFAILED;
                qib_write_kreg(dd, kr_hwerrmask, dd->cspec->hwerrmask);
        }

        qib_dev_err(dd, "%s hardware error\n", msg);

        if (isfatal && !dd->diag_client) {
                qib_dev_err(dd,
                        "Fatal Hardware Error, no longer usable, SN %.16s\n",
                        dd->serial);
                /*
                 * For /sys status file and user programs to print; if no
                 * trailing brace is copied, we'll know it was truncated.
                 */
                if (dd->freezemsg)
                        snprintf(dd->freezemsg, dd->freezelen,
                                 "{%s}", msg);
                qib_disable_after_error(dd);
        }
bail:;
}

/**
 * qib_7220_init_hwerrors - enable hardware errors
 * @dd: the qlogic_ib device
 *
 * now that we have finished initializing everything that might reasonably
 * cause a hardware error, and cleared those errors bits as they occur,
 * we can enable hardware errors in the mask (potentially enabling
 * freeze mode), and enable hardware errors as errors (along with
 * everything else) in errormask
 */
static void qib_7220_init_hwerrors(struct qib_devdata *dd)
{
        u64 val;
        u64 extsval;

        extsval = qib_read_kreg64(dd, kr_extstatus);

        if (!(extsval & (QLOGIC_IB_EXTS_MEMBIST_ENDTEST |
                         QLOGIC_IB_EXTS_MEMBIST_DISABLED)))
                qib_dev_err(dd, "MemBIST did not complete!\n");
        if (extsval & QLOGIC_IB_EXTS_MEMBIST_DISABLED)
                qib_devinfo(dd->pcidev, "MemBIST is disabled.\n");

        val = ~0ULL;    /* default to all hwerrors become interrupts, */

        val &= ~QLOGIC_IB_HWE_IB_UC_MEMORYPARITYERR;
        dd->cspec->hwerrmask = val;

        qib_write_kreg(dd, kr_hwerrclear, ~HWE_MASK(PowerOnBISTFailed));
        qib_write_kreg(dd, kr_hwerrmask, dd->cspec->hwerrmask);

        /* clear all */
        qib_write_kreg(dd, kr_errclear, ~0ULL);
        /* enable errors that are masked, at least this first time. */
        qib_write_kreg(dd, kr_errmask, ~0ULL);
        dd->cspec->errormask = qib_read_kreg64(dd, kr_errmask);
        /* clear any interrupts up to this point (ints still not enabled) */
        qib_write_kreg(dd, kr_intclear, ~0ULL);
}

/*
 * Disable and enable the armlaunch error.  Used for PIO bandwidth testing
 * on chips that are count-based, rather than trigger-based.  There is no
 * reference counting, but that's also fine, given the intended use.
 * Only chip-specific because it's all register accesses
 */
static void qib_set_7220_armlaunch(struct qib_devdata *dd, u32 enable)
{
        if (enable) {
                qib_write_kreg(dd, kr_errclear, ERR_MASK(SendPioArmLaunchErr));
                dd->cspec->errormask |= ERR_MASK(SendPioArmLaunchErr);
        } else
                dd->cspec->errormask &= ~ERR_MASK(SendPioArmLaunchErr);
        qib_write_kreg(dd, kr_errmask, dd->cspec->errormask);
}

/*
 * Formerly took parameter <which> in pre-shifted,
 * pre-merged form with LinkCmd and LinkInitCmd
 * together, and assuming the zero was NOP.
 */
static void qib_set_ib_7220_lstate(struct qib_pportdata *ppd, u16 linkcmd,
                                   u16 linitcmd)
{
        u64 mod_wd;
        struct qib_devdata *dd = ppd->dd;
        unsigned long flags;

        if (linitcmd == QLOGIC_IB_IBCC_LINKINITCMD_DISABLE) {
                /*
                 * If we are told to disable, note that so link-recovery
                 * code does not attempt to bring us back up.
                 */
                spin_lock_irqsave(&ppd->lflags_lock, flags);
                ppd->lflags |= QIBL_IB_LINK_DISABLED;
                spin_unlock_irqrestore(&ppd->lflags_lock, flags);
        } else if (linitcmd || linkcmd == QLOGIC_IB_IBCC_LINKCMD_DOWN) {
                /*
                 * Any other linkinitcmd will lead to LINKDOWN and then
                 * to INIT (if all is well), so clear flag to let
                 * link-recovery code attempt to bring us back up.
                 */
                spin_lock_irqsave(&ppd->lflags_lock, flags);
                ppd->lflags &= ~QIBL_IB_LINK_DISABLED;
                spin_unlock_irqrestore(&ppd->lflags_lock, flags);
        }

        mod_wd = (linkcmd << IBA7220_IBCC_LINKCMD_SHIFT) |
                (linitcmd << QLOGIC_IB_IBCC_LINKINITCMD_SHIFT);

        qib_write_kreg(dd, kr_ibcctrl, ppd->cpspec->ibcctrl | mod_wd);
        /* write to chip to prevent back-to-back writes of ibc reg */
        qib_write_kreg(dd, kr_scratch, 0);
}

/*
 * All detailed interaction with the SerDes has been moved to qib_sd7220.c
 *
 * The portion of IBA7220-specific bringup_serdes() that actually deals with
 * registers and memory within the SerDes itself is qib_sd7220_init().
 */

/**
 * qib_7220_bringup_serdes - bring up the serdes
 * @ppd: physical port on the qlogic_ib device
 */
static int qib_7220_bringup_serdes(struct qib_pportdata *ppd)
{
        struct qib_devdata *dd = ppd->dd;
        u64 val, prev_val, guid, ibc;
        int ret = 0;

        /* Put IBC in reset, sends disabled */
        dd->control &= ~QLOGIC_IB_C_LINKENABLE;
        qib_write_kreg(dd, kr_control, 0ULL);

        if (qib_compat_ddr_negotiate) {
                ppd->cpspec->ibdeltainprog = 1;
                ppd->cpspec->ibsymsnap = read_7220_creg32(dd, cr_ibsymbolerr);
                ppd->cpspec->iblnkerrsnap =
                        read_7220_creg32(dd, cr_iblinkerrrecov);
        }

        /* flowcontrolwatermark is in units of KBytes */
        ibc = 0x5ULL << SYM_LSB(IBCCtrl, FlowCtrlWaterMark);
        /*
         * How often flowctrl sent.  More or less in usecs; balance against
         * watermark value, so that in theory senders always get a flow
         * control update in time to not let the IB link go idle.
         */
        ibc |= 0x3ULL << SYM_LSB(IBCCtrl, FlowCtrlPeriod);
        /* max error tolerance */
        ibc |= 0xfULL << SYM_LSB(IBCCtrl, PhyerrThreshold);
        /* use "real" buffer space for */
        ibc |= 4ULL << SYM_LSB(IBCCtrl, CreditScale);
        /* IB credit flow control. */
        ibc |= 0xfULL << SYM_LSB(IBCCtrl, OverrunThreshold);
        /*
         * set initial max size pkt IBC will send, including ICRC; it's the
         * PIO buffer size in dwords, less 1; also see qib_set_mtu()
         */
        ibc |= ((u64)(ppd->ibmaxlen >> 2) + 1) << SYM_LSB(IBCCtrl, MaxPktLen);
        ppd->cpspec->ibcctrl = ibc; /* without linkcmd or linkinitcmd! */

        /* initially come up waiting for TS1, without sending anything. */
        val = ppd->cpspec->ibcctrl | (QLOGIC_IB_IBCC_LINKINITCMD_DISABLE <<
                QLOGIC_IB_IBCC_LINKINITCMD_SHIFT);
        qib_write_kreg(dd, kr_ibcctrl, val);

        if (!ppd->cpspec->ibcddrctrl) {
                /* not on re-init after reset */
                ppd->cpspec->ibcddrctrl = qib_read_kreg64(dd, kr_ibcddrctrl);

                if (ppd->link_speed_enabled == (QIB_IB_SDR | QIB_IB_DDR))
                        ppd->cpspec->ibcddrctrl |=
                                IBA7220_IBC_SPEED_AUTONEG_MASK |
                                IBA7220_IBC_IBTA_1_2_MASK;
                else
                        ppd->cpspec->ibcddrctrl |=
                                ppd->link_speed_enabled == QIB_IB_DDR ?
                                IBA7220_IBC_SPEED_DDR : IBA7220_IBC_SPEED_SDR;
                if ((ppd->link_width_enabled & (IB_WIDTH_1X | IB_WIDTH_4X)) ==
                    (IB_WIDTH_1X | IB_WIDTH_4X))
                        ppd->cpspec->ibcddrctrl |= IBA7220_IBC_WIDTH_AUTONEG;
                else
                        ppd->cpspec->ibcddrctrl |=
                                ppd->link_width_enabled == IB_WIDTH_4X ?
                                IBA7220_IBC_WIDTH_4X_ONLY :
                                IBA7220_IBC_WIDTH_1X_ONLY;

                /* always enable these on driver reload, not sticky */
                ppd->cpspec->ibcddrctrl |=
                        IBA7220_IBC_RXPOL_MASK << IBA7220_IBC_RXPOL_SHIFT;
                ppd->cpspec->ibcddrctrl |=
                        IBA7220_IBC_HRTBT_MASK << IBA7220_IBC_HRTBT_SHIFT;

                /* enable automatic lane reversal detection for receive */
                ppd->cpspec->ibcddrctrl |= IBA7220_IBC_LANE_REV_SUPPORTED;
        } else
                /* write to chip to prevent back-to-back writes of ibc reg */
                qib_write_kreg(dd, kr_scratch, 0);

        qib_write_kreg(dd, kr_ibcddrctrl, ppd->cpspec->ibcddrctrl);
        qib_write_kreg(dd, kr_scratch, 0);

        qib_write_kreg(dd, kr_ncmodectrl, 0Ull);
        qib_write_kreg(dd, kr_scratch, 0);

        ret = qib_sd7220_init(dd);

        val = qib_read_kreg64(dd, kr_xgxs_cfg);
        prev_val = val;
        val |= QLOGIC_IB_XGXS_FC_SAFE;
        if (val != prev_val) {
                qib_write_kreg(dd, kr_xgxs_cfg, val);
                qib_read_kreg32(dd, kr_scratch);
        }
        if (val & QLOGIC_IB_XGXS_RESET)
                val &= ~QLOGIC_IB_XGXS_RESET;
        if (val != prev_val)
                qib_write_kreg(dd, kr_xgxs_cfg, val);

        /* first time through, set port guid */
        if (!ppd->guid)
                ppd->guid = dd->base_guid;
        guid = be64_to_cpu(ppd->guid);

        qib_write_kreg(dd, kr_hrtbt_guid, guid);
        if (!ret) {
                dd->control |= QLOGIC_IB_C_LINKENABLE;
                qib_write_kreg(dd, kr_control, dd->control);
        } else
                /* write to chip to prevent back-to-back writes of ibc reg */
                qib_write_kreg(dd, kr_scratch, 0);
        return ret;
}

/**
 * qib_7220_quiet_serdes - set serdes to txidle
 * @ppd: physical port of the qlogic_ib device
 * Called when driver is being unloaded
 */
static void qib_7220_quiet_serdes(struct qib_pportdata *ppd)
{
        u64 val;
        struct qib_devdata *dd = ppd->dd;
        unsigned long flags;

        /* disable IBC */
        dd->control &= ~QLOGIC_IB_C_LINKENABLE;
        qib_write_kreg(dd, kr_control,
                       dd->control | QLOGIC_IB_C_FREEZEMODE);

        ppd->cpspec->chase_end = 0;
        if (ppd->cpspec->chase_timer.data) /* if initted */
                del_timer_sync(&ppd->cpspec->chase_timer);

        if (ppd->cpspec->ibsymdelta || ppd->cpspec->iblnkerrdelta ||
            ppd->cpspec->ibdeltainprog) {
                u64 diagc;

                /* enable counter writes */
                diagc = qib_read_kreg64(dd, kr_hwdiagctrl);
                qib_write_kreg(dd, kr_hwdiagctrl,
                               diagc | SYM_MASK(HwDiagCtrl, CounterWrEnable));

                if (ppd->cpspec->ibsymdelta || ppd->cpspec->ibdeltainprog) {
                        val = read_7220_creg32(dd, cr_ibsymbolerr);
                        if (ppd->cpspec->ibdeltainprog)
                                val -= val - ppd->cpspec->ibsymsnap;
                        val -= ppd->cpspec->ibsymdelta;
                        write_7220_creg(dd, cr_ibsymbolerr, val);
                }
                if (ppd->cpspec->iblnkerrdelta || ppd->cpspec->ibdeltainprog) {
                        val = read_7220_creg32(dd, cr_iblinkerrrecov);
                        if (ppd->cpspec->ibdeltainprog)
                                val -= val - ppd->cpspec->iblnkerrsnap;
                        val -= ppd->cpspec->iblnkerrdelta;
                        write_7220_creg(dd, cr_iblinkerrrecov, val);
                }

                /* and disable counter writes */
                qib_write_kreg(dd, kr_hwdiagctrl, diagc);
        }
        qib_set_ib_7220_lstate(ppd, 0, QLOGIC_IB_IBCC_LINKINITCMD_DISABLE);

        spin_lock_irqsave(&ppd->lflags_lock, flags);
        ppd->lflags &= ~QIBL_IB_AUTONEG_INPROG;
        spin_unlock_irqrestore(&ppd->lflags_lock, flags);
        wake_up(&ppd->cpspec->autoneg_wait);
        cancel_delayed_work_sync(&ppd->cpspec->autoneg_work);

        shutdown_7220_relock_poll(ppd->dd);
        val = qib_read_kreg64(ppd->dd, kr_xgxs_cfg);
        val |= QLOGIC_IB_XGXS_RESET;
        qib_write_kreg(ppd->dd, kr_xgxs_cfg, val);
}

/**
 * qib_setup_7220_setextled - set the state of the two external LEDs
 * @dd: the qlogic_ib device
 * @on: whether the link is up or not
 *
 * The exact combo of LEDs if on is true is determined by looking
 * at the ibcstatus.
 *
 * These LEDs indicate the physical and logical state of IB link.
 * For this chip (at least with recommended board pinouts), LED1
 * is Yellow (logical state) and LED2 is Green (physical state),
 *
 * Note:  We try to match the Mellanox HCA LED behavior as best
 * we can.  Green indicates physical link state is OK (something is
 * plugged in, and we can train).
 * Amber indicates the link is logically up (ACTIVE).
 * Mellanox further blinks the amber LED to indicate data packet
 * activity, but we have no hardware support for that, so it would
 * require waking up every 10-20 msecs and checking the counters
 * on the chip, and then turning the LED off if appropriate.  That's
 * visible overhead, so not something we will do.
 *
 */
static void qib_setup_7220_setextled(struct qib_pportdata *ppd, u32 on)
{
        struct qib_devdata *dd = ppd->dd;
        u64 extctl, ledblink = 0, val, lst, ltst;
        unsigned long flags;

        /*
         * The diags use the LED to indicate diag info, so we leave
         * the external LED alone when the diags are running.
         */
        if (dd->diag_client)
                return;

        if (ppd->led_override) {
                ltst = (ppd->led_override & QIB_LED_PHYS) ?
                        IB_PHYSPORTSTATE_LINKUP : IB_PHYSPORTSTATE_DISABLED,
                lst = (ppd->led_override & QIB_LED_LOG) ?
                        IB_PORT_ACTIVE : IB_PORT_DOWN;
        } else if (on) {
                val = qib_read_kreg64(dd, kr_ibcstatus);
                ltst = qib_7220_phys_portstate(val);
                lst = qib_7220_iblink_state(val);
        } else {
                ltst = 0;
                lst = 0;
        }

        spin_lock_irqsave(&dd->cspec->gpio_lock, flags);
        extctl = dd->cspec->extctrl & ~(SYM_MASK(EXTCtrl, LEDPriPortGreenOn) |
                                 SYM_MASK(EXTCtrl, LEDPriPortYellowOn));
        if (ltst == IB_PHYSPORTSTATE_LINKUP) {
                extctl |= SYM_MASK(EXTCtrl, LEDPriPortGreenOn);
                /*
                 * counts are in chip clock (4ns) periods.
                 * This is 1/16 sec (66.6ms) on,
                 * 3/16 sec (187.5 ms) off, with packets rcvd
                 */
                ledblink = ((66600 * 1000UL / 4) << IBA7220_LEDBLINK_ON_SHIFT)
                        | ((187500 * 1000UL / 4) << IBA7220_LEDBLINK_OFF_SHIFT);
        }
        if (lst == IB_PORT_ACTIVE)
                extctl |= SYM_MASK(EXTCtrl, LEDPriPortYellowOn);
        dd->cspec->extctrl = extctl;
        qib_write_kreg(dd, kr_extctrl, extctl);
        spin_unlock_irqrestore(&dd->cspec->gpio_lock, flags);

        if (ledblink) /* blink the LED on packet receive */
                qib_write_kreg(dd, kr_rcvpktledcnt, ledblink);
}

static void qib_7220_free_irq(struct qib_devdata *dd)
{
        if (dd->cspec->irq) {
                free_irq(dd->cspec->irq, dd);
                dd->cspec->irq = 0;
        }
        qib_nomsi(dd);
}

/*
 * qib_setup_7220_cleanup - clean up any per-chip chip-specific stuff
 * @dd: the qlogic_ib device
 *
 * This is called during driver unload.
 *
 */
static void qib_setup_7220_cleanup(struct qib_devdata *dd)
{
        qib_7220_free_irq(dd);
        kfree(dd->cspec->cntrs);
        kfree(dd->cspec->portcntrs);
}

/*
 * This is only called for SDmaInt.
 * SDmaDisabled is handled on the error path.
 */
static void sdma_7220_intr(struct qib_pportdata *ppd, u64 istat)
{
        unsigned long flags;

        spin_lock_irqsave(&ppd->sdma_lock, flags);

        switch (ppd->sdma_state.current_state) {
        case qib_sdma_state_s00_hw_down:
                break;

        case qib_sdma_state_s10_hw_start_up_wait:
                __qib_sdma_process_event(ppd, qib_sdma_event_e20_hw_started);
                break;

        case qib_sdma_state_s20_idle:
                break;

        case qib_sdma_state_s30_sw_clean_up_wait:
                break;

        case qib_sdma_state_s40_hw_clean_up_wait:
                break;

        case qib_sdma_state_s50_hw_halt_wait:
                __qib_sdma_process_event(ppd, qib_sdma_event_e60_hw_halted);
                break;

        case qib_sdma_state_s99_running:
                /* too chatty to print here */
                __qib_sdma_intr(ppd);
                break;
        }
        spin_unlock_irqrestore(&ppd->sdma_lock, flags);
}

static void qib_wantpiobuf_7220_intr(struct qib_devdata *dd, u32 needint)
{
        unsigned long flags;

        spin_lock_irqsave(&dd->sendctrl_lock, flags);
        if (needint) {
                if (!(dd->sendctrl & SYM_MASK(SendCtrl, SendBufAvailUpd)))
                        goto done;
                /*
                 * blip the availupd off, next write will be on, so
                 * we ensure an avail update, regardless of threshold or
                 * buffers becoming free, whenever we want an interrupt
                 */
                qib_write_kreg(dd, kr_sendctrl, dd->sendctrl &
                        ~SYM_MASK(SendCtrl, SendBufAvailUpd));
                qib_write_kreg(dd, kr_scratch, 0ULL);
                dd->sendctrl |= SYM_MASK(SendCtrl, SendIntBufAvail);
        } else
                dd->sendctrl &= ~SYM_MASK(SendCtrl, SendIntBufAvail);
        qib_write_kreg(dd, kr_sendctrl, dd->sendctrl);
        qib_write_kreg(dd, kr_scratch, 0ULL);
done:
        spin_unlock_irqrestore(&dd->sendctrl_lock, flags);
}

/*
 * Handle errors and unusual events first, separate function
 * to improve cache hits for fast path interrupt handling.
 */
static noinline void unlikely_7220_intr(struct qib_devdata *dd, u64 istat)
{
        if (unlikely(istat & ~QLOGIC_IB_I_BITSEXTANT))
                qib_dev_err(dd,
                            "interrupt with unknown interrupts %Lx set\n",
                            istat & ~QLOGIC_IB_I_BITSEXTANT);

        if (istat & QLOGIC_IB_I_GPIO) {
                u32 gpiostatus;

                /*
                 * Boards for this chip currently don't use GPIO interrupts,
                 * so clear by writing GPIOstatus to GPIOclear, and complain
                 * to alert developer. To avoid endless repeats, clear
                 * the bits in the mask, since there is some kind of
                 * programming error or chip problem.
                 */
                gpiostatus = qib_read_kreg32(dd, kr_gpio_status);
                /*
                 * In theory, writing GPIOstatus to GPIOclear could
                 * have a bad side-effect on some diagnostic that wanted
                 * to poll for a status-change, but the various shadows
                 * make that problematic at best. Diags will just suppress
                 * all GPIO interrupts during such tests.
                 */
                qib_write_kreg(dd, kr_gpio_clear, gpiostatus);

                if (gpiostatus) {
                        const u32 mask = qib_read_kreg32(dd, kr_gpio_mask);
                        u32 gpio_irq = mask & gpiostatus;

                        /*
                         * A bit set in status and (chip) Mask register
                         * would cause an interrupt. Since we are not
                         * expecting any, report it. Also check that the
                         * chip reflects our shadow, report issues,
                         * and refresh from the shadow.
                         */
                        /*
                         * Clear any troublemakers, and update chip
                         * from shadow
                         */
                        dd->cspec->gpio_mask &= ~gpio_irq;
                        qib_write_kreg(dd, kr_gpio_mask, dd->cspec->gpio_mask);
                }
        }

        if (istat & QLOGIC_IB_I_ERROR) {
                u64 estat;

                qib_stats.sps_errints++;
                estat = qib_read_kreg64(dd, kr_errstatus);
                if (!estat)
                        qib_devinfo(dd->pcidev,
                                "error interrupt (%Lx), but no error bits set!\n",
                                istat);
                else
                        handle_7220_errors(dd, estat);
        }
}

static irqreturn_t qib_7220intr(int irq, void *data)
{
        struct qib_devdata *dd = data;
        irqreturn_t ret;
        u64 istat;
        u64 ctxtrbits;
        u64 rmask;
        unsigned i;

        if ((dd->flags & (QIB_PRESENT | QIB_BADINTR)) != QIB_PRESENT) {
                /*
                 * This return value is not great, but we do not want the
                 * interrupt core code to remove our interrupt handler
                 * because we don't appear to be handling an interrupt
                 * during a chip reset.
                 */
                ret = IRQ_HANDLED;
                goto bail;
        }

        istat = qib_read_kreg64(dd, kr_intstatus);

        if (unlikely(!istat)) {
                ret = IRQ_NONE; /* not our interrupt, or already handled */
                goto bail;
        }
        if (unlikely(istat == -1)) {
                qib_bad_intrstatus(dd);
                /* don't know if it was our interrupt or not */
                ret = IRQ_NONE;
                goto bail;
        }

        qib_stats.sps_ints++;
        if (dd->int_counter != (u32) -1)
                dd->int_counter++;

        if (unlikely(istat & (~QLOGIC_IB_I_BITSEXTANT |
                              QLOGIC_IB_I_GPIO | QLOGIC_IB_I_ERROR)))
                unlikely_7220_intr(dd, istat);

        /*
         * Clear the interrupt bits we found set, relatively early, so we
         * "know" know the chip will have seen this by the time we process
         * the queue, and will re-interrupt if necessary.  The processor
         * itself won't take the interrupt again until we return.
         */
        qib_write_kreg(dd, kr_intclear, istat);

        /*
         * Handle kernel receive queues before checking for pio buffers
         * available since receives can overflow; piobuf waiters can afford
         * a few extra cycles, since they were waiting anyway.
         */
        ctxtrbits = istat &
                ((QLOGIC_IB_I_RCVAVAIL_MASK << QLOGIC_IB_I_RCVAVAIL_SHIFT) |
                 (QLOGIC_IB_I_RCVURG_MASK << QLOGIC_IB_I_RCVURG_SHIFT));
        if (ctxtrbits) {
                rmask = (1ULL << QLOGIC_IB_I_RCVAVAIL_SHIFT) |
                        (1ULL << QLOGIC_IB_I_RCVURG_SHIFT);
                for (i = 0; i < dd->first_user_ctxt; i++) {
                        if (ctxtrbits & rmask) {
                                ctxtrbits &= ~rmask;
                                qib_kreceive(dd->rcd[i], NULL, NULL);
                        }
                        rmask <<= 1;
                }
                if (ctxtrbits) {
                        ctxtrbits =

                                (ctxtrbits >> QLOGIC_IB_I_RCVAVAIL_SHIFT) |
                                (ctxtrbits >> QLOGIC_IB_I_RCVURG_SHIFT);
                        qib_handle_urcv(dd, ctxtrbits);
                }
        }

        /* only call for SDmaInt */
        if (istat & QLOGIC_IB_I_SDMAINT)
                sdma_7220_intr(dd->pport, istat);

        if ((istat & QLOGIC_IB_I_SPIOBUFAVAIL) && (dd->flags & QIB_INITTED))
                qib_ib_piobufavail(dd);

        ret = IRQ_HANDLED;
bail:
        return ret;
}

/*
 * Set up our chip-specific interrupt handler.
 * The interrupt type has already been setup, so
 * we just need to do the registration and error checking.
 * If we are using MSI interrupts, we may fall back to
 * INTx later, if the interrupt handler doesn't get called
 * within 1/2 second (see verify_interrupt()).
 */
static void qib_setup_7220_interrupt(struct qib_devdata *dd)
{
        if (!dd->cspec->irq)
                qib_dev_err(dd,
                        "irq is 0, BIOS error?  Interrupts won't work\n");
        else {
                int ret = request_irq(dd->cspec->irq, qib_7220intr,
                        dd->msi_lo ? 0 : IRQF_SHARED,
                        QIB_DRV_NAME, dd);

                if (ret)
                        qib_dev_err(dd,
                                "Couldn't setup %s interrupt (irq=%d): %d\n",
                                dd->msi_lo ?  "MSI" : "INTx",
                                dd->cspec->irq, ret);
        }
}

/**
 * qib_7220_boardname - fill in the board name
 * @dd: the qlogic_ib device
 *
 * info is based on the board revision register
 */
static void qib_7220_boardname(struct qib_devdata *dd)
{
        char *n;
        u32 boardid, namelen;

        boardid = SYM_FIELD(dd->revision, Revision,
                            BoardID);

        switch (boardid) {
        case 1:
                n = "InfiniPath_QLE7240";
                break;
        case 2:
                n = "InfiniPath_QLE7280";
                break;
        default:
                qib_dev_err(dd, "Unknown 7220 board with ID %u\n", boardid);
                n = "Unknown_InfiniPath_7220";
                break;
        }

        namelen = strlen(n) + 1;
        dd->boardname = kmalloc(namelen, GFP_KERNEL);
        if (!dd->boardname)
                qib_dev_err(dd, "Failed allocation for board name: %s\n", n);
        else
                snprintf(dd->boardname, namelen, "%s", n);

        if (dd->majrev != 5 || !dd->minrev || dd->minrev > 2)
                qib_dev_err(dd,
                        "Unsupported InfiniPath hardware revision %u.%u!\n",
                        dd->majrev, dd->minrev);

        snprintf(dd->boardversion, sizeof(dd->boardversion),
                 "ChipABI %u.%u, %s, InfiniPath%u %u.%u, SW Compat %u\n",
                 QIB_CHIP_VERS_MAJ, QIB_CHIP_VERS_MIN, dd->boardname,
                 (unsigned)SYM_FIELD(dd->revision, Revision_R, Arch),
                 dd->majrev, dd->minrev,
                 (unsigned)SYM_FIELD(dd->revision, Revision_R, SW));
}

/*
 * This routine sleeps, so it can only be called from user context, not
 * from interrupt context.
 */
static int qib_setup_7220_reset(struct qib_devdata *dd)
{
        u64 val;
        int i;
        int ret;
        u16 cmdval;
        u8 int_line, clinesz;
        unsigned long flags;

        qib_pcie_getcmd(dd, &cmdval, &int_line, &clinesz);

        /* Use dev_err so it shows up in logs, etc. */
        qib_dev_err(dd, "Resetting InfiniPath unit %u\n", dd->unit);

        /* no interrupts till re-initted */
        qib_7220_set_intr_state(dd, 0);

        dd->pport->cpspec->ibdeltainprog = 0;
        dd->pport->cpspec->ibsymdelta = 0;
        dd->pport->cpspec->iblnkerrdelta = 0;

        /*
         * Keep chip from being accessed until we are ready.  Use
         * writeq() directly, to allow the write even though QIB_PRESENT
         * isn't set.
         */
        dd->flags &= ~(QIB_INITTED | QIB_PRESENT);
        dd->int_counter = 0; /* so we check interrupts work again */
        val = dd->control | QLOGIC_IB_C_RESET;
        writeq(val, &dd->kregbase[kr_control]);
        mb(); /* prevent compiler reordering around actual reset */

        for (i = 1; i <= 5; i++) {
                /*
                 * Allow MBIST, etc. to complete; longer on each retry.
                 * We sometimes get machine checks from bus timeout if no
                 * response, so for now, make it *really* long.
                 */
                msleep(1000 + (1 + i) * 2000);

                qib_pcie_reenable(dd, cmdval, int_line, clinesz);

                /*
                 * Use readq directly, so we don't need to mark it as PRESENT
                 * until we get a successful indication that all is well.
                 */
                val = readq(&dd->kregbase[kr_revision]);
                if (val == dd->revision) {
                        dd->flags |= QIB_PRESENT; /* it's back */
                        ret = qib_reinit_intr(dd);
                        goto bail;
                }
        }
        ret = 0; /* failed */

bail:
        if (ret) {
                if (qib_pcie_params(dd, dd->lbus_width, NULL, NULL))
                        qib_dev_err(dd,
                                "Reset failed to setup PCIe or interrupts; continuing anyway\n");

                /* hold IBC in reset, no sends, etc till later */
                qib_write_kreg(dd, kr_control, 0ULL);

                /* clear the reset error, init error/hwerror mask */
                qib_7220_init_hwerrors(dd);

                /* do setup similar to speed or link-width changes */
                if (dd->pport->cpspec->ibcddrctrl & IBA7220_IBC_IBTA_1_2_MASK)
                        dd->cspec->presets_needed = 1;
                spin_lock_irqsave(&dd->pport->lflags_lock, flags);
                dd->pport->lflags |= QIBL_IB_FORCE_NOTIFY;
                dd->pport->lflags &= ~QIBL_IB_AUTONEG_FAILED;
                spin_unlock_irqrestore(&dd->pport->lflags_lock, flags);
        }

        return ret;
}

/**
 * qib_7220_put_tid - write a TID to the chip
 * @dd: the qlogic_ib device
 * @tidptr: pointer to the expected TID (in chip) to update
 * @tidtype: 0 for eager, 1 for expected
 * @pa: physical address of in memory buffer; tidinvalid if freeing
 */
static void qib_7220_put_tid(struct qib_devdata *dd, u64 __iomem *tidptr,
                             u32 type, unsigned long pa)
{
        if (pa != dd->tidinvalid) {
                u64 chippa = pa >> IBA7220_TID_PA_SHIFT;

                /* paranoia checks */
                if (pa != (chippa << IBA7220_TID_PA_SHIFT)) {
                        qib_dev_err(dd, "Physaddr %lx not 2KB aligned!\n",
                                    pa);
                        return;
                }
                if (chippa >= (1UL << IBA7220_TID_SZ_SHIFT)) {
                        qib_dev_err(dd,
                                "Physical page address 0x%lx larger than supported\n",
                                pa);
                        return;
                }

                if (type == RCVHQ_RCV_TYPE_EAGER)
                        chippa |= dd->tidtemplate;
                else /* for now, always full 4KB page */
                        chippa |= IBA7220_TID_SZ_4K;
                pa = chippa;
        }
        writeq(pa, tidptr);
        mmiowb();
}

/**
 * qib_7220_clear_tids - clear all TID entries for a ctxt, expected and eager
 * @dd: the qlogic_ib device
 * @ctxt: the ctxt
 *
 * clear all TID entries for a ctxt, expected and eager.
 * Used from qib_close().  On this chip, TIDs are only 32 bits,
 * not 64, but they are still on 64 bit boundaries, so tidbase
 * is declared as u64 * for the pointer math, even though we write 32 bits
 */
static void qib_7220_clear_tids(struct qib_devdata *dd,
                                struct qib_ctxtdata *rcd)
{
        u64 __iomem *tidbase;
        unsigned long tidinv;
        u32 ctxt;
        int i;

        if (!dd->kregbase || !rcd)
                return;

        ctxt = rcd->ctxt;

        tidinv = dd->tidinvalid;
        tidbase = (u64 __iomem *)
                ((char __iomem *)(dd->kregbase) +
                 dd->rcvtidbase +
                 ctxt * dd->rcvtidcnt * sizeof(*tidbase));

        for (i = 0; i < dd->rcvtidcnt; i++)
                qib_7220_put_tid(dd, &tidbase[i], RCVHQ_RCV_TYPE_EXPECTED,
                                 tidinv);

        tidbase = (u64 __iomem *)
                ((char __iomem *)(dd->kregbase) +
                 dd->rcvegrbase +
                 rcd->rcvegr_tid_base * sizeof(*tidbase));

        for (i = 0; i < rcd->rcvegrcnt; i++)
                qib_7220_put_tid(dd, &tidbase[i], RCVHQ_RCV_TYPE_EAGER,
                                 tidinv);
}

/**
 * qib_7220_tidtemplate - setup constants for TID updates
 * @dd: the qlogic_ib device
 *
 * We setup stuff that we use a lot, to avoid calculating each time
 */
static void qib_7220_tidtemplate(struct qib_devdata *dd)
{
        if (dd->rcvegrbufsize == 2048)
                dd->tidtemplate = IBA7220_TID_SZ_2K;
        else if (dd->rcvegrbufsize == 4096)
                dd->tidtemplate = IBA7220_TID_SZ_4K;
        dd->tidinvalid = 0;
}

/**
 * qib_init_7220_get_base_info - set chip-specific flags for user code
 * @rcd: the qlogic_ib ctxt
 * @kbase: qib_base_info pointer
 *
 * We set the PCIE flag because the lower bandwidth on PCIe vs
 * HyperTransport can affect some user packet algorithims.
 */
static int qib_7220_get_base_info(struct qib_ctxtdata *rcd,
                                  struct qib_base_info *kinfo)
{
        kinfo->spi_runtime_flags |= QIB_RUNTIME_PCIE |
                QIB_RUNTIME_NODMA_RTAIL | QIB_RUNTIME_SDMA;

        if (rcd->dd->flags & QIB_USE_SPCL_TRIG)
                kinfo->spi_runtime_flags |= QIB_RUNTIME_SPECIAL_TRIGGER;

        return 0;
}

static struct qib_message_header *
qib_7220_get_msgheader(struct qib_devdata *dd, __le32 *rhf_addr)
{
        u32 offset = qib_hdrget_offset(rhf_addr);

        return (struct qib_message_header *)
                (rhf_addr - dd->rhf_offset + offset);
}

static void qib_7220_config_ctxts(struct qib_devdata *dd)
{
        unsigned long flags;
        u32 nchipctxts;

        nchipctxts = qib_read_kreg32(dd, kr_portcnt);
        dd->cspec->numctxts = nchipctxts;
        if (qib_n_krcv_queues > 1) {
                dd->qpn_mask = 0x3e;
                dd->first_user_ctxt = qib_n_krcv_queues * dd->num_pports;
                if (dd->first_user_ctxt > nchipctxts)
                        dd->first_user_ctxt = nchipctxts;
        } else
                dd->first_user_ctxt = dd->num_pports;
        dd->n_krcv_queues = dd->first_user_ctxt;

        if (!qib_cfgctxts) {
                int nctxts = dd->first_user_ctxt + num_online_cpus();

                if (nctxts <= 5)
                        dd->ctxtcnt = 5;
                else if (nctxts <= 9)
                        dd->ctxtcnt = 9;
                else if (nctxts <= nchipctxts)
                        dd->ctxtcnt = nchipctxts;
        } else if (qib_cfgctxts <= nchipctxts)
                dd->ctxtcnt = qib_cfgctxts;
        if (!dd->ctxtcnt) /* none of the above, set to max */
                dd->ctxtcnt = nchipctxts;

        /*
         * Chip can be configured for 5, 9, or 17 ctxts, and choice
         * affects number of eager TIDs per ctxt (1K, 2K, 4K).
         * Lock to be paranoid about later motion, etc.
         */
        spin_lock_irqsave(&dd->cspec->rcvmod_lock, flags);
        if (dd->ctxtcnt > 9)
                dd->rcvctrl |= 2ULL << IBA7220_R_CTXTCFG_SHIFT;
        else if (dd->ctxtcnt > 5)
                dd->rcvctrl |= 1ULL << IBA7220_R_CTXTCFG_SHIFT;
        /* else configure for default 5 receive ctxts */
        if (dd->qpn_mask)
                dd->rcvctrl |= 1ULL << QIB_7220_RcvCtrl_RcvQPMapEnable_LSB;
        qib_write_kreg(dd, kr_rcvctrl, dd->rcvctrl);
        spin_unlock_irqrestore(&dd->cspec->rcvmod_lock, flags);

        /* kr_rcvegrcnt changes based on the number of contexts enabled */
        dd->cspec->rcvegrcnt = qib_read_kreg32(dd, kr_rcvegrcnt);
        dd->rcvhdrcnt = max(dd->cspec->rcvegrcnt, IBA7220_KRCVEGRCNT);
}

static int qib_7220_get_ib_cfg(struct qib_pportdata *ppd, int which)
{
        int lsb, ret = 0;
        u64 maskr; /* right-justified mask */

        switch (which) {
        case QIB_IB_CFG_LWID_ENB: /* Get allowed Link-width */
                ret = ppd->link_width_enabled;
                goto done;

        case QIB_IB_CFG_LWID: /* Get currently active Link-width */
                ret = ppd->link_width_active;
                goto done;

        case QIB_IB_CFG_SPD_ENB: /* Get allowed Link speeds */
                ret = ppd->link_speed_enabled;
                goto done;

        case QIB_IB_CFG_SPD: /* Get current Link spd */
                ret = ppd->link_speed_active;
                goto done;

        case QIB_IB_CFG_RXPOL_ENB: /* Get Auto-RX-polarity enable */
                lsb = IBA7220_IBC_RXPOL_SHIFT;
                maskr = IBA7220_IBC_RXPOL_MASK;
                break;

        case QIB_IB_CFG_LREV_ENB: /* Get Auto-Lane-reversal enable */
                lsb = IBA7220_IBC_LREV_SHIFT;
                maskr = IBA7220_IBC_LREV_MASK;
                break;

        case QIB_IB_CFG_LINKLATENCY:
                ret = qib_read_kreg64(ppd->dd, kr_ibcddrstatus)
                        & IBA7220_DDRSTAT_LINKLAT_MASK;
                goto done;

        case QIB_IB_CFG_OP_VLS:
                ret = ppd->vls_operational;
                goto done;

        case QIB_IB_CFG_VL_HIGH_CAP:
                ret = 0;
                goto done;

        case QIB_IB_CFG_VL_LOW_CAP:
                ret = 0;
                goto done;

        case QIB_IB_CFG_OVERRUN_THRESH: /* IB overrun threshold */
                ret = SYM_FIELD(ppd->cpspec->ibcctrl, IBCCtrl,
                                OverrunThreshold);
                goto done;

        case QIB_IB_CFG_PHYERR_THRESH: /* IB PHY error threshold */
                ret = SYM_FIELD(ppd->cpspec->ibcctrl, IBCCtrl,
                                PhyerrThreshold);
                goto done;

        case QIB_IB_CFG_LINKDEFAULT: /* IB link default (sleep/poll) */
                /* will only take effect when the link state changes */
                ret = (ppd->cpspec->ibcctrl &
                       SYM_MASK(IBCCtrl, LinkDownDefaultState)) ?
                        IB_LINKINITCMD_SLEEP : IB_LINKINITCMD_POLL;
                goto done;

        case QIB_IB_CFG_HRTBT: /* Get Heartbeat off/enable/auto */
                lsb = IBA7220_IBC_HRTBT_SHIFT;
                maskr = IBA7220_IBC_HRTBT_MASK;
                break;

        case QIB_IB_CFG_PMA_TICKS:
                /*
                 * 0x00 = 10x link transfer rate or 4 nsec. for 2.5Gbs
                 * Since the clock is always 250MHz, the value is 1 or 0.
                 */
                ret = (ppd->link_speed_active == QIB_IB_DDR);
                goto done;

        default:
                ret = -EINVAL;
                goto done;
        }
        ret = (int)((ppd->cpspec->ibcddrctrl >> lsb) & maskr);
done:
        return ret;
}

static int qib_7220_set_ib_cfg(struct qib_pportdata *ppd, int which, u32 val)
{
        struct qib_devdata *dd = ppd->dd;
        u64 maskr; /* right-justified mask */
        int lsb, ret = 0, setforce = 0;
        u16 lcmd, licmd;
        unsigned long flags;
        u32 tmp = 0;

        switch (which) {
        case QIB_IB_CFG_LIDLMC:
                /*
                 * Set LID and LMC. Combined to avoid possible hazard
                 * caller puts LMC in 16MSbits, DLID in 16LSbits of val
                 */
                lsb = IBA7220_IBC_DLIDLMC_SHIFT;
                maskr = IBA7220_IBC_DLIDLMC_MASK;
                break;

        case QIB_IB_CFG_LWID_ENB: /* set allowed Link-width */
                /*
                 * As with speed, only write the actual register if
                 * the link is currently down, otherwise takes effect
                 * on next link change.
                 */
                ppd->link_width_enabled = val;
                if (!(ppd->lflags & QIBL_LINKDOWN))
                        goto bail;
                /*
                 * We set the QIBL_IB_FORCE_NOTIFY bit so updown
                 * will get called because we want update
                 * link_width_active, and the change may not take
                 * effect for some time (if we are in POLL), so this
                 * flag will force the updown routine to be called
                 * on the next ibstatuschange down interrupt, even
                 * if it's not an down->up transition.
                 */
                val--; /* convert from IB to chip */
                maskr = IBA7220_IBC_WIDTH_MASK;
                lsb = IBA7220_IBC_WIDTH_SHIFT;
                setforce = 1;
                break;

        case QIB_IB_CFG_SPD_ENB: /* set allowed Link speeds */
                /*
                 * If we turn off IB1.2, need to preset SerDes defaults,
                 * but not right now. Set a flag for the next time
                 * we command the link down.  As with width, only write the
                 * actual register if the link is currently down, otherwise
                 * takes effect on next link change.  Since setting is being
                 * explicitly requested (via MAD or sysfs), clear autoneg
                 * failure status if speed autoneg is enabled.
                 */
                ppd->link_speed_enabled = val;
                if ((ppd->cpspec->ibcddrctrl & IBA7220_IBC_IBTA_1_2_MASK) &&
                    !(val & (val - 1)))
                        dd->cspec->presets_needed = 1;
                if (!(ppd->lflags & QIBL_LINKDOWN))
                        goto bail;
                /*
                 * We set the QIBL_IB_FORCE_NOTIFY bit so updown
                 * will get called because we want update
                 * link_speed_active, and the change may not take
                 * effect for some time (if we are in POLL), so this
                 * flag will force the updown routine to be called
                 * on the next ibstatuschange down interrupt, even
                 * if it's not an down->up transition.
                 */
                if (val == (QIB_IB_SDR | QIB_IB_DDR)) {
                        val = IBA7220_IBC_SPEED_AUTONEG_MASK |
                                IBA7220_IBC_IBTA_1_2_MASK;
                        spin_lock_irqsave(&ppd->lflags_lock, flags);
                        ppd->lflags &= ~QIBL_IB_AUTONEG_FAILED;
                        spin_unlock_irqrestore(&ppd->lflags_lock, flags);
                } else
                        val = val == QIB_IB_DDR ?
                                IBA7220_IBC_SPEED_DDR : IBA7220_IBC_SPEED_SDR;
                maskr = IBA7220_IBC_SPEED_AUTONEG_MASK |
                        IBA7220_IBC_IBTA_1_2_MASK;
                /* IBTA 1.2 mode + speed bits are contiguous */
                lsb = SYM_LSB(IBCDDRCtrl, IB_ENHANCED_MODE);
                setforce = 1;
                break;

        case QIB_IB_CFG_RXPOL_ENB: /* set Auto-RX-polarity enable */
                lsb = IBA7220_IBC_RXPOL_SHIFT;
                maskr = IBA7220_IBC_RXPOL_MASK;
                break;

        case QIB_IB_CFG_LREV_ENB: /* set Auto-Lane-reversal enable */
                lsb = IBA7220_IBC_LREV_SHIFT;
                maskr = IBA7220_IBC_LREV_MASK;
                break;

        case QIB_IB_CFG_OVERRUN_THRESH: /* IB overrun threshold */
                maskr = SYM_FIELD(ppd->cpspec->ibcctrl, IBCCtrl,
                                  OverrunThreshold);
                if (maskr != val) {
                        ppd->cpspec->ibcctrl &=
                                ~SYM_MASK(IBCCtrl, OverrunThreshold);
                        ppd->cpspec->ibcctrl |= (u64) val <<
                                SYM_LSB(IBCCtrl, OverrunThreshold);
                        qib_write_kreg(dd, kr_ibcctrl, ppd->cpspec->ibcctrl);
                        qib_write_kreg(dd, kr_scratch, 0);
                }
                goto bail;

        case QIB_IB_CFG_PHYERR_THRESH: /* IB PHY error threshold */
                maskr = SYM_FIELD(ppd->cpspec->ibcctrl, IBCCtrl,
                                  PhyerrThreshold);
                if (maskr != val) {
                        ppd->cpspec->ibcctrl &=
                                ~SYM_MASK(IBCCtrl, PhyerrThreshold);
                        ppd->cpspec->ibcctrl |= (u64) val <<
                                SYM_LSB(IBCCtrl, PhyerrThreshold);
                        qib_write_kreg(dd, kr_ibcctrl, ppd->cpspec->ibcctrl);
                        qib_write_kreg(dd, kr_scratch, 0);
                }
                goto bail;

        case QIB_IB_CFG_PKEYS: /* update pkeys */
                maskr = (u64) ppd->pkeys[0] | ((u64) ppd->pkeys[1] << 16) |
                        ((u64) ppd->pkeys[2] << 32) |
                        ((u64) ppd->pkeys[3] << 48);
                qib_write_kreg(dd, kr_partitionkey, maskr);
                goto bail;

        case QIB_IB_CFG_LINKDEFAULT: /* IB link default (sleep/poll) */
                /* will only take effect when the link state changes */
                if (val == IB_LINKINITCMD_POLL)
                        ppd->cpspec->ibcctrl &=
                                ~SYM_MASK(IBCCtrl, LinkDownDefaultState);
                else /* SLEEP */
                        ppd->cpspec->ibcctrl |=
                                SYM_MASK(IBCCtrl, LinkDownDefaultState);
                qib_write_kreg(dd, kr_ibcctrl, ppd->cpspec->ibcctrl);
                qib_write_kreg(dd, kr_scratch, 0);
                goto bail;

        case QIB_IB_CFG_MTU: /* update the MTU in IBC */
                /*
                 * Update our housekeeping variables, and set IBC max
                 * size, same as init code; max IBC is max we allow in
                 * buffer, less the qword pbc, plus 1 for ICRC, in dwords
                 * Set even if it's unchanged, print debug message only
                 * on changes.
                 */
                val = (ppd->ibmaxlen >> 2) + 1;
                ppd->cpspec->ibcctrl &= ~SYM_MASK(IBCCtrl, MaxPktLen);
                ppd->cpspec->ibcctrl |= (u64)val << SYM_LSB(IBCCtrl, MaxPktLen);
                qib_write_kreg(dd, kr_ibcctrl, ppd->cpspec->ibcctrl);
                qib_write_kreg(dd, kr_scratch, 0);
                goto bail;

        case QIB_IB_CFG_LSTATE: /* set the IB link state */
                switch (val & 0xffff0000) {
                case IB_LINKCMD_DOWN:
                        lcmd = QLOGIC_IB_IBCC_LINKCMD_DOWN;
                        if (!ppd->cpspec->ibdeltainprog &&
                            qib_compat_ddr_negotiate) {
                                ppd->cpspec->ibdeltainprog = 1;
                                ppd->cpspec->ibsymsnap =
                                        read_7220_creg32(dd, cr_ibsymbolerr);
                                ppd->cpspec->iblnkerrsnap =
                                        read_7220_creg32(dd, cr_iblinkerrrecov);
                        }
                        break;

                case IB_LINKCMD_ARMED:
                        lcmd = QLOGIC_IB_IBCC_LINKCMD_ARMED;
                        break;

                case IB_LINKCMD_ACTIVE:
                        lcmd = QLOGIC_IB_IBCC_LINKCMD_ACTIVE;
                        break;

                default:
                        ret = -EINVAL;
                        qib_dev_err(dd, "bad linkcmd req 0x%x\n", val >> 16);
                        goto bail;
                }
                switch (val & 0xffff) {
                case IB_LINKINITCMD_NOP:
                        licmd = 0;
                        break;

                case IB_LINKINITCMD_POLL:
                        licmd = QLOGIC_IB_IBCC_LINKINITCMD_POLL;
                        break;

                case IB_LINKINITCMD_SLEEP:
                        licmd = QLOGIC_IB_IBCC_LINKINITCMD_SLEEP;
                        break;

                case IB_LINKINITCMD_DISABLE:
                        licmd = QLOGIC_IB_IBCC_LINKINITCMD_DISABLE;
                        ppd->cpspec->chase_end = 0;
                        /*
                         * stop state chase counter and timer, if running.
                         * wait forpending timer, but don't clear .data (ppd)!
                         */
                        if (ppd->cpspec->chase_timer.expires) {
                                del_timer_sync(&ppd->cpspec->chase_timer);
                                ppd->cpspec->chase_timer.expires = 0;
                        }
                        break;

                default:
                        ret = -EINVAL;
                        qib_dev_err(dd, "bad linkinitcmd req 0x%x\n",
                                    val & 0xffff);
                        goto bail;
                }
                qib_set_ib_7220_lstate(ppd, lcmd, licmd);

                maskr = IBA7220_IBC_WIDTH_MASK;
                lsb = IBA7220_IBC_WIDTH_SHIFT;
                tmp = (ppd->cpspec->ibcddrctrl >> lsb) & maskr;
                /* If the width active on the chip does not match the
                 * width in the shadow register, write the new active
                 * width to the chip.
                 * We don't have to worry about speed as the speed is taken
                 * care of by set_7220_ibspeed_fast called by ib_updown.
                 */
                if (ppd->link_width_enabled-1 != tmp) {
                        ppd->cpspec->ibcddrctrl &= ~(maskr << lsb);
                        ppd->cpspec->ibcddrctrl |=
                                (((u64)(ppd->link_width_enabled-1) & maskr) <<
                                 lsb);
                        qib_write_kreg(dd, kr_ibcddrctrl,
                                       ppd->cpspec->ibcddrctrl);
                        qib_write_kreg(dd, kr_scratch, 0);
                        spin_lock_irqsave(&ppd->lflags_lock, flags);
                        ppd->lflags |= QIBL_IB_FORCE_NOTIFY;
                        spin_unlock_irqrestore(&ppd->lflags_lock, flags);
                }
                goto bail;

        case QIB_IB_CFG_HRTBT: /* set Heartbeat off/enable/auto */
                if (val > IBA7220_IBC_HRTBT_MASK) {
                        ret = -EINVAL;
                        goto bail;
                }
                lsb = IBA7220_IBC_HRTBT_SHIFT;
                maskr = IBA7220_IBC_HRTBT_MASK;
                break;

        default:
                ret = -EINVAL;
                goto bail;
        }
        ppd->cpspec->ibcddrctrl &= ~(maskr << lsb);
        ppd->cpspec->ibcddrctrl |= (((u64) val & maskr) << lsb);
        qib_write_kreg(dd, kr_ibcddrctrl, ppd->cpspec->ibcddrctrl);
        qib_write_kreg(dd, kr_scratch, 0);
        if (setforce) {
                spin_lock_irqsave(&ppd->lflags_lock, flags);
                ppd->lflags |= QIBL_IB_FORCE_NOTIFY;
                spin_unlock_irqrestore(&ppd->lflags_lock, flags);
        }
bail:
        return ret;
}

static int qib_7220_set_loopback(struct qib_pportdata *ppd, const char *what)
{
        int ret = 0;
        u64 val, ddr;

        if (!strncmp(what, "ibc", 3)) {
                ppd->cpspec->ibcctrl |= SYM_MASK(IBCCtrl, Loopback);
                val = 0; /* disable heart beat, so link will come up */
                qib_devinfo(ppd->dd->pcidev, "Enabling IB%u:%u IBC loopback\n",
                         ppd->dd->unit, ppd->port);
        } else if (!strncmp(what, "off", 3)) {
                ppd->cpspec->ibcctrl &= ~SYM_MASK(IBCCtrl, Loopback);
                /* enable heart beat again */
                val = IBA7220_IBC_HRTBT_MASK << IBA7220_IBC_HRTBT_SHIFT;
                qib_devinfo(ppd->dd->pcidev,
                        "Disabling IB%u:%u IBC loopback (normal)\n",
                        ppd->dd->unit, ppd->port);
        } else
                ret = -EINVAL;
        if (!ret) {
                qib_write_kreg(ppd->dd, kr_ibcctrl, ppd->cpspec->ibcctrl);
                ddr = ppd->cpspec->ibcddrctrl & ~(IBA7220_IBC_HRTBT_MASK
                                             << IBA7220_IBC_HRTBT_SHIFT);
                ppd->cpspec->ibcddrctrl = ddr | val;
                qib_write_kreg(ppd->dd, kr_ibcddrctrl,
                               ppd->cpspec->ibcddrctrl);
                qib_write_kreg(ppd->dd, kr_scratch, 0);
        }
        return ret;
}

static void qib_update_7220_usrhead(struct qib_ctxtdata *rcd, u64 hd,
                                    u32 updegr, u32 egrhd, u32 npkts)
{
        if (updegr)
                qib_write_ureg(rcd->dd, ur_rcvegrindexhead, egrhd, rcd->ctxt);
        mmiowb();
        qib_write_ureg(rcd->dd, ur_rcvhdrhead, hd, rcd->ctxt);
        mmiowb();
}

static u32 qib_7220_hdrqempty(struct qib_ctxtdata *rcd)
{
        u32 head, tail;

        head = qib_read_ureg32(rcd->dd, ur_rcvhdrhead, rcd->ctxt);
        if (rcd->rcvhdrtail_kvaddr)
                tail = qib_get_rcvhdrtail(rcd);
        else
                tail = qib_read_ureg32(rcd->dd, ur_rcvhdrtail, rcd->ctxt);
        return head == tail;
}

/*
 * Modify the RCVCTRL register in chip-specific way. This
 * is a function because bit positions and (future) register
 * location is chip-specifc, but the needed operations are
 * generic. <op> is a bit-mask because we often want to
 * do multiple modifications.
 */
static void rcvctrl_7220_mod(struct qib_pportdata *ppd, unsigned int op,
                             int ctxt)
{
        struct qib_devdata *dd = ppd->dd;
        u64 mask, val;
        unsigned long flags;

        spin_lock_irqsave(&dd->cspec->rcvmod_lock, flags);
        if (op & QIB_RCVCTRL_TAILUPD_ENB)
                dd->rcvctrl |= (1ULL << IBA7220_R_TAILUPD_SHIFT);
        if (op & QIB_RCVCTRL_TAILUPD_DIS)
                dd->rcvctrl &= ~(1ULL << IBA7220_R_TAILUPD_SHIFT);
        if (op & QIB_RCVCTRL_PKEY_ENB)
                dd->rcvctrl &= ~(1ULL << IBA7220_R_PKEY_DIS_SHIFT);
        if (op & QIB_RCVCTRL_PKEY_DIS)
                dd->rcvctrl |= (1ULL << IBA7220_R_PKEY_DIS_SHIFT);
        if (ctxt < 0)
                mask = (1ULL << dd->ctxtcnt) - 1;
        else
                mask = (1ULL << ctxt);
        if (op & QIB_RCVCTRL_CTXT_ENB) {
                /* always done for specific ctxt */
                dd->rcvctrl |= (mask << SYM_LSB(RcvCtrl, PortEnable));
                if (!(dd->flags & QIB_NODMA_RTAIL))
                        dd->rcvctrl |= 1ULL << IBA7220_R_TAILUPD_SHIFT;
                /* Write these registers before the context is enabled. */
                qib_write_kreg_ctxt(dd, kr_rcvhdrtailaddr, ctxt,
                        dd->rcd[ctxt]->rcvhdrqtailaddr_phys);
                qib_write_kreg_ctxt(dd, kr_rcvhdraddr, ctxt,
                        dd->rcd[ctxt]->rcvhdrq_phys);
                dd->rcd[ctxt]->seq_cnt = 1;
        }
        if (op & QIB_RCVCTRL_CTXT_DIS)
                dd->rcvctrl &= ~(mask << SYM_LSB(RcvCtrl, PortEnable));
        if (op & QIB_RCVCTRL_INTRAVAIL_ENB)
                dd->rcvctrl |= (mask << IBA7220_R_INTRAVAIL_SHIFT);
        if (op & QIB_RCVCTRL_INTRAVAIL_DIS)
                dd->rcvctrl &= ~(mask << IBA7220_R_INTRAVAIL_SHIFT);
        qib_write_kreg(dd, kr_rcvctrl, dd->rcvctrl);
        if ((op & QIB_RCVCTRL_INTRAVAIL_ENB) && dd->rhdrhead_intr_off) {
                /* arm rcv interrupt */
                val = qib_read_ureg32(dd, ur_rcvhdrhead, ctxt) |
                        dd->rhdrhead_intr_off;
                qib_write_ureg(dd, ur_rcvhdrhead, val, ctxt);
        }
        if (op & QIB_RCVCTRL_CTXT_ENB) {
                /*
                 * Init the context registers also; if we were
                 * disabled, tail and head should both be zero
                 * already from the enable, but since we don't
                 * know, we have to do it explicitly.
                 */
                val = qib_read_ureg32(dd, ur_rcvegrindextail, ctxt);
                qib_write_ureg(dd, ur_rcvegrindexhead, val, ctxt);

                val = qib_read_ureg32(dd, ur_rcvhdrtail, ctxt);
                dd->rcd[ctxt]->head = val;
                /* If kctxt, interrupt on next receive. */
                if (ctxt < dd->first_user_ctxt)
                        val |= dd->rhdrhead_intr_off;
                qib_write_ureg(dd, ur_rcvhdrhead, val, ctxt);
        }
        if (op & QIB_RCVCTRL_CTXT_DIS) {
                if (ctxt >= 0) {
                        qib_write_kreg_ctxt(dd, kr_rcvhdrtailaddr, ctxt, 0);
                        qib_write_kreg_ctxt(dd, kr_rcvhdraddr, ctxt, 0);
                } else {
                        unsigned i;

                        for (i = 0; i < dd->cfgctxts; i++) {
                                qib_write_kreg_ctxt(dd, kr_rcvhdrtailaddr,
                                                    i, 0);
                                qib_write_kreg_ctxt(dd, kr_rcvhdraddr, i, 0);
                        }
                }
        }
        spin_unlock_irqrestore(&dd->cspec->rcvmod_lock, flags);
}

/*
 * Modify the SENDCTRL register in chip-specific way. This
 * is a function there may be multiple such registers with
 * slightly different layouts. To start, we assume the
 * "canonical" register layout of the first chips.
 * Chip requires no back-back sendctrl writes, so write
 * scratch register after writing sendctrl
 */
static void sendctrl_7220_mod(struct qib_pportdata *ppd, u32 op)
{
        struct qib_devdata *dd = ppd->dd;
        u64 tmp_dd_sendctrl;
        unsigned long flags;

        spin_lock_irqsave(&dd->sendctrl_lock, flags);

        /* First the ones that are "sticky", saved in shadow */
        if (op & QIB_SENDCTRL_CLEAR)
                dd->sendctrl = 0;
        if (op & QIB_SENDCTRL_SEND_DIS)
                dd->sendctrl &= ~SYM_MASK(SendCtrl, SPioEnable);
        else if (op & QIB_SENDCTRL_SEND_ENB) {
                dd->sendctrl |= SYM_MASK(SendCtrl, SPioEnable);
                if (dd->flags & QIB_USE_SPCL_TRIG)
                        dd->sendctrl |= SYM_MASK(SendCtrl,
                                                 SSpecialTriggerEn);
        }
        if (op & QIB_SENDCTRL_AVAIL_DIS)
                dd->sendctrl &= ~SYM_MASK(SendCtrl, SendBufAvailUpd);
        else if (op & QIB_SENDCTRL_AVAIL_ENB)
                dd->sendctrl |= SYM_MASK(SendCtrl, SendBufAvailUpd);

        if (op & QIB_SENDCTRL_DISARM_ALL) {
                u32 i, last;

                tmp_dd_sendctrl = dd->sendctrl;
                /*
                 * disarm any that are not yet launched, disabling sends
                 * and updates until done.
                 */
                last = dd->piobcnt2k + dd->piobcnt4k;
                tmp_dd_sendctrl &=
                        ~(SYM_MASK(SendCtrl, SPioEnable) |
                          SYM_MASK(SendCtrl, SendBufAvailUpd));
                for (i = 0; i < last; i++) {
                        qib_write_kreg(dd, kr_sendctrl,
                                       tmp_dd_sendctrl |
                                       SYM_MASK(SendCtrl, Disarm) | i);
                        qib_write_kreg(dd, kr_scratch, 0);
                }
        }

        tmp_dd_sendctrl = dd->sendctrl;

        if (op & QIB_SENDCTRL_FLUSH)
                tmp_dd_sendctrl |= SYM_MASK(SendCtrl, Abort);
        if (op & QIB_SENDCTRL_DISARM)
                tmp_dd_sendctrl |= SYM_MASK(SendCtrl, Disarm) |
                        ((op & QIB_7220_SendCtrl_DisarmPIOBuf_RMASK) <<
                         SYM_LSB(SendCtrl, DisarmPIOBuf));
        if ((op & QIB_SENDCTRL_AVAIL_BLIP) &&
            (dd->sendctrl & SYM_MASK(SendCtrl, SendBufAvailUpd)))
                tmp_dd_sendctrl &= ~SYM_MASK(SendCtrl, SendBufAvailUpd);

        qib_write_kreg(dd, kr_sendctrl, tmp_dd_sendctrl);
        qib_write_kreg(dd, kr_scratch, 0);

        if (op & QIB_SENDCTRL_AVAIL_BLIP) {
                qib_write_kreg(dd, kr_sendctrl, dd->sendctrl);
                qib_write_kreg(dd, kr_scratch, 0);
        }

        spin_unlock_irqrestore(&dd->sendctrl_lock, flags);

        if (op & QIB_SENDCTRL_FLUSH) {
                u32 v;
                /*
                 * ensure writes have hit chip, then do a few
                 * more reads, to allow DMA of pioavail registers
                 * to occur, so in-memory copy is in sync with
                 * the chip.  Not always safe to sleep.
                 */
                v = qib_read_kreg32(dd, kr_scratch);
                qib_write_kreg(dd, kr_scratch, v);
                v = qib_read_kreg32(dd, kr_scratch);
                qib_write_kreg(dd, kr_scratch, v);
                qib_read_kreg32(dd, kr_scratch);
        }
}

/**
 * qib_portcntr_7220 - read a per-port counter
 * @dd: the qlogic_ib device
 * @creg: the counter to snapshot
 */
static u64 qib_portcntr_7220(struct qib_pportdata *ppd, u32 reg)
{
        u64 ret = 0ULL;
        struct qib_devdata *dd = ppd->dd;
        u16 creg;
        /* 0xffff for unimplemented or synthesized counters */
        static const u16 xlator[] = {
                [QIBPORTCNTR_PKTSEND] = cr_pktsend,
                [QIBPORTCNTR_WORDSEND] = cr_wordsend,
                [QIBPORTCNTR_PSXMITDATA] = cr_psxmitdatacount,
                [QIBPORTCNTR_PSXMITPKTS] = cr_psxmitpktscount,
                [QIBPORTCNTR_PSXMITWAIT] = cr_psxmitwaitcount,
                [QIBPORTCNTR_SENDSTALL] = cr_sendstall,
                [QIBPORTCNTR_PKTRCV] = cr_pktrcv,
                [QIBPORTCNTR_PSRCVDATA] = cr_psrcvdatacount,
                [QIBPORTCNTR_PSRCVPKTS] = cr_psrcvpktscount,
                [QIBPORTCNTR_RCVEBP] = cr_rcvebp,
                [QIBPORTCNTR_RCVOVFL] = cr_rcvovfl,
                [QIBPORTCNTR_WORDRCV] = cr_wordrcv,
                [QIBPORTCNTR_RXDROPPKT] = cr_rxdroppkt,
                [QIBPORTCNTR_RXLOCALPHYERR] = cr_rxotherlocalphyerr,
                [QIBPORTCNTR_RXVLERR] = cr_rxvlerr,
                [QIBPORTCNTR_ERRICRC] = cr_erricrc,
                [QIBPORTCNTR_ERRVCRC] = cr_errvcrc,
                [QIBPORTCNTR_ERRLPCRC] = cr_errlpcrc,
                [QIBPORTCNTR_BADFORMAT] = cr_badformat,
                [QIBPORTCNTR_ERR_RLEN] = cr_err_rlen,
                [QIBPORTCNTR_IBSYMBOLERR] = cr_ibsymbolerr,
                [QIBPORTCNTR_INVALIDRLEN] = cr_invalidrlen,
                [QIBPORTCNTR_UNSUPVL] = cr_txunsupvl,
                [QIBPORTCNTR_EXCESSBUFOVFL] = cr_excessbufferovfl,
                [QIBPORTCNTR_ERRLINK] = cr_errlink,
                [QIBPORTCNTR_IBLINKDOWN] = cr_iblinkdown,
                [QIBPORTCNTR_IBLINKERRRECOV] = cr_iblinkerrrecov,
                [QIBPORTCNTR_LLI] = cr_locallinkintegrityerr,
                [QIBPORTCNTR_PSINTERVAL] = cr_psinterval,
                [QIBPORTCNTR_PSSTART] = cr_psstart,
                [QIBPORTCNTR_PSSTAT] = cr_psstat,
                [QIBPORTCNTR_VL15PKTDROP] = cr_vl15droppedpkt,
                [QIBPORTCNTR_ERRPKEY] = cr_errpkey,
                [QIBPORTCNTR_KHDROVFL] = 0xffff,
        };

        if (reg >= ARRAY_SIZE(xlator)) {
                qib_devinfo(ppd->dd->pcidev,
                         "Unimplemented portcounter %u\n", reg);
                goto done;
        }
        creg = xlator[reg];

        if (reg == QIBPORTCNTR_KHDROVFL) {
                int i;

                /* sum over all kernel contexts */
                for (i = 0; i < dd->first_user_ctxt; i++)
                        ret += read_7220_creg32(dd, cr_portovfl + i);
        }
        if (creg == 0xffff)
                goto done;

        /*
         * only fast incrementing counters are 64bit; use 32 bit reads to
         * avoid two independent reads when on opteron
         */
        if ((creg == cr_wordsend || creg == cr_wordrcv ||
             creg == cr_pktsend || creg == cr_pktrcv))