iser_initiator.c 20.8 KB
Newer Older
1 2
/*
 * Copyright (c) 2004, 2005, 2006 Voltaire, Inc. All rights reserved.
3
 * Copyright (c) 2013-2014 Mellanox Technologies. All rights reserved.
4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43
 *
 * 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/slab.h>
#include <linux/mm.h>
#include <linux/scatterlist.h>
#include <linux/kfifo.h>
#include <scsi/scsi_cmnd.h>
#include <scsi/scsi_host.h>

#include "iscsi_iser.h"

/* Register user buffer memory and initialize passive rdma
44 45 46
 *  dto descriptor. Data size is stored in
 *  task->data[ISER_DIR_IN].data_len, Protection size
 *  os stored in task->prot[ISER_DIR_IN].data_len
47
 */
48
static int iser_prepare_read_cmd(struct iscsi_task *task)
49 50

{
51
	struct iscsi_iser_task *iser_task = task->dd_data;
S
Sagi Grimberg 已提交
52
	struct iser_device  *device = iser_task->iser_conn->ib_conn.device;
53 54
	struct iser_regd_buf *regd_buf;
	int err;
55 56
	struct iser_hdr *hdr = &iser_task->desc.iser_header;
	struct iser_data_buf *buf_in = &iser_task->data[ISER_DIR_IN];
57

58
	err = iser_dma_map_task_data(iser_task,
59 60 61 62 63 64
				     buf_in,
				     ISER_DIR_IN,
				     DMA_FROM_DEVICE);
	if (err)
		return err;

65 66 67 68 69 70 71 72 73 74 75
	if (scsi_prot_sg_count(iser_task->sc)) {
		struct iser_data_buf *pbuf_in = &iser_task->prot[ISER_DIR_IN];

		err = iser_dma_map_task_data(iser_task,
					     pbuf_in,
					     ISER_DIR_IN,
					     DMA_FROM_DEVICE);
		if (err)
			return err;
	}

76
	err = device->iser_reg_rdma_mem(iser_task, ISER_DIR_IN);
77 78 79 80
	if (err) {
		iser_err("Failed to set up Data-IN RDMA\n");
		return err;
	}
81
	regd_buf = &iser_task->rdma_regd[ISER_DIR_IN];
82 83 84 85 86 87

	hdr->flags    |= ISER_RSV;
	hdr->read_stag = cpu_to_be32(regd_buf->reg.rkey);
	hdr->read_va   = cpu_to_be64(regd_buf->reg.va);

	iser_dbg("Cmd itt:%d READ tags RKEY:%#.4X VA:%#llX\n",
88
		 task->itt, regd_buf->reg.rkey,
89 90 91 92 93 94
		 (unsigned long long)regd_buf->reg.va);

	return 0;
}

/* Register user buffer memory and initialize passive rdma
95 96 97
 *  dto descriptor. Data size is stored in
 *  task->data[ISER_DIR_OUT].data_len, Protection size
 *  is stored at task->prot[ISER_DIR_OUT].data_len
98 99
 */
static int
100
iser_prepare_write_cmd(struct iscsi_task *task,
101 102 103 104
		       unsigned int imm_sz,
		       unsigned int unsol_sz,
		       unsigned int edtl)
{
105
	struct iscsi_iser_task *iser_task = task->dd_data;
S
Sagi Grimberg 已提交
106
	struct iser_device  *device = iser_task->iser_conn->ib_conn.device;
107 108
	struct iser_regd_buf *regd_buf;
	int err;
109 110
	struct iser_hdr *hdr = &iser_task->desc.iser_header;
	struct iser_data_buf *buf_out = &iser_task->data[ISER_DIR_OUT];
111
	struct ib_sge *tx_dsg = &iser_task->desc.tx_sg[1];
112

113
	err = iser_dma_map_task_data(iser_task,
114 115 116 117 118 119
				     buf_out,
				     ISER_DIR_OUT,
				     DMA_TO_DEVICE);
	if (err)
		return err;

120 121 122 123 124 125 126 127 128 129 130
	if (scsi_prot_sg_count(iser_task->sc)) {
		struct iser_data_buf *pbuf_out = &iser_task->prot[ISER_DIR_OUT];

		err = iser_dma_map_task_data(iser_task,
					     pbuf_out,
					     ISER_DIR_OUT,
					     DMA_TO_DEVICE);
		if (err)
			return err;
	}

131
	err = device->iser_reg_rdma_mem(iser_task, ISER_DIR_OUT);
132 133 134 135 136
	if (err != 0) {
		iser_err("Failed to register write cmd RDMA mem\n");
		return err;
	}

137
	regd_buf = &iser_task->rdma_regd[ISER_DIR_OUT];
138 139 140 141 142 143 144 145

	if (unsol_sz < edtl) {
		hdr->flags     |= ISER_WSV;
		hdr->write_stag = cpu_to_be32(regd_buf->reg.rkey);
		hdr->write_va   = cpu_to_be64(regd_buf->reg.va + unsol_sz);

		iser_dbg("Cmd itt:%d, WRITE tags, RKEY:%#.4X "
			 "VA:%#llX + unsol:%d\n",
146
			 task->itt, regd_buf->reg.rkey,
147 148 149 150 151
			 (unsigned long long)regd_buf->reg.va, unsol_sz);
	}

	if (imm_sz > 0) {
		iser_dbg("Cmd itt:%d, WRITE, adding imm.data sz: %d\n",
152
			 task->itt, imm_sz);
153 154 155 156
		tx_dsg->addr   = regd_buf->reg.va;
		tx_dsg->length = imm_sz;
		tx_dsg->lkey   = regd_buf->reg.lkey;
		iser_task->desc.num_sge = 2;
157 158 159 160 161 162
	}

	return 0;
}

/* creates a new tx descriptor and adds header regd buffer */
163
static void iser_create_send_desc(struct iser_conn	*iser_conn,
164
				  struct iser_tx_desc	*tx_desc)
165
{
S
Sagi Grimberg 已提交
166
	struct iser_device *device = iser_conn->ib_conn.device;
167

168 169
	ib_dma_sync_single_for_cpu(device->ib_device,
		tx_desc->dma_addr, ISER_HEADERS_LEN, DMA_TO_DEVICE);
170 171 172 173

	memset(&tx_desc->iser_header, 0, sizeof(struct iser_hdr));
	tx_desc->iser_header.flags = ISER_VER;

174 175 176 177 178 179
	tx_desc->num_sge = 1;

	if (tx_desc->tx_sg[0].lkey != device->mr->lkey) {
		tx_desc->tx_sg[0].lkey = device->mr->lkey;
		iser_dbg("sdesc %p lkey mismatch, fixing\n", tx_desc);
	}
180 181
}

182
static void iser_free_login_buf(struct iser_conn *iser_conn)
183
{
S
Sagi Grimberg 已提交
184 185
	struct iser_device *device = iser_conn->ib_conn.device;

186
	if (!iser_conn->login_buf)
187 188
		return;

189
	if (iser_conn->login_req_dma)
S
Sagi Grimberg 已提交
190
		ib_dma_unmap_single(device->ib_device,
191
				    iser_conn->login_req_dma,
192 193
				    ISCSI_DEF_MAX_RECV_SEG_LEN, DMA_TO_DEVICE);

194
	if (iser_conn->login_resp_dma)
S
Sagi Grimberg 已提交
195
		ib_dma_unmap_single(device->ib_device,
196
				    iser_conn->login_resp_dma,
197 198
				    ISER_RX_LOGIN_SIZE, DMA_FROM_DEVICE);

199
	kfree(iser_conn->login_buf);
200 201

	/* make sure we never redo any unmapping */
202 203 204
	iser_conn->login_req_dma = 0;
	iser_conn->login_resp_dma = 0;
	iser_conn->login_buf = NULL;
205 206
}

207
static int iser_alloc_login_buf(struct iser_conn *iser_conn)
208
{
S
Sagi Grimberg 已提交
209
	struct iser_device *device = iser_conn->ib_conn.device;
210 211
	int			req_err, resp_err;

S
Sagi Grimberg 已提交
212
	BUG_ON(device == NULL);
213

214
	iser_conn->login_buf = kmalloc(ISCSI_DEF_MAX_RECV_SEG_LEN +
215
				     ISER_RX_LOGIN_SIZE, GFP_KERNEL);
216
	if (!iser_conn->login_buf)
217 218
		goto out_err;

219 220
	iser_conn->login_req_buf  = iser_conn->login_buf;
	iser_conn->login_resp_buf = iser_conn->login_buf +
221 222
						ISCSI_DEF_MAX_RECV_SEG_LEN;

223 224 225 226
	iser_conn->login_req_dma = ib_dma_map_single(device->ib_device,
						     iser_conn->login_req_buf,
						     ISCSI_DEF_MAX_RECV_SEG_LEN,
						     DMA_TO_DEVICE);
227

228 229 230 231
	iser_conn->login_resp_dma = ib_dma_map_single(device->ib_device,
						      iser_conn->login_resp_buf,
						      ISER_RX_LOGIN_SIZE,
						      DMA_FROM_DEVICE);
232 233

	req_err  = ib_dma_mapping_error(device->ib_device,
234
					iser_conn->login_req_dma);
235
	resp_err = ib_dma_mapping_error(device->ib_device,
236
					iser_conn->login_resp_dma);
237

238 239
	if (req_err || resp_err) {
		if (req_err)
240
			iser_conn->login_req_dma = 0;
241
		if (resp_err)
242
			iser_conn->login_resp_dma = 0;
243 244 245 246 247
		goto free_login_buf;
	}
	return 0;

free_login_buf:
248
	iser_free_login_buf(iser_conn);
249 250 251 252 253

out_err:
	iser_err("unable to alloc or map login buf\n");
	return -ENOMEM;
}
254

255 256
int iser_alloc_rx_descriptors(struct iser_conn *iser_conn,
			      struct iscsi_session *session)
257 258 259 260 261
{
	int i, j;
	u64 dma_addr;
	struct iser_rx_desc *rx_desc;
	struct ib_sge       *rx_sg;
S
Sagi Grimberg 已提交
262 263
	struct ib_conn *ib_conn = &iser_conn->ib_conn;
	struct iser_device *device = ib_conn->device;
264

265 266 267
	iser_conn->qp_max_recv_dtos = session->cmds_max;
	iser_conn->qp_max_recv_dtos_mask = session->cmds_max - 1; /* cmds_max is 2^N */
	iser_conn->min_posted_rx = iser_conn->qp_max_recv_dtos >> 2;
268

S
Sagi Grimberg 已提交
269
	if (device->iser_alloc_rdma_reg_res(ib_conn, session->scsi_cmds_max))
270
		goto create_rdma_reg_res_failed;
271

272
	if (iser_alloc_login_buf(iser_conn))
273 274
		goto alloc_login_buf_fail;

275 276
	iser_conn->num_rx_descs = session->cmds_max;
	iser_conn->rx_descs = kmalloc(iser_conn->num_rx_descs *
277
				sizeof(struct iser_rx_desc), GFP_KERNEL);
278
	if (!iser_conn->rx_descs)
279 280
		goto rx_desc_alloc_fail;

281
	rx_desc = iser_conn->rx_descs;
282

283
	for (i = 0; i < iser_conn->qp_max_recv_dtos; i++, rx_desc++)  {
284 285 286 287 288 289 290 291 292 293 294 295 296
		dma_addr = ib_dma_map_single(device->ib_device, (void *)rx_desc,
					ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
		if (ib_dma_mapping_error(device->ib_device, dma_addr))
			goto rx_desc_dma_map_failed;

		rx_desc->dma_addr = dma_addr;

		rx_sg = &rx_desc->rx_sg;
		rx_sg->addr   = rx_desc->dma_addr;
		rx_sg->length = ISER_RX_PAYLOAD_SIZE;
		rx_sg->lkey   = device->mr->lkey;
	}

297
	iser_conn->rx_desc_head = 0;
298 299 300
	return 0;

rx_desc_dma_map_failed:
301
	rx_desc = iser_conn->rx_descs;
302 303
	for (j = 0; j < i; j++, rx_desc++)
		ib_dma_unmap_single(device->ib_device, rx_desc->dma_addr,
304
				    ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
305 306
	kfree(iser_conn->rx_descs);
	iser_conn->rx_descs = NULL;
307
rx_desc_alloc_fail:
308
	iser_free_login_buf(iser_conn);
309
alloc_login_buf_fail:
S
Sagi Grimberg 已提交
310
	device->iser_free_rdma_reg_res(ib_conn);
311
create_rdma_reg_res_failed:
312 313 314 315
	iser_err("failed allocating rx descriptors / data buffers\n");
	return -ENOMEM;
}

316
void iser_free_rx_descriptors(struct iser_conn *iser_conn)
317 318 319
{
	int i;
	struct iser_rx_desc *rx_desc;
S
Sagi Grimberg 已提交
320 321
	struct ib_conn *ib_conn = &iser_conn->ib_conn;
	struct iser_device *device = ib_conn->device;
322

323
	if (!iser_conn->rx_descs)
324
		goto free_login_buf;
325

326
	if (device->iser_free_rdma_reg_res)
S
Sagi Grimberg 已提交
327
		device->iser_free_rdma_reg_res(ib_conn);
328

329 330
	rx_desc = iser_conn->rx_descs;
	for (i = 0; i < iser_conn->qp_max_recv_dtos; i++, rx_desc++)
331
		ib_dma_unmap_single(device->ib_device, rx_desc->dma_addr,
332
				    ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
333
	kfree(iser_conn->rx_descs);
334
	/* make sure we never redo any unmapping */
335
	iser_conn->rx_descs = NULL;
336 337

free_login_buf:
338
	iser_free_login_buf(iser_conn);
339 340
}

341
static int iser_post_rx_bufs(struct iscsi_conn *conn, struct iscsi_hdr *req)
342
{
343
	struct iser_conn *iser_conn = conn->dd_data;
S
Sagi Grimberg 已提交
344
	struct ib_conn *ib_conn = &iser_conn->ib_conn;
345
	struct iscsi_session *session = conn->session;
346

347 348 349 350
	iser_dbg("req op %x flags %x\n", req->opcode, req->flags);
	/* check if this is the last login - going to full feature phase */
	if ((req->flags & ISCSI_FULL_FEATURE_PHASE) != ISCSI_FULL_FEATURE_PHASE)
		return 0;
351

352
	/*
353 354
	 * Check that there is one posted recv buffer
	 * (for the last login response).
355
	 */
S
Sagi Grimberg 已提交
356
	WARN_ON(ib_conn->post_recv_buf_count != 1);
357

358 359 360 361 362
	if (session->discovery_sess) {
		iser_info("Discovery session, re-using login RX buffer\n");
		return 0;
	} else
		iser_info("Normal session, posting batch of RX %d buffers\n",
363
			  iser_conn->min_posted_rx);
364

365
	/* Initial post receive buffers */
366
	if (iser_post_recvm(iser_conn, iser_conn->min_posted_rx))
367 368
		return -ENOMEM;

369 370 371
	return 0;
}

M
Max Gurtovoy 已提交
372
static inline bool iser_signal_comp(u8 sig_count)
373 374 375 376
{
	return ((sig_count % ISER_SIGNAL_CMD_COUNT) == 0);
}

377 378 379
/**
 * iser_send_command - send command PDU
 */
380
int iser_send_command(struct iscsi_conn *conn,
381
		      struct iscsi_task *task)
382
{
383
	struct iser_conn *iser_conn = conn->dd_data;
384
	struct iscsi_iser_task *iser_task = task->dd_data;
385
	unsigned long edtl;
386
	int err;
387
	struct iser_data_buf *data_buf, *prot_buf;
388
	struct iscsi_scsi_req *hdr = (struct iscsi_scsi_req *)task->hdr;
389
	struct scsi_cmnd *sc  =  task->sc;
390
	struct iser_tx_desc *tx_desc = &iser_task->desc;
M
Max Gurtovoy 已提交
391
	u8 sig_count = ++iser_conn->ib_conn.sig_count;
392 393 394 395

	edtl = ntohl(hdr->data_length);

	/* build the tx desc regd header and add it to the tx desc dto */
396
	tx_desc->type = ISCSI_TX_SCSI_COMMAND;
397
	iser_create_send_desc(iser_conn, tx_desc);
398

399
	if (hdr->flags & ISCSI_FLAG_CMD_READ) {
400
		data_buf = &iser_task->data[ISER_DIR_IN];
401 402
		prot_buf = &iser_task->prot[ISER_DIR_IN];
	} else {
403
		data_buf = &iser_task->data[ISER_DIR_OUT];
404 405
		prot_buf = &iser_task->prot[ISER_DIR_OUT];
	}
406

407 408 409
	if (scsi_sg_count(sc)) { /* using a scatter list */
		data_buf->buf  = scsi_sglist(sc);
		data_buf->size = scsi_sg_count(sc);
410
	}
411
	data_buf->data_len = scsi_bufflen(sc);
412

413 414 415
	if (scsi_prot_sg_count(sc)) {
		prot_buf->buf  = scsi_prot_sglist(sc);
		prot_buf->size = scsi_prot_sg_count(sc);
416 417
		prot_buf->data_len = data_buf->data_len >>
				     ilog2(sc->device->sector_size) * 8;
418 419
	}

420
	if (hdr->flags & ISCSI_FLAG_CMD_READ) {
421
		err = iser_prepare_read_cmd(task);
422 423 424 425
		if (err)
			goto send_command_error;
	}
	if (hdr->flags & ISCSI_FLAG_CMD_WRITE) {
426 427 428
		err = iser_prepare_write_cmd(task,
					     task->imm_count,
				             task->imm_count +
429
					     task->unsol_r2t.data_length,
430 431 432 433 434
					     edtl);
		if (err)
			goto send_command_error;
	}

435
	iser_task->status = ISER_TASK_STATUS_STARTED;
436

437
	err = iser_post_send(&iser_conn->ib_conn, tx_desc,
M
Max Gurtovoy 已提交
438
			     iser_signal_comp(sig_count));
439 440 441 442
	if (!err)
		return 0;

send_command_error:
443
	iser_err("conn %p failed task->itt %d err %d\n",conn, task->itt, err);
444 445 446 447 448 449
	return err;
}

/**
 * iser_send_data_out - send data out PDU
 */
450
int iser_send_data_out(struct iscsi_conn *conn,
451
		       struct iscsi_task *task,
452 453
		       struct iscsi_data *hdr)
{
454
	struct iser_conn *iser_conn = conn->dd_data;
455
	struct iscsi_iser_task *iser_task = task->dd_data;
456 457
	struct iser_tx_desc *tx_desc = NULL;
	struct iser_regd_buf *regd_buf;
458 459
	unsigned long buf_offset;
	unsigned long data_seg_len;
460
	uint32_t itt;
461
	int err = 0;
462 463
	struct ib_sge *tx_dsg;

464
	itt = (__force uint32_t)hdr->itt;
465 466 467 468 469 470
	data_seg_len = ntoh24(hdr->dlength);
	buf_offset   = ntohl(hdr->offset);

	iser_dbg("%s itt %d dseg_len %d offset %d\n",
		 __func__,(int)itt,(int)data_seg_len,(int)buf_offset);

O
Or Gerlitz 已提交
471
	tx_desc = kmem_cache_zalloc(ig.desc_cache, GFP_ATOMIC);
472 473 474 475 476 477
	if (tx_desc == NULL) {
		iser_err("Failed to alloc desc for post dataout\n");
		return -ENOMEM;
	}

	tx_desc->type = ISCSI_TX_DATAOUT;
478
	tx_desc->iser_header.flags = ISER_VER;
479 480
	memcpy(&tx_desc->iscsi_header, hdr, sizeof(struct iscsi_hdr));

481 482
	/* build the tx desc */
	iser_initialize_task_headers(task, tx_desc);
483

484 485 486 487 488 489
	regd_buf = &iser_task->rdma_regd[ISER_DIR_OUT];
	tx_dsg = &tx_desc->tx_sg[1];
	tx_dsg->addr    = regd_buf->reg.va + buf_offset;
	tx_dsg->length  = data_seg_len;
	tx_dsg->lkey    = regd_buf->reg.lkey;
	tx_desc->num_sge = 2;
490

491
	if (buf_offset + data_seg_len > iser_task->data[ISER_DIR_OUT].data_len) {
492 493 494
		iser_err("Offset:%ld & DSL:%ld in Data-Out "
			 "inconsistent with total len:%ld, itt:%d\n",
			 buf_offset, data_seg_len,
495
			 iser_task->data[ISER_DIR_OUT].data_len, itt);
496 497 498 499 500 501 502
		err = -EINVAL;
		goto send_data_out_error;
	}
	iser_dbg("data-out itt: %d, offset: %ld, sz: %ld\n",
		 itt, buf_offset, data_seg_len);


503
	err = iser_post_send(&iser_conn->ib_conn, tx_desc, true);
504 505 506 507 508 509 510 511 512 513
	if (!err)
		return 0;

send_data_out_error:
	kmem_cache_free(ig.desc_cache, tx_desc);
	iser_err("conn %p failed err %d\n",conn, err);
	return err;
}

int iser_send_control(struct iscsi_conn *conn,
514
		      struct iscsi_task *task)
515
{
516
	struct iser_conn *iser_conn = conn->dd_data;
517
	struct iscsi_iser_task *iser_task = task->dd_data;
518
	struct iser_tx_desc *mdesc = &iser_task->desc;
519
	unsigned long data_seg_len;
520
	int err = 0;
521 522 523 524
	struct iser_device *device;

	/* build the tx desc regd header and add it to the tx desc dto */
	mdesc->type = ISCSI_TX_CONTROL;
525
	iser_create_send_desc(iser_conn, mdesc);
526

S
Sagi Grimberg 已提交
527
	device = iser_conn->ib_conn.device;
528

529
	data_seg_len = ntoh24(task->hdr->dlength);
530 531

	if (data_seg_len > 0) {
532 533 534 535 536
		struct ib_sge *tx_dsg = &mdesc->tx_sg[1];
		if (task != conn->login_task) {
			iser_err("data present on non login task!!!\n");
			goto send_control_error;
		}
537 538

		ib_dma_sync_single_for_cpu(device->ib_device,
539
			iser_conn->login_req_dma, task->data_count,
540 541
			DMA_TO_DEVICE);

542
		memcpy(iser_conn->login_req_buf, task->data, task->data_count);
543 544

		ib_dma_sync_single_for_device(device->ib_device,
545
			iser_conn->login_req_dma, task->data_count,
546 547
			DMA_TO_DEVICE);

548
		tx_dsg->addr    = iser_conn->login_req_dma;
O
Or Gerlitz 已提交
549
		tx_dsg->length  = task->data_count;
550 551
		tx_dsg->lkey    = device->mr->lkey;
		mdesc->num_sge = 2;
552 553
	}

554
	if (task == conn->login_task) {
555 556
		iser_dbg("op %x dsl %lx, posting login rx buffer\n",
			 task->hdr->opcode, data_seg_len);
557
		err = iser_post_recvl(iser_conn);
558 559
		if (err)
			goto send_control_error;
560 561 562
		err = iser_post_rx_bufs(conn, task->hdr);
		if (err)
			goto send_control_error;
563 564
	}

565
	err = iser_post_send(&iser_conn->ib_conn, mdesc, true);
566 567 568 569 570 571 572 573 574 575 576
	if (!err)
		return 0;

send_control_error:
	iser_err("conn %p failed err %d\n",conn, err);
	return err;
}

/**
 * iser_rcv_dto_completion - recv DTO completion
 */
577 578
void iser_rcv_completion(struct iser_rx_desc *rx_desc,
			 unsigned long rx_xfer_len,
S
Sagi Grimberg 已提交
579
			 struct ib_conn *ib_conn)
580
{
S
Sagi Grimberg 已提交
581 582
	struct iser_conn *iser_conn = container_of(ib_conn, struct iser_conn,
						   ib_conn);
583
	struct iscsi_hdr *hdr;
584 585 586 587
	u64 rx_dma;
	int rx_buflen, outstanding, count, err;

	/* differentiate between login to all other PDUs */
588 589
	if ((char *)rx_desc == iser_conn->login_resp_buf) {
		rx_dma = iser_conn->login_resp_dma;
590 591 592 593 594
		rx_buflen = ISER_RX_LOGIN_SIZE;
	} else {
		rx_dma = rx_desc->dma_addr;
		rx_buflen = ISER_RX_PAYLOAD_SIZE;
	}
595

S
Sagi Grimberg 已提交
596
	ib_dma_sync_single_for_cpu(ib_conn->device->ib_device, rx_dma,
597
				   rx_buflen, DMA_FROM_DEVICE);
598

599
	hdr = &rx_desc->iscsi_header;
600

601 602
	iser_dbg("op 0x%x itt 0x%x dlen %d\n", hdr->opcode,
			hdr->itt, (int)(rx_xfer_len - ISER_HEADERS_LEN));
603

604
	iscsi_iser_recv(iser_conn->iscsi_conn, hdr, rx_desc->data,
605
			rx_xfer_len - ISER_HEADERS_LEN);
606

S
Sagi Grimberg 已提交
607
	ib_dma_sync_single_for_device(ib_conn->device->ib_device, rx_dma,
608
				      rx_buflen, DMA_FROM_DEVICE);
609 610 611 612 613

	/* decrementing conn->post_recv_buf_count only --after-- freeing the   *
	 * task eliminates the need to worry on tasks which are completed in   *
	 * parallel to the execution of iser_conn_term. So the code that waits *
	 * for the posted rx bufs refcount to become zero handles everything   */
S
Sagi Grimberg 已提交
614
	ib_conn->post_recv_buf_count--;
615

616
	if (rx_dma == iser_conn->login_resp_dma)
617 618
		return;

S
Sagi Grimberg 已提交
619
	outstanding = ib_conn->post_recv_buf_count;
620 621 622 623
	if (outstanding + iser_conn->min_posted_rx <= iser_conn->qp_max_recv_dtos) {
		count = min(iser_conn->qp_max_recv_dtos - outstanding,
			    iser_conn->min_posted_rx);
		err = iser_post_recvm(iser_conn, count);
624 625 626
		if (err)
			iser_err("posting %d rx bufs err %d\n", count, err);
	}
627 628
}

629
void iser_snd_completion(struct iser_tx_desc *tx_desc,
S
Sagi Grimberg 已提交
630
			struct ib_conn *ib_conn)
631
{
632
	struct iscsi_task *task;
S
Sagi Grimberg 已提交
633
	struct iser_device *device = ib_conn->device;
634

635 636 637
	if (tx_desc->type == ISCSI_TX_DATAOUT) {
		ib_dma_unmap_single(device->ib_device, tx_desc->dma_addr,
					ISER_HEADERS_LEN, DMA_TO_DEVICE);
638
		kmem_cache_free(ig.desc_cache, tx_desc);
639
		tx_desc = NULL;
640
	}
641

642
	if (tx_desc && tx_desc->type == ISCSI_TX_CONTROL) {
643
		/* this arithmetic is legal by libiscsi dd_data allocation */
644 645 646 647
		task = (void *) ((long)(void *)tx_desc -
				  sizeof(struct iscsi_task));
		if (task->hdr->itt == RESERVED_ITT)
			iscsi_put_task(task);
648 649 650
	}
}

651
void iser_task_rdma_init(struct iscsi_iser_task *iser_task)
652 653

{
654
	iser_task->status = ISER_TASK_STATUS_INIT;
655

656 657
	iser_task->dir[ISER_DIR_IN] = 0;
	iser_task->dir[ISER_DIR_OUT] = 0;
658

659 660
	iser_task->data[ISER_DIR_IN].data_len  = 0;
	iser_task->data[ISER_DIR_OUT].data_len = 0;
661

662 663 664
	iser_task->prot[ISER_DIR_IN].data_len  = 0;
	iser_task->prot[ISER_DIR_OUT].data_len = 0;

665
	memset(&iser_task->rdma_regd[ISER_DIR_IN], 0,
666
	       sizeof(struct iser_regd_buf));
667
	memset(&iser_task->rdma_regd[ISER_DIR_OUT], 0,
668 669 670
	       sizeof(struct iser_regd_buf));
}

671
void iser_task_rdma_finalize(struct iscsi_iser_task *iser_task)
672
{
S
Sagi Grimberg 已提交
673
	struct iser_device *device = iser_task->iser_conn->ib_conn.device;
674
	int is_rdma_data_aligned = 1;
675 676
	int is_rdma_prot_aligned = 1;
	int prot_count = scsi_prot_sg_count(iser_task->sc);
677 678 679 680

	/* if we were reading, copy back to unaligned sglist,
	 * anyway dma_unmap and free the copy
	 */
681
	if (iser_task->data_copy[ISER_DIR_IN].copy_buf != NULL) {
682 683 684 685 686
		is_rdma_data_aligned = 0;
		iser_finalize_rdma_unaligned_sg(iser_task,
						&iser_task->data[ISER_DIR_IN],
						&iser_task->data_copy[ISER_DIR_IN],
						ISER_DIR_IN);
687
	}
688

689
	if (iser_task->data_copy[ISER_DIR_OUT].copy_buf != NULL) {
690 691 692 693 694
		is_rdma_data_aligned = 0;
		iser_finalize_rdma_unaligned_sg(iser_task,
						&iser_task->data[ISER_DIR_OUT],
						&iser_task->data_copy[ISER_DIR_OUT],
						ISER_DIR_OUT);
695
	}
696

697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712
	if (iser_task->prot_copy[ISER_DIR_IN].copy_buf != NULL) {
		is_rdma_prot_aligned = 0;
		iser_finalize_rdma_unaligned_sg(iser_task,
						&iser_task->prot[ISER_DIR_IN],
						&iser_task->prot_copy[ISER_DIR_IN],
						ISER_DIR_IN);
	}

	if (iser_task->prot_copy[ISER_DIR_OUT].copy_buf != NULL) {
		is_rdma_prot_aligned = 0;
		iser_finalize_rdma_unaligned_sg(iser_task,
						&iser_task->prot[ISER_DIR_OUT],
						&iser_task->prot_copy[ISER_DIR_OUT],
						ISER_DIR_OUT);
	}

713
	if (iser_task->dir[ISER_DIR_IN]) {
714
		device->iser_unreg_rdma_mem(iser_task, ISER_DIR_IN);
715 716 717
		if (is_rdma_data_aligned)
			iser_dma_unmap_task_data(iser_task,
						 &iser_task->data[ISER_DIR_IN]);
718 719 720
		if (prot_count && is_rdma_prot_aligned)
			iser_dma_unmap_task_data(iser_task,
						 &iser_task->prot[ISER_DIR_IN]);
721
	}
722

723 724 725 726 727 728 729 730 731
	if (iser_task->dir[ISER_DIR_OUT]) {
		device->iser_unreg_rdma_mem(iser_task, ISER_DIR_OUT);
		if (is_rdma_data_aligned)
			iser_dma_unmap_task_data(iser_task,
						 &iser_task->data[ISER_DIR_OUT]);
		if (prot_count && is_rdma_prot_aligned)
			iser_dma_unmap_task_data(iser_task,
						 &iser_task->prot[ISER_DIR_OUT]);
	}
732
}