ib_srp.c 98.6 KB
Newer Older
1 2 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
/*
 * Copyright (c) 2005 Cisco Systems.  All rights reserved.
 *
 * This software is available to you under a choice of one of two
 * licenses.  You may choose to be licensed under the terms of the GNU
 * General Public License (GPL) Version 2, available from the file
 * COPYING in the main directory of this source tree, or the
 * OpenIB.org BSD license below:
 *
 *     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.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 */

33
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
34

35 36 37 38 39 40 41
#include <linux/module.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/err.h>
#include <linux/string.h>
#include <linux/parser.h>
#include <linux/random.h>
42
#include <linux/jiffies.h>
43
#include <linux/lockdep.h>
44
#include <rdma/ib_cache.h>
45

A
Arun Sharma 已提交
46
#include <linux/atomic.h>
47 48 49 50

#include <scsi/scsi.h>
#include <scsi/scsi_device.h>
#include <scsi/scsi_dbg.h>
51
#include <scsi/scsi_tcq.h>
52
#include <scsi/srp.h>
53
#include <scsi/scsi_transport_srp.h>
54 55 56 57 58

#include "ib_srp.h"

#define DRV_NAME	"ib_srp"
#define PFX		DRV_NAME ": "
59 60
#define DRV_VERSION	"2.0"
#define DRV_RELDATE	"July 26, 2015"
61 62

MODULE_AUTHOR("Roland Dreier");
63
MODULE_DESCRIPTION("InfiniBand SCSI RDMA Protocol initiator");
64
MODULE_LICENSE("Dual BSD/GPL");
65 66
MODULE_VERSION(DRV_VERSION);
MODULE_INFO(release_date, DRV_RELDATE);
67

68 69 70 71 72
#if !defined(CONFIG_DYNAMIC_DEBUG)
#define DEFINE_DYNAMIC_DEBUG_METADATA(name, fmt)
#define DYNAMIC_DEBUG_BRANCH(descriptor) false
#endif

73 74
static unsigned int srp_sg_tablesize;
static unsigned int cmd_sg_entries;
75 76
static unsigned int indirect_sg_entries;
static bool allow_ext_sg;
77 78
static bool prefer_fr = true;
static bool register_always = true;
79
static bool never_register;
80
static int topspin_workarounds = 1;
81

82 83
module_param(srp_sg_tablesize, uint, 0444);
MODULE_PARM_DESC(srp_sg_tablesize, "Deprecated name for cmd_sg_entries");
84

85 86 87
module_param(cmd_sg_entries, uint, 0444);
MODULE_PARM_DESC(cmd_sg_entries,
		 "Default number of gather/scatter entries in the SRP command (default is 12, max 255)");
88

89 90
module_param(indirect_sg_entries, uint, 0444);
MODULE_PARM_DESC(indirect_sg_entries,
91
		 "Default max number of gather/scatter entries (default is 12, max is " __stringify(SG_MAX_SEGMENTS) ")");
92 93 94 95 96

module_param(allow_ext_sg, bool, 0444);
MODULE_PARM_DESC(allow_ext_sg,
		  "Default behavior when there are more than cmd_sg_entries S/G entries after mapping; fails the request when false (default false)");

97 98 99 100
module_param(topspin_workarounds, int, 0444);
MODULE_PARM_DESC(topspin_workarounds,
		 "Enable workarounds for Topspin/Cisco SRP target bugs if != 0");

101 102 103 104
module_param(prefer_fr, bool, 0444);
MODULE_PARM_DESC(prefer_fr,
"Whether to use fast registration if both FMR and fast registration are supported");

105 106 107 108
module_param(register_always, bool, 0444);
MODULE_PARM_DESC(register_always,
		 "Use memory registration even for contiguous memory regions");

109 110 111
module_param(never_register, bool, 0444);
MODULE_PARM_DESC(never_register, "Never register memory");

112
static const struct kernel_param_ops srp_tmo_ops;
113

114 115 116 117 118
static int srp_reconnect_delay = 10;
module_param_cb(reconnect_delay, &srp_tmo_ops, &srp_reconnect_delay,
		S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(reconnect_delay, "Time between successive reconnect attempts");

119 120 121 122 123 124 125 126
static int srp_fast_io_fail_tmo = 15;
module_param_cb(fast_io_fail_tmo, &srp_tmo_ops, &srp_fast_io_fail_tmo,
		S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(fast_io_fail_tmo,
		 "Number of seconds between the observation of a transport"
		 " layer error and failing all I/O. \"off\" means that this"
		 " functionality is disabled.");

127
static int srp_dev_loss_tmo = 600;
128 129 130 131 132 133 134 135 136 137
module_param_cb(dev_loss_tmo, &srp_tmo_ops, &srp_dev_loss_tmo,
		S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(dev_loss_tmo,
		 "Maximum number of seconds that the SRP transport should"
		 " insulate transport layer errors. After this time has been"
		 " exceeded the SCSI host is removed. Should be"
		 " between 1 and " __stringify(SCSI_DEVICE_BLOCK_MAX_TIMEOUT)
		 " if fast_io_fail_tmo has not been set. \"off\" means that"
		 " this functionality is disabled.");

B
Bart Van Assche 已提交
138 139 140 141 142
static unsigned ch_count;
module_param(ch_count, uint, 0444);
MODULE_PARM_DESC(ch_count,
		 "Number of RDMA channels to use for communication with an SRP target. Using more than one channel improves performance if the HCA supports multiple completion vectors. The default value is the minimum of four times the number of online CPU sockets and the number of completion vectors supported by the HCA.");

143
static void srp_add_one(struct ib_device *device);
144
static void srp_remove_one(struct ib_device *device, void *client_data);
C
Christoph Hellwig 已提交
145 146 147
static void srp_recv_done(struct ib_cq *cq, struct ib_wc *wc);
static void srp_handle_qp_err(struct ib_cq *cq, struct ib_wc *wc,
		const char *opname);
148 149
static int srp_cm_handler(struct ib_cm_id *cm_id, struct ib_cm_event *event);

150
static struct scsi_transport_template *ib_srp_transport_template;
151
static struct workqueue_struct *srp_remove_wq;
152

153 154 155 156 157 158
static struct ib_client srp_client = {
	.name   = "srp",
	.add    = srp_add_one,
	.remove = srp_remove_one
};

159 160
static struct ib_sa_client srp_sa_client;

161 162 163 164 165 166 167 168 169 170 171 172 173 174
static int srp_tmo_get(char *buffer, const struct kernel_param *kp)
{
	int tmo = *(int *)kp->arg;

	if (tmo >= 0)
		return sprintf(buffer, "%d", tmo);
	else
		return sprintf(buffer, "off");
}

static int srp_tmo_set(const char *val, const struct kernel_param *kp)
{
	int tmo, res;

175 176 177 178
	res = srp_parse_tmo(&tmo, val);
	if (res)
		goto out;

179 180 181 182 183
	if (kp->arg == &srp_reconnect_delay)
		res = srp_tmo_valid(tmo, srp_fast_io_fail_tmo,
				    srp_dev_loss_tmo);
	else if (kp->arg == &srp_fast_io_fail_tmo)
		res = srp_tmo_valid(srp_reconnect_delay, tmo, srp_dev_loss_tmo);
184
	else
185 186
		res = srp_tmo_valid(srp_reconnect_delay, srp_fast_io_fail_tmo,
				    tmo);
187 188 189 190 191 192 193 194
	if (res)
		goto out;
	*(int *)kp->arg = tmo;

out:
	return res;
}

195
static const struct kernel_param_ops srp_tmo_ops = {
196 197 198 199
	.get = srp_tmo_get,
	.set = srp_tmo_set,
};

200 201 202 203 204 205 206 207 208 209
static inline struct srp_target_port *host_to_target(struct Scsi_Host *host)
{
	return (struct srp_target_port *) host->hostdata;
}

static const char *srp_target_info(struct Scsi_Host *host)
{
	return host_to_target(host)->target_name;
}

210 211 212
static int srp_target_is_topspin(struct srp_target_port *target)
{
	static const u8 topspin_oui[3] = { 0x00, 0x05, 0xad };
213
	static const u8 cisco_oui[3]   = { 0x00, 0x1b, 0x0d };
214 215

	return topspin_workarounds &&
216 217
		(!memcmp(&target->ioc_guid, topspin_oui, sizeof topspin_oui) ||
		 !memcmp(&target->ioc_guid, cisco_oui, sizeof cisco_oui));
218 219
}

220 221 222 223 224 225 226 227 228 229 230 231 232 233
static struct srp_iu *srp_alloc_iu(struct srp_host *host, size_t size,
				   gfp_t gfp_mask,
				   enum dma_data_direction direction)
{
	struct srp_iu *iu;

	iu = kmalloc(sizeof *iu, gfp_mask);
	if (!iu)
		goto out;

	iu->buf = kzalloc(size, gfp_mask);
	if (!iu->buf)
		goto out_free_iu;

234 235 236
	iu->dma = ib_dma_map_single(host->srp_dev->dev, iu->buf, size,
				    direction);
	if (ib_dma_mapping_error(host->srp_dev->dev, iu->dma))
237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256
		goto out_free_buf;

	iu->size      = size;
	iu->direction = direction;

	return iu;

out_free_buf:
	kfree(iu->buf);
out_free_iu:
	kfree(iu);
out:
	return NULL;
}

static void srp_free_iu(struct srp_host *host, struct srp_iu *iu)
{
	if (!iu)
		return;

257 258
	ib_dma_unmap_single(host->srp_dev->dev, iu->dma, iu->size,
			    iu->direction);
259 260 261 262 263 264
	kfree(iu->buf);
	kfree(iu);
}

static void srp_qp_event(struct ib_event *event, void *context)
{
265 266
	pr_debug("QP event %s (%d)\n",
		 ib_event_msg(event->event), event->event);
267 268 269 270 271 272 273 274 275 276 277 278
}

static int srp_init_qp(struct srp_target_port *target,
		       struct ib_qp *qp)
{
	struct ib_qp_attr *attr;
	int ret;

	attr = kmalloc(sizeof *attr, GFP_KERNEL);
	if (!attr)
		return -ENOMEM;

279 280 281 282
	ret = ib_find_cached_pkey(target->srp_host->srp_dev->dev,
				  target->srp_host->port,
				  be16_to_cpu(target->pkey),
				  &attr->pkey_index);
283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301
	if (ret)
		goto out;

	attr->qp_state        = IB_QPS_INIT;
	attr->qp_access_flags = (IB_ACCESS_REMOTE_READ |
				    IB_ACCESS_REMOTE_WRITE);
	attr->port_num        = target->srp_host->port;

	ret = ib_modify_qp(qp, attr,
			   IB_QP_STATE		|
			   IB_QP_PKEY_INDEX	|
			   IB_QP_ACCESS_FLAGS	|
			   IB_QP_PORT);

out:
	kfree(attr);
	return ret;
}

302
static int srp_new_cm_id(struct srp_rdma_ch *ch)
D
David Dillow 已提交
303
{
304
	struct srp_target_port *target = ch->target;
D
David Dillow 已提交
305 306
	struct ib_cm_id *new_cm_id;

307
	new_cm_id = ib_create_cm_id(target->srp_host->srp_dev->dev,
308
				    srp_cm_handler, ch);
D
David Dillow 已提交
309 310 311
	if (IS_ERR(new_cm_id))
		return PTR_ERR(new_cm_id);

312 313 314 315 316 317 318
	if (ch->cm_id)
		ib_destroy_cm_id(ch->cm_id);
	ch->cm_id = new_cm_id;
	ch->path.sgid = target->sgid;
	ch->path.dgid = target->orig_dgid;
	ch->path.pkey = target->pkey;
	ch->path.service_id = target->service_id;
D
David Dillow 已提交
319 320 321 322

	return 0;
}

323 324 325 326 327 328
static struct ib_fmr_pool *srp_alloc_fmr_pool(struct srp_target_port *target)
{
	struct srp_device *dev = target->srp_host->srp_dev;
	struct ib_fmr_pool_param fmr_param;

	memset(&fmr_param, 0, sizeof(fmr_param));
329
	fmr_param.pool_size	    = target->mr_pool_size;
330 331
	fmr_param.dirty_watermark   = fmr_param.pool_size / 4;
	fmr_param.cache		    = 1;
332 333
	fmr_param.max_pages_per_fmr = dev->max_pages_per_mr;
	fmr_param.page_shift	    = ilog2(dev->mr_page_size);
334 335 336 337 338 339 340
	fmr_param.access	    = (IB_ACCESS_LOCAL_WRITE |
				       IB_ACCESS_REMOTE_WRITE |
				       IB_ACCESS_REMOTE_READ);

	return ib_create_fmr_pool(dev->pd, &fmr_param);
}

341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388
/**
 * srp_destroy_fr_pool() - free the resources owned by a pool
 * @pool: Fast registration pool to be destroyed.
 */
static void srp_destroy_fr_pool(struct srp_fr_pool *pool)
{
	int i;
	struct srp_fr_desc *d;

	if (!pool)
		return;

	for (i = 0, d = &pool->desc[0]; i < pool->size; i++, d++) {
		if (d->mr)
			ib_dereg_mr(d->mr);
	}
	kfree(pool);
}

/**
 * srp_create_fr_pool() - allocate and initialize a pool for fast registration
 * @device:            IB device to allocate fast registration descriptors for.
 * @pd:                Protection domain associated with the FR descriptors.
 * @pool_size:         Number of descriptors to allocate.
 * @max_page_list_len: Maximum fast registration work request page list length.
 */
static struct srp_fr_pool *srp_create_fr_pool(struct ib_device *device,
					      struct ib_pd *pd, int pool_size,
					      int max_page_list_len)
{
	struct srp_fr_pool *pool;
	struct srp_fr_desc *d;
	struct ib_mr *mr;
	int i, ret = -EINVAL;

	if (pool_size <= 0)
		goto err;
	ret = -ENOMEM;
	pool = kzalloc(sizeof(struct srp_fr_pool) +
		       pool_size * sizeof(struct srp_fr_desc), GFP_KERNEL);
	if (!pool)
		goto err;
	pool->size = pool_size;
	pool->max_page_list_len = max_page_list_len;
	spin_lock_init(&pool->lock);
	INIT_LIST_HEAD(&pool->free_list);

	for (i = 0, d = &pool->desc[0]; i < pool->size; i++, d++) {
389 390
		mr = ib_alloc_mr(pd, IB_MR_TYPE_MEM_REG,
				 max_page_list_len);
391 392
		if (IS_ERR(mr)) {
			ret = PTR_ERR(mr);
393 394 395
			if (ret == -ENOMEM)
				pr_info("%s: ib_alloc_mr() failed. Try to reduce max_cmd_per_lun, max_sect or ch_count\n",
					dev_name(&device->dev));
396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456
			goto destroy_pool;
		}
		d->mr = mr;
		list_add_tail(&d->entry, &pool->free_list);
	}

out:
	return pool;

destroy_pool:
	srp_destroy_fr_pool(pool);

err:
	pool = ERR_PTR(ret);
	goto out;
}

/**
 * srp_fr_pool_get() - obtain a descriptor suitable for fast registration
 * @pool: Pool to obtain descriptor from.
 */
static struct srp_fr_desc *srp_fr_pool_get(struct srp_fr_pool *pool)
{
	struct srp_fr_desc *d = NULL;
	unsigned long flags;

	spin_lock_irqsave(&pool->lock, flags);
	if (!list_empty(&pool->free_list)) {
		d = list_first_entry(&pool->free_list, typeof(*d), entry);
		list_del(&d->entry);
	}
	spin_unlock_irqrestore(&pool->lock, flags);

	return d;
}

/**
 * srp_fr_pool_put() - put an FR descriptor back in the free list
 * @pool: Pool the descriptor was allocated from.
 * @desc: Pointer to an array of fast registration descriptor pointers.
 * @n:    Number of descriptors to put back.
 *
 * Note: The caller must already have queued an invalidation request for
 * desc->mr->rkey before calling this function.
 */
static void srp_fr_pool_put(struct srp_fr_pool *pool, struct srp_fr_desc **desc,
			    int n)
{
	unsigned long flags;
	int i;

	spin_lock_irqsave(&pool->lock, flags);
	for (i = 0; i < n; i++)
		list_add(&desc[i]->entry, &pool->free_list);
	spin_unlock_irqrestore(&pool->lock, flags);
}

static struct srp_fr_pool *srp_alloc_fr_pool(struct srp_target_port *target)
{
	struct srp_device *dev = target->srp_host->srp_dev;

457
	return srp_create_fr_pool(dev->dev, dev->pd, target->mr_pool_size,
458 459 460
				  dev->max_pages_per_mr);
}

461 462
/**
 * srp_destroy_qp() - destroy an RDMA queue pair
463
 * @qp: RDMA queue pair.
464
 *
S
Steve Wise 已提交
465 466
 * Drain the qp before destroying it.  This avoids that the receive
 * completion handler can access the queue pair while it is
467 468
 * being destroyed.
 */
469
static void srp_destroy_qp(struct ib_qp *qp)
470
{
471 472
	ib_drain_rq(qp);
	ib_destroy_qp(qp);
473 474
}

475
static int srp_create_ch_ib(struct srp_rdma_ch *ch)
476
{
477
	struct srp_target_port *target = ch->target;
478
	struct srp_device *dev = target->srp_host->srp_dev;
479
	struct ib_qp_init_attr *init_attr;
480 481
	struct ib_cq *recv_cq, *send_cq;
	struct ib_qp *qp;
482
	struct ib_fmr_pool *fmr_pool = NULL;
483
	struct srp_fr_pool *fr_pool = NULL;
484
	const int m = 1 + dev->use_fast_reg * target->mr_per_cmd * 2;
485 486 487 488 489 490
	int ret;

	init_attr = kzalloc(sizeof *init_attr, GFP_KERNEL);
	if (!init_attr)
		return -ENOMEM;

S
Steve Wise 已提交
491
	/* queue_size + 1 for ib_drain_rq() */
C
Christoph Hellwig 已提交
492 493
	recv_cq = ib_alloc_cq(dev->dev, ch, target->queue_size + 1,
				ch->comp_vector, IB_POLL_SOFTIRQ);
494 495
	if (IS_ERR(recv_cq)) {
		ret = PTR_ERR(recv_cq);
496
		goto err;
497 498
	}

C
Christoph Hellwig 已提交
499 500
	send_cq = ib_alloc_cq(dev->dev, ch, m * target->queue_size,
				ch->comp_vector, IB_POLL_DIRECT);
501 502
	if (IS_ERR(send_cq)) {
		ret = PTR_ERR(send_cq);
503
		goto err_recv_cq;
504 505
	}

506
	init_attr->event_handler       = srp_qp_event;
507
	init_attr->cap.max_send_wr     = m * target->queue_size;
508
	init_attr->cap.max_recv_wr     = target->queue_size + 1;
509 510
	init_attr->cap.max_recv_sge    = 1;
	init_attr->cap.max_send_sge    = 1;
511
	init_attr->sq_sig_type         = IB_SIGNAL_REQ_WR;
512
	init_attr->qp_type             = IB_QPT_RC;
513 514
	init_attr->send_cq             = send_cq;
	init_attr->recv_cq             = recv_cq;
515

516
	qp = ib_create_qp(dev->pd, init_attr);
517 518
	if (IS_ERR(qp)) {
		ret = PTR_ERR(qp);
519
		goto err_send_cq;
520 521
	}

522
	ret = srp_init_qp(target, qp);
523 524
	if (ret)
		goto err_qp;
525

526
	if (dev->use_fast_reg) {
527 528 529 530 531 532 533
		fr_pool = srp_alloc_fr_pool(target);
		if (IS_ERR(fr_pool)) {
			ret = PTR_ERR(fr_pool);
			shost_printk(KERN_WARNING, target->scsi_host, PFX
				     "FR pool allocation failed (%d)\n", ret);
			goto err_qp;
		}
534
	} else if (dev->use_fmr) {
535 536 537 538 539 540 541 542 543
		fmr_pool = srp_alloc_fmr_pool(target);
		if (IS_ERR(fmr_pool)) {
			ret = PTR_ERR(fmr_pool);
			shost_printk(KERN_WARNING, target->scsi_host, PFX
				     "FMR pool allocation failed (%d)\n", ret);
			goto err_qp;
		}
	}

544
	if (ch->qp)
545
		srp_destroy_qp(ch->qp);
546
	if (ch->recv_cq)
C
Christoph Hellwig 已提交
547
		ib_free_cq(ch->recv_cq);
548
	if (ch->send_cq)
C
Christoph Hellwig 已提交
549
		ib_free_cq(ch->send_cq);
550

551 552 553
	ch->qp = qp;
	ch->recv_cq = recv_cq;
	ch->send_cq = send_cq;
554

555 556 557 558 559 560 561 562 563 564
	if (dev->use_fast_reg) {
		if (ch->fr_pool)
			srp_destroy_fr_pool(ch->fr_pool);
		ch->fr_pool = fr_pool;
	} else if (dev->use_fmr) {
		if (ch->fmr_pool)
			ib_destroy_fmr_pool(ch->fmr_pool);
		ch->fmr_pool = fmr_pool;
	}

565 566 567 568
	kfree(init_attr);
	return 0;

err_qp:
569
	srp_destroy_qp(qp);
570 571

err_send_cq:
C
Christoph Hellwig 已提交
572
	ib_free_cq(send_cq);
573 574

err_recv_cq:
C
Christoph Hellwig 已提交
575
	ib_free_cq(recv_cq);
576 577

err:
578 579 580 581
	kfree(init_attr);
	return ret;
}

582 583
/*
 * Note: this function may be called without srp_alloc_iu_bufs() having been
584
 * invoked. Hence the ch->[rt]x_ring checks.
585
 */
586 587
static void srp_free_ch_ib(struct srp_target_port *target,
			   struct srp_rdma_ch *ch)
588
{
589
	struct srp_device *dev = target->srp_host->srp_dev;
590 591
	int i;

B
Bart Van Assche 已提交
592 593 594
	if (!ch->target)
		return;

595 596 597
	if (ch->cm_id) {
		ib_destroy_cm_id(ch->cm_id);
		ch->cm_id = NULL;
598 599
	}

B
Bart Van Assche 已提交
600 601 602 603
	/* If srp_new_cm_id() succeeded but srp_create_ch_ib() not, return. */
	if (!ch->qp)
		return;

604
	if (dev->use_fast_reg) {
605 606
		if (ch->fr_pool)
			srp_destroy_fr_pool(ch->fr_pool);
607
	} else if (dev->use_fmr) {
608 609
		if (ch->fmr_pool)
			ib_destroy_fmr_pool(ch->fmr_pool);
610
	}
C
Christoph Hellwig 已提交
611

612
	srp_destroy_qp(ch->qp);
C
Christoph Hellwig 已提交
613 614
	ib_free_cq(ch->send_cq);
	ib_free_cq(ch->recv_cq);
615

B
Bart Van Assche 已提交
616 617 618 619 620 621 622 623
	/*
	 * Avoid that the SCSI error handler tries to use this channel after
	 * it has been freed. The SCSI error handler can namely continue
	 * trying to perform recovery actions after scsi_remove_host()
	 * returned.
	 */
	ch->target = NULL;

624 625
	ch->qp = NULL;
	ch->send_cq = ch->recv_cq = NULL;
626

627
	if (ch->rx_ring) {
628
		for (i = 0; i < target->queue_size; ++i)
629 630 631
			srp_free_iu(target->srp_host, ch->rx_ring[i]);
		kfree(ch->rx_ring);
		ch->rx_ring = NULL;
632
	}
633
	if (ch->tx_ring) {
634
		for (i = 0; i < target->queue_size; ++i)
635 636 637
			srp_free_iu(target->srp_host, ch->tx_ring[i]);
		kfree(ch->tx_ring);
		ch->tx_ring = NULL;
638
	}
639 640 641 642
}

static void srp_path_rec_completion(int status,
				    struct ib_sa_path_rec *pathrec,
643
				    void *ch_ptr)
644
{
645 646
	struct srp_rdma_ch *ch = ch_ptr;
	struct srp_target_port *target = ch->target;
647

648
	ch->status = status;
649
	if (status)
650 651
		shost_printk(KERN_ERR, target->scsi_host,
			     PFX "Got failed path rec status %d\n", status);
652
	else
653 654
		ch->path = *pathrec;
	complete(&ch->done);
655 656
}

657
static int srp_lookup_path(struct srp_rdma_ch *ch)
658
{
659
	struct srp_target_port *target = ch->target;
660 661
	int ret;

662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682
	ch->path.numb_path = 1;

	init_completion(&ch->done);

	ch->path_query_id = ib_sa_path_rec_get(&srp_sa_client,
					       target->srp_host->srp_dev->dev,
					       target->srp_host->port,
					       &ch->path,
					       IB_SA_PATH_REC_SERVICE_ID |
					       IB_SA_PATH_REC_DGID	 |
					       IB_SA_PATH_REC_SGID	 |
					       IB_SA_PATH_REC_NUMB_PATH	 |
					       IB_SA_PATH_REC_PKEY,
					       SRP_PATH_REC_TIMEOUT_MS,
					       GFP_KERNEL,
					       srp_path_rec_completion,
					       ch, &ch->path_query);
	if (ch->path_query_id < 0)
		return ch->path_query_id;

	ret = wait_for_completion_interruptible(&ch->done);
683 684
	if (ret < 0)
		return ret;
685

686
	if (ch->status < 0)
687 688
		shost_printk(KERN_WARNING, target->scsi_host,
			     PFX "Path record query failed\n");
689

690
	return ch->status;
691 692
}

B
Bart Van Assche 已提交
693
static int srp_send_req(struct srp_rdma_ch *ch, bool multich)
694
{
695
	struct srp_target_port *target = ch->target;
696 697 698 699 700 701 702 703 704 705
	struct {
		struct ib_cm_req_param param;
		struct srp_login_req   priv;
	} *req = NULL;
	int status;

	req = kzalloc(sizeof *req, GFP_KERNEL);
	if (!req)
		return -ENOMEM;

706
	req->param.primary_path		      = &ch->path;
707 708
	req->param.alternate_path 	      = NULL;
	req->param.service_id 		      = target->service_id;
709 710
	req->param.qp_num		      = ch->qp->qp_num;
	req->param.qp_type		      = ch->qp->qp_type;
711 712 713 714 715 716 717 718 719 720 721 722 723 724
	req->param.private_data 	      = &req->priv;
	req->param.private_data_len 	      = sizeof req->priv;
	req->param.flow_control 	      = 1;

	get_random_bytes(&req->param.starting_psn, 4);
	req->param.starting_psn 	     &= 0xffffff;

	/*
	 * Pick some arbitrary defaults here; we could make these
	 * module parameters if anyone cared about setting them.
	 */
	req->param.responder_resources	      = 4;
	req->param.remote_cm_response_timeout = 20;
	req->param.local_cm_response_timeout  = 20;
725
	req->param.retry_count                = target->tl_retry_count;
726 727 728 729 730
	req->param.rnr_retry_count 	      = 7;
	req->param.max_cm_retries 	      = 15;

	req->priv.opcode     	= SRP_LOGIN_REQ;
	req->priv.tag        	= 0;
731
	req->priv.req_it_iu_len = cpu_to_be32(target->max_iu_len);
732 733
	req->priv.req_buf_fmt 	= cpu_to_be16(SRP_BUF_FORMAT_DIRECT |
					      SRP_BUF_FORMAT_INDIRECT);
B
Bart Van Assche 已提交
734 735
	req->priv.req_flags	= (multich ? SRP_MULTICHAN_MULTI :
				   SRP_MULTICHAN_SINGLE);
736
	/*
R
Roland Dreier 已提交
737
	 * In the published SRP specification (draft rev. 16a), the
738 739 740 741 742 743 744 745 746
	 * port identifier format is 8 bytes of ID extension followed
	 * by 8 bytes of GUID.  Older drafts put the two halves in the
	 * opposite order, so that the GUID comes first.
	 *
	 * Targets conforming to these obsolete drafts can be
	 * recognized by the I/O Class they report.
	 */
	if (target->io_class == SRP_REV10_IB_IO_CLASS) {
		memcpy(req->priv.initiator_port_id,
747
		       &target->sgid.global.interface_id, 8);
748
		memcpy(req->priv.initiator_port_id + 8,
749
		       &target->initiator_ext, 8);
750 751 752 753
		memcpy(req->priv.target_port_id,     &target->ioc_guid, 8);
		memcpy(req->priv.target_port_id + 8, &target->id_ext, 8);
	} else {
		memcpy(req->priv.initiator_port_id,
754 755
		       &target->initiator_ext, 8);
		memcpy(req->priv.initiator_port_id + 8,
756
		       &target->sgid.global.interface_id, 8);
757 758 759 760
		memcpy(req->priv.target_port_id,     &target->id_ext, 8);
		memcpy(req->priv.target_port_id + 8, &target->ioc_guid, 8);
	}

761 762
	/*
	 * Topspin/Cisco SRP targets will reject our login unless we
763 764
	 * zero out the first 8 bytes of our initiator port ID and set
	 * the second 8 bytes to the local node GUID.
765
	 */
766
	if (srp_target_is_topspin(target)) {
767 768 769
		shost_printk(KERN_DEBUG, target->scsi_host,
			     PFX "Topspin/Cisco initiator port ID workaround "
			     "activated for target GUID %016llx\n",
770
			     be64_to_cpu(target->ioc_guid));
771
		memset(req->priv.initiator_port_id, 0, 8);
772
		memcpy(req->priv.initiator_port_id + 8,
773
		       &target->srp_host->srp_dev->dev->node_guid, 8);
774 775
	}

776
	status = ib_send_cm_req(ch->cm_id, &req->param);
777 778 779 780 781 782

	kfree(req);

	return status;
}

783 784 785 786 787 788 789 790 791 792 793 794
static bool srp_queue_remove_work(struct srp_target_port *target)
{
	bool changed = false;

	spin_lock_irq(&target->lock);
	if (target->state != SRP_TARGET_REMOVED) {
		target->state = SRP_TARGET_REMOVED;
		changed = true;
	}
	spin_unlock_irq(&target->lock);

	if (changed)
795
		queue_work(srp_remove_wq, &target->remove_work);
796 797 798 799

	return changed;
}

800 801
static void srp_disconnect_target(struct srp_target_port *target)
{
B
Bart Van Assche 已提交
802 803
	struct srp_rdma_ch *ch;
	int i;
804

805
	/* XXX should send SRP_I_LOGOUT request */
806

807 808 809 810 811 812
	for (i = 0; i < target->ch_count; i++) {
		ch = &target->ch[i];
		ch->connected = false;
		if (ch->cm_id && ib_send_cm_dreq(ch->cm_id, NULL, 0)) {
			shost_printk(KERN_DEBUG, target->scsi_host,
				     PFX "Sending CM DREQ failed\n");
813
		}
814
	}
815 816
}

817 818
static void srp_free_req_data(struct srp_target_port *target,
			      struct srp_rdma_ch *ch)
819
{
820 821
	struct srp_device *dev = target->srp_host->srp_dev;
	struct ib_device *ibdev = dev->dev;
822 823 824
	struct srp_request *req;
	int i;

825
	if (!ch->req_ring)
826 827 828
		return;

	for (i = 0; i < target->req_ring_size; ++i) {
829
		req = &ch->req_ring[i];
830
		if (dev->use_fast_reg) {
831
			kfree(req->fr_list);
832
		} else {
833
			kfree(req->fmr_list);
834 835
			kfree(req->map_page);
		}
836 837 838 839 840 841
		if (req->indirect_dma_addr) {
			ib_dma_unmap_single(ibdev, req->indirect_dma_addr,
					    target->indirect_size,
					    DMA_TO_DEVICE);
		}
		kfree(req->indirect_desc);
842
	}
843

844 845
	kfree(ch->req_ring);
	ch->req_ring = NULL;
846 847
}

848
static int srp_alloc_req_data(struct srp_rdma_ch *ch)
849
{
850
	struct srp_target_port *target = ch->target;
851 852 853
	struct srp_device *srp_dev = target->srp_host->srp_dev;
	struct ib_device *ibdev = srp_dev->dev;
	struct srp_request *req;
854
	void *mr_list;
855 856 857
	dma_addr_t dma_addr;
	int i, ret = -ENOMEM;

858 859 860
	ch->req_ring = kcalloc(target->req_ring_size, sizeof(*ch->req_ring),
			       GFP_KERNEL);
	if (!ch->req_ring)
861 862 863
		goto out;

	for (i = 0; i < target->req_ring_size; ++i) {
864
		req = &ch->req_ring[i];
865
		mr_list = kmalloc(target->mr_per_cmd * sizeof(void *),
866 867 868
				  GFP_KERNEL);
		if (!mr_list)
			goto out;
869
		if (srp_dev->use_fast_reg) {
870
			req->fr_list = mr_list;
871
		} else {
872
			req->fmr_list = mr_list;
873 874 875 876 877
			req->map_page = kmalloc(srp_dev->max_pages_per_mr *
						sizeof(void *), GFP_KERNEL);
			if (!req->map_page)
				goto out;
		}
878
		req->indirect_desc = kmalloc(target->indirect_size, GFP_KERNEL);
879
		if (!req->indirect_desc)
880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895
			goto out;

		dma_addr = ib_dma_map_single(ibdev, req->indirect_desc,
					     target->indirect_size,
					     DMA_TO_DEVICE);
		if (ib_dma_mapping_error(ibdev, dma_addr))
			goto out;

		req->indirect_dma_addr = dma_addr;
	}
	ret = 0;

out:
	return ret;
}

896 897 898 899 900 901 902 903 904 905 906 907 908 909 910
/**
 * srp_del_scsi_host_attr() - Remove attributes defined in the host template.
 * @shost: SCSI host whose attributes to remove from sysfs.
 *
 * Note: Any attributes defined in the host template and that did not exist
 * before invocation of this function will be ignored.
 */
static void srp_del_scsi_host_attr(struct Scsi_Host *shost)
{
	struct device_attribute **attr;

	for (attr = shost->hostt->shost_attrs; attr && *attr; ++attr)
		device_remove_file(&shost->shost_dev, *attr);
}

911 912
static void srp_remove_target(struct srp_target_port *target)
{
B
Bart Van Assche 已提交
913 914
	struct srp_rdma_ch *ch;
	int i;
915

916 917
	WARN_ON_ONCE(target->state != SRP_TARGET_REMOVED);

918
	srp_del_scsi_host_attr(target->scsi_host);
919
	srp_rport_get(target->rport);
920 921
	srp_remove_host(target->scsi_host);
	scsi_remove_host(target->scsi_host);
922
	srp_stop_rport_timers(target->rport);
923
	srp_disconnect_target(target);
B
Bart Van Assche 已提交
924 925 926 927
	for (i = 0; i < target->ch_count; i++) {
		ch = &target->ch[i];
		srp_free_ch_ib(target, ch);
	}
928
	cancel_work_sync(&target->tl_err_work);
929
	srp_rport_put(target->rport);
B
Bart Van Assche 已提交
930 931 932 933 934 935
	for (i = 0; i < target->ch_count; i++) {
		ch = &target->ch[i];
		srp_free_req_data(target, ch);
	}
	kfree(target->ch);
	target->ch = NULL;
936 937 938 939 940

	spin_lock(&target->srp_host->target_lock);
	list_del(&target->list);
	spin_unlock(&target->srp_host->target_lock);

941 942 943
	scsi_host_put(target->scsi_host);
}

D
David Howells 已提交
944
static void srp_remove_work(struct work_struct *work)
945
{
D
David Howells 已提交
946
	struct srp_target_port *target =
947
		container_of(work, struct srp_target_port, remove_work);
948

949
	WARN_ON_ONCE(target->state != SRP_TARGET_REMOVED);
950

951
	srp_remove_target(target);
952 953
}

954 955 956 957 958 959 960
static void srp_rport_delete(struct srp_rport *rport)
{
	struct srp_target_port *target = rport->lld_data;

	srp_queue_remove_work(target);
}

961 962 963 964 965 966 967 968 969 970 971 972 973 974
/**
 * srp_connected_ch() - number of connected channels
 * @target: SRP target port.
 */
static int srp_connected_ch(struct srp_target_port *target)
{
	int i, c = 0;

	for (i = 0; i < target->ch_count; i++)
		c += target->ch[i].connected;

	return c;
}

B
Bart Van Assche 已提交
975
static int srp_connect_ch(struct srp_rdma_ch *ch, bool multich)
976
{
977
	struct srp_target_port *target = ch->target;
978 979
	int ret;

980
	WARN_ON_ONCE(!multich && srp_connected_ch(target) > 0);
981

982
	ret = srp_lookup_path(ch);
983
	if (ret)
B
Bart Van Assche 已提交
984
		goto out;
985 986

	while (1) {
987
		init_completion(&ch->done);
B
Bart Van Assche 已提交
988
		ret = srp_send_req(ch, multich);
989
		if (ret)
B
Bart Van Assche 已提交
990
			goto out;
991
		ret = wait_for_completion_interruptible(&ch->done);
992
		if (ret < 0)
B
Bart Van Assche 已提交
993
			goto out;
994 995 996 997 998 999 1000

		/*
		 * The CM event handling code will set status to
		 * SRP_PORT_REDIRECT if we get a port redirect REJ
		 * back, or SRP_DLID_REDIRECT if we get a lid/qp
		 * redirect REJ back.
		 */
B
Bart Van Assche 已提交
1001 1002
		ret = ch->status;
		switch (ret) {
1003
		case 0:
1004
			ch->connected = true;
B
Bart Van Assche 已提交
1005
			goto out;
1006 1007

		case SRP_PORT_REDIRECT:
1008
			ret = srp_lookup_path(ch);
1009
			if (ret)
B
Bart Van Assche 已提交
1010
				goto out;
1011 1012 1013 1014 1015
			break;

		case SRP_DLID_REDIRECT:
			break;

D
David Dillow 已提交
1016 1017
		case SRP_STALE_CONN:
			shost_printk(KERN_ERR, target->scsi_host, PFX
1018
				     "giving up on stale connection\n");
B
Bart Van Assche 已提交
1019 1020
			ret = -ECONNRESET;
			goto out;
D
David Dillow 已提交
1021

1022
		default:
B
Bart Van Assche 已提交
1023
			goto out;
1024 1025
		}
	}
B
Bart Van Assche 已提交
1026 1027 1028

out:
	return ret <= 0 ? ret : -ENODEV;
1029 1030
}

C
Christoph Hellwig 已提交
1031 1032 1033 1034 1035 1036 1037
static void srp_inv_rkey_err_done(struct ib_cq *cq, struct ib_wc *wc)
{
	srp_handle_qp_err(cq, wc, "INV RKEY");
}

static int srp_inv_rkey(struct srp_request *req, struct srp_rdma_ch *ch,
		u32 rkey)
1038 1039 1040 1041 1042 1043 1044 1045 1046 1047
{
	struct ib_send_wr *bad_wr;
	struct ib_send_wr wr = {
		.opcode		    = IB_WR_LOCAL_INV,
		.next		    = NULL,
		.num_sge	    = 0,
		.send_flags	    = 0,
		.ex.invalidate_rkey = rkey,
	};

C
Christoph Hellwig 已提交
1048 1049
	wr.wr_cqe = &req->reg_cqe;
	req->reg_cqe.done = srp_inv_rkey_err_done;
1050
	return ib_post_send(ch->qp, &wr, &bad_wr);
1051 1052
}

1053
static void srp_unmap_data(struct scsi_cmnd *scmnd,
1054
			   struct srp_rdma_ch *ch,
1055 1056
			   struct srp_request *req)
{
1057
	struct srp_target_port *target = ch->target;
1058 1059 1060
	struct srp_device *dev = target->srp_host->srp_dev;
	struct ib_device *ibdev = dev->dev;
	int i, res;
1061

1062
	if (!scsi_sglist(scmnd) ||
1063 1064 1065 1066
	    (scmnd->sc_data_direction != DMA_TO_DEVICE &&
	     scmnd->sc_data_direction != DMA_FROM_DEVICE))
		return;

1067 1068 1069 1070
	if (dev->use_fast_reg) {
		struct srp_fr_desc **pfr;

		for (i = req->nmdesc, pfr = req->fr_list; i > 0; i--, pfr++) {
C
Christoph Hellwig 已提交
1071
			res = srp_inv_rkey(req, ch, (*pfr)->mr->rkey);
1072 1073 1074 1075 1076 1077 1078 1079 1080
			if (res < 0) {
				shost_printk(KERN_ERR, target->scsi_host, PFX
				  "Queueing INV WR for rkey %#x failed (%d)\n",
				  (*pfr)->mr->rkey, res);
				queue_work(system_long_wq,
					   &target->tl_err_work);
			}
		}
		if (req->nmdesc)
1081
			srp_fr_pool_put(ch->fr_pool, req->fr_list,
1082
					req->nmdesc);
1083
	} else if (dev->use_fmr) {
1084 1085 1086 1087 1088
		struct ib_pool_fmr **pfmr;

		for (i = req->nmdesc, pfmr = req->fmr_list; i > 0; i--, pfmr++)
			ib_fmr_pool_unmap(*pfmr);
	}
1089

1090 1091
	ib_dma_unmap_sg(ibdev, scsi_sglist(scmnd), scsi_sg_count(scmnd),
			scmnd->sc_data_direction);
1092 1093
}

B
Bart Van Assche 已提交
1094 1095
/**
 * srp_claim_req - Take ownership of the scmnd associated with a request.
1096
 * @ch: SRP RDMA channel.
B
Bart Van Assche 已提交
1097
 * @req: SRP request.
1098
 * @sdev: If not NULL, only take ownership for this SCSI device.
B
Bart Van Assche 已提交
1099 1100 1101 1102 1103 1104
 * @scmnd: If NULL, take ownership of @req->scmnd. If not NULL, only take
 *         ownership of @req->scmnd if it equals @scmnd.
 *
 * Return value:
 * Either NULL or a pointer to the SCSI command the caller became owner of.
 */
1105
static struct scsi_cmnd *srp_claim_req(struct srp_rdma_ch *ch,
B
Bart Van Assche 已提交
1106
				       struct srp_request *req,
1107
				       struct scsi_device *sdev,
B
Bart Van Assche 已提交
1108 1109 1110 1111
				       struct scsi_cmnd *scmnd)
{
	unsigned long flags;

1112
	spin_lock_irqsave(&ch->lock, flags);
1113 1114 1115
	if (req->scmnd &&
	    (!sdev || req->scmnd->device == sdev) &&
	    (!scmnd || req->scmnd == scmnd)) {
B
Bart Van Assche 已提交
1116 1117 1118 1119 1120
		scmnd = req->scmnd;
		req->scmnd = NULL;
	} else {
		scmnd = NULL;
	}
1121
	spin_unlock_irqrestore(&ch->lock, flags);
B
Bart Van Assche 已提交
1122 1123 1124 1125 1126

	return scmnd;
}

/**
B
Bart Van Assche 已提交
1127
 * srp_free_req() - Unmap data and adjust ch->req_lim.
1128
 * @ch:     SRP RDMA channel.
1129 1130 1131
 * @req:    Request to be freed.
 * @scmnd:  SCSI command associated with @req.
 * @req_lim_delta: Amount to be added to @target->req_lim.
B
Bart Van Assche 已提交
1132
 */
1133 1134
static void srp_free_req(struct srp_rdma_ch *ch, struct srp_request *req,
			 struct scsi_cmnd *scmnd, s32 req_lim_delta)
1135
{
1136 1137
	unsigned long flags;

1138
	srp_unmap_data(scmnd, ch, req);
B
Bart Van Assche 已提交
1139

1140 1141 1142
	spin_lock_irqsave(&ch->lock, flags);
	ch->req_lim += req_lim_delta;
	spin_unlock_irqrestore(&ch->lock, flags);
1143 1144
}

1145 1146
static void srp_finish_req(struct srp_rdma_ch *ch, struct srp_request *req,
			   struct scsi_device *sdev, int result)
1147
{
1148
	struct scsi_cmnd *scmnd = srp_claim_req(ch, req, sdev, NULL);
B
Bart Van Assche 已提交
1149 1150

	if (scmnd) {
1151
		srp_free_req(ch, req, scmnd, 0);
1152
		scmnd->result = result;
B
Bart Van Assche 已提交
1153 1154
		scmnd->scsi_done(scmnd);
	}
1155 1156
}

1157
static void srp_terminate_io(struct srp_rport *rport)
1158
{
1159
	struct srp_target_port *target = rport->lld_data;
B
Bart Van Assche 已提交
1160
	struct srp_rdma_ch *ch;
1161 1162
	struct Scsi_Host *shost = target->scsi_host;
	struct scsi_device *sdev;
B
Bart Van Assche 已提交
1163
	int i, j;
1164

1165 1166 1167 1168 1169 1170 1171
	/*
	 * Invoking srp_terminate_io() while srp_queuecommand() is running
	 * is not safe. Hence the warning statement below.
	 */
	shost_for_each_device(sdev, shost)
		WARN_ON_ONCE(sdev->request_queue->request_fn_active);

B
Bart Van Assche 已提交
1172 1173
	for (i = 0; i < target->ch_count; i++) {
		ch = &target->ch[i];
1174

B
Bart Van Assche 已提交
1175 1176 1177 1178 1179 1180
		for (j = 0; j < target->req_ring_size; ++j) {
			struct srp_request *req = &ch->req_ring[j];

			srp_finish_req(ch, req, NULL,
				       DID_TRANSPORT_FAILFAST << 16);
		}
1181 1182
	}
}
1183

1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195
/*
 * It is up to the caller to ensure that srp_rport_reconnect() calls are
 * serialized and that no concurrent srp_queuecommand(), srp_abort(),
 * srp_reset_device() or srp_reset_host() calls will occur while this function
 * is in progress. One way to realize that is not to call this function
 * directly but to call srp_reconnect_rport() instead since that last function
 * serializes calls of this function via rport->mutex and also blocks
 * srp_queuecommand() calls before invoking this function.
 */
static int srp_rport_reconnect(struct srp_rport *rport)
{
	struct srp_target_port *target = rport->lld_data;
B
Bart Van Assche 已提交
1196 1197 1198
	struct srp_rdma_ch *ch;
	int i, j, ret = 0;
	bool multich = false;
1199

1200
	srp_disconnect_target(target);
1201 1202 1203 1204

	if (target->state == SRP_TARGET_SCANNING)
		return -ENODEV;

1205
	/*
1206 1207 1208
	 * Now get a new local CM ID so that we avoid confusing the target in
	 * case things are really fouled up. Doing so also ensures that all CM
	 * callbacks will have finished before a new QP is allocated.
1209
	 */
B
Bart Van Assche 已提交
1210 1211 1212
	for (i = 0; i < target->ch_count; i++) {
		ch = &target->ch[i];
		ret += srp_new_cm_id(ch);
1213
	}
B
Bart Van Assche 已提交
1214 1215 1216 1217
	for (i = 0; i < target->ch_count; i++) {
		ch = &target->ch[i];
		for (j = 0; j < target->req_ring_size; ++j) {
			struct srp_request *req = &ch->req_ring[j];
1218

B
Bart Van Assche 已提交
1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229
			srp_finish_req(ch, req, NULL, DID_RESET << 16);
		}
	}
	for (i = 0; i < target->ch_count; i++) {
		ch = &target->ch[i];
		/*
		 * Whether or not creating a new CM ID succeeded, create a new
		 * QP. This guarantees that all completion callback function
		 * invocations have finished before request resetting starts.
		 */
		ret += srp_create_ch_ib(ch);
1230

B
Bart Van Assche 已提交
1231 1232 1233 1234
		INIT_LIST_HEAD(&ch->free_tx);
		for (j = 0; j < target->queue_size; ++j)
			list_add(&ch->tx_ring[j]->list, &ch->free_tx);
	}
1235 1236 1237

	target->qp_in_error = false;

B
Bart Van Assche 已提交
1238 1239
	for (i = 0; i < target->ch_count; i++) {
		ch = &target->ch[i];
1240
		if (ret)
B
Bart Van Assche 已提交
1241 1242 1243 1244
			break;
		ret = srp_connect_ch(ch, multich);
		multich = true;
	}
1245

1246 1247 1248
	if (ret == 0)
		shost_printk(KERN_INFO, target->scsi_host,
			     PFX "reconnect succeeded\n");
1249 1250 1251 1252

	return ret;
}

1253 1254
static void srp_map_desc(struct srp_map_state *state, dma_addr_t dma_addr,
			 unsigned int dma_len, u32 rkey)
1255
{
1256
	struct srp_direct_buf *desc = state->desc;
1257

1258 1259
	WARN_ON_ONCE(!dma_len);

1260 1261 1262
	desc->va = cpu_to_be64(dma_addr);
	desc->key = cpu_to_be32(rkey);
	desc->len = cpu_to_be32(dma_len);
1263

1264 1265 1266 1267
	state->total_len += dma_len;
	state->desc++;
	state->ndesc++;
}
1268

1269
static int srp_map_finish_fmr(struct srp_map_state *state,
1270
			      struct srp_rdma_ch *ch)
1271
{
1272 1273
	struct srp_target_port *target = ch->target;
	struct srp_device *dev = target->srp_host->srp_dev;
1274
	struct ib_pd *pd = target->pd;
1275 1276
	struct ib_pool_fmr *fmr;
	u64 io_addr = 0;
1277

1278 1279 1280 1281
	if (state->fmr.next >= state->fmr.end) {
		shost_printk(KERN_ERR, ch->target->scsi_host,
			     PFX "Out of MRs (mr_per_cmd = %d)\n",
			     ch->target->mr_per_cmd);
1282
		return -ENOMEM;
1283
	}
1284

S
Sagi Grimberg 已提交
1285 1286 1287 1288 1289
	WARN_ON_ONCE(!dev->use_fmr);

	if (state->npages == 0)
		return 0;

1290
	if (state->npages == 1 && (pd->flags & IB_PD_UNSAFE_GLOBAL_RKEY)) {
S
Sagi Grimberg 已提交
1291
		srp_map_desc(state, state->base_dma_addr, state->dma_len,
1292
			     pd->unsafe_global_rkey);
S
Sagi Grimberg 已提交
1293 1294 1295
		goto reset_state;
	}

1296
	fmr = ib_fmr_pool_map_phys(ch->fmr_pool, state->pages,
1297 1298 1299
				   state->npages, io_addr);
	if (IS_ERR(fmr))
		return PTR_ERR(fmr);
1300

1301
	*state->fmr.next++ = fmr;
1302
	state->nmdesc++;
1303

1304 1305
	srp_map_desc(state, state->base_dma_addr & ~dev->mr_page_mask,
		     state->dma_len, fmr->fmr->rkey);
1306

S
Sagi Grimberg 已提交
1307 1308 1309 1310
reset_state:
	state->npages = 0;
	state->dma_len = 0;

1311 1312 1313
	return 0;
}

C
Christoph Hellwig 已提交
1314 1315 1316 1317 1318
static void srp_reg_mr_err_done(struct ib_cq *cq, struct ib_wc *wc)
{
	srp_handle_qp_err(cq, wc, "FAST REG");
}

1319 1320 1321 1322 1323 1324
/*
 * Map up to sg_nents elements of state->sg where *sg_offset_p is the offset
 * where to start in the first element. If sg_offset_p != NULL then
 * *sg_offset_p is updated to the offset in state->sg[retval] of the first
 * byte that has not yet been mapped.
 */
1325
static int srp_map_finish_fr(struct srp_map_state *state,
C
Christoph Hellwig 已提交
1326
			     struct srp_request *req,
1327 1328
			     struct srp_rdma_ch *ch, int sg_nents,
			     unsigned int *sg_offset_p)
1329
{
1330
	struct srp_target_port *target = ch->target;
1331
	struct srp_device *dev = target->srp_host->srp_dev;
1332
	struct ib_pd *pd = target->pd;
1333
	struct ib_send_wr *bad_wr;
1334
	struct ib_reg_wr wr;
1335 1336
	struct srp_fr_desc *desc;
	u32 rkey;
1337
	int n, err;
1338

1339 1340 1341 1342
	if (state->fr.next >= state->fr.end) {
		shost_printk(KERN_ERR, ch->target->scsi_host,
			     PFX "Out of MRs (mr_per_cmd = %d)\n",
			     ch->target->mr_per_cmd);
1343
		return -ENOMEM;
1344
	}
1345

S
Sagi Grimberg 已提交
1346 1347
	WARN_ON_ONCE(!dev->use_fast_reg);

1348
	if (sg_nents == 1 && (pd->flags & IB_PD_UNSAFE_GLOBAL_RKEY)) {
1349 1350 1351 1352
		unsigned int sg_offset = sg_offset_p ? *sg_offset_p : 0;

		srp_map_desc(state, sg_dma_address(state->sg) + sg_offset,
			     sg_dma_len(state->sg) - sg_offset,
1353
			     pd->unsafe_global_rkey);
1354 1355
		if (sg_offset_p)
			*sg_offset_p = 0;
1356
		return 1;
S
Sagi Grimberg 已提交
1357 1358
	}

1359
	desc = srp_fr_pool_get(ch->fr_pool);
1360 1361 1362 1363 1364 1365
	if (!desc)
		return -ENOMEM;

	rkey = ib_inc_rkey(desc->mr->rkey);
	ib_update_fast_reg_key(desc->mr, rkey);

1366 1367
	n = ib_map_mr_sg(desc->mr, state->sg, sg_nents, sg_offset_p,
			 dev->mr_page_size);
1368 1369
	if (unlikely(n < 0)) {
		srp_fr_pool_put(ch->fr_pool, &desc, 1);
1370
		pr_debug("%s: ib_map_mr_sg(%d, %d) returned %d.\n",
1371
			 dev_name(&req->scmnd->device->sdev_gendev), sg_nents,
1372
			 sg_offset_p ? *sg_offset_p : -1, n);
1373
		return n;
1374
	}
1375

1376
	WARN_ON_ONCE(desc->mr->length == 0);
1377

C
Christoph Hellwig 已提交
1378 1379
	req->reg_cqe.done = srp_reg_mr_err_done;

1380 1381
	wr.wr.next = NULL;
	wr.wr.opcode = IB_WR_REG_MR;
C
Christoph Hellwig 已提交
1382
	wr.wr.wr_cqe = &req->reg_cqe;
1383 1384 1385 1386 1387 1388 1389
	wr.wr.num_sge = 0;
	wr.wr.send_flags = 0;
	wr.mr = desc->mr;
	wr.key = desc->mr->rkey;
	wr.access = (IB_ACCESS_LOCAL_WRITE |
		     IB_ACCESS_REMOTE_READ |
		     IB_ACCESS_REMOTE_WRITE);
1390

1391
	*state->fr.next++ = desc;
1392 1393
	state->nmdesc++;

1394 1395
	srp_map_desc(state, desc->mr->iova,
		     desc->mr->length, desc->mr->rkey);
1396

S
Sagi Grimberg 已提交
1397
	err = ib_post_send(ch->qp, &wr.wr, &bad_wr);
1398 1399
	if (unlikely(err)) {
		WARN_ON_ONCE(err == -ENOMEM);
S
Sagi Grimberg 已提交
1400
		return err;
1401
	}
S
Sagi Grimberg 已提交
1402

1403
	return n;
1404 1405
}

1406
static int srp_map_sg_entry(struct srp_map_state *state,
1407
			    struct srp_rdma_ch *ch,
1408
			    struct scatterlist *sg)
1409
{
1410
	struct srp_target_port *target = ch->target;
1411 1412 1413 1414
	struct srp_device *dev = target->srp_host->srp_dev;
	struct ib_device *ibdev = dev->dev;
	dma_addr_t dma_addr = ib_sg_dma_address(ibdev, sg);
	unsigned int dma_len = ib_sg_dma_len(ibdev, sg);
1415
	unsigned int len = 0;
1416 1417
	int ret;

1418
	WARN_ON_ONCE(!dma_len);
1419

1420
	while (dma_len) {
1421
		unsigned offset = dma_addr & ~dev->mr_page_mask;
1422 1423 1424

		if (state->npages == dev->max_pages_per_mr ||
		    (state->npages > 0 && offset != 0)) {
1425
			ret = srp_map_finish_fmr(state, ch);
1426 1427 1428 1429
			if (ret)
				return ret;
		}

1430
		len = min_t(unsigned int, dma_len, dev->mr_page_size - offset);
1431

1432 1433
		if (!state->npages)
			state->base_dma_addr = dma_addr;
1434
		state->pages[state->npages++] = dma_addr & dev->mr_page_mask;
1435
		state->dma_len += len;
1436 1437 1438 1439
		dma_addr += len;
		dma_len -= len;
	}

1440
	/*
1441
	 * If the end of the MR is not on a page boundary then we need to
1442
	 * close it out and start a new one -- we can only merge at page
1443
	 * boundaries.
1444 1445
	 */
	ret = 0;
1446
	if ((dma_addr & ~dev->mr_page_mask) != 0)
1447
		ret = srp_map_finish_fmr(state, ch);
1448 1449 1450
	return ret;
}

S
Sagi Grimberg 已提交
1451 1452 1453
static int srp_map_sg_fmr(struct srp_map_state *state, struct srp_rdma_ch *ch,
			  struct srp_request *req, struct scatterlist *scat,
			  int count)
1454 1455
{
	struct scatterlist *sg;
1456
	int i, ret;
1457

S
Sagi Grimberg 已提交
1458 1459
	state->pages = req->map_page;
	state->fmr.next = req->fmr_list;
1460
	state->fmr.end = req->fmr_list + ch->target->mr_per_cmd;
S
Sagi Grimberg 已提交
1461 1462

	for_each_sg(scat, sg, count, i) {
1463
		ret = srp_map_sg_entry(state, ch, sg);
S
Sagi Grimberg 已提交
1464 1465
		if (ret)
			return ret;
1466
	}
1467

1468
	ret = srp_map_finish_fmr(state, ch);
S
Sagi Grimberg 已提交
1469 1470 1471 1472 1473 1474 1475 1476 1477 1478
	if (ret)
		return ret;

	return 0;
}

static int srp_map_sg_fr(struct srp_map_state *state, struct srp_rdma_ch *ch,
			 struct srp_request *req, struct scatterlist *scat,
			 int count)
{
1479 1480
	unsigned int sg_offset = 0;

1481
	state->fr.next = req->fr_list;
1482
	state->fr.end = req->fr_list + ch->target->mr_per_cmd;
1483
	state->sg = scat;
S
Sagi Grimberg 已提交
1484

1485 1486 1487
	if (count == 0)
		return 0;

B
Bart Van Assche 已提交
1488
	while (count) {
1489
		int i, n;
S
Sagi Grimberg 已提交
1490

1491
		n = srp_map_finish_fr(state, req, ch, count, &sg_offset);
1492 1493 1494
		if (unlikely(n < 0))
			return n;

B
Bart Van Assche 已提交
1495
		count -= n;
1496 1497 1498
		for (i = 0; i < n; i++)
			state->sg = sg_next(state->sg);
	}
S
Sagi Grimberg 已提交
1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514

	return 0;
}

static int srp_map_sg_dma(struct srp_map_state *state, struct srp_rdma_ch *ch,
			  struct srp_request *req, struct scatterlist *scat,
			  int count)
{
	struct srp_target_port *target = ch->target;
	struct srp_device *dev = target->srp_host->srp_dev;
	struct scatterlist *sg;
	int i;

	for_each_sg(scat, sg, count, i) {
		srp_map_desc(state, ib_sg_dma_address(dev->dev, sg),
			     ib_sg_dma_len(dev->dev, sg),
1515
			     target->pd->unsafe_global_rkey);
1516
	}
1517

S
Sagi Grimberg 已提交
1518
	return 0;
1519 1520
}

1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536
/*
 * Register the indirect data buffer descriptor with the HCA.
 *
 * Note: since the indirect data buffer descriptor has been allocated with
 * kmalloc() it is guaranteed that this buffer is a physically contiguous
 * memory buffer.
 */
static int srp_map_idb(struct srp_rdma_ch *ch, struct srp_request *req,
		       void **next_mr, void **end_mr, u32 idb_len,
		       __be32 *idb_rkey)
{
	struct srp_target_port *target = ch->target;
	struct srp_device *dev = target->srp_host->srp_dev;
	struct srp_map_state state;
	struct srp_direct_buf idb_desc;
	u64 idb_pages[1];
1537
	struct scatterlist idb_sg[1];
1538 1539 1540 1541 1542 1543 1544 1545 1546
	int ret;

	memset(&state, 0, sizeof(state));
	memset(&idb_desc, 0, sizeof(idb_desc));
	state.gen.next = next_mr;
	state.gen.end = end_mr;
	state.desc = &idb_desc;
	state.base_dma_addr = req->indirect_dma_addr;
	state.dma_len = idb_len;
1547 1548 1549

	if (dev->use_fast_reg) {
		state.sg = idb_sg;
1550
		sg_init_one(idb_sg, req->indirect_desc, idb_len);
1551
		idb_sg->dma_address = req->indirect_dma_addr; /* hack! */
1552 1553 1554
#ifdef CONFIG_NEED_SG_DMA_LENGTH
		idb_sg->dma_length = idb_sg->length;	      /* hack^2 */
#endif
1555
		ret = srp_map_finish_fr(&state, req, ch, 1, NULL);
1556 1557
		if (ret < 0)
			return ret;
1558
		WARN_ON_ONCE(ret < 1);
1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569
	} else if (dev->use_fmr) {
		state.pages = idb_pages;
		state.pages[0] = (req->indirect_dma_addr &
				  dev->mr_page_mask);
		state.npages = 1;
		ret = srp_map_finish_fmr(&state, ch);
		if (ret < 0)
			return ret;
	} else {
		return -EINVAL;
	}
1570 1571 1572

	*idb_rkey = idb_desc.key;

1573
	return 0;
1574 1575
}

1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599
static void srp_check_mapping(struct srp_map_state *state,
			      struct srp_rdma_ch *ch, struct srp_request *req,
			      struct scatterlist *scat, int count)
{
	struct srp_device *dev = ch->target->srp_host->srp_dev;
	struct srp_fr_desc **pfr;
	u64 desc_len = 0, mr_len = 0;
	int i;

	for (i = 0; i < state->ndesc; i++)
		desc_len += be32_to_cpu(req->indirect_desc[i].len);
	if (dev->use_fast_reg)
		for (i = 0, pfr = req->fr_list; i < state->nmdesc; i++, pfr++)
			mr_len += (*pfr)->mr->length;
	else if (dev->use_fmr)
		for (i = 0; i < state->nmdesc; i++)
			mr_len += be32_to_cpu(req->indirect_desc[i].len);
	if (desc_len != scsi_bufflen(req->scmnd) ||
	    mr_len > scsi_bufflen(req->scmnd))
		pr_err("Inconsistent: scsi len %d <> desc len %lld <> mr len %lld; ndesc %d; nmdesc = %d\n",
		       scsi_bufflen(req->scmnd), desc_len, mr_len,
		       state->ndesc, state->nmdesc);
}

1600 1601 1602 1603 1604 1605 1606 1607 1608
/**
 * srp_map_data() - map SCSI data buffer onto an SRP request
 * @scmnd: SCSI command to map
 * @ch: SRP RDMA channel
 * @req: SRP request
 *
 * Returns the length in bytes of the SRP_CMD IU or a negative value if
 * mapping failed.
 */
1609
static int srp_map_data(struct scsi_cmnd *scmnd, struct srp_rdma_ch *ch,
1610 1611
			struct srp_request *req)
{
1612
	struct srp_target_port *target = ch->target;
1613
	struct ib_pd *pd = target->pd;
1614
	struct scatterlist *scat;
1615
	struct srp_cmd *cmd = req->cmd->buf;
1616
	int len, nents, count, ret;
1617 1618
	struct srp_device *dev;
	struct ib_device *ibdev;
1619 1620
	struct srp_map_state state;
	struct srp_indirect_buf *indirect_hdr;
1621 1622
	u32 idb_len, table_len;
	__be32 idb_rkey;
1623
	u8 fmt;
1624

1625
	if (!scsi_sglist(scmnd) || scmnd->sc_data_direction == DMA_NONE)
1626 1627 1628 1629
		return sizeof (struct srp_cmd);

	if (scmnd->sc_data_direction != DMA_FROM_DEVICE &&
	    scmnd->sc_data_direction != DMA_TO_DEVICE) {
1630 1631 1632
		shost_printk(KERN_WARNING, target->scsi_host,
			     PFX "Unhandled data direction %d\n",
			     scmnd->sc_data_direction);
1633 1634 1635
		return -EINVAL;
	}

1636 1637
	nents = scsi_sg_count(scmnd);
	scat  = scsi_sglist(scmnd);
1638

1639
	dev = target->srp_host->srp_dev;
1640 1641 1642
	ibdev = dev->dev;

	count = ib_dma_map_sg(ibdev, scat, nents, scmnd->sc_data_direction);
1643 1644
	if (unlikely(count == 0))
		return -EIO;
1645 1646 1647

	fmt = SRP_DATA_DESC_DIRECT;
	len = sizeof (struct srp_cmd) +	sizeof (struct srp_direct_buf);
1648

1649
	if (count == 1 && (pd->flags & IB_PD_UNSAFE_GLOBAL_RKEY)) {
1650 1651 1652 1653 1654 1655
		/*
		 * The midlayer only generated a single gather/scatter
		 * entry, or DMA mapping coalesced everything to a
		 * single entry.  So a direct descriptor along with
		 * the DMA MR suffices.
		 */
1656
		struct srp_direct_buf *buf = (void *) cmd->add_data;
1657

1658
		buf->va  = cpu_to_be64(ib_sg_dma_address(ibdev, scat));
1659
		buf->key = cpu_to_be32(pd->unsafe_global_rkey);
1660
		buf->len = cpu_to_be32(ib_sg_dma_len(ibdev, scat));
1661

1662
		req->nmdesc = 0;
1663 1664 1665
		goto map_complete;
	}

1666 1667 1668
	/*
	 * We have more than one scatter/gather entry, so build our indirect
	 * descriptor table, trying to merge as many entries as we can.
1669 1670 1671
	 */
	indirect_hdr = (void *) cmd->add_data;

1672 1673 1674
	ib_dma_sync_single_for_cpu(ibdev, req->indirect_dma_addr,
				   target->indirect_size, DMA_TO_DEVICE);

1675
	memset(&state, 0, sizeof(state));
B
Bart Van Assche 已提交
1676
	state.desc = req->indirect_desc;
S
Sagi Grimberg 已提交
1677
	if (dev->use_fast_reg)
1678
		ret = srp_map_sg_fr(&state, ch, req, scat, count);
S
Sagi Grimberg 已提交
1679
	else if (dev->use_fmr)
1680
		ret = srp_map_sg_fmr(&state, ch, req, scat, count);
S
Sagi Grimberg 已提交
1681
	else
1682 1683 1684 1685
		ret = srp_map_sg_dma(&state, ch, req, scat, count);
	req->nmdesc = state.nmdesc;
	if (ret < 0)
		goto unmap;
1686

1687 1688 1689
	{
		DEFINE_DYNAMIC_DEBUG_METADATA(ddm,
			"Memory mapping consistency check");
1690
		if (DYNAMIC_DEBUG_BRANCH(ddm))
1691 1692
			srp_check_mapping(&state, ch, req, scat, count);
	}
1693

1694 1695 1696 1697 1698
	/* We've mapped the request, now pull as much of the indirect
	 * descriptor table as we can into the command buffer. If this
	 * target is not using an external indirect table, we are
	 * guaranteed to fit into the command, as the SCSI layer won't
	 * give us more S/G entries than we allow.
1699 1700
	 */
	if (state.ndesc == 1) {
1701 1702
		/*
		 * Memory registration collapsed the sg-list into one entry,
1703 1704 1705
		 * so use a direct descriptor.
		 */
		struct srp_direct_buf *buf = (void *) cmd->add_data;
1706

1707
		*buf = req->indirect_desc[0];
1708
		goto map_complete;
1709 1710
	}

1711 1712 1713 1714
	if (unlikely(target->cmd_sg_cnt < state.ndesc &&
						!target->allow_ext_sg)) {
		shost_printk(KERN_ERR, target->scsi_host,
			     "Could not fit S/G list into SRP_CMD\n");
1715 1716
		ret = -EIO;
		goto unmap;
1717 1718 1719
	}

	count = min(state.ndesc, target->cmd_sg_cnt);
1720
	table_len = state.ndesc * sizeof (struct srp_direct_buf);
1721
	idb_len = sizeof(struct srp_indirect_buf) + table_len;
1722 1723 1724

	fmt = SRP_DATA_DESC_INDIRECT;
	len = sizeof(struct srp_cmd) + sizeof (struct srp_indirect_buf);
1725
	len += count * sizeof (struct srp_direct_buf);
1726

1727 1728
	memcpy(indirect_hdr->desc_list, req->indirect_desc,
	       count * sizeof (struct srp_direct_buf));
1729

1730
	if (!(pd->flags & IB_PD_UNSAFE_GLOBAL_RKEY)) {
1731 1732 1733
		ret = srp_map_idb(ch, req, state.gen.next, state.gen.end,
				  idb_len, &idb_rkey);
		if (ret < 0)
1734
			goto unmap;
1735 1736
		req->nmdesc++;
	} else {
1737
		idb_rkey = cpu_to_be32(pd->unsafe_global_rkey);
1738 1739
	}

1740
	indirect_hdr->table_desc.va = cpu_to_be64(req->indirect_dma_addr);
1741
	indirect_hdr->table_desc.key = idb_rkey;
1742 1743 1744 1745
	indirect_hdr->table_desc.len = cpu_to_be32(table_len);
	indirect_hdr->len = cpu_to_be32(state.total_len);

	if (scmnd->sc_data_direction == DMA_TO_DEVICE)
1746
		cmd->data_out_desc_cnt = count;
1747
	else
1748 1749 1750 1751
		cmd->data_in_desc_cnt = count;

	ib_dma_sync_single_for_device(ibdev, req->indirect_dma_addr, table_len,
				      DMA_TO_DEVICE);
1752 1753

map_complete:
1754 1755 1756 1757 1758 1759
	if (scmnd->sc_data_direction == DMA_TO_DEVICE)
		cmd->buf_fmt = fmt << 4;
	else
		cmd->buf_fmt = fmt;

	return len;
1760 1761 1762

unmap:
	srp_unmap_data(scmnd, ch, req);
1763 1764
	if (ret == -ENOMEM && req->nmdesc >= target->mr_pool_size)
		ret = -E2BIG;
1765
	return ret;
1766 1767
}

1768 1769 1770
/*
 * Return an IU and possible credit to the free pool
 */
1771
static void srp_put_tx_iu(struct srp_rdma_ch *ch, struct srp_iu *iu,
1772 1773 1774 1775
			  enum srp_iu_type iu_type)
{
	unsigned long flags;

1776 1777
	spin_lock_irqsave(&ch->lock, flags);
	list_add(&iu->list, &ch->free_tx);
1778
	if (iu_type != SRP_IU_RSP)
1779 1780
		++ch->req_lim;
	spin_unlock_irqrestore(&ch->lock, flags);
1781 1782
}

1783
/*
1784
 * Must be called with ch->lock held to protect req_lim and free_tx.
1785
 * If IU is not sent, it must be returned using srp_put_tx_iu().
1786 1787 1788 1789 1790 1791 1792 1793 1794 1795
 *
 * Note:
 * An upper limit for the number of allocated information units for each
 * request type is:
 * - SRP_IU_CMD: SRP_CMD_SQ_SIZE, since the SCSI mid-layer never queues
 *   more than Scsi_Host.can_queue requests.
 * - SRP_IU_TSK_MGMT: SRP_TSK_MGMT_SQ_SIZE.
 * - SRP_IU_RSP: 1, since a conforming SRP target never sends more than
 *   one unanswered SRP request to an initiator.
 */
1796
static struct srp_iu *__srp_get_tx_iu(struct srp_rdma_ch *ch,
1797 1798
				      enum srp_iu_type iu_type)
{
1799
	struct srp_target_port *target = ch->target;
1800 1801 1802
	s32 rsv = (iu_type == SRP_IU_TSK_MGMT) ? 0 : SRP_TSK_MGMT_SQ_SIZE;
	struct srp_iu *iu;

1803 1804
	lockdep_assert_held(&ch->lock);

C
Christoph Hellwig 已提交
1805
	ib_process_cq_direct(ch->send_cq, -1);
1806

1807
	if (list_empty(&ch->free_tx))
1808 1809 1810
		return NULL;

	/* Initiator responses to target requests do not consume credits */
1811
	if (iu_type != SRP_IU_RSP) {
1812
		if (ch->req_lim <= rsv) {
1813 1814 1815 1816
			++target->zero_req_lim;
			return NULL;
		}

1817
		--ch->req_lim;
1818 1819
	}

1820
	iu = list_first_entry(&ch->free_tx, struct srp_iu, list);
1821
	list_del(&iu->list);
1822 1823 1824
	return iu;
}

C
Christoph Hellwig 已提交
1825 1826 1827 1828 1829 1830 1831 1832 1833 1834
static void srp_send_done(struct ib_cq *cq, struct ib_wc *wc)
{
	struct srp_iu *iu = container_of(wc->wr_cqe, struct srp_iu, cqe);
	struct srp_rdma_ch *ch = cq->cq_context;

	if (unlikely(wc->status != IB_WC_SUCCESS)) {
		srp_handle_qp_err(cq, wc, "SEND");
		return;
	}

1835 1836
	lockdep_assert_held(&ch->lock);

C
Christoph Hellwig 已提交
1837 1838 1839
	list_add(&iu->list, &ch->free_tx);
}

1840
static int srp_post_send(struct srp_rdma_ch *ch, struct srp_iu *iu, int len)
1841
{
1842
	struct srp_target_port *target = ch->target;
1843 1844 1845 1846 1847
	struct ib_sge list;
	struct ib_send_wr wr, *bad_wr;

	list.addr   = iu->dma;
	list.length = len;
1848
	list.lkey   = target->lkey;
1849

C
Christoph Hellwig 已提交
1850 1851
	iu->cqe.done = srp_send_done;

1852
	wr.next       = NULL;
C
Christoph Hellwig 已提交
1853
	wr.wr_cqe     = &iu->cqe;
1854 1855 1856 1857 1858
	wr.sg_list    = &list;
	wr.num_sge    = 1;
	wr.opcode     = IB_WR_SEND;
	wr.send_flags = IB_SEND_SIGNALED;

1859
	return ib_post_send(ch->qp, &wr, &bad_wr);
1860 1861
}

1862
static int srp_post_recv(struct srp_rdma_ch *ch, struct srp_iu *iu)
1863
{
1864
	struct srp_target_port *target = ch->target;
1865
	struct ib_recv_wr wr, *bad_wr;
1866
	struct ib_sge list;
1867 1868 1869

	list.addr   = iu->dma;
	list.length = iu->size;
1870
	list.lkey   = target->lkey;
1871

C
Christoph Hellwig 已提交
1872 1873
	iu->cqe.done = srp_recv_done;

1874
	wr.next     = NULL;
C
Christoph Hellwig 已提交
1875
	wr.wr_cqe   = &iu->cqe;
1876 1877 1878
	wr.sg_list  = &list;
	wr.num_sge  = 1;

1879
	return ib_post_recv(ch->qp, &wr, &bad_wr);
1880 1881
}

1882
static void srp_process_rsp(struct srp_rdma_ch *ch, struct srp_rsp *rsp)
1883
{
1884
	struct srp_target_port *target = ch->target;
1885 1886 1887 1888 1889
	struct srp_request *req;
	struct scsi_cmnd *scmnd;
	unsigned long flags;

	if (unlikely(rsp->tag & SRP_TAG_TSK_MGMT)) {
1890 1891
		spin_lock_irqsave(&ch->lock, flags);
		ch->req_lim += be32_to_cpu(rsp->req_lim_delta);
1892 1893 1894 1895 1896 1897 1898 1899 1900 1901
		if (rsp->tag == ch->tsk_mgmt_tag) {
			ch->tsk_mgmt_status = -1;
			if (be32_to_cpu(rsp->resp_data_len) >= 4)
				ch->tsk_mgmt_status = rsp->data[3];
			complete(&ch->tsk_mgmt_done);
		} else {
			shost_printk(KERN_ERR, target->scsi_host,
				     "Received tsk mgmt response too late for tag %#llx\n",
				     rsp->tag);
		}
1902
		spin_unlock_irqrestore(&ch->lock, flags);
1903
	} else {
B
Bart Van Assche 已提交
1904
		scmnd = scsi_host_find_tag(target->scsi_host, rsp->tag);
1905
		if (scmnd && scmnd->host_scribble) {
B
Bart Van Assche 已提交
1906 1907
			req = (void *)scmnd->host_scribble;
			scmnd = srp_claim_req(ch, req, NULL, scmnd);
1908 1909
		} else {
			scmnd = NULL;
B
Bart Van Assche 已提交
1910
		}
B
Bart Van Assche 已提交
1911
		if (!scmnd) {
1912
			shost_printk(KERN_ERR, target->scsi_host,
B
Bart Van Assche 已提交
1913 1914
				     "Null scmnd for RSP w/tag %#016llx received on ch %td / QP %#x\n",
				     rsp->tag, ch - target->ch, ch->qp->qp_num);
B
Bart Van Assche 已提交
1915

1916 1917 1918
			spin_lock_irqsave(&ch->lock, flags);
			ch->req_lim += be32_to_cpu(rsp->req_lim_delta);
			spin_unlock_irqrestore(&ch->lock, flags);
B
Bart Van Assche 已提交
1919 1920 1921

			return;
		}
1922 1923 1924 1925 1926 1927 1928 1929 1930
		scmnd->result = rsp->status;

		if (rsp->flags & SRP_RSP_FLAG_SNSVALID) {
			memcpy(scmnd->sense_buffer, rsp->data +
			       be32_to_cpu(rsp->resp_data_len),
			       min_t(int, be32_to_cpu(rsp->sense_data_len),
				     SCSI_SENSE_BUFFERSIZE));
		}

B
Bart Van Assche 已提交
1931
		if (unlikely(rsp->flags & SRP_RSP_FLAG_DIUNDER))
1932
			scsi_set_resid(scmnd, be32_to_cpu(rsp->data_in_res_cnt));
B
Bart Van Assche 已提交
1933 1934 1935 1936 1937 1938
		else if (unlikely(rsp->flags & SRP_RSP_FLAG_DIOVER))
			scsi_set_resid(scmnd, -be32_to_cpu(rsp->data_in_res_cnt));
		else if (unlikely(rsp->flags & SRP_RSP_FLAG_DOUNDER))
			scsi_set_resid(scmnd, be32_to_cpu(rsp->data_out_res_cnt));
		else if (unlikely(rsp->flags & SRP_RSP_FLAG_DOOVER))
			scsi_set_resid(scmnd, -be32_to_cpu(rsp->data_out_res_cnt));
1939

1940
		srp_free_req(ch, req, scmnd,
B
Bart Van Assche 已提交
1941 1942
			     be32_to_cpu(rsp->req_lim_delta));

1943 1944
		scmnd->host_scribble = NULL;
		scmnd->scsi_done(scmnd);
1945 1946 1947
	}
}

1948
static int srp_response_common(struct srp_rdma_ch *ch, s32 req_delta,
1949 1950
			       void *rsp, int len)
{
1951
	struct srp_target_port *target = ch->target;
1952
	struct ib_device *dev = target->srp_host->srp_dev->dev;
1953 1954
	unsigned long flags;
	struct srp_iu *iu;
1955
	int err;
1956

1957 1958 1959 1960
	spin_lock_irqsave(&ch->lock, flags);
	ch->req_lim += req_delta;
	iu = __srp_get_tx_iu(ch, SRP_IU_RSP);
	spin_unlock_irqrestore(&ch->lock, flags);
1961

1962 1963 1964
	if (!iu) {
		shost_printk(KERN_ERR, target->scsi_host, PFX
			     "no IU available to send response\n");
1965
		return 1;
1966 1967 1968 1969 1970 1971
	}

	ib_dma_sync_single_for_cpu(dev, iu->dma, len, DMA_TO_DEVICE);
	memcpy(iu->buf, rsp, len);
	ib_dma_sync_single_for_device(dev, iu->dma, len, DMA_TO_DEVICE);

1972
	err = srp_post_send(ch, iu, len);
1973
	if (err) {
1974 1975
		shost_printk(KERN_ERR, target->scsi_host, PFX
			     "unable to post response: %d\n", err);
1976
		srp_put_tx_iu(ch, iu, SRP_IU_RSP);
1977
	}
1978 1979 1980 1981

	return err;
}

1982
static void srp_process_cred_req(struct srp_rdma_ch *ch,
1983 1984 1985 1986 1987 1988 1989 1990
				 struct srp_cred_req *req)
{
	struct srp_cred_rsp rsp = {
		.opcode = SRP_CRED_RSP,
		.tag = req->tag,
	};
	s32 delta = be32_to_cpu(req->req_lim_delta);

1991 1992
	if (srp_response_common(ch, delta, &rsp, sizeof(rsp)))
		shost_printk(KERN_ERR, ch->target->scsi_host, PFX
1993 1994 1995
			     "problems processing SRP_CRED_REQ\n");
}

1996
static void srp_process_aer_req(struct srp_rdma_ch *ch,
1997 1998
				struct srp_aer_req *req)
{
1999
	struct srp_target_port *target = ch->target;
2000 2001 2002 2003 2004 2005 2006
	struct srp_aer_rsp rsp = {
		.opcode = SRP_AER_RSP,
		.tag = req->tag,
	};
	s32 delta = be32_to_cpu(req->req_lim_delta);

	shost_printk(KERN_ERR, target->scsi_host, PFX
B
Bart Van Assche 已提交
2007
		     "ignoring AER for LUN %llu\n", scsilun_to_int(&req->lun));
2008

2009
	if (srp_response_common(ch, delta, &rsp, sizeof(rsp)))
2010 2011 2012 2013
		shost_printk(KERN_ERR, target->scsi_host, PFX
			     "problems processing SRP_AER_REQ\n");
}

C
Christoph Hellwig 已提交
2014
static void srp_recv_done(struct ib_cq *cq, struct ib_wc *wc)
2015
{
C
Christoph Hellwig 已提交
2016 2017
	struct srp_iu *iu = container_of(wc->wr_cqe, struct srp_iu, cqe);
	struct srp_rdma_ch *ch = cq->cq_context;
2018
	struct srp_target_port *target = ch->target;
2019
	struct ib_device *dev = target->srp_host->srp_dev->dev;
2020
	int res;
2021 2022
	u8 opcode;

C
Christoph Hellwig 已提交
2023 2024 2025 2026 2027
	if (unlikely(wc->status != IB_WC_SUCCESS)) {
		srp_handle_qp_err(cq, wc, "RECV");
		return;
	}

2028
	ib_dma_sync_single_for_cpu(dev, iu->dma, ch->max_ti_iu_len,
2029
				   DMA_FROM_DEVICE);
2030 2031 2032 2033

	opcode = *(u8 *) iu->buf;

	if (0) {
2034 2035
		shost_printk(KERN_ERR, target->scsi_host,
			     PFX "recv completion, opcode 0x%02x\n", opcode);
B
Bart Van Assche 已提交
2036 2037
		print_hex_dump(KERN_ERR, "", DUMP_PREFIX_OFFSET, 8, 1,
			       iu->buf, wc->byte_len, true);
2038 2039 2040 2041
	}

	switch (opcode) {
	case SRP_RSP:
2042
		srp_process_rsp(ch, iu->buf);
2043 2044
		break;

2045
	case SRP_CRED_REQ:
2046
		srp_process_cred_req(ch, iu->buf);
2047 2048 2049
		break;

	case SRP_AER_REQ:
2050
		srp_process_aer_req(ch, iu->buf);
2051 2052
		break;

2053 2054
	case SRP_T_LOGOUT:
		/* XXX Handle target logout */
2055 2056
		shost_printk(KERN_WARNING, target->scsi_host,
			     PFX "Got target logout request\n");
2057 2058 2059
		break;

	default:
2060 2061
		shost_printk(KERN_WARNING, target->scsi_host,
			     PFX "Unhandled SRP opcode 0x%02x\n", opcode);
2062 2063 2064
		break;
	}

2065
	ib_dma_sync_single_for_device(dev, iu->dma, ch->max_ti_iu_len,
2066
				      DMA_FROM_DEVICE);
2067

2068
	res = srp_post_recv(ch, iu);
2069 2070 2071
	if (res != 0)
		shost_printk(KERN_ERR, target->scsi_host,
			     PFX "Recv failed with error code %d\n", res);
2072 2073
}

2074 2075
/**
 * srp_tl_err_work() - handle a transport layer error
2076
 * @work: Work structure embedded in an SRP target port.
2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089
 *
 * Note: This function may get invoked before the rport has been created,
 * hence the target->rport test.
 */
static void srp_tl_err_work(struct work_struct *work)
{
	struct srp_target_port *target;

	target = container_of(work, struct srp_target_port, tl_err_work);
	if (target->rport)
		srp_start_tl_fail_timers(target->rport);
}

C
Christoph Hellwig 已提交
2090 2091
static void srp_handle_qp_err(struct ib_cq *cq, struct ib_wc *wc,
		const char *opname)
2092
{
C
Christoph Hellwig 已提交
2093
	struct srp_rdma_ch *ch = cq->cq_context;
2094 2095
	struct srp_target_port *target = ch->target;

2096
	if (ch->connected && !target->qp_in_error) {
C
Christoph Hellwig 已提交
2097 2098 2099 2100
		shost_printk(KERN_ERR, target->scsi_host,
			     PFX "failed %s status %s (%d) for CQE %p\n",
			     opname, ib_wc_status_msg(wc->status), wc->status,
			     wc->wr_cqe);
2101
		queue_work(system_long_wq, &target->tl_err_work);
2102
	}
2103 2104 2105
	target->qp_in_error = true;
}

2106
static int srp_queuecommand(struct Scsi_Host *shost, struct scsi_cmnd *scmnd)
2107
{
2108
	struct srp_target_port *target = host_to_target(shost);
2109
	struct srp_rport *rport = target->rport;
2110
	struct srp_rdma_ch *ch;
2111 2112 2113
	struct srp_request *req;
	struct srp_iu *iu;
	struct srp_cmd *cmd;
2114
	struct ib_device *dev;
2115
	unsigned long flags;
B
Bart Van Assche 已提交
2116 2117
	u32 tag;
	u16 idx;
2118
	int len, ret;
2119 2120 2121 2122 2123 2124 2125 2126 2127 2128
	const bool in_scsi_eh = !in_interrupt() && current == shost->ehandler;

	/*
	 * The SCSI EH thread is the only context from which srp_queuecommand()
	 * can get invoked for blocked devices (SDEV_BLOCK /
	 * SDEV_CREATED_BLOCK). Avoid racing with srp_reconnect_rport() by
	 * locking the rport mutex if invoked from inside the SCSI EH.
	 */
	if (in_scsi_eh)
		mutex_lock(&rport->mutex);
2129

2130 2131 2132
	scmnd->result = srp_chkready(target->rport);
	if (unlikely(scmnd->result))
		goto err;
2133

B
Bart Van Assche 已提交
2134 2135
	WARN_ON_ONCE(scmnd->request->tag < 0);
	tag = blk_mq_unique_tag(scmnd->request);
B
Bart Van Assche 已提交
2136
	ch = &target->ch[blk_mq_unique_tag_to_hwq(tag)];
B
Bart Van Assche 已提交
2137 2138 2139 2140
	idx = blk_mq_unique_tag_to_tag(tag);
	WARN_ONCE(idx >= target->req_ring_size, "%s: tag %#x: idx %d >= %d\n",
		  dev_name(&shost->shost_gendev), tag, idx,
		  target->req_ring_size);
2141 2142 2143 2144

	spin_lock_irqsave(&ch->lock, flags);
	iu = __srp_get_tx_iu(ch, SRP_IU_CMD);
	spin_unlock_irqrestore(&ch->lock, flags);
2145

B
Bart Van Assche 已提交
2146 2147 2148 2149
	if (!iu)
		goto err;

	req = &ch->req_ring[idx];
2150
	dev = target->srp_host->srp_dev->dev;
2151
	ib_dma_sync_single_for_cpu(dev, iu->dma, target->max_iu_len,
2152
				   DMA_TO_DEVICE);
2153

2154
	scmnd->host_scribble = (void *) req;
2155 2156 2157 2158 2159

	cmd = iu->buf;
	memset(cmd, 0, sizeof *cmd);

	cmd->opcode = SRP_CMD;
B
Bart Van Assche 已提交
2160
	int_to_scsilun(scmnd->device->lun, &cmd->lun);
B
Bart Van Assche 已提交
2161
	cmd->tag    = tag;
2162 2163 2164 2165 2166
	memcpy(cmd->cdb, scmnd->cmnd, scmnd->cmd_len);

	req->scmnd    = scmnd;
	req->cmd      = iu;

2167
	len = srp_map_data(scmnd, ch, req);
2168
	if (len < 0) {
2169
		shost_printk(KERN_ERR, target->scsi_host,
2170 2171 2172 2173
			     PFX "Failed to map data (%d)\n", len);
		/*
		 * If we ran out of memory descriptors (-ENOMEM) because an
		 * application is queuing many requests with more than
2174
		 * max_pages_per_mr sg-list elements, tell the SCSI mid-layer
2175 2176 2177 2178
		 * to reduce queue depth temporarily.
		 */
		scmnd->result = len == -ENOMEM ?
			DID_OK << 16 | QUEUE_FULL << 1 : DID_ERROR << 16;
2179
		goto err_iu;
2180 2181
	}

2182
	ib_dma_sync_single_for_device(dev, iu->dma, target->max_iu_len,
2183
				      DMA_TO_DEVICE);
2184

2185
	if (srp_post_send(ch, iu, len)) {
2186
		shost_printk(KERN_ERR, target->scsi_host, PFX "Send failed\n");
2187 2188 2189
		goto err_unmap;
	}

2190 2191
	ret = 0;

2192 2193 2194 2195
unlock_rport:
	if (in_scsi_eh)
		mutex_unlock(&rport->mutex);

2196
	return ret;
2197 2198

err_unmap:
2199
	srp_unmap_data(scmnd, ch, req);
2200

2201
err_iu:
2202
	srp_put_tx_iu(ch, iu, SRP_IU_CMD);
2203

2204 2205 2206 2207 2208 2209
	/*
	 * Avoid that the loops that iterate over the request ring can
	 * encounter a dangling SCSI command pointer.
	 */
	req->scmnd = NULL;

2210 2211 2212 2213 2214 2215 2216
err:
	if (scmnd->result) {
		scmnd->scsi_done(scmnd);
		ret = 0;
	} else {
		ret = SCSI_MLQUEUE_HOST_BUSY;
	}
2217

2218
	goto unlock_rport;
2219 2220
}

2221 2222
/*
 * Note: the resources allocated in this function are freed in
2223
 * srp_free_ch_ib().
2224
 */
2225
static int srp_alloc_iu_bufs(struct srp_rdma_ch *ch)
2226
{
2227
	struct srp_target_port *target = ch->target;
2228 2229
	int i;

2230 2231 2232
	ch->rx_ring = kcalloc(target->queue_size, sizeof(*ch->rx_ring),
			      GFP_KERNEL);
	if (!ch->rx_ring)
2233
		goto err_no_ring;
2234 2235 2236
	ch->tx_ring = kcalloc(target->queue_size, sizeof(*ch->tx_ring),
			      GFP_KERNEL);
	if (!ch->tx_ring)
2237 2238 2239
		goto err_no_ring;

	for (i = 0; i < target->queue_size; ++i) {
2240 2241 2242 2243
		ch->rx_ring[i] = srp_alloc_iu(target->srp_host,
					      ch->max_ti_iu_len,
					      GFP_KERNEL, DMA_FROM_DEVICE);
		if (!ch->rx_ring[i])
2244 2245 2246
			goto err;
	}

2247
	for (i = 0; i < target->queue_size; ++i) {
2248 2249 2250 2251
		ch->tx_ring[i] = srp_alloc_iu(target->srp_host,
					      target->max_iu_len,
					      GFP_KERNEL, DMA_TO_DEVICE);
		if (!ch->tx_ring[i])
2252
			goto err;
2253

2254
		list_add(&ch->tx_ring[i]->list, &ch->free_tx);
2255 2256 2257 2258 2259
	}

	return 0;

err:
2260
	for (i = 0; i < target->queue_size; ++i) {
2261 2262
		srp_free_iu(target->srp_host, ch->rx_ring[i]);
		srp_free_iu(target->srp_host, ch->tx_ring[i]);
2263 2264
	}

2265 2266

err_no_ring:
2267 2268 2269 2270
	kfree(ch->tx_ring);
	ch->tx_ring = NULL;
	kfree(ch->rx_ring);
	ch->rx_ring = NULL;
2271

2272 2273 2274
	return -ENOMEM;
}

2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301
static uint32_t srp_compute_rq_tmo(struct ib_qp_attr *qp_attr, int attr_mask)
{
	uint64_t T_tr_ns, max_compl_time_ms;
	uint32_t rq_tmo_jiffies;

	/*
	 * According to section 11.2.4.2 in the IBTA spec (Modify Queue Pair,
	 * table 91), both the QP timeout and the retry count have to be set
	 * for RC QP's during the RTR to RTS transition.
	 */
	WARN_ON_ONCE((attr_mask & (IB_QP_TIMEOUT | IB_QP_RETRY_CNT)) !=
		     (IB_QP_TIMEOUT | IB_QP_RETRY_CNT));

	/*
	 * Set target->rq_tmo_jiffies to one second more than the largest time
	 * it can take before an error completion is generated. See also
	 * C9-140..142 in the IBTA spec for more information about how to
	 * convert the QP Local ACK Timeout value to nanoseconds.
	 */
	T_tr_ns = 4096 * (1ULL << qp_attr->timeout);
	max_compl_time_ms = qp_attr->retry_cnt * 4 * T_tr_ns;
	do_div(max_compl_time_ms, NSEC_PER_MSEC);
	rq_tmo_jiffies = msecs_to_jiffies(max_compl_time_ms + 1000);

	return rq_tmo_jiffies;
}

2302
static void srp_cm_rep_handler(struct ib_cm_id *cm_id,
2303
			       const struct srp_login_rsp *lrsp,
2304
			       struct srp_rdma_ch *ch)
2305
{
2306
	struct srp_target_port *target = ch->target;
2307 2308 2309 2310 2311 2312
	struct ib_qp_attr *qp_attr = NULL;
	int attr_mask = 0;
	int ret;
	int i;

	if (lrsp->opcode == SRP_LOGIN_RSP) {
2313 2314
		ch->max_ti_iu_len = be32_to_cpu(lrsp->max_ti_iu_len);
		ch->req_lim       = be32_to_cpu(lrsp->req_lim_delta);
2315 2316 2317 2318 2319 2320

		/*
		 * Reserve credits for task management so we don't
		 * bounce requests back to the SCSI mid-layer.
		 */
		target->scsi_host->can_queue
2321
			= min(ch->req_lim - SRP_TSK_MGMT_SQ_SIZE,
2322
			      target->scsi_host->can_queue);
2323 2324 2325
		target->scsi_host->cmd_per_lun
			= min_t(int, target->scsi_host->can_queue,
				target->scsi_host->cmd_per_lun);
2326 2327 2328 2329 2330 2331 2332
	} else {
		shost_printk(KERN_WARNING, target->scsi_host,
			     PFX "Unhandled RSP opcode %#x\n", lrsp->opcode);
		ret = -ECONNRESET;
		goto error;
	}

2333 2334
	if (!ch->rx_ring) {
		ret = srp_alloc_iu_bufs(ch);
2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348
		if (ret)
			goto error;
	}

	ret = -ENOMEM;
	qp_attr = kmalloc(sizeof *qp_attr, GFP_KERNEL);
	if (!qp_attr)
		goto error;

	qp_attr->qp_state = IB_QPS_RTR;
	ret = ib_cm_init_qp_attr(cm_id, qp_attr, &attr_mask);
	if (ret)
		goto error_free;

2349
	ret = ib_modify_qp(ch->qp, qp_attr, attr_mask);
2350 2351 2352
	if (ret)
		goto error_free;

2353
	for (i = 0; i < target->queue_size; i++) {
2354 2355 2356
		struct srp_iu *iu = ch->rx_ring[i];

		ret = srp_post_recv(ch, iu);
2357 2358 2359 2360 2361 2362 2363 2364 2365
		if (ret)
			goto error_free;
	}

	qp_attr->qp_state = IB_QPS_RTS;
	ret = ib_cm_init_qp_attr(cm_id, qp_attr, &attr_mask);
	if (ret)
		goto error_free;

2366 2367
	target->rq_tmo_jiffies = srp_compute_rq_tmo(qp_attr, attr_mask);

2368
	ret = ib_modify_qp(ch->qp, qp_attr, attr_mask);
2369 2370 2371 2372 2373 2374 2375 2376 2377
	if (ret)
		goto error_free;

	ret = ib_send_cm_rtu(cm_id, NULL, 0);

error_free:
	kfree(qp_attr);

error:
2378
	ch->status = ret;
2379 2380
}

2381 2382
static void srp_cm_rej_handler(struct ib_cm_id *cm_id,
			       struct ib_cm_event *event,
2383
			       struct srp_rdma_ch *ch)
2384
{
2385
	struct srp_target_port *target = ch->target;
2386
	struct Scsi_Host *shost = target->scsi_host;
2387 2388 2389 2390 2391 2392
	struct ib_class_port_info *cpi;
	int opcode;

	switch (event->param.rej_rcvd.reason) {
	case IB_CM_REJ_PORT_CM_REDIRECT:
		cpi = event->param.rej_rcvd.ari;
2393 2394
		ch->path.dlid = cpi->redirect_lid;
		ch->path.pkey = cpi->redirect_pkey;
2395
		cm_id->remote_cm_qpn = be32_to_cpu(cpi->redirect_qp) & 0x00ffffff;
2396
		memcpy(ch->path.dgid.raw, cpi->redirect_gid, 16);
2397

2398
		ch->status = ch->path.dlid ?
2399 2400 2401 2402
			SRP_DLID_REDIRECT : SRP_PORT_REDIRECT;
		break;

	case IB_CM_REJ_PORT_REDIRECT:
2403
		if (srp_target_is_topspin(target)) {
2404 2405 2406 2407 2408
			/*
			 * Topspin/Cisco SRP gateways incorrectly send
			 * reject reason code 25 when they mean 24
			 * (port redirect).
			 */
2409
			memcpy(ch->path.dgid.raw,
2410 2411
			       event->param.rej_rcvd.ari, 16);

2412 2413
			shost_printk(KERN_DEBUG, shost,
				     PFX "Topspin/Cisco redirect to target port GID %016llx%016llx\n",
2414 2415
				     be64_to_cpu(ch->path.dgid.global.subnet_prefix),
				     be64_to_cpu(ch->path.dgid.global.interface_id));
2416

2417
			ch->status = SRP_PORT_REDIRECT;
2418
		} else {
2419 2420
			shost_printk(KERN_WARNING, shost,
				     "  REJ reason: IB_CM_REJ_PORT_REDIRECT\n");
2421
			ch->status = -ECONNRESET;
2422 2423 2424 2425
		}
		break;

	case IB_CM_REJ_DUPLICATE_LOCAL_COMM_ID:
2426 2427
		shost_printk(KERN_WARNING, shost,
			    "  REJ reason: IB_CM_REJ_DUPLICATE_LOCAL_COMM_ID\n");
2428
		ch->status = -ECONNRESET;
2429 2430 2431 2432 2433 2434 2435 2436 2437
		break;

	case IB_CM_REJ_CONSUMER_DEFINED:
		opcode = *(u8 *) event->private_data;
		if (opcode == SRP_LOGIN_REJ) {
			struct srp_login_rej *rej = event->private_data;
			u32 reason = be32_to_cpu(rej->reason);

			if (reason == SRP_LOGIN_REJ_REQ_IT_IU_LENGTH_TOO_LARGE)
2438 2439
				shost_printk(KERN_WARNING, shost,
					     PFX "SRP_LOGIN_REJ: requested max_it_iu_len too large\n");
2440
			else
B
Bart Van Assche 已提交
2441 2442
				shost_printk(KERN_WARNING, shost, PFX
					     "SRP LOGIN from %pI6 to %pI6 REJECTED, reason 0x%08x\n",
2443 2444
					     target->sgid.raw,
					     target->orig_dgid.raw, reason);
2445
		} else
2446 2447 2448
			shost_printk(KERN_WARNING, shost,
				     "  REJ reason: IB_CM_REJ_CONSUMER_DEFINED,"
				     " opcode 0x%02x\n", opcode);
2449
		ch->status = -ECONNRESET;
2450 2451
		break;

D
David Dillow 已提交
2452 2453
	case IB_CM_REJ_STALE_CONN:
		shost_printk(KERN_WARNING, shost, "  REJ reason: stale connection\n");
2454
		ch->status = SRP_STALE_CONN;
D
David Dillow 已提交
2455 2456
		break;

2457
	default:
2458 2459
		shost_printk(KERN_WARNING, shost, "  REJ reason 0x%x\n",
			     event->param.rej_rcvd.reason);
2460
		ch->status = -ECONNRESET;
2461 2462 2463 2464 2465
	}
}

static int srp_cm_handler(struct ib_cm_id *cm_id, struct ib_cm_event *event)
{
2466 2467
	struct srp_rdma_ch *ch = cm_id->context;
	struct srp_target_port *target = ch->target;
2468 2469 2470 2471
	int comp = 0;

	switch (event->event) {
	case IB_CM_REQ_ERROR:
2472 2473
		shost_printk(KERN_DEBUG, target->scsi_host,
			     PFX "Sending CM REQ failed\n");
2474
		comp = 1;
2475
		ch->status = -ECONNRESET;
2476 2477 2478 2479
		break;

	case IB_CM_REP_RECEIVED:
		comp = 1;
2480
		srp_cm_rep_handler(cm_id, event->private_data, ch);
2481 2482 2483
		break;

	case IB_CM_REJ_RECEIVED:
2484
		shost_printk(KERN_DEBUG, target->scsi_host, PFX "REJ received\n");
2485 2486
		comp = 1;

2487
		srp_cm_rej_handler(cm_id, event, ch);
2488 2489
		break;

2490
	case IB_CM_DREQ_RECEIVED:
2491 2492
		shost_printk(KERN_WARNING, target->scsi_host,
			     PFX "DREQ received - connection closed\n");
2493
		ch->connected = false;
2494
		if (ib_send_cm_drep(cm_id, NULL, 0))
2495 2496
			shost_printk(KERN_ERR, target->scsi_host,
				     PFX "Sending CM DREP failed\n");
2497
		queue_work(system_long_wq, &target->tl_err_work);
2498 2499 2500
		break;

	case IB_CM_TIMEWAIT_EXIT:
2501 2502
		shost_printk(KERN_ERR, target->scsi_host,
			     PFX "connection closed\n");
2503
		comp = 1;
2504

2505
		ch->status = 0;
2506 2507
		break;

2508 2509 2510 2511 2512
	case IB_CM_MRA_RECEIVED:
	case IB_CM_DREQ_ERROR:
	case IB_CM_DREP_RECEIVED:
		break;

2513
	default:
2514 2515
		shost_printk(KERN_WARNING, target->scsi_host,
			     PFX "Unhandled CM event %d\n", event->event);
2516 2517 2518 2519
		break;
	}

	if (comp)
2520
		complete(&ch->done);
2521 2522 2523 2524

	return 0;
}

2525 2526 2527 2528 2529 2530 2531 2532
/**
 * srp_change_queue_depth - setting device queue depth
 * @sdev: scsi device struct
 * @qdepth: requested queue depth
 *
 * Returns queue depth.
 */
static int
2533
srp_change_queue_depth(struct scsi_device *sdev, int qdepth)
2534
{
2535
	if (!sdev->tagged_supported)
2536
		qdepth = 1;
2537
	return scsi_change_queue_depth(sdev, qdepth);
2538 2539
}

B
Bart Van Assche 已提交
2540
static int srp_send_tsk_mgmt(struct srp_rdma_ch *ch, u64 req_tag, u64 lun,
2541
			     u8 func, u8 *status)
2542
{
2543
	struct srp_target_port *target = ch->target;
2544
	struct srp_rport *rport = target->rport;
2545
	struct ib_device *dev = target->srp_host->srp_dev->dev;
2546 2547
	struct srp_iu *iu;
	struct srp_tsk_mgmt *tsk_mgmt;
2548
	int res;
2549

2550
	if (!ch->connected || target->qp_in_error)
2551 2552
		return -1;

2553
	/*
2554
	 * Lock the rport mutex to avoid that srp_create_ch_ib() is
2555 2556 2557
	 * invoked while a task management function is being sent.
	 */
	mutex_lock(&rport->mutex);
2558 2559 2560
	spin_lock_irq(&ch->lock);
	iu = __srp_get_tx_iu(ch, SRP_IU_TSK_MGMT);
	spin_unlock_irq(&ch->lock);
2561

2562 2563 2564
	if (!iu) {
		mutex_unlock(&rport->mutex);

2565
		return -1;
2566
	}
2567

2568 2569
	ib_dma_sync_single_for_cpu(dev, iu->dma, sizeof *tsk_mgmt,
				   DMA_TO_DEVICE);
2570 2571 2572 2573
	tsk_mgmt = iu->buf;
	memset(tsk_mgmt, 0, sizeof *tsk_mgmt);

	tsk_mgmt->opcode 	= SRP_TSK_MGMT;
B
Bart Van Assche 已提交
2574
	int_to_scsilun(lun, &tsk_mgmt->lun);
2575
	tsk_mgmt->tsk_mgmt_func = func;
2576
	tsk_mgmt->task_tag	= req_tag;
2577

2578 2579 2580 2581 2582 2583 2584
	spin_lock_irq(&ch->lock);
	ch->tsk_mgmt_tag = (ch->tsk_mgmt_tag + 1) | SRP_TAG_TSK_MGMT;
	tsk_mgmt->tag = ch->tsk_mgmt_tag;
	spin_unlock_irq(&ch->lock);

	init_completion(&ch->tsk_mgmt_done);

2585 2586
	ib_dma_sync_single_for_device(dev, iu->dma, sizeof *tsk_mgmt,
				      DMA_TO_DEVICE);
2587 2588
	if (srp_post_send(ch, iu, sizeof(*tsk_mgmt))) {
		srp_put_tx_iu(ch, iu, SRP_IU_TSK_MGMT);
2589 2590
		mutex_unlock(&rport->mutex);

2591 2592
		return -1;
	}
2593 2594 2595 2596
	res = wait_for_completion_timeout(&ch->tsk_mgmt_done,
					msecs_to_jiffies(SRP_ABORT_TIMEOUT_MS));
	if (res > 0 && status)
		*status = ch->tsk_mgmt_status;
2597
	mutex_unlock(&rport->mutex);
2598

2599
	WARN_ON_ONCE(res < 0);
2600

2601
	return res > 0 ? 0 : -1;
2602 2603
}

2604 2605
static int srp_abort(struct scsi_cmnd *scmnd)
{
2606
	struct srp_target_port *target = host_to_target(scmnd->device->host);
2607
	struct srp_request *req = (struct srp_request *) scmnd->host_scribble;
B
Bart Van Assche 已提交
2608
	u32 tag;
B
Bart Van Assche 已提交
2609
	u16 ch_idx;
2610
	struct srp_rdma_ch *ch;
2611
	int ret;
2612

2613
	shost_printk(KERN_ERR, target->scsi_host, "SRP abort called\n");
2614

B
Bart Van Assche 已提交
2615
	if (!req)
2616
		return SUCCESS;
B
Bart Van Assche 已提交
2617
	tag = blk_mq_unique_tag(scmnd->request);
B
Bart Van Assche 已提交
2618 2619 2620 2621 2622 2623 2624 2625
	ch_idx = blk_mq_unique_tag_to_hwq(tag);
	if (WARN_ON_ONCE(ch_idx >= target->ch_count))
		return SUCCESS;
	ch = &target->ch[ch_idx];
	if (!srp_claim_req(ch, req, NULL, scmnd))
		return SUCCESS;
	shost_printk(KERN_ERR, target->scsi_host,
		     "Sending SRP abort for tag %#x\n", tag);
B
Bart Van Assche 已提交
2626
	if (srp_send_tsk_mgmt(ch, tag, scmnd->device->lun,
2627
			      SRP_TSK_ABORT_TASK, NULL) == 0)
2628
		ret = SUCCESS;
2629
	else if (target->rport->state == SRP_RPORT_LOST)
2630
		ret = FAST_IO_FAIL;
2631 2632
	else
		ret = FAILED;
2633
	srp_free_req(ch, req, scmnd, 0);
B
Bart Van Assche 已提交
2634
	scmnd->result = DID_ABORT << 16;
2635
	scmnd->scsi_done(scmnd);
2636

2637
	return ret;
2638 2639 2640 2641
}

static int srp_reset_device(struct scsi_cmnd *scmnd)
{
2642
	struct srp_target_port *target = host_to_target(scmnd->device->host);
B
Bart Van Assche 已提交
2643
	struct srp_rdma_ch *ch;
2644
	int i;
2645
	u8 status;
2646

2647
	shost_printk(KERN_ERR, target->scsi_host, "SRP reset_device called\n");
2648

B
Bart Van Assche 已提交
2649
	ch = &target->ch[0];
2650
	if (srp_send_tsk_mgmt(ch, SRP_TAG_NO_REQ, scmnd->device->lun,
2651
			      SRP_TSK_LUN_RESET, &status))
2652
		return FAILED;
2653
	if (status)
2654 2655
		return FAILED;

B
Bart Van Assche 已提交
2656 2657 2658 2659
	for (i = 0; i < target->ch_count; i++) {
		ch = &target->ch[i];
		for (i = 0; i < target->req_ring_size; ++i) {
			struct srp_request *req = &ch->req_ring[i];
2660

B
Bart Van Assche 已提交
2661 2662
			srp_finish_req(ch, req, scmnd->device, DID_RESET << 16);
		}
2663
	}
2664 2665

	return SUCCESS;
2666 2667 2668 2669 2670 2671
}

static int srp_reset_host(struct scsi_cmnd *scmnd)
{
	struct srp_target_port *target = host_to_target(scmnd->device->host);

2672
	shost_printk(KERN_ERR, target->scsi_host, PFX "SRP reset_host called\n");
2673

2674
	return srp_reconnect_rport(target->rport) == 0 ? SUCCESS : FAILED;
2675 2676
}

2677 2678 2679 2680 2681 2682
static int srp_slave_alloc(struct scsi_device *sdev)
{
	struct Scsi_Host *shost = sdev->host;
	struct srp_target_port *target = host_to_target(shost);
	struct srp_device *srp_dev = target->srp_host->srp_dev;

2683
	if (true)
2684 2685 2686 2687 2688 2689
		blk_queue_virt_boundary(sdev->request_queue,
					~srp_dev->mr_page_mask);

	return 0;
}

2690 2691 2692 2693 2694 2695 2696 2697 2698 2699 2700 2701 2702 2703 2704
static int srp_slave_configure(struct scsi_device *sdev)
{
	struct Scsi_Host *shost = sdev->host;
	struct srp_target_port *target = host_to_target(shost);
	struct request_queue *q = sdev->request_queue;
	unsigned long timeout;

	if (sdev->type == TYPE_DISK) {
		timeout = max_t(unsigned, 30 * HZ, target->rq_tmo_jiffies);
		blk_queue_rq_timeout(q, timeout);
	}

	return 0;
}

2705 2706
static ssize_t show_id_ext(struct device *dev, struct device_attribute *attr,
			   char *buf)
2707
{
2708
	struct srp_target_port *target = host_to_target(class_to_shost(dev));
2709

2710
	return sprintf(buf, "0x%016llx\n", be64_to_cpu(target->id_ext));
2711 2712
}

2713 2714
static ssize_t show_ioc_guid(struct device *dev, struct device_attribute *attr,
			     char *buf)
2715
{
2716
	struct srp_target_port *target = host_to_target(class_to_shost(dev));
2717

2718
	return sprintf(buf, "0x%016llx\n", be64_to_cpu(target->ioc_guid));
2719 2720
}

2721 2722
static ssize_t show_service_id(struct device *dev,
			       struct device_attribute *attr, char *buf)
2723
{
2724
	struct srp_target_port *target = host_to_target(class_to_shost(dev));
2725

2726
	return sprintf(buf, "0x%016llx\n", be64_to_cpu(target->service_id));
2727 2728
}

2729 2730
static ssize_t show_pkey(struct device *dev, struct device_attribute *attr,
			 char *buf)
2731
{
2732
	struct srp_target_port *target = host_to_target(class_to_shost(dev));
2733

2734
	return sprintf(buf, "0x%04x\n", be16_to_cpu(target->pkey));
2735 2736
}

B
Bart Van Assche 已提交
2737 2738 2739 2740 2741
static ssize_t show_sgid(struct device *dev, struct device_attribute *attr,
			 char *buf)
{
	struct srp_target_port *target = host_to_target(class_to_shost(dev));

2742
	return sprintf(buf, "%pI6\n", target->sgid.raw);
B
Bart Van Assche 已提交
2743 2744
}

2745 2746
static ssize_t show_dgid(struct device *dev, struct device_attribute *attr,
			 char *buf)
2747
{
2748
	struct srp_target_port *target = host_to_target(class_to_shost(dev));
B
Bart Van Assche 已提交
2749
	struct srp_rdma_ch *ch = &target->ch[0];
2750

2751
	return sprintf(buf, "%pI6\n", ch->path.dgid.raw);
2752 2753
}

2754 2755
static ssize_t show_orig_dgid(struct device *dev,
			      struct device_attribute *attr, char *buf)
2756
{
2757
	struct srp_target_port *target = host_to_target(class_to_shost(dev));
2758

2759
	return sprintf(buf, "%pI6\n", target->orig_dgid.raw);
2760 2761
}

2762 2763 2764 2765
static ssize_t show_req_lim(struct device *dev,
			    struct device_attribute *attr, char *buf)
{
	struct srp_target_port *target = host_to_target(class_to_shost(dev));
B
Bart Van Assche 已提交
2766 2767
	struct srp_rdma_ch *ch;
	int i, req_lim = INT_MAX;
2768

B
Bart Van Assche 已提交
2769 2770 2771 2772 2773
	for (i = 0; i < target->ch_count; i++) {
		ch = &target->ch[i];
		req_lim = min(req_lim, ch->req_lim);
	}
	return sprintf(buf, "%d\n", req_lim);
2774 2775
}

2776 2777
static ssize_t show_zero_req_lim(struct device *dev,
				 struct device_attribute *attr, char *buf)
2778
{
2779
	struct srp_target_port *target = host_to_target(class_to_shost(dev));
2780 2781 2782 2783

	return sprintf(buf, "%d\n", target->zero_req_lim);
}

2784 2785
static ssize_t show_local_ib_port(struct device *dev,
				  struct device_attribute *attr, char *buf)
2786
{
2787
	struct srp_target_port *target = host_to_target(class_to_shost(dev));
2788 2789 2790 2791

	return sprintf(buf, "%d\n", target->srp_host->port);
}

2792 2793
static ssize_t show_local_ib_device(struct device *dev,
				    struct device_attribute *attr, char *buf)
2794
{
2795
	struct srp_target_port *target = host_to_target(class_to_shost(dev));
2796

2797
	return sprintf(buf, "%s\n", target->srp_host->srp_dev->dev->name);
2798 2799
}

B
Bart Van Assche 已提交
2800 2801 2802 2803 2804 2805 2806 2807
static ssize_t show_ch_count(struct device *dev, struct device_attribute *attr,
			     char *buf)
{
	struct srp_target_port *target = host_to_target(class_to_shost(dev));

	return sprintf(buf, "%d\n", target->ch_count);
}

2808 2809 2810 2811 2812 2813 2814 2815
static ssize_t show_comp_vector(struct device *dev,
				struct device_attribute *attr, char *buf)
{
	struct srp_target_port *target = host_to_target(class_to_shost(dev));

	return sprintf(buf, "%d\n", target->comp_vector);
}

2816 2817 2818 2819 2820 2821 2822 2823
static ssize_t show_tl_retry_count(struct device *dev,
				   struct device_attribute *attr, char *buf)
{
	struct srp_target_port *target = host_to_target(class_to_shost(dev));

	return sprintf(buf, "%d\n", target->tl_retry_count);
}

2824 2825 2826 2827 2828 2829 2830 2831
static ssize_t show_cmd_sg_entries(struct device *dev,
				   struct device_attribute *attr, char *buf)
{
	struct srp_target_port *target = host_to_target(class_to_shost(dev));

	return sprintf(buf, "%u\n", target->cmd_sg_cnt);
}

2832 2833 2834 2835 2836 2837 2838 2839
static ssize_t show_allow_ext_sg(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	struct srp_target_port *target = host_to_target(class_to_shost(dev));

	return sprintf(buf, "%s\n", target->allow_ext_sg ? "true" : "false");
}

2840 2841 2842 2843
static DEVICE_ATTR(id_ext,	    S_IRUGO, show_id_ext,	   NULL);
static DEVICE_ATTR(ioc_guid,	    S_IRUGO, show_ioc_guid,	   NULL);
static DEVICE_ATTR(service_id,	    S_IRUGO, show_service_id,	   NULL);
static DEVICE_ATTR(pkey,	    S_IRUGO, show_pkey,		   NULL);
B
Bart Van Assche 已提交
2844
static DEVICE_ATTR(sgid,	    S_IRUGO, show_sgid,		   NULL);
2845 2846
static DEVICE_ATTR(dgid,	    S_IRUGO, show_dgid,		   NULL);
static DEVICE_ATTR(orig_dgid,	    S_IRUGO, show_orig_dgid,	   NULL);
2847
static DEVICE_ATTR(req_lim,         S_IRUGO, show_req_lim,         NULL);
2848 2849 2850
static DEVICE_ATTR(zero_req_lim,    S_IRUGO, show_zero_req_lim,	   NULL);
static DEVICE_ATTR(local_ib_port,   S_IRUGO, show_local_ib_port,   NULL);
static DEVICE_ATTR(local_ib_device, S_IRUGO, show_local_ib_device, NULL);
B
Bart Van Assche 已提交
2851
static DEVICE_ATTR(ch_count,        S_IRUGO, show_ch_count,        NULL);
2852
static DEVICE_ATTR(comp_vector,     S_IRUGO, show_comp_vector,     NULL);
2853
static DEVICE_ATTR(tl_retry_count,  S_IRUGO, show_tl_retry_count,  NULL);
2854
static DEVICE_ATTR(cmd_sg_entries,  S_IRUGO, show_cmd_sg_entries,  NULL);
2855
static DEVICE_ATTR(allow_ext_sg,    S_IRUGO, show_allow_ext_sg,    NULL);
2856 2857 2858 2859 2860 2861

static struct device_attribute *srp_host_attrs[] = {
	&dev_attr_id_ext,
	&dev_attr_ioc_guid,
	&dev_attr_service_id,
	&dev_attr_pkey,
B
Bart Van Assche 已提交
2862
	&dev_attr_sgid,
2863 2864
	&dev_attr_dgid,
	&dev_attr_orig_dgid,
2865
	&dev_attr_req_lim,
2866 2867 2868
	&dev_attr_zero_req_lim,
	&dev_attr_local_ib_port,
	&dev_attr_local_ib_device,
B
Bart Van Assche 已提交
2869
	&dev_attr_ch_count,
2870
	&dev_attr_comp_vector,
2871
	&dev_attr_tl_retry_count,
2872
	&dev_attr_cmd_sg_entries,
2873
	&dev_attr_allow_ext_sg,
2874 2875 2876
	NULL
};

2877 2878
static struct scsi_host_template srp_template = {
	.module				= THIS_MODULE,
R
Roland Dreier 已提交
2879 2880
	.name				= "InfiniBand SRP initiator",
	.proc_name			= DRV_NAME,
2881
	.slave_alloc			= srp_slave_alloc,
2882
	.slave_configure		= srp_slave_configure,
2883 2884
	.info				= srp_target_info,
	.queuecommand			= srp_queuecommand,
2885
	.change_queue_depth             = srp_change_queue_depth,
2886 2887 2888
	.eh_abort_handler		= srp_abort,
	.eh_device_reset_handler	= srp_reset_device,
	.eh_host_reset_handler		= srp_reset_host,
B
Bart Van Assche 已提交
2889
	.skip_settle_delay		= true,
2890
	.sg_tablesize			= SRP_DEF_SG_TABLESIZE,
2891
	.can_queue			= SRP_DEFAULT_CMD_SQ_SIZE,
2892
	.this_id			= -1,
2893
	.cmd_per_lun			= SRP_DEFAULT_CMD_SQ_SIZE,
2894
	.use_clustering			= ENABLE_CLUSTERING,
B
Bart Van Assche 已提交
2895
	.shost_attrs			= srp_host_attrs,
2896
	.track_queue_depth		= 1,
2897 2898
};

2899 2900 2901 2902 2903 2904 2905 2906 2907 2908 2909
static int srp_sdev_count(struct Scsi_Host *host)
{
	struct scsi_device *sdev;
	int c = 0;

	shost_for_each_device(sdev, host)
		c++;

	return c;
}

2910 2911 2912 2913 2914 2915 2916
/*
 * Return values:
 * < 0 upon failure. Caller is responsible for SRP target port cleanup.
 * 0 and target->state == SRP_TARGET_REMOVED if asynchronous target port
 *    removal has been scheduled.
 * 0 and target->state != SRP_TARGET_REMOVED upon success.
 */
2917 2918
static int srp_add_target(struct srp_host *host, struct srp_target_port *target)
{
2919 2920 2921
	struct srp_rport_identifiers ids;
	struct srp_rport *rport;

2922
	target->state = SRP_TARGET_SCANNING;
2923
	sprintf(target->target_name, "SRP.T10:%016llX",
2924
		be64_to_cpu(target->id_ext));
2925

2926
	if (scsi_add_host(target->scsi_host, host->srp_dev->dev->dma_device))
2927 2928
		return -ENODEV;

2929 2930
	memcpy(ids.port_id, &target->id_ext, 8);
	memcpy(ids.port_id + 8, &target->ioc_guid, 8);
2931
	ids.roles = SRP_RPORT_ROLE_TARGET;
2932 2933 2934 2935 2936 2937
	rport = srp_rport_add(target->scsi_host, &ids);
	if (IS_ERR(rport)) {
		scsi_remove_host(target->scsi_host);
		return PTR_ERR(rport);
	}

2938
	rport->lld_data = target;
2939
	target->rport = rport;
2940

2941
	spin_lock(&host->target_lock);
2942
	list_add_tail(&target->list, &host->target_list);
2943
	spin_unlock(&host->target_lock);
2944 2945

	scsi_scan_target(&target->scsi_host->shost_gendev,
2946
			 0, target->scsi_id, SCAN_WILD_CARD, SCSI_SCAN_INITIAL);
2947

2948 2949
	if (srp_connected_ch(target) < target->ch_count ||
	    target->qp_in_error) {
2950 2951 2952 2953 2954 2955
		shost_printk(KERN_INFO, target->scsi_host,
			     PFX "SCSI scan failed - removing SCSI host\n");
		srp_queue_remove_work(target);
		goto out;
	}

2956
	pr_debug("%s: SCSI scan succeeded - detected %d LUNs\n",
2957 2958 2959 2960 2961 2962 2963 2964 2965
		 dev_name(&target->scsi_host->shost_gendev),
		 srp_sdev_count(target->scsi_host));

	spin_lock_irq(&target->lock);
	if (target->state == SRP_TARGET_SCANNING)
		target->state = SRP_TARGET_LIVE;
	spin_unlock_irq(&target->lock);

out:
2966 2967 2968
	return 0;
}

2969
static void srp_release_dev(struct device *dev)
2970 2971
{
	struct srp_host *host =
2972
		container_of(dev, struct srp_host, dev);
2973 2974 2975 2976 2977 2978

	complete(&host->released);
}

static struct class srp_class = {
	.name    = "infiniband_srp",
2979
	.dev_release = srp_release_dev
2980 2981
};

2982 2983
/**
 * srp_conn_unique() - check whether the connection to a target is unique
2984 2985
 * @host:   SRP host.
 * @target: SRP target port.
2986 2987 2988 2989 2990 2991 2992 2993 2994 2995 2996 2997 2998 2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013
 */
static bool srp_conn_unique(struct srp_host *host,
			    struct srp_target_port *target)
{
	struct srp_target_port *t;
	bool ret = false;

	if (target->state == SRP_TARGET_REMOVED)
		goto out;

	ret = true;

	spin_lock(&host->target_lock);
	list_for_each_entry(t, &host->target_list, list) {
		if (t != target &&
		    target->id_ext == t->id_ext &&
		    target->ioc_guid == t->ioc_guid &&
		    target->initiator_ext == t->initiator_ext) {
			ret = false;
			break;
		}
	}
	spin_unlock(&host->target_lock);

out:
	return ret;
}

3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025 3026 3027 3028 3029
/*
 * Target ports are added by writing
 *
 *     id_ext=<SRP ID ext>,ioc_guid=<SRP IOC GUID>,dgid=<dest GID>,
 *     pkey=<P_Key>,service_id=<service ID>
 *
 * to the add_target sysfs attribute.
 */
enum {
	SRP_OPT_ERR		= 0,
	SRP_OPT_ID_EXT		= 1 << 0,
	SRP_OPT_IOC_GUID	= 1 << 1,
	SRP_OPT_DGID		= 1 << 2,
	SRP_OPT_PKEY		= 1 << 3,
	SRP_OPT_SERVICE_ID	= 1 << 4,
	SRP_OPT_MAX_SECT	= 1 << 5,
3030
	SRP_OPT_MAX_CMD_PER_LUN	= 1 << 6,
3031
	SRP_OPT_IO_CLASS	= 1 << 7,
3032
	SRP_OPT_INITIATOR_EXT	= 1 << 8,
3033
	SRP_OPT_CMD_SG_ENTRIES	= 1 << 9,
3034 3035
	SRP_OPT_ALLOW_EXT_SG	= 1 << 10,
	SRP_OPT_SG_TABLESIZE	= 1 << 11,
3036
	SRP_OPT_COMP_VECTOR	= 1 << 12,
3037
	SRP_OPT_TL_RETRY_COUNT	= 1 << 13,
3038
	SRP_OPT_QUEUE_SIZE	= 1 << 14,
3039 3040 3041 3042 3043 3044 3045
	SRP_OPT_ALL		= (SRP_OPT_ID_EXT	|
				   SRP_OPT_IOC_GUID	|
				   SRP_OPT_DGID		|
				   SRP_OPT_PKEY		|
				   SRP_OPT_SERVICE_ID),
};

3046
static const match_table_t srp_opt_tokens = {
3047 3048 3049 3050 3051 3052 3053
	{ SRP_OPT_ID_EXT,		"id_ext=%s" 		},
	{ SRP_OPT_IOC_GUID,		"ioc_guid=%s" 		},
	{ SRP_OPT_DGID,			"dgid=%s" 		},
	{ SRP_OPT_PKEY,			"pkey=%x" 		},
	{ SRP_OPT_SERVICE_ID,		"service_id=%s"		},
	{ SRP_OPT_MAX_SECT,		"max_sect=%d" 		},
	{ SRP_OPT_MAX_CMD_PER_LUN,	"max_cmd_per_lun=%d" 	},
3054
	{ SRP_OPT_IO_CLASS,		"io_class=%x"		},
3055
	{ SRP_OPT_INITIATOR_EXT,	"initiator_ext=%s"	},
3056
	{ SRP_OPT_CMD_SG_ENTRIES,	"cmd_sg_entries=%u"	},
3057 3058
	{ SRP_OPT_ALLOW_EXT_SG,		"allow_ext_sg=%u"	},
	{ SRP_OPT_SG_TABLESIZE,		"sg_tablesize=%u"	},
3059
	{ SRP_OPT_COMP_VECTOR,		"comp_vector=%u"	},
3060
	{ SRP_OPT_TL_RETRY_COUNT,	"tl_retry_count=%u"	},
3061
	{ SRP_OPT_QUEUE_SIZE,		"queue_size=%d"		},
3062
	{ SRP_OPT_ERR,			NULL 			}
3063 3064 3065 3066 3067 3068 3069 3070 3071 3072 3073 3074 3075 3076 3077 3078 3079 3080
};

static int srp_parse_options(const char *buf, struct srp_target_port *target)
{
	char *options, *sep_opt;
	char *p;
	char dgid[3];
	substring_t args[MAX_OPT_ARGS];
	int opt_mask = 0;
	int token;
	int ret = -EINVAL;
	int i;

	options = kstrdup(buf, GFP_KERNEL);
	if (!options)
		return -ENOMEM;

	sep_opt = options;
3081
	while ((p = strsep(&sep_opt, ",\n")) != NULL) {
3082 3083 3084 3085 3086 3087 3088 3089 3090
		if (!*p)
			continue;

		token = match_token(p, srp_opt_tokens, args);
		opt_mask |= token;

		switch (token) {
		case SRP_OPT_ID_EXT:
			p = match_strdup(args);
3091 3092 3093 3094
			if (!p) {
				ret = -ENOMEM;
				goto out;
			}
3095 3096 3097 3098 3099 3100
			target->id_ext = cpu_to_be64(simple_strtoull(p, NULL, 16));
			kfree(p);
			break;

		case SRP_OPT_IOC_GUID:
			p = match_strdup(args);
3101 3102 3103 3104
			if (!p) {
				ret = -ENOMEM;
				goto out;
			}
3105 3106 3107 3108 3109 3110
			target->ioc_guid = cpu_to_be64(simple_strtoull(p, NULL, 16));
			kfree(p);
			break;

		case SRP_OPT_DGID:
			p = match_strdup(args);
3111 3112 3113 3114
			if (!p) {
				ret = -ENOMEM;
				goto out;
			}
3115
			if (strlen(p) != 32) {
3116
				pr_warn("bad dest GID parameter '%s'\n", p);
3117
				kfree(p);
3118 3119 3120 3121
				goto out;
			}

			for (i = 0; i < 16; ++i) {
3122 3123 3124 3125 3126 3127 3128
				strlcpy(dgid, p + i * 2, sizeof(dgid));
				if (sscanf(dgid, "%hhx",
					   &target->orig_dgid.raw[i]) < 1) {
					ret = -EINVAL;
					kfree(p);
					goto out;
				}
3129
			}
3130
			kfree(p);
3131 3132 3133 3134
			break;

		case SRP_OPT_PKEY:
			if (match_hex(args, &token)) {
3135
				pr_warn("bad P_Key parameter '%s'\n", p);
3136 3137
				goto out;
			}
3138
			target->pkey = cpu_to_be16(token);
3139 3140 3141 3142
			break;

		case SRP_OPT_SERVICE_ID:
			p = match_strdup(args);
3143 3144 3145 3146
			if (!p) {
				ret = -ENOMEM;
				goto out;
			}
3147 3148 3149 3150 3151 3152
			target->service_id = cpu_to_be64(simple_strtoull(p, NULL, 16));
			kfree(p);
			break;

		case SRP_OPT_MAX_SECT:
			if (match_int(args, &token)) {
3153
				pr_warn("bad max sect parameter '%s'\n", p);
3154 3155 3156 3157 3158
				goto out;
			}
			target->scsi_host->max_sectors = token;
			break;

3159 3160 3161 3162 3163 3164 3165 3166 3167 3168 3169 3170
		case SRP_OPT_QUEUE_SIZE:
			if (match_int(args, &token) || token < 1) {
				pr_warn("bad queue_size parameter '%s'\n", p);
				goto out;
			}
			target->scsi_host->can_queue = token;
			target->queue_size = token + SRP_RSP_SQ_SIZE +
					     SRP_TSK_MGMT_SQ_SIZE;
			if (!(opt_mask & SRP_OPT_MAX_CMD_PER_LUN))
				target->scsi_host->cmd_per_lun = token;
			break;

3171
		case SRP_OPT_MAX_CMD_PER_LUN:
3172
			if (match_int(args, &token) || token < 1) {
3173 3174
				pr_warn("bad max cmd_per_lun parameter '%s'\n",
					p);
3175 3176
				goto out;
			}
3177
			target->scsi_host->cmd_per_lun = token;
3178 3179
			break;

3180 3181
		case SRP_OPT_IO_CLASS:
			if (match_hex(args, &token)) {
3182
				pr_warn("bad IO class parameter '%s'\n", p);
3183 3184 3185 3186
				goto out;
			}
			if (token != SRP_REV10_IB_IO_CLASS &&
			    token != SRP_REV16A_IB_IO_CLASS) {
3187 3188 3189
				pr_warn("unknown IO class parameter value %x specified (use %x or %x).\n",
					token, SRP_REV10_IB_IO_CLASS,
					SRP_REV16A_IB_IO_CLASS);
3190 3191 3192 3193 3194
				goto out;
			}
			target->io_class = token;
			break;

3195 3196
		case SRP_OPT_INITIATOR_EXT:
			p = match_strdup(args);
3197 3198 3199 3200
			if (!p) {
				ret = -ENOMEM;
				goto out;
			}
3201 3202 3203 3204
			target->initiator_ext = cpu_to_be64(simple_strtoull(p, NULL, 16));
			kfree(p);
			break;

3205 3206
		case SRP_OPT_CMD_SG_ENTRIES:
			if (match_int(args, &token) || token < 1 || token > 255) {
3207 3208
				pr_warn("bad max cmd_sg_entries parameter '%s'\n",
					p);
3209 3210 3211 3212 3213
				goto out;
			}
			target->cmd_sg_cnt = token;
			break;

3214 3215
		case SRP_OPT_ALLOW_EXT_SG:
			if (match_int(args, &token)) {
3216
				pr_warn("bad allow_ext_sg parameter '%s'\n", p);
3217 3218 3219 3220 3221 3222 3223
				goto out;
			}
			target->allow_ext_sg = !!token;
			break;

		case SRP_OPT_SG_TABLESIZE:
			if (match_int(args, &token) || token < 1 ||
3224
					token > SG_MAX_SEGMENTS) {
3225 3226
				pr_warn("bad max sg_tablesize parameter '%s'\n",
					p);
3227 3228 3229 3230 3231
				goto out;
			}
			target->sg_tablesize = token;
			break;

3232 3233 3234 3235 3236 3237 3238 3239
		case SRP_OPT_COMP_VECTOR:
			if (match_int(args, &token) || token < 0) {
				pr_warn("bad comp_vector parameter '%s'\n", p);
				goto out;
			}
			target->comp_vector = token;
			break;

3240 3241 3242 3243 3244 3245 3246 3247 3248
		case SRP_OPT_TL_RETRY_COUNT:
			if (match_int(args, &token) || token < 2 || token > 7) {
				pr_warn("bad tl_retry_count parameter '%s' (must be a number between 2 and 7)\n",
					p);
				goto out;
			}
			target->tl_retry_count = token;
			break;

3249
		default:
3250 3251
			pr_warn("unknown parameter or missing value '%s' in target creation request\n",
				p);
3252 3253 3254 3255 3256 3257 3258 3259 3260 3261
			goto out;
		}
	}

	if ((opt_mask & SRP_OPT_ALL) == SRP_OPT_ALL)
		ret = 0;
	else
		for (i = 0; i < ARRAY_SIZE(srp_opt_tokens); ++i)
			if ((srp_opt_tokens[i].token & SRP_OPT_ALL) &&
			    !(srp_opt_tokens[i].token & opt_mask))
3262 3263
				pr_warn("target creation request is missing parameter '%s'\n",
					srp_opt_tokens[i].pattern);
3264

3265 3266 3267 3268 3269 3270
	if (target->scsi_host->cmd_per_lun > target->scsi_host->can_queue
	    && (opt_mask & SRP_OPT_MAX_CMD_PER_LUN))
		pr_warn("cmd_per_lun = %d > queue_size = %d\n",
			target->scsi_host->cmd_per_lun,
			target->scsi_host->can_queue);

3271 3272 3273 3274 3275
out:
	kfree(options);
	return ret;
}

3276 3277
static ssize_t srp_create_target(struct device *dev,
				 struct device_attribute *attr,
3278 3279 3280
				 const char *buf, size_t count)
{
	struct srp_host *host =
3281
		container_of(dev, struct srp_host, dev);
3282 3283
	struct Scsi_Host *target_host;
	struct srp_target_port *target;
3284
	struct srp_rdma_ch *ch;
3285 3286
	struct srp_device *srp_dev = host->srp_dev;
	struct ib_device *ibdev = srp_dev->dev;
B
Bart Van Assche 已提交
3287
	int ret, node_idx, node, cpu, i;
3288
	unsigned int max_sectors_per_mr, mr_per_cmd = 0;
B
Bart Van Assche 已提交
3289
	bool multich = false;
3290 3291 3292 3293 3294 3295

	target_host = scsi_host_alloc(&srp_template,
				      sizeof (struct srp_target_port));
	if (!target_host)
		return -ENOMEM;

3296
	target_host->transportt  = ib_srp_transport_template;
3297 3298
	target_host->max_channel = 0;
	target_host->max_id      = 1;
B
Bart Van Assche 已提交
3299
	target_host->max_lun     = -1LL;
A
Arne Redlich 已提交
3300
	target_host->max_cmd_len = sizeof ((struct srp_cmd *) (void *) 0L)->cdb;
R
Roland Dreier 已提交
3301

3302 3303
	target = host_to_target(target_host);

3304 3305 3306
	target->io_class	= SRP_REV16A_IB_IO_CLASS;
	target->scsi_host	= target_host;
	target->srp_host	= host;
3307
	target->pd		= host->srp_dev->pd;
J
Jason Gunthorpe 已提交
3308
	target->lkey		= host->srp_dev->pd->local_dma_lkey;
3309
	target->cmd_sg_cnt	= cmd_sg_entries;
3310 3311
	target->sg_tablesize	= indirect_sg_entries ? : cmd_sg_entries;
	target->allow_ext_sg	= allow_ext_sg;
3312
	target->tl_retry_count	= 7;
3313
	target->queue_size	= SRP_DEFAULT_QUEUE_SIZE;
3314

3315 3316 3317 3318 3319 3320
	/*
	 * Avoid that the SCSI host can be removed by srp_remove_target()
	 * before this function returns.
	 */
	scsi_host_get(target->scsi_host);

3321 3322 3323
	ret = mutex_lock_interruptible(&host->add_target_mutex);
	if (ret < 0)
		goto put;
3324

3325 3326
	ret = srp_parse_options(buf, target);
	if (ret)
3327
		goto out;
3328

3329 3330
	target->req_ring_size = target->queue_size - SRP_TSK_MGMT_SQ_SIZE;

3331 3332 3333 3334 3335 3336 3337
	if (!srp_conn_unique(target->srp_host, target)) {
		shost_printk(KERN_INFO, target->scsi_host,
			     PFX "Already connected to target port with id_ext=%016llx;ioc_guid=%016llx;initiator_ext=%016llx\n",
			     be64_to_cpu(target->id_ext),
			     be64_to_cpu(target->ioc_guid),
			     be64_to_cpu(target->initiator_ext));
		ret = -EEXIST;
3338
		goto out;
3339 3340
	}

3341
	if (!srp_dev->has_fmr && !srp_dev->has_fr && !target->allow_ext_sg &&
3342
	    target->cmd_sg_cnt < target->sg_tablesize) {
3343
		pr_warn("No MR pool and no external indirect descriptors, limiting sg_tablesize to cmd_sg_cnt\n");
3344 3345 3346
		target->sg_tablesize = target->cmd_sg_cnt;
	}

3347 3348 3349 3350 3351 3352 3353 3354 3355 3356 3357 3358 3359 3360 3361 3362 3363 3364 3365 3366 3367 3368 3369 3370
	if (srp_dev->use_fast_reg || srp_dev->use_fmr) {
		/*
		 * FR and FMR can only map one HCA page per entry. If the
		 * start address is not aligned on a HCA page boundary two
		 * entries will be used for the head and the tail although
		 * these two entries combined contain at most one HCA page of
		 * data. Hence the "+ 1" in the calculation below.
		 *
		 * The indirect data buffer descriptor is contiguous so the
		 * memory for that buffer will only be registered if
		 * register_always is true. Hence add one to mr_per_cmd if
		 * register_always has been set.
		 */
		max_sectors_per_mr = srp_dev->max_pages_per_mr <<
				  (ilog2(srp_dev->mr_page_size) - 9);
		mr_per_cmd = register_always +
			(target->scsi_host->max_sectors + 1 +
			 max_sectors_per_mr - 1) / max_sectors_per_mr;
		pr_debug("max_sectors = %u; max_pages_per_mr = %u; mr_page_size = %u; max_sectors_per_mr = %u; mr_per_cmd = %u\n",
			 target->scsi_host->max_sectors,
			 srp_dev->max_pages_per_mr, srp_dev->mr_page_size,
			 max_sectors_per_mr, mr_per_cmd);
	}

3371
	target_host->sg_tablesize = target->sg_tablesize;
3372 3373
	target->mr_pool_size = target->scsi_host->can_queue * mr_per_cmd;
	target->mr_per_cmd = mr_per_cmd;
3374 3375
	target->indirect_size = target->sg_tablesize *
				sizeof (struct srp_direct_buf);
3376 3377 3378 3379
	target->max_iu_len = sizeof (struct srp_cmd) +
			     sizeof (struct srp_indirect_buf) +
			     target->cmd_sg_cnt * sizeof (struct srp_direct_buf);

3380
	INIT_WORK(&target->tl_err_work, srp_tl_err_work);
3381
	INIT_WORK(&target->remove_work, srp_remove_work);
3382
	spin_lock_init(&target->lock);
3383
	ret = ib_query_gid(ibdev, host->port, 0, &target->sgid, NULL);
3384
	if (ret)
3385
		goto out;
3386

B
Bart Van Assche 已提交
3387 3388 3389 3390 3391 3392 3393 3394 3395
	ret = -ENOMEM;
	target->ch_count = max_t(unsigned, num_online_nodes(),
				 min(ch_count ? :
				     min(4 * num_online_nodes(),
					 ibdev->num_comp_vectors),
				     num_online_cpus()));
	target->ch = kcalloc(target->ch_count, sizeof(*target->ch),
			     GFP_KERNEL);
	if (!target->ch)
3396
		goto out;
3397

B
Bart Van Assche 已提交
3398 3399 3400 3401 3402 3403 3404 3405 3406 3407 3408 3409 3410 3411 3412 3413 3414 3415 3416 3417 3418 3419 3420 3421 3422 3423 3424 3425
	node_idx = 0;
	for_each_online_node(node) {
		const int ch_start = (node_idx * target->ch_count /
				      num_online_nodes());
		const int ch_end = ((node_idx + 1) * target->ch_count /
				    num_online_nodes());
		const int cv_start = (node_idx * ibdev->num_comp_vectors /
				      num_online_nodes() + target->comp_vector)
				     % ibdev->num_comp_vectors;
		const int cv_end = ((node_idx + 1) * ibdev->num_comp_vectors /
				    num_online_nodes() + target->comp_vector)
				   % ibdev->num_comp_vectors;
		int cpu_idx = 0;

		for_each_online_cpu(cpu) {
			if (cpu_to_node(cpu) != node)
				continue;
			if (ch_start + cpu_idx >= ch_end)
				continue;
			ch = &target->ch[ch_start + cpu_idx];
			ch->target = target;
			ch->comp_vector = cv_start == cv_end ? cv_start :
				cv_start + cpu_idx % (cv_end - cv_start);
			spin_lock_init(&ch->lock);
			INIT_LIST_HEAD(&ch->free_tx);
			ret = srp_new_cm_id(ch);
			if (ret)
				goto err_disconnect;
3426

B
Bart Van Assche 已提交
3427 3428 3429 3430 3431 3432 3433 3434 3435 3436 3437
			ret = srp_create_ch_ib(ch);
			if (ret)
				goto err_disconnect;

			ret = srp_alloc_req_data(ch);
			if (ret)
				goto err_disconnect;

			ret = srp_connect_ch(ch, multich);
			if (ret) {
				shost_printk(KERN_ERR, target->scsi_host,
3438
					     PFX "Connection %d/%d to %pI6 failed\n",
B
Bart Van Assche 已提交
3439
					     ch_start + cpu_idx,
3440 3441
					     target->ch_count,
					     ch->target->orig_dgid.raw);
B
Bart Van Assche 已提交
3442
				if (node_idx == 0 && cpu_idx == 0) {
B
Bart Van Assche 已提交
3443
					goto free_ch;
B
Bart Van Assche 已提交
3444 3445 3446 3447
				} else {
					srp_free_ch_ib(target, ch);
					srp_free_req_data(target, ch);
					target->ch_count = ch - target->ch;
3448
					goto connected;
B
Bart Van Assche 已提交
3449 3450 3451 3452 3453 3454 3455
				}
			}

			multich = true;
			cpu_idx++;
		}
		node_idx++;
3456 3457
	}

3458
connected:
B
Bart Van Assche 已提交
3459 3460
	target->scsi_host->nr_hw_queues = target->ch_count;

3461 3462 3463 3464
	ret = srp_add_target(host, target);
	if (ret)
		goto err_disconnect;

3465 3466 3467 3468 3469
	if (target->state != SRP_TARGET_REMOVED) {
		shost_printk(KERN_DEBUG, target->scsi_host, PFX
			     "new target: id_ext %016llx ioc_guid %016llx pkey %04x service_id %016llx sgid %pI6 dgid %pI6\n",
			     be64_to_cpu(target->id_ext),
			     be64_to_cpu(target->ioc_guid),
3470
			     be16_to_cpu(target->pkey),
3471
			     be64_to_cpu(target->service_id),
3472
			     target->sgid.raw, target->orig_dgid.raw);
3473
	}
B
Bart Van Assche 已提交
3474

3475 3476 3477 3478
	ret = count;

out:
	mutex_unlock(&host->add_target_mutex);
3479

3480
put:
3481
	scsi_host_put(target->scsi_host);
3482 3483
	if (ret < 0)
		scsi_host_put(target->scsi_host);
3484

3485
	return ret;
3486 3487 3488 3489

err_disconnect:
	srp_disconnect_target(target);

B
Bart Van Assche 已提交
3490
free_ch:
B
Bart Van Assche 已提交
3491 3492 3493 3494 3495
	for (i = 0; i < target->ch_count; i++) {
		ch = &target->ch[i];
		srp_free_ch_ib(target, ch);
		srp_free_req_data(target, ch);
	}
3496

B
Bart Van Assche 已提交
3497
	kfree(target->ch);
3498
	goto out;
3499 3500
}

3501
static DEVICE_ATTR(add_target, S_IWUSR, NULL, srp_create_target);
3502

3503 3504
static ssize_t show_ibdev(struct device *dev, struct device_attribute *attr,
			  char *buf)
3505
{
3506
	struct srp_host *host = container_of(dev, struct srp_host, dev);
3507

3508
	return sprintf(buf, "%s\n", host->srp_dev->dev->name);
3509 3510
}

3511
static DEVICE_ATTR(ibdev, S_IRUGO, show_ibdev, NULL);
3512

3513 3514
static ssize_t show_port(struct device *dev, struct device_attribute *attr,
			 char *buf)
3515
{
3516
	struct srp_host *host = container_of(dev, struct srp_host, dev);
3517 3518 3519 3520

	return sprintf(buf, "%d\n", host->port);
}

3521
static DEVICE_ATTR(port, S_IRUGO, show_port, NULL);
3522

3523
static struct srp_host *srp_add_port(struct srp_device *device, u8 port)
3524 3525 3526 3527 3528 3529 3530 3531
{
	struct srp_host *host;

	host = kzalloc(sizeof *host, GFP_KERNEL);
	if (!host)
		return NULL;

	INIT_LIST_HEAD(&host->target_list);
3532
	spin_lock_init(&host->target_lock);
3533
	init_completion(&host->released);
3534
	mutex_init(&host->add_target_mutex);
3535
	host->srp_dev = device;
3536 3537
	host->port = port;

3538 3539
	host->dev.class = &srp_class;
	host->dev.parent = device->dev->dma_device;
3540
	dev_set_name(&host->dev, "srp-%s-%d", device->dev->name, port);
3541

3542
	if (device_register(&host->dev))
3543
		goto free_host;
3544
	if (device_create_file(&host->dev, &dev_attr_add_target))
3545
		goto err_class;
3546
	if (device_create_file(&host->dev, &dev_attr_ibdev))
3547
		goto err_class;
3548
	if (device_create_file(&host->dev, &dev_attr_port))
3549 3550 3551 3552 3553
		goto err_class;

	return host;

err_class:
3554
	device_unregister(&host->dev);
3555

3556
free_host:
3557 3558 3559 3560 3561 3562 3563
	kfree(host);

	return NULL;
}

static void srp_add_one(struct ib_device *device)
{
3564
	struct srp_device *srp_dev;
3565
	struct ib_device_attr *attr = &device->attrs;
3566
	struct srp_host *host;
3567
	int mr_page_shift, p;
3568
	u64 max_pages_per_mr;
3569
	unsigned int flags = 0;
3570

3571
	srp_dev = kzalloc(sizeof(*srp_dev), GFP_KERNEL);
3572
	if (!srp_dev)
3573
		return;
3574 3575 3576

	/*
	 * Use the smallest page size supported by the HCA, down to a
3577 3578
	 * minimum of 4096 bytes. We're unlikely to build large sglists
	 * out of smaller entries.
3579
	 */
3580
	mr_page_shift		= max(12, ffs(attr->page_size_cap) - 1);
3581 3582
	srp_dev->mr_page_size	= 1 << mr_page_shift;
	srp_dev->mr_page_mask	= ~((u64) srp_dev->mr_page_size - 1);
3583
	max_pages_per_mr	= attr->max_mr_size;
3584
	do_div(max_pages_per_mr, srp_dev->mr_page_size);
3585
	pr_debug("%s: %llu / %u = %llu <> %u\n", __func__,
3586
		 attr->max_mr_size, srp_dev->mr_page_size,
3587
		 max_pages_per_mr, SRP_MAX_PAGES_PER_MR);
3588 3589
	srp_dev->max_pages_per_mr = min_t(u64, SRP_MAX_PAGES_PER_MR,
					  max_pages_per_mr);
3590 3591 3592

	srp_dev->has_fmr = (device->alloc_fmr && device->dealloc_fmr &&
			    device->map_phys_fmr && device->unmap_fmr);
3593
	srp_dev->has_fr = (attr->device_cap_flags &
3594
			   IB_DEVICE_MEM_MGT_EXTENSIONS);
3595
	if (!never_register && !srp_dev->has_fmr && !srp_dev->has_fr) {
3596
		dev_warn(&device->dev, "neither FMR nor FR is supported\n");
3597
	} else if (!never_register &&
3598
		   attr->max_mr_size >= 2 * srp_dev->mr_page_size) {
3599 3600 3601 3602
		srp_dev->use_fast_reg = (srp_dev->has_fr &&
					 (!srp_dev->has_fmr || prefer_fr));
		srp_dev->use_fmr = !srp_dev->use_fast_reg && srp_dev->has_fmr;
	}
3603

3604 3605 3606 3607
	if (never_register || !register_always ||
	    (!srp_dev->has_fmr && !srp_dev->has_fr))
		flags |= IB_PD_UNSAFE_GLOBAL_RKEY;

3608 3609 3610
	if (srp_dev->use_fast_reg) {
		srp_dev->max_pages_per_mr =
			min_t(u32, srp_dev->max_pages_per_mr,
3611
			      attr->max_fast_reg_page_list_len);
3612
	}
3613 3614
	srp_dev->mr_max_size	= srp_dev->mr_page_size *
				   srp_dev->max_pages_per_mr;
3615
	pr_debug("%s: mr_page_shift = %d, device->max_mr_size = %#llx, device->max_fast_reg_page_list_len = %u, max_pages_per_mr = %d, mr_max_size = %#x\n",
3616 3617
		 device->name, mr_page_shift, attr->max_mr_size,
		 attr->max_fast_reg_page_list_len,
3618
		 srp_dev->max_pages_per_mr, srp_dev->mr_max_size);
3619 3620 3621 3622

	INIT_LIST_HEAD(&srp_dev->dev_list);

	srp_dev->dev = device;
3623
	srp_dev->pd  = ib_alloc_pd(device, flags);
3624 3625 3626 3627
	if (IS_ERR(srp_dev->pd))
		goto free_dev;


3628
	for (p = rdma_start_port(device); p <= rdma_end_port(device); ++p) {
3629
		host = srp_add_port(srp_dev, p);
3630
		if (host)
3631
			list_add_tail(&host->list, &srp_dev->dev_list);
3632 3633
	}

3634
	ib_set_client_data(device, &srp_client, srp_dev);
3635
	return;
3636 3637 3638

free_dev:
	kfree(srp_dev);
3639 3640
}

3641
static void srp_remove_one(struct ib_device *device, void *client_data)
3642
{
3643
	struct srp_device *srp_dev;
3644
	struct srp_host *host, *tmp_host;
3645
	struct srp_target_port *target;
3646

3647
	srp_dev = client_data;
3648 3649
	if (!srp_dev)
		return;
3650

3651
	list_for_each_entry_safe(host, tmp_host, &srp_dev->dev_list, list) {
3652
		device_unregister(&host->dev);
3653 3654 3655 3656 3657 3658 3659
		/*
		 * Wait for the sysfs entry to go away, so that no new
		 * target ports can be created.
		 */
		wait_for_completion(&host->released);

		/*
3660
		 * Remove all target ports.
3661
		 */
3662
		spin_lock(&host->target_lock);
3663 3664
		list_for_each_entry(target, &host->target_list, list)
			srp_queue_remove_work(target);
3665
		spin_unlock(&host->target_lock);
3666 3667

		/*
3668
		 * Wait for tl_err and target port removal tasks.
3669
		 */
3670
		flush_workqueue(system_long_wq);
3671
		flush_workqueue(srp_remove_wq);
3672 3673 3674 3675

		kfree(host);
	}

3676 3677 3678
	ib_dealloc_pd(srp_dev->pd);

	kfree(srp_dev);
3679 3680
}

3681
static struct srp_function_template ib_srp_transport_functions = {
3682 3683
	.has_rport_state	 = true,
	.reset_timer_if_blocked	 = true,
3684
	.reconnect_delay	 = &srp_reconnect_delay,
3685 3686 3687
	.fast_io_fail_tmo	 = &srp_fast_io_fail_tmo,
	.dev_loss_tmo		 = &srp_dev_loss_tmo,
	.reconnect		 = srp_rport_reconnect,
3688
	.rport_delete		 = srp_rport_delete,
3689
	.terminate_rport_io	 = srp_terminate_io,
3690 3691
};

3692 3693 3694 3695
static int __init srp_init_module(void)
{
	int ret;

3696
	if (srp_sg_tablesize) {
3697
		pr_warn("srp_sg_tablesize is deprecated, please use cmd_sg_entries\n");
3698 3699 3700 3701 3702 3703 3704 3705
		if (!cmd_sg_entries)
			cmd_sg_entries = srp_sg_tablesize;
	}

	if (!cmd_sg_entries)
		cmd_sg_entries = SRP_DEF_SG_TABLESIZE;

	if (cmd_sg_entries > 255) {
3706
		pr_warn("Clamping cmd_sg_entries to 255\n");
3707
		cmd_sg_entries = 255;
3708 3709
	}

3710 3711 3712
	if (!indirect_sg_entries)
		indirect_sg_entries = cmd_sg_entries;
	else if (indirect_sg_entries < cmd_sg_entries) {
3713 3714
		pr_warn("Bumping up indirect_sg_entries to match cmd_sg_entries (%u)\n",
			cmd_sg_entries);
3715 3716 3717
		indirect_sg_entries = cmd_sg_entries;
	}

3718 3719 3720 3721 3722 3723
	if (indirect_sg_entries > SG_MAX_SEGMENTS) {
		pr_warn("Clamping indirect_sg_entries to %u\n",
			SG_MAX_SEGMENTS);
		indirect_sg_entries = SG_MAX_SEGMENTS;
	}

3724
	srp_remove_wq = create_workqueue("srp_remove");
3725 3726
	if (!srp_remove_wq) {
		ret = -ENOMEM;
3727 3728 3729 3730
		goto out;
	}

	ret = -ENOMEM;
3731 3732 3733
	ib_srp_transport_template =
		srp_attach_transport(&ib_srp_transport_functions);
	if (!ib_srp_transport_template)
3734
		goto destroy_wq;
3735

3736 3737
	ret = class_register(&srp_class);
	if (ret) {
3738
		pr_err("couldn't register class infiniband_srp\n");
3739
		goto release_tr;
3740 3741
	}

3742 3743
	ib_sa_register_client(&srp_sa_client);

3744 3745
	ret = ib_register_client(&srp_client);
	if (ret) {
3746
		pr_err("couldn't register IB client\n");
3747
		goto unreg_sa;
3748 3749
	}

3750 3751 3752 3753 3754 3755 3756 3757 3758 3759 3760 3761 3762
out:
	return ret;

unreg_sa:
	ib_sa_unregister_client(&srp_sa_client);
	class_unregister(&srp_class);

release_tr:
	srp_release_transport(ib_srp_transport_template);

destroy_wq:
	destroy_workqueue(srp_remove_wq);
	goto out;
3763 3764 3765 3766 3767
}

static void __exit srp_cleanup_module(void)
{
	ib_unregister_client(&srp_client);
3768
	ib_sa_unregister_client(&srp_sa_client);
3769
	class_unregister(&srp_class);
3770
	srp_release_transport(ib_srp_transport_template);
3771
	destroy_workqueue(srp_remove_wq);
3772 3773 3774 3775
}

module_init(srp_init_module);
module_exit(srp_cleanup_module);