qib_mad.c

Go to the documentation of this file.

/*
 * Copyright (c) 2012 Intel Corporation.  All rights reserved.
 * Copyright (c) 2006 - 2012 QLogic Corporation. All rights reserved.
 * Copyright (c) 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.
 */

#include <rdma/ib_smi.h>

#include "qib.h"
#include "qib_mad.h"

static int reply(struct ib_smp *smp)
{
    /*
     * The verbs framework will handle the directed/LID route
     * packet changes.
     */
    smp->method = IB_MGMT_METHOD_GET_RESP;
    if (smp->mgmt_class == IB_MGMT_CLASS_SUBN_DIRECTED_ROUTE)
        smp->status |= IB_SMP_DIRECTION;
    return IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_REPLY;
}

static int reply_failure(struct ib_smp *smp)
{
    /*
     * The verbs framework will handle the directed/LID route
     * packet changes.
     */
    smp->method = IB_MGMT_METHOD_GET_RESP;
    if (smp->mgmt_class == IB_MGMT_CLASS_SUBN_DIRECTED_ROUTE)
        smp->status |= IB_SMP_DIRECTION;
    return IB_MAD_RESULT_FAILURE | IB_MAD_RESULT_REPLY;
}

static void qib_send_trap(struct qib_ibport *ibp, void *data, unsigned len)
{
    struct ib_mad_send_buf *send_buf;
    struct ib_mad_agent *agent;
    struct ib_smp *smp;
    int ret;
    unsigned long flags;
    unsigned long timeout;

    agent = ibp->send_agent;
    if (!agent)
        return;

    /* o14-3.2.1 */
    if (!(ppd_from_ibp(ibp)->lflags & QIBL_LINKACTIVE))
        return;

    /* o14-2 */
    if (ibp->trap_timeout && time_before(jiffies, ibp->trap_timeout))
        return;

    send_buf = ib_create_send_mad(agent, 0, 0, 0, IB_MGMT_MAD_HDR,
                      IB_MGMT_MAD_DATA, GFP_ATOMIC);
    if (IS_ERR(send_buf))
        return;

    smp = send_buf->mad;
    smp->base_version = IB_MGMT_BASE_VERSION;
    smp->mgmt_class = IB_MGMT_CLASS_SUBN_LID_ROUTED;
    smp->class_version = 1;
    smp->method = IB_MGMT_METHOD_TRAP;
    ibp->tid++;
    smp->tid = cpu_to_be64(ibp->tid);
    smp->attr_id = IB_SMP_ATTR_NOTICE;
    /* o14-1: smp->mkey = 0; */
    memcpy(smp->data, data, len);

    spin_lock_irqsave(&ibp->lock, flags);
    if (!ibp->sm_ah) {
        if (ibp->sm_lid != be16_to_cpu(IB_LID_PERMISSIVE)) {
            struct ib_ah *ah;

            ah = qib_create_qp0_ah(ibp, ibp->sm_lid);
            if (IS_ERR(ah))
                ret = PTR_ERR(ah);
            else {
                send_buf->ah = ah;
                ibp->sm_ah = to_iah(ah);
                ret = 0;
            }
        } else
            ret = -EINVAL;
    } else {
        send_buf->ah = &ibp->sm_ah->ibah;
        ret = 0;
    }
    spin_unlock_irqrestore(&ibp->lock, flags);

    if (!ret)
        ret = ib_post_send_mad(send_buf, NULL);
    if (!ret) {
        /* 4.096 usec. */
        timeout = (4096 * (1UL << ibp->subnet_timeout)) / 1000;
        ibp->trap_timeout = jiffies + usecs_to_jiffies(timeout);
    } else {
        ib_free_send_mad(send_buf);
        ibp->trap_timeout = 0;
    }
}

/*
 * Send a bad [PQ]_Key trap (ch. 14.3.8).
 */
void qib_bad_pqkey(struct qib_ibport *ibp, __be16 trap_num, u32 key, u32 sl,
           u32 qp1, u32 qp2, __be16 lid1, __be16 lid2)
{
    struct ib_mad_notice_attr data;

    if (trap_num == IB_NOTICE_TRAP_BAD_PKEY)
        ibp->pkey_violations++;
    else
        ibp->qkey_violations++;
    ibp->n_pkt_drops++;

    /* Send violation trap */
    data.generic_type = IB_NOTICE_TYPE_SECURITY;
    data.prod_type_msb = 0;
    data.prod_type_lsb = IB_NOTICE_PROD_CA;
    data.trap_num = trap_num;
    data.issuer_lid = cpu_to_be16(ppd_from_ibp(ibp)->lid);
    data.toggle_count = 0;
    memset(&data.details, 0, sizeof data.details);
    data.details.ntc_257_258.lid1 = lid1;
    data.details.ntc_257_258.lid2 = lid2;
    data.details.ntc_257_258.key = cpu_to_be32(key);
    data.details.ntc_257_258.sl_qp1 = cpu_to_be32((sl << 28) | qp1);
    data.details.ntc_257_258.qp2 = cpu_to_be32(qp2);

    qib_send_trap(ibp, &data, sizeof data);
}

/*
 * Send a bad M_Key trap (ch. 14.3.9).
 */
static void qib_bad_mkey(struct qib_ibport *ibp, struct ib_smp *smp)
{
    struct ib_mad_notice_attr data;

    /* Send violation trap */
    data.generic_type = IB_NOTICE_TYPE_SECURITY;
    data.prod_type_msb = 0;
    data.prod_type_lsb = IB_NOTICE_PROD_CA;
    data.trap_num = IB_NOTICE_TRAP_BAD_MKEY;
    data.issuer_lid = cpu_to_be16(ppd_from_ibp(ibp)->lid);
    data.toggle_count = 0;
    memset(&data.details, 0, sizeof data.details);
    data.details.ntc_256.lid = data.issuer_lid;
    data.details.ntc_256.method = smp->method;
    data.details.ntc_256.attr_id = smp->attr_id;
    data.details.ntc_256.attr_mod = smp->attr_mod;
    data.details.ntc_256.mkey = smp->mkey;
    if (smp->mgmt_class == IB_MGMT_CLASS_SUBN_DIRECTED_ROUTE) {
        u8 hop_cnt;

        data.details.ntc_256.dr_slid = smp->dr_slid;
        data.details.ntc_256.dr_trunc_hop = IB_NOTICE_TRAP_DR_NOTICE;
        hop_cnt = smp->hop_cnt;
        if (hop_cnt > ARRAY_SIZE(data.details.ntc_256.dr_rtn_path)) {
            data.details.ntc_256.dr_trunc_hop |=
                IB_NOTICE_TRAP_DR_TRUNC;
            hop_cnt = ARRAY_SIZE(data.details.ntc_256.dr_rtn_path);
        }
        data.details.ntc_256.dr_trunc_hop |= hop_cnt;
        memcpy(data.details.ntc_256.dr_rtn_path, smp->return_path,
               hop_cnt);
    }

    qib_send_trap(ibp, &data, sizeof data);
}

/*
 * Send a Port Capability Mask Changed trap (ch. 14.3.11).
 */
void qib_cap_mask_chg(struct qib_ibport *ibp)
{
    struct ib_mad_notice_attr data;

    data.generic_type = IB_NOTICE_TYPE_INFO;
    data.prod_type_msb = 0;
    data.prod_type_lsb = IB_NOTICE_PROD_CA;
    data.trap_num = IB_NOTICE_TRAP_CAP_MASK_CHG;
    data.issuer_lid = cpu_to_be16(ppd_from_ibp(ibp)->lid);
    data.toggle_count = 0;
    memset(&data.details, 0, sizeof data.details);
    data.details.ntc_144.lid = data.issuer_lid;
    data.details.ntc_144.new_cap_mask = cpu_to_be32(ibp->port_cap_flags);

    qib_send_trap(ibp, &data, sizeof data);
}

/*
 * Send a System Image GUID Changed trap (ch. 14.3.12).
 */
void qib_sys_guid_chg(struct qib_ibport *ibp)
{
    struct ib_mad_notice_attr data;

    data.generic_type = IB_NOTICE_TYPE_INFO;
    data.prod_type_msb = 0;
    data.prod_type_lsb = IB_NOTICE_PROD_CA;
    data.trap_num = IB_NOTICE_TRAP_SYS_GUID_CHG;
    data.issuer_lid = cpu_to_be16(ppd_from_ibp(ibp)->lid);
    data.toggle_count = 0;
    memset(&data.details, 0, sizeof data.details);
    data.details.ntc_145.lid = data.issuer_lid;
    data.details.ntc_145.new_sys_guid = ib_qib_sys_image_guid;

    qib_send_trap(ibp, &data, sizeof data);
}

/*
 * Send a Node Description Changed trap (ch. 14.3.13).
 */
void qib_node_desc_chg(struct qib_ibport *ibp)
{
    struct ib_mad_notice_attr data;

    data.generic_type = IB_NOTICE_TYPE_INFO;
    data.prod_type_msb = 0;
    data.prod_type_lsb = IB_NOTICE_PROD_CA;
    data.trap_num = IB_NOTICE_TRAP_CAP_MASK_CHG;
    data.issuer_lid = cpu_to_be16(ppd_from_ibp(ibp)->lid);
    data.toggle_count = 0;
    memset(&data.details, 0, sizeof data.details);
    data.details.ntc_144.lid = data.issuer_lid;
    data.details.ntc_144.local_changes = 1;
    data.details.ntc_144.change_flags = IB_NOTICE_TRAP_NODE_DESC_CHG;

    qib_send_trap(ibp, &data, sizeof data);
}

static int subn_get_nodedescription(struct ib_smp *smp,
                    struct ib_device *ibdev)
{
    if (smp->attr_mod)
        smp->status |= IB_SMP_INVALID_FIELD;

    memcpy(smp->data, ibdev->node_desc, sizeof(smp->data));

    return reply(smp);
}

static int subn_get_nodeinfo(struct ib_smp *smp, struct ib_device *ibdev,
                 u8 port)
{
    struct ib_node_info *nip = (struct ib_node_info *)&smp->data;
    struct qib_devdata *dd = dd_from_ibdev(ibdev);
    u32 vendor, majrev, minrev;
    unsigned pidx = port - 1; /* IB number port from 1, hdw from 0 */

    /* GUID 0 is illegal */
    if (smp->attr_mod || pidx >= dd->num_pports ||
        dd->pport[pidx].guid == 0)
        smp->status |= IB_SMP_INVALID_FIELD;
    else
        nip->port_guid = dd->pport[pidx].guid;

    nip->base_version = 1;
    nip->class_version = 1;
    nip->node_type = 1;     /* channel adapter */
    nip->num_ports = ibdev->phys_port_cnt;
    /* This is already in network order */
    nip->sys_guid = ib_qib_sys_image_guid;
    nip->node_guid = dd->pport->guid; /* Use first-port GUID as node */
    nip->partition_cap = cpu_to_be16(qib_get_npkeys(dd));
    nip->device_id = cpu_to_be16(dd->deviceid);
    majrev = dd->majrev;
    minrev = dd->minrev;
    nip->revision = cpu_to_be32((majrev << 16) | minrev);
    nip->local_port_num = port;
    vendor = dd->vendorid;
    nip->vendor_id[0] = QIB_SRC_OUI_1;
    nip->vendor_id[1] = QIB_SRC_OUI_2;
    nip->vendor_id[2] = QIB_SRC_OUI_3;

    return reply(smp);
}

static int subn_get_guidinfo(struct ib_smp *smp, struct ib_device *ibdev,
                 u8 port)
{
    struct qib_devdata *dd = dd_from_ibdev(ibdev);
    u32 startgx = 8 * be32_to_cpu(smp->attr_mod);
    __be64 *p = (__be64 *) smp->data;
    unsigned pidx = port - 1; /* IB number port from 1, hdw from 0 */

    /* 32 blocks of 8 64-bit GUIDs per block */

    memset(smp->data, 0, sizeof(smp->data));

    if (startgx == 0 && pidx < dd->num_pports) {
        struct qib_pportdata *ppd = dd->pport + pidx;
        struct qib_ibport *ibp = &ppd->ibport_data;
        __be64 g = ppd->guid;
        unsigned i;

        /* GUID 0 is illegal */
        if (g == 0)
            smp->status |= IB_SMP_INVALID_FIELD;
        else {
            /* The first is a copy of the read-only HW GUID. */
            p[0] = g;
            for (i = 1; i < QIB_GUIDS_PER_PORT; i++)
                p[i] = ibp->guids[i - 1];
        }
    } else
        smp->status |= IB_SMP_INVALID_FIELD;

    return reply(smp);
}

static void set_link_width_enabled(struct qib_pportdata *ppd, u32 w)
{
    (void) ppd->dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LWID_ENB, w);
}

static void set_link_speed_enabled(struct qib_pportdata *ppd, u32 s)
{
    (void) ppd->dd->f_set_ib_cfg(ppd, QIB_IB_CFG_SPD_ENB, s);
}

static int get_overrunthreshold(struct qib_pportdata *ppd)
{
    return ppd->dd->f_get_ib_cfg(ppd, QIB_IB_CFG_OVERRUN_THRESH);
}

static int set_overrunthreshold(struct qib_pportdata *ppd, unsigned n)
{
    (void) ppd->dd->f_set_ib_cfg(ppd, QIB_IB_CFG_OVERRUN_THRESH,
                     (u32)n);
    return 0;
}

static int get_phyerrthreshold(struct qib_pportdata *ppd)
{
    return ppd->dd->f_get_ib_cfg(ppd, QIB_IB_CFG_PHYERR_THRESH);
}

static int set_phyerrthreshold(struct qib_pportdata *ppd, unsigned n)
{
    (void) ppd->dd->f_set_ib_cfg(ppd, QIB_IB_CFG_PHYERR_THRESH,
                     (u32)n);
    return 0;
}

static int get_linkdowndefaultstate(struct qib_pportdata *ppd)
{
    return ppd->dd->f_get_ib_cfg(ppd, QIB_IB_CFG_LINKDEFAULT) ==
        IB_LINKINITCMD_SLEEP;
}

static int check_mkey(struct qib_ibport *ibp, struct ib_smp *smp, int mad_flags)
{
    int valid_mkey = 0;
    int ret = 0;

    /* Is the mkey in the process of expiring? */
    if (ibp->mkey_lease_timeout &&
        time_after_eq(jiffies, ibp->mkey_lease_timeout)) {
        /* Clear timeout and mkey protection field. */
        ibp->mkey_lease_timeout = 0;
        ibp->mkeyprot = 0;
    }

    if ((mad_flags & IB_MAD_IGNORE_MKEY) ||  ibp->mkey == 0 ||
        ibp->mkey == smp->mkey)
        valid_mkey = 1;

    /* Unset lease timeout on any valid Get/Set/TrapRepress */
    if (valid_mkey && ibp->mkey_lease_timeout &&
        (smp->method == IB_MGMT_METHOD_GET ||
         smp->method == IB_MGMT_METHOD_SET ||
         smp->method == IB_MGMT_METHOD_TRAP_REPRESS))
        ibp->mkey_lease_timeout = 0;

    if (!valid_mkey) {
        switch (smp->method) {
        case IB_MGMT_METHOD_GET:
            /* Bad mkey not a violation below level 2 */
            if (ibp->mkeyprot < 2)
                break;
        case IB_MGMT_METHOD_SET:
        case IB_MGMT_METHOD_TRAP_REPRESS:
            if (ibp->mkey_violations != 0xFFFF)
                ++ibp->mkey_violations;
            if (!ibp->mkey_lease_timeout && ibp->mkey_lease_period)
                ibp->mkey_lease_timeout = jiffies +
                    ibp->mkey_lease_period * HZ;
            /* Generate a trap notice. */
            qib_bad_mkey(ibp, smp);
            ret = 1;
        }
    }

    return ret;
}

static int subn_get_portinfo(struct ib_smp *smp, struct ib_device *ibdev,
                 u8 port)
{
    struct qib_devdata *dd;
    struct qib_pportdata *ppd;
    struct qib_ibport *ibp;
    struct ib_port_info *pip = (struct ib_port_info *)smp->data;
    u8 mtu;
    int ret;
    u32 state;
    u32 port_num = be32_to_cpu(smp->attr_mod);

    if (port_num == 0)
        port_num = port;
    else {
        if (port_num > ibdev->phys_port_cnt) {
            smp->status |= IB_SMP_INVALID_FIELD;
            ret = reply(smp);
            goto bail;
        }
        if (port_num != port) {
            ibp = to_iport(ibdev, port_num);
            ret = check_mkey(ibp, smp, 0);
            if (ret) {
                ret = IB_MAD_RESULT_FAILURE;
                goto bail;
            }
        }
    }

    dd = dd_from_ibdev(ibdev);
    /* IB numbers ports from 1, hdw from 0 */
    ppd = dd->pport + (port_num - 1);
    ibp = &ppd->ibport_data;

    /* Clear all fields.  Only set the non-zero fields. */
    memset(smp->data, 0, sizeof(smp->data));

    /* Only return the mkey if the protection field allows it. */
    if (!(smp->method == IB_MGMT_METHOD_GET &&
          ibp->mkey != smp->mkey &&
          ibp->mkeyprot == 1))
        pip->mkey = ibp->mkey;
    pip->gid_prefix = ibp->gid_prefix;
    pip->lid = cpu_to_be16(ppd->lid);
    pip->sm_lid = cpu_to_be16(ibp->sm_lid);
    pip->cap_mask = cpu_to_be32(ibp->port_cap_flags);
    /* pip->diag_code; */
    pip->mkey_lease_period = cpu_to_be16(ibp->mkey_lease_period);
    pip->local_port_num = port;
    pip->link_width_enabled = ppd->link_width_enabled;
    pip->link_width_supported = ppd->link_width_supported;
    pip->link_width_active = ppd->link_width_active;
    state = dd->f_iblink_state(ppd->lastibcstat);
    pip->linkspeed_portstate = ppd->link_speed_supported << 4 | state;

    pip->portphysstate_linkdown =
        (dd->f_ibphys_portstate(ppd->lastibcstat) << 4) |
        (get_linkdowndefaultstate(ppd) ? 1 : 2);
    pip->mkeyprot_resv_lmc = (ibp->mkeyprot << 6) | ppd->lmc;
    pip->linkspeedactive_enabled = (ppd->link_speed_active << 4) |
        ppd->link_speed_enabled;
    switch (ppd->ibmtu) {
    default: /* something is wrong; fall through */
    case 4096:
        mtu = IB_MTU_4096;
        break;
    case 2048:
        mtu = IB_MTU_2048;
        break;
    case 1024:
        mtu = IB_MTU_1024;
        break;
    case 512:
        mtu = IB_MTU_512;
        break;
    case 256:
        mtu = IB_MTU_256;
        break;
    }
    pip->neighbormtu_mastersmsl = (mtu << 4) | ibp->sm_sl;
    pip->vlcap_inittype = ppd->vls_supported << 4;  /* InitType = 0 */
    pip->vl_high_limit = ibp->vl_high_limit;
    pip->vl_arb_high_cap =
        dd->f_get_ib_cfg(ppd, QIB_IB_CFG_VL_HIGH_CAP);
    pip->vl_arb_low_cap =
        dd->f_get_ib_cfg(ppd, QIB_IB_CFG_VL_LOW_CAP);
    /* InitTypeReply = 0 */
    pip->inittypereply_mtucap = qib_ibmtu ? qib_ibmtu : IB_MTU_4096;
    /* HCAs ignore VLStallCount and HOQLife */
    /* pip->vlstallcnt_hoqlife; */
    pip->operationalvl_pei_peo_fpi_fpo =
        dd->f_get_ib_cfg(ppd, QIB_IB_CFG_OP_VLS) << 4;
    pip->mkey_violations = cpu_to_be16(ibp->mkey_violations);
    /* P_KeyViolations are counted by hardware. */
    pip->pkey_violations = cpu_to_be16(ibp->pkey_violations);
    pip->qkey_violations = cpu_to_be16(ibp->qkey_violations);
    /* Only the hardware GUID is supported for now */
    pip->guid_cap = QIB_GUIDS_PER_PORT;
    pip->clientrereg_resv_subnetto = ibp->subnet_timeout;
    /* 32.768 usec. response time (guessing) */
    pip->resv_resptimevalue = 3;
    pip->localphyerrors_overrunerrors =
        (get_phyerrthreshold(ppd) << 4) |
        get_overrunthreshold(ppd);
    /* pip->max_credit_hint; */
    if (ibp->port_cap_flags & IB_PORT_LINK_LATENCY_SUP) {
        u32 v;

        v = dd->f_get_ib_cfg(ppd, QIB_IB_CFG_LINKLATENCY);
        pip->link_roundtrip_latency[0] = v >> 16;
        pip->link_roundtrip_latency[1] = v >> 8;
        pip->link_roundtrip_latency[2] = v;
    }

    ret = reply(smp);

bail:
    return ret;
}

static int get_pkeys(struct qib_devdata *dd, u8 port, u16 *pkeys)
{
    struct qib_pportdata *ppd = dd->pport + port - 1;
    /*
     * always a kernel context, no locking needed.
     * If we get here with ppd setup, no need to check
     * that pd is valid.
     */
    struct qib_ctxtdata *rcd = dd->rcd[ppd->hw_pidx];

    memcpy(pkeys, rcd->pkeys, sizeof(rcd->pkeys));

    return 0;
}

static int subn_get_pkeytable(struct ib_smp *smp, struct ib_device *ibdev,
                  u8 port)
{
    u32 startpx = 32 * (be32_to_cpu(smp->attr_mod) & 0xffff);
    u16 *p = (u16 *) smp->data;
    __be16 *q = (__be16 *) smp->data;

    /* 64 blocks of 32 16-bit P_Key entries */

    memset(smp->data, 0, sizeof(smp->data));
    if (startpx == 0) {
        struct qib_devdata *dd = dd_from_ibdev(ibdev);
        unsigned i, n = qib_get_npkeys(dd);

        get_pkeys(dd, port, p);

        for (i = 0; i < n; i++)
            q[i] = cpu_to_be16(p[i]);
    } else
        smp->status |= IB_SMP_INVALID_FIELD;

    return reply(smp);
}

static int subn_set_guidinfo(struct ib_smp *smp, struct ib_device *ibdev,
                 u8 port)
{
    struct qib_devdata *dd = dd_from_ibdev(ibdev);
    u32 startgx = 8 * be32_to_cpu(smp->attr_mod);
    __be64 *p = (__be64 *) smp->data;
    unsigned pidx = port - 1; /* IB number port from 1, hdw from 0 */

    /* 32 blocks of 8 64-bit GUIDs per block */

    if (startgx == 0 && pidx < dd->num_pports) {
        struct qib_pportdata *ppd = dd->pport + pidx;
        struct qib_ibport *ibp = &ppd->ibport_data;
        unsigned i;

        /* The first entry is read-only. */
        for (i = 1; i < QIB_GUIDS_PER_PORT; i++)
            ibp->guids[i - 1] = p[i];
    } else
        smp->status |= IB_SMP_INVALID_FIELD;

    /* The only GUID we support is the first read-only entry. */
    return subn_get_guidinfo(smp, ibdev, port);
}

static int subn_set_portinfo(struct ib_smp *smp, struct ib_device *ibdev,
                 u8 port)
{
    struct ib_port_info *pip = (struct ib_port_info *)smp->data;
    struct ib_event event;
    struct qib_devdata *dd;
    struct qib_pportdata *ppd;
    struct qib_ibport *ibp;
    u8 clientrereg = (pip->clientrereg_resv_subnetto & 0x80);
    unsigned long flags;
    u16 lid, smlid;
    u8 lwe;
    u8 lse;
    u8 state;
    u8 vls;
    u8 msl;
    u16 lstate;
    int ret, ore, mtu;
    u32 port_num = be32_to_cpu(smp->attr_mod);

    if (port_num == 0)
        port_num = port;
    else {
        if (port_num > ibdev->phys_port_cnt)
            goto err;
        /* Port attributes can only be set on the receiving port */
        if (port_num != port)
            goto get_only;
    }

    dd = dd_from_ibdev(ibdev);
    /* IB numbers ports from 1, hdw from 0 */
    ppd = dd->pport + (port_num - 1);
    ibp = &ppd->ibport_data;
    event.device = ibdev;
    event.element.port_num = port;

    ibp->mkey = pip->mkey;
    ibp->gid_prefix = pip->gid_prefix;
    ibp->mkey_lease_period = be16_to_cpu(pip->mkey_lease_period);

    lid = be16_to_cpu(pip->lid);
    /* Must be a valid unicast LID address. */
    if (lid == 0 || lid >= QIB_MULTICAST_LID_BASE)
        smp->status |= IB_SMP_INVALID_FIELD;
    else if (ppd->lid != lid || ppd->lmc != (pip->mkeyprot_resv_lmc & 7)) {
        if (ppd->lid != lid)
            qib_set_uevent_bits(ppd, _QIB_EVENT_LID_CHANGE_BIT);
        if (ppd->lmc != (pip->mkeyprot_resv_lmc & 7))
            qib_set_uevent_bits(ppd, _QIB_EVENT_LMC_CHANGE_BIT);
        qib_set_lid(ppd, lid, pip->mkeyprot_resv_lmc & 7);
        event.event = IB_EVENT_LID_CHANGE;
        ib_dispatch_event(&event);
    }

    smlid = be16_to_cpu(pip->sm_lid);
    msl = pip->neighbormtu_mastersmsl & 0xF;
    /* Must be a valid unicast LID address. */
    if (smlid == 0 || smlid >= QIB_MULTICAST_LID_BASE)
        smp->status |= IB_SMP_INVALID_FIELD;
    else if (smlid != ibp->sm_lid || msl != ibp->sm_sl) {
        spin_lock_irqsave(&ibp->lock, flags);
        if (ibp->sm_ah) {
            if (smlid != ibp->sm_lid)
                ibp->sm_ah->attr.dlid = smlid;
            if (msl != ibp->sm_sl)
                ibp->sm_ah->attr.sl = msl;
        }
        spin_unlock_irqrestore(&ibp->lock, flags);
        if (smlid != ibp->sm_lid)
            ibp->sm_lid = smlid;
        if (msl != ibp->sm_sl)
            ibp->sm_sl = msl;
        event.event = IB_EVENT_SM_CHANGE;
        ib_dispatch_event(&event);
    }

    /* Allow 1x or 4x to be set (see 14.2.6.6). */
    lwe = pip->link_width_enabled;
    if (lwe) {
        if (lwe == 0xFF)
            set_link_width_enabled(ppd, ppd->link_width_supported);
        else if (lwe >= 16 || (lwe & ~ppd->link_width_supported))
            smp->status |= IB_SMP_INVALID_FIELD;
        else if (lwe != ppd->link_width_enabled)
            set_link_width_enabled(ppd, lwe);
    }

    lse = pip->linkspeedactive_enabled & 0xF;
    if (lse) {
        /*
         * The IB 1.2 spec. only allows link speed values
         * 1, 3, 5, 7, 15.  1.2.1 extended to allow specific
         * speeds.
         */
        if (lse == 15)
            set_link_speed_enabled(ppd,
                           ppd->link_speed_supported);
        else if (lse >= 8 || (lse & ~ppd->link_speed_supported))
            smp->status |= IB_SMP_INVALID_FIELD;
        else if (lse != ppd->link_speed_enabled)
            set_link_speed_enabled(ppd, lse);
    }

    /* Set link down default state. */
    switch (pip->portphysstate_linkdown & 0xF) {
    case 0: /* NOP */
        break;
    case 1: /* SLEEP */
        (void) dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LINKDEFAULT,
                    IB_LINKINITCMD_SLEEP);
        break;
    case 2: /* POLL */
        (void) dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LINKDEFAULT,
                    IB_LINKINITCMD_POLL);
        break;
    default:
        smp->status |= IB_SMP_INVALID_FIELD;
    }

    ibp->mkeyprot = pip->mkeyprot_resv_lmc >> 6;
    ibp->vl_high_limit = pip->vl_high_limit;
    (void) dd->f_set_ib_cfg(ppd, QIB_IB_CFG_VL_HIGH_LIMIT,
                    ibp->vl_high_limit);

    mtu = ib_mtu_enum_to_int((pip->neighbormtu_mastersmsl >> 4) & 0xF);
    if (mtu == -1)
        smp->status |= IB_SMP_INVALID_FIELD;
    else
        qib_set_mtu(ppd, mtu);

    /* Set operational VLs */
    vls = (pip->operationalvl_pei_peo_fpi_fpo >> 4) & 0xF;
    if (vls) {
        if (vls > ppd->vls_supported)
            smp->status |= IB_SMP_INVALID_FIELD;
        else
            (void) dd->f_set_ib_cfg(ppd, QIB_IB_CFG_OP_VLS, vls);
    }

    if (pip->mkey_violations == 0)
        ibp->mkey_violations = 0;

    if (pip->pkey_violations == 0)
        ibp->pkey_violations = 0;

    if (pip->qkey_violations == 0)
        ibp->qkey_violations = 0;

    ore = pip->localphyerrors_overrunerrors;
    if (set_phyerrthreshold(ppd, (ore >> 4) & 0xF))
        smp->status |= IB_SMP_INVALID_FIELD;

    if (set_overrunthreshold(ppd, (ore & 0xF)))
        smp->status |= IB_SMP_INVALID_FIELD;

    ibp->subnet_timeout = pip->clientrereg_resv_subnetto & 0x1F;

    /*
     * Do the port state change now that the other link parameters
     * have been set.
     * Changing the port physical state only makes sense if the link
     * is down or is being set to down.
     */
    state = pip->linkspeed_portstate & 0xF;
    lstate = (pip->portphysstate_linkdown >> 4) & 0xF;
    if (lstate && !(state == IB_PORT_DOWN || state == IB_PORT_NOP))
        smp->status |= IB_SMP_INVALID_FIELD;

    /*
     * Only state changes of DOWN, ARM, and ACTIVE are valid
     * and must be in the correct state to take effect (see 7.2.6).
     */
    switch (state) {
    case IB_PORT_NOP:
        if (lstate == 0)
            break;
        /* FALLTHROUGH */
    case IB_PORT_DOWN:
        if (lstate == 0)
            lstate = QIB_IB_LINKDOWN_ONLY;
        else if (lstate == 1)
            lstate = QIB_IB_LINKDOWN_SLEEP;
        else if (lstate == 2)
            lstate = QIB_IB_LINKDOWN;
        else if (lstate == 3)
            lstate = QIB_IB_LINKDOWN_DISABLE;
        else {
            smp->status |= IB_SMP_INVALID_FIELD;
            break;
        }
        spin_lock_irqsave(&ppd->lflags_lock, flags);
        ppd->lflags &= ~QIBL_LINKV;
        spin_unlock_irqrestore(&ppd->lflags_lock, flags);
        qib_set_linkstate(ppd, lstate);
        /*
         * Don't send a reply if the response would be sent
         * through the disabled port.
         */
        if (lstate == QIB_IB_LINKDOWN_DISABLE && smp->hop_cnt) {
            ret = IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_CONSUMED;
            goto done;
        }
        qib_wait_linkstate(ppd, QIBL_LINKV, 10);
        break;
    case IB_PORT_ARMED:
        qib_set_linkstate(ppd, QIB_IB_LINKARM);
        break;
    case IB_PORT_ACTIVE:
        qib_set_linkstate(ppd, QIB_IB_LINKACTIVE);
        break;
    default:
        smp->status |= IB_SMP_INVALID_FIELD;
    }

    if (clientrereg) {
        event.event = IB_EVENT_CLIENT_REREGISTER;
        ib_dispatch_event(&event);
    }

    ret = subn_get_portinfo(smp, ibdev, port);

    /* restore re-reg bit per o14-12.2.1 */
    pip->clientrereg_resv_subnetto |= clientrereg;

    goto get_only;

err:
    smp->status |= IB_SMP_INVALID_FIELD;
get_only:
    ret = subn_get_portinfo(smp, ibdev, port);
done:
    return ret;
}

static int rm_pkey(struct qib_pportdata *ppd, u16 key)
{
    int i;
    int ret;

    for (i = 0; i < ARRAY_SIZE(ppd->pkeys); i++) {
        if (ppd->pkeys[i] != key)
            continue;
        if (atomic_dec_and_test(&ppd->pkeyrefs[i])) {
            ppd->pkeys[i] = 0;
            ret = 1;
            goto bail;
        }
        break;
    }

    ret = 0;

bail:
    return ret;
}

static int add_pkey(struct qib_pportdata *ppd, u16 key)
{
    int i;
    u16 lkey = key & 0x7FFF;
    int any = 0;
    int ret;

    if (lkey == 0x7FFF) {
        ret = 0;
        goto bail;
    }

    /* Look for an empty slot or a matching PKEY. */
    for (i = 0; i < ARRAY_SIZE(ppd->pkeys); i++) {
        if (!ppd->pkeys[i]) {
            any++;
            continue;
        }
        /* If it matches exactly, try to increment the ref count */
        if (ppd->pkeys[i] == key) {
            if (atomic_inc_return(&ppd->pkeyrefs[i]) > 1) {
                ret = 0;
                goto bail;
            }
            /* Lost the race. Look for an empty slot below. */
            atomic_dec(&ppd->pkeyrefs[i]);
            any++;
        }
        /*
         * It makes no sense to have both the limited and unlimited
         * PKEY set at the same time since the unlimited one will
         * disable the limited one.
         */
        if ((ppd->pkeys[i] & 0x7FFF) == lkey) {
            ret = -EEXIST;
            goto bail;
        }
    }
    if (!any) {
        ret = -EBUSY;
        goto bail;
    }
    for (i = 0; i < ARRAY_SIZE(ppd->pkeys); i++) {
        if (!ppd->pkeys[i] &&
            atomic_inc_return(&ppd->pkeyrefs[i]) == 1) {
            /* for qibstats, etc. */
            ppd->pkeys[i] = key;
            ret = 1;
            goto bail;
        }
    }
    ret = -EBUSY;

bail:
    return ret;
}

static int set_pkeys(struct qib_devdata *dd, u8 port, u16 *pkeys)
{
    struct qib_pportdata *ppd;
    struct qib_ctxtdata *rcd;
    int i;
    int changed = 0;

    /*
     * IB port one/two always maps to context zero/one,
     * always a kernel context, no locking needed
     * If we get here with ppd setup, no need to check
     * that rcd is valid.
     */
    ppd = dd->pport + (port - 1);
    rcd = dd->rcd[ppd->hw_pidx];

    for (i = 0; i < ARRAY_SIZE(rcd->pkeys); i++) {
        u16 key = pkeys[i];
        u16 okey = rcd->pkeys[i];

        if (key == okey)
            continue;
        /*
         * The value of this PKEY table entry is changing.
         * Remove the old entry in the hardware's array of PKEYs.
         */
        if (okey & 0x7FFF)
            changed |= rm_pkey(ppd, okey);
        if (key & 0x7FFF) {
            int ret = add_pkey(ppd, key);

            if (ret < 0)
                key = 0;
            else
                changed |= ret;
        }
        rcd->pkeys[i] = key;
    }
    if (changed) {
        struct ib_event event;

        (void) dd->f_set_ib_cfg(ppd, QIB_IB_CFG_PKEYS, 0);

        event.event = IB_EVENT_PKEY_CHANGE;
        event.device = &dd->verbs_dev.ibdev;
        event.element.port_num = 1;
        ib_dispatch_event(&event);
    }
    return 0;
}

static int subn_set_pkeytable(struct ib_smp *smp, struct ib_device *ibdev,
                  u8 port)
{
    u32 startpx = 32 * (be32_to_cpu(smp->attr_mod) & 0xffff);
    __be16 *p = (__be16 *) smp->data;
    u16 *q = (u16 *) smp->data;
    struct qib_devdata *dd = dd_from_ibdev(ibdev);
    unsigned i, n = qib_get_npkeys(dd);

    for (i = 0; i < n; i++)
        q[i] = be16_to_cpu(p[i]);

    if (startpx != 0 || set_pkeys(dd, port, q) != 0)
        smp->status |= IB_SMP_INVALID_FIELD;

    return subn_get_pkeytable(smp, ibdev, port);
}

static int subn_get_sl_to_vl(struct ib_smp *smp, struct ib_device *ibdev,
                 u8 port)
{
    struct qib_ibport *ibp = to_iport(ibdev, port);
    u8 *p = (u8 *) smp->data;
    unsigned i;

    memset(smp->data, 0, sizeof(smp->data));

    if (!(ibp->port_cap_flags & IB_PORT_SL_MAP_SUP))
        smp->status |= IB_SMP_UNSUP_METHOD;
    else
        for (i = 0; i < ARRAY_SIZE(ibp->sl_to_vl); i += 2)
            *p++ = (ibp->sl_to_vl[i] << 4) | ibp->sl_to_vl[i + 1];

    return reply(smp);
}

static int subn_set_sl_to_vl(struct ib_smp *smp, struct ib_device *ibdev,
                 u8 port)
{
    struct qib_ibport *ibp = to_iport(ibdev, port);
    u8 *p = (u8 *) smp->data;
    unsigned i;

    if (!(ibp->port_cap_flags & IB_PORT_SL_MAP_SUP)) {
        smp->status |= IB_SMP_UNSUP_METHOD;
        return reply(smp);
    }

    for (i = 0; i < ARRAY_SIZE(ibp->sl_to_vl); i += 2, p++) {
        ibp->sl_to_vl[i] = *p >> 4;
        ibp->sl_to_vl[i + 1] = *p & 0xF;
    }
    qib_set_uevent_bits(ppd_from_ibp(to_iport(ibdev, port)),
                _QIB_EVENT_SL2VL_CHANGE_BIT);

    return subn_get_sl_to_vl(smp, ibdev, port);
}

static int subn_get_vl_arb(struct ib_smp *smp, struct ib_device *ibdev,
               u8 port)
{
    unsigned which = be32_to_cpu(smp->attr_mod) >> 16;
    struct qib_pportdata *ppd = ppd_from_ibp(to_iport(ibdev, port));

    memset(smp->data, 0, sizeof(smp->data));

    if (ppd->vls_supported == IB_VL_VL0)
        smp->status |= IB_SMP_UNSUP_METHOD;
    else if (which == IB_VLARB_LOWPRI_0_31)
        (void) ppd->dd->f_get_ib_table(ppd, QIB_IB_TBL_VL_LOW_ARB,
                           smp->data);
    else if (which == IB_VLARB_HIGHPRI_0_31)
        (void) ppd->dd->f_get_ib_table(ppd, QIB_IB_TBL_VL_HIGH_ARB,
                           smp->data);
    else
        smp->status |= IB_SMP_INVALID_FIELD;

    return reply(smp);
}

static int subn_set_vl_arb(struct ib_smp *smp, struct ib_device *ibdev,
               u8 port)
{
    unsigned which = be32_to_cpu(smp->attr_mod) >> 16;
    struct qib_pportdata *ppd = ppd_from_ibp(to_iport(ibdev, port));

    if (ppd->vls_supported == IB_VL_VL0)
        smp->status |= IB_SMP_UNSUP_METHOD;
    else if (which == IB_VLARB_LOWPRI_0_31)
        (void) ppd->dd->f_set_ib_table(ppd, QIB_IB_TBL_VL_LOW_ARB,
                           smp->data);
    else if (which == IB_VLARB_HIGHPRI_0_31)
        (void) ppd->dd->f_set_ib_table(ppd, QIB_IB_TBL_VL_HIGH_ARB,
                           smp->data);
    else
        smp->status |= IB_SMP_INVALID_FIELD;

    return subn_get_vl_arb(smp, ibdev, port);
}

static int subn_trap_repress(struct ib_smp *smp, struct ib_device *ibdev,
                 u8 port)
{
    /*
     * For now, we only send the trap once so no need to process this.
     * o13-6, o13-7,
     * o14-3.a4 The SMA shall not send any message in response to a valid
     * SubnTrapRepress() message.
     */
    return IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_CONSUMED;
}

static int pma_get_classportinfo(struct ib_pma_mad *pmp,
                 struct ib_device *ibdev)
{
    struct ib_class_port_info *p =
        (struct ib_class_port_info *)pmp->data;
    struct qib_devdata *dd = dd_from_ibdev(ibdev);

    memset(pmp->data, 0, sizeof(pmp->data));

    if (pmp->mad_hdr.attr_mod != 0)
        pmp->mad_hdr.status |= IB_SMP_INVALID_FIELD;

    /* Note that AllPortSelect is not valid */
    p->base_version = 1;
    p->class_version = 1;
    p->capability_mask = IB_PMA_CLASS_CAP_EXT_WIDTH;
    /*
     * Set the most significant bit of CM2 to indicate support for
     * congestion statistics
     */
    p->reserved[0] = dd->psxmitwait_supported << 7;
    /*
     * Expected response time is 4.096 usec. * 2^18 == 1.073741824 sec.
     */
    p->resp_time_value = 18;

    return reply((struct ib_smp *) pmp);
}

static int pma_get_portsamplescontrol(struct ib_pma_mad *pmp,
                      struct ib_device *ibdev, u8 port)
{
    struct ib_pma_portsamplescontrol *p =
        (struct ib_pma_portsamplescontrol *)pmp->data;
    struct qib_ibdev *dev = to_idev(ibdev);
    struct qib_devdata *dd = dd_from_dev(dev);
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    unsigned long flags;
    u8 port_select = p->port_select;

    memset(pmp->data, 0, sizeof(pmp->data));

    p->port_select = port_select;
    if (pmp->mad_hdr.attr_mod != 0 || port_select != port) {
        pmp->mad_hdr.status |= IB_SMP_INVALID_FIELD;
        goto bail;
    }
    spin_lock_irqsave(&ibp->lock, flags);
    p->tick = dd->f_get_ib_cfg(ppd, QIB_IB_CFG_PMA_TICKS);
    p->sample_status = dd->f_portcntr(ppd, QIBPORTCNTR_PSSTAT);
    p->counter_width = 4;   /* 32 bit counters */
    p->counter_mask0_9 = COUNTER_MASK0_9;
    p->sample_start = cpu_to_be32(ibp->pma_sample_start);
    p->sample_interval = cpu_to_be32(ibp->pma_sample_interval);
    p->tag = cpu_to_be16(ibp->pma_tag);
    p->counter_select[0] = ibp->pma_counter_select[0];
    p->counter_select[1] = ibp->pma_counter_select[1];
    p->counter_select[2] = ibp->pma_counter_select[2];
    p->counter_select[3] = ibp->pma_counter_select[3];
    p->counter_select[4] = ibp->pma_counter_select[4];
    spin_unlock_irqrestore(&ibp->lock, flags);

bail:
    return reply((struct ib_smp *) pmp);
}

static int pma_set_portsamplescontrol(struct ib_pma_mad *pmp,
                      struct ib_device *ibdev, u8 port)
{
    struct ib_pma_portsamplescontrol *p =
        (struct ib_pma_portsamplescontrol *)pmp->data;
    struct qib_ibdev *dev = to_idev(ibdev);
    struct qib_devdata *dd = dd_from_dev(dev);
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    unsigned long flags;
    u8 status, xmit_flags;
    int ret;

    if (pmp->mad_hdr.attr_mod != 0 || p->port_select != port) {
        pmp->mad_hdr.status |= IB_SMP_INVALID_FIELD;
        ret = reply((struct ib_smp *) pmp);
        goto bail;
    }

    spin_lock_irqsave(&ibp->lock, flags);

    /* Port Sampling code owns the PS* HW counters */
    xmit_flags = ppd->cong_stats.flags;
    ppd->cong_stats.flags = IB_PMA_CONG_HW_CONTROL_SAMPLE;
    status = dd->f_portcntr(ppd, QIBPORTCNTR_PSSTAT);
    if (status == IB_PMA_SAMPLE_STATUS_DONE ||
        (status == IB_PMA_SAMPLE_STATUS_RUNNING &&
         xmit_flags == IB_PMA_CONG_HW_CONTROL_TIMER)) {
        ibp->pma_sample_start = be32_to_cpu(p->sample_start);
        ibp->pma_sample_interval = be32_to_cpu(p->sample_interval);
        ibp->pma_tag = be16_to_cpu(p->tag);
        ibp->pma_counter_select[0] = p->counter_select[0];
        ibp->pma_counter_select[1] = p->counter_select[1];
        ibp->pma_counter_select[2] = p->counter_select[2];
        ibp->pma_counter_select[3] = p->counter_select[3];
        ibp->pma_counter_select[4] = p->counter_select[4];
        dd->f_set_cntr_sample(ppd, ibp->pma_sample_interval,
                      ibp->pma_sample_start);
    }
    spin_unlock_irqrestore(&ibp->lock, flags);

    ret = pma_get_portsamplescontrol(pmp, ibdev, port);

bail:
    return ret;
}

static u64 get_counter(struct qib_ibport *ibp, struct qib_pportdata *ppd,
               __be16 sel)
{
    u64 ret;

    switch (sel) {
    case IB_PMA_PORT_XMIT_DATA:
        ret = ppd->dd->f_portcntr(ppd, QIBPORTCNTR_PSXMITDATA);
        break;
    case IB_PMA_PORT_RCV_DATA:
        ret = ppd->dd->f_portcntr(ppd, QIBPORTCNTR_PSRCVDATA);
        break;
    case IB_PMA_PORT_XMIT_PKTS:
        ret = ppd->dd->f_portcntr(ppd, QIBPORTCNTR_PSXMITPKTS);
        break;
    case IB_PMA_PORT_RCV_PKTS:
        ret = ppd->dd->f_portcntr(ppd, QIBPORTCNTR_PSRCVPKTS);
        break;
    case IB_PMA_PORT_XMIT_WAIT:
        ret = ppd->dd->f_portcntr(ppd, QIBPORTCNTR_PSXMITWAIT);
        break;
    default:
        ret = 0;
    }

    return ret;
}

/* This function assumes that the xmit_wait lock is already held */
static u64 xmit_wait_get_value_delta(struct qib_pportdata *ppd)
{
    u32 delta;

    delta = get_counter(&ppd->ibport_data, ppd,
                IB_PMA_PORT_XMIT_WAIT);
    return ppd->cong_stats.counter + delta;
}

static void cache_hw_sample_counters(struct qib_pportdata *ppd)
{
    struct qib_ibport *ibp = &ppd->ibport_data;

    ppd->cong_stats.counter_cache.psxmitdata =
        get_counter(ibp, ppd, IB_PMA_PORT_XMIT_DATA);
    ppd->cong_stats.counter_cache.psrcvdata =
        get_counter(ibp, ppd, IB_PMA_PORT_RCV_DATA);
    ppd->cong_stats.counter_cache.psxmitpkts =
        get_counter(ibp, ppd, IB_PMA_PORT_XMIT_PKTS);
    ppd->cong_stats.counter_cache.psrcvpkts =
        get_counter(ibp, ppd, IB_PMA_PORT_RCV_PKTS);
    ppd->cong_stats.counter_cache.psxmitwait =
        get_counter(ibp, ppd, IB_PMA_PORT_XMIT_WAIT);
}

static u64 get_cache_hw_sample_counters(struct qib_pportdata *ppd,
                    __be16 sel)
{
    u64 ret;

    switch (sel) {
    case IB_PMA_PORT_XMIT_DATA:
        ret = ppd->cong_stats.counter_cache.psxmitdata;
        break;
    case IB_PMA_PORT_RCV_DATA:
        ret = ppd->cong_stats.counter_cache.psrcvdata;
        break;
    case IB_PMA_PORT_XMIT_PKTS:
        ret = ppd->cong_stats.counter_cache.psxmitpkts;
        break;
    case IB_PMA_PORT_RCV_PKTS:
        ret = ppd->cong_stats.counter_cache.psrcvpkts;
        break;
    case IB_PMA_PORT_XMIT_WAIT:
        ret = ppd->cong_stats.counter_cache.psxmitwait;
        break;
    default:
        ret = 0;
    }

    return ret;
}

static int pma_get_portsamplesresult(struct ib_pma_mad *pmp,
                     struct ib_device *ibdev, u8 port)
{
    struct ib_pma_portsamplesresult *p =
        (struct ib_pma_portsamplesresult *)pmp->data;
    struct qib_ibdev *dev = to_idev(ibdev);
    struct qib_devdata *dd = dd_from_dev(dev);
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    unsigned long flags;
    u8 status;
    int i;

    memset(pmp->data, 0, sizeof(pmp->data));
    spin_lock_irqsave(&ibp->lock, flags);
    p->tag = cpu_to_be16(ibp->pma_tag);
    if (ppd->cong_stats.flags == IB_PMA_CONG_HW_CONTROL_TIMER)
        p->sample_status = IB_PMA_SAMPLE_STATUS_DONE;
    else {
        status = dd->f_portcntr(ppd, QIBPORTCNTR_PSSTAT);
        p->sample_status = cpu_to_be16(status);
        if (status == IB_PMA_SAMPLE_STATUS_DONE) {
            cache_hw_sample_counters(ppd);
            ppd->cong_stats.counter =
                xmit_wait_get_value_delta(ppd);
            dd->f_set_cntr_sample(ppd,
                          QIB_CONG_TIMER_PSINTERVAL, 0);
            ppd->cong_stats.flags = IB_PMA_CONG_HW_CONTROL_TIMER;
        }
    }
    for (i = 0; i < ARRAY_SIZE(ibp->pma_counter_select); i++)
        p->counter[i] = cpu_to_be32(
            get_cache_hw_sample_counters(
                ppd, ibp->pma_counter_select[i]));
    spin_unlock_irqrestore(&ibp->lock, flags);

    return reply((struct ib_smp *) pmp);
}

static int pma_get_portsamplesresult_ext(struct ib_pma_mad *pmp,
                     struct ib_device *ibdev, u8 port)
{
    struct ib_pma_portsamplesresult_ext *p =
        (struct ib_pma_portsamplesresult_ext *)pmp->data;
    struct qib_ibdev *dev = to_idev(ibdev);
    struct qib_devdata *dd = dd_from_dev(dev);
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    unsigned long flags;
    u8 status;
    int i;

    /* Port Sampling code owns the PS* HW counters */
    memset(pmp->data, 0, sizeof(pmp->data));
    spin_lock_irqsave(&ibp->lock, flags);
    p->tag = cpu_to_be16(ibp->pma_tag);
    if (ppd->cong_stats.flags == IB_PMA_CONG_HW_CONTROL_TIMER)
        p->sample_status = IB_PMA_SAMPLE_STATUS_DONE;
    else {
        status = dd->f_portcntr(ppd, QIBPORTCNTR_PSSTAT);
        p->sample_status = cpu_to_be16(status);
        /* 64 bits */
        p->extended_width = cpu_to_be32(0x80000000);
        if (status == IB_PMA_SAMPLE_STATUS_DONE) {
            cache_hw_sample_counters(ppd);
            ppd->cong_stats.counter =
                xmit_wait_get_value_delta(ppd);
            dd->f_set_cntr_sample(ppd,
                          QIB_CONG_TIMER_PSINTERVAL, 0);
            ppd->cong_stats.flags = IB_PMA_CONG_HW_CONTROL_TIMER;
        }
    }
    for (i = 0; i < ARRAY_SIZE(ibp->pma_counter_select); i++)
        p->counter[i] = cpu_to_be64(
            get_cache_hw_sample_counters(
                ppd, ibp->pma_counter_select[i]));
    spin_unlock_irqrestore(&ibp->lock, flags);

    return reply((struct ib_smp *) pmp);
}

static int pma_get_portcounters(struct ib_pma_mad *pmp,
                struct ib_device *ibdev, u8 port)
{
    struct ib_pma_portcounters *p = (struct ib_pma_portcounters *)
        pmp->data;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    struct qib_verbs_counters cntrs;
    u8 port_select = p->port_select;

    qib_get_counters(ppd, &cntrs);

    /* Adjust counters for any resets done. */
    cntrs.symbol_error_counter -= ibp->z_symbol_error_counter;
    cntrs.link_error_recovery_counter -=
        ibp->z_link_error_recovery_counter;
    cntrs.link_downed_counter -= ibp->z_link_downed_counter;
    cntrs.port_rcv_errors -= ibp->z_port_rcv_errors;
    cntrs.port_rcv_remphys_errors -= ibp->z_port_rcv_remphys_errors;
    cntrs.port_xmit_discards -= ibp->z_port_xmit_discards;
    cntrs.port_xmit_data -= ibp->z_port_xmit_data;
    cntrs.port_rcv_data -= ibp->z_port_rcv_data;
    cntrs.port_xmit_packets -= ibp->z_port_xmit_packets;
    cntrs.port_rcv_packets -= ibp->z_port_rcv_packets;
    cntrs.local_link_integrity_errors -=
        ibp->z_local_link_integrity_errors;
    cntrs.excessive_buffer_overrun_errors -=
        ibp->z_excessive_buffer_overrun_errors;
    cntrs.vl15_dropped -= ibp->z_vl15_dropped;
    cntrs.vl15_dropped += ibp->n_vl15_dropped;

    memset(pmp->data, 0, sizeof(pmp->data));

    p->port_select = port_select;
    if (pmp->mad_hdr.attr_mod != 0 || port_select != port)
        pmp->mad_hdr.status |= IB_SMP_INVALID_FIELD;

    if (cntrs.symbol_error_counter > 0xFFFFUL)
        p->symbol_error_counter = cpu_to_be16(0xFFFF);
    else
        p->symbol_error_counter =
            cpu_to_be16((u16)cntrs.symbol_error_counter);
    if (cntrs.link_error_recovery_counter > 0xFFUL)
        p->link_error_recovery_counter = 0xFF;
    else
        p->link_error_recovery_counter =
            (u8)cntrs.link_error_recovery_counter;
    if (cntrs.link_downed_counter > 0xFFUL)
        p->link_downed_counter = 0xFF;
    else
        p->link_downed_counter = (u8)cntrs.link_downed_counter;
    if (cntrs.port_rcv_errors > 0xFFFFUL)
        p->port_rcv_errors = cpu_to_be16(0xFFFF);
    else
        p->port_rcv_errors =
            cpu_to_be16((u16) cntrs.port_rcv_errors);
    if (cntrs.port_rcv_remphys_errors > 0xFFFFUL)
        p->port_rcv_remphys_errors = cpu_to_be16(0xFFFF);
    else
        p->port_rcv_remphys_errors =
            cpu_to_be16((u16)cntrs.port_rcv_remphys_errors);
    if (cntrs.port_xmit_discards > 0xFFFFUL)
        p->port_xmit_discards = cpu_to_be16(0xFFFF);
    else
        p->port_xmit_discards =
            cpu_to_be16((u16)cntrs.port_xmit_discards);
    if (cntrs.local_link_integrity_errors > 0xFUL)
        cntrs.local_link_integrity_errors = 0xFUL;
    if (cntrs.excessive_buffer_overrun_errors > 0xFUL)
        cntrs.excessive_buffer_overrun_errors = 0xFUL;
    p->link_overrun_errors = (cntrs.local_link_integrity_errors << 4) |
        cntrs.excessive_buffer_overrun_errors;
    if (cntrs.vl15_dropped > 0xFFFFUL)
        p->vl15_dropped = cpu_to_be16(0xFFFF);
    else
        p->vl15_dropped = cpu_to_be16((u16)cntrs.vl15_dropped);
    if (cntrs.port_xmit_data > 0xFFFFFFFFUL)
        p->port_xmit_data = cpu_to_be32(0xFFFFFFFF);
    else
        p->port_xmit_data = cpu_to_be32((u32)cntrs.port_xmit_data);
    if (cntrs.port_rcv_data > 0xFFFFFFFFUL)
        p->port_rcv_data = cpu_to_be32(0xFFFFFFFF);
    else
        p->port_rcv_data = cpu_to_be32((u32)cntrs.port_rcv_data);
    if (cntrs.port_xmit_packets > 0xFFFFFFFFUL)
        p->port_xmit_packets = cpu_to_be32(0xFFFFFFFF);
    else
        p->port_xmit_packets =
            cpu_to_be32((u32)cntrs.port_xmit_packets);
    if (cntrs.port_rcv_packets > 0xFFFFFFFFUL)
        p->port_rcv_packets = cpu_to_be32(0xFFFFFFFF);
    else
        p->port_rcv_packets =
            cpu_to_be32((u32) cntrs.port_rcv_packets);

    return reply((struct ib_smp *) pmp);
}

static int pma_get_portcounters_cong(struct ib_pma_mad *pmp,
                     struct ib_device *ibdev, u8 port)
{
    /* Congestion PMA packets start at offset 24 not 64 */
    struct ib_pma_portcounters_cong *p =
        (struct ib_pma_portcounters_cong *)pmp->reserved;
    struct qib_verbs_counters cntrs;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    struct qib_devdata *dd = dd_from_ppd(ppd);
    u32 port_select = be32_to_cpu(pmp->mad_hdr.attr_mod) & 0xFF;
    u64 xmit_wait_counter;
    unsigned long flags;

    /*
     * This check is performed only in the GET method because the
     * SET method ends up calling this anyway.
     */
    if (!dd->psxmitwait_supported)
        pmp->mad_hdr.status |= IB_SMP_UNSUP_METH_ATTR;
    if (port_select != port)
        pmp->mad_hdr.status |= IB_SMP_INVALID_FIELD;

    qib_get_counters(ppd, &cntrs);
    spin_lock_irqsave(&ppd->ibport_data.lock, flags);
    xmit_wait_counter = xmit_wait_get_value_delta(ppd);
    spin_unlock_irqrestore(&ppd->ibport_data.lock, flags);

    /* Adjust counters for any resets done. */
    cntrs.symbol_error_counter -= ibp->z_symbol_error_counter;
    cntrs.link_error_recovery_counter -=
        ibp->z_link_error_recovery_counter;
    cntrs.link_downed_counter -= ibp->z_link_downed_counter;
    cntrs.port_rcv_errors -= ibp->z_port_rcv_errors;
    cntrs.port_rcv_remphys_errors -=
        ibp->z_port_rcv_remphys_errors;
    cntrs.port_xmit_discards -= ibp->z_port_xmit_discards;
    cntrs.local_link_integrity_errors -=
        ibp->z_local_link_integrity_errors;
    cntrs.excessive_buffer_overrun_errors -=
        ibp->z_excessive_buffer_overrun_errors;
    cntrs.vl15_dropped -= ibp->z_vl15_dropped;
    cntrs.vl15_dropped += ibp->n_vl15_dropped;
    cntrs.port_xmit_data -= ibp->z_port_xmit_data;
    cntrs.port_rcv_data -= ibp->z_port_rcv_data;
    cntrs.port_xmit_packets -= ibp->z_port_xmit_packets;
    cntrs.port_rcv_packets -= ibp->z_port_rcv_packets;

    memset(pmp->reserved, 0, sizeof(pmp->reserved) +
           sizeof(pmp->data));

    /*
     * Set top 3 bits to indicate interval in picoseconds in
     * remaining bits.
     */
    p->port_check_rate =
        cpu_to_be16((QIB_XMIT_RATE_PICO << 13) |
                (dd->psxmitwait_check_rate &
                 ~(QIB_XMIT_RATE_PICO << 13)));
    p->port_adr_events = cpu_to_be64(0);
    p->port_xmit_wait = cpu_to_be64(xmit_wait_counter);
    p->port_xmit_data = cpu_to_be64(cntrs.port_xmit_data);
    p->port_rcv_data = cpu_to_be64(cntrs.port_rcv_data);
    p->port_xmit_packets =
        cpu_to_be64(cntrs.port_xmit_packets);
    p->port_rcv_packets =
        cpu_to_be64(cntrs.port_rcv_packets);
    if (cntrs.symbol_error_counter > 0xFFFFUL)
        p->symbol_error_counter = cpu_to_be16(0xFFFF);
    else
        p->symbol_error_counter =
            cpu_to_be16(
                (u16)cntrs.symbol_error_counter);
    if (cntrs.link_error_recovery_counter > 0xFFUL)
        p->link_error_recovery_counter = 0xFF;
    else
        p->link_error_recovery_counter =
            (u8)cntrs.link_error_recovery_counter;
    if (cntrs.link_downed_counter > 0xFFUL)
        p->link_downed_counter = 0xFF;
    else
        p->link_downed_counter =
            (u8)cntrs.link_downed_counter;
    if (cntrs.port_rcv_errors > 0xFFFFUL)
        p->port_rcv_errors = cpu_to_be16(0xFFFF);
    else
        p->port_rcv_errors =
            cpu_to_be16((u16) cntrs.port_rcv_errors);
    if (cntrs.port_rcv_remphys_errors > 0xFFFFUL)
        p->port_rcv_remphys_errors = cpu_to_be16(0xFFFF);
    else
        p->port_rcv_remphys_errors =
            cpu_to_be16(
                (u16)cntrs.port_rcv_remphys_errors);
    if (cntrs.port_xmit_discards > 0xFFFFUL)
        p->port_xmit_discards = cpu_to_be16(0xFFFF);
    else
        p->port_xmit_discards =
            cpu_to_be16((u16)cntrs.port_xmit_discards);
    if (cntrs.local_link_integrity_errors > 0xFUL)
        cntrs.local_link_integrity_errors = 0xFUL;
    if (cntrs.excessive_buffer_overrun_errors > 0xFUL)
        cntrs.excessive_buffer_overrun_errors = 0xFUL;
    p->link_overrun_errors = (cntrs.local_link_integrity_errors << 4) |
        cntrs.excessive_buffer_overrun_errors;
    if (cntrs.vl15_dropped > 0xFFFFUL)
        p->vl15_dropped = cpu_to_be16(0xFFFF);
    else
        p->vl15_dropped = cpu_to_be16((u16)cntrs.vl15_dropped);

    return reply((struct ib_smp *)pmp);
}

static int pma_get_portcounters_ext(struct ib_pma_mad *pmp,
                    struct ib_device *ibdev, u8 port)
{
    struct ib_pma_portcounters_ext *p =
        (struct ib_pma_portcounters_ext *)pmp->data;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    u64 swords, rwords, spkts, rpkts, xwait;
    u8 port_select = p->port_select;

    memset(pmp->data, 0, sizeof(pmp->data));

    p->port_select = port_select;
    if (pmp->mad_hdr.attr_mod != 0 || port_select != port) {
        pmp->mad_hdr.status |= IB_SMP_INVALID_FIELD;
        goto bail;
    }

    qib_snapshot_counters(ppd, &swords, &rwords, &spkts, &rpkts, &xwait);

    /* Adjust counters for any resets done. */
    swords -= ibp->z_port_xmit_data;
    rwords -= ibp->z_port_rcv_data;
    spkts -= ibp->z_port_xmit_packets;
    rpkts -= ibp->z_port_rcv_packets;

    p->port_xmit_data = cpu_to_be64(swords);
    p->port_rcv_data = cpu_to_be64(rwords);
    p->port_xmit_packets = cpu_to_be64(spkts);
    p->port_rcv_packets = cpu_to_be64(rpkts);
    p->port_unicast_xmit_packets = cpu_to_be64(ibp->n_unicast_xmit);
    p->port_unicast_rcv_packets = cpu_to_be64(ibp->n_unicast_rcv);
    p->port_multicast_xmit_packets = cpu_to_be64(ibp->n_multicast_xmit);
    p->port_multicast_rcv_packets = cpu_to_be64(ibp->n_multicast_rcv);

bail:
    return reply((struct ib_smp *) pmp);
}

static int pma_set_portcounters(struct ib_pma_mad *pmp,
                struct ib_device *ibdev, u8 port)
{
    struct ib_pma_portcounters *p = (struct ib_pma_portcounters *)
        pmp->data;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    struct qib_verbs_counters cntrs;

    /*
     * Since the HW doesn't support clearing counters, we save the
     * current count and subtract it from future responses.
     */
    qib_get_counters(ppd, &cntrs);

    if (p->counter_select & IB_PMA_SEL_SYMBOL_ERROR)
        ibp->z_symbol_error_counter = cntrs.symbol_error_counter;

    if (p->counter_select & IB_PMA_SEL_LINK_ERROR_RECOVERY)
        ibp->z_link_error_recovery_counter =
            cntrs.link_error_recovery_counter;

    if (p->counter_select & IB_PMA_SEL_LINK_DOWNED)
        ibp->z_link_downed_counter = cntrs.link_downed_counter;

    if (p->counter_select & IB_PMA_SEL_PORT_RCV_ERRORS)
        ibp->z_port_rcv_errors = cntrs.port_rcv_errors;

    if (p->counter_select & IB_PMA_SEL_PORT_RCV_REMPHYS_ERRORS)
        ibp->z_port_rcv_remphys_errors =
            cntrs.port_rcv_remphys_errors;

    if (p->counter_select & IB_PMA_SEL_PORT_XMIT_DISCARDS)
        ibp->z_port_xmit_discards = cntrs.port_xmit_discards;

    if (p->counter_select & IB_PMA_SEL_LOCAL_LINK_INTEGRITY_ERRORS)
        ibp->z_local_link_integrity_errors =
            cntrs.local_link_integrity_errors;

    if (p->counter_select & IB_PMA_SEL_EXCESSIVE_BUFFER_OVERRUNS)
        ibp->z_excessive_buffer_overrun_errors =
            cntrs.excessive_buffer_overrun_errors;

    if (p->counter_select & IB_PMA_SEL_PORT_VL15_DROPPED) {
        ibp->n_vl15_dropped = 0;
        ibp->z_vl15_dropped = cntrs.vl15_dropped;
    }

    if (p->counter_select & IB_PMA_SEL_PORT_XMIT_DATA)
        ibp->z_port_xmit_data = cntrs.port_xmit_data;

    if (p->counter_select & IB_PMA_SEL_PORT_RCV_DATA)
        ibp->z_port_rcv_data = cntrs.port_rcv_data;

    if (p->counter_select & IB_PMA_SEL_PORT_XMIT_PACKETS)
        ibp->z_port_xmit_packets = cntrs.port_xmit_packets;

    if (p->counter_select & IB_PMA_SEL_PORT_RCV_PACKETS)
        ibp->z_port_rcv_packets = cntrs.port_rcv_packets;

    return pma_get_portcounters(pmp, ibdev, port);
}

static int pma_set_portcounters_cong(struct ib_pma_mad *pmp,
                     struct ib_device *ibdev, u8 port)
{
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    struct qib_devdata *dd = dd_from_ppd(ppd);
    struct qib_verbs_counters cntrs;
    u32 counter_select = (be32_to_cpu(pmp->mad_hdr.attr_mod) >> 24) & 0xFF;
    int ret = 0;
    unsigned long flags;

    qib_get_counters(ppd, &cntrs);
    /* Get counter values before we save them */
    ret = pma_get_portcounters_cong(pmp, ibdev, port);

    if (counter_select & IB_PMA_SEL_CONG_XMIT) {
        spin_lock_irqsave(&ppd->ibport_data.lock, flags);
        ppd->cong_stats.counter = 0;
        dd->f_set_cntr_sample(ppd, QIB_CONG_TIMER_PSINTERVAL,
                      0x0);
        spin_unlock_irqrestore(&ppd->ibport_data.lock, flags);
    }
    if (counter_select & IB_PMA_SEL_CONG_PORT_DATA) {
        ibp->z_port_xmit_data = cntrs.port_xmit_data;
        ibp->z_port_rcv_data = cntrs.port_rcv_data;
        ibp->z_port_xmit_packets = cntrs.port_xmit_packets;
        ibp->z_port_rcv_packets = cntrs.port_rcv_packets;
    }
    if (counter_select & IB_PMA_SEL_CONG_ALL) {
        ibp->z_symbol_error_counter =
            cntrs.symbol_error_counter;
        ibp->z_link_error_recovery_counter =
            cntrs.link_error_recovery_counter;
        ibp->z_link_downed_counter =
            cntrs.link_downed_counter;
        ibp->z_port_rcv_errors = cntrs.port_rcv_errors;
        ibp->z_port_rcv_remphys_errors =
            cntrs.port_rcv_remphys_errors;
        ibp->z_port_xmit_discards =
            cntrs.port_xmit_discards;
        ibp->z_local_link_integrity_errors =
            cntrs.local_link_integrity_errors;
        ibp->z_excessive_buffer_overrun_errors =
            cntrs.excessive_buffer_overrun_errors;
        ibp->n_vl15_dropped = 0;
        ibp->z_vl15_dropped = cntrs.vl15_dropped;
    }

    return ret;
}

static int pma_set_portcounters_ext(struct ib_pma_mad *pmp,
                    struct ib_device *ibdev, u8 port)
{
    struct ib_pma_portcounters *p = (struct ib_pma_portcounters *)
        pmp->data;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    u64 swords, rwords, spkts, rpkts, xwait;

    qib_snapshot_counters(ppd, &swords, &rwords, &spkts, &rpkts, &xwait);

    if (p->counter_select & IB_PMA_SELX_PORT_XMIT_DATA)
        ibp->z_port_xmit_data = swords;

    if (p->counter_select & IB_PMA_SELX_PORT_RCV_DATA)
        ibp->z_port_rcv_data = rwords;

    if (p->counter_select & IB_PMA_SELX_PORT_XMIT_PACKETS)
        ibp->z_port_xmit_packets = spkts;

    if (p->counter_select & IB_PMA_SELX_PORT_RCV_PACKETS)
        ibp->z_port_rcv_packets = rpkts;

    if (p->counter_select & IB_PMA_SELX_PORT_UNI_XMIT_PACKETS)
        ibp->n_unicast_xmit = 0;

    if (p->counter_select & IB_PMA_SELX_PORT_UNI_RCV_PACKETS)
        ibp->n_unicast_rcv = 0;

    if (p->counter_select & IB_PMA_SELX_PORT_MULTI_XMIT_PACKETS)
        ibp->n_multicast_xmit = 0;

    if (p->counter_select & IB_PMA_SELX_PORT_MULTI_RCV_PACKETS)
        ibp->n_multicast_rcv = 0;

    return pma_get_portcounters_ext(pmp, ibdev, port);
}

static int process_subn(struct ib_device *ibdev, int mad_flags,
            u8 port, struct ib_mad *in_mad,
            struct ib_mad *out_mad)
{
    struct ib_smp *smp = (struct ib_smp *)out_mad;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    int ret;

    *out_mad = *in_mad;
    if (smp->class_version != 1) {
        smp->status |= IB_SMP_UNSUP_VERSION;
        ret = reply(smp);
        goto bail;
    }

    ret = check_mkey(ibp, smp, mad_flags);
    if (ret) {
        u32 port_num = be32_to_cpu(smp->attr_mod);

        /*
         * If this is a get/set portinfo, we already check the
         * M_Key if the MAD is for another port and the M_Key
         * is OK on the receiving port. This check is needed
         * to increment the error counters when the M_Key
         * fails to match on *both* ports.
         */
        if (in_mad->mad_hdr.attr_id == IB_SMP_ATTR_PORT_INFO &&
            (smp->method == IB_MGMT_METHOD_GET ||
             smp->method == IB_MGMT_METHOD_SET) &&
            port_num && port_num <= ibdev->phys_port_cnt &&
            port != port_num)
            (void) check_mkey(to_iport(ibdev, port_num), smp, 0);
        ret = IB_MAD_RESULT_FAILURE;
        goto bail;
    }

    switch (smp->method) {
    case IB_MGMT_METHOD_GET:
        switch (smp->attr_id) {
        case IB_SMP_ATTR_NODE_DESC:
            ret = subn_get_nodedescription(smp, ibdev);
            goto bail;
        case IB_SMP_ATTR_NODE_INFO:
            ret = subn_get_nodeinfo(smp, ibdev, port);
            goto bail;
        case IB_SMP_ATTR_GUID_INFO:
            ret = subn_get_guidinfo(smp, ibdev, port);
            goto bail;
        case IB_SMP_ATTR_PORT_INFO:
            ret = subn_get_portinfo(smp, ibdev, port);
            goto bail;
        case IB_SMP_ATTR_PKEY_TABLE:
            ret = subn_get_pkeytable(smp, ibdev, port);
            goto bail;
        case IB_SMP_ATTR_SL_TO_VL_TABLE:
            ret = subn_get_sl_to_vl(smp, ibdev, port);
            goto bail;
        case IB_SMP_ATTR_VL_ARB_TABLE:
            ret = subn_get_vl_arb(smp, ibdev, port);
            goto bail;
        case IB_SMP_ATTR_SM_INFO:
            if (ibp->port_cap_flags & IB_PORT_SM_DISABLED) {
                ret = IB_MAD_RESULT_SUCCESS |
                    IB_MAD_RESULT_CONSUMED;
                goto bail;
            }
            if (ibp->port_cap_flags & IB_PORT_SM) {
                ret = IB_MAD_RESULT_SUCCESS;
                goto bail;
            }
            /* FALLTHROUGH */
        default:
            smp->status |= IB_SMP_UNSUP_METH_ATTR;
            ret = reply(smp);
            goto bail;
        }

    case IB_MGMT_METHOD_SET:
        switch (smp->attr_id) {
        case IB_SMP_ATTR_GUID_INFO:
            ret = subn_set_guidinfo(smp, ibdev, port);
            goto bail;
        case IB_SMP_ATTR_PORT_INFO:
            ret = subn_set_portinfo(smp, ibdev, port);
            goto bail;
        case IB_SMP_ATTR_PKEY_TABLE:
            ret = subn_set_pkeytable(smp, ibdev, port);
            goto bail;
        case IB_SMP_ATTR_SL_TO_VL_TABLE:
            ret = subn_set_sl_to_vl(smp, ibdev, port);
            goto bail;
        case IB_SMP_ATTR_VL_ARB_TABLE:
            ret = subn_set_vl_arb(smp, ibdev, port);
            goto bail;
        case IB_SMP_ATTR_SM_INFO:
            if (ibp->port_cap_flags & IB_PORT_SM_DISABLED) {
                ret = IB_MAD_RESULT_SUCCESS |
                    IB_MAD_RESULT_CONSUMED;
                goto bail;
            }
            if (ibp->port_cap_flags & IB_PORT_SM) {
                ret = IB_MAD_RESULT_SUCCESS;
                goto bail;
            }
            /* FALLTHROUGH */
        default:
            smp->status |= IB_SMP_UNSUP_METH_ATTR;
            ret = reply(smp);
            goto bail;
        }

    case IB_MGMT_METHOD_TRAP_REPRESS:
        if (smp->attr_id == IB_SMP_ATTR_NOTICE)
            ret = subn_trap_repress(smp, ibdev, port);
        else {
            smp->status |= IB_SMP_UNSUP_METH_ATTR;
            ret = reply(smp);
        }
        goto bail;

    case IB_MGMT_METHOD_TRAP:
    case IB_MGMT_METHOD_REPORT:
    case IB_MGMT_METHOD_REPORT_RESP:
    case IB_MGMT_METHOD_GET_RESP:
        /*
         * The ib_mad module will call us to process responses
         * before checking for other consumers.
         * Just tell the caller to process it normally.
         */
        ret = IB_MAD_RESULT_SUCCESS;
        goto bail;

    case IB_MGMT_METHOD_SEND:
        if (ib_get_smp_direction(smp) &&
            smp->attr_id == QIB_VENDOR_IPG) {
            ppd->dd->f_set_ib_cfg(ppd, QIB_IB_CFG_PORT,
                          smp->data[0]);
            ret = IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_CONSUMED;
        } else
            ret = IB_MAD_RESULT_SUCCESS;
        goto bail;

    default:
        smp->status |= IB_SMP_UNSUP_METHOD;
        ret = reply(smp);
    }

bail:
    return ret;
}

static int process_perf(struct ib_device *ibdev, u8 port,
            struct ib_mad *in_mad,
            struct ib_mad *out_mad)
{
    struct ib_pma_mad *pmp = (struct ib_pma_mad *)out_mad;
    int ret;

    *out_mad = *in_mad;
    if (pmp->mad_hdr.class_version != 1) {
        pmp->mad_hdr.status |= IB_SMP_UNSUP_VERSION;
        ret = reply((struct ib_smp *) pmp);
        goto bail;
    }

    switch (pmp->mad_hdr.method) {
    case IB_MGMT_METHOD_GET:
        switch (pmp->mad_hdr.attr_id) {
        case IB_PMA_CLASS_PORT_INFO:
            ret = pma_get_classportinfo(pmp, ibdev);
            goto bail;
        case IB_PMA_PORT_SAMPLES_CONTROL:
            ret = pma_get_portsamplescontrol(pmp, ibdev, port);
            goto bail;
        case IB_PMA_PORT_SAMPLES_RESULT:
            ret = pma_get_portsamplesresult(pmp, ibdev, port);
            goto bail;
        case IB_PMA_PORT_SAMPLES_RESULT_EXT:
            ret = pma_get_portsamplesresult_ext(pmp, ibdev, port);
            goto bail;
        case IB_PMA_PORT_COUNTERS:
            ret = pma_get_portcounters(pmp, ibdev, port);
            goto bail;
        case IB_PMA_PORT_COUNTERS_EXT:
            ret = pma_get_portcounters_ext(pmp, ibdev, port);
            goto bail;
        case IB_PMA_PORT_COUNTERS_CONG:
            ret = pma_get_portcounters_cong(pmp, ibdev, port);
            goto bail;
        default:
            pmp->mad_hdr.status |= IB_SMP_UNSUP_METH_ATTR;
            ret = reply((struct ib_smp *) pmp);
            goto bail;
        }

    case IB_MGMT_METHOD_SET:
        switch (pmp->mad_hdr.attr_id) {
        case IB_PMA_PORT_SAMPLES_CONTROL:
            ret = pma_set_portsamplescontrol(pmp, ibdev, port);
            goto bail;
        case IB_PMA_PORT_COUNTERS:
            ret = pma_set_portcounters(pmp, ibdev, port);
            goto bail;
        case IB_PMA_PORT_COUNTERS_EXT:
            ret = pma_set_portcounters_ext(pmp, ibdev, port);
            goto bail;
        case IB_PMA_PORT_COUNTERS_CONG:
            ret = pma_set_portcounters_cong(pmp, ibdev, port);
            goto bail;
        default:
            pmp->mad_hdr.status |= IB_SMP_UNSUP_METH_ATTR;
            ret = reply((struct ib_smp *) pmp);
            goto bail;
        }

    case IB_MGMT_METHOD_TRAP:
    case IB_MGMT_METHOD_GET_RESP:
        /*
         * The ib_mad module will call us to process responses
         * before checking for other consumers.
         * Just tell the caller to process it normally.
         */
        ret = IB_MAD_RESULT_SUCCESS;
        goto bail;

    default:
        pmp->mad_hdr.status |= IB_SMP_UNSUP_METHOD;
        ret = reply((struct ib_smp *) pmp);
    }

bail:
    return ret;
}

static int cc_get_classportinfo(struct ib_cc_mad *ccp,
                struct ib_device *ibdev)
{
    struct ib_cc_classportinfo_attr *p =
        (struct ib_cc_classportinfo_attr *)ccp->mgmt_data;

    memset(ccp->mgmt_data, 0, sizeof(ccp->mgmt_data));

    p->base_version = 1;
    p->class_version = 1;
    p->cap_mask = 0;

    /*
     * Expected response time is 4.096 usec. * 2^18 == 1.073741824 sec.
     */
    p->resp_time_value = 18;

    return reply((struct ib_smp *) ccp);
}

static int cc_get_congestion_info(struct ib_cc_mad *ccp,
                struct ib_device *ibdev, u8 port)
{
    struct ib_cc_info_attr *p =
        (struct ib_cc_info_attr *)ccp->mgmt_data;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);

    memset(ccp->mgmt_data, 0, sizeof(ccp->mgmt_data));

    p->congestion_info = 0;
    p->control_table_cap = ppd->cc_max_table_entries;

    return reply((struct ib_smp *) ccp);
}

static int cc_get_congestion_setting(struct ib_cc_mad *ccp,
                struct ib_device *ibdev, u8 port)
{
    int i;
    struct ib_cc_congestion_setting_attr *p =
        (struct ib_cc_congestion_setting_attr *)ccp->mgmt_data;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    struct ib_cc_congestion_entry_shadow *entries;

    memset(ccp->mgmt_data, 0, sizeof(ccp->mgmt_data));

    spin_lock(&ppd->cc_shadow_lock);

    entries = ppd->congestion_entries_shadow->entries;
    p->port_control = cpu_to_be16(
        ppd->congestion_entries_shadow->port_control);
    p->control_map = cpu_to_be16(
        ppd->congestion_entries_shadow->control_map);
    for (i = 0; i < IB_CC_CCS_ENTRIES; i++) {
        p->entries[i].ccti_increase = entries[i].ccti_increase;
        p->entries[i].ccti_timer = cpu_to_be16(entries[i].ccti_timer);
        p->entries[i].trigger_threshold = entries[i].trigger_threshold;
        p->entries[i].ccti_min = entries[i].ccti_min;
    }

    spin_unlock(&ppd->cc_shadow_lock);

    return reply((struct ib_smp *) ccp);
}

static int cc_get_congestion_control_table(struct ib_cc_mad *ccp,
                struct ib_device *ibdev, u8 port)
{
    struct ib_cc_table_attr *p =
        (struct ib_cc_table_attr *)ccp->mgmt_data;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    u32 cct_block_index = be32_to_cpu(ccp->attr_mod);
    u32 max_cct_block;
    u32 cct_entry;
    struct ib_cc_table_entry_shadow *entries;
    int i;

    /* Is the table index more than what is supported? */
    if (cct_block_index > IB_CC_TABLE_CAP_DEFAULT - 1)
        goto bail;

    memset(ccp->mgmt_data, 0, sizeof(ccp->mgmt_data));

    spin_lock(&ppd->cc_shadow_lock);

    max_cct_block =
        (ppd->ccti_entries_shadow->ccti_last_entry + 1)/IB_CCT_ENTRIES;
    max_cct_block = max_cct_block ? max_cct_block - 1 : 0;

    if (cct_block_index > max_cct_block) {
        spin_unlock(&ppd->cc_shadow_lock);
        goto bail;
    }

    ccp->attr_mod = cpu_to_be32(cct_block_index);

    cct_entry = IB_CCT_ENTRIES * (cct_block_index + 1);

    cct_entry--;

    p->ccti_limit = cpu_to_be16(cct_entry);

    entries = &ppd->ccti_entries_shadow->
            entries[IB_CCT_ENTRIES * cct_block_index];
    cct_entry %= IB_CCT_ENTRIES;

    for (i = 0; i <= cct_entry; i++)
        p->ccti_entries[i].entry = cpu_to_be16(entries[i].entry);

    spin_unlock(&ppd->cc_shadow_lock);

    return reply((struct ib_smp *) ccp);

bail:
    return reply_failure((struct ib_smp *) ccp);
}

static int cc_set_congestion_setting(struct ib_cc_mad *ccp,
                struct ib_device *ibdev, u8 port)
{
    struct ib_cc_congestion_setting_attr *p =
        (struct ib_cc_congestion_setting_attr *)ccp->mgmt_data;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    int i;

    ppd->cc_sl_control_map = be16_to_cpu(p->control_map);

    for (i = 0; i < IB_CC_CCS_ENTRIES; i++) {
        ppd->congestion_entries[i].ccti_increase =
            p->entries[i].ccti_increase;

        ppd->congestion_entries[i].ccti_timer =
            be16_to_cpu(p->entries[i].ccti_timer);

        ppd->congestion_entries[i].trigger_threshold =
            p->entries[i].trigger_threshold;

        ppd->congestion_entries[i].ccti_min =
            p->entries[i].ccti_min;
    }

    return reply((struct ib_smp *) ccp);
}

static int cc_set_congestion_control_table(struct ib_cc_mad *ccp,
                struct ib_device *ibdev, u8 port)
{
    struct ib_cc_table_attr *p =
        (struct ib_cc_table_attr *)ccp->mgmt_data;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);
    u32 cct_block_index = be32_to_cpu(ccp->attr_mod);
    u32 cct_entry;
    struct ib_cc_table_entry_shadow *entries;
    int i;

    /* Is the table index more than what is supported? */
    if (cct_block_index > IB_CC_TABLE_CAP_DEFAULT - 1)
        goto bail;

    /* If this packet is the first in the sequence then
     * zero the total table entry count.
     */
    if (be16_to_cpu(p->ccti_limit) < IB_CCT_ENTRIES)
        ppd->total_cct_entry = 0;

    cct_entry = (be16_to_cpu(p->ccti_limit))%IB_CCT_ENTRIES;

    /* ccti_limit is 0 to 63 */
    ppd->total_cct_entry += (cct_entry + 1);

    if (ppd->total_cct_entry > ppd->cc_supported_table_entries)
        goto bail;

    ppd->ccti_limit = be16_to_cpu(p->ccti_limit);

    entries = ppd->ccti_entries + (IB_CCT_ENTRIES * cct_block_index);

    for (i = 0; i <= cct_entry; i++)
        entries[i].entry = be16_to_cpu(p->ccti_entries[i].entry);

    spin_lock(&ppd->cc_shadow_lock);

    ppd->ccti_entries_shadow->ccti_last_entry = ppd->total_cct_entry - 1;
    memcpy(ppd->ccti_entries_shadow->entries, ppd->ccti_entries,
        (ppd->total_cct_entry * sizeof(struct ib_cc_table_entry)));

    ppd->congestion_entries_shadow->port_control = IB_CC_CCS_PC_SL_BASED;
    ppd->congestion_entries_shadow->control_map = ppd->cc_sl_control_map;
    memcpy(ppd->congestion_entries_shadow->entries, ppd->congestion_entries,
        IB_CC_CCS_ENTRIES * sizeof(struct ib_cc_congestion_entry));

    spin_unlock(&ppd->cc_shadow_lock);

    return reply((struct ib_smp *) ccp);

bail:
    return reply_failure((struct ib_smp *) ccp);
}

static int check_cc_key(struct qib_ibport *ibp,
            struct ib_cc_mad *ccp, int mad_flags)
{
    return 0;
}

static int process_cc(struct ib_device *ibdev, int mad_flags,
            u8 port, struct ib_mad *in_mad,
            struct ib_mad *out_mad)
{
    struct ib_cc_mad *ccp = (struct ib_cc_mad *)out_mad;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    int ret;

    *out_mad = *in_mad;

    if (ccp->class_version != 2) {
        ccp->status |= IB_SMP_UNSUP_VERSION;
        ret = reply((struct ib_smp *)ccp);
        goto bail;
    }

    ret = check_cc_key(ibp, ccp, mad_flags);
    if (ret)
        goto bail;

    switch (ccp->method) {
    case IB_MGMT_METHOD_GET:
        switch (ccp->attr_id) {
        case IB_CC_ATTR_CLASSPORTINFO:
            ret = cc_get_classportinfo(ccp, ibdev);
            goto bail;

        case IB_CC_ATTR_CONGESTION_INFO:
            ret = cc_get_congestion_info(ccp, ibdev, port);
            goto bail;

        case IB_CC_ATTR_CA_CONGESTION_SETTING:
            ret = cc_get_congestion_setting(ccp, ibdev, port);
            goto bail;

        case IB_CC_ATTR_CONGESTION_CONTROL_TABLE:
            ret = cc_get_congestion_control_table(ccp, ibdev, port);
            goto bail;

            /* FALLTHROUGH */
        default:
            ccp->status |= IB_SMP_UNSUP_METH_ATTR;
            ret = reply((struct ib_smp *) ccp);
            goto bail;
        }

    case IB_MGMT_METHOD_SET:
        switch (ccp->attr_id) {
        case IB_CC_ATTR_CA_CONGESTION_SETTING:
            ret = cc_set_congestion_setting(ccp, ibdev, port);
            goto bail;

        case IB_CC_ATTR_CONGESTION_CONTROL_TABLE:
            ret = cc_set_congestion_control_table(ccp, ibdev, port);
            goto bail;

            /* FALLTHROUGH */
        default:
            ccp->status |= IB_SMP_UNSUP_METH_ATTR;
            ret = reply((struct ib_smp *) ccp);
            goto bail;
        }

    case IB_MGMT_METHOD_GET_RESP:
        /*
         * The ib_mad module will call us to process responses
         * before checking for other consumers.
         * Just tell the caller to process it normally.
         */
        ret = IB_MAD_RESULT_SUCCESS;
        goto bail;

    case IB_MGMT_METHOD_TRAP:
    default:
        ccp->status |= IB_SMP_UNSUP_METHOD;
        ret = reply((struct ib_smp *) ccp);
    }

bail:
    return ret;
}

int qib_process_mad(struct ib_device *ibdev, int mad_flags, u8 port,
            struct ib_wc *in_wc, struct ib_grh *in_grh,
            struct ib_mad *in_mad, struct ib_mad *out_mad)
{
    int ret;
    struct qib_ibport *ibp = to_iport(ibdev, port);
    struct qib_pportdata *ppd = ppd_from_ibp(ibp);

    switch (in_mad->mad_hdr.mgmt_class) {
    case IB_MGMT_CLASS_SUBN_DIRECTED_ROUTE:
    case IB_MGMT_CLASS_SUBN_LID_ROUTED:
        ret = process_subn(ibdev, mad_flags, port, in_mad, out_mad);
        goto bail;

    case IB_MGMT_CLASS_PERF_MGMT:
        ret = process_perf(ibdev, port, in_mad, out_mad);
        goto bail;

    case IB_MGMT_CLASS_CONG_MGMT:
        if (!ppd->congestion_entries_shadow ||
             !qib_cc_table_size) {
            ret = IB_MAD_RESULT_SUCCESS;
            goto bail;
        }
        ret = process_cc(ibdev, mad_flags, port, in_mad, out_mad);
        goto bail;

    default:
        ret = IB_MAD_RESULT_SUCCESS;
    }

bail:
    return ret;
}

static void send_handler(struct ib_mad_agent *agent,
             struct ib_mad_send_wc *mad_send_wc)
{
    ib_free_send_mad(mad_send_wc->send_buf);
}

static void xmit_wait_timer_func(unsigned long opaque)
{
    struct qib_pportdata *ppd = (struct qib_pportdata *)opaque;
    struct qib_devdata *dd = dd_from_ppd(ppd);
    unsigned long flags;
    u8 status;

    spin_lock_irqsave(&ppd->ibport_data.lock, flags);
    if (ppd->cong_stats.flags == IB_PMA_CONG_HW_CONTROL_SAMPLE) {
        status = dd->f_portcntr(ppd, QIBPORTCNTR_PSSTAT);
        if (status == IB_PMA_SAMPLE_STATUS_DONE) {
            /* save counter cache */
            cache_hw_sample_counters(ppd);
            ppd->cong_stats.flags = IB_PMA_CONG_HW_CONTROL_TIMER;
        } else
            goto done;
    }
    ppd->cong_stats.counter = xmit_wait_get_value_delta(ppd);
    dd->f_set_cntr_sample(ppd, QIB_CONG_TIMER_PSINTERVAL, 0x0);
done:
    spin_unlock_irqrestore(&ppd->ibport_data.lock, flags);
    mod_timer(&ppd->cong_stats.timer, jiffies + HZ);
}

int qib_create_agents(struct qib_ibdev *dev)
{
    struct qib_devdata *dd = dd_from_dev(dev);
    struct ib_mad_agent *agent;
    struct qib_ibport *ibp;
    int p;
    int ret;

    for (p = 0; p < dd->num_pports; p++) {
        ibp = &dd->pport[p].ibport_data;
        agent = ib_register_mad_agent(&dev->ibdev, p + 1, IB_QPT_SMI,
                          NULL, 0, send_handler,
                          NULL, NULL);
        if (IS_ERR(agent)) {
            ret = PTR_ERR(agent);
            goto err;
        }

        /* Initialize xmit_wait structure */
        dd->pport[p].cong_stats.counter = 0;
        init_timer(&dd->pport[p].cong_stats.timer);
        dd->pport[p].cong_stats.timer.function = xmit_wait_timer_func;
        dd->pport[p].cong_stats.timer.data =
            (unsigned long)(&dd->pport[p]);
        dd->pport[p].cong_stats.timer.expires = 0;
        add_timer(&dd->pport[p].cong_stats.timer);

        ibp->send_agent = agent;
    }

    return 0;

err:
    for (p = 0; p < dd->num_pports; p++) {
        ibp = &dd->pport[p].ibport_data;
        if (ibp->send_agent) {
            agent = ibp->send_agent;
            ibp->send_agent = NULL;
            ib_unregister_mad_agent(agent);
        }
    }

    return ret;
}

void qib_free_agents(struct qib_ibdev *dev)
{
    struct qib_devdata *dd = dd_from_dev(dev);
    struct ib_mad_agent *agent;
    struct qib_ibport *ibp;
    int p;

    for (p = 0; p < dd->num_pports; p++) {
        ibp = &dd->pport[p].ibport_data;
        if (ibp->send_agent) {
            agent = ibp->send_agent;
            ibp->send_agent = NULL;
            ib_unregister_mad_agent(agent);
        }
        if (ibp->sm_ah) {
            ib_destroy_ah(&ibp->sm_ah->ibah);
            ibp->sm_ah = NULL;
        }
        if (dd->pport[p].cong_stats.timer.data)
            del_timer_sync(&dd->pport[p].cong_stats.timer);
    }
}