drivers/infiniband/hw/qib/qib_mad.c

   1 /*
   2  * Copyright (c) 2006, 2007, 2008, 2009, 2010 QLogic Corporation.
   3  * All rights reserved.
   4  * Copyright (c) 2005, 2006 PathScale, Inc. All rights reserved.
   5  *
   6  * This software is available to you under a choice of one of two
   7  * licenses.  You may choose to be licensed under the terms of the GNU
   8  * General Public License (GPL) Version 2, available from the file
   9  * COPYING in the main directory of this source tree, or the
  10  * OpenIB.org BSD license below:
  11  *
  12  *     Redistribution and use in source and binary forms, with or
  13  *     without modification, are permitted provided that the following
  14  *     conditions are met:
  15  *
  16  *      - Redistributions of source code must retain the above
  17  *        copyright notice, this list of conditions and the following
  18  *        disclaimer.
  19  *
  20  *      - Redistributions in binary form must reproduce the above
  21  *        copyright notice, this list of conditions and the following
  22  *        disclaimer in the documentation and/or other materials
  23  *        provided with the distribution.
  24  *
  25  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  26  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  27  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  28  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  29  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  30  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  31  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  32  * SOFTWARE.
  33  */
  34
  35 #include <rdma/ib_smi.h>
  36
  37 #include "qib.h"
  38 #include "qib_mad.h"
  39
  40 static int reply(struct ib_smp *smp)
  41 {
  42         /*
  43          * The verbs framework will handle the directed/LID route
  44          * packet changes.
  45          */
  46         smp->method = IB_MGMT_METHOD_GET_RESP;
  47         if (smp->mgmt_class == IB_MGMT_CLASS_SUBN_DIRECTED_ROUTE)
  48                 smp->status |= IB_SMP_DIRECTION;
  49         return IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_REPLY;
  50 }
  51
  52 static void qib_send_trap(struct qib_ibport *ibp, void *data, unsigned len)
  53 {
  54         struct ib_mad_send_buf *send_buf;
  55         struct ib_mad_agent *agent;
  56         struct ib_smp *smp;
  57         int ret;
  58         unsigned long flags;
  59         unsigned long timeout;
  60
  61         agent = ibp->send_agent;
  62         if (!agent)
  63                 return;
  64
  65         /* o14-3.2.1 */
  66         if (!(ppd_from_ibp(ibp)->lflags & QIBL_LINKACTIVE))
  67                 return;
  68
  69         /* o14-2 */
  70         if (ibp->trap_timeout && time_before(jiffies, ibp->trap_timeout))
  71                 return;
  72
  73         send_buf = ib_create_send_mad(agent, 0, 0, 0, IB_MGMT_MAD_HDR,
  74                                       IB_MGMT_MAD_DATA, GFP_ATOMIC);
  75         if (IS_ERR(send_buf))
  76                 return;
  77
  78         smp = send_buf->mad;
  79         smp->base_version = IB_MGMT_BASE_VERSION;
  80         smp->mgmt_class = IB_MGMT_CLASS_SUBN_LID_ROUTED;
  81         smp->class_version = 1;
  82         smp->method = IB_MGMT_METHOD_TRAP;
  83         ibp->tid++;
  84         smp->tid = cpu_to_be64(ibp->tid);
  85         smp->attr_id = IB_SMP_ATTR_NOTICE;
  86         /* o14-1: smp->mkey = 0; */
  87         memcpy(smp->data, data, len);
  88
  89         spin_lock_irqsave(&ibp->lock, flags);
  90         if (!ibp->sm_ah) {
  91                 if (ibp->sm_lid != be16_to_cpu(IB_LID_PERMISSIVE)) {
  92                         struct ib_ah *ah;
  93                         struct ib_ah_attr attr;
  94
  95                         memset(&attr, 0, sizeof attr);
  96                         attr.dlid = ibp->sm_lid;
  97                         attr.port_num = ppd_from_ibp(ibp)->port;
  98                         ah = ib_create_ah(ibp->qp0->ibqp.pd, &attr);
  99                         if (IS_ERR(ah))
 100                                 ret = -EINVAL;
 101                         else {
 102                                 send_buf->ah = ah;
 103                                 ibp->sm_ah = to_iah(ah);
 104                                 ret = 0;
 105                         }
 106                 } else
 107                         ret = -EINVAL;
 108         } else {
 109                 send_buf->ah = &ibp->sm_ah->ibah;
 110                 ret = 0;
 111         }
 112         spin_unlock_irqrestore(&ibp->lock, flags);
 113
 114         if (!ret)
 115                 ret = ib_post_send_mad(send_buf, NULL);
 116         if (!ret) {
 117                 /* 4.096 usec. */
 118                 timeout = (4096 * (1UL << ibp->subnet_timeout)) / 1000;
 119                 ibp->trap_timeout = jiffies + usecs_to_jiffies(timeout);
 120         } else {
 121                 ib_free_send_mad(send_buf);
 122                 ibp->trap_timeout = 0;
 123         }
 124 }
 125
 126 /*
 127  * Send a bad [PQ]_Key trap (ch. 14.3.8).
 128  */
 129 void qib_bad_pqkey(struct qib_ibport *ibp, __be16 trap_num, u32 key, u32 sl,
 130                    u32 qp1, u32 qp2, __be16 lid1, __be16 lid2)
 131 {
 132         struct ib_mad_notice_attr data;
 133
 134         if (trap_num == IB_NOTICE_TRAP_BAD_PKEY)
 135                 ibp->pkey_violations++;
 136         else
 137                 ibp->qkey_violations++;
 138         ibp->n_pkt_drops++;
 139
 140         /* Send violation trap */
 141         data.generic_type = IB_NOTICE_TYPE_SECURITY;
 142         data.prod_type_msb = 0;
 143         data.prod_type_lsb = IB_NOTICE_PROD_CA;
 144         data.trap_num = trap_num;
 145         data.issuer_lid = cpu_to_be16(ppd_from_ibp(ibp)->lid);
 146         data.toggle_count = 0;
 147         memset(&data.details, 0, sizeof data.details);
 148         data.details.ntc_257_258.lid1 = lid1;
 149         data.details.ntc_257_258.lid2 = lid2;
 150         data.details.ntc_257_258.key = cpu_to_be32(key);
 151         data.details.ntc_257_258.sl_qp1 = cpu_to_be32((sl << 28) | qp1);
 152         data.details.ntc_257_258.qp2 = cpu_to_be32(qp2);
 153
 154         qib_send_trap(ibp, &data, sizeof data);
 155 }
 156
 157 /*
 158  * Send a bad M_Key trap (ch. 14.3.9).
 159  */
 160 static void qib_bad_mkey(struct qib_ibport *ibp, struct ib_smp *smp)
 161 {
 162         struct ib_mad_notice_attr data;
 163
 164         /* Send violation trap */
 165         data.generic_type = IB_NOTICE_TYPE_SECURITY;
 166         data.prod_type_msb = 0;
 167         data.prod_type_lsb = IB_NOTICE_PROD_CA;
 168         data.trap_num = IB_NOTICE_TRAP_BAD_MKEY;
 169         data.issuer_lid = cpu_to_be16(ppd_from_ibp(ibp)->lid);
 170         data.toggle_count = 0;
 171         memset(&data.details, 0, sizeof data.details);
 172         data.details.ntc_256.lid = data.issuer_lid;
 173         data.details.ntc_256.method = smp->method;
 174         data.details.ntc_256.attr_id = smp->attr_id;
 175         data.details.ntc_256.attr_mod = smp->attr_mod;
 176         data.details.ntc_256.mkey = smp->mkey;
 177         if (smp->mgmt_class == IB_MGMT_CLASS_SUBN_DIRECTED_ROUTE) {
 178                 u8 hop_cnt;
 179
 180                 data.details.ntc_256.dr_slid = smp->dr_slid;
 181                 data.details.ntc_256.dr_trunc_hop = IB_NOTICE_TRAP_DR_NOTICE;
 182                 hop_cnt = smp->hop_cnt;
 183                 if (hop_cnt > ARRAY_SIZE(data.details.ntc_256.dr_rtn_path)) {
 184                         data.details.ntc_256.dr_trunc_hop |=
 185                                 IB_NOTICE_TRAP_DR_TRUNC;
 186                         hop_cnt = ARRAY_SIZE(data.details.ntc_256.dr_rtn_path);
 187                 }
 188                 data.details.ntc_256.dr_trunc_hop |= hop_cnt;
 189                 memcpy(data.details.ntc_256.dr_rtn_path, smp->return_path,
 190                        hop_cnt);
 191         }
 192
 193         qib_send_trap(ibp, &data, sizeof data);
 194 }
 195
 196 /*
 197  * Send a Port Capability Mask Changed trap (ch. 14.3.11).
 198  */
 199 void qib_cap_mask_chg(struct qib_ibport *ibp)
 200 {
 201         struct ib_mad_notice_attr data;
 202
 203         data.generic_type = IB_NOTICE_TYPE_INFO;
 204         data.prod_type_msb = 0;
 205         data.prod_type_lsb = IB_NOTICE_PROD_CA;
 206         data.trap_num = IB_NOTICE_TRAP_CAP_MASK_CHG;
 207         data.issuer_lid = cpu_to_be16(ppd_from_ibp(ibp)->lid);
 208         data.toggle_count = 0;
 209         memset(&data.details, 0, sizeof data.details);
 210         data.details.ntc_144.lid = data.issuer_lid;
 211         data.details.ntc_144.new_cap_mask = cpu_to_be32(ibp->port_cap_flags);
 212
 213         qib_send_trap(ibp, &data, sizeof data);
 214 }
 215
 216 /*
 217  * Send a System Image GUID Changed trap (ch. 14.3.12).
 218  */
 219 void qib_sys_guid_chg(struct qib_ibport *ibp)
 220 {
 221         struct ib_mad_notice_attr data;
 222
 223         data.generic_type = IB_NOTICE_TYPE_INFO;
 224         data.prod_type_msb = 0;
 225         data.prod_type_lsb = IB_NOTICE_PROD_CA;
 226         data.trap_num = IB_NOTICE_TRAP_SYS_GUID_CHG;
 227         data.issuer_lid = cpu_to_be16(ppd_from_ibp(ibp)->lid);
 228         data.toggle_count = 0;
 229         memset(&data.details, 0, sizeof data.details);
 230         data.details.ntc_145.lid = data.issuer_lid;
 231         data.details.ntc_145.new_sys_guid = ib_qib_sys_image_guid;
 232
 233         qib_send_trap(ibp, &data, sizeof data);
 234 }
 235
 236 /*
 237  * Send a Node Description Changed trap (ch. 14.3.13).
 238  */
 239 void qib_node_desc_chg(struct qib_ibport *ibp)
 240 {
 241         struct ib_mad_notice_attr data;
 242
 243         data.generic_type = IB_NOTICE_TYPE_INFO;
 244         data.prod_type_msb = 0;
 245         data.prod_type_lsb = IB_NOTICE_PROD_CA;
 246         data.trap_num = IB_NOTICE_TRAP_CAP_MASK_CHG;
 247         data.issuer_lid = cpu_to_be16(ppd_from_ibp(ibp)->lid);
 248         data.toggle_count = 0;
 249         memset(&data.details, 0, sizeof data.details);
 250         data.details.ntc_144.lid = data.issuer_lid;
 251         data.details.ntc_144.local_changes = 1;
 252         data.details.ntc_144.change_flags = IB_NOTICE_TRAP_NODE_DESC_CHG;
 253
 254         qib_send_trap(ibp, &data, sizeof data);
 255 }
 256
 257 static int subn_get_nodedescription(struct ib_smp *smp,
 258                                     struct ib_device *ibdev)
 259 {
 260         if (smp->attr_mod)
 261                 smp->status |= IB_SMP_INVALID_FIELD;
 262
 263         memcpy(smp->data, ibdev->node_desc, sizeof(smp->data));
 264
 265         return reply(smp);
 266 }
 267
 268 static int subn_get_nodeinfo(struct ib_smp *smp, struct ib_device *ibdev,
 269                              u8 port)
 270 {
 271         struct ib_node_info *nip = (struct ib_node_info *)&smp->data;
 272         struct qib_devdata *dd = dd_from_ibdev(ibdev);
 273         u32 vendor, majrev, minrev;
 274         unsigned pidx = port - 1; /* IB number port from 1, hdw from 0 */
 275
 276         /* GUID 0 is illegal */
 277         if (smp->attr_mod || pidx >= dd->num_pports ||
 278             dd->pport[pidx].guid == 0)
 279                 smp->status |= IB_SMP_INVALID_FIELD;
 280         else
 281                 nip->port_guid = dd->pport[pidx].guid;
 282
 283         nip->base_version = 1;
 284         nip->class_version = 1;
 285         nip->node_type = 1;     /* channel adapter */
 286         nip->num_ports = ibdev->phys_port_cnt;
 287         /* This is already in network order */
 288         nip->sys_guid = ib_qib_sys_image_guid;
 289         nip->node_guid = dd->pport->guid; /* Use first-port GUID as node */
 290         nip->partition_cap = cpu_to_be16(qib_get_npkeys(dd));
 291         nip->device_id = cpu_to_be16(dd->deviceid);
 292         majrev = dd->majrev;
 293         minrev = dd->minrev;
 294         nip->revision = cpu_to_be32((majrev << 16) | minrev);
 295         nip->local_port_num = port;
 296         vendor = dd->vendorid;
 297         nip->vendor_id[0] = QIB_SRC_OUI_1;
 298         nip->vendor_id[1] = QIB_SRC_OUI_2;
 299         nip->vendor_id[2] = QIB_SRC_OUI_3;
 300
 301         return reply(smp);
 302 }
 303
 304 static int subn_get_guidinfo(struct ib_smp *smp, struct ib_device *ibdev,
 305                              u8 port)
 306 {
 307         struct qib_devdata *dd = dd_from_ibdev(ibdev);
 308         u32 startgx = 8 * be32_to_cpu(smp->attr_mod);
 309         __be64 *p = (__be64 *) smp->data;
 310         unsigned pidx = port - 1; /* IB number port from 1, hdw from 0 */
 311
 312         /* 32 blocks of 8 64-bit GUIDs per block */
 313
 314         memset(smp->data, 0, sizeof(smp->data));
 315
 316         if (startgx == 0 && pidx < dd->num_pports) {
 317                 struct qib_pportdata *ppd = dd->pport + pidx;
 318                 struct qib_ibport *ibp = &ppd->ibport_data;
 319                 __be64 g = ppd->guid;
 320                 unsigned i;
 321
 322                 /* GUID 0 is illegal */
 323                 if (g == 0)
 324                         smp->status |= IB_SMP_INVALID_FIELD;
 325                 else {
 326                         /* The first is a copy of the read-only HW GUID. */
 327                         p[0] = g;
 328                         for (i = 1; i < QIB_GUIDS_PER_PORT; i++)
 329                                 p[i] = ibp->guids[i - 1];
 330                 }
 331         } else
 332                 smp->status |= IB_SMP_INVALID_FIELD;
 333
 334         return reply(smp);
 335 }
 336
 337 static void set_link_width_enabled(struct qib_pportdata *ppd, u32 w)
 338 {
 339         (void) ppd->dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LWID_ENB, w);
 340 }
 341
 342 static void set_link_speed_enabled(struct qib_pportdata *ppd, u32 s)
 343 {
 344         (void) ppd->dd->f_set_ib_cfg(ppd, QIB_IB_CFG_SPD_ENB, s);
 345 }
 346
 347 static int get_overrunthreshold(struct qib_pportdata *ppd)
 348 {
 349         return ppd->dd->f_get_ib_cfg(ppd, QIB_IB_CFG_OVERRUN_THRESH);
 350 }
 351
 352 /**
 353  * set_overrunthreshold - set the overrun threshold
 354  * @ppd: the physical port data
 355  * @n: the new threshold
 356  *
 357  * Note that this will only take effect when the link state changes.
 358  */
 359 static int set_overrunthreshold(struct qib_pportdata *ppd, unsigned n)
 360 {
 361         (void) ppd->dd->f_set_ib_cfg(ppd, QIB_IB_CFG_OVERRUN_THRESH,
 362                                          (u32)n);
 363         return 0;
 364 }
 365
 366 static int get_phyerrthreshold(struct qib_pportdata *ppd)
 367 {
 368         return ppd->dd->f_get_ib_cfg(ppd, QIB_IB_CFG_PHYERR_THRESH);
 369 }
 370
 371 /**
 372  * set_phyerrthreshold - set the physical error threshold
 373  * @ppd: the physical port data
 374  * @n: the new threshold
 375  *
 376  * Note that this will only take effect when the link state changes.
 377  */
 378 static int set_phyerrthreshold(struct qib_pportdata *ppd, unsigned n)
 379 {
 380         (void) ppd->dd->f_set_ib_cfg(ppd, QIB_IB_CFG_PHYERR_THRESH,
 381                                          (u32)n);
 382         return 0;
 383 }
 384
 385 /**
 386  * get_linkdowndefaultstate - get the default linkdown state
 387  * @ppd: the physical port data
 388  *
 389  * Returns zero if the default is POLL, 1 if the default is SLEEP.
 390  */
 391 static int get_linkdowndefaultstate(struct qib_pportdata *ppd)
 392 {
 393         return ppd->dd->f_get_ib_cfg(ppd, QIB_IB_CFG_LINKDEFAULT) ==
 394                 IB_LINKINITCMD_SLEEP;
 395 }
 396
 397 static int check_mkey(struct qib_ibport *ibp, struct ib_smp *smp, int mad_flags)
 398 {
 399         int ret = 0;
 400
 401         /* Is the mkey in the process of expiring? */
 402         if (ibp->mkey_lease_timeout &&
 403             time_after_eq(jiffies, ibp->mkey_lease_timeout)) {
 404                 /* Clear timeout and mkey protection field. */
 405                 ibp->mkey_lease_timeout = 0;
 406                 ibp->mkeyprot = 0;
 407         }
 408
 409         /* M_Key checking depends on Portinfo:M_Key_protect_bits */
 410         if ((mad_flags & IB_MAD_IGNORE_MKEY) == 0 && ibp->mkey != 0 &&
 411             ibp->mkey != smp->mkey &&
 412             (smp->method == IB_MGMT_METHOD_SET ||
 413              smp->method == IB_MGMT_METHOD_TRAP_REPRESS ||
 414              (smp->method == IB_MGMT_METHOD_GET && ibp->mkeyprot >= 2))) {
 415                 if (ibp->mkey_violations != 0xFFFF)
 416                         ++ibp->mkey_violations;
 417                 if (!ibp->mkey_lease_timeout && ibp->mkey_lease_period)
 418                         ibp->mkey_lease_timeout = jiffies +
 419                                 ibp->mkey_lease_period * HZ;
 420                 /* Generate a trap notice. */
 421                 qib_bad_mkey(ibp, smp);
 422                 ret = IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_CONSUMED;
 423         } else if (ibp->mkey_lease_timeout)
 424                 ibp->mkey_lease_timeout = 0;
 425
 426         return ret;
 427 }
 428
 429 static int subn_get_portinfo(struct ib_smp *smp, struct ib_device *ibdev,
 430                              u8 port)
 431 {
 432         struct qib_devdata *dd;
 433         struct qib_pportdata *ppd;
 434         struct qib_ibport *ibp;
 435         struct ib_port_info *pip = (struct ib_port_info *)smp->data;
 436         u16 lid;
 437         u8 mtu;
 438         int ret;
 439         u32 state;
 440         u32 port_num = be32_to_cpu(smp->attr_mod);
 441
 442         if (port_num == 0)
 443                 port_num = port;
 444         else {
 445                 if (port_num > ibdev->phys_port_cnt) {
 446                         smp->status |= IB_SMP_INVALID_FIELD;
 447                         ret = reply(smp);
 448                         goto bail;
 449                 }
 450                 if (port_num != port) {
 451                         ibp = to_iport(ibdev, port_num);
 452                         ret = check_mkey(ibp, smp, 0);
 453                         if (ret)
 454                                 goto bail;
 455                 }
 456         }
 457
 458         dd = dd_from_ibdev(ibdev);
 459         /* IB numbers ports from 1, hdw from 0 */
 460         ppd = dd->pport + (port_num - 1);
 461         ibp = &ppd->ibport_data;
 462
 463         /* Clear all fields.  Only set the non-zero fields. */
 464         memset(smp->data, 0, sizeof(smp->data));
 465
 466         /* Only return the mkey if the protection field allows it. */
 467         if (!(smp->method == IB_MGMT_METHOD_GET &&
 468               ibp->mkey != smp->mkey &&
 469               ibp->mkeyprot == 1))
 470                 pip->mkey = ibp->mkey;
 471         pip->gid_prefix = ibp->gid_prefix;
 472         lid = ppd->lid;
 473         pip->lid = lid ? cpu_to_be16(lid) : IB_LID_PERMISSIVE;
 474         pip->sm_lid = cpu_to_be16(ibp->sm_lid);
 475         pip->cap_mask = cpu_to_be32(ibp->port_cap_flags);
 476         /* pip->diag_code; */
 477         pip->mkey_lease_period = cpu_to_be16(ibp->mkey_lease_period);
 478         pip->local_port_num = port;
 479         pip->link_width_enabled = ppd->link_width_enabled;
 480         pip->link_width_supported = ppd->link_width_supported;
 481         pip->link_width_active = ppd->link_width_active;
 482         state = dd->f_iblink_state(ppd->lastibcstat);
 483         pip->linkspeed_portstate = ppd->link_speed_supported << 4 | state;
 484
 485         pip->portphysstate_linkdown =
 486                 (dd->f_ibphys_portstate(ppd->lastibcstat) << 4) |
 487                 (get_linkdowndefaultstate(ppd) ? 1 : 2);
 488         pip->mkeyprot_resv_lmc = (ibp->mkeyprot << 6) | ppd->lmc;
 489         pip->linkspeedactive_enabled = (ppd->link_speed_active << 4) |
 490                 ppd->link_speed_enabled;
 491         switch (ppd->ibmtu) {
 492         default: /* something is wrong; fall through */
 493         case 4096:
 494                 mtu = IB_MTU_4096;
 495                 break;
 496         case 2048:
 497                 mtu = IB_MTU_2048;
 498                 break;
 499         case 1024:
 500                 mtu = IB_MTU_1024;
 501                 break;
 502         case 512:
 503                 mtu = IB_MTU_512;
 504                 break;
 505         case 256:
 506                 mtu = IB_MTU_256;
 507                 break;
 508         }
 509         pip->neighbormtu_mastersmsl = (mtu << 4) | ibp->sm_sl;
 510         pip->vlcap_inittype = ppd->vls_supported << 4;  /* InitType = 0 */
 511         pip->vl_high_limit = ibp->vl_high_limit;
 512         pip->vl_arb_high_cap =
 513                 dd->f_get_ib_cfg(ppd, QIB_IB_CFG_VL_HIGH_CAP);
 514         pip->vl_arb_low_cap =
 515                 dd->f_get_ib_cfg(ppd, QIB_IB_CFG_VL_LOW_CAP);
 516         /* InitTypeReply = 0 */
 517         pip->inittypereply_mtucap = qib_ibmtu ? qib_ibmtu : IB_MTU_4096;
 518         /* HCAs ignore VLStallCount and HOQLife */
 519         /* pip->vlstallcnt_hoqlife; */
 520         pip->operationalvl_pei_peo_fpi_fpo =
 521                 dd->f_get_ib_cfg(ppd, QIB_IB_CFG_OP_VLS) << 4;
 522         pip->mkey_violations = cpu_to_be16(ibp->mkey_violations);
 523         /* P_KeyViolations are counted by hardware. */
 524         pip->pkey_violations = cpu_to_be16(ibp->pkey_violations);
 525         pip->qkey_violations = cpu_to_be16(ibp->qkey_violations);
 526         /* Only the hardware GUID is supported for now */
 527         pip->guid_cap = QIB_GUIDS_PER_PORT;
 528         pip->clientrereg_resv_subnetto = ibp->subnet_timeout;
 529         /* 32.768 usec. response time (guessing) */
 530         pip->resv_resptimevalue = 3;
 531         pip->localphyerrors_overrunerrors =
 532                 (get_phyerrthreshold(ppd) << 4) |
 533                 get_overrunthreshold(ppd);
 534         /* pip->max_credit_hint; */
 535         if (ibp->port_cap_flags & IB_PORT_LINK_LATENCY_SUP) {
 536                 u32 v;
 537
 538                 v = dd->f_get_ib_cfg(ppd, QIB_IB_CFG_LINKLATENCY);
 539                 pip->link_roundtrip_latency[0] = v >> 16;
 540                 pip->link_roundtrip_latency[1] = v >> 8;
 541                 pip->link_roundtrip_latency[2] = v;
 542         }
 543
 544         ret = reply(smp);
 545
 546 bail:
 547         return ret;
 548 }
 549
 550 /**
 551  * get_pkeys - return the PKEY table
 552  * @dd: the qlogic_ib device
 553  * @port: the IB port number
 554  * @pkeys: the pkey table is placed here
 555  */
 556 static int get_pkeys(struct qib_devdata *dd, u8 port, u16 *pkeys)
 557 {
 558         struct qib_pportdata *ppd = dd->pport + port - 1;
 559         /*
 560          * always a kernel context, no locking needed.
 561          * If we get here with ppd setup, no need to check
 562          * that pd is valid.
 563          */
 564         struct qib_ctxtdata *rcd = dd->rcd[ppd->hw_pidx];
 565
 566         memcpy(pkeys, rcd->pkeys, sizeof(rcd->pkeys));
 567
 568         return 0;
 569 }
 570
 571 static int subn_get_pkeytable(struct ib_smp *smp, struct ib_device *ibdev,
 572                               u8 port)
 573 {
 574         u32 startpx = 32 * (be32_to_cpu(smp->attr_mod) & 0xffff);
 575         u16 *p = (u16 *) smp->data;
 576         __be16 *q = (__be16 *) smp->data;
 577
 578         /* 64 blocks of 32 16-bit P_Key entries */
 579
 580         memset(smp->data, 0, sizeof(smp->data));
 581         if (startpx == 0) {
 582                 struct qib_devdata *dd = dd_from_ibdev(ibdev);
 583                 unsigned i, n = qib_get_npkeys(dd);
 584
 585                 get_pkeys(dd, port, p);
 586
 587                 for (i = 0; i < n; i++)
 588                         q[i] = cpu_to_be16(p[i]);
 589         } else
 590                 smp->status |= IB_SMP_INVALID_FIELD;
 591
 592         return reply(smp);
 593 }
 594
 595 static int subn_set_guidinfo(struct ib_smp *smp, struct ib_device *ibdev,
 596                              u8 port)
 597 {
 598         struct qib_devdata *dd = dd_from_ibdev(ibdev);
 599         u32 startgx = 8 * be32_to_cpu(smp->attr_mod);
 600         __be64 *p = (__be64 *) smp->data;
 601         unsigned pidx = port - 1; /* IB number port from 1, hdw from 0 */
 602
 603         /* 32 blocks of 8 64-bit GUIDs per block */
 604
 605         if (startgx == 0 && pidx < dd->num_pports) {
 606                 struct qib_pportdata *ppd = dd->pport + pidx;
 607                 struct qib_ibport *ibp = &ppd->ibport_data;
 608                 unsigned i;
 609
 610                 /* The first entry is read-only. */
 611                 for (i = 1; i < QIB_GUIDS_PER_PORT; i++)
 612                         ibp->guids[i - 1] = p[i];
 613         } else
 614                 smp->status |= IB_SMP_INVALID_FIELD;
 615
 616         /* The only GUID we support is the first read-only entry. */
 617         return subn_get_guidinfo(smp, ibdev, port);
 618 }
 619
 620 /**
 621  * subn_set_portinfo - set port information
 622  * @smp: the incoming SM packet
 623  * @ibdev: the infiniband device
 624  * @port: the port on the device
 625  *
 626  * Set Portinfo (see ch. 14.2.5.6).
 627  */
 628 static int subn_set_portinfo(struct ib_smp *smp, struct ib_device *ibdev,
 629                              u8 port)
 630 {
 631         struct ib_port_info *pip = (struct ib_port_info *)smp->data;
 632         struct ib_event event;
 633         struct qib_devdata *dd;
 634         struct qib_pportdata *ppd;
 635         struct qib_ibport *ibp;
 636         char clientrereg = 0;
 637         unsigned long flags;
 638         u16 lid, smlid;
 639         u8 lwe;
 640         u8 lse;
 641         u8 state;
 642         u8 vls;
 643         u8 msl;
 644         u16 lstate;
 645         int ret, ore, mtu;
 646         u32 port_num = be32_to_cpu(smp->attr_mod);
 647
 648         if (port_num == 0)
 649                 port_num = port;
 650         else {
 651                 if (port_num > ibdev->phys_port_cnt)
 652                         goto err;
 653                 /* Port attributes can only be set on the receiving port */
 654                 if (port_num != port)
 655                         goto get_only;
 656         }
 657
 658         dd = dd_from_ibdev(ibdev);
 659         /* IB numbers ports from 1, hdw from 0 */
 660         ppd = dd->pport + (port_num - 1);
 661         ibp = &ppd->ibport_data;
 662         event.device = ibdev;
 663         event.element.port_num = port;
 664
 665         ibp->mkey = pip->mkey;
 666         ibp->gid_prefix = pip->gid_prefix;
 667         ibp->mkey_lease_period = be16_to_cpu(pip->mkey_lease_period);
 668
 669         lid = be16_to_cpu(pip->lid);
 670         /* Must be a valid unicast LID address. */
 671         if (lid == 0 || lid >= QIB_MULTICAST_LID_BASE)
 672                 smp->status |= IB_SMP_INVALID_FIELD;
 673         else if (ppd->lid != lid || ppd->lmc != (pip->mkeyprot_resv_lmc & 7)) {
 674                 if (ppd->lid != lid)
 675                         qib_set_uevent_bits(ppd, _QIB_EVENT_LID_CHANGE_BIT);
 676                 if (ppd->lmc != (pip->mkeyprot_resv_lmc & 7))
 677                         qib_set_uevent_bits(ppd, _QIB_EVENT_LMC_CHANGE_BIT);
 678                 qib_set_lid(ppd, lid, pip->mkeyprot_resv_lmc & 7);
 679                 event.event = IB_EVENT_LID_CHANGE;
 680                 ib_dispatch_event(&event);
 681         }
 682
 683         smlid = be16_to_cpu(pip->sm_lid);
 684         msl = pip->neighbormtu_mastersmsl & 0xF;
 685         /* Must be a valid unicast LID address. */
 686         if (smlid == 0 || smlid >= QIB_MULTICAST_LID_BASE)
 687                 smp->status |= IB_SMP_INVALID_FIELD;
 688         else if (smlid != ibp->sm_lid || msl != ibp->sm_sl) {
 689                 spin_lock_irqsave(&ibp->lock, flags);
 690                 if (ibp->sm_ah) {
 691                         if (smlid != ibp->sm_lid)
 692                                 ibp->sm_ah->attr.dlid = smlid;
 693                         if (msl != ibp->sm_sl)
 694                                 ibp->sm_ah->attr.sl = msl;
 695                 }
 696                 spin_unlock_irqrestore(&ibp->lock, flags);
 697                 if (smlid != ibp->sm_lid)
 698                         ibp->sm_lid = smlid;
 699                 if (msl != ibp->sm_sl)
 700                         ibp->sm_sl = msl;
 701                 event.event = IB_EVENT_SM_CHANGE;
 702                 ib_dispatch_event(&event);
 703         }
 704
 705         /* Allow 1x or 4x to be set (see 14.2.6.6). */
 706         lwe = pip->link_width_enabled;
 707         if (lwe) {
 708                 if (lwe == 0xFF)
 709                         set_link_width_enabled(ppd, ppd->link_width_supported);
 710                 else if (lwe >= 16 || (lwe & ~ppd->link_width_supported))
 711                         smp->status |= IB_SMP_INVALID_FIELD;
 712                 else if (lwe != ppd->link_width_enabled)
 713                         set_link_width_enabled(ppd, lwe);
 714         }
 715
 716         lse = pip->linkspeedactive_enabled & 0xF;
 717         if (lse) {
 718                 /*
 719                  * The IB 1.2 spec. only allows link speed values
 720                  * 1, 3, 5, 7, 15.  1.2.1 extended to allow specific
 721                  * speeds.
 722                  */
 723                 if (lse == 15)
 724                         set_link_speed_enabled(ppd,
 725                                                ppd->link_speed_supported);
 726                 else if (lse >= 8 || (lse & ~ppd->link_speed_supported))
 727                         smp->status |= IB_SMP_INVALID_FIELD;
 728                 else if (lse != ppd->link_speed_enabled)
 729                         set_link_speed_enabled(ppd, lse);
 730         }
 731
 732         /* Set link down default state. */
 733         switch (pip->portphysstate_linkdown & 0xF) {
 734         case 0: /* NOP */
 735                 break;
 736         case 1: /* SLEEP */
 737                 (void) dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LINKDEFAULT,
 738                                         IB_LINKINITCMD_SLEEP);
 739                 break;
 740         case 2: /* POLL */
 741                 (void) dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LINKDEFAULT,
 742                                         IB_LINKINITCMD_POLL);
 743                 break;
 744         default:
 745                 smp->status |= IB_SMP_INVALID_FIELD;
 746         }
 747
 748         ibp->mkeyprot = pip->mkeyprot_resv_lmc >> 6;
 749         ibp->vl_high_limit = pip->vl_high_limit;
 750         (void) dd->f_set_ib_cfg(ppd, QIB_IB_CFG_VL_HIGH_LIMIT,
 751                                     ibp->vl_high_limit);
 752
 753         mtu = ib_mtu_enum_to_int((pip->neighbormtu_mastersmsl >> 4) & 0xF);
 754         if (mtu == -1)
 755                 smp->status |= IB_SMP_INVALID_FIELD;
 756         else
 757                 qib_set_mtu(ppd, mtu);
 758
 759         /* Set operational VLs */
 760         vls = (pip->operationalvl_pei_peo_fpi_fpo >> 4) & 0xF;
 761         if (vls) {
 762                 if (vls > ppd->vls_supported)
 763                         smp->status |= IB_SMP_INVALID_FIELD;
 764                 else
 765                         (void) dd->f_set_ib_cfg(ppd, QIB_IB_CFG_OP_VLS, vls);
 766         }
 767
 768         if (pip->mkey_violations == 0)
 769                 ibp->mkey_violations = 0;
 770
 771         if (pip->pkey_violations == 0)
 772                 ibp->pkey_violations = 0;
 773
 774         if (pip->qkey_violations == 0)
 775                 ibp->qkey_violations = 0;
 776
 777         ore = pip->localphyerrors_overrunerrors;
 778         if (set_phyerrthreshold(ppd, (ore >> 4) & 0xF))
 779                 smp->status |= IB_SMP_INVALID_FIELD;
 780
 781         if (set_overrunthreshold(ppd, (ore & 0xF)))
 782                 smp->status |= IB_SMP_INVALID_FIELD;
 783
 784         ibp->subnet_timeout = pip->clientrereg_resv_subnetto & 0x1F;
 785
 786         if (pip->clientrereg_resv_subnetto & 0x80) {
 787                 clientrereg = 1;
 788                 event.event = IB_EVENT_CLIENT_REREGISTER;
 789                 ib_dispatch_event(&event);
 790         }
 791
 792         /*
 793          * Do the port state change now that the other link parameters
 794          * have been set.
 795          * Changing the port physical state only makes sense if the link
 796          * is down or is being set to down.
 797          */
 798         state = pip->linkspeed_portstate & 0xF;
 799         lstate = (pip->portphysstate_linkdown >> 4) & 0xF;
 800         if (lstate && !(state == IB_PORT_DOWN || state == IB_PORT_NOP))
 801                 smp->status |= IB_SMP_INVALID_FIELD;
 802
 803         /*
 804          * Only state changes of DOWN, ARM, and ACTIVE are valid
 805          * and must be in the correct state to take effect (see 7.2.6).
 806          */
 807         switch (state) {
 808         case IB_PORT_NOP:
 809                 if (lstate == 0)
 810                         break;
 811                 /* FALLTHROUGH */
 812         case IB_PORT_DOWN:
 813                 if (lstate == 0)
 814                         lstate = QIB_IB_LINKDOWN_ONLY;
 815                 else if (lstate == 1)
 816                         lstate = QIB_IB_LINKDOWN_SLEEP;
 817                 else if (lstate == 2)
 818                         lstate = QIB_IB_LINKDOWN;
 819                 else if (lstate == 3)
 820                         lstate = QIB_IB_LINKDOWN_DISABLE;
 821                 else {
 822                         smp->status |= IB_SMP_INVALID_FIELD;
 823                         break;
 824                 }
 825                 spin_lock_irqsave(&ppd->lflags_lock, flags);
 826                 ppd->lflags &= ~QIBL_LINKV;
 827                 spin_unlock_irqrestore(&ppd->lflags_lock, flags);
 828                 qib_set_linkstate(ppd, lstate);
 829                 /*
 830                  * Don't send a reply if the response would be sent
 831                  * through the disabled port.
 832                  */
 833                 if (lstate == QIB_IB_LINKDOWN_DISABLE && smp->hop_cnt) {
 834                         ret = IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_CONSUMED;
 835                         goto done;
 836                 }
 837                 qib_wait_linkstate(ppd, QIBL_LINKV, 10);
 838                 break;
 839         case IB_PORT_ARMED:
 840                 qib_set_linkstate(ppd, QIB_IB_LINKARM);
 841                 break;
 842         case IB_PORT_ACTIVE:
 843                 qib_set_linkstate(ppd, QIB_IB_LINKACTIVE);
 844                 break;
 845         default:
 846                 smp->status |= IB_SMP_INVALID_FIELD;
 847         }
 848
 849         ret = subn_get_portinfo(smp, ibdev, port);
 850
 851         if (clientrereg)
 852                 pip->clientrereg_resv_subnetto |= 0x80;
 853
 854         goto get_only;
 855
 856 err:
 857         smp->status |= IB_SMP_INVALID_FIELD;
 858 get_only:
 859         ret = subn_get_portinfo(smp, ibdev, port);
 860 done:
 861         return ret;
 862 }
 863
 864 /**
 865  * rm_pkey - decrecment the reference count for the given PKEY
 866  * @dd: the qlogic_ib device
 867  * @key: the PKEY index
 868  *
 869  * Return true if this was the last reference and the hardware table entry
 870  * needs to be changed.
 871  */
 872 static int rm_pkey(struct qib_pportdata *ppd, u16 key)
 873 {
 874         int i;
 875         int ret;
 876
 877         for (i = 0; i < ARRAY_SIZE(ppd->pkeys); i++) {
 878                 if (ppd->pkeys[i] != key)
 879                         continue;
 880                 if (atomic_dec_and_test(&ppd->pkeyrefs[i])) {
 881                         ppd->pkeys[i] = 0;
 882                         ret = 1;
 883                         goto bail;
 884                 }
 885                 break;
 886         }
 887
 888         ret = 0;
 889
 890 bail:
 891         return ret;
 892 }
 893
 894 /**
 895  * add_pkey - add the given PKEY to the hardware table
 896  * @dd: the qlogic_ib device
 897  * @key: the PKEY
 898  *
 899  * Return an error code if unable to add the entry, zero if no change,
 900  * or 1 if the hardware PKEY register needs to be updated.
 901  */
 902 static int add_pkey(struct qib_pportdata *ppd, u16 key)
 903 {
 904         int i;
 905         u16 lkey = key & 0x7FFF;
 906         int any = 0;
 907         int ret;
 908
 909         if (lkey == 0x7FFF) {
 910                 ret = 0;
 911                 goto bail;
 912         }
 913
 914         /* Look for an empty slot or a matching PKEY. */
 915         for (i = 0; i < ARRAY_SIZE(ppd->pkeys); i++) {
 916                 if (!ppd->pkeys[i]) {
 917                         any++;
 918                         continue;
 919                 }
 920                 /* If it matches exactly, try to increment the ref count */
 921                 if (ppd->pkeys[i] == key) {
 922                         if (atomic_inc_return(&ppd->pkeyrefs[i]) > 1) {
 923                                 ret = 0;
 924                                 goto bail;
 925                         }
 926                         /* Lost the race. Look for an empty slot below. */
 927                         atomic_dec(&ppd->pkeyrefs[i]);
 928                         any++;
 929                 }
 930                 /*
 931                  * It makes no sense to have both the limited and unlimited
 932                  * PKEY set at the same time since the unlimited one will
 933                  * disable the limited one.
 934                  */
 935                 if ((ppd->pkeys[i] & 0x7FFF) == lkey) {
 936                         ret = -EEXIST;
 937                         goto bail;
 938                 }
 939         }
 940         if (!any) {
 941                 ret = -EBUSY;
 942                 goto bail;
 943         }
 944         for (i = 0; i < ARRAY_SIZE(ppd->pkeys); i++) {
 945                 if (!ppd->pkeys[i] &&
 946                     atomic_inc_return(&ppd->pkeyrefs[i]) == 1) {
 947                         /* for qibstats, etc. */
 948                         ppd->pkeys[i] = key;
 949                         ret = 1;
 950                         goto bail;
 951                 }
 952         }
 953         ret = -EBUSY;
 954
 955 bail:
 956         return ret;
 957 }
 958
 959 /**
 960  * set_pkeys - set the PKEY table for ctxt 0
 961  * @dd: the qlogic_ib device
 962  * @port: the IB port number
 963  * @pkeys: the PKEY table
 964  */
 965 static int set_pkeys(struct qib_devdata *dd, u8 port, u16 *pkeys)
 966 {
 967         struct qib_pportdata *ppd;
 968         struct qib_ctxtdata *rcd;
 969         int i;
 970         int changed = 0;
 971
 972         /*
 973          * IB port one/two always maps to context zero/one,
 974          * always a kernel context, no locking needed
 975          * If we get here with ppd setup, no need to check
 976          * that rcd is valid.
 977          */
 978         ppd = dd->pport + (port - 1);
 979         rcd = dd->rcd[ppd->hw_pidx];
 980
 981         for (i = 0; i < ARRAY_SIZE(rcd->pkeys); i++) {
 982                 u16 key = pkeys[i];
 983                 u16 okey = rcd->pkeys[i];
 984
 985                 if (key == okey)
 986                         continue;
 987                 /*
 988                  * The value of this PKEY table entry is changing.
 989                  * Remove the old entry in the hardware's array of PKEYs.
 990                  */
 991                 if (okey & 0x7FFF)
 992                         changed |= rm_pkey(ppd, okey);
 993                 if (key & 0x7FFF) {
 994                         int ret = add_pkey(ppd, key);
 995
 996                         if (ret < 0)
 997                                 key = 0;
 998                         else
 999                                 changed |= ret;
1000                 }
1001                 rcd->pkeys[i] = key;
1002         }
1003         if (changed) {
1004                 struct ib_event event;
1005
1006                 (void) dd->f_set_ib_cfg(ppd, QIB_IB_CFG_PKEYS, 0);
1007
1008                 event.event = IB_EVENT_PKEY_CHANGE;
1009                 event.device = &dd->verbs_dev.ibdev;
1010                 event.element.port_num = 1;
1011                 ib_dispatch_event(&event);
1012         }
1013         return 0;
1014 }
1015
1016 static int subn_set_pkeytable(struct ib_smp *smp, struct ib_device *ibdev,
1017                               u8 port)
1018 {
1019         u32 startpx = 32 * (be32_to_cpu(smp->attr_mod) & 0xffff);
1020         __be16 *p = (__be16 *) smp->data;
1021         u16 *q = (u16 *) smp->data;
1022         struct qib_devdata *dd = dd_from_ibdev(ibdev);
1023         unsigned i, n = qib_get_npkeys(dd);
1024
1025         for (i = 0; i < n; i++)
1026                 q[i] = be16_to_cpu(p[i]);
1027
1028         if (startpx != 0 || set_pkeys(dd, port, q) != 0)
1029                 smp->status |= IB_SMP_INVALID_FIELD;
1030
1031         return subn_get_pkeytable(smp, ibdev, port);
1032 }
1033
1034 static int subn_get_sl_to_vl(struct ib_smp *smp, struct ib_device *ibdev,
1035                              u8 port)
1036 {
1037         struct qib_ibport *ibp = to_iport(ibdev, port);
1038         u8 *p = (u8 *) smp->data;
1039         unsigned i;
1040
1041         memset(smp->data, 0, sizeof(smp->data));
1042
1043         if (!(ibp->port_cap_flags & IB_PORT_SL_MAP_SUP))
1044                 smp->status |= IB_SMP_UNSUP_METHOD;
1045         else
1046                 for (i = 0; i < ARRAY_SIZE(ibp->sl_to_vl); i += 2)
1047                         *p++ = (ibp->sl_to_vl[i] << 4) | ibp->sl_to_vl[i + 1];
1048
1049         return reply(smp);
1050 }
1051
1052 static int subn_set_sl_to_vl(struct ib_smp *smp, struct ib_device *ibdev,
1053                              u8 port)
1054 {
1055         struct qib_ibport *ibp = to_iport(ibdev, port);
1056         u8 *p = (u8 *) smp->data;
1057         unsigned i;
1058
1059         if (!(ibp->port_cap_flags & IB_PORT_SL_MAP_SUP)) {
1060                 smp->status |= IB_SMP_UNSUP_METHOD;
1061                 return reply(smp);
1062         }
1063
1064         for (i = 0; i < ARRAY_SIZE(ibp->sl_to_vl); i += 2, p++) {
1065                 ibp->sl_to_vl[i] = *p >> 4;
1066                 ibp->sl_to_vl[i + 1] = *p & 0xF;
1067         }
1068         qib_set_uevent_bits(ppd_from_ibp(to_iport(ibdev, port)),
1069                             _QIB_EVENT_SL2VL_CHANGE_BIT);
1070
1071         return subn_get_sl_to_vl(smp, ibdev, port);
1072 }
1073
1074 static int subn_get_vl_arb(struct ib_smp *smp, struct ib_device *ibdev,
1075                            u8 port)
1076 {
1077         unsigned which = be32_to_cpu(smp->attr_mod) >> 16;
1078         struct qib_pportdata *ppd = ppd_from_ibp(to_iport(ibdev, port));
1079
1080         memset(smp->data, 0, sizeof(smp->data));
1081
1082         if (ppd->vls_supported == IB_VL_VL0)
1083                 smp->status |= IB_SMP_UNSUP_METHOD;
1084         else if (which == IB_VLARB_LOWPRI_0_31)
1085                 (void) ppd->dd->f_get_ib_table(ppd, QIB_IB_TBL_VL_LOW_ARB,
1086                                                    smp->data);
1087         else if (which == IB_VLARB_HIGHPRI_0_31)
1088                 (void) ppd->dd->f_get_ib_table(ppd, QIB_IB_TBL_VL_HIGH_ARB,
1089                                                    smp->data);
1090         else
1091                 smp->status |= IB_SMP_INVALID_FIELD;
1092
1093         return reply(smp);
1094 }
1095
1096 static int subn_set_vl_arb(struct ib_smp *smp, struct ib_device *ibdev,
1097                            u8 port)
1098 {
1099         unsigned which = be32_to_cpu(smp->attr_mod) >> 16;
1100         struct qib_pportdata *ppd = ppd_from_ibp(to_iport(ibdev, port));
1101
1102         if (ppd->vls_supported == IB_VL_VL0)
1103                 smp->status |= IB_SMP_UNSUP_METHOD;
1104         else if (which == IB_VLARB_LOWPRI_0_31)
1105                 (void) ppd->dd->f_set_ib_table(ppd, QIB_IB_TBL_VL_LOW_ARB,
1106                                                    smp->data);
1107         else if (which == IB_VLARB_HIGHPRI_0_31)
1108                 (void) ppd->dd->f_set_ib_table(ppd, QIB_IB_TBL_VL_HIGH_ARB,
1109                                                    smp->data);
1110         else
1111                 smp->status |= IB_SMP_INVALID_FIELD;
1112
1113         return subn_get_vl_arb(smp, ibdev, port);
1114 }
1115
1116 static int subn_trap_repress(struct ib_smp *smp, struct ib_device *ibdev,
1117                              u8 port)
1118 {
1119         /*
1120          * For now, we only send the trap once so no need to process this.
1121          * o13-6, o13-7,
1122          * o14-3.a4 The SMA shall not send any message in response to a valid
1123          * SubnTrapRepress() message.
1124          */
1125         return IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_CONSUMED;
1126 }
1127
1128 static int pma_get_classportinfo(struct ib_pma_mad *pmp,
1129                                  struct ib_device *ibdev)
1130 {
1131         struct ib_class_port_info *p =
1132                 (struct ib_class_port_info *)pmp->data;
1133         struct qib_devdata *dd = dd_from_ibdev(ibdev);
1134
1135         memset(pmp->data, 0, sizeof(pmp->data));
1136
1137         if (pmp->mad_hdr.attr_mod != 0)
1138                 pmp->mad_hdr.status |= IB_SMP_INVALID_FIELD;
1139
1140         /* Note that AllPortSelect is not valid */
1141         p->base_version = 1;
1142         p->class_version = 1;
1143         p->capability_mask = IB_PMA_CLASS_CAP_EXT_WIDTH;
1144         /*
1145          * Set the most significant bit of CM2 to indicate support for
1146          * congestion statistics
1147          */
1148         p->reserved[0] = dd->psxmitwait_supported << 7;
1149         /*
1150          * Expected response time is 4.096 usec. * 2^18 == 1.073741824 sec.
1151          */
1152         p->resp_time_value = 18;
1153
1154         return reply((struct ib_smp *) pmp);
1155 }
1156
1157 static int pma_get_portsamplescontrol(struct ib_pma_mad *pmp,
1158                                       struct ib_device *ibdev, u8 port)
1159 {
1160         struct ib_pma_portsamplescontrol *p =
1161                 (struct ib_pma_portsamplescontrol *)pmp->data;
1162         struct qib_ibdev *dev = to_idev(ibdev);
1163         struct qib_devdata *dd = dd_from_dev(dev);
1164         struct qib_ibport *ibp = to_iport(ibdev, port);
1165         struct qib_pportdata *ppd = ppd_from_ibp(ibp);
1166         unsigned long flags;
1167         u8 port_select = p->port_select;
1168
1169         memset(pmp->data, 0, sizeof(pmp->data));
1170
1171         p->port_select = port_select;
1172         if (pmp->mad_hdr.attr_mod != 0 || port_select != port) {
1173                 pmp->mad_hdr.status |= IB_SMP_INVALID_FIELD;
1174                 goto bail;
1175         }
1176         spin_lock_irqsave(&ibp->lock, flags);
1177         p->tick = dd->f_get_ib_cfg(ppd, QIB_IB_CFG_PMA_TICKS);
1178         p->sample_status = dd->f_portcntr(ppd, QIBPORTCNTR_PSSTAT);
1179         p->counter_width = 4;   /* 32 bit counters */
1180         p->counter_mask0_9 = COUNTER_MASK0_9;
1181         p->sample_start = cpu_to_be32(ibp->pma_sample_start);
1182         p->sample_interval = cpu_to_be32(ibp->pma_sample_interval);
1183         p->tag = cpu_to_be16(ibp->pma_tag);
1184         p->counter_select[0] = ibp->pma_counter_select[0];
1185         p->counter_select[1] = ibp->pma_counter_select[1];
1186         p->counter_select[2] = ibp->pma_counter_select[2];
1187         p->counter_select[3] = ibp->pma_counter_select[3];
1188         p->counter_select[4] = ibp->pma_counter_select[4];
1189         spin_unlock_irqrestore(&ibp->lock, flags);
1190
1191 bail:
1192         return reply((struct ib_smp *) pmp);
1193 }
1194
1195 static int pma_set_portsamplescontrol(struct ib_pma_mad *pmp,
1196                                       struct ib_device *ibdev, u8 port)
1197 {
1198         struct ib_pma_portsamplescontrol *p =
1199                 (struct ib_pma_portsamplescontrol *)pmp->data;
1200         struct qib_ibdev *dev = to_idev(ibdev);
1201         struct qib_devdata *dd = dd_from_dev(dev);
1202         struct qib_ibport *ibp = to_iport(ibdev, port);
1203         struct qib_pportdata *ppd = ppd_from_ibp(ibp);
1204         unsigned long flags;
1205         u8 status, xmit_flags;
1206         int ret;
1207
1208         if (pmp->mad_hdr.attr_mod != 0 || p->port_select != port) {
1209                 pmp->mad_hdr.status |= IB_SMP_INVALID_FIELD;
1210                 ret = reply((struct ib_smp *) pmp);
1211                 goto bail;
1212         }
1213
1214         spin_lock_irqsave(&ibp->lock, flags);
1215
1216         /* Port Sampling code owns the PS* HW counters */
1217         xmit_flags = ppd->cong_stats.flags;
1218         ppd->cong_stats.flags = IB_PMA_CONG_HW_CONTROL_SAMPLE;
1219         status = dd->f_portcntr(ppd, QIBPORTCNTR_PSSTAT);
1220         if (status == IB_PMA_SAMPLE_STATUS_DONE ||
1221             (status == IB_PMA_SAMPLE_STATUS_RUNNING &&
1222              xmit_flags == IB_PMA_CONG_HW_CONTROL_TIMER)) {
1223                 ibp->pma_sample_start = be32_to_cpu(p->sample_start);
1224                 ibp->pma_sample_interval = be32_to_cpu(p->sample_interval);
1225                 ibp->pma_tag = be16_to_cpu(p->tag);
1226                 ibp->pma_counter_select[0] = p->counter_select[0];
1227                 ibp->pma_counter_select[1] = p->counter_select[1];
1228                 ibp->pma_counter_select[2] = p->counter_select[2];
1229                 ibp->pma_counter_select[3] = p->counter_select[3];
1230                 ibp->pma_counter_select[4] = p->counter_select[4];
1231                 dd->f_set_cntr_sample(ppd, ibp->pma_sample_interval,
1232                                       ibp->pma_sample_start);
1233         }
1234         spin_unlock_irqrestore(&ibp->lock, flags);
1235
1236         ret = pma_get_portsamplescontrol(pmp, ibdev, port);
1237
1238 bail:
1239         return ret;
1240 }
1241
1242 static u64 get_counter(struct qib_ibport *ibp, struct qib_pportdata *ppd,
1243                        __be16 sel)
1244 {
1245         u64 ret;
1246
1247         switch (sel) {
1248         case IB_PMA_PORT_XMIT_DATA:
1249                 ret = ppd->dd->f_portcntr(ppd, QIBPORTCNTR_PSXMITDATA);
1250                 break;
1251         case IB_PMA_PORT_RCV_DATA:
1252                 ret = ppd->dd->f_portcntr(ppd, QIBPORTCNTR_PSRCVDATA);
1253                 break;
1254         case IB_PMA_PORT_XMIT_PKTS:
1255                 ret = ppd->dd->f_portcntr(ppd, QIBPORTCNTR_PSXMITPKTS);
1256                 break;
1257         case IB_PMA_PORT_RCV_PKTS:
1258                 ret = ppd->dd->f_portcntr(ppd, QIBPORTCNTR_PSRCVPKTS);
1259                 break;
1260         case IB_PMA_PORT_XMIT_WAIT:
1261                 ret = ppd->dd->f_portcntr(ppd, QIBPORTCNTR_PSXMITWAIT);
1262                 break;
1263         default:
1264                 ret = 0;
1265         }
1266
1267         return ret;
1268 }
1269
1270 /* This function assumes that the xmit_wait lock is already held */
1271 static u64 xmit_wait_get_value_delta(struct qib_pportdata *ppd)
1272 {
1273         u32 delta;
1274
1275         delta = get_counter(&ppd->ibport_data, ppd,
1276                             IB_PMA_PORT_XMIT_WAIT);
1277         return ppd->cong_stats.counter + delta;
1278 }
1279
1280 static void cache_hw_sample_counters(struct qib_pportdata *ppd)
1281 {
1282         struct qib_ibport *ibp = &ppd->ibport_data;
1283
1284         ppd->cong_stats.counter_cache.psxmitdata =
1285                 get_counter(ibp, ppd, IB_PMA_PORT_XMIT_DATA);
1286         ppd->cong_stats.counter_cache.psrcvdata =
1287                 get_counter(ibp, ppd, IB_PMA_PORT_RCV_DATA);
1288         ppd->cong_stats.counter_cache.psxmitpkts =
1289                 get_counter(ibp, ppd, IB_PMA_PORT_XMIT_PKTS);
1290         ppd->cong_stats.counter_cache.psrcvpkts =
1291                 get_counter(ibp, ppd, IB_PMA_PORT_RCV_PKTS);
1292         ppd->cong_stats.counter_cache.psxmitwait =
1293                 get_counter(ibp, ppd, IB_PMA_PORT_XMIT_WAIT);
1294 }
1295
1296 static u64 get_cache_hw_sample_counters(struct qib_pportdata *ppd,
1297                                         __be16 sel)
1298 {
1299         u64 ret;
1300
1301         switch (sel) {
1302         case IB_PMA_PORT_XMIT_DATA:
1303                 ret = ppd->cong_stats.counter_cache.psxmitdata;
1304                 break;
1305         case IB_PMA_PORT_RCV_DATA:
1306                 ret = ppd->cong_stats.counter_cache.psrcvdata;
1307                 break;
1308         case IB_PMA_PORT_XMIT_PKTS:
1309                 ret = ppd->cong_stats.counter_cache.psxmitpkts;
1310                 break;
1311         case IB_PMA_PORT_RCV_PKTS:
1312                 ret = ppd->cong_stats.counter_cache.psrcvpkts;
1313                 break;
1314         case IB_PMA_PORT_XMIT_WAIT:
1315                 ret = ppd->cong_stats.counter_cache.psxmitwait;
1316                 break;
1317         default:
1318                 ret = 0;
1319         }
1320
1321         return ret;
1322 }
1323
1324 static int pma_get_portsamplesresult(struct ib_pma_mad *pmp,
1325                                      struct ib_device *ibdev, u8 port)
1326 {
1327         struct ib_pma_portsamplesresult *p =
1328                 (struct ib_pma_portsamplesresult *)pmp->data;
1329         struct qib_ibdev *dev = to_idev(ibdev);
1330         struct qib_devdata *dd = dd_from_dev(dev);
1331         struct qib_ibport *ibp = to_iport(ibdev, port);
1332         struct qib_pportdata *ppd = ppd_from_ibp(ibp);
1333         unsigned long flags;
1334         u8 status;
1335         int i;
1336
1337         memset(pmp->data, 0, sizeof(pmp->data));
1338         spin_lock_irqsave(&ibp->lock, flags);
1339         p->tag = cpu_to_be16(ibp->pma_tag);
1340         if (ppd->cong_stats.flags == IB_PMA_CONG_HW_CONTROL_TIMER)
1341                 p->sample_status = IB_PMA_SAMPLE_STATUS_DONE;
1342         else {
1343                 status = dd->f_portcntr(ppd, QIBPORTCNTR_PSSTAT);
1344                 p->sample_status = cpu_to_be16(status);
1345                 if (status == IB_PMA_SAMPLE_STATUS_DONE) {
1346                         cache_hw_sample_counters(ppd);
1347                         ppd->cong_stats.counter =
1348                                 xmit_wait_get_value_delta(ppd);
1349                         dd->f_set_cntr_sample(ppd,
1350                                               QIB_CONG_TIMER_PSINTERVAL, 0);
1351                         ppd->cong_stats.flags = IB_PMA_CONG_HW_CONTROL_TIMER;
1352                 }
1353         }
1354         for (i = 0; i < ARRAY_SIZE(ibp->pma_counter_select); i++)
1355                 p->counter[i] = cpu_to_be32(
1356                         get_cache_hw_sample_counters(
1357                                 ppd, ibp->pma_counter_select[i]));
1358         spin_unlock_irqrestore(&ibp->lock, flags);
1359
1360         return reply((struct ib_smp *) pmp);
1361 }
1362
1363 static int pma_get_portsamplesresult_ext(struct ib_pma_mad *pmp,
1364                                          struct ib_device *ibdev, u8 port)
1365 {
1366         struct ib_pma_portsamplesresult_ext *p =
1367                 (struct ib_pma_portsamplesresult_ext *)pmp->data;
1368         struct qib_ibdev *dev = to_idev(ibdev);
1369         struct qib_devdata *dd = dd_from_dev(dev);
1370         struct qib_ibport *ibp = to_iport(ibdev, port);
1371         struct qib_pportdata *ppd = ppd_from_ibp(ibp);
1372         unsigned long flags;
1373         u8 status;
1374         int i;
1375
1376         /* Port Sampling code owns the PS* HW counters */
1377         memset(pmp->data, 0, sizeof(pmp->data));
1378         spin_lock_irqsave(&ibp->lock, flags);
1379         p->tag = cpu_to_be16(ibp->pma_tag);
1380         if (ppd->cong_stats.flags == IB_PMA_CONG_HW_CONTROL_TIMER)
1381                 p->sample_status = IB_PMA_SAMPLE_STATUS_DONE;
1382         else {
1383                 status = dd->f_portcntr(ppd, QIBPORTCNTR_PSSTAT);
1384                 p->sample_status = cpu_to_be16(status);
1385                 /* 64 bits */
1386                 p->extended_width = cpu_to_be32(0x80000000);
1387                 if (status == IB_PMA_SAMPLE_STATUS_DONE) {
1388                         cache_hw_sample_counters(ppd);
1389                         ppd->cong_stats.counter =
1390                                 xmit_wait_get_value_delta(ppd);
1391                         dd->f_set_cntr_sample(ppd,
1392                                               QIB_CONG_TIMER_PSINTERVAL, 0);
1393                         ppd->cong_stats.flags = IB_PMA_CONG_HW_CONTROL_TIMER;
1394                 }
1395         }
1396         for (i = 0; i < ARRAY_SIZE(ibp->pma_counter_select); i++)
1397                 p->counter[i] = cpu_to_be64(
1398                         get_cache_hw_sample_counters(
1399                                 ppd, ibp->pma_counter_select[i]));
1400         spin_unlock_irqrestore(&ibp->lock, flags);
1401
1402         return reply((struct ib_smp *) pmp);
1403 }
1404
1405 static int pma_get_portcounters(struct ib_pma_mad *pmp,
1406                                 struct ib_device *ibdev, u8 port)
1407 {
1408         struct ib_pma_portcounters *p = (struct ib_pma_portcounters *)
1409                 pmp->data;
1410         struct qib_ibport *ibp = to_iport(ibdev, port);
1411         struct qib_pportdata *ppd = ppd_from_ibp(ibp);
1412         struct qib_verbs_counters cntrs;
1413         u8 port_select = p->port_select;
1414
1415         qib_get_counters(ppd, &cntrs);
1416
1417         /* Adjust counters for any resets done. */
1418         cntrs.symbol_error_counter -= ibp->z_symbol_error_counter;
1419         cntrs.link_error_recovery_counter -=
1420                 ibp->z_link_error_recovery_counter;
1421         cntrs.link_downed_counter -= ibp->z_link_downed_counter;
1422         cntrs.port_rcv_errors -= ibp->z_port_rcv_errors;
1423         cntrs.port_rcv_remphys_errors -= ibp->z_port_rcv_remphys_errors;
1424         cntrs.port_xmit_discards -= ibp->z_port_xmit_discards;
1425         cntrs.port_xmit_data -= ibp->z_port_xmit_data;
1426         cntrs.port_rcv_data -= ibp->z_port_rcv_data;
1427         cntrs.port_xmit_packets -= ibp->z_port_xmit_packets;
1428         cntrs.port_rcv_packets -= ibp->z_port_rcv_packets;
1429         cntrs.local_link_integrity_errors -=
1430                 ibp->z_local_link_integrity_errors;
1431         cntrs.excessive_buffer_overrun_errors -=
1432                 ibp->z_excessive_buffer_overrun_errors;
1433         cntrs.vl15_dropped -= ibp->z_vl15_dropped;
1434         cntrs.vl15_dropped += ibp->n_vl15_dropped;
1435
1436         memset(pmp->data, 0, sizeof(pmp->data));
1437
1438         p->port_select = port_select;
1439         if (pmp->mad_hdr.attr_mod != 0 || port_select != port)
1440                 pmp->mad_hdr.status |= IB_SMP_INVALID_FIELD;
1441
1442         if (cntrs.symbol_error_counter > 0xFFFFUL)
1443                 p->symbol_error_counter = cpu_to_be16(0xFFFF);
1444         else
1445                 p->symbol_error_counter =
1446                         cpu_to_be16((u16)cntrs.symbol_error_counter);
1447         if (cntrs.link_error_recovery_counter > 0xFFUL)
1448                 p->link_error_recovery_counter = 0xFF;
1449         else
1450                 p->link_error_recovery_counter =
1451                         (u8)cntrs.link_error_recovery_counter;
1452         if (cntrs.link_downed_counter > 0xFFUL)
1453                 p->link_downed_counter = 0xFF;
1454         else
1455                 p->link_downed_counter = (u8)cntrs.link_downed_counter;
1456         if (cntrs.port_rcv_errors > 0xFFFFUL)
1457                 p->port_rcv_errors = cpu_to_be16(0xFFFF);
1458         else
1459                 p->port_rcv_errors =
1460                         cpu_to_be16((u16) cntrs.port_rcv_errors);
1461         if (cntrs.port_rcv_remphys_errors > 0xFFFFUL)
1462                 p->port_rcv_remphys_errors = cpu_to_be16(0xFFFF);
1463         else
1464                 p->port_rcv_remphys_errors =
1465                         cpu_to_be16((u16)cntrs.port_rcv_remphys_errors);
1466         if (cntrs.port_xmit_discards > 0xFFFFUL)
1467                 p->port_xmit_discards = cpu_to_be16(0xFFFF);
1468         else
1469                 p->port_xmit_discards =
1470                         cpu_to_be16((u16)cntrs.port_xmit_discards);
1471         if (cntrs.local_link_integrity_errors > 0xFUL)
1472                 cntrs.local_link_integrity_errors = 0xFUL;
1473         if (cntrs.excessive_buffer_overrun_errors > 0xFUL)
1474                 cntrs.excessive_buffer_overrun_errors = 0xFUL;
1475         p->link_overrun_errors = (cntrs.local_link_integrity_errors << 4) |
1476                 cntrs.excessive_buffer_overrun_errors;
1477         if (cntrs.vl15_dropped > 0xFFFFUL)
1478                 p->vl15_dropped = cpu_to_be16(0xFFFF);
1479         else
1480                 p->vl15_dropped = cpu_to_be16((u16)cntrs.vl15_dropped);
1481         if (cntrs.port_xmit_data > 0xFFFFFFFFUL)
1482                 p->port_xmit_data = cpu_to_be32(0xFFFFFFFF);
1483         else
1484                 p->port_xmit_data = cpu_to_be32((u32)cntrs.port_xmit_data);
1485         if (cntrs.port_rcv_data > 0xFFFFFFFFUL)
1486                 p->port_rcv_data = cpu_to_be32(0xFFFFFFFF);
1487         else
1488                 p->port_rcv_data = cpu_to_be32((u32)cntrs.port_rcv_data);
1489         if (cntrs.port_xmit_packets > 0xFFFFFFFFUL)
1490                 p->port_xmit_packets = cpu_to_be32(0xFFFFFFFF);
1491         else
1492                 p->port_xmit_packets =
1493                         cpu_to_be32((u32)cntrs.port_xmit_packets);
1494         if (cntrs.port_rcv_packets > 0xFFFFFFFFUL)
1495                 p->port_rcv_packets = cpu_to_be32(0xFFFFFFFF);
1496         else
1497                 p->port_rcv_packets =
1498                         cpu_to_be32((u32) cntrs.port_rcv_packets);
1499
1500         return reply((struct ib_smp *) pmp);
1501 }
1502
1503 static int pma_get_portcounters_cong(struct ib_pma_mad *pmp,
1504                                      struct ib_device *ibdev, u8 port)
1505 {
1506         /* Congestion PMA packets start at offset 24 not 64 */
1507         struct ib_pma_portcounters_cong *p =
1508                 (struct ib_pma_portcounters_cong *)pmp->reserved;
1509         struct qib_verbs_counters cntrs;
1510         struct qib_ibport *ibp = to_iport(ibdev, port);
1511         struct qib_pportdata *ppd = ppd_from_ibp(ibp);
1512         struct qib_devdata *dd = dd_from_ppd(ppd);
1513         u32 port_select = be32_to_cpu(pmp->mad_hdr.attr_mod) & 0xFF;
1514         u64 xmit_wait_counter;
1515         unsigned long flags;
1516
1517         /*
1518          * This check is performed only in the GET method because the
1519          * SET method ends up calling this anyway.
1520          */
1521         if (!dd->psxmitwait_supported)
1522                 pmp->mad_hdr.status |= IB_SMP_UNSUP_METH_ATTR;
1523         if (port_select != port)
1524                 pmp->mad_hdr.status |= IB_SMP_INVALID_FIELD;
1525
1526         qib_get_counters(ppd, &cntrs);
1527         spin_lock_irqsave(&ppd->ibport_data.lock, flags);
1528         xmit_wait_counter = xmit_wait_get_value_delta(ppd);
1529         spin_unlock_irqrestore(&ppd->ibport_data.lock, flags);
1530
1531         /* Adjust counters for any resets done. */
1532         cntrs.symbol_error_counter -= ibp->z_symbol_error_counter;
1533         cntrs.link_error_recovery_counter -=
1534                 ibp->z_link_error_recovery_counter;
1535         cntrs.link_downed_counter -= ibp->z_link_downed_counter;
1536         cntrs.port_rcv_errors -= ibp->z_port_rcv_errors;
1537         cntrs.port_rcv_remphys_errors -=
1538                 ibp->z_port_rcv_remphys_errors;
1539         cntrs.port_xmit_discards -= ibp->z_port_xmit_discards;
1540         cntrs.local_link_integrity_errors -=
1541                 ibp->z_local_link_integrity_errors;
1542         cntrs.excessive_buffer_overrun_errors -=
1543                 ibp->z_excessive_buffer_overrun_errors;
1544         cntrs.vl15_dropped -= ibp->z_vl15_dropped;
1545         cntrs.vl15_dropped += ibp->n_vl15_dropped;
1546         cntrs.port_xmit_data -= ibp->z_port_xmit_data;
1547         cntrs.port_rcv_data -= ibp->z_port_rcv_data;
1548         cntrs.port_xmit_packets -= ibp->z_port_xmit_packets;
1549         cntrs.port_rcv_packets -= ibp->z_port_rcv_packets;
1550
1551         memset(pmp->reserved, 0, sizeof(pmp->reserved) +
1552                sizeof(pmp->data));
1553
1554         /*
1555          * Set top 3 bits to indicate interval in picoseconds in
1556          * remaining bits.
1557          */
1558         p->port_check_rate =
1559                 cpu_to_be16((QIB_XMIT_RATE_PICO << 13) |
1560                             (dd->psxmitwait_check_rate &
1561                              ~(QIB_XMIT_RATE_PICO << 13)));
1562         p->port_adr_events = cpu_to_be64(0);
1563         p->port_xmit_wait = cpu_to_be64(xmit_wait_counter);
1564         p->port_xmit_data = cpu_to_be64(cntrs.port_xmit_data);
1565         p->port_rcv_data = cpu_to_be64(cntrs.port_rcv_data);
1566         p->port_xmit_packets =
1567                 cpu_to_be64(cntrs.port_xmit_packets);
1568         p->port_rcv_packets =
1569                 cpu_to_be64(cntrs.port_rcv_packets);
1570         if (cntrs.symbol_error_counter > 0xFFFFUL)
1571                 p->symbol_error_counter = cpu_to_be16(0xFFFF);
1572         else
1573                 p->symbol_error_counter =
1574                         cpu_to_be16(
1575                                 (u16)cntrs.symbol_error_counter);
1576         if (cntrs.link_error_recovery_counter > 0xFFUL)
1577                 p->link_error_recovery_counter = 0xFF;
1578         else
1579                 p->link_error_recovery_counter =
1580                         (u8)cntrs.link_error_recovery_counter;
1581         if (cntrs.link_downed_counter > 0xFFUL)
1582                 p->link_downed_counter = 0xFF;
1583         else
1584                 p->link_downed_counter =
1585                         (u8)cntrs.link_downed_counter;
1586         if (cntrs.port_rcv_errors > 0xFFFFUL)
1587                 p->port_rcv_errors = cpu_to_be16(0xFFFF);
1588         else
1589                 p->port_rcv_errors =
1590                         cpu_to_be16((u16) cntrs.port_rcv_errors);
1591         if (cntrs.port_rcv_remphys_errors > 0xFFFFUL)
1592                 p->port_rcv_remphys_errors = cpu_to_be16(0xFFFF);
1593         else
1594                 p->port_rcv_remphys_errors =
1595                         cpu_to_be16(
1596                                 (u16)cntrs.port_rcv_remphys_errors);
1597         if (cntrs.port_xmit_discards > 0xFFFFUL)
1598                 p->port_xmit_discards = cpu_to_be16(0xFFFF);
1599         else
1600                 p->port_xmit_discards =
1601                         cpu_to_be16((u16)cntrs.port_xmit_discards);
1602         if (cntrs.local_link_integrity_errors > 0xFUL)
1603                 cntrs.local_link_integrity_errors = 0xFUL;
1604         if (cntrs.excessive_buffer_overrun_errors > 0xFUL)
1605                 cntrs.excessive_buffer_overrun_errors = 0xFUL;
1606         p->link_overrun_errors = (cntrs.local_link_integrity_errors << 4) |
1607                 cntrs.excessive_buffer_overrun_errors;
1608         if (cntrs.vl15_dropped > 0xFFFFUL)
1609                 p->vl15_dropped = cpu_to_be16(0xFFFF);
1610         else
1611                 p->vl15_dropped = cpu_to_be16((u16)cntrs.vl15_dropped);
1612
1613         return reply((struct ib_smp *)pmp);
1614 }
1615
1616 static int pma_get_portcounters_ext(struct ib_pma_mad *pmp,
1617                                     struct ib_device *ibdev, u8 port)
1618 {
1619         struct ib_pma_portcounters_ext *p =
1620                 (struct ib_pma_portcounters_ext *)pmp->data;
1621         struct qib_ibport *ibp = to_iport(ibdev, port);
1622         struct qib_pportdata *ppd = ppd_from_ibp(ibp);
1623         u64 swords, rwords, spkts, rpkts, xwait;
1624         u8 port_select = p->port_select;
1625
1626         memset(pmp->data, 0, sizeof(pmp->data));
1627
1628         p->port_select = port_select;
1629         if (pmp->mad_hdr.attr_mod != 0 || port_select != port) {
1630                 pmp->mad_hdr.status |= IB_SMP_INVALID_FIELD;
1631                 goto bail;
1632         }
1633
1634         qib_snapshot_counters(ppd, &swords, &rwords, &spkts, &rpkts, &xwait);
1635
1636         /* Adjust counters for any resets done. */
1637         swords -= ibp->z_port_xmit_data;
1638         rwords -= ibp->z_port_rcv_data;
1639         spkts -= ibp->z_port_xmit_packets;
1640         rpkts -= ibp->z_port_rcv_packets;
1641
1642         p->port_xmit_data = cpu_to_be64(swords);
1643         p->port_rcv_data = cpu_to_be64(rwords);
1644         p->port_xmit_packets = cpu_to_be64(spkts);
1645         p->port_rcv_packets = cpu_to_be64(rpkts);
1646         p->port_unicast_xmit_packets = cpu_to_be64(ibp->n_unicast_xmit);
1647         p->port_unicast_rcv_packets = cpu_to_be64(ibp->n_unicast_rcv);
1648         p->port_multicast_xmit_packets = cpu_to_be64(ibp->n_multicast_xmit);
1649         p->port_multicast_rcv_packets = cpu_to_be64(ibp->n_multicast_rcv);
1650
1651 bail:
1652         return reply((struct ib_smp *) pmp);
1653 }
1654
1655 static int pma_set_portcounters(struct ib_pma_mad *pmp,
1656                                 struct ib_device *ibdev, u8 port)
1657 {
1658         struct ib_pma_portcounters *p = (struct ib_pma_portcounters *)
1659                 pmp->data;
1660         struct qib_ibport *ibp = to_iport(ibdev, port);
1661         struct qib_pportdata *ppd = ppd_from_ibp(ibp);
1662         struct qib_verbs_counters cntrs;
1663
1664         /*
1665          * Since the HW doesn't support clearing counters, we save the
1666          * current count and subtract it from future responses.
1667          */
1668         qib_get_counters(ppd, &cntrs);
1669
1670         if (p->counter_select & IB_PMA_SEL_SYMBOL_ERROR)
1671                 ibp->z_symbol_error_counter = cntrs.symbol_error_counter;
1672
1673         if (p->counter_select & IB_PMA_SEL_LINK_ERROR_RECOVERY)
1674                 ibp->z_link_error_recovery_counter =
1675                         cntrs.link_error_recovery_counter;
1676
1677         if (p->counter_select & IB_PMA_SEL_LINK_DOWNED)
1678                 ibp->z_link_downed_counter = cntrs.link_downed_counter;
1679
1680         if (p->counter_select & IB_PMA_SEL_PORT_RCV_ERRORS)
1681                 ibp->z_port_rcv_errors = cntrs.port_rcv_errors;
1682
1683         if (p->counter_select & IB_PMA_SEL_PORT_RCV_REMPHYS_ERRORS)
1684                 ibp->z_port_rcv_remphys_errors =
1685                         cntrs.port_rcv_remphys_errors;
1686
1687         if (p->counter_select & IB_PMA_SEL_PORT_XMIT_DISCARDS)
1688                 ibp->z_port_xmit_discards = cntrs.port_xmit_discards;
1689
1690         if (p->counter_select & IB_PMA_SEL_LOCAL_LINK_INTEGRITY_ERRORS)
1691                 ibp->z_local_link_integrity_errors =
1692                         cntrs.local_link_integrity_errors;
1693
1694         if (p->counter_select & IB_PMA_SEL_EXCESSIVE_BUFFER_OVERRUNS)
1695                 ibp->z_excessive_buffer_overrun_errors =
1696                         cntrs.excessive_buffer_overrun_errors;
1697
1698         if (p->counter_select & IB_PMA_SEL_PORT_VL15_DROPPED) {
1699                 ibp->n_vl15_dropped = 0;
1700                 ibp->z_vl15_dropped = cntrs.vl15_dropped;
1701         }
1702
1703         if (p->counter_select & IB_PMA_SEL_PORT_XMIT_DATA)
1704                 ibp->z_port_xmit_data = cntrs.port_xmit_data;
1705
1706         if (p->counter_select & IB_PMA_SEL_PORT_RCV_DATA)
1707                 ibp->z_port_rcv_data = cntrs.port_rcv_data;
1708
1709         if (p->counter_select & IB_PMA_SEL_PORT_XMIT_PACKETS)
1710                 ibp->z_port_xmit_packets = cntrs.port_xmit_packets;
1711
1712         if (p->counter_select & IB_PMA_SEL_PORT_RCV_PACKETS)
1713                 ibp->z_port_rcv_packets = cntrs.port_rcv_packets;
1714
1715         return pma_get_portcounters(pmp, ibdev, port);
1716 }
1717
1718 static int pma_set_portcounters_cong(struct ib_pma_mad *pmp,
1719                                      struct ib_device *ibdev, u8 port)
1720 {
1721         struct qib_ibport *ibp = to_iport(ibdev, port);
1722         struct qib_pportdata *ppd = ppd_from_ibp(ibp);
1723         struct qib_devdata *dd = dd_from_ppd(ppd);
1724         struct qib_verbs_counters cntrs;
1725         u32 counter_select = (be32_to_cpu(pmp->mad_hdr.attr_mod) >> 24) & 0xFF;
1726         int ret = 0;
1727         unsigned long flags;
1728
1729         qib_get_counters(ppd, &cntrs);
1730         /* Get counter values before we save them */
1731         ret = pma_get_portcounters_cong(pmp, ibdev, port);
1732
1733         if (counter_select & IB_PMA_SEL_CONG_XMIT) {
1734                 spin_lock_irqsave(&ppd->ibport_data.lock, flags);
1735                 ppd->cong_stats.counter = 0;
1736                 dd->f_set_cntr_sample(ppd, QIB_CONG_TIMER_PSINTERVAL,
1737                                       0x0);
1738                 spin_unlock_irqrestore(&ppd->ibport_data.lock, flags);
1739         }
1740         if (counter_select & IB_PMA_SEL_CONG_PORT_DATA) {
1741                 ibp->z_port_xmit_data = cntrs.port_xmit_data;
1742                 ibp->z_port_rcv_data = cntrs.port_rcv_data;
1743                 ibp->z_port_xmit_packets = cntrs.port_xmit_packets;
1744                 ibp->z_port_rcv_packets = cntrs.port_rcv_packets;
1745         }
1746         if (counter_select & IB_PMA_SEL_CONG_ALL) {
1747                 ibp->z_symbol_error_counter =
1748                         cntrs.symbol_error_counter;
1749                 ibp->z_link_error_recovery_counter =
1750                         cntrs.link_error_recovery_counter;
1751                 ibp->z_link_downed_counter =
1752                         cntrs.link_downed_counter;
1753                 ibp->z_port_rcv_errors = cntrs.port_rcv_errors;
1754                 ibp->z_port_rcv_remphys_errors =
1755                         cntrs.port_rcv_remphys_errors;
1756                 ibp->z_port_xmit_discards =
1757                         cntrs.port_xmit_discards;
1758                 ibp->z_local_link_integrity_errors =
1759                         cntrs.local_link_integrity_errors;
1760                 ibp->z_excessive_buffer_overrun_errors =
1761                         cntrs.excessive_buffer_overrun_errors;
1762                 ibp->n_vl15_dropped = 0;
1763                 ibp->z_vl15_dropped = cntrs.vl15_dropped;
1764         }
1765
1766         return ret;
1767 }
1768
1769 static int pma_set_portcounters_ext(struct ib_pma_mad *pmp,
1770                                     struct ib_device *ibdev, u8 port)
1771 {
1772         struct ib_pma_portcounters *p = (struct ib_pma_portcounters *)
1773                 pmp->data;
1774         struct qib_ibport *ibp = to_iport(ibdev, port);
1775         struct qib_pportdata *ppd = ppd_from_ibp(ibp);
1776         u64 swords, rwords, spkts, rpkts, xwait;
1777
1778         qib_snapshot_counters(ppd, &swords, &rwords, &spkts, &rpkts, &xwait);
1779
1780         if (p->counter_select & IB_PMA_SELX_PORT_XMIT_DATA)
1781                 ibp->z_port_xmit_data = swords;
1782
1783         if (p->counter_select & IB_PMA_SELX_PORT_RCV_DATA)
1784                 ibp->z_port_rcv_data = rwords;
1785
1786         if (p->counter_select & IB_PMA_SELX_PORT_XMIT_PACKETS)
1787                 ibp->z_port_xmit_packets = spkts;
1788
1789         if (p->counter_select & IB_PMA_SELX_PORT_RCV_PACKETS)
1790                 ibp->z_port_rcv_packets = rpkts;
1791
1792         if (p->counter_select & IB_PMA_SELX_PORT_UNI_XMIT_PACKETS)
1793                 ibp->n_unicast_xmit = 0;
1794
1795         if (p->counter_select & IB_PMA_SELX_PORT_UNI_RCV_PACKETS)
1796                 ibp->n_unicast_rcv = 0;
1797
1798         if (p->counter_select & IB_PMA_SELX_PORT_MULTI_XMIT_PACKETS)
1799                 ibp->n_multicast_xmit = 0;
1800
1801         if (p->counter_select & IB_PMA_SELX_PORT_MULTI_RCV_PACKETS)
1802                 ibp->n_multicast_rcv = 0;
1803
1804         return pma_get_portcounters_ext(pmp, ibdev, port);
1805 }
1806
1807 static int process_subn(struct ib_device *ibdev, int mad_flags,
1808                         u8 port, struct ib_mad *in_mad,
1809                         struct ib_mad *out_mad)
1810 {
1811         struct ib_smp *smp = (struct ib_smp *)out_mad;
1812         struct qib_ibport *ibp = to_iport(ibdev, port);
1813         struct qib_pportdata *ppd = ppd_from_ibp(ibp);
1814         int ret;
1815
1816         *out_mad = *in_mad;
1817         if (smp->class_version != 1) {
1818                 smp->status |= IB_SMP_UNSUP_VERSION;
1819                 ret = reply(smp);
1820                 goto bail;
1821         }
1822
1823         ret = check_mkey(ibp, smp, mad_flags);
1824         if (ret) {
1825                 u32 port_num = be32_to_cpu(smp->attr_mod);
1826
1827                 /*
1828                  * If this is a get/set portinfo, we already check the
1829                  * M_Key if the MAD is for another port and the M_Key
1830                  * is OK on the receiving port. This check is needed
1831                  * to increment the error counters when the M_Key
1832                  * fails to match on *both* ports.
1833                  */
1834                 if (in_mad->mad_hdr.attr_id == IB_SMP_ATTR_PORT_INFO &&
1835                     (smp->method == IB_MGMT_METHOD_GET ||
1836                      smp->method == IB_MGMT_METHOD_SET) &&
1837                     port_num && port_num <= ibdev->phys_port_cnt &&
1838                     port != port_num)
1839                         (void) check_mkey(to_iport(ibdev, port_num), smp, 0);
1840                 goto bail;
1841         }
1842
1843         switch (smp->method) {
1844         case IB_MGMT_METHOD_GET:
1845                 switch (smp->attr_id) {
1846                 case IB_SMP_ATTR_NODE_DESC:
1847                         ret = subn_get_nodedescription(smp, ibdev);
1848                         goto bail;
1849                 case IB_SMP_ATTR_NODE_INFO:
1850                         ret = subn_get_nodeinfo(smp, ibdev, port);
1851                         goto bail;
1852                 case IB_SMP_ATTR_GUID_INFO:
1853                         ret = subn_get_guidinfo(smp, ibdev, port);
1854                         goto bail;
1855                 case IB_SMP_ATTR_PORT_INFO:
1856                         ret = subn_get_portinfo(smp, ibdev, port);
1857                         goto bail;
1858                 case IB_SMP_ATTR_PKEY_TABLE:
1859                         ret = subn_get_pkeytable(smp, ibdev, port);
1860                         goto bail;
1861                 case IB_SMP_ATTR_SL_TO_VL_TABLE:
1862                         ret = subn_get_sl_to_vl(smp, ibdev, port);
1863                         goto bail;
1864                 case IB_SMP_ATTR_VL_ARB_TABLE:
1865                         ret = subn_get_vl_arb(smp, ibdev, port);
1866                         goto bail;
1867                 case IB_SMP_ATTR_SM_INFO:
1868                         if (ibp->port_cap_flags & IB_PORT_SM_DISABLED) {
1869                                 ret = IB_MAD_RESULT_SUCCESS |
1870                                         IB_MAD_RESULT_CONSUMED;
1871                                 goto bail;
1872                         }
1873                         if (ibp->port_cap_flags & IB_PORT_SM) {
1874                                 ret = IB_MAD_RESULT_SUCCESS;
1875                                 goto bail;
1876                         }
1877                         /* FALLTHROUGH */
1878                 default:
1879                         smp->status |= IB_SMP_UNSUP_METH_ATTR;
1880                         ret = reply(smp);
1881                         goto bail;
1882                 }
1883
1884         case IB_MGMT_METHOD_SET:
1885                 switch (smp->attr_id) {
1886                 case IB_SMP_ATTR_GUID_INFO:
1887                         ret = subn_set_guidinfo(smp, ibdev, port);
1888                         goto bail;
1889                 case IB_SMP_ATTR_PORT_INFO:
1890                         ret = subn_set_portinfo(smp, ibdev, port);
1891                         goto bail;
1892                 case IB_SMP_ATTR_PKEY_TABLE:
1893                         ret = subn_set_pkeytable(smp, ibdev, port);
1894                         goto bail;
1895                 case IB_SMP_ATTR_SL_TO_VL_TABLE:
1896                         ret = subn_set_sl_to_vl(smp, ibdev, port);
1897                         goto bail;
1898                 case IB_SMP_ATTR_VL_ARB_TABLE:
1899                         ret = subn_set_vl_arb(smp, ibdev, port);
1900                         goto bail;
1901                 case IB_SMP_ATTR_SM_INFO:
1902                         if (ibp->port_cap_flags & IB_PORT_SM_DISABLED) {
1903                                 ret = IB_MAD_RESULT_SUCCESS |
1904                                         IB_MAD_RESULT_CONSUMED;
1905                                 goto bail;
1906                         }
1907                         if (ibp->port_cap_flags & IB_PORT_SM) {
1908                                 ret = IB_MAD_RESULT_SUCCESS;
1909                                 goto bail;
1910                         }
1911                         /* FALLTHROUGH */
1912                 default:
1913                         smp->status |= IB_SMP_UNSUP_METH_ATTR;
1914                         ret = reply(smp);
1915                         goto bail;
1916                 }
1917
1918         case IB_MGMT_METHOD_TRAP_REPRESS:
1919                 if (smp->attr_id == IB_SMP_ATTR_NOTICE)
1920                         ret = subn_trap_repress(smp, ibdev, port);
1921                 else {
1922                         smp->status |= IB_SMP_UNSUP_METH_ATTR;
1923                         ret = reply(smp);
1924                 }
1925                 goto bail;
1926
1927         case IB_MGMT_METHOD_TRAP:
1928         case IB_MGMT_METHOD_REPORT:
1929         case IB_MGMT_METHOD_REPORT_RESP:
1930         case IB_MGMT_METHOD_GET_RESP:
1931                 /*
1932                  * The ib_mad module will call us to process responses
1933                  * before checking for other consumers.
1934                  * Just tell the caller to process it normally.
1935                  */
1936                 ret = IB_MAD_RESULT_SUCCESS;
1937                 goto bail;
1938
1939         case IB_MGMT_METHOD_SEND:
1940                 if (ib_get_smp_direction(smp) &&
1941                     smp->attr_id == QIB_VENDOR_IPG) {
1942                         ppd->dd->f_set_ib_cfg(ppd, QIB_IB_CFG_PORT,
1943                                               smp->data[0]);
1944                         ret = IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_CONSUMED;
1945                 } else
1946                         ret = IB_MAD_RESULT_SUCCESS;
1947                 goto bail;
1948
1949         default:
1950                 smp->status |= IB_SMP_UNSUP_METHOD;
1951                 ret = reply(smp);
1952         }
1953
1954 bail:
1955         return ret;
1956 }
1957
1958 static int process_perf(struct ib_device *ibdev, u8 port,
1959                         struct ib_mad *in_mad,
1960                         struct ib_mad *out_mad)
1961 {
1962         struct ib_pma_mad *pmp = (struct ib_pma_mad *)out_mad;
1963         int ret;
1964
1965         *out_mad = *in_mad;
1966         if (pmp->mad_hdr.class_version != 1) {
1967                 pmp->mad_hdr.status |= IB_SMP_UNSUP_VERSION;
1968                 ret = reply((struct ib_smp *) pmp);
1969                 goto bail;
1970         }
1971
1972         switch (pmp->mad_hdr.method) {
1973         case IB_MGMT_METHOD_GET:
1974                 switch (pmp->mad_hdr.attr_id) {
1975                 case IB_PMA_CLASS_PORT_INFO:
1976                         ret = pma_get_classportinfo(pmp, ibdev);
1977                         goto bail;
1978                 case IB_PMA_PORT_SAMPLES_CONTROL:
1979                         ret = pma_get_portsamplescontrol(pmp, ibdev, port);
1980                         goto bail;
1981                 case IB_PMA_PORT_SAMPLES_RESULT:
1982                         ret = pma_get_portsamplesresult(pmp, ibdev, port);
1983                         goto bail;
1984                 case IB_PMA_PORT_SAMPLES_RESULT_EXT:
1985                         ret = pma_get_portsamplesresult_ext(pmp, ibdev, port);
1986                         goto bail;
1987                 case IB_PMA_PORT_COUNTERS:
1988                         ret = pma_get_portcounters(pmp, ibdev, port);
1989                         goto bail;
1990                 case IB_PMA_PORT_COUNTERS_EXT:
1991                         ret = pma_get_portcounters_ext(pmp, ibdev, port);
1992                         goto bail;
1993                 case IB_PMA_PORT_COUNTERS_CONG:
1994                         ret = pma_get_portcounters_cong(pmp, ibdev, port);
1995                         goto bail;
1996                 default:
1997                         pmp->mad_hdr.status |= IB_SMP_UNSUP_METH_ATTR;
1998                         ret = reply((struct ib_smp *) pmp);
1999                         goto bail;
2000                 }
2001
2002         case IB_MGMT_METHOD_SET:
2003                 switch (pmp->mad_hdr.attr_id) {
2004                 case IB_PMA_PORT_SAMPLES_CONTROL:
2005                         ret = pma_set_portsamplescontrol(pmp, ibdev, port);
2006                         goto bail;
2007                 case IB_PMA_PORT_COUNTERS:
2008                         ret = pma_set_portcounters(pmp, ibdev, port);
2009                         goto bail;
2010                 case IB_PMA_PORT_COUNTERS_EXT:
2011                         ret = pma_set_portcounters_ext(pmp, ibdev, port);
2012                         goto bail;
2013                 case IB_PMA_PORT_COUNTERS_CONG:
2014                         ret = pma_set_portcounters_cong(pmp, ibdev, port);
2015                         goto bail;
2016                 default:
2017                         pmp->mad_hdr.status |= IB_SMP_UNSUP_METH_ATTR;
2018                         ret = reply((struct ib_smp *) pmp);
2019                         goto bail;
2020                 }
2021
2022         case IB_MGMT_METHOD_TRAP:
2023         case IB_MGMT_METHOD_GET_RESP:
2024                 /*
2025                  * The ib_mad module will call us to process responses
2026                  * before checking for other consumers.
2027                  * Just tell the caller to process it normally.
2028                  */
2029                 ret = IB_MAD_RESULT_SUCCESS;
2030                 goto bail;
2031
2032         default:
2033                 pmp->mad_hdr.status |= IB_SMP_UNSUP_METHOD;
2034                 ret = reply((struct ib_smp *) pmp);
2035         }
2036
2037 bail:
2038         return ret;
2039 }
2040
2041 /**
2042  * qib_process_mad - process an incoming MAD packet
2043  * @ibdev: the infiniband device this packet came in on
2044  * @mad_flags: MAD flags
2045  * @port: the port number this packet came in on
2046  * @in_wc: the work completion entry for this packet
2047  * @in_grh: the global route header for this packet
2048  * @in_mad: the incoming MAD
2049  * @out_mad: any outgoing MAD reply
2050  *
2051  * Returns IB_MAD_RESULT_SUCCESS if this is a MAD that we are not
2052  * interested in processing.
2053  *
2054  * Note that the verbs framework has already done the MAD sanity checks,
2055  * and hop count/pointer updating for IB_MGMT_CLASS_SUBN_DIRECTED_ROUTE
2056  * MADs.
2057  *
2058  * This is called by the ib_mad module.
2059  */
2060 int qib_process_mad(struct ib_device *ibdev, int mad_flags, u8 port,
2061                     struct ib_wc *in_wc, struct ib_grh *in_grh,
2062                     struct ib_mad *in_mad, struct ib_mad *out_mad)
2063 {
2064         int ret;
2065
2066         switch (in_mad->mad_hdr.mgmt_class) {
2067         case IB_MGMT_CLASS_SUBN_DIRECTED_ROUTE:
2068         case IB_MGMT_CLASS_SUBN_LID_ROUTED:
2069                 ret = process_subn(ibdev, mad_flags, port, in_mad, out_mad);
2070                 goto bail;
2071
2072         case IB_MGMT_CLASS_PERF_MGMT:
2073                 ret = process_perf(ibdev, port, in_mad, out_mad);
2074                 goto bail;
2075
2076         default:
2077                 ret = IB_MAD_RESULT_SUCCESS;
2078         }
2079
2080 bail:
2081         return ret;
2082 }
2083
2084 static void send_handler(struct ib_mad_agent *agent,
2085                          struct ib_mad_send_wc *mad_send_wc)
2086 {
2087         ib_free_send_mad(mad_send_wc->send_buf);
2088 }
2089
2090 static void xmit_wait_timer_func(unsigned long opaque)
2091 {
2092         struct qib_pportdata *ppd = (struct qib_pportdata *)opaque;
2093         struct qib_devdata *dd = dd_from_ppd(ppd);
2094         unsigned long flags;
2095         u8 status;
2096
2097         spin_lock_irqsave(&ppd->ibport_data.lock, flags);
2098         if (ppd->cong_stats.flags == IB_PMA_CONG_HW_CONTROL_SAMPLE) {
2099                 status = dd->f_portcntr(ppd, QIBPORTCNTR_PSSTAT);
2100                 if (status == IB_PMA_SAMPLE_STATUS_DONE) {
2101                         /* save counter cache */
2102                         cache_hw_sample_counters(ppd);
2103                         ppd->cong_stats.flags = IB_PMA_CONG_HW_CONTROL_TIMER;
2104                 } else
2105                         goto done;
2106         }
2107         ppd->cong_stats.counter = xmit_wait_get_value_delta(ppd);
2108         dd->f_set_cntr_sample(ppd, QIB_CONG_TIMER_PSINTERVAL, 0x0);
2109 done:
2110         spin_unlock_irqrestore(&ppd->ibport_data.lock, flags);
2111         mod_timer(&ppd->cong_stats.timer, jiffies + HZ);
2112 }
2113
2114 int qib_create_agents(struct qib_ibdev *dev)
2115 {
2116         struct qib_devdata *dd = dd_from_dev(dev);
2117         struct ib_mad_agent *agent;
2118         struct qib_ibport *ibp;
2119         int p;
2120         int ret;
2121
2122         for (p = 0; p < dd->num_pports; p++) {
2123                 ibp = &dd->pport[p].ibport_data;
2124                 agent = ib_register_mad_agent(&dev->ibdev, p + 1, IB_QPT_SMI,
2125                                               NULL, 0, send_handler,
2126                                               NULL, NULL);
2127                 if (IS_ERR(agent)) {
2128                         ret = PTR_ERR(agent);
2129                         goto err;
2130                 }
2131
2132                 /* Initialize xmit_wait structure */
2133                 dd->pport[p].cong_stats.counter = 0;
2134                 init_timer(&dd->pport[p].cong_stats.timer);
2135                 dd->pport[p].cong_stats.timer.function = xmit_wait_timer_func;
2136                 dd->pport[p].cong_stats.timer.data =
2137                         (unsigned long)(&dd->pport[p]);
2138                 dd->pport[p].cong_stats.timer.expires = 0;
2139                 add_timer(&dd->pport[p].cong_stats.timer);
2140
2141                 ibp->send_agent = agent;
2142         }
2143
2144         return 0;
2145
2146 err:
2147         for (p = 0; p < dd->num_pports; p++) {
2148                 ibp = &dd->pport[p].ibport_data;
2149                 if (ibp->send_agent) {
2150                         agent = ibp->send_agent;
2151                         ibp->send_agent = NULL;
2152                         ib_unregister_mad_agent(agent);
2153                 }
2154         }
2155
2156         return ret;
2157 }
2158
2159 void qib_free_agents(struct qib_ibdev *dev)
2160 {
2161         struct qib_devdata *dd = dd_from_dev(dev);
2162         struct ib_mad_agent *agent;
2163         struct qib_ibport *ibp;
2164         int p;
2165
2166         for (p = 0; p < dd->num_pports; p++) {
2167                 ibp = &dd->pport[p].ibport_data;
2168                 if (ibp->send_agent) {
2169                         agent = ibp->send_agent;
2170                         ibp->send_agent = NULL;
2171                         ib_unregister_mad_agent(agent);
2172                 }
2173                 if (ibp->sm_ah) {
2174                         ib_destroy_ah(&ibp->sm_ah->ibah);
2175                         ibp->sm_ah = NULL;
2176                 }
2177                 if (dd->pport[p].cong_stats.timer.data)
2178                         del_timer_sync(&dd->pport[p].cong_stats.timer);
2179         }
2180 }