driver.c 39.3 KB
Newer Older
M
Mike Marciniszyn 已提交
1
/*
2
 * Copyright(c) 2015-2017 Intel Corporation.
M
Mike Marciniszyn 已提交
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55
 *
 * This file is provided under a dual BSD/GPLv2 license.  When using or
 * redistributing this file, you may do so under either license.
 *
 * GPL LICENSE SUMMARY
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 *
 * BSD LICENSE
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 *  - Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 *  - Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in
 *    the documentation and/or other materials provided with the
 *    distribution.
 *  - Neither the name of Intel Corporation nor the names of its
 *    contributors may be used to endorse or promote products derived
 *    from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 */

#include <linux/spinlock.h>
#include <linux/pci.h>
#include <linux/io.h>
#include <linux/delay.h>
#include <linux/netdevice.h>
#include <linux/vmalloc.h>
#include <linux/module.h>
#include <linux/prefetch.h>
56
#include <rdma/ib_verbs.h>
M
Mike Marciniszyn 已提交
57 58 59 60 61

#include "hfi.h"
#include "trace.h"
#include "qp.h"
#include "sdma.h"
62
#include "debugfs.h"
63
#include "vnic.h"
M
Mike Marciniszyn 已提交
64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79

#undef pr_fmt
#define pr_fmt(fmt) DRIVER_NAME ": " fmt

/*
 * The size has to be longer than this string, so we can append
 * board/chip information to it in the initialization code.
 */
const char ib_hfi1_version[] = HFI1_DRIVER_VERSION "\n";

DEFINE_SPINLOCK(hfi1_devs_lock);
LIST_HEAD(hfi1_dev_list);
DEFINE_MUTEX(hfi1_mutex);	/* general driver use */

unsigned int hfi1_max_mtu = HFI1_DEFAULT_MAX_MTU;
module_param_named(max_mtu, hfi1_max_mtu, uint, S_IRUGO);
80 81
MODULE_PARM_DESC(max_mtu, "Set max MTU bytes, default is " __stringify(
		 HFI1_DEFAULT_MAX_MTU));
M
Mike Marciniszyn 已提交
82 83 84 85 86 87

unsigned int hfi1_cu = 1;
module_param_named(cu, hfi1_cu, uint, S_IRUGO);
MODULE_PARM_DESC(cu, "Credit return units");

unsigned long hfi1_cap_mask = HFI1_CAP_MASK_DEFAULT;
88 89
static int hfi1_caps_set(const char *val, const struct kernel_param *kp);
static int hfi1_caps_get(char *buffer, const struct kernel_param *kp);
M
Mike Marciniszyn 已提交
90 91 92 93 94 95 96 97 98 99 100 101 102 103
static const struct kernel_param_ops cap_ops = {
	.set = hfi1_caps_set,
	.get = hfi1_caps_get
};
module_param_cb(cap_mask, &cap_ops, &hfi1_cap_mask, S_IWUSR | S_IRUGO);
MODULE_PARM_DESC(cap_mask, "Bit mask of enabled/disabled HW features");

MODULE_LICENSE("Dual BSD/GPL");
MODULE_DESCRIPTION("Intel Omni-Path Architecture driver");

/*
 * MAX_PKT_RCV is the max # if packets processed per receive interrupt.
 */
#define MAX_PKT_RECV 64
104 105 106 107 108
/*
 * MAX_PKT_THREAD_RCV is the max # of packets processed before
 * the qp_wait_list queue is flushed.
 */
#define MAX_PKT_RECV_THREAD (MAX_PKT_RECV * 4)
M
Mike Marciniszyn 已提交
109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165
#define EGR_HEAD_UPDATE_THRESHOLD 16

struct hfi1_ib_stats hfi1_stats;

static int hfi1_caps_set(const char *val, const struct kernel_param *kp)
{
	int ret = 0;
	unsigned long *cap_mask_ptr = (unsigned long *)kp->arg,
		cap_mask = *cap_mask_ptr, value, diff,
		write_mask = ((HFI1_CAP_WRITABLE_MASK << HFI1_CAP_USER_SHIFT) |
			      HFI1_CAP_WRITABLE_MASK);

	ret = kstrtoul(val, 0, &value);
	if (ret) {
		pr_warn("Invalid module parameter value for 'cap_mask'\n");
		goto done;
	}
	/* Get the changed bits (except the locked bit) */
	diff = value ^ (cap_mask & ~HFI1_CAP_LOCKED_SMASK);

	/* Remove any bits that are not allowed to change after driver load */
	if (HFI1_CAP_LOCKED() && (diff & ~write_mask)) {
		pr_warn("Ignoring non-writable capability bits %#lx\n",
			diff & ~write_mask);
		diff &= write_mask;
	}

	/* Mask off any reserved bits */
	diff &= ~HFI1_CAP_RESERVED_MASK;
	/* Clear any previously set and changing bits */
	cap_mask &= ~diff;
	/* Update the bits with the new capability */
	cap_mask |= (value & diff);
	/* Check for any kernel/user restrictions */
	diff = (cap_mask & (HFI1_CAP_MUST_HAVE_KERN << HFI1_CAP_USER_SHIFT)) ^
		((cap_mask & HFI1_CAP_MUST_HAVE_KERN) << HFI1_CAP_USER_SHIFT);
	cap_mask &= ~diff;
	/* Set the bitmask to the final set */
	*cap_mask_ptr = cap_mask;
done:
	return ret;
}

static int hfi1_caps_get(char *buffer, const struct kernel_param *kp)
{
	unsigned long cap_mask = *(unsigned long *)kp->arg;

	cap_mask &= ~HFI1_CAP_LOCKED_SMASK;
	cap_mask |= ((cap_mask & HFI1_CAP_K2U) << HFI1_CAP_USER_SHIFT);

	return scnprintf(buffer, PAGE_SIZE, "0x%lx", cap_mask);
}

const char *get_unit_name(int unit)
{
	static char iname[16];

166
	snprintf(iname, sizeof(iname), DRIVER_NAME "_%u", unit);
M
Mike Marciniszyn 已提交
167 168 169
	return iname;
}

170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185
const char *get_card_name(struct rvt_dev_info *rdi)
{
	struct hfi1_ibdev *ibdev = container_of(rdi, struct hfi1_ibdev, rdi);
	struct hfi1_devdata *dd = container_of(ibdev,
					       struct hfi1_devdata, verbs_dev);
	return get_unit_name(dd->unit);
}

struct pci_dev *get_pci_dev(struct rvt_dev_info *rdi)
{
	struct hfi1_ibdev *ibdev = container_of(rdi, struct hfi1_ibdev, rdi);
	struct hfi1_devdata *dd = container_of(ibdev,
					       struct hfi1_devdata, verbs_dev);
	return dd->pcidev;
}

M
Mike Marciniszyn 已提交
186 187 188 189 190 191 192 193 194 195 196 197
/*
 * Return count of units with at least one port ACTIVE.
 */
int hfi1_count_active_units(void)
{
	struct hfi1_devdata *dd;
	struct hfi1_pportdata *ppd;
	unsigned long flags;
	int pidx, nunits_active = 0;

	spin_lock_irqsave(&hfi1_devs_lock, flags);
	list_for_each_entry(dd, &hfi1_dev_list, list) {
198
		if (!(dd->flags & HFI1_PRESENT) || !dd->kregbase1)
M
Mike Marciniszyn 已提交
199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225
			continue;
		for (pidx = 0; pidx < dd->num_pports; ++pidx) {
			ppd = dd->pport + pidx;
			if (ppd->lid && ppd->linkup) {
				nunits_active++;
				break;
			}
		}
	}
	spin_unlock_irqrestore(&hfi1_devs_lock, flags);
	return nunits_active;
}

/*
 * Get address of eager buffer from it's index (allocated in chunks, not
 * contiguous).
 */
static inline void *get_egrbuf(const struct hfi1_ctxtdata *rcd, u64 rhf,
			       u8 *update)
{
	u32 idx = rhf_egr_index(rhf), offset = rhf_egr_buf_offset(rhf);

	*update |= !(idx & (rcd->egrbufs.threshold - 1)) && !offset;
	return (void *)(((u64)(rcd->egrbufs.rcvtids[idx].addr)) +
			(offset * RCV_BUF_BLOCK_SIZE));
}

226 227 228 229 230 231 232 233 234 235 236 237 238 239
static inline void *hfi1_get_header(struct hfi1_devdata *dd,
				    __le32 *rhf_addr)
{
	u32 offset = rhf_hdrq_offset(rhf_to_cpu(rhf_addr));

	return (void *)(rhf_addr - dd->rhf_offset + offset);
}

static inline struct ib_header *hfi1_get_msgheader(struct hfi1_devdata *dd,
						   __le32 *rhf_addr)
{
	return (struct ib_header *)hfi1_get_header(dd, rhf_addr);
}

M
Mike Marciniszyn 已提交
240 241 242 243 244 245
/*
 * Validate and encode the a given RcvArray Buffer size.
 * The function will check whether the given size falls within
 * allowed size ranges for the respective type and, optionally,
 * return the proper encoding.
 */
246
int hfi1_rcvbuf_validate(u32 size, u8 type, u16 *encoded)
M
Mike Marciniszyn 已提交
247
{
248
	if (unlikely(!PAGE_ALIGNED(size)))
M
Mike Marciniszyn 已提交
249 250 251 252 253 254 255 256 257 258 259 260 261 262
		return 0;
	if (unlikely(size < MIN_EAGER_BUFFER))
		return 0;
	if (size >
	    (type == PT_EAGER ? MAX_EAGER_BUFFER : MAX_EXPECTED_BUFFER))
		return 0;
	if (encoded)
		*encoded = ilog2(size / PAGE_SIZE) + 1;
	return 1;
}

static void rcv_hdrerr(struct hfi1_ctxtdata *rcd, struct hfi1_pportdata *ppd,
		       struct hfi1_packet *packet)
{
263
	struct ib_header *rhdr = packet->hdr;
M
Mike Marciniszyn 已提交
264
	u32 rte = rhf_rcv_type_err(packet->rhf);
265 266
	u8 lnh = ib_get_lnh(rhdr);
	bool has_grh = false;
267
	struct hfi1_ibport *ibp = rcd_to_iport(rcd);
268 269
	struct hfi1_devdata *dd = ppd->dd;
	struct rvt_dev_info *rdi = &dd->verbs_dev.rdi;
M
Mike Marciniszyn 已提交
270 271 272 273

	if (packet->rhf & (RHF_VCRC_ERR | RHF_ICRC_ERR))
		return;

274 275 276 277 278 279 280 281 282 283
	if (lnh == HFI1_LRH_BTH) {
		packet->ohdr = &rhdr->u.oth;
	} else if (lnh == HFI1_LRH_GRH) {
		has_grh = true;
		packet->ohdr = &rhdr->u.l.oth;
		packet->grh = &rhdr->u.l.grh;
	} else {
		goto drop;
	}

M
Mike Marciniszyn 已提交
284 285 286
	if (packet->rhf & RHF_TID_ERR) {
		/* For TIDERR and RC QPs preemptively schedule a NAK */
		u32 tlen = rhf_pkt_len(packet->rhf); /* in bytes */
287
		u32 dlid = ib_get_dlid(rhdr);
M
Mike Marciniszyn 已提交
288
		u32 qp_num;
289
		u32 mlid_base = be16_to_cpu(IB_MULTICAST_LID_BASE);
M
Mike Marciniszyn 已提交
290 291 292 293 294 295

		/* Sanity check packet */
		if (tlen < 24)
			goto drop;

		/* Check for GRH */
296
		if (has_grh) {
M
Mike Marciniszyn 已提交
297
			u32 vtf;
298
			struct ib_grh *grh = packet->grh;
M
Mike Marciniszyn 已提交
299

300
			if (grh->next_hdr != IB_GRH_NEXT_HDR)
M
Mike Marciniszyn 已提交
301
				goto drop;
302
			vtf = be32_to_cpu(grh->version_tclass_flow);
M
Mike Marciniszyn 已提交
303 304
			if ((vtf >> IB_GRH_VERSION_SHIFT) != IB_GRH_VERSION)
				goto drop;
305
		}
306

M
Mike Marciniszyn 已提交
307
		/* Get the destination QP number. */
308 309
		qp_num = ib_bth_get_qpn(packet->ohdr);
		if (dlid < mlid_base) {
310
			struct rvt_qp *qp;
311
			unsigned long flags;
M
Mike Marciniszyn 已提交
312 313

			rcu_read_lock();
314
			qp = rvt_lookup_qpn(rdi, &ibp->rvp, qp_num);
M
Mike Marciniszyn 已提交
315 316 317 318 319 320 321 322 323
			if (!qp) {
				rcu_read_unlock();
				goto drop;
			}

			/*
			 * Handle only RC QPs - for other QP types drop error
			 * packet.
			 */
324
			spin_lock_irqsave(&qp->r_lock, flags);
M
Mike Marciniszyn 已提交
325 326

			/* Check for valid receive state. */
327 328
			if (!(ib_rvt_state_ops[qp->state] &
			      RVT_PROCESS_RECV_OK)) {
329
				ibp->rvp.n_pkt_drops++;
M
Mike Marciniszyn 已提交
330 331 332 333
			}

			switch (qp->ibqp.qp_type) {
			case IB_QPT_RC:
334
				hfi1_rc_hdrerr(rcd, packet, qp);
M
Mike Marciniszyn 已提交
335 336 337 338 339 340
				break;
			default:
				/* For now don't handle any other QP types */
				break;
			}

341
			spin_unlock_irqrestore(&qp->r_lock, flags);
M
Mike Marciniszyn 已提交
342 343 344 345 346 347 348 349 350
			rcu_read_unlock();
		} /* Unicast QP */
	} /* Valid packet with TIDErr */

	/* handle "RcvTypeErr" flags */
	switch (rte) {
	case RHF_RTE_ERROR_OP_CODE_ERR:
	{
		void *ebuf = NULL;
351
		u8 opcode;
M
Mike Marciniszyn 已提交
352 353 354 355

		if (rhf_use_egr_bfr(packet->rhf))
			ebuf = packet->ebuf;

356
		if (!ebuf)
M
Mike Marciniszyn 已提交
357 358
			goto drop; /* this should never happen */

359
		opcode = ib_bth_get_opcode(packet->ohdr);
M
Mike Marciniszyn 已提交
360 361 362
		if (opcode == IB_OPCODE_CNP) {
			/*
			 * Only in pre-B0 h/w is the CNP_OPCODE handled
363
			 * via this code path.
M
Mike Marciniszyn 已提交
364
			 */
365
			struct rvt_qp *qp = NULL;
M
Mike Marciniszyn 已提交
366 367 368 369
			u32 lqpn, rqpn;
			u16 rlid;
			u8 svc_type, sl, sc5;

370
			sc5 = hfi1_9B_get_sc5(rhdr, packet->rhf);
M
Mike Marciniszyn 已提交
371 372
			sl = ibp->sc_to_sl[sc5];

373
			lqpn = ib_bth_get_qpn(packet->ohdr);
M
Mike Marciniszyn 已提交
374
			rcu_read_lock();
375
			qp = rvt_lookup_qpn(rdi, &ibp->rvp, lqpn);
376
			if (!qp) {
M
Mike Marciniszyn 已提交
377 378 379 380 381 382 383 384 385 386 387
				rcu_read_unlock();
				goto drop;
			}

			switch (qp->ibqp.qp_type) {
			case IB_QPT_UD:
				rlid = 0;
				rqpn = 0;
				svc_type = IB_CC_SVCTYPE_UD;
				break;
			case IB_QPT_UC:
388
				rlid = ib_get_slid(rhdr);
M
Mike Marciniszyn 已提交
389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411
				rqpn = qp->remote_qpn;
				svc_type = IB_CC_SVCTYPE_UC;
				break;
			default:
				goto drop;
			}

			process_becn(ppd, sl, rlid, lqpn, rqpn, svc_type);
			rcu_read_unlock();
		}

		packet->rhf &= ~RHF_RCV_TYPE_ERR_SMASK;
		break;
	}
	default:
		break;
	}

drop:
	return;
}

static inline void init_packet(struct hfi1_ctxtdata *rcd,
412
			       struct hfi1_packet *packet)
M
Mike Marciniszyn 已提交
413 414 415 416 417 418
{
	packet->rsize = rcd->rcvhdrqentsize; /* words */
	packet->maxcnt = rcd->rcvhdrq_cnt * packet->rsize; /* words */
	packet->rcd = rcd;
	packet->updegr = 0;
	packet->etail = -1;
419
	packet->rhf_addr = get_rhf_addr(rcd);
M
Mike Marciniszyn 已提交
420 421 422 423 424
	packet->rhf = rhf_to_cpu(packet->rhf_addr);
	packet->rhqoff = rcd->head;
	packet->numpkt = 0;
}

425 426
void hfi1_process_ecn_slowpath(struct rvt_qp *qp, struct hfi1_packet *pkt,
			       bool do_cnp)
M
Mike Marciniszyn 已提交
427 428
{
	struct hfi1_ibport *ibp = to_iport(qp->ibqp.device, qp->port_num);
429 430
	struct ib_header *hdr = pkt->hdr;
	struct ib_other_headers *ohdr = pkt->ohdr;
431
	struct ib_grh *grh = pkt->grh;
432
	u32 rqpn = 0, bth1;
433
	u16 rlid, dlid = ib_get_dlid(hdr);
434 435 436
	u8 sc, svc_type;
	bool is_mcast = false;

M
Mike Marciniszyn 已提交
437
	switch (qp->ibqp.qp_type) {
438 439
	case IB_QPT_SMI:
	case IB_QPT_GSI:
M
Mike Marciniszyn 已提交
440
	case IB_QPT_UD:
441
		rlid = ib_get_slid(hdr);
442
		rqpn = ib_get_sqpn(ohdr);
M
Mike Marciniszyn 已提交
443
		svc_type = IB_CC_SVCTYPE_UD;
444 445
		is_mcast = (dlid > be16_to_cpu(IB_MULTICAST_LID_BASE)) &&
			(dlid != be16_to_cpu(IB_LID_PERMISSIVE));
M
Mike Marciniszyn 已提交
446
		break;
447
	case IB_QPT_UC:
448
		rlid = rdma_ah_get_dlid(&qp->remote_ah_attr);
449 450 451 452
		rqpn = qp->remote_qpn;
		svc_type = IB_CC_SVCTYPE_UC;
		break;
	case IB_QPT_RC:
453
		rlid = rdma_ah_get_dlid(&qp->remote_ah_attr);
454 455 456
		rqpn = qp->remote_qpn;
		svc_type = IB_CC_SVCTYPE_RC;
		break;
M
Mike Marciniszyn 已提交
457 458 459 460
	default:
		return;
	}

461
	sc = hfi1_9B_get_sc5(hdr, pkt->rhf);
M
Mike Marciniszyn 已提交
462

463
	bth1 = be32_to_cpu(ohdr->bth[1]);
464
	if (do_cnp && (bth1 & IB_FECN_SMASK)) {
465
		u16 pkey = ib_bth_get_pkey(ohdr);
M
Mike Marciniszyn 已提交
466

467
		return_cnp(ibp, qp, rqpn, pkey, dlid, rlid, sc, grh);
M
Mike Marciniszyn 已提交
468 469
	}

470
	if (!is_mcast && (bth1 & IB_BECN_SMASK)) {
M
Mike Marciniszyn 已提交
471
		struct hfi1_pportdata *ppd = ppd_from_ibp(ibp);
472
		u32 lqpn = bth1 & RVT_QPN_MASK;
473
		u8 sl = ibp->sc_to_sl[sc];
M
Mike Marciniszyn 已提交
474

475
		process_becn(ppd, sl, rlid, lqpn, rqpn, svc_type);
M
Mike Marciniszyn 已提交
476
	}
477

M
Mike Marciniszyn 已提交
478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496
}

struct ps_mdata {
	struct hfi1_ctxtdata *rcd;
	u32 rsize;
	u32 maxcnt;
	u32 ps_head;
	u32 ps_tail;
	u32 ps_seq;
};

static inline void init_ps_mdata(struct ps_mdata *mdata,
				 struct hfi1_packet *packet)
{
	struct hfi1_ctxtdata *rcd = packet->rcd;

	mdata->rcd = rcd;
	mdata->rsize = packet->rsize;
	mdata->maxcnt = packet->maxcnt;
497
	mdata->ps_head = packet->rhqoff;
M
Mike Marciniszyn 已提交
498

499
	if (HFI1_CAP_KGET_MASK(rcd->flags, DMA_RTAIL)) {
500
		mdata->ps_tail = get_rcvhdrtail(rcd);
501 502 503 504
		if (rcd->ctxt == HFI1_CTRL_CTXT)
			mdata->ps_seq = rcd->seq_cnt;
		else
			mdata->ps_seq = 0; /* not used with DMA_RTAIL */
M
Mike Marciniszyn 已提交
505 506 507 508 509 510
	} else {
		mdata->ps_tail = 0; /* used only with DMA_RTAIL*/
		mdata->ps_seq = rcd->seq_cnt;
	}
}

511 512
static inline int ps_done(struct ps_mdata *mdata, u64 rhf,
			  struct hfi1_ctxtdata *rcd)
M
Mike Marciniszyn 已提交
513
{
514
	if (HFI1_CAP_KGET_MASK(rcd->flags, DMA_RTAIL))
M
Mike Marciniszyn 已提交
515 516 517 518
		return mdata->ps_head == mdata->ps_tail;
	return mdata->ps_seq != rhf_rcv_seq(rhf);
}

519 520 521 522 523 524 525 526 527 528 529 530 531 532 533
static inline int ps_skip(struct ps_mdata *mdata, u64 rhf,
			  struct hfi1_ctxtdata *rcd)
{
	/*
	 * Control context can potentially receive an invalid rhf.
	 * Drop such packets.
	 */
	if ((rcd->ctxt == HFI1_CTRL_CTXT) && (mdata->ps_head != mdata->ps_tail))
		return mdata->ps_seq != rhf_rcv_seq(rhf);

	return 0;
}

static inline void update_ps_mdata(struct ps_mdata *mdata,
				   struct hfi1_ctxtdata *rcd)
M
Mike Marciniszyn 已提交
534 535
{
	mdata->ps_head += mdata->rsize;
536
	if (mdata->ps_head >= mdata->maxcnt)
M
Mike Marciniszyn 已提交
537
		mdata->ps_head = 0;
538 539 540 541

	/* Control context must do seq counting */
	if (!HFI1_CAP_KGET_MASK(rcd->flags, DMA_RTAIL) ||
	    (rcd->ctxt == HFI1_CTRL_CTXT)) {
M
Mike Marciniszyn 已提交
542 543 544 545 546 547 548 549 550 551
		if (++mdata->ps_seq > 13)
			mdata->ps_seq = 1;
	}
}

/*
 * prescan_rxq - search through the receive queue looking for packets
 * containing Excplicit Congestion Notifications (FECNs, or BECNs).
 * When an ECN is found, process the Congestion Notification, and toggle
 * it off.
552 553
 * This is declared as a macro to allow quick checking of the port to avoid
 * the overhead of a function call if not enabled.
M
Mike Marciniszyn 已提交
554
 */
555 556 557 558 559 560
#define prescan_rxq(rcd, packet) \
	do { \
		if (rcd->ppd->cc_prescan) \
			__prescan_rxq(packet); \
	} while (0)
static void __prescan_rxq(struct hfi1_packet *packet)
M
Mike Marciniszyn 已提交
561 562 563 564 565 566 567 568
{
	struct hfi1_ctxtdata *rcd = packet->rcd;
	struct ps_mdata mdata;

	init_ps_mdata(&mdata, packet);

	while (1) {
		struct hfi1_devdata *dd = rcd->dd;
569
		struct hfi1_ibport *ibp = rcd_to_iport(rcd);
570
		__le32 *rhf_addr = (__le32 *)rcd->rcvhdrq + mdata.ps_head +
M
Mike Marciniszyn 已提交
571
					 dd->rhf_offset;
572
		struct rvt_qp *qp;
573
		struct ib_header *hdr;
574
		struct rvt_dev_info *rdi = &dd->verbs_dev.rdi;
M
Mike Marciniszyn 已提交
575
		u64 rhf = rhf_to_cpu(rhf_addr);
576
		u32 etype = rhf_rcv_type(rhf), qpn, bth1;
M
Mike Marciniszyn 已提交
577 578 579
		int is_ecn = 0;
		u8 lnh;

580
		if (ps_done(&mdata, rhf, rcd))
M
Mike Marciniszyn 已提交
581 582
			break;

583 584 585
		if (ps_skip(&mdata, rhf, rcd))
			goto next;

M
Mike Marciniszyn 已提交
586 587 588
		if (etype != RHF_RCV_TYPE_IB)
			goto next;

589 590
		packet->hdr = hfi1_get_msgheader(dd, rhf_addr);
		hdr = packet->hdr;
591
		lnh = ib_get_lnh(hdr);
M
Mike Marciniszyn 已提交
592

593 594
		if (lnh == HFI1_LRH_BTH) {
			packet->ohdr = &hdr->u.oth;
595
			packet->grh = NULL;
596 597
		} else if (lnh == HFI1_LRH_GRH) {
			packet->ohdr = &hdr->u.l.oth;
598
			packet->grh = &hdr->u.l.grh;
599
		} else {
M
Mike Marciniszyn 已提交
600
			goto next; /* just in case */
601
		}
602

603
		bth1 = be32_to_cpu(packet->ohdr->bth[1]);
604
		is_ecn = !!(bth1 & (IB_FECN_SMASK | IB_BECN_SMASK));
M
Mike Marciniszyn 已提交
605 606 607 608

		if (!is_ecn)
			goto next;

609
		qpn = bth1 & RVT_QPN_MASK;
M
Mike Marciniszyn 已提交
610
		rcu_read_lock();
611
		qp = rvt_lookup_qpn(rdi, &ibp->rvp, qpn);
M
Mike Marciniszyn 已提交
612

613
		if (!qp) {
M
Mike Marciniszyn 已提交
614 615 616 617
			rcu_read_unlock();
			goto next;
		}

618
		process_ecn(qp, packet, true);
M
Mike Marciniszyn 已提交
619
		rcu_read_unlock();
620 621

		/* turn off BECN, FECN */
622
		bth1 &= ~(IB_FECN_SMASK | IB_BECN_SMASK);
623
		packet->ohdr->bth[1] = cpu_to_be32(bth1);
M
Mike Marciniszyn 已提交
624
next:
625
		update_ps_mdata(&mdata, rcd);
M
Mike Marciniszyn 已提交
626 627
	}
}
628

629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671
static void process_rcv_qp_work(struct hfi1_ctxtdata *rcd)
{
	struct rvt_qp *qp, *nqp;

	/*
	 * Iterate over all QPs waiting to respond.
	 * The list won't change since the IRQ is only run on one CPU.
	 */
	list_for_each_entry_safe(qp, nqp, &rcd->qp_wait_list, rspwait) {
		list_del_init(&qp->rspwait);
		if (qp->r_flags & RVT_R_RSP_NAK) {
			qp->r_flags &= ~RVT_R_RSP_NAK;
			hfi1_send_rc_ack(rcd, qp, 0);
		}
		if (qp->r_flags & RVT_R_RSP_SEND) {
			unsigned long flags;

			qp->r_flags &= ~RVT_R_RSP_SEND;
			spin_lock_irqsave(&qp->s_lock, flags);
			if (ib_rvt_state_ops[qp->state] &
					RVT_PROCESS_OR_FLUSH_SEND)
				hfi1_schedule_send(qp);
			spin_unlock_irqrestore(&qp->s_lock, flags);
		}
		rvt_put_qp(qp);
	}
}

static noinline int max_packet_exceeded(struct hfi1_packet *packet, int thread)
{
	if (thread) {
		if ((packet->numpkt & (MAX_PKT_RECV_THREAD - 1)) == 0)
			/* allow defered processing */
			process_rcv_qp_work(packet->rcd);
		cond_resched();
		return RCV_PKT_OK;
	} else {
		this_cpu_inc(*packet->rcd->dd->rcv_limit);
		return RCV_PKT_LIMIT;
	}
}

static inline int check_max_packet(struct hfi1_packet *packet, int thread)
672 673 674
{
	int ret = RCV_PKT_OK;

675 676 677 678 679 680 681 682 683
	if (unlikely((packet->numpkt & (MAX_PKT_RECV - 1)) == 0))
		ret = max_packet_exceeded(packet, thread);
	return ret;
}

static noinline int skip_rcv_packet(struct hfi1_packet *packet, int thread)
{
	int ret;

684 685 686 687 688 689
	/* Set up for the next packet */
	packet->rhqoff += packet->rsize;
	if (packet->rhqoff >= packet->maxcnt)
		packet->rhqoff = 0;

	packet->numpkt++;
690
	ret = check_max_packet(packet, thread);
691 692 693 694 695 696 697

	packet->rhf_addr = (__le32 *)packet->rcd->rcvhdrq + packet->rhqoff +
				     packet->rcd->dd->rhf_offset;
	packet->rhf = rhf_to_cpu(packet->rhf_addr);

	return ret;
}
M
Mike Marciniszyn 已提交
698

699
static inline int process_rcv_packet(struct hfi1_packet *packet, int thread)
M
Mike Marciniszyn 已提交
700
{
701
	int ret;
M
Mike Marciniszyn 已提交
702 703

	packet->etype = rhf_rcv_type(packet->rhf);
704

M
Mike Marciniszyn 已提交
705 706 707 708 709 710 711 712 713 714 715 716 717 718
	/* total length */
	packet->tlen = rhf_pkt_len(packet->rhf); /* in bytes */
	/* retrieve eager buffer details */
	packet->ebuf = NULL;
	if (rhf_use_egr_bfr(packet->rhf)) {
		packet->etail = rhf_egr_index(packet->rhf);
		packet->ebuf = get_egrbuf(packet->rcd, packet->rhf,
				 &packet->updegr);
		/*
		 * Prefetch the contents of the eager buffer.  It is
		 * OK to send a negative length to prefetch_range().
		 * The +2 is the size of the RHF.
		 */
		prefetch_range(packet->ebuf,
719 720 721
			       packet->tlen - ((packet->rcd->rcvhdrqentsize -
					       (rhf_hdrq_offset(packet->rhf)
						+ 2)) * 4));
M
Mike Marciniszyn 已提交
722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739
	}

	/*
	 * Call a type specific handler for the packet. We
	 * should be able to trust that etype won't be beyond
	 * the range of valid indexes. If so something is really
	 * wrong and we can probably just let things come
	 * crashing down. There is no need to eat another
	 * comparison in this performance critical code.
	 */
	packet->rcd->dd->rhf_rcv_function_map[packet->etype](packet);
	packet->numpkt++;

	/* Set up for the next packet */
	packet->rhqoff += packet->rsize;
	if (packet->rhqoff >= packet->maxcnt)
		packet->rhqoff = 0;

740
	ret = check_max_packet(packet, thread);
M
Mike Marciniszyn 已提交
741

742
	packet->rhf_addr = (__le32 *)packet->rcd->rcvhdrq + packet->rhqoff +
M
Mike Marciniszyn 已提交
743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761
				      packet->rcd->dd->rhf_offset;
	packet->rhf = rhf_to_cpu(packet->rhf_addr);

	return ret;
}

static inline void process_rcv_update(int last, struct hfi1_packet *packet)
{
	/*
	 * Update head regs etc., every 16 packets, if not last pkt,
	 * to help prevent rcvhdrq overflows, when many packets
	 * are processed and queue is nearly full.
	 * Don't request an interrupt for intermediate updates.
	 */
	if (!last && !(packet->numpkt & 0xf)) {
		update_usrhead(packet->rcd, packet->rhqoff, packet->updegr,
			       packet->etail, 0, 0);
		packet->updegr = 0;
	}
762
	packet->grh = NULL;
M
Mike Marciniszyn 已提交
763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779
}

static inline void finish_packet(struct hfi1_packet *packet)
{
	/*
	 * Nothing we need to free for the packet.
	 *
	 * The only thing we need to do is a final update and call for an
	 * interrupt
	 */
	update_usrhead(packet->rcd, packet->rcd->head, packet->updegr,
		       packet->etail, rcv_intr_dynamic, packet->numpkt);
}

/*
 * Handle receive interrupts when using the no dma rtail option.
 */
780
int handle_receive_interrupt_nodma_rtail(struct hfi1_ctxtdata *rcd, int thread)
M
Mike Marciniszyn 已提交
781 782
{
	u32 seq;
783
	int last = RCV_PKT_OK;
M
Mike Marciniszyn 已提交
784 785 786 787
	struct hfi1_packet packet;

	init_packet(rcd, &packet);
	seq = rhf_rcv_seq(packet.rhf);
788 789
	if (seq != rcd->seq_cnt) {
		last = RCV_PKT_DONE;
M
Mike Marciniszyn 已提交
790
		goto bail;
791
	}
M
Mike Marciniszyn 已提交
792

793
	prescan_rxq(rcd, &packet);
M
Mike Marciniszyn 已提交
794

795 796
	while (last == RCV_PKT_OK) {
		last = process_rcv_packet(&packet, thread);
M
Mike Marciniszyn 已提交
797 798 799 800
		seq = rhf_rcv_seq(packet.rhf);
		if (++rcd->seq_cnt > 13)
			rcd->seq_cnt = 1;
		if (seq != rcd->seq_cnt)
801
			last = RCV_PKT_DONE;
M
Mike Marciniszyn 已提交
802 803
		process_rcv_update(last, &packet);
	}
804 805
	process_rcv_qp_work(rcd);
	rcd->head = packet.rhqoff;
M
Mike Marciniszyn 已提交
806 807
bail:
	finish_packet(&packet);
808
	return last;
M
Mike Marciniszyn 已提交
809 810
}

811
int handle_receive_interrupt_dma_rtail(struct hfi1_ctxtdata *rcd, int thread)
M
Mike Marciniszyn 已提交
812 813
{
	u32 hdrqtail;
814
	int last = RCV_PKT_OK;
M
Mike Marciniszyn 已提交
815 816 817 818
	struct hfi1_packet packet;

	init_packet(rcd, &packet);
	hdrqtail = get_rcvhdrtail(rcd);
819 820
	if (packet.rhqoff == hdrqtail) {
		last = RCV_PKT_DONE;
M
Mike Marciniszyn 已提交
821
		goto bail;
822
	}
M
Mike Marciniszyn 已提交
823 824
	smp_rmb();  /* prevent speculative reads of dma'ed hdrq */

825
	prescan_rxq(rcd, &packet);
M
Mike Marciniszyn 已提交
826

827 828
	while (last == RCV_PKT_OK) {
		last = process_rcv_packet(&packet, thread);
M
Mike Marciniszyn 已提交
829
		if (packet.rhqoff == hdrqtail)
830
			last = RCV_PKT_DONE;
M
Mike Marciniszyn 已提交
831 832
		process_rcv_update(last, &packet);
	}
833 834
	process_rcv_qp_work(rcd);
	rcd->head = packet.rhqoff;
M
Mike Marciniszyn 已提交
835 836
bail:
	finish_packet(&packet);
837
	return last;
M
Mike Marciniszyn 已提交
838 839
}

840
static inline void set_nodma_rtail(struct hfi1_devdata *dd, u8 ctxt)
M
Mike Marciniszyn 已提交
841 842 843
{
	int i;

844 845 846 847 848 849 850 851 852 853 854 855
	/*
	 * For dynamically allocated kernel contexts (like vnic) switch
	 * interrupt handler only for that context. Otherwise, switch
	 * interrupt handler for all statically allocated kernel contexts.
	 */
	if (ctxt >= dd->first_dyn_alloc_ctxt) {
		dd->rcd[ctxt]->do_interrupt =
			&handle_receive_interrupt_nodma_rtail;
		return;
	}

	for (i = HFI1_CTRL_CTXT + 1; i < dd->first_dyn_alloc_ctxt; i++)
M
Mike Marciniszyn 已提交
856 857 858 859
		dd->rcd[i]->do_interrupt =
			&handle_receive_interrupt_nodma_rtail;
}

860
static inline void set_dma_rtail(struct hfi1_devdata *dd, u8 ctxt)
M
Mike Marciniszyn 已提交
861 862 863
{
	int i;

864 865 866 867 868 869 870 871 872 873 874 875
	/*
	 * For dynamically allocated kernel contexts (like vnic) switch
	 * interrupt handler only for that context. Otherwise, switch
	 * interrupt handler for all statically allocated kernel contexts.
	 */
	if (ctxt >= dd->first_dyn_alloc_ctxt) {
		dd->rcd[ctxt]->do_interrupt =
			&handle_receive_interrupt_dma_rtail;
		return;
	}

	for (i = HFI1_CTRL_CTXT + 1; i < dd->first_dyn_alloc_ctxt; i++)
M
Mike Marciniszyn 已提交
876 877 878 879
		dd->rcd[i]->do_interrupt =
			&handle_receive_interrupt_dma_rtail;
}

880 881 882 883 884
void set_all_slowpath(struct hfi1_devdata *dd)
{
	int i;

	/* HFI1_CTRL_CTXT must always use the slow path interrupt handler */
885 886 887 888 889 890 891
	for (i = HFI1_CTRL_CTXT + 1; i < dd->num_rcv_contexts; i++) {
		struct hfi1_ctxtdata *rcd = dd->rcd[i];

		if ((i < dd->first_dyn_alloc_ctxt) ||
		    (rcd && rcd->sc && (rcd->sc->type == SC_KERNEL)))
			rcd->do_interrupt = &handle_receive_interrupt;
	}
892 893 894
}

static inline int set_armed_to_active(struct hfi1_ctxtdata *rcd,
895
				      struct hfi1_packet *packet,
896 897 898
				      struct hfi1_devdata *dd)
{
	struct work_struct *lsaw = &rcd->ppd->linkstate_active_work;
899
	u8 etype = rhf_rcv_type(packet->rhf);
900
	u8 sc = SC15_PACKET;
901

902 903 904 905 906 907
	if (etype == RHF_RCV_TYPE_IB) {
		struct ib_header *hdr = hfi1_get_msgheader(packet->rcd->dd,
							   packet->rhf_addr);
		sc = hfi1_9B_get_sc5(hdr, packet->rhf);
	}
	if (sc != SC15_PACKET) {
908
		int hwstate = driver_lstate(rcd->ppd);
909

910 911 912 913
		if (hwstate != IB_PORT_ACTIVE) {
			dd_dev_info(dd,
				    "Unexpected link state %s\n",
				    opa_lstate_name(hwstate));
914 915 916 917 918 919 920 921 922
			return 0;
		}

		queue_work(rcd->ppd->hfi1_wq, lsaw);
		return 1;
	}
	return 0;
}

M
Mike Marciniszyn 已提交
923 924 925 926 927 928 929
/*
 * handle_receive_interrupt - receive a packet
 * @rcd: the context
 *
 * Called from interrupt handler for errors or receive interrupt.
 * This is the slow path interrupt handler.
 */
930
int handle_receive_interrupt(struct hfi1_ctxtdata *rcd, int thread)
M
Mike Marciniszyn 已提交
931 932 933
{
	struct hfi1_devdata *dd = rcd->dd;
	u32 hdrqtail;
934
	int needset, last = RCV_PKT_OK;
M
Mike Marciniszyn 已提交
935
	struct hfi1_packet packet;
936 937 938 939
	int skip_pkt = 0;

	/* Control context will always use the slow path interrupt handler */
	needset = (rcd->ctxt == HFI1_CTRL_CTXT) ? 0 : 1;
M
Mike Marciniszyn 已提交
940 941 942

	init_packet(rcd, &packet);

943
	if (!HFI1_CAP_KGET_MASK(rcd->flags, DMA_RTAIL)) {
M
Mike Marciniszyn 已提交
944 945
		u32 seq = rhf_rcv_seq(packet.rhf);

946 947
		if (seq != rcd->seq_cnt) {
			last = RCV_PKT_DONE;
M
Mike Marciniszyn 已提交
948
			goto bail;
949
		}
M
Mike Marciniszyn 已提交
950 951 952
		hdrqtail = 0;
	} else {
		hdrqtail = get_rcvhdrtail(rcd);
953 954
		if (packet.rhqoff == hdrqtail) {
			last = RCV_PKT_DONE;
M
Mike Marciniszyn 已提交
955
			goto bail;
956
		}
M
Mike Marciniszyn 已提交
957
		smp_rmb();  /* prevent speculative reads of dma'ed hdrq */
958 959 960 961 962 963 964 965 966 967 968

		/*
		 * Control context can potentially receive an invalid
		 * rhf. Drop such packets.
		 */
		if (rcd->ctxt == HFI1_CTRL_CTXT) {
			u32 seq = rhf_rcv_seq(packet.rhf);

			if (seq != rcd->seq_cnt)
				skip_pkt = 1;
		}
M
Mike Marciniszyn 已提交
969 970
	}

971
	prescan_rxq(rcd, &packet);
M
Mike Marciniszyn 已提交
972

973
	while (last == RCV_PKT_OK) {
974 975 976
		if (unlikely(dd->do_drop &&
			     atomic_xchg(&dd->drop_packet, DROP_PACKET_OFF) ==
			     DROP_PACKET_ON)) {
M
Mike Marciniszyn 已提交
977 978 979 980
			dd->do_drop = 0;

			/* On to the next packet */
			packet.rhqoff += packet.rsize;
981
			packet.rhf_addr = (__le32 *)rcd->rcvhdrq +
M
Mike Marciniszyn 已提交
982 983 984 985
					  packet.rhqoff +
					  dd->rhf_offset;
			packet.rhf = rhf_to_cpu(packet.rhf_addr);

986 987 988
		} else if (skip_pkt) {
			last = skip_rcv_packet(&packet, thread);
			skip_pkt = 0;
M
Mike Marciniszyn 已提交
989
		} else {
990 991 992
			/* Auto activate link on non-SC15 packet receive */
			if (unlikely(rcd->ppd->host_link_state ==
				     HLS_UP_ARMED) &&
993
			    set_armed_to_active(rcd, &packet, dd))
994
				goto bail;
995
			last = process_rcv_packet(&packet, thread);
M
Mike Marciniszyn 已提交
996 997
		}

998
		if (!HFI1_CAP_KGET_MASK(rcd->flags, DMA_RTAIL)) {
M
Mike Marciniszyn 已提交
999 1000 1001 1002 1003
			u32 seq = rhf_rcv_seq(packet.rhf);

			if (++rcd->seq_cnt > 13)
				rcd->seq_cnt = 1;
			if (seq != rcd->seq_cnt)
1004
				last = RCV_PKT_DONE;
M
Mike Marciniszyn 已提交
1005
			if (needset) {
1006
				dd_dev_info(dd, "Switching to NO_DMA_RTAIL\n");
1007
				set_nodma_rtail(dd, rcd->ctxt);
M
Mike Marciniszyn 已提交
1008 1009 1010 1011
				needset = 0;
			}
		} else {
			if (packet.rhqoff == hdrqtail)
1012
				last = RCV_PKT_DONE;
1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025
			/*
			 * Control context can potentially receive an invalid
			 * rhf. Drop such packets.
			 */
			if (rcd->ctxt == HFI1_CTRL_CTXT) {
				u32 seq = rhf_rcv_seq(packet.rhf);

				if (++rcd->seq_cnt > 13)
					rcd->seq_cnt = 1;
				if (!last && (seq != rcd->seq_cnt))
					skip_pkt = 1;
			}

M
Mike Marciniszyn 已提交
1026 1027 1028
			if (needset) {
				dd_dev_info(dd,
					    "Switching to DMA_RTAIL\n");
1029
				set_dma_rtail(dd, rcd->ctxt);
M
Mike Marciniszyn 已提交
1030 1031 1032 1033 1034 1035 1036
				needset = 0;
			}
		}

		process_rcv_update(last, &packet);
	}

1037 1038
	process_rcv_qp_work(rcd);
	rcd->head = packet.rhqoff;
M
Mike Marciniszyn 已提交
1039 1040 1041 1042 1043 1044 1045

bail:
	/*
	 * Always write head at end, and setup rcv interrupt, even
	 * if no packets were processed.
	 */
	finish_packet(&packet);
1046
	return last;
M
Mike Marciniszyn 已提交
1047 1048
}

1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077
/*
 * We may discover in the interrupt that the hardware link state has
 * changed from ARMED to ACTIVE (due to the arrival of a non-SC15 packet),
 * and we need to update the driver's notion of the link state.  We cannot
 * run set_link_state from interrupt context, so we queue this function on
 * a workqueue.
 *
 * We delay the regular interrupt processing until after the state changes
 * so that the link will be in the correct state by the time any application
 * we wake up attempts to send a reply to any message it received.
 * (Subsequent receive interrupts may possibly force the wakeup before we
 * update the link state.)
 *
 * The rcd is freed in hfi1_free_ctxtdata after hfi1_postinit_cleanup invokes
 * dd->f_cleanup(dd) to disable the interrupt handler and flush workqueues,
 * so we're safe from use-after-free of the rcd.
 */
void receive_interrupt_work(struct work_struct *work)
{
	struct hfi1_pportdata *ppd = container_of(work, struct hfi1_pportdata,
						  linkstate_active_work);
	struct hfi1_devdata *dd = ppd->dd;
	int i;

	/* Received non-SC15 packet implies neighbor_normal */
	ppd->neighbor_normal = 1;
	set_link_state(ppd, HLS_UP_ACTIVE);

	/*
1078 1079
	 * Interrupt all statically allocated kernel contexts that could
	 * have had an interrupt during auto activation.
1080
	 */
1081
	for (i = HFI1_CTRL_CTXT; i < dd->first_dyn_alloc_ctxt; i++)
1082 1083 1084
		force_recv_intr(dd->rcd[i]);
}

M
Mike Marciniszyn 已提交
1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138
/*
 * Convert a given MTU size to the on-wire MAD packet enumeration.
 * Return -1 if the size is invalid.
 */
int mtu_to_enum(u32 mtu, int default_if_bad)
{
	switch (mtu) {
	case     0: return OPA_MTU_0;
	case   256: return OPA_MTU_256;
	case   512: return OPA_MTU_512;
	case  1024: return OPA_MTU_1024;
	case  2048: return OPA_MTU_2048;
	case  4096: return OPA_MTU_4096;
	case  8192: return OPA_MTU_8192;
	case 10240: return OPA_MTU_10240;
	}
	return default_if_bad;
}

u16 enum_to_mtu(int mtu)
{
	switch (mtu) {
	case OPA_MTU_0:     return 0;
	case OPA_MTU_256:   return 256;
	case OPA_MTU_512:   return 512;
	case OPA_MTU_1024:  return 1024;
	case OPA_MTU_2048:  return 2048;
	case OPA_MTU_4096:  return 4096;
	case OPA_MTU_8192:  return 8192;
	case OPA_MTU_10240: return 10240;
	default: return 0xffff;
	}
}

/*
 * set_mtu - set the MTU
 * @ppd: the per port data
 *
 * We can handle "any" incoming size, the issue here is whether we
 * need to restrict our outgoing size.  We do not deal with what happens
 * to programs that are already running when the size changes.
 */
int set_mtu(struct hfi1_pportdata *ppd)
{
	struct hfi1_devdata *dd = ppd->dd;
	int i, drain, ret = 0, is_up = 0;

	ppd->ibmtu = 0;
	for (i = 0; i < ppd->vls_supported; i++)
		if (ppd->ibmtu < dd->vld[i].mtu)
			ppd->ibmtu = dd->vld[i].mtu;
	ppd->ibmaxlen = ppd->ibmtu + lrh_max_header_bytes(ppd->dd);

	mutex_lock(&ppd->hls_lock);
1139 1140 1141
	if (ppd->host_link_state == HLS_UP_INIT ||
	    ppd->host_link_state == HLS_UP_ARMED ||
	    ppd->host_link_state == HLS_UP_ACTIVE)
M
Mike Marciniszyn 已提交
1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178
		is_up = 1;

	drain = !is_ax(dd) && is_up;

	if (drain)
		/*
		 * MTU is specified per-VL. To ensure that no packet gets
		 * stuck (due, e.g., to the MTU for the packet's VL being
		 * reduced), empty the per-VL FIFOs before adjusting MTU.
		 */
		ret = stop_drain_data_vls(dd);

	if (ret) {
		dd_dev_err(dd, "%s: cannot stop/drain VLs - refusing to change per-VL MTUs\n",
			   __func__);
		goto err;
	}

	hfi1_set_ib_cfg(ppd, HFI1_IB_CFG_MTU, 0);

	if (drain)
		open_fill_data_vls(dd); /* reopen all VLs */

err:
	mutex_unlock(&ppd->hls_lock);

	return ret;
}

int hfi1_set_lid(struct hfi1_pportdata *ppd, u32 lid, u8 lmc)
{
	struct hfi1_devdata *dd = ppd->dd;

	ppd->lid = lid;
	ppd->lmc = lmc;
	hfi1_set_ib_cfg(ppd, HFI1_IB_CFG_LIDLMC, 0);

1179
	dd_dev_info(dd, "port %u: got a lid: 0x%x\n", ppd->port, lid);
M
Mike Marciniszyn 已提交
1180 1181 1182 1183

	return 0;
}

1184 1185 1186 1187
void shutdown_led_override(struct hfi1_pportdata *ppd)
{
	struct hfi1_devdata *dd = ppd->dd;

1188
	/*
1189 1190 1191
	 * This pairs with the memory barrier in hfi1_start_led_override to
	 * ensure that we read the correct state of LED beaconing represented
	 * by led_override_timer_active
1192
	 */
1193
	smp_rmb();
1194 1195 1196
	if (atomic_read(&ppd->led_override_timer_active)) {
		del_timer_sync(&ppd->led_override_timer);
		atomic_set(&ppd->led_override_timer_active, 0);
1197 1198
		/* Ensure the atomic_set is visible to all CPUs */
		smp_wmb();
1199 1200
	}

1201 1202
	/* Hand control of the LED to the DC for normal operation */
	write_csr(dd, DCC_CFG_LED_CNTRL, 0);
1203
}
M
Mike Marciniszyn 已提交
1204 1205 1206 1207 1208

static void run_led_override(unsigned long opaque)
{
	struct hfi1_pportdata *ppd = (struct hfi1_pportdata *)opaque;
	struct hfi1_devdata *dd = ppd->dd;
1209 1210
	unsigned long timeout;
	int phase_idx;
M
Mike Marciniszyn 已提交
1211 1212 1213 1214

	if (!(dd->flags & HFI1_INITTED))
		return;

1215
	phase_idx = ppd->led_override_phase & 1;
M
Mike Marciniszyn 已提交
1216

1217 1218 1219
	setextled(dd, phase_idx);

	timeout = ppd->led_override_vals[phase_idx];
1220

1221 1222
	/* Set up for next phase */
	ppd->led_override_phase = !ppd->led_override_phase;
M
Mike Marciniszyn 已提交
1223

1224
	mod_timer(&ppd->led_override_timer, jiffies + timeout);
M
Mike Marciniszyn 已提交
1225 1226
}

1227 1228
/*
 * To have the LED blink in a particular pattern, provide timeon and timeoff
1229 1230 1231
 * in milliseconds.
 * To turn off custom blinking and return to normal operation, use
 * shutdown_led_override()
1232
 */
1233 1234
void hfi1_start_led_override(struct hfi1_pportdata *ppd, unsigned int timeon,
			     unsigned int timeoff)
M
Mike Marciniszyn 已提交
1235
{
1236
	if (!(ppd->dd->flags & HFI1_INITTED))
M
Mike Marciniszyn 已提交
1237 1238
		return;

1239 1240 1241
	/* Convert to jiffies for direct use in timer */
	ppd->led_override_vals[0] = msecs_to_jiffies(timeoff);
	ppd->led_override_vals[1] = msecs_to_jiffies(timeon);
M
Mike Marciniszyn 已提交
1242

1243 1244
	/* Arbitrarily start from LED on phase */
	ppd->led_override_phase = 1;
M
Mike Marciniszyn 已提交
1245 1246 1247

	/*
	 * If the timer has not already been started, do so. Use a "quick"
1248
	 * timeout so the handler will be called soon to look at our request.
M
Mike Marciniszyn 已提交
1249
	 */
1250
	if (!timer_pending(&ppd->led_override_timer)) {
1251
		setup_timer(&ppd->led_override_timer, run_led_override,
1252
			    (unsigned long)ppd);
M
Mike Marciniszyn 已提交
1253 1254
		ppd->led_override_timer.expires = jiffies + 1;
		add_timer(&ppd->led_override_timer);
1255 1256 1257
		atomic_set(&ppd->led_override_timer_active, 1);
		/* Ensure the atomic_set is visible to all CPUs */
		smp_wmb();
M
Mike Marciniszyn 已提交
1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284
	}
}

/**
 * hfi1_reset_device - reset the chip if possible
 * @unit: the device to reset
 *
 * Whether or not reset is successful, we attempt to re-initialize the chip
 * (that is, much like a driver unload/reload).  We clear the INITTED flag
 * so that the various entry points will fail until we reinitialize.  For
 * now, we only allow this if no user contexts are open that use chip resources
 */
int hfi1_reset_device(int unit)
{
	int ret, i;
	struct hfi1_devdata *dd = hfi1_lookup(unit);
	struct hfi1_pportdata *ppd;
	unsigned long flags;
	int pidx;

	if (!dd) {
		ret = -ENODEV;
		goto bail;
	}

	dd_dev_info(dd, "Reset on unit %u requested\n", unit);

1285
	if (!dd->kregbase1 || !(dd->flags & HFI1_PRESENT)) {
M
Mike Marciniszyn 已提交
1286
		dd_dev_info(dd,
1287 1288
			    "Invalid unit number %u or not initialized or not present\n",
			    unit);
M
Mike Marciniszyn 已提交
1289 1290 1291 1292 1293 1294
		ret = -ENXIO;
		goto bail;
	}

	spin_lock_irqsave(&dd->uctxt_lock, flags);
	if (dd->rcd)
1295 1296
		for (i = dd->first_dyn_alloc_ctxt;
		     i < dd->num_rcv_contexts; i++) {
1297
			if (!dd->rcd[i])
M
Mike Marciniszyn 已提交
1298 1299 1300 1301 1302 1303 1304 1305 1306 1307
				continue;
			spin_unlock_irqrestore(&dd->uctxt_lock, flags);
			ret = -EBUSY;
			goto bail;
		}
	spin_unlock_irqrestore(&dd->uctxt_lock, flags);

	for (pidx = 0; pidx < dd->num_pports; ++pidx) {
		ppd = dd->pport + pidx;

1308
		shutdown_led_override(ppd);
M
Mike Marciniszyn 已提交
1309 1310 1311 1312 1313 1314 1315 1316 1317 1318
	}
	if (dd->flags & HFI1_HAS_SEND_DMA)
		sdma_exit(dd);

	hfi1_reset_cpu_counters(dd);

	ret = hfi1_init(dd, 1);

	if (ret)
		dd_dev_err(dd,
1319 1320
			   "Reinitialize unit %u after reset failed with %d\n",
			   unit, ret);
M
Mike Marciniszyn 已提交
1321 1322
	else
		dd_dev_info(dd, "Reinitialized unit %u after resetting\n",
1323
			    unit);
M
Mike Marciniszyn 已提交
1324 1325 1326 1327 1328

bail:
	return ret;
}

1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380
static inline void hfi1_setup_ib_header(struct hfi1_packet *packet)
{
	packet->hdr = (struct hfi1_ib_message_header *)
			hfi1_get_msgheader(packet->rcd->dd,
					   packet->rhf_addr);
	packet->hlen = (u8 *)packet->rhf_addr - (u8 *)packet->hdr;
}

static int hfi1_setup_9B_packet(struct hfi1_packet *packet)
{
	struct hfi1_ibport *ibp = rcd_to_iport(packet->rcd);
	struct ib_header *hdr;
	u8 lnh;

	hfi1_setup_ib_header(packet);
	hdr = packet->hdr;

	lnh = ib_get_lnh(hdr);
	if (lnh == HFI1_LRH_BTH) {
		packet->ohdr = &hdr->u.oth;
		packet->grh = NULL;
	} else if (lnh == HFI1_LRH_GRH) {
		u32 vtf;

		packet->ohdr = &hdr->u.l.oth;
		packet->grh = &hdr->u.l.grh;
		if (packet->grh->next_hdr != IB_GRH_NEXT_HDR)
			goto drop;
		vtf = be32_to_cpu(packet->grh->version_tclass_flow);
		if ((vtf >> IB_GRH_VERSION_SHIFT) != IB_GRH_VERSION)
			goto drop;
	} else {
		goto drop;
	}

	/* Query commonly used fields from packet header */
	packet->opcode = ib_bth_get_opcode(packet->ohdr);
	packet->slid = ib_get_slid(hdr);
	packet->dlid = ib_get_dlid(hdr);
	packet->sl = ib_get_sl(hdr);
	packet->sc = hfi1_9B_get_sc5(hdr, packet->rhf);
	packet->pad = ib_bth_get_pad(packet->ohdr);
	packet->extra_byte = 0;
	packet->fecn = ib_bth_get_fecn(packet->ohdr);
	packet->becn = ib_bth_get_becn(packet->ohdr);

	return 0;
drop:
	ibp->rvp.n_pkt_drops++;
	return -EINVAL;
}

M
Mike Marciniszyn 已提交
1381 1382 1383 1384 1385 1386
void handle_eflags(struct hfi1_packet *packet)
{
	struct hfi1_ctxtdata *rcd = packet->rcd;
	u32 rte = rhf_rcv_type_err(packet->rhf);

	rcv_hdrerr(rcd, rcd->ppd, packet);
1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399
	if (rhf_err_flags(packet->rhf))
		dd_dev_err(rcd->dd,
			   "receive context %d: rhf 0x%016llx, errs [ %s%s%s%s%s%s%s%s] rte 0x%x\n",
			   rcd->ctxt, packet->rhf,
			   packet->rhf & RHF_K_HDR_LEN_ERR ? "k_hdr_len " : "",
			   packet->rhf & RHF_DC_UNC_ERR ? "dc_unc " : "",
			   packet->rhf & RHF_DC_ERR ? "dc " : "",
			   packet->rhf & RHF_TID_ERR ? "tid " : "",
			   packet->rhf & RHF_LEN_ERR ? "len " : "",
			   packet->rhf & RHF_ECC_ERR ? "ecc " : "",
			   packet->rhf & RHF_VCRC_ERR ? "vcrc " : "",
			   packet->rhf & RHF_ICRC_ERR ? "icrc " : "",
			   rte);
M
Mike Marciniszyn 已提交
1400 1401 1402 1403 1404 1405 1406 1407
}

/*
 * The following functions are called by the interrupt handler. They are type
 * specific handlers for each packet type.
 */
int process_receive_ib(struct hfi1_packet *packet)
{
1408 1409 1410
	if (unlikely(hfi1_dbg_fault_packet(packet)))
		return RHF_RCV_CONTINUE;

1411 1412 1413
	if (hfi1_setup_9B_packet(packet))
		return RHF_RCV_CONTINUE;

M
Mike Marciniszyn 已提交
1414 1415 1416 1417 1418 1419 1420 1421 1422
	trace_hfi1_rcvhdr(packet->rcd->ppd->dd,
			  packet->rcd->ctxt,
			  rhf_err_flags(packet->rhf),
			  RHF_RCV_TYPE_IB,
			  packet->hlen,
			  packet->tlen,
			  packet->updegr,
			  rhf_egr_index(packet->rhf));

1423 1424 1425 1426 1427
	if (unlikely(
		 (hfi1_dbg_fault_suppress_err(&packet->rcd->dd->verbs_dev) &&
		 (packet->rhf & RHF_DC_ERR))))
		return RHF_RCV_CONTINUE;

M
Mike Marciniszyn 已提交
1428 1429 1430 1431 1432 1433 1434 1435 1436
	if (unlikely(rhf_err_flags(packet->rhf))) {
		handle_eflags(packet);
		return RHF_RCV_CONTINUE;
	}

	hfi1_ib_rcv(packet);
	return RHF_RCV_CONTINUE;
}

1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449
static inline bool hfi1_is_vnic_packet(struct hfi1_packet *packet)
{
	/* Packet received in VNIC context via RSM */
	if (packet->rcd->is_vnic)
		return true;

	if ((HFI1_GET_L2_TYPE(packet->ebuf) == OPA_VNIC_L2_TYPE) &&
	    (HFI1_GET_L4_TYPE(packet->ebuf) == OPA_VNIC_L4_ETHR))
		return true;

	return false;
}

M
Mike Marciniszyn 已提交
1450 1451
int process_receive_bypass(struct hfi1_packet *packet)
{
1452 1453
	struct hfi1_devdata *dd = packet->rcd->dd;

1454
	if (unlikely(rhf_err_flags(packet->rhf))) {
M
Mike Marciniszyn 已提交
1455
		handle_eflags(packet);
1456 1457 1458 1459
	} else if (hfi1_is_vnic_packet(packet)) {
		hfi1_vnic_bypass_rcv(packet);
		return RHF_RCV_CONTINUE;
	}
M
Mike Marciniszyn 已提交
1460

1461
	dd_dev_err(dd, "Unsupported bypass packet. Dropping\n");
1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473
	incr_cntr64(&dd->sw_rcv_bypass_packet_errors);
	if (!(dd->err_info_rcvport.status_and_code & OPA_EI_STATUS_SMASK)) {
		u64 *flits = packet->ebuf;

		if (flits && !(packet->rhf & RHF_LEN_ERR)) {
			dd->err_info_rcvport.packet_flit1 = flits[0];
			dd->err_info_rcvport.packet_flit2 =
				packet->tlen > sizeof(flits[0]) ? flits[1] : 0;
		}
		dd->err_info_rcvport.status_and_code |=
			(OPA_EI_STATUS_SMASK | BAD_L2_ERR);
	}
M
Mike Marciniszyn 已提交
1474 1475 1476 1477 1478
	return RHF_RCV_CONTINUE;
}

int process_receive_error(struct hfi1_packet *packet)
{
1479 1480 1481 1482 1483 1484
	/* KHdrHCRCErr -- KDETH packet with a bad HCRC */
	if (unlikely(
		 hfi1_dbg_fault_suppress_err(&packet->rcd->dd->verbs_dev) &&
		 rhf_rcv_type_err(packet->rhf) == 3))
		return RHF_RCV_CONTINUE;

1485
	hfi1_setup_ib_header(packet);
M
Mike Marciniszyn 已提交
1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496
	handle_eflags(packet);

	if (unlikely(rhf_err_flags(packet->rhf)))
		dd_dev_err(packet->rcd->dd,
			   "Unhandled error packet received. Dropping.\n");

	return RHF_RCV_CONTINUE;
}

int kdeth_process_expected(struct hfi1_packet *packet)
{
1497 1498
	if (unlikely(hfi1_dbg_fault_packet(packet)))
		return RHF_RCV_CONTINUE;
1499 1500

	hfi1_setup_ib_header(packet);
M
Mike Marciniszyn 已提交
1501 1502 1503 1504 1505 1506 1507 1508 1509 1510
	if (unlikely(rhf_err_flags(packet->rhf)))
		handle_eflags(packet);

	dd_dev_err(packet->rcd->dd,
		   "Unhandled expected packet received. Dropping.\n");
	return RHF_RCV_CONTINUE;
}

int kdeth_process_eager(struct hfi1_packet *packet)
{
1511
	hfi1_setup_ib_header(packet);
M
Mike Marciniszyn 已提交
1512 1513
	if (unlikely(rhf_err_flags(packet->rhf)))
		handle_eflags(packet);
1514 1515
	if (unlikely(hfi1_dbg_fault_packet(packet)))
		return RHF_RCV_CONTINUE;
M
Mike Marciniszyn 已提交
1516 1517 1518 1519 1520 1521 1522 1523 1524

	dd_dev_err(packet->rcd->dd,
		   "Unhandled eager packet received. Dropping.\n");
	return RHF_RCV_CONTINUE;
}

int process_receive_invalid(struct hfi1_packet *packet)
{
	dd_dev_err(packet->rcd->dd, "Invalid packet type %d. Dropping\n",
1525
		   rhf_rcv_type(packet->rhf));
M
Mike Marciniszyn 已提交
1526 1527
	return RHF_RCV_CONTINUE;
}