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