iser_verbs.c 29.6 KB
Newer Older
1 2 3
/*
 * Copyright (c) 2004, 2005, 2006 Voltaire, Inc. All rights reserved.
 * Copyright (c) 2005, 2006 Cisco Systems.  All rights reserved.
O
Or Gerlitz 已提交
4
 * Copyright (c) 2013 Mellanox Technologies. All rights reserved.
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35
 *
 * 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.
 */
#include <linux/kernel.h>
#include <linux/module.h>
36
#include <linux/slab.h>
37 38 39 40 41
#include <linux/delay.h>

#include "iscsi_iser.h"

#define ISCSI_ISER_MAX_CONN	8
42 43
#define ISER_MAX_RX_CQ_LEN	(ISER_QP_MAX_RECV_DTOS * ISCSI_ISER_MAX_CONN)
#define ISER_MAX_TX_CQ_LEN	(ISER_QP_MAX_REQ_DTOS  * ISCSI_ISER_MAX_CONN)
44 45 46 47 48 49 50 51 52 53 54 55 56 57

static void iser_cq_tasklet_fn(unsigned long data);
static void iser_cq_callback(struct ib_cq *cq, void *cq_context);

static void iser_cq_event_callback(struct ib_event *cause, void *context)
{
	iser_err("got cq event %d \n", cause->event);
}

static void iser_qp_event_callback(struct ib_event *cause, void *context)
{
	iser_err("got qp event %d\n",cause->event);
}

58 59 60 61 62 63 64
static void iser_event_handler(struct ib_event_handler *handler,
				struct ib_event *event)
{
	iser_err("async event %d on device %s port %d\n", event->event,
		event->device->name, event->element.port_num);
}

65 66 67 68 69 70 71 72 73
/**
 * iser_create_device_ib_res - creates Protection Domain (PD), Completion
 * Queue (CQ), DMA Memory Region (DMA MR) with the device associated with
 * the adapator.
 *
 * returns 0 on success, -1 on failure
 */
static int iser_create_device_ib_res(struct iser_device *device)
{
74
	struct iser_cq_desc *cq_desc;
75 76
	struct ib_device_attr *dev_attr = &device->dev_attr;
	int ret, i, j;
77

78 79
	ret = ib_query_device(device->ib_device, dev_attr);
	if (ret) {
80
		pr_warn("Query device failed for %s\n", device->ib_device->name);
81
		return ret;
82 83 84 85 86 87 88 89 90 91 92 93
	}

	/* Assign function handles  - based on FMR support */
	if (device->ib_device->alloc_fmr && device->ib_device->dealloc_fmr &&
	    device->ib_device->map_phys_fmr && device->ib_device->unmap_fmr) {
		iser_info("FMR supported, using FMR for registration\n");
		device->iser_alloc_rdma_reg_res = iser_create_fmr_pool;
		device->iser_free_rdma_reg_res = iser_free_fmr_pool;
		device->iser_reg_rdma_mem = iser_reg_rdma_mem_fmr;
		device->iser_unreg_rdma_mem = iser_unreg_mem_fmr;
	} else
	if (dev_attr->device_cap_flags & IB_DEVICE_MEM_MGT_EXTENSIONS) {
94 95 96 97 98
		iser_info("FastReg supported, using FastReg for registration\n");
		device->iser_alloc_rdma_reg_res = iser_create_fastreg_pool;
		device->iser_free_rdma_reg_res = iser_free_fastreg_pool;
		device->iser_reg_rdma_mem = iser_reg_rdma_mem_fastreg;
		device->iser_unreg_rdma_mem = iser_unreg_mem_fastreg;
99
	} else {
100
		iser_err("IB device does not support FMRs nor FastRegs, can't register memory\n");
101
		return -1;
102
	}
103

104
	device->cqs_used = min(ISER_MAX_CQ, device->ib_device->num_comp_vectors);
105 106 107
	iser_info("using %d CQs, device %s supports %d vectors\n",
		  device->cqs_used, device->ib_device->name,
		  device->ib_device->num_comp_vectors);
108 109 110 111 112 113 114

	device->cq_desc = kmalloc(sizeof(struct iser_cq_desc) * device->cqs_used,
				  GFP_KERNEL);
	if (device->cq_desc == NULL)
		goto cq_desc_err;
	cq_desc = device->cq_desc;

115 116 117 118
	device->pd = ib_alloc_pd(device->ib_device);
	if (IS_ERR(device->pd))
		goto pd_err;

119 120 121 122 123 124 125 126 127 128 129
	for (i = 0; i < device->cqs_used; i++) {
		cq_desc[i].device   = device;
		cq_desc[i].cq_index = i;

		device->rx_cq[i] = ib_create_cq(device->ib_device,
					  iser_cq_callback,
					  iser_cq_event_callback,
					  (void *)&cq_desc[i],
					  ISER_MAX_RX_CQ_LEN, i);
		if (IS_ERR(device->rx_cq[i]))
			goto cq_err;
130

131 132 133 134
		device->tx_cq[i] = ib_create_cq(device->ib_device,
					  NULL, iser_cq_event_callback,
					  (void *)&cq_desc[i],
					  ISER_MAX_TX_CQ_LEN, i);
135

136 137
		if (IS_ERR(device->tx_cq[i]))
			goto cq_err;
138

139 140
		if (ib_req_notify_cq(device->rx_cq[i], IB_CQ_NEXT_COMP))
			goto cq_err;
141

142 143 144 145
		tasklet_init(&device->cq_tasklet[i],
			     iser_cq_tasklet_fn,
			(unsigned long)&cq_desc[i]);
	}
146

147 148 149
	device->mr = ib_get_dma_mr(device->pd, IB_ACCESS_LOCAL_WRITE |
				   IB_ACCESS_REMOTE_WRITE |
				   IB_ACCESS_REMOTE_READ);
150 151 152
	if (IS_ERR(device->mr))
		goto dma_mr_err;

153 154 155 156 157
	INIT_IB_EVENT_HANDLER(&device->event_handler, device->ib_device,
				iser_event_handler);
	if (ib_register_event_handler(&device->event_handler))
		goto handler_err;

158 159
	return 0;

160 161
handler_err:
	ib_dereg_mr(device->mr);
162
dma_mr_err:
163 164 165 166 167 168 169 170 171
	for (j = 0; j < device->cqs_used; j++)
		tasklet_kill(&device->cq_tasklet[j]);
cq_err:
	for (j = 0; j < i; j++) {
		if (device->tx_cq[j])
			ib_destroy_cq(device->tx_cq[j]);
		if (device->rx_cq[j])
			ib_destroy_cq(device->rx_cq[j]);
	}
172 173
	ib_dealloc_pd(device->pd);
pd_err:
174 175
	kfree(device->cq_desc);
cq_desc_err:
176 177 178 179 180
	iser_err("failed to allocate an IB resource\n");
	return -1;
}

/**
181
 * iser_free_device_ib_res - destroy/dealloc/dereg the DMA MR,
182 183 184 185
 * CQ and PD created with the device associated with the adapator.
 */
static void iser_free_device_ib_res(struct iser_device *device)
{
186
	int i;
187 188
	BUG_ON(device->mr == NULL);

189 190 191 192 193 194 195 196
	for (i = 0; i < device->cqs_used; i++) {
		tasklet_kill(&device->cq_tasklet[i]);
		(void)ib_destroy_cq(device->tx_cq[i]);
		(void)ib_destroy_cq(device->rx_cq[i]);
		device->tx_cq[i] = NULL;
		device->rx_cq[i] = NULL;
	}

197
	(void)ib_unregister_event_handler(&device->event_handler);
198 199 200
	(void)ib_dereg_mr(device->mr);
	(void)ib_dealloc_pd(device->pd);

201 202
	kfree(device->cq_desc);

203 204 205 206 207
	device->mr = NULL;
	device->pd = NULL;
}

/**
208
 * iser_create_fmr_pool - Creates FMR pool and page_vector
209
 *
210
 * returns 0 on success, or errno code on failure
211
 */
212
int iser_create_fmr_pool(struct iser_conn *ib_conn, unsigned cmds_max)
213
{
214
	struct iser_device *device = ib_conn->device;
215
	struct ib_fmr_pool_param params;
216
	int ret = -ENOMEM;
217

218 219 220 221
	ib_conn->fmr.page_vec = kmalloc(sizeof(*ib_conn->fmr.page_vec) +
					(sizeof(u64)*(ISCSI_ISER_SG_TABLESIZE + 1)),
					GFP_KERNEL);
	if (!ib_conn->fmr.page_vec)
222
		return ret;
223

224
	ib_conn->fmr.page_vec->pages = (u64 *)(ib_conn->fmr.page_vec + 1);
225

226
	params.page_shift        = SHIFT_4K;
227 228 229 230 231
	/* when the first/last SG element are not start/end *
	 * page aligned, the map whould be of N+1 pages     */
	params.max_pages_per_fmr = ISCSI_ISER_SG_TABLESIZE + 1;
	/* make the pool size twice the max number of SCSI commands *
	 * the ML is expected to queue, watermark for unmap at 50%  */
232 233
	params.pool_size	 = cmds_max * 2;
	params.dirty_watermark	 = cmds_max;
234 235 236 237 238 239
	params.cache		 = 0;
	params.flush_function	 = NULL;
	params.access		 = (IB_ACCESS_LOCAL_WRITE  |
				    IB_ACCESS_REMOTE_WRITE |
				    IB_ACCESS_REMOTE_READ);

240 241
	ib_conn->fmr.pool = ib_create_fmr_pool(device->pd, &params);
	if (!IS_ERR(ib_conn->fmr.pool))
242 243 244
		return 0;

	/* no FMR => no need for page_vec */
245 246
	kfree(ib_conn->fmr.page_vec);
	ib_conn->fmr.page_vec = NULL;
247

248 249
	ret = PTR_ERR(ib_conn->fmr.pool);
	ib_conn->fmr.pool = NULL;
250 251 252 253
	if (ret != -ENOSYS) {
		iser_err("FMR allocation failed, err %d\n", ret);
		return ret;
	} else {
254
		iser_warn("FMRs are not supported, using unaligned mode\n");
255
		return 0;
256
	}
257 258 259 260 261 262 263 264
}

/**
 * iser_free_fmr_pool - releases the FMR pool and page vec
 */
void iser_free_fmr_pool(struct iser_conn *ib_conn)
{
	iser_info("freeing conn %p fmr pool %p\n",
265
		  ib_conn, ib_conn->fmr.pool);
266

267 268
	if (ib_conn->fmr.pool != NULL)
		ib_destroy_fmr_pool(ib_conn->fmr.pool);
269

270
	ib_conn->fmr.pool = NULL;
271

272 273
	kfree(ib_conn->fmr.page_vec);
	ib_conn->fmr.page_vec = NULL;
274 275
}

276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298
static int
iser_create_fastreg_desc(struct ib_device *ib_device, struct ib_pd *pd,
			 struct fast_reg_descriptor *desc)
{
	int ret;

	desc->data_frpl = ib_alloc_fast_reg_page_list(ib_device,
						      ISCSI_ISER_SG_TABLESIZE + 1);
	if (IS_ERR(desc->data_frpl)) {
		ret = PTR_ERR(desc->data_frpl);
		iser_err("Failed to allocate ib_fast_reg_page_list err=%d\n",
			 ret);
		return PTR_ERR(desc->data_frpl);
	}

	desc->data_mr = ib_alloc_fast_reg_mr(pd, ISCSI_ISER_SG_TABLESIZE + 1);
	if (IS_ERR(desc->data_mr)) {
		ret = PTR_ERR(desc->data_mr);
		iser_err("Failed to allocate ib_fast_reg_mr err=%d\n", ret);
		goto fast_reg_mr_failure;
	}
	iser_info("Create fr_desc %p page_list %p\n",
		  desc, desc->data_frpl->page_list);
299
	desc->reg_indicators |= ISER_DATA_KEY_VALID;
300 301 302 303 304 305 306 307 308

	return 0;

fast_reg_mr_failure:
	ib_free_fast_reg_page_list(desc->data_frpl);

	return ret;
}

309
/**
310
 * iser_create_fastreg_pool - Creates pool of fast_reg descriptors
311 312 313
 * for fast registration work requests.
 * returns 0 on success, or errno code on failure
 */
314
int iser_create_fastreg_pool(struct iser_conn *ib_conn, unsigned cmds_max)
315 316 317 318 319
{
	struct iser_device	*device = ib_conn->device;
	struct fast_reg_descriptor	*desc;
	int i, ret;

320 321
	INIT_LIST_HEAD(&ib_conn->fastreg.pool);
	ib_conn->fastreg.pool_size = 0;
322 323 324 325 326 327 328 329
	for (i = 0; i < cmds_max; i++) {
		desc = kmalloc(sizeof(*desc), GFP_KERNEL);
		if (!desc) {
			iser_err("Failed to allocate a new fast_reg descriptor\n");
			ret = -ENOMEM;
			goto err;
		}

330 331 332 333 334 335 336
		ret = iser_create_fastreg_desc(device->ib_device,
					       device->pd, desc);
		if (ret) {
			iser_err("Failed to create fastreg descriptor err=%d\n",
				 ret);
			kfree(desc);
			goto err;
337 338
		}

339 340
		list_add_tail(&desc->list, &ib_conn->fastreg.pool);
		ib_conn->fastreg.pool_size++;
341 342 343
	}

	return 0;
344

345
err:
346
	iser_free_fastreg_pool(ib_conn);
347 348 349 350
	return ret;
}

/**
351
 * iser_free_fastreg_pool - releases the pool of fast_reg descriptors
352
 */
353
void iser_free_fastreg_pool(struct iser_conn *ib_conn)
354 355 356 357
{
	struct fast_reg_descriptor *desc, *tmp;
	int i = 0;

358
	if (list_empty(&ib_conn->fastreg.pool))
359 360
		return;

361
	iser_info("freeing conn %p fr pool\n", ib_conn);
362

363
	list_for_each_entry_safe(desc, tmp, &ib_conn->fastreg.pool, list) {
364 365 366 367 368 369 370
		list_del(&desc->list);
		ib_free_fast_reg_page_list(desc->data_frpl);
		ib_dereg_mr(desc->data_mr);
		kfree(desc);
		++i;
	}

371
	if (i < ib_conn->fastreg.pool_size)
372
		iser_warn("pool still has %d regions registered\n",
373
			  ib_conn->fastreg.pool_size - i);
374 375
}

376 377 378 379 380 381 382 383 384 385 386 387 388 389 390
/**
 * iser_create_ib_conn_res - Queue-Pair (QP)
 *
 * returns 0 on success, -1 on failure
 */
static int iser_create_ib_conn_res(struct iser_conn *ib_conn)
{
	struct iser_device	*device;
	struct ib_qp_init_attr	init_attr;
	int			ret = -ENOMEM;
	int index, min_index = 0;

	BUG_ON(ib_conn->device == NULL);

	device = ib_conn->device;
391 392 393

	memset(&init_attr, 0, sizeof init_attr);

394 395 396 397 398 399 400 401
	mutex_lock(&ig.connlist_mutex);
	/* select the CQ with the minimal number of usages */
	for (index = 0; index < device->cqs_used; index++)
		if (device->cq_active_qps[index] <
		    device->cq_active_qps[min_index])
			min_index = index;
	device->cq_active_qps[min_index]++;
	mutex_unlock(&ig.connlist_mutex);
402
	iser_info("cq index %d used for ib_conn %p\n", min_index, ib_conn);
403

404 405
	init_attr.event_handler = iser_qp_event_callback;
	init_attr.qp_context	= (void *)ib_conn;
406 407
	init_attr.send_cq	= device->tx_cq[min_index];
	init_attr.recv_cq	= device->rx_cq[min_index];
408 409
	init_attr.cap.max_send_wr  = ISER_QP_MAX_REQ_DTOS;
	init_attr.cap.max_recv_wr  = ISER_QP_MAX_RECV_DTOS;
410
	init_attr.cap.max_send_sge = 2;
411
	init_attr.cap.max_recv_sge = 1;
412 413 414 415 416
	init_attr.sq_sig_type	= IB_SIGNAL_REQ_WR;
	init_attr.qp_type	= IB_QPT_RC;

	ret = rdma_create_qp(ib_conn->cma_id, device->pd, &init_attr);
	if (ret)
417
		goto out_err;
418 419

	ib_conn->qp = ib_conn->cma_id->qp;
420
	iser_info("setting conn %p cma_id %p qp %p\n",
421
		  ib_conn, ib_conn->cma_id,
422
		  ib_conn->cma_id->qp);
423 424
	return ret;

425
out_err:
426 427 428 429 430
	iser_err("unable to alloc mem or create resource, err %d\n", ret);
	return ret;
}

/**
431
 * releases the QP objects, returns 0 on success,
432 433
 * -1 on failure
 */
R
Roi Dayan 已提交
434
static int iser_free_ib_conn_res(struct iser_conn *ib_conn)
435
{
436
	int cq_index;
437 438
	BUG_ON(ib_conn == NULL);

439
	iser_info("freeing conn %p cma_id %p qp %p\n",
440
		  ib_conn, ib_conn->cma_id,
441
		  ib_conn->qp);
442 443 444

	/* qp is created only once both addr & route are resolved */

445 446 447
	if (ib_conn->qp != NULL) {
		cq_index = ((struct iser_cq_desc *)ib_conn->qp->recv_cq->cq_context)->cq_index;
		ib_conn->device->cq_active_qps[cq_index]--;
448

449 450
		rdma_destroy_qp(ib_conn->cma_id);
	}
451 452

	ib_conn->qp	  = NULL;
453

454 455 456 457 458 459 460 461 462 463
	return 0;
}

/**
 * based on the resolved device node GUID see if there already allocated
 * device for this device. If there's no such, create one.
 */
static
struct iser_device *iser_device_find_by_ib_device(struct rdma_cm_id *cma_id)
{
A
Arne Redlich 已提交
464
	struct iser_device *device;
465 466 467

	mutex_lock(&ig.device_list_mutex);

A
Arne Redlich 已提交
468
	list_for_each_entry(device, &ig.device_list, ig_list)
469 470
		/* find if there's a match using the node GUID */
		if (device->ib_device->node_guid == cma_id->device->node_guid)
471
			goto inc_refcnt;
A
Arne Redlich 已提交
472 473 474 475 476 477 478 479 480 481 482 483

	device = kzalloc(sizeof *device, GFP_KERNEL);
	if (device == NULL)
		goto out;

	/* assign this device to the device */
	device->ib_device = cma_id->device;
	/* init the device and link it into ig device list */
	if (iser_create_device_ib_res(device)) {
		kfree(device);
		device = NULL;
		goto out;
484
	}
A
Arne Redlich 已提交
485 486
	list_add(&device->ig_list, &ig.device_list);

487
inc_refcnt:
488
	device->refcount++;
489
out:
490 491 492 493 494 495 496 497 498
	mutex_unlock(&ig.device_list_mutex);
	return device;
}

/* if there's no demand for this device, release it */
static void iser_device_try_release(struct iser_device *device)
{
	mutex_lock(&ig.device_list_mutex);
	device->refcount--;
499
	iser_info("device %p refcount %d\n", device, device->refcount);
500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520
	if (!device->refcount) {
		iser_free_device_ib_res(device);
		list_del(&device->ig_list);
		kfree(device);
	}
	mutex_unlock(&ig.device_list_mutex);
}

static int iser_conn_state_comp_exch(struct iser_conn *ib_conn,
				     enum iser_ib_conn_state comp,
				     enum iser_ib_conn_state exch)
{
	int ret;

	spin_lock_bh(&ib_conn->lock);
	if ((ret = (ib_conn->state == comp)))
		ib_conn->state = exch;
	spin_unlock_bh(&ib_conn->lock);
	return ret;
}

521 522 523
/**
 * Frees all conn objects and deallocs conn descriptor
 */
524
static void iser_conn_release(struct iser_conn *ib_conn, int can_destroy_id)
525 526 527 528 529 530 531 532
{
	struct iser_device  *device = ib_conn->device;

	BUG_ON(ib_conn->state != ISER_CONN_DOWN);

	mutex_lock(&ig.connlist_mutex);
	list_del(&ib_conn->conn_list);
	mutex_unlock(&ig.connlist_mutex);
533
	iser_free_rx_descriptors(ib_conn);
R
Roi Dayan 已提交
534
	iser_free_ib_conn_res(ib_conn);
535 536 537 538
	ib_conn->device = NULL;
	/* on EVENT_ADDR_ERROR there's no device yet for this conn */
	if (device != NULL)
		iser_device_try_release(device);
R
Roi Dayan 已提交
539 540 541 542 543
	/* if cma handler context, the caller actually destroy the id */
	if (ib_conn->cma_id != NULL && can_destroy_id) {
		rdma_destroy_id(ib_conn->cma_id);
		ib_conn->cma_id = NULL;
	}
544
	iscsi_destroy_endpoint(ib_conn->ep);
545 546
}

547 548 549 550 551
void iser_conn_get(struct iser_conn *ib_conn)
{
	atomic_inc(&ib_conn->refcount);
}

552
int iser_conn_put(struct iser_conn *ib_conn, int can_destroy_id)
553
{
554 555 556 557 558
	if (atomic_dec_and_test(&ib_conn->refcount)) {
		iser_conn_release(ib_conn, can_destroy_id);
		return 1;
	}
	return 0;
559 560
}

561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581
/**
 * triggers start of the disconnect procedures and wait for them to be done
 */
void iser_conn_terminate(struct iser_conn *ib_conn)
{
	int err = 0;

	/* change the ib conn state only if the conn is UP, however always call
	 * rdma_disconnect since this is the only way to cause the CMA to change
	 * the QP state to ERROR
	 */

	iser_conn_state_comp_exch(ib_conn, ISER_CONN_UP, ISER_CONN_TERMINATING);
	err = rdma_disconnect(ib_conn->cma_id);
	if (err)
		iser_err("Failed to disconnect, conn: 0x%p err %d\n",
			 ib_conn,err);

	wait_event_interruptible(ib_conn->wait,
				 ib_conn->state == ISER_CONN_DOWN);

582
	iser_conn_put(ib_conn, 1); /* deref ib conn deallocate */
583 584
}

585
static int iser_connect_error(struct rdma_cm_id *cma_id)
586 587 588 589 590 591
{
	struct iser_conn *ib_conn;
	ib_conn = (struct iser_conn *)cma_id->context;

	ib_conn->state = ISER_CONN_DOWN;
	wake_up_interruptible(&ib_conn->wait);
592
	return iser_conn_put(ib_conn, 0); /* deref ib conn's cma id */
593 594
}

595
static int iser_addr_handler(struct rdma_cm_id *cma_id)
596 597 598 599 600 601
{
	struct iser_device *device;
	struct iser_conn   *ib_conn;
	int    ret;

	device = iser_device_find_by_ib_device(cma_id);
602 603
	if (!device) {
		iser_err("device lookup/creation failed\n");
604
		return iser_connect_error(cma_id);
605 606
	}

607 608 609
	ib_conn = (struct iser_conn *)cma_id->context;
	ib_conn->device = device;

610 611 612 613 614 615 616 617 618 619 620 621 622
	/* connection T10-PI support */
	if (iser_pi_enable) {
		if (!(device->dev_attr.device_cap_flags &
		      IB_DEVICE_SIGNATURE_HANDOVER)) {
			iser_warn("T10-PI requested but not supported on %s, "
				  "continue without T10-PI\n",
				  ib_conn->device->ib_device->name);
			ib_conn->pi_support = false;
		} else {
			ib_conn->pi_support = true;
		}
	}

623 624 625
	ret = rdma_resolve_route(cma_id, 1000);
	if (ret) {
		iser_err("resolve route failed: %d\n", ret);
626
		return iser_connect_error(cma_id);
627
	}
628 629

	return 0;
630 631
}

632
static int iser_route_handler(struct rdma_cm_id *cma_id)
633 634 635
{
	struct rdma_conn_param conn_param;
	int    ret;
636
	struct iser_cm_hdr req_hdr;
637 638 639 640 641 642 643 644 645 646 647

	ret = iser_create_ib_conn_res((struct iser_conn *)cma_id->context);
	if (ret)
		goto failure;

	memset(&conn_param, 0, sizeof conn_param);
	conn_param.responder_resources = 4;
	conn_param.initiator_depth     = 1;
	conn_param.retry_count	       = 7;
	conn_param.rnr_retry_count     = 6;

648 649 650 651 652 653
	memset(&req_hdr, 0, sizeof(req_hdr));
	req_hdr.flags = (ISER_ZBVA_NOT_SUPPORTED |
			ISER_SEND_W_INV_NOT_SUPPORTED);
	conn_param.private_data		= (void *)&req_hdr;
	conn_param.private_data_len	= sizeof(struct iser_cm_hdr);

654 655 656 657 658 659
	ret = rdma_connect(cma_id, &conn_param);
	if (ret) {
		iser_err("failure connecting: %d\n", ret);
		goto failure;
	}

660
	return 0;
661
failure:
662
	return iser_connect_error(cma_id);
663 664 665 666 667 668 669 670 671 672 673
}

static void iser_connected_handler(struct rdma_cm_id *cma_id)
{
	struct iser_conn *ib_conn;

	ib_conn = (struct iser_conn *)cma_id->context;
	ib_conn->state = ISER_CONN_UP;
	wake_up_interruptible(&ib_conn->wait);
}

674
static int iser_disconnected_handler(struct rdma_cm_id *cma_id)
675 676
{
	struct iser_conn *ib_conn;
677
	int ret;
678 679 680 681 682 683

	ib_conn = (struct iser_conn *)cma_id->context;

	/* getting here when the state is UP means that the conn is being *
	 * terminated asynchronously from the iSCSI layer's perspective.  */
	if (iser_conn_state_comp_exch(ib_conn, ISER_CONN_UP,
684 685 686 687 688 689 690
					ISER_CONN_TERMINATING)){
		if (ib_conn->iser_conn)
			iscsi_conn_failure(ib_conn->iser_conn->iscsi_conn,
					   ISCSI_ERR_CONN_FAILED);
		else
			iser_err("iscsi_iser connection isn't bound\n");
	}
691 692

	/* Complete the termination process if no posts are pending */
693
	if (ib_conn->post_recv_buf_count == 0 &&
694 695 696 697
	    (atomic_read(&ib_conn->post_send_buf_count) == 0)) {
		ib_conn->state = ISER_CONN_DOWN;
		wake_up_interruptible(&ib_conn->wait);
	}
698 699 700

	ret = iser_conn_put(ib_conn, 0); /* deref ib conn's cma id */
	return ret;
701 702 703 704 705 706
}

static int iser_cma_handler(struct rdma_cm_id *cma_id, struct rdma_cm_event *event)
{
	int ret = 0;

707 708
	iser_info("event %d status %d conn %p id %p\n",
		  event->event, event->status, cma_id->context, cma_id);
709 710 711

	switch (event->event) {
	case RDMA_CM_EVENT_ADDR_RESOLVED:
712
		ret = iser_addr_handler(cma_id);
713 714
		break;
	case RDMA_CM_EVENT_ROUTE_RESOLVED:
715
		ret = iser_route_handler(cma_id);
716 717 718 719 720 721 722 723 724
		break;
	case RDMA_CM_EVENT_ESTABLISHED:
		iser_connected_handler(cma_id);
		break;
	case RDMA_CM_EVENT_ADDR_ERROR:
	case RDMA_CM_EVENT_ROUTE_ERROR:
	case RDMA_CM_EVENT_CONNECT_ERROR:
	case RDMA_CM_EVENT_UNREACHABLE:
	case RDMA_CM_EVENT_REJECTED:
725
		ret = iser_connect_error(cma_id);
726 727 728
		break;
	case RDMA_CM_EVENT_DISCONNECTED:
	case RDMA_CM_EVENT_DEVICE_REMOVAL:
729
	case RDMA_CM_EVENT_ADDR_CHANGE:
730
		ret = iser_disconnected_handler(cma_id);
731 732
		break;
	default:
733
		iser_err("Unexpected RDMA CM event (%d)\n", event->event);
734 735 736 737 738
		break;
	}
	return ret;
}

739
void iser_conn_init(struct iser_conn *ib_conn)
740 741 742
{
	ib_conn->state = ISER_CONN_INIT;
	init_waitqueue_head(&ib_conn->wait);
743
	ib_conn->post_recv_buf_count = 0;
744
	atomic_set(&ib_conn->post_send_buf_count, 0);
745
	atomic_set(&ib_conn->refcount, 1); /* ref ib conn allocation */
746 747 748 749 750 751
	INIT_LIST_HEAD(&ib_conn->conn_list);
	spin_lock_init(&ib_conn->lock);
}

 /**
 * starts the process of connecting to the target
752
 * sleeps until the connection is established or rejected
753 754 755 756 757 758 759 760 761
 */
int iser_connect(struct iser_conn   *ib_conn,
		 struct sockaddr_in *src_addr,
		 struct sockaddr_in *dst_addr,
		 int                 non_blocking)
{
	struct sockaddr *src, *dst;
	int err = 0;

H
Harvey Harrison 已提交
762 763
	sprintf(ib_conn->name, "%pI4:%d",
		&dst_addr->sin_addr.s_addr, dst_addr->sin_port);
764 765 766 767

	/* the device is known only --after-- address resolution */
	ib_conn->device = NULL;

768 769
	iser_info("connecting to: %pI4, port 0x%x\n",
		  &dst_addr->sin_addr, dst_addr->sin_port);
770 771 772

	ib_conn->state = ISER_CONN_PENDING;

773
	iser_conn_get(ib_conn); /* ref ib conn's cma id */
774 775
	ib_conn->cma_id = rdma_create_id(iser_cma_handler,
					     (void *)ib_conn,
776
					     RDMA_PS_TCP, IB_QPT_RC);
777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809
	if (IS_ERR(ib_conn->cma_id)) {
		err = PTR_ERR(ib_conn->cma_id);
		iser_err("rdma_create_id failed: %d\n", err);
		goto id_failure;
	}

	src = (struct sockaddr *)src_addr;
	dst = (struct sockaddr *)dst_addr;
	err = rdma_resolve_addr(ib_conn->cma_id, src, dst, 1000);
	if (err) {
		iser_err("rdma_resolve_addr failed: %d\n", err);
		goto addr_failure;
	}

	if (!non_blocking) {
		wait_event_interruptible(ib_conn->wait,
					 (ib_conn->state != ISER_CONN_PENDING));

		if (ib_conn->state != ISER_CONN_UP) {
			err =  -EIO;
			goto connect_failure;
		}
	}

	mutex_lock(&ig.connlist_mutex);
	list_add(&ib_conn->conn_list, &ig.connlist);
	mutex_unlock(&ig.connlist_mutex);
	return 0;

id_failure:
	ib_conn->cma_id = NULL;
addr_failure:
	ib_conn->state = ISER_CONN_DOWN;
810
	iser_conn_put(ib_conn, 1); /* deref ib conn's cma id */
811
connect_failure:
812
	iser_conn_put(ib_conn, 1); /* deref ib conn deallocate */
813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832
	return err;
}

/**
 * iser_reg_page_vec - Register physical memory
 *
 * returns: 0 on success, errno code on failure
 */
int iser_reg_page_vec(struct iser_conn     *ib_conn,
		      struct iser_page_vec *page_vec,
		      struct iser_mem_reg  *mem_reg)
{
	struct ib_pool_fmr *mem;
	u64		   io_addr;
	u64		   *page_list;
	int		   status;

	page_list = page_vec->pages;
	io_addr	  = page_list[0];

833
	mem  = ib_fmr_pool_map_phys(ib_conn->fmr.pool,
834 835
				    page_list,
				    page_vec->length,
836
				    io_addr);
837 838 839 840 841 842 843 844 845

	if (IS_ERR(mem)) {
		status = (int)PTR_ERR(mem);
		iser_err("ib_fmr_pool_map_phys failed: %d\n", status);
		return status;
	}

	mem_reg->lkey  = mem->fmr->lkey;
	mem_reg->rkey  = mem->fmr->rkey;
846
	mem_reg->len   = page_vec->length * SIZE_4K;
847
	mem_reg->va    = io_addr;
848
	mem_reg->is_mr = 1;
849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865
	mem_reg->mem_h = (void *)mem;

	mem_reg->va   += page_vec->offset;
	mem_reg->len   = page_vec->data_size;

	iser_dbg("PHYSICAL Mem.register, [PHYS p_array: 0x%p, sz: %d, "
		 "entry[0]: (0x%08lx,%ld)] -> "
		 "[lkey: 0x%08X mem_h: 0x%p va: 0x%08lX sz: %ld]\n",
		 page_vec, page_vec->length,
		 (unsigned long)page_vec->pages[0],
		 (unsigned long)page_vec->data_size,
		 (unsigned int)mem_reg->lkey, mem_reg->mem_h,
		 (unsigned long)mem_reg->va, (unsigned long)mem_reg->len);
	return 0;
}

/**
866 867
 * Unregister (previosuly registered using FMR) memory.
 * If memory is non-FMR does nothing.
868
 */
869 870
void iser_unreg_mem_fmr(struct iscsi_iser_task *iser_task,
			enum iser_data_dir cmd_dir)
871
{
872
	struct iser_mem_reg *reg = &iser_task->rdma_regd[cmd_dir].reg;
873 874
	int ret;

875
	if (!reg->is_mr)
876 877
		return;

878 879 880 881 882 883 884 885 886
	iser_dbg("PHYSICAL Mem.Unregister mem_h %p\n",reg->mem_h);

	ret = ib_fmr_pool_unmap((struct ib_pool_fmr *)reg->mem_h);
	if (ret)
		iser_err("ib_fmr_pool_unmap failed %d\n", ret);

	reg->mem_h = NULL;
}

887 888
void iser_unreg_mem_fastreg(struct iscsi_iser_task *iser_task,
			    enum iser_data_dir cmd_dir)
889 890 891 892 893 894 895 896 897 898 899
{
	struct iser_mem_reg *reg = &iser_task->rdma_regd[cmd_dir].reg;
	struct iser_conn *ib_conn = iser_task->iser_conn->ib_conn;
	struct fast_reg_descriptor *desc = reg->mem_h;

	if (!reg->is_mr)
		return;

	reg->mem_h = NULL;
	reg->is_mr = 0;
	spin_lock_bh(&ib_conn->lock);
900
	list_add_tail(&desc->list, &ib_conn->fastreg.pool);
901 902 903
	spin_unlock_bh(&ib_conn->lock);
}

904 905 906 907 908 909
int iser_post_recvl(struct iser_conn *ib_conn)
{
	struct ib_recv_wr rx_wr, *rx_wr_failed;
	struct ib_sge	  sge;
	int ib_ret;

910
	sge.addr   = ib_conn->login_resp_dma;
911 912 913
	sge.length = ISER_RX_LOGIN_SIZE;
	sge.lkey   = ib_conn->device->mr->lkey;

914
	rx_wr.wr_id   = (unsigned long)ib_conn->login_resp_buf;
915 916 917 918
	rx_wr.sg_list = &sge;
	rx_wr.num_sge = 1;
	rx_wr.next    = NULL;

919
	ib_conn->post_recv_buf_count++;
920 921 922
	ib_ret	= ib_post_recv(ib_conn->qp, &rx_wr, &rx_wr_failed);
	if (ib_ret) {
		iser_err("ib_post_recv failed ret=%d\n", ib_ret);
923
		ib_conn->post_recv_buf_count--;
924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940
	}
	return ib_ret;
}

int iser_post_recvm(struct iser_conn *ib_conn, int count)
{
	struct ib_recv_wr *rx_wr, *rx_wr_failed;
	int i, ib_ret;
	unsigned int my_rx_head = ib_conn->rx_desc_head;
	struct iser_rx_desc *rx_desc;

	for (rx_wr = ib_conn->rx_wr, i = 0; i < count; i++, rx_wr++) {
		rx_desc		= &ib_conn->rx_descs[my_rx_head];
		rx_wr->wr_id	= (unsigned long)rx_desc;
		rx_wr->sg_list	= &rx_desc->rx_sg;
		rx_wr->num_sge	= 1;
		rx_wr->next	= rx_wr + 1;
941
		my_rx_head = (my_rx_head + 1) & ib_conn->qp_max_recv_dtos_mask;
942 943 944 945 946
	}

	rx_wr--;
	rx_wr->next = NULL; /* mark end of work requests list */

947
	ib_conn->post_recv_buf_count += count;
948 949 950
	ib_ret	= ib_post_recv(ib_conn->qp, ib_conn->rx_wr, &rx_wr_failed);
	if (ib_ret) {
		iser_err("ib_post_recv failed ret=%d\n", ib_ret);
951
		ib_conn->post_recv_buf_count -= count;
952 953 954 955 956 957
	} else
		ib_conn->rx_desc_head = my_rx_head;
	return ib_ret;
}


958 959 960 961 962
/**
 * iser_start_send - Initiate a Send DTO operation
 *
 * returns 0 on success, -1 on failure
 */
963
int iser_post_send(struct iser_conn *ib_conn, struct iser_tx_desc *tx_desc)
964
{
965
	int		  ib_ret;
966 967
	struct ib_send_wr send_wr, *send_wr_failed;

968 969
	ib_dma_sync_single_for_device(ib_conn->device->ib_device,
		tx_desc->dma_addr, ISER_HEADERS_LEN, DMA_TO_DEVICE);
970 971 972

	send_wr.next	   = NULL;
	send_wr.wr_id	   = (unsigned long)tx_desc;
973 974
	send_wr.sg_list	   = tx_desc->tx_sg;
	send_wr.num_sge	   = tx_desc->num_sge;
975
	send_wr.opcode	   = IB_WR_SEND;
976
	send_wr.send_flags = IB_SEND_SIGNALED;
977 978 979 980 981 982 983 984

	atomic_inc(&ib_conn->post_send_buf_count);

	ib_ret = ib_post_send(ib_conn->qp, &send_wr, &send_wr_failed);
	if (ib_ret) {
		iser_err("ib_post_send failed, ret:%d\n", ib_ret);
		atomic_dec(&ib_conn->post_send_buf_count);
	}
985
	return ib_ret;
986 987
}

988
static void iser_handle_comp_error(struct iser_tx_desc *desc,
989
				struct iser_conn *ib_conn)
990
{
991 992
	if (desc && desc->type == ISCSI_TX_DATAOUT)
		kmem_cache_free(ig.desc_cache, desc);
993

994
	if (ib_conn->post_recv_buf_count == 0 &&
995 996 997 998 999 1000 1001 1002 1003
	    atomic_read(&ib_conn->post_send_buf_count) == 0) {
		/* getting here when the state is UP means that the conn is *
		 * being terminated asynchronously from the iSCSI layer's   *
		 * perspective.                                             */
		if (iser_conn_state_comp_exch(ib_conn, ISER_CONN_UP,
		    ISER_CONN_TERMINATING))
			iscsi_conn_failure(ib_conn->iser_conn->iscsi_conn,
					   ISCSI_ERR_CONN_FAILED);

1004 1005 1006 1007
		/* no more non completed posts to the QP, complete the
		 * termination process w.o worrying on disconnect event */
		ib_conn->state = ISER_CONN_DOWN;
		wake_up_interruptible(&ib_conn->wait);
1008
	}
1009 1010
}

1011
static int iser_drain_tx_cq(struct iser_device  *device, int cq_index)
1012
{
1013
	struct ib_cq  *cq = device->tx_cq[cq_index];
1014
	struct ib_wc  wc;
1015
	struct iser_tx_desc *tx_desc;
1016 1017 1018 1019
	struct iser_conn *ib_conn;
	int completed_tx = 0;

	while (ib_poll_cq(cq, 1, &wc) == 1) {
1020
		tx_desc	= (struct iser_tx_desc *) (unsigned long) wc.wr_id;
1021 1022 1023
		ib_conn = wc.qp->qp_context;
		if (wc.status == IB_WC_SUCCESS) {
			if (wc.opcode == IB_WC_SEND)
1024
				iser_snd_completion(tx_desc, ib_conn);
1025
			else
1026 1027 1028 1029
				iser_err("expected opcode %d got %d\n",
					IB_WC_SEND, wc.opcode);
		} else {
			iser_err("tx id %llx status %d vend_err %x\n",
1030
				 wc.wr_id, wc.status, wc.vendor_err);
1031
			if (wc.wr_id != ISER_FASTREG_LI_WRID) {
1032 1033 1034
				atomic_dec(&ib_conn->post_send_buf_count);
				iser_handle_comp_error(tx_desc, ib_conn);
			}
1035 1036 1037 1038 1039 1040 1041
		}
		completed_tx++;
	}
	return completed_tx;
}


1042 1043
static void iser_cq_tasklet_fn(unsigned long data)
{
1044 1045 1046 1047
	struct iser_cq_desc *cq_desc = (struct iser_cq_desc *)data;
	struct iser_device  *device = cq_desc->device;
	int cq_index = cq_desc->cq_index;
	struct ib_cq	     *cq = device->rx_cq[cq_index];
1048
	 struct ib_wc	     wc;
1049
	 struct iser_rx_desc *desc;
1050
	 unsigned long	     xfer_len;
1051
	struct iser_conn *ib_conn;
1052 1053
	int completed_tx, completed_rx;
	completed_tx = completed_rx = 0;
1054 1055

	while (ib_poll_cq(cq, 1, &wc) == 1) {
1056
		desc	 = (struct iser_rx_desc *) (unsigned long) wc.wr_id;
1057
		BUG_ON(desc == NULL);
1058
		ib_conn = wc.qp->qp_context;
1059
		if (wc.status == IB_WC_SUCCESS) {
1060
			if (wc.opcode == IB_WC_RECV) {
1061
				xfer_len = (unsigned long)wc.byte_len;
1062 1063 1064 1065
				iser_rcv_completion(desc, xfer_len, ib_conn);
			} else
				iser_err("expected opcode %d got %d\n",
					IB_WC_RECV, wc.opcode);
1066
		} else {
1067
			if (wc.status != IB_WC_WR_FLUSH_ERR)
1068
				iser_err("rx id %llx status %d vend_err %x\n",
1069
					wc.wr_id, wc.status, wc.vendor_err);
1070 1071
			ib_conn->post_recv_buf_count--;
			iser_handle_comp_error(NULL, ib_conn);
1072
		}
1073 1074
		completed_rx++;
		if (!(completed_rx & 63))
1075
			completed_tx += iser_drain_tx_cq(device, cq_index);
1076 1077 1078 1079
	}
	/* #warning "it is assumed here that arming CQ only once its empty" *
	 * " would not cause interrupts to be missed"                       */
	ib_req_notify_cq(cq, IB_CQ_NEXT_COMP);
1080

1081
	completed_tx += iser_drain_tx_cq(device, cq_index);
1082
	iser_dbg("got %d rx %d tx completions\n", completed_rx, completed_tx);
1083 1084 1085 1086
}

static void iser_cq_callback(struct ib_cq *cq, void *cq_context)
{
1087 1088 1089
	struct iser_cq_desc *cq_desc = (struct iser_cq_desc *)cq_context;
	struct iser_device  *device = cq_desc->device;
	int cq_index = cq_desc->cq_index;
1090

1091
	tasklet_schedule(&device->cq_tasklet[cq_index]);
1092
}