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