drivers/infiniband/hw/qib/qib_mad.c

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