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