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