]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blame - drivers/infiniband/ulp/isert/ib_isert.c
projects / mirror_ubuntu-zesty-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
iser-target: Remove code duplication
[mirror_ubuntu-zesty-kernel.git] / drivers / infiniband / ulp / isert / ib_isert.c
CommitLineData
b8d26b3b
NB		 1/*******************************************************************************
2 * This file contains iSCSI extentions for RDMA (iSER) Verbs
3 *
4c76251e 4 * (c) Copyright 2013 Datera, Inc.
b8d26b3b
NB		 5 *
6 * Nicholas A. Bellinger <nab@linux-iscsi.org>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 ****************************************************************************/
18
19#include <linux/string.h>
20#include <linux/module.h>
21#include <linux/scatterlist.h>
22#include <linux/socket.h>
23#include <linux/in.h>
24#include <linux/in6.h>
25#include <rdma/ib_verbs.h>
26#include <rdma/rdma_cm.h>
27#include <target/target_core_base.h>
28#include <target/target_core_fabric.h>
29#include <target/iscsi/iscsi_transport.h>
531b7bf4 30#include <linux/semaphore.h>
b8d26b3b
NB		 31
32#include "isert_proto.h"
33#include "ib_isert.h"
34
35#define ISERT_MAX_CONN 8
36#define ISER_MAX_RX_CQ_LEN (ISERT_QP_MAX_RECV_DTOS * ISERT_MAX_CONN)
37#define ISER_MAX_TX_CQ_LEN (ISERT_QP_MAX_REQ_DTOS * ISERT_MAX_CONN)
bdf20e72
SG		 38#define ISER_MAX_CQ_LEN (ISER_MAX_RX_CQ_LEN + ISER_MAX_TX_CQ_LEN + \
39 ISERT_MAX_CONN)
b8d26b3b 40
24f412dd
SG		 41int isert_debug_level = 0;
42module_param_named(debug_level, isert_debug_level, int, 0644);
43MODULE_PARM_DESC(debug_level, "Enable debug tracing if > 0 (default:0)");
44
b8d26b3b
NB		 45static DEFINE_MUTEX(device_list_mutex);
46static LIST_HEAD(device_list);
b8d26b3b 47static struct workqueue_struct *isert_comp_wq;
b02efbfc 48static struct workqueue_struct *isert_release_wq;
b8d26b3b 49
d40945d8
VP		 50static void
51isert_unmap_cmd(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn);
52static int
53isert_map_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd,
54 struct isert_rdma_wr *wr);
59464ef4 55static void
a3a5a826 56isert_unreg_rdma(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn);
59464ef4 57static int
a3a5a826
SG		 58isert_reg_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd,
59 struct isert_rdma_wr *wr);
f93f3a70
SG		 60static int
61isert_put_response(struct iscsi_conn *conn, struct iscsi_cmd *cmd);
2371e5da
SG		 62static int
63isert_rdma_post_recvl(struct isert_conn *isert_conn);
64static int
65isert_rdma_accept(struct isert_conn *isert_conn);
ca6c1d82 66struct rdma_cm_id *isert_setup_id(struct isert_np *isert_np);
d40945d8 67
302cc7c3
SG		 68static inline bool
69isert_prot_cmd(struct isert_conn *conn, struct se_cmd *cmd)
70{
23a548ee 71 return (conn->pi_support &&
302cc7c3
SG		 72 cmd->prot_op != TARGET_PROT_NORMAL);
73}
74
75
b8d26b3b
NB		 76static void
77isert_qp_event_callback(struct ib_event *e, void *context)
78{
79 struct isert_conn *isert_conn = (struct isert_conn *)context;
80
4c22e07f 81 isert_err("conn %p event: %d\n", isert_conn, e->event);
b8d26b3b
NB		 82 switch (e->event) {
83 case IB_EVENT_COMM_EST:
84 rdma_notify(isert_conn->conn_cm_id, IB_EVENT_COMM_EST);
85 break;
86 case IB_EVENT_QP_LAST_WQE_REACHED:
4c22e07f 87 isert_warn("Reached TX IB_EVENT_QP_LAST_WQE_REACHED\n");
b8d26b3b
NB		 88 break;
89 default:
90 break;
91 }
92}
93
94static int
95isert_query_device(struct ib_device *ib_dev, struct ib_device_attr *devattr)
96{
97 int ret;
98
99 ret = ib_query_device(ib_dev, devattr);
100 if (ret) {
24f412dd 101 isert_err("ib_query_device() failed: %d\n", ret);
b8d26b3b
NB		 102 return ret;
103 }
24f412dd
SG		 104 isert_dbg("devattr->max_sge: %d\n", devattr->max_sge);
105 isert_dbg("devattr->max_sge_rd: %d\n", devattr->max_sge_rd);
b8d26b3b
NB		 106
107 return 0;
108}
109
110static int
570db170 111isert_conn_setup_qp(struct isert_conn *isert_conn, struct rdma_cm_id *cma_id)
b8d26b3b
NB		 112{
113 struct isert_device *device = isert_conn->conn_device;
114 struct ib_qp_init_attr attr;
4a295bae
SG		 115 struct isert_comp *comp;
116 int ret, i, min = 0;
b8d26b3b 117
b8d26b3b 118 mutex_lock(&device_list_mutex);
4a295bae
SG		 119 for (i = 0; i < device->comps_used; i++)
120 if (device->comps[i].active_qps <
121 device->comps[min].active_qps)
122 min = i;
123 comp = &device->comps[min];
124 comp->active_qps++;
24f412dd 125 isert_info("conn %p, using comp %p min_index: %d\n",
4a295bae 126 isert_conn, comp, min);
b8d26b3b
NB		 127 mutex_unlock(&device_list_mutex);
128
129 memset(&attr, 0, sizeof(struct ib_qp_init_attr));
130 attr.event_handler = isert_qp_event_callback;
131 attr.qp_context = isert_conn;
6f0fae3d
SG		 132 attr.send_cq = comp->cq;
133 attr.recv_cq = comp->cq;
b8d26b3b 134 attr.cap.max_send_wr = ISERT_QP_MAX_REQ_DTOS;
bdf20e72 135 attr.cap.max_recv_wr = ISERT_QP_MAX_RECV_DTOS + 1;
b8d26b3b
NB		 136 /*
137 * FIXME: Use devattr.max_sge - 2 for max_send_sge as
f57915cf
OG		 138 * work-around for RDMA_READs with ConnectX-2.
139 *
140 * Also, still make sure to have at least two SGEs for
141 * outgoing control PDU responses.
b8d26b3b 142 */
f57915cf 143 attr.cap.max_send_sge = max(2, device->dev_attr.max_sge - 2);
b8d26b3b
NB		 144 isert_conn->max_sge = attr.cap.max_send_sge;
145
146 attr.cap.max_recv_sge = 1;
147 attr.sq_sig_type = IB_SIGNAL_REQ_WR;
148 attr.qp_type = IB_QPT_RC;
570db170 149 if (device->pi_capable)
d3e125da 150 attr.create_flags |= IB_QP_CREATE_SIGNATURE_EN;
b8d26b3b 151
b8d26b3b
NB		 152 ret = rdma_create_qp(cma_id, isert_conn->conn_pd, &attr);
153 if (ret) {
24f412dd 154 isert_err("rdma_create_qp failed for cma_id %d\n", ret);
19e2090f 155 goto err;
b8d26b3b
NB		 156 }
157 isert_conn->conn_qp = cma_id->qp;
b8d26b3b
NB		 158
159 return 0;
19e2090f
SG		 160err:
161 mutex_lock(&device_list_mutex);
4a295bae 162 comp->active_qps--;
19e2090f
SG		 163 mutex_unlock(&device_list_mutex);
164
165 return ret;
b8d26b3b
NB		 166}
167
168static void
169isert_cq_event_callback(struct ib_event *e, void *context)
170{
4c22e07f 171 isert_dbg("event: %d\n", e->event);
b8d26b3b
NB		 172}
173
174static int
175isert_alloc_rx_descriptors(struct isert_conn *isert_conn)
176{
177 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
178 struct iser_rx_desc *rx_desc;
179 struct ib_sge *rx_sg;
180 u64 dma_addr;
181 int i, j;
182
183 isert_conn->conn_rx_descs = kzalloc(ISERT_QP_MAX_RECV_DTOS *
184 sizeof(struct iser_rx_desc), GFP_KERNEL);
185 if (!isert_conn->conn_rx_descs)
186 goto fail;
187
188 rx_desc = isert_conn->conn_rx_descs;
189
190 for (i = 0; i < ISERT_QP_MAX_RECV_DTOS; i++, rx_desc++) {
191 dma_addr = ib_dma_map_single(ib_dev, (void *)rx_desc,
192 ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
193 if (ib_dma_mapping_error(ib_dev, dma_addr))
194 goto dma_map_fail;
195
196 rx_desc->dma_addr = dma_addr;
197
198 rx_sg = &rx_desc->rx_sg;
199 rx_sg->addr = rx_desc->dma_addr;
200 rx_sg->length = ISER_RX_PAYLOAD_SIZE;
201 rx_sg->lkey = isert_conn->conn_mr->lkey;
202 }
203
204 isert_conn->conn_rx_desc_head = 0;
4c22e07f 205
b8d26b3b
NB		 206 return 0;
207
208dma_map_fail:
209 rx_desc = isert_conn->conn_rx_descs;
210 for (j = 0; j < i; j++, rx_desc++) {
211 ib_dma_unmap_single(ib_dev, rx_desc->dma_addr,
212 ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
213 }
214 kfree(isert_conn->conn_rx_descs);
215 isert_conn->conn_rx_descs = NULL;
216fail:
4c22e07f
SG		 217 isert_err("conn %p failed to allocate rx descriptors\n", isert_conn);
218
b8d26b3b
NB		 219 return -ENOMEM;
220}
221
222static void
223isert_free_rx_descriptors(struct isert_conn *isert_conn)
224{
225 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
226 struct iser_rx_desc *rx_desc;
227 int i;
228
229 if (!isert_conn->conn_rx_descs)
230 return;
231
232 rx_desc = isert_conn->conn_rx_descs;
233 for (i = 0; i < ISERT_QP_MAX_RECV_DTOS; i++, rx_desc++) {
234 ib_dma_unmap_single(ib_dev, rx_desc->dma_addr,
235 ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
236 }
237
238 kfree(isert_conn->conn_rx_descs);
239 isert_conn->conn_rx_descs = NULL;
240}
241
6f0fae3d
SG		 242static void isert_cq_work(struct work_struct *);
243static void isert_cq_callback(struct ib_cq *, void *);
b8d26b3b
NB		 244
245static int
246isert_create_device_ib_res(struct isert_device *device)
247{
248 struct ib_device *ib_dev = device->ib_device;
59464ef4 249 struct ib_device_attr *dev_attr;
4a295bae 250 int ret = 0, i;
6f0fae3d 251 int max_cqe;
b8d26b3b 252
59464ef4
VP		 253 dev_attr = &device->dev_attr;
254 ret = isert_query_device(ib_dev, dev_attr);
255 if (ret)
256 return ret;
257
6f0fae3d 258 max_cqe = min(ISER_MAX_CQ_LEN, dev_attr->max_cqe);
b1a5ad00 259
d40945d8 260 /* asign function handlers */
f2252258
SG		 261 if (dev_attr->device_cap_flags & IB_DEVICE_MEM_MGT_EXTENSIONS &&
262 dev_attr->device_cap_flags & IB_DEVICE_SIGNATURE_HANDOVER) {
a3a5a826
SG		 263 device->use_fastreg = 1;
264 device->reg_rdma_mem = isert_reg_rdma;
265 device->unreg_rdma_mem = isert_unreg_rdma;
59464ef4 266 } else {
a3a5a826 267 device->use_fastreg = 0;
59464ef4
VP		 268 device->reg_rdma_mem = isert_map_rdma;
269 device->unreg_rdma_mem = isert_unmap_cmd;
270 }
d40945d8 271
d3e125da
SG		 272 /* Check signature cap */
273 device->pi_capable = dev_attr->device_cap_flags &
274 IB_DEVICE_SIGNATURE_HANDOVER ? true : false;
275
4a295bae
SG		 276 device->comps_used = min(ISERT_MAX_CQ, min_t(int, num_online_cpus(),
277 device->ib_device->num_comp_vectors));
24f412dd 278 isert_info("Using %d CQs, %s supports %d vectors support "
4a295bae
SG		 279 "Fast registration %d pi_capable %d\n",
280 device->comps_used, device->ib_device->name,
281 device->ib_device->num_comp_vectors, device->use_fastreg,
282 device->pi_capable);
283
284 device->comps = kcalloc(device->comps_used, sizeof(struct isert_comp),
285 GFP_KERNEL);
286 if (!device->comps) {
24f412dd 287 isert_err("Unable to allocate completion contexts\n");
b8d26b3b
NB		 288 return -ENOMEM;
289 }
4a295bae
SG		 290
291 for (i = 0; i < device->comps_used; i++) {
292 struct isert_comp *comp = &device->comps[i];
293
294 comp->device = device;
6f0fae3d
SG		 295 INIT_WORK(&comp->work, isert_cq_work);
296 comp->cq = ib_create_cq(device->ib_device,
297 isert_cq_callback,
298 isert_cq_event_callback,
299 (void *)comp,
300 max_cqe, i);
301 if (IS_ERR(comp->cq)) {
302 ret = PTR_ERR(comp->cq);
303 comp->cq = NULL;
b8d26b3b 304 goto out_cq;
94a71110 305 }
b8d26b3b 306
6f0fae3d 307 ret = ib_req_notify_cq(comp->cq, IB_CQ_NEXT_COMP);
94a71110 308 if (ret)
b8d26b3b
NB		 309 goto out_cq;
310 }
311
b8d26b3b
NB		 312 return 0;
313
314out_cq:
4a295bae
SG		 315 for (i = 0; i < device->comps_used; i++) {
316 struct isert_comp *comp = &device->comps[i];
b8d26b3b 317
6f0fae3d
SG		 318 if (comp->cq) {
319 cancel_work_sync(&comp->work);
320 ib_destroy_cq(comp->cq);
b8d26b3b
NB		 321 }
322 }
4a295bae 323 kfree(device->comps);
b8d26b3b
NB		 324
325 return ret;
326}
327
328static void
329isert_free_device_ib_res(struct isert_device *device)
330{
b8d26b3b
NB		 331 int i;
332
24f412dd 333 isert_info("device %p\n", device);
b8d26b3b 334
4a295bae
SG		 335 for (i = 0; i < device->comps_used; i++) {
336 struct isert_comp *comp = &device->comps[i];
b8d26b3b 337
6f0fae3d
SG		 338 cancel_work_sync(&comp->work);
339 ib_destroy_cq(comp->cq);
340 comp->cq = NULL;
4a295bae
SG		 341 }
342 kfree(device->comps);
b8d26b3b
NB		 343}
344
345static void
346isert_device_try_release(struct isert_device *device)
347{
348 mutex_lock(&device_list_mutex);
349 device->refcount--;
4c22e07f 350 isert_info("device %p refcount %d\n", device, device->refcount);
b8d26b3b
NB		 351 if (!device->refcount) {
352 isert_free_device_ib_res(device);
353 list_del(&device->dev_node);
354 kfree(device);
355 }
356 mutex_unlock(&device_list_mutex);
357}
358
359static struct isert_device *
360isert_device_find_by_ib_dev(struct rdma_cm_id *cma_id)
361{
362 struct isert_device *device;
363 int ret;
364
365 mutex_lock(&device_list_mutex);
366 list_for_each_entry(device, &device_list, dev_node) {
367 if (device->ib_device->node_guid == cma_id->device->node_guid) {
368 device->refcount++;
4c22e07f
SG		 369 isert_info("Found iser device %p refcount %d\n",
370 device, device->refcount);
b8d26b3b
NB		 371 mutex_unlock(&device_list_mutex);
372 return device;
373 }
374 }
375
376 device = kzalloc(sizeof(struct isert_device), GFP_KERNEL);
377 if (!device) {
378 mutex_unlock(&device_list_mutex);
379 return ERR_PTR(-ENOMEM);
380 }
381
382 INIT_LIST_HEAD(&device->dev_node);
383
384 device->ib_device = cma_id->device;
385 ret = isert_create_device_ib_res(device);
386 if (ret) {
387 kfree(device);
388 mutex_unlock(&device_list_mutex);
389 return ERR_PTR(ret);
390 }
391
392 device->refcount++;
393 list_add_tail(&device->dev_node, &device_list);
4c22e07f
SG		 394 isert_info("Created a new iser device %p refcount %d\n",
395 device, device->refcount);
b8d26b3b
NB		 396 mutex_unlock(&device_list_mutex);
397
398 return device;
399}
400
59464ef4 401static void
a3a5a826 402isert_conn_free_fastreg_pool(struct isert_conn *isert_conn)
59464ef4
VP		 403{
404 struct fast_reg_descriptor *fr_desc, *tmp;
405 int i = 0;
406
a3a5a826 407 if (list_empty(&isert_conn->conn_fr_pool))
59464ef4
VP		 408 return;
409
4c22e07f 410 isert_info("Freeing conn %p fastreg pool", isert_conn);
59464ef4
VP		 411
412 list_for_each_entry_safe(fr_desc, tmp,
a3a5a826 413 &isert_conn->conn_fr_pool, list) {
59464ef4
VP		 414 list_del(&fr_desc->list);
415 ib_free_fast_reg_page_list(fr_desc->data_frpl);
416 ib_dereg_mr(fr_desc->data_mr);
d3e125da
SG		 417 if (fr_desc->pi_ctx) {
418 ib_free_fast_reg_page_list(fr_desc->pi_ctx->prot_frpl);
419 ib_dereg_mr(fr_desc->pi_ctx->prot_mr);
420 ib_destroy_mr(fr_desc->pi_ctx->sig_mr);
421 kfree(fr_desc->pi_ctx);
422 }
59464ef4
VP		 423 kfree(fr_desc);
424 ++i;
425 }
426
a3a5a826 427 if (i < isert_conn->conn_fr_pool_size)
24f412dd 428 isert_warn("Pool still has %d regions registered\n",
a3a5a826 429 isert_conn->conn_fr_pool_size - i);
59464ef4
VP		 430}
431
570db170
SG		 432static int
433isert_create_pi_ctx(struct fast_reg_descriptor *desc,
434 struct ib_device *device,
435 struct ib_pd *pd)
436{
437 struct ib_mr_init_attr mr_init_attr;
438 struct pi_context *pi_ctx;
439 int ret;
440
441 pi_ctx = kzalloc(sizeof(*desc->pi_ctx), GFP_KERNEL);
442 if (!pi_ctx) {
24f412dd 443 isert_err("Failed to allocate pi context\n");
570db170
SG		 444 return -ENOMEM;
445 }
446
447 pi_ctx->prot_frpl = ib_alloc_fast_reg_page_list(device,
448 ISCSI_ISER_SG_TABLESIZE);
449 if (IS_ERR(pi_ctx->prot_frpl)) {
24f412dd 450 isert_err("Failed to allocate prot frpl err=%ld\n",
570db170
SG		 451 PTR_ERR(pi_ctx->prot_frpl));
452 ret = PTR_ERR(pi_ctx->prot_frpl);
453 goto err_pi_ctx;
454 }
455
456 pi_ctx->prot_mr = ib_alloc_fast_reg_mr(pd, ISCSI_ISER_SG_TABLESIZE);
457 if (IS_ERR(pi_ctx->prot_mr)) {
24f412dd 458 isert_err("Failed to allocate prot frmr err=%ld\n",
570db170
SG		 459 PTR_ERR(pi_ctx->prot_mr));
460 ret = PTR_ERR(pi_ctx->prot_mr);
461 goto err_prot_frpl;
462 }
463 desc->ind |= ISERT_PROT_KEY_VALID;
464
465 memset(&mr_init_attr, 0, sizeof(mr_init_attr));
466 mr_init_attr.max_reg_descriptors = 2;
467 mr_init_attr.flags |= IB_MR_SIGNATURE_EN;
468 pi_ctx->sig_mr = ib_create_mr(pd, &mr_init_attr);
469 if (IS_ERR(pi_ctx->sig_mr)) {
24f412dd 470 isert_err("Failed to allocate signature enabled mr err=%ld\n",
570db170
SG		 471 PTR_ERR(pi_ctx->sig_mr));
472 ret = PTR_ERR(pi_ctx->sig_mr);
473 goto err_prot_mr;
474 }
475
476 desc->pi_ctx = pi_ctx;
477 desc->ind |= ISERT_SIG_KEY_VALID;
478 desc->ind &= ~ISERT_PROTECTED;
479
480 return 0;
481
482err_prot_mr:
483 ib_dereg_mr(desc->pi_ctx->prot_mr);
484err_prot_frpl:
485 ib_free_fast_reg_page_list(desc->pi_ctx->prot_frpl);
486err_pi_ctx:
487 kfree(desc->pi_ctx);
488
489 return ret;
490}
491
dc87a90f
SG		 492static int
493isert_create_fr_desc(struct ib_device *ib_device, struct ib_pd *pd,
570db170 494 struct fast_reg_descriptor *fr_desc)
dc87a90f 495{
d3e125da
SG		 496 int ret;
497
dc87a90f
SG		 498 fr_desc->data_frpl = ib_alloc_fast_reg_page_list(ib_device,
499 ISCSI_ISER_SG_TABLESIZE);
500 if (IS_ERR(fr_desc->data_frpl)) {
24f412dd 501 isert_err("Failed to allocate data frpl err=%ld\n",
4c22e07f 502 PTR_ERR(fr_desc->data_frpl));
dc87a90f
SG		 503 return PTR_ERR(fr_desc->data_frpl);
504 }
505
506 fr_desc->data_mr = ib_alloc_fast_reg_mr(pd, ISCSI_ISER_SG_TABLESIZE);
507 if (IS_ERR(fr_desc->data_mr)) {
24f412dd 508 isert_err("Failed to allocate data frmr err=%ld\n",
4c22e07f 509 PTR_ERR(fr_desc->data_mr));
d3e125da
SG		 510 ret = PTR_ERR(fr_desc->data_mr);
511 goto err_data_frpl;
dc87a90f 512 }
d3e125da
SG		 513 fr_desc->ind |= ISERT_DATA_KEY_VALID;
514
24f412dd 515 isert_dbg("Created fr_desc %p\n", fr_desc);
dc87a90f
SG		 516
517 return 0;
570db170 518
d3e125da
SG		 519err_data_frpl:
520 ib_free_fast_reg_page_list(fr_desc->data_frpl);
521
522 return ret;
59464ef4
VP		 523}
524
525static int
570db170 526isert_conn_create_fastreg_pool(struct isert_conn *isert_conn)
59464ef4
VP		 527{
528 struct fast_reg_descriptor *fr_desc;
529 struct isert_device *device = isert_conn->conn_device;
f46d6a8a
NB		 530 struct se_session *se_sess = isert_conn->conn->sess->se_sess;
531 struct se_node_acl *se_nacl = se_sess->se_node_acl;
532 int i, ret, tag_num;
533 /*
534 * Setup the number of FRMRs based upon the number of tags
535 * available to session in iscsi_target_locate_portal().
536 */
537 tag_num = max_t(u32, ISCSIT_MIN_TAGS, se_nacl->queue_depth);
538 tag_num = (tag_num * 2) + ISCSIT_EXTRA_TAGS;
59464ef4 539
a3a5a826 540 isert_conn->conn_fr_pool_size = 0;
f46d6a8a 541 for (i = 0; i < tag_num; i++) {
59464ef4
VP		 542 fr_desc = kzalloc(sizeof(*fr_desc), GFP_KERNEL);
543 if (!fr_desc) {
24f412dd 544 isert_err("Failed to allocate fast_reg descriptor\n");
59464ef4
VP		 545 ret = -ENOMEM;
546 goto err;
547 }
548
dc87a90f 549 ret = isert_create_fr_desc(device->ib_device,
570db170 550 isert_conn->conn_pd, fr_desc);
dc87a90f 551 if (ret) {
24f412dd 552 isert_err("Failed to create fastreg descriptor err=%d\n",
dc87a90f 553 ret);
a80e21b3 554 kfree(fr_desc);
59464ef4
VP		 555 goto err;
556 }
59464ef4 557
a3a5a826
SG		 558 list_add_tail(&fr_desc->list, &isert_conn->conn_fr_pool);
559 isert_conn->conn_fr_pool_size++;
59464ef4
VP		 560 }
561
24f412dd 562 isert_dbg("Creating conn %p fastreg pool size=%d",
a3a5a826 563 isert_conn, isert_conn->conn_fr_pool_size);
59464ef4
VP		 564
565 return 0;
566
567err:
a3a5a826 568 isert_conn_free_fastreg_pool(isert_conn);
59464ef4
VP		 569 return ret;
570}
571
b8d26b3b
NB		 572static int
573isert_connect_request(struct rdma_cm_id *cma_id, struct rdma_cm_event *event)
574{
ca6c1d82
SG		 575 struct isert_np *isert_np = cma_id->context;
576 struct iscsi_np *np = isert_np->np;
b8d26b3b
NB		 577 struct isert_conn *isert_conn;
578 struct isert_device *device;
579 struct ib_device *ib_dev = cma_id->device;
580 int ret = 0;
14f4b54f
SG		 581
582 spin_lock_bh(&np->np_thread_lock);
583 if (!np->enabled) {
584 spin_unlock_bh(&np->np_thread_lock);
24f412dd 585 isert_dbg("iscsi_np is not enabled, reject connect request\n");
14f4b54f
SG		 586 return rdma_reject(cma_id, NULL, 0);
587 }
588 spin_unlock_bh(&np->np_thread_lock);
b8d26b3b 589
4c22e07f 590 isert_dbg("cma_id: %p, portal: %p\n",
b8d26b3b
NB		 591 cma_id, cma_id->context);
592
593 isert_conn = kzalloc(sizeof(struct isert_conn), GFP_KERNEL);
594 if (!isert_conn) {
24f412dd 595 isert_err("Unable to allocate isert_conn\n");
b8d26b3b
NB		 596 return -ENOMEM;
597 }
598 isert_conn->state = ISER_CONN_INIT;
599 INIT_LIST_HEAD(&isert_conn->conn_accept_node);
600 init_completion(&isert_conn->conn_login_comp);
2371e5da 601 init_completion(&isert_conn->login_req_comp);
defd8848 602 init_completion(&isert_conn->conn_wait);
b8d26b3b 603 kref_init(&isert_conn->conn_kref);
b2cb9649 604 mutex_init(&isert_conn->conn_mutex);
59464ef4 605 spin_lock_init(&isert_conn->conn_lock);
f46d6a8a 606 INIT_LIST_HEAD(&isert_conn->conn_fr_pool);
b8d26b3b 607
b8d26b3b 608 isert_conn->conn_cm_id = cma_id;
b8d26b3b
NB		 609
610 isert_conn->login_buf = kzalloc(ISCSI_DEF_MAX_RECV_SEG_LEN +
611 ISER_RX_LOGIN_SIZE, GFP_KERNEL);
612 if (!isert_conn->login_buf) {
24f412dd 613 isert_err("Unable to allocate isert_conn->login_buf\n");
b8d26b3b
NB		 614 ret = -ENOMEM;
615 goto out;
616 }
617
618 isert_conn->login_req_buf = isert_conn->login_buf;
619 isert_conn->login_rsp_buf = isert_conn->login_buf +
620 ISCSI_DEF_MAX_RECV_SEG_LEN;
24f412dd 621 isert_dbg("Set login_buf: %p login_req_buf: %p login_rsp_buf: %p\n",
b8d26b3b
NB		 622 isert_conn->login_buf, isert_conn->login_req_buf,
623 isert_conn->login_rsp_buf);
624
625 isert_conn->login_req_dma = ib_dma_map_single(ib_dev,
626 (void *)isert_conn->login_req_buf,
627 ISCSI_DEF_MAX_RECV_SEG_LEN, DMA_FROM_DEVICE);
628
629 ret = ib_dma_mapping_error(ib_dev, isert_conn->login_req_dma);
630 if (ret) {
24f412dd 631 isert_err("ib_dma_mapping_error failed for login_req_dma: %d\n",
b8d26b3b
NB		 632 ret);
633 isert_conn->login_req_dma = 0;
634 goto out_login_buf;
635 }
636
637 isert_conn->login_rsp_dma = ib_dma_map_single(ib_dev,
638 (void *)isert_conn->login_rsp_buf,
639 ISER_RX_LOGIN_SIZE, DMA_TO_DEVICE);
640
641 ret = ib_dma_mapping_error(ib_dev, isert_conn->login_rsp_dma);
642 if (ret) {
24f412dd 643 isert_err("ib_dma_mapping_error failed for login_rsp_dma: %d\n",
b8d26b3b
NB		 644 ret);
645 isert_conn->login_rsp_dma = 0;
646 goto out_req_dma_map;
647 }
648
649 device = isert_device_find_by_ib_dev(cma_id);
650 if (IS_ERR(device)) {
651 ret = PTR_ERR(device);
652 goto out_rsp_dma_map;
653 }
654
1a92e17e
SG		 655 /* Set max inflight RDMA READ requests */
656 isert_conn->initiator_depth = min_t(u8,
657 event->param.conn.initiator_depth,
658 device->dev_attr.max_qp_init_rd_atom);
24f412dd 659 isert_dbg("Using initiator_depth: %u\n", isert_conn->initiator_depth);
1a92e17e 660
b8d26b3b 661 isert_conn->conn_device = device;
eb6ab132
SG		 662 isert_conn->conn_pd = ib_alloc_pd(isert_conn->conn_device->ib_device);
663 if (IS_ERR(isert_conn->conn_pd)) {
664 ret = PTR_ERR(isert_conn->conn_pd);
24f412dd 665 isert_err("ib_alloc_pd failed for conn %p: ret=%d\n",
eb6ab132
SG		 666 isert_conn, ret);
667 goto out_pd;
668 }
b8d26b3b 669
eb6ab132
SG		 670 isert_conn->conn_mr = ib_get_dma_mr(isert_conn->conn_pd,
671 IB_ACCESS_LOCAL_WRITE);
672 if (IS_ERR(isert_conn->conn_mr)) {
673 ret = PTR_ERR(isert_conn->conn_mr);
24f412dd 674 isert_err("ib_get_dma_mr failed for conn %p: ret=%d\n",
eb6ab132
SG		 675 isert_conn, ret);
676 goto out_mr;
677 }
b8d26b3b 678
570db170 679 ret = isert_conn_setup_qp(isert_conn, cma_id);
b8d26b3b
NB		 680 if (ret)
681 goto out_conn_dev;
682
2371e5da
SG		 683 ret = isert_rdma_post_recvl(isert_conn);
684 if (ret)
685 goto out_conn_dev;
686
687 ret = isert_rdma_accept(isert_conn);
688 if (ret)
689 goto out_conn_dev;
690
b8d26b3b 691 mutex_lock(&isert_np->np_accept_mutex);
9fe63c88 692 list_add_tail(&isert_conn->conn_accept_node, &isert_np->np_accept_list);
b8d26b3b
NB		 693 mutex_unlock(&isert_np->np_accept_mutex);
694
24f412dd 695 isert_info("np %p: Allow accept_np to continue\n", np);
531b7bf4 696 up(&isert_np->np_sem);
b8d26b3b
NB		 697 return 0;
698
699out_conn_dev:
eb6ab132
SG		 700 ib_dereg_mr(isert_conn->conn_mr);
701out_mr:
702 ib_dealloc_pd(isert_conn->conn_pd);
703out_pd:
b8d26b3b
NB		 704 isert_device_try_release(device);
705out_rsp_dma_map:
706 ib_dma_unmap_single(ib_dev, isert_conn->login_rsp_dma,
707 ISER_RX_LOGIN_SIZE, DMA_TO_DEVICE);
708out_req_dma_map:
709 ib_dma_unmap_single(ib_dev, isert_conn->login_req_dma,
710 ISCSI_DEF_MAX_RECV_SEG_LEN, DMA_FROM_DEVICE);
711out_login_buf:
712 kfree(isert_conn->login_buf);
713out:
714 kfree(isert_conn);
2371e5da 715 rdma_reject(cma_id, NULL, 0);
b8d26b3b
NB		 716 return ret;
717}
718
719static void
720isert_connect_release(struct isert_conn *isert_conn)
721{
722 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
723 struct isert_device *device = isert_conn->conn_device;
b8d26b3b 724
4c22e07f 725 isert_dbg("conn %p\n", isert_conn);
b8d26b3b 726
a3a5a826
SG		 727 if (device && device->use_fastreg)
728 isert_conn_free_fastreg_pool(isert_conn);
59464ef4 729
19e2090f
SG		 730 isert_free_rx_descriptors(isert_conn);
731 rdma_destroy_id(isert_conn->conn_cm_id);
732
b8d26b3b 733 if (isert_conn->conn_qp) {
4a295bae
SG		 734 struct isert_comp *comp = isert_conn->conn_qp->recv_cq->cq_context;
735
24f412dd 736 isert_dbg("dec completion context %p active_qps\n", comp);
19e2090f 737 mutex_lock(&device_list_mutex);
4a295bae 738 comp->active_qps--;
19e2090f 739 mutex_unlock(&device_list_mutex);
b8d26b3b 740
19e2090f 741 ib_destroy_qp(isert_conn->conn_qp);
b8d26b3b
NB		 742 }
743
eb6ab132
SG		 744 ib_dereg_mr(isert_conn->conn_mr);
745 ib_dealloc_pd(isert_conn->conn_pd);
746
b8d26b3b
NB		 747 if (isert_conn->login_buf) {
748 ib_dma_unmap_single(ib_dev, isert_conn->login_rsp_dma,
749 ISER_RX_LOGIN_SIZE, DMA_TO_DEVICE);
750 ib_dma_unmap_single(ib_dev, isert_conn->login_req_dma,
751 ISCSI_DEF_MAX_RECV_SEG_LEN,
752 DMA_FROM_DEVICE);
753 kfree(isert_conn->login_buf);
754 }
755 kfree(isert_conn);
756
757 if (device)
758 isert_device_try_release(device);
b8d26b3b
NB		 759}
760
761static void
762isert_connected_handler(struct rdma_cm_id *cma_id)
763{
19e2090f 764 struct isert_conn *isert_conn = cma_id->qp->qp_context;
c2f88b17 765
24f412dd 766 isert_info("conn %p\n", isert_conn);
128e9cc8 767
2371e5da 768 if (!kref_get_unless_zero(&isert_conn->conn_kref)) {
24f412dd 769 isert_warn("conn %p connect_release is running\n", isert_conn);
2371e5da
SG		 770 return;
771 }
772
773 mutex_lock(&isert_conn->conn_mutex);
774 if (isert_conn->state != ISER_CONN_FULL_FEATURE)
775 isert_conn->state = ISER_CONN_UP;
776 mutex_unlock(&isert_conn->conn_mutex);
b8d26b3b
NB		 777}
778
779static void
780isert_release_conn_kref(struct kref *kref)
781{
782 struct isert_conn *isert_conn = container_of(kref,
783 struct isert_conn, conn_kref);
784
4c22e07f
SG		 785 isert_info("conn %p final kref %s/%d\n", isert_conn, current->comm,
786 current->pid);
b8d26b3b
NB		 787
788 isert_connect_release(isert_conn);
789}
790
791static void
792isert_put_conn(struct isert_conn *isert_conn)
793{
794 kref_put(&isert_conn->conn_kref, isert_release_conn_kref);
795}
796
954f2372
SG		 797/**
798 * isert_conn_terminate() - Initiate connection termination
799 * @isert_conn: isert connection struct
800 *
801 * Notes:
128e9cc8 802 * In case the connection state is FULL_FEATURE, move state
954f2372 803 * to TEMINATING and start teardown sequence (rdma_disconnect).
128e9cc8 804 * In case the connection state is UP, complete flush as well.
954f2372
SG		 805 *
806 * This routine must be called with conn_mutex held. Thus it is
807 * safe to call multiple times.
808 */
809static void
810isert_conn_terminate(struct isert_conn *isert_conn)
811{
812 int err;
813
128e9cc8
SG		 814 switch (isert_conn->state) {
815 case ISER_CONN_TERMINATING:
816 break;
817 case ISER_CONN_UP:
128e9cc8 818 case ISER_CONN_FULL_FEATURE: /* FALLTHRU */
24f412dd 819 isert_info("Terminating conn %p state %d\n",
954f2372 820 isert_conn, isert_conn->state);
128e9cc8 821 isert_conn->state = ISER_CONN_TERMINATING;
954f2372
SG		 822 err = rdma_disconnect(isert_conn->conn_cm_id);
823 if (err)
24f412dd 824 isert_warn("Failed rdma_disconnect isert_conn %p\n",
954f2372 825 isert_conn);
128e9cc8
SG		 826 break;
827 default:
24f412dd 828 isert_warn("conn %p teminating in state %d\n",
128e9cc8 829 isert_conn, isert_conn->state);
954f2372
SG		 830 }
831}
832
3b726ae2 833static int
ca6c1d82
SG		 834isert_np_cma_handler(struct isert_np *isert_np,
835 enum rdma_cm_event_type event)
b8d26b3b 836{
24f412dd 837 isert_dbg("isert np %p, handling event %d\n", isert_np, event);
3b726ae2 838
ca6c1d82
SG		 839 switch (event) {
840 case RDMA_CM_EVENT_DEVICE_REMOVAL:
3b726ae2 841 isert_np->np_cm_id = NULL;
ca6c1d82
SG		 842 break;
843 case RDMA_CM_EVENT_ADDR_CHANGE:
844 isert_np->np_cm_id = isert_setup_id(isert_np);
845 if (IS_ERR(isert_np->np_cm_id)) {
24f412dd
SG		 846 isert_err("isert np %p setup id failed: %ld\n",
847 isert_np, PTR_ERR(isert_np->np_cm_id));
ca6c1d82
SG		 848 isert_np->np_cm_id = NULL;
849 }
850 break;
851 default:
24f412dd 852 isert_err("isert np %p Unexpected event %d\n",
ca6c1d82 853 isert_np, event);
3b726ae2
SG		 854 }
855
ca6c1d82
SG		 856 return -1;
857}
858
859static int
860isert_disconnected_handler(struct rdma_cm_id *cma_id,
861 enum rdma_cm_event_type event)
862{
863 struct isert_np *isert_np = cma_id->context;
864 struct isert_conn *isert_conn;
865
866 if (isert_np->np_cm_id == cma_id)
867 return isert_np_cma_handler(cma_id->context, event);
868
19e2090f 869 isert_conn = cma_id->qp->qp_context;
b8d26b3b 870
128e9cc8
SG		 871 mutex_lock(&isert_conn->conn_mutex);
872 isert_conn_terminate(isert_conn);
873 mutex_unlock(&isert_conn->conn_mutex);
874
24f412dd 875 isert_info("conn %p completing conn_wait\n", isert_conn);
128e9cc8 876 complete(&isert_conn->conn_wait);
3b726ae2
SG		 877
878 return 0;
b8d26b3b
NB		 879}
880
954f2372
SG		 881static void
882isert_connect_error(struct rdma_cm_id *cma_id)
883{
19e2090f 884 struct isert_conn *isert_conn = cma_id->qp->qp_context;
954f2372
SG		 885
886 isert_put_conn(isert_conn);
887}
888
b8d26b3b
NB		 889static int
890isert_cma_handler(struct rdma_cm_id *cma_id, struct rdma_cm_event *event)
891{
892 int ret = 0;
893
4c22e07f
SG		 894 isert_info("event %d status %d id %p np %p\n", event->event,
895 event->status, cma_id, cma_id->context);
b8d26b3b
NB		 896
897 switch (event->event) {
898 case RDMA_CM_EVENT_CONNECT_REQUEST:
b8d26b3b 899 ret = isert_connect_request(cma_id, event);
3b726ae2 900 if (ret)
4c22e07f 901 isert_err("failed handle connect request %d\n", ret);
b8d26b3b
NB		 902 break;
903 case RDMA_CM_EVENT_ESTABLISHED:
b8d26b3b
NB		 904 isert_connected_handler(cma_id);
905 break;
88c4015f
SG		 906 case RDMA_CM_EVENT_ADDR_CHANGE: /* FALLTHRU */
907 case RDMA_CM_EVENT_DISCONNECTED: /* FALLTHRU */
908 case RDMA_CM_EVENT_DEVICE_REMOVAL: /* FALLTHRU */
88c4015f 909 case RDMA_CM_EVENT_TIMEWAIT_EXIT: /* FALLTHRU */
ca6c1d82 910 ret = isert_disconnected_handler(cma_id, event->event);
b8d26b3b 911 break;
954f2372
SG		 912 case RDMA_CM_EVENT_REJECTED: /* FALLTHRU */
913 case RDMA_CM_EVENT_UNREACHABLE: /* FALLTHRU */
b8d26b3b 914 case RDMA_CM_EVENT_CONNECT_ERROR:
954f2372
SG		 915 isert_connect_error(cma_id);
916 break;
b8d26b3b 917 default:
24f412dd 918 isert_err("Unhandled RDMA CMA event: %d\n", event->event);
b8d26b3b
NB		 919 break;
920 }
921
b8d26b3b
NB		 922 return ret;
923}
924
925static int
926isert_post_recv(struct isert_conn *isert_conn, u32 count)
927{
928 struct ib_recv_wr *rx_wr, *rx_wr_failed;
929 int i, ret;
930 unsigned int rx_head = isert_conn->conn_rx_desc_head;
931 struct iser_rx_desc *rx_desc;
932
933 for (rx_wr = isert_conn->conn_rx_wr, i = 0; i < count; i++, rx_wr++) {
934 rx_desc = &isert_conn->conn_rx_descs[rx_head];
b0a191e7 935 rx_wr->wr_id = (uintptr_t)rx_desc;
b8d26b3b
NB		 936 rx_wr->sg_list = &rx_desc->rx_sg;
937 rx_wr->num_sge = 1;
938 rx_wr->next = rx_wr + 1;
939 rx_head = (rx_head + 1) & (ISERT_QP_MAX_RECV_DTOS - 1);
940 }
941
942 rx_wr--;
943 rx_wr->next = NULL; /* mark end of work requests list */
944
945 isert_conn->post_recv_buf_count += count;
946 ret = ib_post_recv(isert_conn->conn_qp, isert_conn->conn_rx_wr,
947 &rx_wr_failed);
948 if (ret) {
24f412dd 949 isert_err("ib_post_recv() failed with ret: %d\n", ret);
b8d26b3b
NB		 950 isert_conn->post_recv_buf_count -= count;
951 } else {
24f412dd 952 isert_dbg("isert_post_recv(): Posted %d RX buffers\n", count);
b8d26b3b
NB		 953 isert_conn->conn_rx_desc_head = rx_head;
954 }
955 return ret;
956}
957
958static int
959isert_post_send(struct isert_conn *isert_conn, struct iser_tx_desc *tx_desc)
960{
961 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
962 struct ib_send_wr send_wr, *send_wr_failed;
963 int ret;
964
965 ib_dma_sync_single_for_device(ib_dev, tx_desc->dma_addr,
966 ISER_HEADERS_LEN, DMA_TO_DEVICE);
967
968 send_wr.next = NULL;
b0a191e7 969 send_wr.wr_id = (uintptr_t)tx_desc;
b8d26b3b
NB		 970 send_wr.sg_list = tx_desc->tx_sg;
971 send_wr.num_sge = tx_desc->num_sge;
972 send_wr.opcode = IB_WR_SEND;
973 send_wr.send_flags = IB_SEND_SIGNALED;
974
b8d26b3b 975 ret = ib_post_send(isert_conn->conn_qp, &send_wr, &send_wr_failed);
bdf20e72 976 if (ret)
24f412dd 977 isert_err("ib_post_send() failed, ret: %d\n", ret);
b8d26b3b
NB		 978
979 return ret;
980}
981
982static void
983isert_create_send_desc(struct isert_conn *isert_conn,
984 struct isert_cmd *isert_cmd,
985 struct iser_tx_desc *tx_desc)
986{
987 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
988
989 ib_dma_sync_single_for_cpu(ib_dev, tx_desc->dma_addr,
990 ISER_HEADERS_LEN, DMA_TO_DEVICE);
991
992 memset(&tx_desc->iser_header, 0, sizeof(struct iser_hdr));
993 tx_desc->iser_header.flags = ISER_VER;
994
995 tx_desc->num_sge = 1;
996 tx_desc->isert_cmd = isert_cmd;
997
998 if (tx_desc->tx_sg[0].lkey != isert_conn->conn_mr->lkey) {
999 tx_desc->tx_sg[0].lkey = isert_conn->conn_mr->lkey;
24f412dd 1000 isert_dbg("tx_desc %p lkey mismatch, fixing\n", tx_desc);
b8d26b3b
NB		 1001 }
1002}
1003
1004static int
1005isert_init_tx_hdrs(struct isert_conn *isert_conn,
1006 struct iser_tx_desc *tx_desc)
1007{
1008 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
1009 u64 dma_addr;
1010
1011 dma_addr = ib_dma_map_single(ib_dev, (void *)tx_desc,
1012 ISER_HEADERS_LEN, DMA_TO_DEVICE);
1013 if (ib_dma_mapping_error(ib_dev, dma_addr)) {
24f412dd 1014 isert_err("ib_dma_mapping_error() failed\n");
b8d26b3b
NB		 1015 return -ENOMEM;
1016 }
1017
1018 tx_desc->dma_addr = dma_addr;
1019 tx_desc->tx_sg[0].addr = tx_desc->dma_addr;
1020 tx_desc->tx_sg[0].length = ISER_HEADERS_LEN;
1021 tx_desc->tx_sg[0].lkey = isert_conn->conn_mr->lkey;
1022
4c22e07f
SG		 1023 isert_dbg("Setup tx_sg[0].addr: 0x%llx length: %u lkey: 0x%x\n",
1024 tx_desc->tx_sg[0].addr, tx_desc->tx_sg[0].length,
1025 tx_desc->tx_sg[0].lkey);
b8d26b3b
NB		 1026
1027 return 0;
1028}
1029
1030static void
95b60f07 1031isert_init_send_wr(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd,
68a86dee 1032 struct ib_send_wr *send_wr)
b8d26b3b 1033{
95b60f07
NB		 1034 struct iser_tx_desc *tx_desc = &isert_cmd->tx_desc;
1035
b8d26b3b 1036 isert_cmd->rdma_wr.iser_ib_op = ISER_IB_SEND;
b0a191e7 1037 send_wr->wr_id = (uintptr_t)&isert_cmd->tx_desc;
b8d26b3b 1038 send_wr->opcode = IB_WR_SEND;
95b60f07 1039 send_wr->sg_list = &tx_desc->tx_sg[0];
b8d26b3b 1040 send_wr->num_sge = isert_cmd->tx_desc.num_sge;
95b60f07 1041 send_wr->send_flags = IB_SEND_SIGNALED;
b8d26b3b
NB		 1042}
1043
1044static int
1045isert_rdma_post_recvl(struct isert_conn *isert_conn)
1046{
1047 struct ib_recv_wr rx_wr, *rx_wr_fail;
1048 struct ib_sge sge;
1049 int ret;
1050
1051 memset(&sge, 0, sizeof(struct ib_sge));
1052 sge.addr = isert_conn->login_req_dma;
1053 sge.length = ISER_RX_LOGIN_SIZE;
1054 sge.lkey = isert_conn->conn_mr->lkey;
1055
24f412dd 1056 isert_dbg("Setup sge: addr: %llx length: %d 0x%08x\n",
b8d26b3b
NB		 1057 sge.addr, sge.length, sge.lkey);
1058
1059 memset(&rx_wr, 0, sizeof(struct ib_recv_wr));
b0a191e7 1060 rx_wr.wr_id = (uintptr_t)isert_conn->login_req_buf;
b8d26b3b
NB		 1061 rx_wr.sg_list = &sge;
1062 rx_wr.num_sge = 1;
1063
1064 isert_conn->post_recv_buf_count++;
1065 ret = ib_post_recv(isert_conn->conn_qp, &rx_wr, &rx_wr_fail);
1066 if (ret) {
24f412dd 1067 isert_err("ib_post_recv() failed: %d\n", ret);
b8d26b3b
NB		 1068 isert_conn->post_recv_buf_count--;
1069 }
1070
b8d26b3b
NB		 1071 return ret;
1072}
1073
1074static int
1075isert_put_login_tx(struct iscsi_conn *conn, struct iscsi_login *login,
1076 u32 length)
1077{
1078 struct isert_conn *isert_conn = conn->context;
1079 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
1080 struct iser_tx_desc *tx_desc = &isert_conn->conn_login_tx_desc;
1081 int ret;
1082
1083 isert_create_send_desc(isert_conn, NULL, tx_desc);
1084
1085 memcpy(&tx_desc->iscsi_header, &login->rsp[0],
1086 sizeof(struct iscsi_hdr));
1087
1088 isert_init_tx_hdrs(isert_conn, tx_desc);
1089
1090 if (length > 0) {
1091 struct ib_sge *tx_dsg = &tx_desc->tx_sg[1];
1092
1093 ib_dma_sync_single_for_cpu(ib_dev, isert_conn->login_rsp_dma,
1094 length, DMA_TO_DEVICE);
1095
1096 memcpy(isert_conn->login_rsp_buf, login->rsp_buf, length);
1097
1098 ib_dma_sync_single_for_device(ib_dev, isert_conn->login_rsp_dma,
1099 length, DMA_TO_DEVICE);
1100
1101 tx_dsg->addr = isert_conn->login_rsp_dma;
1102 tx_dsg->length = length;
1103 tx_dsg->lkey = isert_conn->conn_mr->lkey;
1104 tx_desc->num_sge = 2;
1105 }
1106 if (!login->login_failed) {
1107 if (login->login_complete) {
e0546fc1
SG		 1108 if (!conn->sess->sess_ops->SessionType &&
1109 isert_conn->conn_device->use_fastreg) {
570db170 1110 ret = isert_conn_create_fastreg_pool(isert_conn);
f46d6a8a 1111 if (ret) {
24f412dd 1112 isert_err("Conn: %p failed to create"
f46d6a8a
NB		 1113 " fastreg pool\n", isert_conn);
1114 return ret;
1115 }
1116 }
1117
b8d26b3b
NB		 1118 ret = isert_alloc_rx_descriptors(isert_conn);
1119 if (ret)
1120 return ret;
1121
1122 ret = isert_post_recv(isert_conn, ISERT_MIN_POSTED_RX);
1123 if (ret)
1124 return ret;
1125
128e9cc8 1126 /* Now we are in FULL_FEATURE phase */
2371e5da 1127 mutex_lock(&isert_conn->conn_mutex);
128e9cc8 1128 isert_conn->state = ISER_CONN_FULL_FEATURE;
2371e5da 1129 mutex_unlock(&isert_conn->conn_mutex);
b8d26b3b
NB		 1130 goto post_send;
1131 }
1132
1133 ret = isert_rdma_post_recvl(isert_conn);
1134 if (ret)
1135 return ret;
1136 }
1137post_send:
1138 ret = isert_post_send(isert_conn, tx_desc);
1139 if (ret)
1140 return ret;
1141
1142 return 0;
1143}
1144
1145static void
2371e5da 1146isert_rx_login_req(struct isert_conn *isert_conn)
b8d26b3b 1147{
2371e5da
SG		 1148 struct iser_rx_desc *rx_desc = (void *)isert_conn->login_req_buf;
1149 int rx_buflen = isert_conn->login_req_len;
b8d26b3b
NB		 1150 struct iscsi_conn *conn = isert_conn->conn;
1151 struct iscsi_login *login = conn->conn_login;
1152 int size;
1153
24f412dd 1154 isert_info("conn %p\n", isert_conn);
2371e5da
SG		 1155
1156 WARN_ON_ONCE(!login);
b8d26b3b
NB		 1157
1158 if (login->first_request) {
1159 struct iscsi_login_req *login_req =
1160 (struct iscsi_login_req *)&rx_desc->iscsi_header;
1161 /*
1162 * Setup the initial iscsi_login values from the leading
1163 * login request PDU.
1164 */
1165 login->leading_connection = (!login_req->tsih) ? 1 : 0;
1166 login->current_stage =
1167 (login_req->flags & ISCSI_FLAG_LOGIN_CURRENT_STAGE_MASK)
1168 >> 2;
1169 login->version_min = login_req->min_version;
1170 login->version_max = login_req->max_version;
1171 memcpy(login->isid, login_req->isid, 6);
1172 login->cmd_sn = be32_to_cpu(login_req->cmdsn);
1173 login->init_task_tag = login_req->itt;
1174 login->initial_exp_statsn = be32_to_cpu(login_req->exp_statsn);
1175 login->cid = be16_to_cpu(login_req->cid);
1176 login->tsih = be16_to_cpu(login_req->tsih);
1177 }
1178
1179 memcpy(&login->req[0], (void *)&rx_desc->iscsi_header, ISCSI_HDR_LEN);
1180
1181 size = min(rx_buflen, MAX_KEY_VALUE_PAIRS);
4c22e07f
SG		 1182 isert_dbg("Using login payload size: %d, rx_buflen: %d "
1183 "MAX_KEY_VALUE_PAIRS: %d\n", size, rx_buflen,
1184 MAX_KEY_VALUE_PAIRS);
b8d26b3b
NB		 1185 memcpy(login->req_buf, &rx_desc->data[0], size);
1186
6faaa85f
NB		 1187 if (login->first_request) {
1188 complete(&isert_conn->conn_login_comp);
1189 return;
1190 }
1191 schedule_delayed_work(&conn->login_work, 0);
b8d26b3b
NB		 1192}
1193
b8d26b3b 1194static struct iscsi_cmd
676687c6 1195*isert_allocate_cmd(struct iscsi_conn *conn)
b8d26b3b
NB		 1196{
1197 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
1198 struct isert_cmd *isert_cmd;
d703ce2f 1199 struct iscsi_cmd *cmd;
b8d26b3b 1200
676687c6 1201 cmd = iscsit_allocate_cmd(conn, TASK_INTERRUPTIBLE);
d703ce2f 1202 if (!cmd) {
24f412dd 1203 isert_err("Unable to allocate iscsi_cmd + isert_cmd\n");
b8d26b3b
NB		 1204 return NULL;
1205 }
d703ce2f 1206 isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b 1207 isert_cmd->conn = isert_conn;
d703ce2f 1208 isert_cmd->iscsi_cmd = cmd;
b8d26b3b 1209
d703ce2f 1210 return cmd;
b8d26b3b
NB		 1211}
1212
1213static int
1214isert_handle_scsi_cmd(struct isert_conn *isert_conn,
d703ce2f
NB		 1215 struct isert_cmd *isert_cmd, struct iscsi_cmd *cmd,
1216 struct iser_rx_desc *rx_desc, unsigned char *buf)
b8d26b3b 1217{
b8d26b3b
NB		 1218 struct iscsi_conn *conn = isert_conn->conn;
1219 struct iscsi_scsi_req *hdr = (struct iscsi_scsi_req *)buf;
1220 struct scatterlist *sg;
1221 int imm_data, imm_data_len, unsol_data, sg_nents, rc;
1222 bool dump_payload = false;
1223
1224 rc = iscsit_setup_scsi_cmd(conn, cmd, buf);
1225 if (rc < 0)
1226 return rc;
1227
1228 imm_data = cmd->immediate_data;
1229 imm_data_len = cmd->first_burst_len;
1230 unsol_data = cmd->unsolicited_data;
1231
1232 rc = iscsit_process_scsi_cmd(conn, cmd, hdr);
1233 if (rc < 0) {
1234 return 0;
1235 } else if (rc > 0) {
1236 dump_payload = true;
1237 goto sequence_cmd;
1238 }
1239
1240 if (!imm_data)
1241 return 0;
1242
1243 sg = &cmd->se_cmd.t_data_sg[0];
1244 sg_nents = max(1UL, DIV_ROUND_UP(imm_data_len, PAGE_SIZE));
1245
24f412dd 1246 isert_dbg("Copying Immediate SG: %p sg_nents: %u from %p imm_data_len: %d\n",
4c22e07f 1247 sg, sg_nents, &rx_desc->data[0], imm_data_len);
b8d26b3b
NB		 1248
1249 sg_copy_from_buffer(sg, sg_nents, &rx_desc->data[0], imm_data_len);
1250
1251 cmd->write_data_done += imm_data_len;
1252
1253 if (cmd->write_data_done == cmd->se_cmd.data_length) {
1254 spin_lock_bh(&cmd->istate_lock);
1255 cmd->cmd_flags |= ICF_GOT_LAST_DATAOUT;
1256 cmd->i_state = ISTATE_RECEIVED_LAST_DATAOUT;
1257 spin_unlock_bh(&cmd->istate_lock);
1258 }
1259
1260sequence_cmd:
561bf158 1261 rc = iscsit_sequence_cmd(conn, cmd, buf, hdr->cmdsn);
b8d26b3b
NB		 1262
1263 if (!rc && dump_payload == false && unsol_data)
1264 iscsit_set_unsoliticed_dataout(cmd);
6cc44a6f
NB		 1265 else if (dump_payload && imm_data)
1266 target_put_sess_cmd(conn->sess->se_sess, &cmd->se_cmd);
b8d26b3b 1267
b8d26b3b
NB		 1268 return 0;
1269}
1270
1271static int
1272isert_handle_iscsi_dataout(struct isert_conn *isert_conn,
1273 struct iser_rx_desc *rx_desc, unsigned char *buf)
1274{
1275 struct scatterlist *sg_start;
1276 struct iscsi_conn *conn = isert_conn->conn;
1277 struct iscsi_cmd *cmd = NULL;
1278 struct iscsi_data *hdr = (struct iscsi_data *)buf;
1279 u32 unsol_data_len = ntoh24(hdr->dlength);
1280 int rc, sg_nents, sg_off, page_off;
1281
1282 rc = iscsit_check_dataout_hdr(conn, buf, &cmd);
1283 if (rc < 0)
1284 return rc;
1285 else if (!cmd)
1286 return 0;
1287 /*
1288 * FIXME: Unexpected unsolicited_data out
1289 */
1290 if (!cmd->unsolicited_data) {
24f412dd 1291 isert_err("Received unexpected solicited data payload\n");
b8d26b3b
NB		 1292 dump_stack();
1293 return -1;
1294 }
1295
4c22e07f
SG		 1296 isert_dbg("Unsolicited DataOut unsol_data_len: %u, "
1297 "write_data_done: %u, data_length: %u\n",
1298 unsol_data_len, cmd->write_data_done,
1299 cmd->se_cmd.data_length);
b8d26b3b
NB		 1300
1301 sg_off = cmd->write_data_done / PAGE_SIZE;
1302 sg_start = &cmd->se_cmd.t_data_sg[sg_off];
1303 sg_nents = max(1UL, DIV_ROUND_UP(unsol_data_len, PAGE_SIZE));
1304 page_off = cmd->write_data_done % PAGE_SIZE;
1305 /*
1306 * FIXME: Non page-aligned unsolicited_data out
1307 */
1308 if (page_off) {
4c22e07f 1309 isert_err("unexpected non-page aligned data payload\n");
b8d26b3b
NB		 1310 dump_stack();
1311 return -1;
1312 }
4c22e07f
SG		 1313 isert_dbg("Copying DataOut: sg_start: %p, sg_off: %u "
1314 "sg_nents: %u from %p %u\n", sg_start, sg_off,
1315 sg_nents, &rx_desc->data[0], unsol_data_len);
b8d26b3b
NB		 1316
1317 sg_copy_from_buffer(sg_start, sg_nents, &rx_desc->data[0],
1318 unsol_data_len);
1319
1320 rc = iscsit_check_dataout_payload(cmd, hdr, false);
1321 if (rc < 0)
1322 return rc;
1323
1324 return 0;
1325}
1326
778de368
NB		 1327static int
1328isert_handle_nop_out(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd,
d703ce2f
NB		 1329 struct iscsi_cmd *cmd, struct iser_rx_desc *rx_desc,
1330 unsigned char *buf)
778de368 1331{
778de368
NB		 1332 struct iscsi_conn *conn = isert_conn->conn;
1333 struct iscsi_nopout *hdr = (struct iscsi_nopout *)buf;
1334 int rc;
1335
1336 rc = iscsit_setup_nop_out(conn, cmd, hdr);
1337 if (rc < 0)
1338 return rc;
1339 /*
1340 * FIXME: Add support for NOPOUT payload using unsolicited RDMA payload
1341 */
1342
1343 return iscsit_process_nop_out(conn, cmd, hdr);
1344}
1345
adb54c29
NB		 1346static int
1347isert_handle_text_cmd(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd,
d703ce2f
NB		 1348 struct iscsi_cmd *cmd, struct iser_rx_desc *rx_desc,
1349 struct iscsi_text *hdr)
adb54c29 1350{
adb54c29
NB		 1351 struct iscsi_conn *conn = isert_conn->conn;
1352 u32 payload_length = ntoh24(hdr->dlength);
1353 int rc;
1354 unsigned char *text_in;
1355
1356 rc = iscsit_setup_text_cmd(conn, cmd, hdr);
1357 if (rc < 0)
1358 return rc;
1359
1360 text_in = kzalloc(payload_length, GFP_KERNEL);
1361 if (!text_in) {
24f412dd 1362 isert_err("Unable to allocate text_in of payload_length: %u\n",
4c22e07f 1363 payload_length);
adb54c29
NB		 1364 return -ENOMEM;
1365 }
1366 cmd->text_in_ptr = text_in;
1367
1368 memcpy(cmd->text_in_ptr, &rx_desc->data[0], payload_length);
1369
1370 return iscsit_process_text_cmd(conn, cmd, hdr);
1371}
1372
b8d26b3b
NB		 1373static int
1374isert_rx_opcode(struct isert_conn *isert_conn, struct iser_rx_desc *rx_desc,
1375 uint32_t read_stag, uint64_t read_va,
1376 uint32_t write_stag, uint64_t write_va)
1377{
1378 struct iscsi_hdr *hdr = &rx_desc->iscsi_header;
1379 struct iscsi_conn *conn = isert_conn->conn;
ca40d24e 1380 struct iscsi_session *sess = conn->sess;
b8d26b3b
NB		 1381 struct iscsi_cmd *cmd;
1382 struct isert_cmd *isert_cmd;
1383 int ret = -EINVAL;
1384 u8 opcode = (hdr->opcode & ISCSI_OPCODE_MASK);
1385
ca40d24e
NB		 1386 if (sess->sess_ops->SessionType &&
1387 (!(opcode & ISCSI_OP_TEXT) || !(opcode & ISCSI_OP_LOGOUT))) {
24f412dd 1388 isert_err("Got illegal opcode: 0x%02x in SessionType=Discovery,"
4c22e07f 1389 " ignoring\n", opcode);
ca40d24e
NB		 1390 return 0;
1391 }
1392
b8d26b3b
NB		 1393 switch (opcode) {
1394 case ISCSI_OP_SCSI_CMD:
676687c6 1395 cmd = isert_allocate_cmd(conn);
b8d26b3b
NB		 1396 if (!cmd)
1397 break;
1398
d703ce2f 1399 isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 1400 isert_cmd->read_stag = read_stag;
1401 isert_cmd->read_va = read_va;
1402 isert_cmd->write_stag = write_stag;
1403 isert_cmd->write_va = write_va;
1404
d703ce2f 1405 ret = isert_handle_scsi_cmd(isert_conn, isert_cmd, cmd,
b8d26b3b
NB		 1406 rx_desc, (unsigned char *)hdr);
1407 break;
1408 case ISCSI_OP_NOOP_OUT:
676687c6 1409 cmd = isert_allocate_cmd(conn);
b8d26b3b
NB		 1410 if (!cmd)
1411 break;
1412
d703ce2f
NB		 1413 isert_cmd = iscsit_priv_cmd(cmd);
1414 ret = isert_handle_nop_out(isert_conn, isert_cmd, cmd,
778de368 1415 rx_desc, (unsigned char *)hdr);
b8d26b3b
NB		 1416 break;
1417 case ISCSI_OP_SCSI_DATA_OUT:
1418 ret = isert_handle_iscsi_dataout(isert_conn, rx_desc,
1419 (unsigned char *)hdr);
1420 break;
1421 case ISCSI_OP_SCSI_TMFUNC:
676687c6 1422 cmd = isert_allocate_cmd(conn);
b8d26b3b
NB		 1423 if (!cmd)
1424 break;
1425
1426 ret = iscsit_handle_task_mgt_cmd(conn, cmd,
1427 (unsigned char *)hdr);
1428 break;
1429 case ISCSI_OP_LOGOUT:
676687c6 1430 cmd = isert_allocate_cmd(conn);
b8d26b3b
NB		 1431 if (!cmd)
1432 break;
1433
1434 ret = iscsit_handle_logout_cmd(conn, cmd, (unsigned char *)hdr);
b8d26b3b 1435 break;
adb54c29 1436 case ISCSI_OP_TEXT:
676687c6 1437 cmd = isert_allocate_cmd(conn);
adb54c29
NB		 1438 if (!cmd)
1439 break;
1440
d703ce2f
NB		 1441 isert_cmd = iscsit_priv_cmd(cmd);
1442 ret = isert_handle_text_cmd(isert_conn, isert_cmd, cmd,
adb54c29
NB		 1443 rx_desc, (struct iscsi_text *)hdr);
1444 break;
b8d26b3b 1445 default:
24f412dd 1446 isert_err("Got unknown iSCSI OpCode: 0x%02x\n", opcode);
b8d26b3b
NB		 1447 dump_stack();
1448 break;
1449 }
1450
1451 return ret;
1452}
1453
1454static void
1455isert_rx_do_work(struct iser_rx_desc *rx_desc, struct isert_conn *isert_conn)
1456{
1457 struct iser_hdr *iser_hdr = &rx_desc->iser_header;
1458 uint64_t read_va = 0, write_va = 0;
1459 uint32_t read_stag = 0, write_stag = 0;
1460 int rc;
1461
1462 switch (iser_hdr->flags & 0xF0) {
1463 case ISCSI_CTRL:
1464 if (iser_hdr->flags & ISER_RSV) {
1465 read_stag = be32_to_cpu(iser_hdr->read_stag);
1466 read_va = be64_to_cpu(iser_hdr->read_va);
4c22e07f
SG		 1467 isert_dbg("ISER_RSV: read_stag: 0x%x read_va: 0x%llx\n",
1468 read_stag, (unsigned long long)read_va);
b8d26b3b
NB		 1469 }
1470 if (iser_hdr->flags & ISER_WSV) {
1471 write_stag = be32_to_cpu(iser_hdr->write_stag);
1472 write_va = be64_to_cpu(iser_hdr->write_va);
4c22e07f
SG		 1473 isert_dbg("ISER_WSV: write_stag: 0x%x write_va: 0x%llx\n",
1474 write_stag, (unsigned long long)write_va);
b8d26b3b
NB		 1475 }
1476
24f412dd 1477 isert_dbg("ISER ISCSI_CTRL PDU\n");
b8d26b3b
NB		 1478 break;
1479 case ISER_HELLO:
24f412dd 1480 isert_err("iSER Hello message\n");
b8d26b3b
NB		 1481 break;
1482 default:
24f412dd 1483 isert_warn("Unknown iSER hdr flags: 0x%02x\n", iser_hdr->flags);
b8d26b3b
NB		 1484 break;
1485 }
1486
1487 rc = isert_rx_opcode(isert_conn, rx_desc,
1488 read_stag, read_va, write_stag, write_va);
1489}
1490
1491static void
1492isert_rx_completion(struct iser_rx_desc *desc, struct isert_conn *isert_conn,
4a295bae 1493 u32 xfer_len)
b8d26b3b
NB		 1494{
1495 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
1496 struct iscsi_hdr *hdr;
1497 u64 rx_dma;
1498 int rx_buflen, outstanding;
1499
1500 if ((char *)desc == isert_conn->login_req_buf) {
1501 rx_dma = isert_conn->login_req_dma;
1502 rx_buflen = ISER_RX_LOGIN_SIZE;
4c22e07f 1503 isert_dbg("login_buf: Using rx_dma: 0x%llx, rx_buflen: %d\n",
b8d26b3b
NB		 1504 rx_dma, rx_buflen);
1505 } else {
1506 rx_dma = desc->dma_addr;
1507 rx_buflen = ISER_RX_PAYLOAD_SIZE;
4c22e07f 1508 isert_dbg("req_buf: Using rx_dma: 0x%llx, rx_buflen: %d\n",
b8d26b3b
NB		 1509 rx_dma, rx_buflen);
1510 }
1511
1512 ib_dma_sync_single_for_cpu(ib_dev, rx_dma, rx_buflen, DMA_FROM_DEVICE);
1513
1514 hdr = &desc->iscsi_header;
24f412dd 1515 isert_dbg("iSCSI opcode: 0x%02x, ITT: 0x%08x, flags: 0x%02x dlen: %d\n",
b8d26b3b
NB		 1516 hdr->opcode, hdr->itt, hdr->flags,
1517 (int)(xfer_len - ISER_HEADERS_LEN));
1518
2371e5da
SG		 1519 if ((char *)desc == isert_conn->login_req_buf) {
1520 isert_conn->login_req_len = xfer_len - ISER_HEADERS_LEN;
1521 if (isert_conn->conn) {
1522 struct iscsi_login *login = isert_conn->conn->conn_login;
1523
1524 if (login && !login->first_request)
1525 isert_rx_login_req(isert_conn);
1526 }
1527 mutex_lock(&isert_conn->conn_mutex);
1528 complete(&isert_conn->login_req_comp);
1529 mutex_unlock(&isert_conn->conn_mutex);
1530 } else {
b8d26b3b 1531 isert_rx_do_work(desc, isert_conn);
2371e5da 1532 }
b8d26b3b
NB		 1533
1534 ib_dma_sync_single_for_device(ib_dev, rx_dma, rx_buflen,
1535 DMA_FROM_DEVICE);
1536
1537 isert_conn->post_recv_buf_count--;
4c22e07f
SG		 1538 isert_dbg("Decremented post_recv_buf_count: %d\n",
1539 isert_conn->post_recv_buf_count);
b8d26b3b
NB		 1540
1541 if ((char *)desc == isert_conn->login_req_buf)
1542 return;
1543
1544 outstanding = isert_conn->post_recv_buf_count;
1545 if (outstanding + ISERT_MIN_POSTED_RX <= ISERT_QP_MAX_RECV_DTOS) {
1546 int err, count = min(ISERT_QP_MAX_RECV_DTOS - outstanding,
1547 ISERT_MIN_POSTED_RX);
1548 err = isert_post_recv(isert_conn, count);
1549 if (err) {
24f412dd 1550 isert_err("isert_post_recv() count: %d failed, %d\n",
b8d26b3b
NB		 1551 count, err);
1552 }
1553 }
1554}
1555
e3d7e4c3
SG		 1556static int
1557isert_map_data_buf(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd,
1558 struct scatterlist *sg, u32 nents, u32 length, u32 offset,
1559 enum iser_ib_op_code op, struct isert_data_buf *data)
1560{
1561 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
1562
1563 data->dma_dir = op == ISER_IB_RDMA_WRITE ?
1564 DMA_TO_DEVICE : DMA_FROM_DEVICE;
1565
1566 data->len = length - offset;
1567 data->offset = offset;
1568 data->sg_off = data->offset / PAGE_SIZE;
1569
1570 data->sg = &sg[data->sg_off];
1571 data->nents = min_t(unsigned int, nents - data->sg_off,
1572 ISCSI_ISER_SG_TABLESIZE);
1573 data->len = min_t(unsigned int, data->len, ISCSI_ISER_SG_TABLESIZE *
1574 PAGE_SIZE);
1575
1576 data->dma_nents = ib_dma_map_sg(ib_dev, data->sg, data->nents,
1577 data->dma_dir);
1578 if (unlikely(!data->dma_nents)) {
24f412dd 1579 isert_err("Cmd: unable to dma map SGs %p\n", sg);
e3d7e4c3
SG		 1580 return -EINVAL;
1581 }
1582
24f412dd 1583 isert_dbg("Mapped cmd: %p count: %u sg: %p sg_nents: %u rdma_len %d\n",
4c22e07f 1584 isert_cmd, data->dma_nents, data->sg, data->nents, data->len);
e3d7e4c3
SG		 1585
1586 return 0;
1587}
1588
1589static void
1590isert_unmap_data_buf(struct isert_conn *isert_conn, struct isert_data_buf *data)
1591{
1592 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
1593
1594 ib_dma_unmap_sg(ib_dev, data->sg, data->nents, data->dma_dir);
1595 memset(data, 0, sizeof(*data));
1596}
1597
1598
1599
b8d26b3b
NB		 1600static void
1601isert_unmap_cmd(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn)
1602{
1603 struct isert_rdma_wr *wr = &isert_cmd->rdma_wr;
b8d26b3b 1604
4c22e07f 1605 isert_dbg("Cmd %p\n", isert_cmd);
e3d7e4c3
SG		 1606
1607 if (wr->data.sg) {
4c22e07f 1608 isert_dbg("Cmd %p unmap_sg op\n", isert_cmd);
e3d7e4c3 1609 isert_unmap_data_buf(isert_conn, &wr->data);
b8d26b3b
NB		 1610 }
1611
90ecc6e2 1612 if (wr->send_wr) {
4c22e07f 1613 isert_dbg("Cmd %p free send_wr\n", isert_cmd);
90ecc6e2
VP		 1614 kfree(wr->send_wr);
1615 wr->send_wr = NULL;
1616 }
b8d26b3b 1617
90ecc6e2 1618 if (wr->ib_sge) {
4c22e07f 1619 isert_dbg("Cmd %p free ib_sge\n", isert_cmd);
90ecc6e2
VP		 1620 kfree(wr->ib_sge);
1621 wr->ib_sge = NULL;
1622 }
b8d26b3b
NB		 1623}
1624
59464ef4 1625static void
a3a5a826 1626isert_unreg_rdma(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn)
59464ef4
VP		 1627{
1628 struct isert_rdma_wr *wr = &isert_cmd->rdma_wr;
59464ef4
VP		 1629 LIST_HEAD(unmap_list);
1630
4c22e07f 1631 isert_dbg("Cmd %p\n", isert_cmd);
59464ef4
VP		 1632
1633 if (wr->fr_desc) {
4c22e07f 1634 isert_dbg("Cmd %p free fr_desc %p\n", isert_cmd, wr->fr_desc);
9e961ae7
SG		 1635 if (wr->fr_desc->ind & ISERT_PROTECTED) {
1636 isert_unmap_data_buf(isert_conn, &wr->prot);
1637 wr->fr_desc->ind &= ~ISERT_PROTECTED;
1638 }
59464ef4 1639 spin_lock_bh(&isert_conn->conn_lock);
a3a5a826 1640 list_add_tail(&wr->fr_desc->list, &isert_conn->conn_fr_pool);
59464ef4
VP		 1641 spin_unlock_bh(&isert_conn->conn_lock);
1642 wr->fr_desc = NULL;
1643 }
1644
e3d7e4c3 1645 if (wr->data.sg) {
4c22e07f 1646 isert_dbg("Cmd %p unmap_sg op\n", isert_cmd);
e3d7e4c3 1647 isert_unmap_data_buf(isert_conn, &wr->data);
59464ef4
VP		 1648 }
1649
1650 wr->ib_sge = NULL;
1651 wr->send_wr = NULL;
1652}
1653
b8d26b3b 1654static void
03e7848a 1655isert_put_cmd(struct isert_cmd *isert_cmd, bool comp_err)
b8d26b3b 1656{
d703ce2f 1657 struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd;
b8d26b3b 1658 struct isert_conn *isert_conn = isert_cmd->conn;
186a9647 1659 struct iscsi_conn *conn = isert_conn->conn;
d40945d8 1660 struct isert_device *device = isert_conn->conn_device;
b8d26b3b 1661
4c22e07f 1662 isert_dbg("Cmd %p\n", isert_cmd);
b8d26b3b
NB		 1663
1664 switch (cmd->iscsi_opcode) {
1665 case ISCSI_OP_SCSI_CMD:
b8d26b3b
NB		 1666 spin_lock_bh(&conn->cmd_lock);
1667 if (!list_empty(&cmd->i_conn_node))
5159d763 1668 list_del_init(&cmd->i_conn_node);
b8d26b3b
NB		 1669 spin_unlock_bh(&conn->cmd_lock);
1670
03e7848a 1671 if (cmd->data_direction == DMA_TO_DEVICE) {
b8d26b3b 1672 iscsit_stop_dataout_timer(cmd);
03e7848a
NB		 1673 /*
1674 * Check for special case during comp_err where
1675 * WRITE_PENDING has been handed off from core,
1676 * but requires an extra target_put_sess_cmd()
1677 * before transport_generic_free_cmd() below.
1678 */
1679 if (comp_err &&
1680 cmd->se_cmd.t_state == TRANSPORT_WRITE_PENDING) {
1681 struct se_cmd *se_cmd = &cmd->se_cmd;
1682
1683 target_put_sess_cmd(se_cmd->se_sess, se_cmd);
1684 }
1685 }
b8d26b3b 1686
d40945d8 1687 device->unreg_rdma_mem(isert_cmd, isert_conn);
186a9647
NB		 1688 transport_generic_free_cmd(&cmd->se_cmd, 0);
1689 break;
b8d26b3b 1690 case ISCSI_OP_SCSI_TMFUNC:
186a9647
NB		 1691 spin_lock_bh(&conn->cmd_lock);
1692 if (!list_empty(&cmd->i_conn_node))
5159d763 1693 list_del_init(&cmd->i_conn_node);
186a9647
NB		 1694 spin_unlock_bh(&conn->cmd_lock);
1695
b8d26b3b
NB		 1696 transport_generic_free_cmd(&cmd->se_cmd, 0);
1697 break;
1698 case ISCSI_OP_REJECT:
1699 case ISCSI_OP_NOOP_OUT:
adb54c29 1700 case ISCSI_OP_TEXT:
b8d26b3b
NB		 1701 spin_lock_bh(&conn->cmd_lock);
1702 if (!list_empty(&cmd->i_conn_node))
5159d763 1703 list_del_init(&cmd->i_conn_node);
b8d26b3b
NB		 1704 spin_unlock_bh(&conn->cmd_lock);
1705
1706 /*
1707 * Handle special case for REJECT when iscsi_add_reject*() has
1708 * overwritten the original iscsi_opcode assignment, and the
1709 * associated cmd->se_cmd needs to be released.
1710 */
1711 if (cmd->se_cmd.se_tfo != NULL) {
24f412dd 1712 isert_dbg("Calling transport_generic_free_cmd from"
3df8f68a
NB		 1713 " isert_put_cmd for 0x%02x\n",
1714 cmd->iscsi_opcode);
b8d26b3b
NB		 1715 transport_generic_free_cmd(&cmd->se_cmd, 0);
1716 break;
1717 }
1718 /*
1719 * Fall-through
1720 */
1721 default:
d703ce2f 1722 iscsit_release_cmd(cmd);
b8d26b3b
NB		 1723 break;
1724 }
1725}
1726
1727static void
1728isert_unmap_tx_desc(struct iser_tx_desc *tx_desc, struct ib_device *ib_dev)
1729{
1730 if (tx_desc->dma_addr != 0) {
4c22e07f 1731 isert_dbg("unmap single for tx_desc->dma_addr\n");
b8d26b3b
NB		 1732 ib_dma_unmap_single(ib_dev, tx_desc->dma_addr,
1733 ISER_HEADERS_LEN, DMA_TO_DEVICE);
1734 tx_desc->dma_addr = 0;
1735 }
1736}
1737
1738static void
1739isert_completion_put(struct iser_tx_desc *tx_desc, struct isert_cmd *isert_cmd,
03e7848a 1740 struct ib_device *ib_dev, bool comp_err)
b8d26b3b 1741{
dbbc5d11 1742 if (isert_cmd->pdu_buf_dma != 0) {
4c22e07f 1743 isert_dbg("unmap single for isert_cmd->pdu_buf_dma\n");
dbbc5d11
NB		 1744 ib_dma_unmap_single(ib_dev, isert_cmd->pdu_buf_dma,
1745 isert_cmd->pdu_buf_len, DMA_TO_DEVICE);
1746 isert_cmd->pdu_buf_dma = 0;
b8d26b3b
NB		 1747 }
1748
1749 isert_unmap_tx_desc(tx_desc, ib_dev);
03e7848a 1750 isert_put_cmd(isert_cmd, comp_err);
b8d26b3b
NB		 1751}
1752
96b7973e
SG		 1753static int
1754isert_check_pi_status(struct se_cmd *se_cmd, struct ib_mr *sig_mr)
1755{
1756 struct ib_mr_status mr_status;
1757 int ret;
1758
1759 ret = ib_check_mr_status(sig_mr, IB_MR_CHECK_SIG_STATUS, &mr_status);
1760 if (ret) {
24f412dd 1761 isert_err("ib_check_mr_status failed, ret %d\n", ret);
96b7973e
SG		 1762 goto fail_mr_status;
1763 }
1764
1765 if (mr_status.fail_status & IB_MR_CHECK_SIG_STATUS) {
1766 u64 sec_offset_err;
1767 u32 block_size = se_cmd->se_dev->dev_attrib.block_size + 8;
1768
1769 switch (mr_status.sig_err.err_type) {
1770 case IB_SIG_BAD_GUARD:
1771 se_cmd->pi_err = TCM_LOGICAL_BLOCK_GUARD_CHECK_FAILED;
1772 break;
1773 case IB_SIG_BAD_REFTAG:
1774 se_cmd->pi_err = TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED;
1775 break;
1776 case IB_SIG_BAD_APPTAG:
1777 se_cmd->pi_err = TCM_LOGICAL_BLOCK_APP_TAG_CHECK_FAILED;
1778 break;
1779 }
1780 sec_offset_err = mr_status.sig_err.sig_err_offset;
1781 do_div(sec_offset_err, block_size);
1782 se_cmd->bad_sector = sec_offset_err + se_cmd->t_task_lba;
1783
4c22e07f
SG		 1784 isert_err("PI error found type %d at sector 0x%llx "
1785 "expected 0x%x vs actual 0x%x\n",
1786 mr_status.sig_err.err_type,
1787 (unsigned long long)se_cmd->bad_sector,
1788 mr_status.sig_err.expected,
1789 mr_status.sig_err.actual);
96b7973e
SG		 1790 ret = 1;
1791 }
1792
1793fail_mr_status:
1794 return ret;
1795}
1796
f93f3a70
SG		 1797static void
1798isert_completion_rdma_write(struct iser_tx_desc *tx_desc,
1799 struct isert_cmd *isert_cmd)
1800{
9e961ae7 1801 struct isert_rdma_wr *wr = &isert_cmd->rdma_wr;
f93f3a70 1802 struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd;
9e961ae7 1803 struct se_cmd *se_cmd = &cmd->se_cmd;
f93f3a70
SG		 1804 struct isert_conn *isert_conn = isert_cmd->conn;
1805 struct isert_device *device = isert_conn->conn_device;
9e961ae7
SG		 1806 int ret = 0;
1807
1808 if (wr->fr_desc && wr->fr_desc->ind & ISERT_PROTECTED) {
96b7973e
SG		 1809 ret = isert_check_pi_status(se_cmd,
1810 wr->fr_desc->pi_ctx->sig_mr);
1811 wr->fr_desc->ind &= ~ISERT_PROTECTED;
9e961ae7 1812 }
f93f3a70
SG		 1813
1814 device->unreg_rdma_mem(isert_cmd, isert_conn);
897bb2c9 1815 wr->send_wr_num = 0;
9e961ae7
SG		 1816 if (ret)
1817 transport_send_check_condition_and_sense(se_cmd,
1818 se_cmd->pi_err, 0);
1819 else
1820 isert_put_response(isert_conn->conn, cmd);
f93f3a70
SG		 1821}
1822
b8d26b3b
NB		 1823static void
1824isert_completion_rdma_read(struct iser_tx_desc *tx_desc,
1825 struct isert_cmd *isert_cmd)
1826{
1827 struct isert_rdma_wr *wr = &isert_cmd->rdma_wr;
d703ce2f 1828 struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd;
b8d26b3b 1829 struct se_cmd *se_cmd = &cmd->se_cmd;
90ecc6e2 1830 struct isert_conn *isert_conn = isert_cmd->conn;
d40945d8 1831 struct isert_device *device = isert_conn->conn_device;
5bac4b1a 1832 int ret = 0;
b8d26b3b 1833
9e961ae7 1834 if (wr->fr_desc && wr->fr_desc->ind & ISERT_PROTECTED) {
96b7973e
SG		 1835 ret = isert_check_pi_status(se_cmd,
1836 wr->fr_desc->pi_ctx->sig_mr);
1837 wr->fr_desc->ind &= ~ISERT_PROTECTED;
9e961ae7
SG		 1838 }
1839
b8d26b3b 1840 iscsit_stop_dataout_timer(cmd);
d40945d8 1841 device->unreg_rdma_mem(isert_cmd, isert_conn);
e3d7e4c3 1842 cmd->write_data_done = wr->data.len;
b6b87a1d 1843 wr->send_wr_num = 0;
b8d26b3b 1844
24f412dd 1845 isert_dbg("Cmd: %p RDMA_READ comp calling execute_cmd\n", isert_cmd);
b8d26b3b
NB		 1846 spin_lock_bh(&cmd->istate_lock);
1847 cmd->cmd_flags |= ICF_GOT_LAST_DATAOUT;
1848 cmd->i_state = ISTATE_RECEIVED_LAST_DATAOUT;
1849 spin_unlock_bh(&cmd->istate_lock);
1850
5bac4b1a
SG		 1851 if (ret)
1852 transport_send_check_condition_and_sense(se_cmd,
1853 se_cmd->pi_err, 0);
1854 else
1855 target_execute_cmd(se_cmd);
b8d26b3b
NB		 1856}
1857
1858static void
1859isert_do_control_comp(struct work_struct *work)
1860{
1861 struct isert_cmd *isert_cmd = container_of(work,
1862 struct isert_cmd, comp_work);
1863 struct isert_conn *isert_conn = isert_cmd->conn;
1864 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
d703ce2f 1865 struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd;
b8d26b3b 1866
4c22e07f
SG		 1867 isert_dbg("Cmd %p i_state %d\n", isert_cmd, cmd->i_state);
1868
b8d26b3b
NB		 1869 switch (cmd->i_state) {
1870 case ISTATE_SEND_TASKMGTRSP:
b8d26b3b 1871 iscsit_tmr_post_handler(cmd, cmd->conn);
10633c37
SG		 1872 case ISTATE_SEND_REJECT: /* FALLTHRU */
1873 case ISTATE_SEND_TEXTRSP: /* FALLTHRU */
b8d26b3b 1874 cmd->i_state = ISTATE_SENT_STATUS;
4c22e07f
SG		 1875 isert_completion_put(&isert_cmd->tx_desc, isert_cmd,
1876 ib_dev, false);
3df8f68a 1877 break;
b8d26b3b 1878 case ISTATE_SEND_LOGOUTRSP:
b8d26b3b
NB		 1879 iscsit_logout_post_handler(cmd, cmd->conn);
1880 break;
1881 default:
4c22e07f 1882 isert_err("Unknown i_state %d\n", cmd->i_state);
b8d26b3b
NB		 1883 dump_stack();
1884 break;
1885 }
1886}
1887
1888static void
1889isert_response_completion(struct iser_tx_desc *tx_desc,
1890 struct isert_cmd *isert_cmd,
1891 struct isert_conn *isert_conn,
1892 struct ib_device *ib_dev)
1893{
d703ce2f 1894 struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd;
b8d26b3b
NB		 1895
1896 if (cmd->i_state == ISTATE_SEND_TASKMGTRSP ||
3df8f68a 1897 cmd->i_state == ISTATE_SEND_LOGOUTRSP ||
adb54c29
NB		 1898 cmd->i_state == ISTATE_SEND_REJECT ||
1899 cmd->i_state == ISTATE_SEND_TEXTRSP) {
b8d26b3b
NB		 1900 isert_unmap_tx_desc(tx_desc, ib_dev);
1901
1902 INIT_WORK(&isert_cmd->comp_work, isert_do_control_comp);
1903 queue_work(isert_comp_wq, &isert_cmd->comp_work);
1904 return;
1905 }
897bb2c9 1906
b8d26b3b 1907 cmd->i_state = ISTATE_SENT_STATUS;
03e7848a 1908 isert_completion_put(tx_desc, isert_cmd, ib_dev, false);
b8d26b3b
NB		 1909}
1910
1911static void
68a86dee
SG		 1912isert_send_completion(struct iser_tx_desc *tx_desc,
1913 struct isert_conn *isert_conn)
b8d26b3b
NB		 1914{
1915 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
1916 struct isert_cmd *isert_cmd = tx_desc->isert_cmd;
1917 struct isert_rdma_wr *wr;
1918
1919 if (!isert_cmd) {
b8d26b3b
NB		 1920 isert_unmap_tx_desc(tx_desc, ib_dev);
1921 return;
1922 }
1923 wr = &isert_cmd->rdma_wr;
1924
4c22e07f
SG		 1925 isert_dbg("Cmd %p iser_ib_op %d\n", isert_cmd, wr->iser_ib_op);
1926
b8d26b3b
NB		 1927 switch (wr->iser_ib_op) {
1928 case ISER_IB_RECV:
4c22e07f 1929 isert_err("Got ISER_IB_RECV\n");
b8d26b3b
NB		 1930 dump_stack();
1931 break;
1932 case ISER_IB_SEND:
b8d26b3b
NB		 1933 isert_response_completion(tx_desc, isert_cmd,
1934 isert_conn, ib_dev);
1935 break;
1936 case ISER_IB_RDMA_WRITE:
f93f3a70 1937 isert_completion_rdma_write(tx_desc, isert_cmd);
b8d26b3b
NB		 1938 break;
1939 case ISER_IB_RDMA_READ:
b8d26b3b
NB		 1940 isert_completion_rdma_read(tx_desc, isert_cmd);
1941 break;
1942 default:
4c22e07f 1943 isert_err("Unknown wr->iser_ib_op: 0x%x\n", wr->iser_ib_op);
b8d26b3b
NB		 1944 dump_stack();
1945 break;
1946 }
1947}
1948
6f0fae3d
SG		 1949/**
1950 * is_isert_tx_desc() - Indicate if the completion wr_id
1951 * is a TX descriptor or not.
1952 * @isert_conn: iser connection
1953 * @wr_id: completion WR identifier
1954 *
1955 * Since we cannot rely on wc opcode in FLUSH errors
1956 * we must work around it by checking if the wr_id address
1957 * falls in the iser connection rx_descs buffer. If so
1958 * it is an RX descriptor, otherwize it is a TX.
1959 */
1960static inline bool
1961is_isert_tx_desc(struct isert_conn *isert_conn, void *wr_id)
1962{
1963 void *start = isert_conn->conn_rx_descs;
1964 int len = ISERT_QP_MAX_RECV_DTOS * sizeof(*isert_conn->conn_rx_descs);
1965
1966 if (wr_id >= start && wr_id < start + len)
1967 return false;
1968
1969 return true;
1970}
1971
b8d26b3b 1972static void
6f0fae3d 1973isert_cq_comp_err(struct isert_conn *isert_conn, struct ib_wc *wc)
b8d26b3b 1974{
bdf20e72 1975 if (wc->wr_id == ISER_BEACON_WRID) {
24f412dd 1976 isert_info("conn %p completing conn_wait_comp_err\n",
bdf20e72
SG		 1977 isert_conn);
1978 complete(&isert_conn->conn_wait_comp_err);
1979 } else
6f0fae3d 1980 if (is_isert_tx_desc(isert_conn, (void *)wc->wr_id)) {
df43debd
SG		 1981 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
1982 struct isert_cmd *isert_cmd;
6f0fae3d 1983 struct iser_tx_desc *desc;
df43debd 1984
6f0fae3d
SG		 1985 desc = (struct iser_tx_desc *)(uintptr_t)wc->wr_id;
1986 isert_cmd = desc->isert_cmd;
df43debd
SG		 1987 if (!isert_cmd)
1988 isert_unmap_tx_desc(desc, ib_dev);
1989 else
1990 isert_completion_put(desc, isert_cmd, ib_dev, true);
df43debd
SG		 1991 } else {
1992 isert_conn->post_recv_buf_count--;
bdf20e72
SG		 1993 if (!isert_conn->post_recv_buf_count)
1994 iscsit_cause_connection_reinstatement(isert_conn->conn, 0);
df43debd 1995 }
b8d26b3b
NB		 1996}
1997
1998static void
6f0fae3d 1999isert_handle_wc(struct ib_wc *wc)
b8d26b3b 2000{
b8d26b3b
NB		 2001 struct isert_conn *isert_conn;
2002 struct iser_tx_desc *tx_desc;
6f0fae3d 2003 struct iser_rx_desc *rx_desc;
b8d26b3b 2004
6f0fae3d
SG		 2005 isert_conn = wc->qp->qp_context;
2006 if (likely(wc->status == IB_WC_SUCCESS)) {
2007 if (wc->opcode == IB_WC_RECV) {
2008 rx_desc = (struct iser_rx_desc *)(uintptr_t)wc->wr_id;
2009 isert_rx_completion(rx_desc, isert_conn, wc->byte_len);
b8d26b3b 2010 } else {
6f0fae3d
SG		 2011 tx_desc = (struct iser_tx_desc *)(uintptr_t)wc->wr_id;
2012 isert_send_completion(tx_desc, isert_conn);
b8d26b3b 2013 }
6f0fae3d
SG		 2014 } else {
2015 if (wc->status != IB_WC_WR_FLUSH_ERR)
24f412dd 2016 isert_err("wr id %llx status %d vend_err %x\n",
6f0fae3d
SG		 2017 wc->wr_id, wc->status, wc->vendor_err);
2018 else
24f412dd 2019 isert_dbg("flush error: wr id %llx\n", wc->wr_id);
b8d26b3b 2020
6f0fae3d
SG		 2021 if (wc->wr_id != ISER_FASTREG_LI_WRID)
2022 isert_cq_comp_err(isert_conn, wc);
2023 }
b8d26b3b
NB		 2024}
2025
2026static void
6f0fae3d 2027isert_cq_work(struct work_struct *work)
b8d26b3b 2028{
37d9fe80 2029 enum { isert_poll_budget = 65536 };
4a295bae 2030 struct isert_comp *comp = container_of(work, struct isert_comp,
6f0fae3d 2031 work);
36ea63b5
SG		 2032 struct ib_wc *const wcs = comp->wcs;
2033 int i, n, completed = 0;
b8d26b3b 2034
36ea63b5
SG		 2035 while ((n = ib_poll_cq(comp->cq, ARRAY_SIZE(comp->wcs), wcs)) > 0) {
2036 for (i = 0; i < n; i++)
2037 isert_handle_wc(&wcs[i]);
b8d26b3b 2038
36ea63b5
SG		 2039 completed += n;
2040 if (completed >= isert_poll_budget)
37d9fe80
SG		 2041 break;
2042 }
2043
6f0fae3d 2044 ib_req_notify_cq(comp->cq, IB_CQ_NEXT_COMP);
b8d26b3b
NB		 2045}
2046
2047static void
6f0fae3d 2048isert_cq_callback(struct ib_cq *cq, void *context)
b8d26b3b 2049{
4a295bae 2050 struct isert_comp *comp = context;
b8d26b3b 2051
6f0fae3d 2052 queue_work(isert_comp_wq, &comp->work);
b8d26b3b
NB		 2053}
2054
2055static int
2056isert_post_response(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd)
2057{
2058 struct ib_send_wr *wr_failed;
2059 int ret;
2060
b8d26b3b
NB		 2061 ret = ib_post_send(isert_conn->conn_qp, &isert_cmd->tx_desc.send_wr,
2062 &wr_failed);
2063 if (ret) {
24f412dd 2064 isert_err("ib_post_send failed with %d\n", ret);
b8d26b3b
NB		 2065 return ret;
2066 }
2067 return ret;
2068}
2069
2070static int
2071isert_put_response(struct iscsi_conn *conn, struct iscsi_cmd *cmd)
2072{
d703ce2f 2073 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 2074 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2075 struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr;
2076 struct iscsi_scsi_rsp *hdr = (struct iscsi_scsi_rsp *)
2077 &isert_cmd->tx_desc.iscsi_header;
2078
2079 isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc);
2080 iscsit_build_rsp_pdu(cmd, conn, true, hdr);
2081 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
2082 /*
2083 * Attach SENSE DATA payload to iSCSI Response PDU
2084 */
2085 if (cmd->se_cmd.sense_buffer &&
2086 ((cmd->se_cmd.se_cmd_flags & SCF_TRANSPORT_TASK_SENSE) ||
2087 (cmd->se_cmd.se_cmd_flags & SCF_EMULATED_TASK_SENSE))) {
2088 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
2089 struct ib_sge *tx_dsg = &isert_cmd->tx_desc.tx_sg[1];
dbbc5d11 2090 u32 padding, pdu_len;
b8d26b3b
NB		 2091
2092 put_unaligned_be16(cmd->se_cmd.scsi_sense_length,
2093 cmd->sense_buffer);
2094 cmd->se_cmd.scsi_sense_length += sizeof(__be16);
2095
2096 padding = -(cmd->se_cmd.scsi_sense_length) & 3;
2097 hton24(hdr->dlength, (u32)cmd->se_cmd.scsi_sense_length);
dbbc5d11 2098 pdu_len = cmd->se_cmd.scsi_sense_length + padding;
b8d26b3b 2099
dbbc5d11
NB		 2100 isert_cmd->pdu_buf_dma = ib_dma_map_single(ib_dev,
2101 (void *)cmd->sense_buffer, pdu_len,
b8d26b3b
NB		 2102 DMA_TO_DEVICE);
2103
dbbc5d11
NB		 2104 isert_cmd->pdu_buf_len = pdu_len;
2105 tx_dsg->addr = isert_cmd->pdu_buf_dma;
2106 tx_dsg->length = pdu_len;
b8d26b3b
NB		 2107 tx_dsg->lkey = isert_conn->conn_mr->lkey;
2108 isert_cmd->tx_desc.num_sge = 2;
2109 }
2110
68a86dee 2111 isert_init_send_wr(isert_conn, isert_cmd, send_wr);
b8d26b3b 2112
4c22e07f 2113 isert_dbg("Posting SCSI Response\n");
b8d26b3b
NB		 2114
2115 return isert_post_response(isert_conn, isert_cmd);
2116}
2117
131e6abc
NB		 2118static void
2119isert_aborted_task(struct iscsi_conn *conn, struct iscsi_cmd *cmd)
2120{
2121 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
2122 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2123 struct isert_device *device = isert_conn->conn_device;
2124
2125 spin_lock_bh(&conn->cmd_lock);
2126 if (!list_empty(&cmd->i_conn_node))
2127 list_del_init(&cmd->i_conn_node);
2128 spin_unlock_bh(&conn->cmd_lock);
2129
2130 if (cmd->data_direction == DMA_TO_DEVICE)
2131 iscsit_stop_dataout_timer(cmd);
2132
2133 device->unreg_rdma_mem(isert_cmd, isert_conn);
2134}
2135
e70beee7
NB		 2136static enum target_prot_op
2137isert_get_sup_prot_ops(struct iscsi_conn *conn)
2138{
2139 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2140 struct isert_device *device = isert_conn->conn_device;
2141
23a548ee
SG		 2142 if (conn->tpg->tpg_attrib.t10_pi) {
2143 if (device->pi_capable) {
24f412dd 2144 isert_info("conn %p PI offload enabled\n", isert_conn);
23a548ee
SG		 2145 isert_conn->pi_support = true;
2146 return TARGET_PROT_ALL;
2147 }
2148 }
2149
24f412dd 2150 isert_info("conn %p PI offload disabled\n", isert_conn);
23a548ee 2151 isert_conn->pi_support = false;
e70beee7
NB		 2152
2153 return TARGET_PROT_NORMAL;
2154}
2155
b8d26b3b
NB		 2156static int
2157isert_put_nopin(struct iscsi_cmd *cmd, struct iscsi_conn *conn,
2158 bool nopout_response)
2159{
d703ce2f 2160 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 2161 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2162 struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr;
2163
2164 isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc);
2165 iscsit_build_nopin_rsp(cmd, conn, (struct iscsi_nopin *)
2166 &isert_cmd->tx_desc.iscsi_header,
2167 nopout_response);
2168 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
68a86dee 2169 isert_init_send_wr(isert_conn, isert_cmd, send_wr);
b8d26b3b 2170
4c22e07f 2171 isert_dbg("conn %p Posting NOPIN Response\n", isert_conn);
b8d26b3b
NB		 2172
2173 return isert_post_response(isert_conn, isert_cmd);
2174}
2175
2176static int
2177isert_put_logout_rsp(struct iscsi_cmd *cmd, struct iscsi_conn *conn)
2178{
d703ce2f 2179 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 2180 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2181 struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr;
2182
2183 isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc);
2184 iscsit_build_logout_rsp(cmd, conn, (struct iscsi_logout_rsp *)
2185 &isert_cmd->tx_desc.iscsi_header);
2186 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
68a86dee 2187 isert_init_send_wr(isert_conn, isert_cmd, send_wr);
b8d26b3b 2188
4c22e07f 2189 isert_dbg("conn %p Posting Logout Response\n", isert_conn);
b8d26b3b
NB		 2190
2191 return isert_post_response(isert_conn, isert_cmd);
2192}
2193
2194static int
2195isert_put_tm_rsp(struct iscsi_cmd *cmd, struct iscsi_conn *conn)
2196{
d703ce2f 2197 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 2198 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2199 struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr;
2200
2201 isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc);
2202 iscsit_build_task_mgt_rsp(cmd, conn, (struct iscsi_tm_rsp *)
2203 &isert_cmd->tx_desc.iscsi_header);
2204 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
68a86dee 2205 isert_init_send_wr(isert_conn, isert_cmd, send_wr);
b8d26b3b 2206
4c22e07f 2207 isert_dbg("conn %p Posting Task Management Response\n", isert_conn);
b8d26b3b
NB		 2208
2209 return isert_post_response(isert_conn, isert_cmd);
2210}
2211
2212static int
2213isert_put_reject(struct iscsi_cmd *cmd, struct iscsi_conn *conn)
2214{
d703ce2f 2215 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 2216 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2217 struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr;
3df8f68a
NB		 2218 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
2219 struct ib_sge *tx_dsg = &isert_cmd->tx_desc.tx_sg[1];
2220 struct iscsi_reject *hdr =
2221 (struct iscsi_reject *)&isert_cmd->tx_desc.iscsi_header;
b8d26b3b
NB		 2222
2223 isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc);
3df8f68a 2224 iscsit_build_reject(cmd, conn, hdr);
b8d26b3b 2225 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
3df8f68a
NB		 2226
2227 hton24(hdr->dlength, ISCSI_HDR_LEN);
dbbc5d11 2228 isert_cmd->pdu_buf_dma = ib_dma_map_single(ib_dev,
3df8f68a
NB		 2229 (void *)cmd->buf_ptr, ISCSI_HDR_LEN,
2230 DMA_TO_DEVICE);
dbbc5d11
NB		 2231 isert_cmd->pdu_buf_len = ISCSI_HDR_LEN;
2232 tx_dsg->addr = isert_cmd->pdu_buf_dma;
3df8f68a
NB		 2233 tx_dsg->length = ISCSI_HDR_LEN;
2234 tx_dsg->lkey = isert_conn->conn_mr->lkey;
2235 isert_cmd->tx_desc.num_sge = 2;
2236
68a86dee 2237 isert_init_send_wr(isert_conn, isert_cmd, send_wr);
b8d26b3b 2238
4c22e07f 2239 isert_dbg("conn %p Posting Reject\n", isert_conn);
b8d26b3b
NB		 2240
2241 return isert_post_response(isert_conn, isert_cmd);
2242}
2243
adb54c29
NB		 2244static int
2245isert_put_text_rsp(struct iscsi_cmd *cmd, struct iscsi_conn *conn)
2246{
d703ce2f 2247 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
adb54c29
NB		 2248 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2249 struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr;
2250 struct iscsi_text_rsp *hdr =
2251 (struct iscsi_text_rsp *)&isert_cmd->tx_desc.iscsi_header;
2252 u32 txt_rsp_len;
2253 int rc;
2254
2255 isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc);
22c7aaa5 2256 rc = iscsit_build_text_rsp(cmd, conn, hdr, ISCSI_INFINIBAND);
adb54c29
NB		 2257 if (rc < 0)
2258 return rc;
2259
2260 txt_rsp_len = rc;
2261 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
2262
2263 if (txt_rsp_len) {
2264 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
2265 struct ib_sge *tx_dsg = &isert_cmd->tx_desc.tx_sg[1];
2266 void *txt_rsp_buf = cmd->buf_ptr;
2267
2268 isert_cmd->pdu_buf_dma = ib_dma_map_single(ib_dev,
2269 txt_rsp_buf, txt_rsp_len, DMA_TO_DEVICE);
2270
2271 isert_cmd->pdu_buf_len = txt_rsp_len;
2272 tx_dsg->addr = isert_cmd->pdu_buf_dma;
2273 tx_dsg->length = txt_rsp_len;
2274 tx_dsg->lkey = isert_conn->conn_mr->lkey;
2275 isert_cmd->tx_desc.num_sge = 2;
2276 }
68a86dee 2277 isert_init_send_wr(isert_conn, isert_cmd, send_wr);
adb54c29 2278
4c22e07f 2279 isert_dbg("conn %p Text Reject\n", isert_conn);
adb54c29
NB		 2280
2281 return isert_post_response(isert_conn, isert_cmd);
2282}
2283
b8d26b3b
NB		 2284static int
2285isert_build_rdma_wr(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd,
2286 struct ib_sge *ib_sge, struct ib_send_wr *send_wr,
2287 u32 data_left, u32 offset)
2288{
d703ce2f 2289 struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd;
b8d26b3b
NB		 2290 struct scatterlist *sg_start, *tmp_sg;
2291 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
2292 u32 sg_off, page_off;
2293 int i = 0, sg_nents;
2294
2295 sg_off = offset / PAGE_SIZE;
2296 sg_start = &cmd->se_cmd.t_data_sg[sg_off];
2297 sg_nents = min(cmd->se_cmd.t_data_nents - sg_off, isert_conn->max_sge);
2298 page_off = offset % PAGE_SIZE;
2299
2300 send_wr->sg_list = ib_sge;
2301 send_wr->num_sge = sg_nents;
b0a191e7 2302 send_wr->wr_id = (uintptr_t)&isert_cmd->tx_desc;
b8d26b3b
NB		 2303 /*
2304 * Perform mapping of TCM scatterlist memory ib_sge dma_addr.
2305 */
2306 for_each_sg(sg_start, tmp_sg, sg_nents, i) {
4c22e07f
SG		 2307 isert_dbg("RDMA from SGL dma_addr: 0x%llx dma_len: %u, "
2308 "page_off: %u\n",
2309 (unsigned long long)tmp_sg->dma_address,
2310 tmp_sg->length, page_off);
b8d26b3b
NB		 2311
2312 ib_sge->addr = ib_sg_dma_address(ib_dev, tmp_sg) + page_off;
2313 ib_sge->length = min_t(u32, data_left,
2314 ib_sg_dma_len(ib_dev, tmp_sg) - page_off);
2315 ib_sge->lkey = isert_conn->conn_mr->lkey;
2316
4c22e07f
SG		 2317 isert_dbg("RDMA ib_sge: addr: 0x%llx length: %u lkey: %x\n",
2318 ib_sge->addr, ib_sge->length, ib_sge->lkey);
b8d26b3b
NB		 2319 page_off = 0;
2320 data_left -= ib_sge->length;
2321 ib_sge++;
24f412dd 2322 isert_dbg("Incrementing ib_sge pointer to %p\n", ib_sge);
b8d26b3b
NB		 2323 }
2324
24f412dd 2325 isert_dbg("Set outgoing sg_list: %p num_sg: %u from TCM SGLs\n",
4c22e07f 2326 send_wr->sg_list, send_wr->num_sge);
b8d26b3b
NB		 2327
2328 return sg_nents;
2329}
2330
2331static int
90ecc6e2
VP		 2332isert_map_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd,
2333 struct isert_rdma_wr *wr)
b8d26b3b
NB		 2334{
2335 struct se_cmd *se_cmd = &cmd->se_cmd;
d703ce2f 2336 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b 2337 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
e3d7e4c3 2338 struct isert_data_buf *data = &wr->data;
90ecc6e2 2339 struct ib_send_wr *send_wr;
b8d26b3b 2340 struct ib_sge *ib_sge;
e3d7e4c3
SG		 2341 u32 offset, data_len, data_left, rdma_write_max, va_offset = 0;
2342 int ret = 0, i, ib_sge_cnt;
90ecc6e2 2343
e3d7e4c3 2344 isert_cmd->tx_desc.isert_cmd = isert_cmd;
b8d26b3b 2345
e3d7e4c3
SG		 2346 offset = wr->iser_ib_op == ISER_IB_RDMA_READ ? cmd->write_data_done : 0;
2347 ret = isert_map_data_buf(isert_conn, isert_cmd, se_cmd->t_data_sg,
2348 se_cmd->t_data_nents, se_cmd->data_length,
2349 offset, wr->iser_ib_op, &wr->data);
2350 if (ret)
2351 return ret;
b8d26b3b 2352
e3d7e4c3
SG		 2353 data_left = data->len;
2354 offset = data->offset;
b8d26b3b 2355
e3d7e4c3 2356 ib_sge = kzalloc(sizeof(struct ib_sge) * data->nents, GFP_KERNEL);
b8d26b3b 2357 if (!ib_sge) {
24f412dd 2358 isert_warn("Unable to allocate ib_sge\n");
b8d26b3b 2359 ret = -ENOMEM;
e3d7e4c3 2360 goto unmap_cmd;
b8d26b3b 2361 }
90ecc6e2 2362 wr->ib_sge = ib_sge;
b8d26b3b 2363
e3d7e4c3 2364 wr->send_wr_num = DIV_ROUND_UP(data->nents, isert_conn->max_sge);
b8d26b3b
NB		 2365 wr->send_wr = kzalloc(sizeof(struct ib_send_wr) * wr->send_wr_num,
2366 GFP_KERNEL);
2367 if (!wr->send_wr) {
24f412dd 2368 isert_dbg("Unable to allocate wr->send_wr\n");
b8d26b3b 2369 ret = -ENOMEM;
e3d7e4c3 2370 goto unmap_cmd;
b8d26b3b 2371 }
b8d26b3b
NB		 2372
2373 wr->isert_cmd = isert_cmd;
2374 rdma_write_max = isert_conn->max_sge * PAGE_SIZE;
b8d26b3b
NB		 2375
2376 for (i = 0; i < wr->send_wr_num; i++) {
2377 send_wr = &isert_cmd->rdma_wr.send_wr[i];
2378 data_len = min(data_left, rdma_write_max);
2379
b8d26b3b 2380 send_wr->send_flags = 0;
90ecc6e2
VP		 2381 if (wr->iser_ib_op == ISER_IB_RDMA_WRITE) {
2382 send_wr->opcode = IB_WR_RDMA_WRITE;
2383 send_wr->wr.rdma.remote_addr = isert_cmd->read_va + offset;
2384 send_wr->wr.rdma.rkey = isert_cmd->read_stag;
2385 if (i + 1 == wr->send_wr_num)
2386 send_wr->next = &isert_cmd->tx_desc.send_wr;
2387 else
2388 send_wr->next = &wr->send_wr[i + 1];
2389 } else {
2390 send_wr->opcode = IB_WR_RDMA_READ;
2391 send_wr->wr.rdma.remote_addr = isert_cmd->write_va + va_offset;
2392 send_wr->wr.rdma.rkey = isert_cmd->write_stag;
2393 if (i + 1 == wr->send_wr_num)
2394 send_wr->send_flags = IB_SEND_SIGNALED;
2395 else
2396 send_wr->next = &wr->send_wr[i + 1];
2397 }
b8d26b3b
NB		 2398
2399 ib_sge_cnt = isert_build_rdma_wr(isert_conn, isert_cmd, ib_sge,
2400 send_wr, data_len, offset);
2401 ib_sge += ib_sge_cnt;
2402
b8d26b3b 2403 offset += data_len;
90ecc6e2 2404 va_offset += data_len;
b8d26b3b
NB		 2405 data_left -= data_len;
2406 }
90ecc6e2
VP		 2407
2408 return 0;
e3d7e4c3
SG		 2409unmap_cmd:
2410 isert_unmap_data_buf(isert_conn, data);
2411
90ecc6e2
VP		 2412 return ret;
2413}
2414
59464ef4
VP		 2415static int
2416isert_map_fr_pagelist(struct ib_device *ib_dev,
2417 struct scatterlist *sg_start, int sg_nents, u64 *fr_pl)
2418{
2419 u64 start_addr, end_addr, page, chunk_start = 0;
2420 struct scatterlist *tmp_sg;
2421 int i = 0, new_chunk, last_ent, n_pages;
2422
2423 n_pages = 0;
2424 new_chunk = 1;
2425 last_ent = sg_nents - 1;
2426 for_each_sg(sg_start, tmp_sg, sg_nents, i) {
2427 start_addr = ib_sg_dma_address(ib_dev, tmp_sg);
2428 if (new_chunk)
2429 chunk_start = start_addr;
2430 end_addr = start_addr + ib_sg_dma_len(ib_dev, tmp_sg);
2431
4c22e07f
SG		 2432 isert_dbg("SGL[%d] dma_addr: 0x%llx len: %u\n",
2433 i, (unsigned long long)tmp_sg->dma_address,
2434 tmp_sg->length);
59464ef4
VP		 2435
2436 if ((end_addr & ~PAGE_MASK) && i < last_ent) {
2437 new_chunk = 0;
2438 continue;
2439 }
2440 new_chunk = 1;
2441
2442 page = chunk_start & PAGE_MASK;
2443 do {
2444 fr_pl[n_pages++] = page;
4c22e07f
SG		 2445 isert_dbg("Mapped page_list[%d] page_addr: 0x%llx\n",
2446 n_pages - 1, page);
59464ef4
VP		 2447 page += PAGE_SIZE;
2448 } while (page < end_addr);
2449 }
2450
2451 return n_pages;
2452}
2453
10633c37
SG		 2454static inline void
2455isert_inv_rkey(struct ib_send_wr *inv_wr, struct ib_mr *mr)
2456{
2457 u32 rkey;
2458
2459 memset(inv_wr, 0, sizeof(*inv_wr));
2460 inv_wr->wr_id = ISER_FASTREG_LI_WRID;
2461 inv_wr->opcode = IB_WR_LOCAL_INV;
2462 inv_wr->ex.invalidate_rkey = mr->rkey;
2463
2464 /* Bump the key */
2465 rkey = ib_inc_rkey(mr->rkey);
2466 ib_update_fast_reg_key(mr, rkey);
2467}
2468
59464ef4 2469static int
e3d7e4c3
SG		 2470isert_fast_reg_mr(struct isert_conn *isert_conn,
2471 struct fast_reg_descriptor *fr_desc,
2472 struct isert_data_buf *mem,
9e961ae7 2473 enum isert_indicator ind,
e3d7e4c3 2474 struct ib_sge *sge)
59464ef4 2475{
59464ef4 2476 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
9e961ae7
SG		 2477 struct ib_mr *mr;
2478 struct ib_fast_reg_page_list *frpl;
59464ef4
VP		 2479 struct ib_send_wr fr_wr, inv_wr;
2480 struct ib_send_wr *bad_wr, *wr = NULL;
9bd626e7
SG		 2481 int ret, pagelist_len;
2482 u32 page_off;
59464ef4 2483
e3d7e4c3
SG		 2484 if (mem->dma_nents == 1) {
2485 sge->lkey = isert_conn->conn_mr->lkey;
2486 sge->addr = ib_sg_dma_address(ib_dev, &mem->sg[0]);
2487 sge->length = ib_sg_dma_len(ib_dev, &mem->sg[0]);
4c22e07f
SG		 2488 isert_dbg("sge: addr: 0x%llx length: %u lkey: %x\n",
2489 sge->addr, sge->length, sge->lkey);
e3d7e4c3
SG		 2490 return 0;
2491 }
2492
9e961ae7
SG		 2493 if (ind == ISERT_DATA_KEY_VALID) {
2494 /* Registering data buffer */
2495 mr = fr_desc->data_mr;
2496 frpl = fr_desc->data_frpl;
2497 } else {
2498 /* Registering protection buffer */
2499 mr = fr_desc->pi_ctx->prot_mr;
2500 frpl = fr_desc->pi_ctx->prot_frpl;
2501 }
2502
e3d7e4c3 2503 page_off = mem->offset % PAGE_SIZE;
59464ef4 2504
24f412dd 2505 isert_dbg("Use fr_desc %p sg_nents %d offset %u\n",
4c22e07f 2506 fr_desc, mem->nents, mem->offset);
59464ef4 2507
e3d7e4c3 2508 pagelist_len = isert_map_fr_pagelist(ib_dev, mem->sg, mem->nents,
9e961ae7 2509 &frpl->page_list[0]);
59464ef4 2510
10633c37
SG		 2511 if (!(fr_desc->ind & ind)) {
2512 isert_inv_rkey(&inv_wr, mr);
59464ef4 2513 wr = &inv_wr;
59464ef4
VP		 2514 }
2515
2516 /* Prepare FASTREG WR */
2517 memset(&fr_wr, 0, sizeof(fr_wr));
9bb4ca68 2518 fr_wr.wr_id = ISER_FASTREG_LI_WRID;
59464ef4 2519 fr_wr.opcode = IB_WR_FAST_REG_MR;
9e961ae7
SG		 2520 fr_wr.wr.fast_reg.iova_start = frpl->page_list[0] + page_off;
2521 fr_wr.wr.fast_reg.page_list = frpl;
59464ef4
VP		 2522 fr_wr.wr.fast_reg.page_list_len = pagelist_len;
2523 fr_wr.wr.fast_reg.page_shift = PAGE_SHIFT;
e3d7e4c3 2524 fr_wr.wr.fast_reg.length = mem->len;
9e961ae7 2525 fr_wr.wr.fast_reg.rkey = mr->rkey;
59464ef4
VP		 2526 fr_wr.wr.fast_reg.access_flags = IB_ACCESS_LOCAL_WRITE;
2527
2528 if (!wr)
2529 wr = &fr_wr;
2530 else
2531 wr->next = &fr_wr;
2532
2533 ret = ib_post_send(isert_conn->conn_qp, wr, &bad_wr);
2534 if (ret) {
24f412dd 2535 isert_err("fast registration failed, ret:%d\n", ret);
59464ef4
VP		 2536 return ret;
2537 }
9e961ae7 2538 fr_desc->ind &= ~ind;
59464ef4 2539
9e961ae7
SG		 2540 sge->lkey = mr->lkey;
2541 sge->addr = frpl->page_list[0] + page_off;
e3d7e4c3 2542 sge->length = mem->len;
59464ef4 2543
4c22e07f
SG		 2544 isert_dbg("sge: addr: 0x%llx length: %u lkey: %x\n",
2545 sge->addr, sge->length, sge->lkey);
9e961ae7
SG		 2546
2547 return ret;
2548}
2549
3d73cf1a
SG		 2550static inline void
2551isert_set_dif_domain(struct se_cmd *se_cmd, struct ib_sig_attrs *sig_attrs,
2552 struct ib_sig_domain *domain)
2553{
78eda2bb 2554 domain->sig_type = IB_SIG_TYPE_T10_DIF;
3d73cf1a
SG		 2555 domain->sig.dif.bg_type = IB_T10DIF_CRC;
2556 domain->sig.dif.pi_interval = se_cmd->se_dev->dev_attrib.block_size;
2557 domain->sig.dif.ref_tag = se_cmd->reftag_seed;
78eda2bb
SG		 2558 /*
2559 * At the moment we hard code those, but if in the future
2560 * the target core would like to use it, we will take it
2561 * from se_cmd.
2562 */
2563 domain->sig.dif.apptag_check_mask = 0xffff;
2564 domain->sig.dif.app_escape = true;
2565 domain->sig.dif.ref_escape = true;
2566 if (se_cmd->prot_type == TARGET_DIF_TYPE1_PROT ||
2567 se_cmd->prot_type == TARGET_DIF_TYPE2_PROT)
2568 domain->sig.dif.ref_remap = true;
3d73cf1a
SG		 2569};
2570
9e961ae7
SG		 2571static int
2572isert_set_sig_attrs(struct se_cmd *se_cmd, struct ib_sig_attrs *sig_attrs)
2573{
9e961ae7
SG		 2574 switch (se_cmd->prot_op) {
2575 case TARGET_PROT_DIN_INSERT:
2576 case TARGET_PROT_DOUT_STRIP:
78eda2bb 2577 sig_attrs->mem.sig_type = IB_SIG_TYPE_NONE;
3d73cf1a 2578 isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->wire);
9e961ae7
SG		 2579 break;
2580 case TARGET_PROT_DOUT_INSERT:
2581 case TARGET_PROT_DIN_STRIP:
78eda2bb 2582 sig_attrs->wire.sig_type = IB_SIG_TYPE_NONE;
3d73cf1a 2583 isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->mem);
9e961ae7
SG		 2584 break;
2585 case TARGET_PROT_DIN_PASS:
2586 case TARGET_PROT_DOUT_PASS:
3d73cf1a
SG		 2587 isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->wire);
2588 isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->mem);
9e961ae7
SG		 2589 break;
2590 default:
24f412dd 2591 isert_err("Unsupported PI operation %d\n", se_cmd->prot_op);
9e961ae7
SG		 2592 return -EINVAL;
2593 }
2594
2595 return 0;
2596}
2597
2598static inline u8
2599isert_set_prot_checks(u8 prot_checks)
2600{
2601 return (prot_checks & TARGET_DIF_CHECK_GUARD ? 0xc0 : 0) |
2602 (prot_checks & TARGET_DIF_CHECK_REFTAG ? 0x30 : 0) |
2603 (prot_checks & TARGET_DIF_CHECK_REFTAG ? 0x0f : 0);
2604}
2605
2606static int
570db170
SG		 2607isert_reg_sig_mr(struct isert_conn *isert_conn,
2608 struct se_cmd *se_cmd,
2609 struct isert_rdma_wr *rdma_wr,
2610 struct fast_reg_descriptor *fr_desc)
9e961ae7
SG		 2611{
2612 struct ib_send_wr sig_wr, inv_wr;
2613 struct ib_send_wr *bad_wr, *wr = NULL;
2614 struct pi_context *pi_ctx = fr_desc->pi_ctx;
2615 struct ib_sig_attrs sig_attrs;
2616 int ret;
9e961ae7
SG		 2617
2618 memset(&sig_attrs, 0, sizeof(sig_attrs));
2619 ret = isert_set_sig_attrs(se_cmd, &sig_attrs);
2620 if (ret)
2621 goto err;
59464ef4 2622
9e961ae7
SG		 2623 sig_attrs.check_mask = isert_set_prot_checks(se_cmd->prot_checks);
2624
2625 if (!(fr_desc->ind & ISERT_SIG_KEY_VALID)) {
10633c37 2626 isert_inv_rkey(&inv_wr, pi_ctx->sig_mr);
9e961ae7 2627 wr = &inv_wr;
9e961ae7
SG		 2628 }
2629
2630 memset(&sig_wr, 0, sizeof(sig_wr));
2631 sig_wr.opcode = IB_WR_REG_SIG_MR;
c2caa207 2632 sig_wr.wr_id = ISER_FASTREG_LI_WRID;
570db170 2633 sig_wr.sg_list = &rdma_wr->ib_sg[DATA];
9e961ae7
SG		 2634 sig_wr.num_sge = 1;
2635 sig_wr.wr.sig_handover.access_flags = IB_ACCESS_LOCAL_WRITE;
2636 sig_wr.wr.sig_handover.sig_attrs = &sig_attrs;
2637 sig_wr.wr.sig_handover.sig_mr = pi_ctx->sig_mr;
2638 if (se_cmd->t_prot_sg)
570db170 2639 sig_wr.wr.sig_handover.prot = &rdma_wr->ib_sg[PROT];
9e961ae7
SG		 2640
2641 if (!wr)
2642 wr = &sig_wr;
2643 else
2644 wr->next = &sig_wr;
2645
2646 ret = ib_post_send(isert_conn->conn_qp, wr, &bad_wr);
2647 if (ret) {
24f412dd 2648 isert_err("fast registration failed, ret:%d\n", ret);
9e961ae7
SG		 2649 goto err;
2650 }
2651 fr_desc->ind &= ~ISERT_SIG_KEY_VALID;
2652
570db170
SG		 2653 rdma_wr->ib_sg[SIG].lkey = pi_ctx->sig_mr->lkey;
2654 rdma_wr->ib_sg[SIG].addr = 0;
2655 rdma_wr->ib_sg[SIG].length = se_cmd->data_length;
9e961ae7
SG		 2656 if (se_cmd->prot_op != TARGET_PROT_DIN_STRIP &&
2657 se_cmd->prot_op != TARGET_PROT_DOUT_INSERT)
2658 /*
2659 * We have protection guards on the wire
2660 * so we need to set a larget transfer
2661 */
570db170 2662 rdma_wr->ib_sg[SIG].length += se_cmd->prot_length;
9e961ae7 2663
24f412dd 2664 isert_dbg("sig_sge: addr: 0x%llx length: %u lkey: %x\n",
570db170
SG		 2665 rdma_wr->ib_sg[SIG].addr, rdma_wr->ib_sg[SIG].length,
2666 rdma_wr->ib_sg[SIG].lkey);
9e961ae7 2667err:
59464ef4
VP		 2668 return ret;
2669}
2670
570db170
SG		 2671static int
2672isert_handle_prot_cmd(struct isert_conn *isert_conn,
2673 struct isert_cmd *isert_cmd,
2674 struct isert_rdma_wr *wr)
2675{
2676 struct isert_device *device = isert_conn->conn_device;
2677 struct se_cmd *se_cmd = &isert_cmd->iscsi_cmd->se_cmd;
2678 int ret;
2679
2680 if (!wr->fr_desc->pi_ctx) {
2681 ret = isert_create_pi_ctx(wr->fr_desc,
2682 device->ib_device,
2683 isert_conn->conn_pd);
2684 if (ret) {
24f412dd 2685 isert_err("conn %p failed to allocate pi_ctx\n",
570db170
SG		 2686 isert_conn);
2687 return ret;
2688 }
2689 }
2690
2691 if (se_cmd->t_prot_sg) {
2692 ret = isert_map_data_buf(isert_conn, isert_cmd,
2693 se_cmd->t_prot_sg,
2694 se_cmd->t_prot_nents,
2695 se_cmd->prot_length,
2696 0, wr->iser_ib_op, &wr->prot);
2697 if (ret) {
24f412dd 2698 isert_err("conn %p failed to map protection buffer\n",
570db170
SG		 2699 isert_conn);
2700 return ret;
2701 }
2702
2703 memset(&wr->ib_sg[PROT], 0, sizeof(wr->ib_sg[PROT]));
2704 ret = isert_fast_reg_mr(isert_conn, wr->fr_desc, &wr->prot,
2705 ISERT_PROT_KEY_VALID, &wr->ib_sg[PROT]);
2706 if (ret) {
24f412dd 2707 isert_err("conn %p failed to fast reg mr\n",
570db170
SG		 2708 isert_conn);
2709 goto unmap_prot_cmd;
2710 }
2711 }
2712
2713 ret = isert_reg_sig_mr(isert_conn, se_cmd, wr, wr->fr_desc);
2714 if (ret) {
24f412dd 2715 isert_err("conn %p failed to fast reg mr\n",
570db170
SG		 2716 isert_conn);
2717 goto unmap_prot_cmd;
2718 }
2719 wr->fr_desc->ind |= ISERT_PROTECTED;
2720
2721 return 0;
2722
2723unmap_prot_cmd:
2724 if (se_cmd->t_prot_sg)
2725 isert_unmap_data_buf(isert_conn, &wr->prot);
2726
2727 return ret;
2728}
2729
59464ef4 2730static int
a3a5a826
SG		 2731isert_reg_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd,
2732 struct isert_rdma_wr *wr)
59464ef4
VP		 2733{
2734 struct se_cmd *se_cmd = &cmd->se_cmd;
2735 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
e3d7e4c3 2736 struct isert_conn *isert_conn = conn->context;
e3d7e4c3 2737 struct fast_reg_descriptor *fr_desc = NULL;
570db170
SG		 2738 struct ib_send_wr *send_wr;
2739 struct ib_sge *ib_sg;
e3d7e4c3
SG		 2740 u32 offset;
2741 int ret = 0;
59464ef4
VP		 2742 unsigned long flags;
2743
e3d7e4c3 2744 isert_cmd->tx_desc.isert_cmd = isert_cmd;
59464ef4 2745
e3d7e4c3
SG		 2746 offset = wr->iser_ib_op == ISER_IB_RDMA_READ ? cmd->write_data_done : 0;
2747 ret = isert_map_data_buf(isert_conn, isert_cmd, se_cmd->t_data_sg,
2748 se_cmd->t_data_nents, se_cmd->data_length,
2749 offset, wr->iser_ib_op, &wr->data);
2750 if (ret)
2751 return ret;
59464ef4 2752
302cc7c3 2753 if (wr->data.dma_nents != 1 || isert_prot_cmd(isert_conn, se_cmd)) {
e3d7e4c3
SG		 2754 spin_lock_irqsave(&isert_conn->conn_lock, flags);
2755 fr_desc = list_first_entry(&isert_conn->conn_fr_pool,
2756 struct fast_reg_descriptor, list);
2757 list_del(&fr_desc->list);
2758 spin_unlock_irqrestore(&isert_conn->conn_lock, flags);
2759 wr->fr_desc = fr_desc;
59464ef4 2760 }
59464ef4 2761
9e961ae7 2762 ret = isert_fast_reg_mr(isert_conn, fr_desc, &wr->data,
570db170 2763 ISERT_DATA_KEY_VALID, &wr->ib_sg[DATA]);
e3d7e4c3
SG		 2764 if (ret)
2765 goto unmap_cmd;
59464ef4 2766
302cc7c3 2767 if (isert_prot_cmd(isert_conn, se_cmd)) {
570db170 2768 ret = isert_handle_prot_cmd(isert_conn, isert_cmd, wr);
9e961ae7 2769 if (ret)
570db170 2770 goto unmap_cmd;
9e961ae7 2771
570db170
SG		 2772 ib_sg = &wr->ib_sg[SIG];
2773 } else {
2774 ib_sg = &wr->ib_sg[DATA];
2775 }
9e961ae7 2776
570db170 2777 memcpy(&wr->s_ib_sge, ib_sg, sizeof(*ib_sg));
e3d7e4c3 2778 wr->ib_sge = &wr->s_ib_sge;
59464ef4
VP		 2779 wr->send_wr_num = 1;
2780 memset(&wr->s_send_wr, 0, sizeof(*send_wr));
2781 wr->send_wr = &wr->s_send_wr;
59464ef4 2782 wr->isert_cmd = isert_cmd;
59464ef4
VP		 2783
2784 send_wr = &isert_cmd->rdma_wr.s_send_wr;
e3d7e4c3 2785 send_wr->sg_list = &wr->s_ib_sge;
59464ef4 2786 send_wr->num_sge = 1;
b0a191e7 2787 send_wr->wr_id = (uintptr_t)&isert_cmd->tx_desc;
59464ef4
VP		 2788 if (wr->iser_ib_op == ISER_IB_RDMA_WRITE) {
2789 send_wr->opcode = IB_WR_RDMA_WRITE;
2790 send_wr->wr.rdma.remote_addr = isert_cmd->read_va;
2791 send_wr->wr.rdma.rkey = isert_cmd->read_stag;
302cc7c3 2792 send_wr->send_flags = !isert_prot_cmd(isert_conn, se_cmd) ?
9e961ae7 2793 0 : IB_SEND_SIGNALED;
59464ef4
VP		 2794 } else {
2795 send_wr->opcode = IB_WR_RDMA_READ;
2796 send_wr->wr.rdma.remote_addr = isert_cmd->write_va;
2797 send_wr->wr.rdma.rkey = isert_cmd->write_stag;
2798 send_wr->send_flags = IB_SEND_SIGNALED;
2799 }
2800
e3d7e4c3 2801 return 0;
570db170 2802
e3d7e4c3
SG		 2803unmap_cmd:
2804 if (fr_desc) {
f01b9f73 2805 spin_lock_irqsave(&isert_conn->conn_lock, flags);
e3d7e4c3 2806 list_add_tail(&fr_desc->list, &isert_conn->conn_fr_pool);
f01b9f73 2807 spin_unlock_irqrestore(&isert_conn->conn_lock, flags);
59464ef4 2808 }
e3d7e4c3 2809 isert_unmap_data_buf(isert_conn, &wr->data);
59464ef4 2810
59464ef4
VP		 2811 return ret;
2812}
2813
90ecc6e2
VP		 2814static int
2815isert_put_datain(struct iscsi_conn *conn, struct iscsi_cmd *cmd)
2816{
2817 struct se_cmd *se_cmd = &cmd->se_cmd;
59464ef4 2818 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
90ecc6e2
VP		 2819 struct isert_rdma_wr *wr = &isert_cmd->rdma_wr;
2820 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
d40945d8 2821 struct isert_device *device = isert_conn->conn_device;
90ecc6e2
VP		 2822 struct ib_send_wr *wr_failed;
2823 int rc;
2824
24f412dd 2825 isert_dbg("Cmd: %p RDMA_WRITE data_length: %u\n",
90ecc6e2 2826 isert_cmd, se_cmd->data_length);
4c22e07f 2827
90ecc6e2 2828 wr->iser_ib_op = ISER_IB_RDMA_WRITE;
d40945d8 2829 rc = device->reg_rdma_mem(conn, cmd, wr);
90ecc6e2 2830 if (rc) {
24f412dd 2831 isert_err("Cmd: %p failed to prepare RDMA res\n", isert_cmd);
90ecc6e2
VP		 2832 return rc;
2833 }
2834
302cc7c3 2835 if (!isert_prot_cmd(isert_conn, se_cmd)) {
9e961ae7
SG		 2836 /*
2837 * Build isert_conn->tx_desc for iSCSI response PDU and attach
2838 */
2839 isert_create_send_desc(isert_conn, isert_cmd,
2840 &isert_cmd->tx_desc);
2841 iscsit_build_rsp_pdu(cmd, conn, true, (struct iscsi_scsi_rsp *)
2842 &isert_cmd->tx_desc.iscsi_header);
2843 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
2844 isert_init_send_wr(isert_conn, isert_cmd,
68a86dee 2845 &isert_cmd->tx_desc.send_wr);
9e961ae7 2846 isert_cmd->rdma_wr.s_send_wr.next = &isert_cmd->tx_desc.send_wr;
897bb2c9 2847 wr->send_wr_num += 1;
9e961ae7 2848 }
b8d26b3b 2849
b8d26b3b 2850 rc = ib_post_send(isert_conn->conn_qp, wr->send_wr, &wr_failed);
bdf20e72 2851 if (rc)
24f412dd 2852 isert_warn("ib_post_send() failed for IB_WR_RDMA_WRITE\n");
9e961ae7 2853
302cc7c3 2854 if (!isert_prot_cmd(isert_conn, se_cmd))
24f412dd 2855 isert_dbg("Cmd: %p posted RDMA_WRITE + Response for iSER Data "
9e961ae7
SG		 2856 "READ\n", isert_cmd);
2857 else
24f412dd 2858 isert_dbg("Cmd: %p posted RDMA_WRITE for iSER Data READ\n",
9e961ae7 2859 isert_cmd);
b8d26b3b 2860
90ecc6e2 2861 return 1;
b8d26b3b
NB		 2862}
2863
2864static int
2865isert_get_dataout(struct iscsi_conn *conn, struct iscsi_cmd *cmd, bool recovery)
2866{
2867 struct se_cmd *se_cmd = &cmd->se_cmd;
d703ce2f 2868 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 2869 struct isert_rdma_wr *wr = &isert_cmd->rdma_wr;
2870 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
d40945d8 2871 struct isert_device *device = isert_conn->conn_device;
90ecc6e2
VP		 2872 struct ib_send_wr *wr_failed;
2873 int rc;
b8d26b3b 2874
24f412dd 2875 isert_dbg("Cmd: %p RDMA_READ data_length: %u write_data_done: %u\n",
90ecc6e2 2876 isert_cmd, se_cmd->data_length, cmd->write_data_done);
b8d26b3b 2877 wr->iser_ib_op = ISER_IB_RDMA_READ;
d40945d8 2878 rc = device->reg_rdma_mem(conn, cmd, wr);
90ecc6e2 2879 if (rc) {
24f412dd 2880 isert_err("Cmd: %p failed to prepare RDMA res\n", isert_cmd);
90ecc6e2 2881 return rc;
b8d26b3b
NB		 2882 }
2883
b8d26b3b 2884 rc = ib_post_send(isert_conn->conn_qp, wr->send_wr, &wr_failed);
bdf20e72 2885 if (rc)
24f412dd 2886 isert_warn("ib_post_send() failed for IB_WR_RDMA_READ\n");
bdf20e72 2887
24f412dd 2888 isert_dbg("Cmd: %p posted RDMA_READ memory for ISER Data WRITE\n",
90ecc6e2 2889 isert_cmd);
b8d26b3b 2890
90ecc6e2 2891 return 0;
b8d26b3b
NB		 2892}
2893
2894static int
2895isert_immediate_queue(struct iscsi_conn *conn, struct iscsi_cmd *cmd, int state)
2896{
2897 int ret;
2898
2899 switch (state) {
2900 case ISTATE_SEND_NOPIN_WANT_RESPONSE:
2901 ret = isert_put_nopin(cmd, conn, false);
2902 break;
2903 default:
24f412dd 2904 isert_err("Unknown immediate state: 0x%02x\n", state);
b8d26b3b
NB		 2905 ret = -EINVAL;
2906 break;
2907 }
2908
2909 return ret;
2910}
2911
2912static int
2913isert_response_queue(struct iscsi_conn *conn, struct iscsi_cmd *cmd, int state)
2914{
991bb764 2915 struct isert_conn *isert_conn = conn->context;
b8d26b3b
NB		 2916 int ret;
2917
2918 switch (state) {
2919 case ISTATE_SEND_LOGOUTRSP:
2920 ret = isert_put_logout_rsp(cmd, conn);
991bb764
SG		 2921 if (!ret)
2922 isert_conn->logout_posted = true;
b8d26b3b
NB		 2923 break;
2924 case ISTATE_SEND_NOPIN:
2925 ret = isert_put_nopin(cmd, conn, true);
2926 break;
2927 case ISTATE_SEND_TASKMGTRSP:
2928 ret = isert_put_tm_rsp(cmd, conn);
2929 break;
2930 case ISTATE_SEND_REJECT:
2931 ret = isert_put_reject(cmd, conn);
2932 break;
adb54c29
NB		 2933 case ISTATE_SEND_TEXTRSP:
2934 ret = isert_put_text_rsp(cmd, conn);
2935 break;
b8d26b3b
NB		 2936 case ISTATE_SEND_STATUS:
2937 /*
2938 * Special case for sending non GOOD SCSI status from TX thread
2939 * context during pre se_cmd excecution failure.
2940 */
2941 ret = isert_put_response(conn, cmd);
2942 break;
2943 default:
24f412dd 2944 isert_err("Unknown response state: 0x%02x\n", state);
b8d26b3b
NB		 2945 ret = -EINVAL;
2946 break;
2947 }
2948
2949 return ret;
2950}
2951
ca6c1d82
SG		 2952struct rdma_cm_id *
2953isert_setup_id(struct isert_np *isert_np)
2954{
2955 struct iscsi_np *np = isert_np->np;
2956 struct rdma_cm_id *id;
2957 struct sockaddr *sa;
2958 int ret;
2959
2960 sa = (struct sockaddr *)&np->np_sockaddr;
24f412dd 2961 isert_dbg("ksockaddr: %p, sa: %p\n", &np->np_sockaddr, sa);
ca6c1d82
SG		 2962
2963 id = rdma_create_id(isert_cma_handler, isert_np,
2964 RDMA_PS_TCP, IB_QPT_RC);
2965 if (IS_ERR(id)) {
24f412dd 2966 isert_err("rdma_create_id() failed: %ld\n", PTR_ERR(id));
ca6c1d82
SG		 2967 ret = PTR_ERR(id);
2968 goto out;
2969 }
24f412dd 2970 isert_dbg("id %p context %p\n", id, id->context);
ca6c1d82
SG		 2971
2972 ret = rdma_bind_addr(id, sa);
2973 if (ret) {
24f412dd 2974 isert_err("rdma_bind_addr() failed: %d\n", ret);
ca6c1d82
SG		 2975 goto out_id;
2976 }
2977
2978 ret = rdma_listen(id, ISERT_RDMA_LISTEN_BACKLOG);
2979 if (ret) {
24f412dd 2980 isert_err("rdma_listen() failed: %d\n", ret);
ca6c1d82
SG		 2981 goto out_id;
2982 }
2983
2984 return id;
2985out_id:
2986 rdma_destroy_id(id);
2987out:
2988 return ERR_PTR(ret);
2989}
2990
b8d26b3b
NB		 2991static int
2992isert_setup_np(struct iscsi_np *np,
2993 struct __kernel_sockaddr_storage *ksockaddr)
2994{
2995 struct isert_np *isert_np;
2996 struct rdma_cm_id *isert_lid;
b8d26b3b
NB		 2997 int ret;
2998
2999 isert_np = kzalloc(sizeof(struct isert_np), GFP_KERNEL);
3000 if (!isert_np) {
24f412dd 3001 isert_err("Unable to allocate struct isert_np\n");
b8d26b3b
NB		 3002 return -ENOMEM;
3003 }
531b7bf4 3004 sema_init(&isert_np->np_sem, 0);
b8d26b3b
NB		 3005 mutex_init(&isert_np->np_accept_mutex);
3006 INIT_LIST_HEAD(&isert_np->np_accept_list);
3007 init_completion(&isert_np->np_login_comp);
ca6c1d82 3008 isert_np->np = np;
b8d26b3b 3009
b8d26b3b
NB		 3010 /*
3011 * Setup the np->np_sockaddr from the passed sockaddr setup
3012 * in iscsi_target_configfs.c code..
3013 */
3014 memcpy(&np->np_sockaddr, ksockaddr,
3015 sizeof(struct __kernel_sockaddr_storage));
3016
ca6c1d82 3017 isert_lid = isert_setup_id(isert_np);
b8d26b3b 3018 if (IS_ERR(isert_lid)) {
b8d26b3b
NB		 3019 ret = PTR_ERR(isert_lid);
3020 goto out;
3021 }
3022
b8d26b3b
NB		 3023 isert_np->np_cm_id = isert_lid;
3024 np->np_context = isert_np;
b8d26b3b
NB		 3025
3026 return 0;
3027
b8d26b3b
NB		 3028out:
3029 kfree(isert_np);
ca6c1d82 3030
b8d26b3b
NB		 3031 return ret;
3032}
3033
b8d26b3b
NB		 3034static int
3035isert_rdma_accept(struct isert_conn *isert_conn)
3036{
3037 struct rdma_cm_id *cm_id = isert_conn->conn_cm_id;
3038 struct rdma_conn_param cp;
3039 int ret;
3040
3041 memset(&cp, 0, sizeof(struct rdma_conn_param));
b8d26b3b
NB		 3042 cp.initiator_depth = isert_conn->initiator_depth;
3043 cp.retry_count = 7;
3044 cp.rnr_retry_count = 7;
3045
b8d26b3b
NB		 3046 ret = rdma_accept(cm_id, &cp);
3047 if (ret) {
24f412dd 3048 isert_err("rdma_accept() failed with: %d\n", ret);
b8d26b3b
NB		 3049 return ret;
3050 }
3051
b8d26b3b
NB		 3052 return 0;
3053}
3054
3055static int
3056isert_get_login_rx(struct iscsi_conn *conn, struct iscsi_login *login)
3057{
3058 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
3059 int ret;
3060
24f412dd 3061 isert_info("before login_req comp conn: %p\n", isert_conn);
2371e5da
SG		 3062 ret = wait_for_completion_interruptible(&isert_conn->login_req_comp);
3063 if (ret) {
24f412dd 3064 isert_err("isert_conn %p interrupted before got login req\n",
2371e5da
SG		 3065 isert_conn);
3066 return ret;
3067 }
3068 reinit_completion(&isert_conn->login_req_comp);
3069
6faaa85f
NB		 3070 /*
3071 * For login requests after the first PDU, isert_rx_login_req() will
3072 * kick schedule_delayed_work(&conn->login_work) as the packet is
3073 * received, which turns this callback from iscsi_target_do_login_rx()
3074 * into a NOP.
3075 */
3076 if (!login->first_request)
3077 return 0;
b8d26b3b 3078
2371e5da
SG		 3079 isert_rx_login_req(isert_conn);
3080
24f412dd 3081 isert_info("before conn_login_comp conn: %p\n", conn);
b8d26b3b
NB		 3082 ret = wait_for_completion_interruptible(&isert_conn->conn_login_comp);
3083 if (ret)
3084 return ret;
3085
24f412dd 3086 isert_info("processing login->req: %p\n", login->req);
2371e5da 3087
b8d26b3b
NB		 3088 return 0;
3089}
3090
3091static void
3092isert_set_conn_info(struct iscsi_np *np, struct iscsi_conn *conn,
3093 struct isert_conn *isert_conn)
3094{
3095 struct rdma_cm_id *cm_id = isert_conn->conn_cm_id;
3096 struct rdma_route *cm_route = &cm_id->route;
3097 struct sockaddr_in *sock_in;
3098 struct sockaddr_in6 *sock_in6;
3099
3100 conn->login_family = np->np_sockaddr.ss_family;
3101
3102 if (np->np_sockaddr.ss_family == AF_INET6) {
3103 sock_in6 = (struct sockaddr_in6 *)&cm_route->addr.dst_addr;
3104 snprintf(conn->login_ip, sizeof(conn->login_ip), "%pI6c",
3105 &sock_in6->sin6_addr.in6_u);
3106 conn->login_port = ntohs(sock_in6->sin6_port);
3107
3108 sock_in6 = (struct sockaddr_in6 *)&cm_route->addr.src_addr;
3109 snprintf(conn->local_ip, sizeof(conn->local_ip), "%pI6c",
3110 &sock_in6->sin6_addr.in6_u);
3111 conn->local_port = ntohs(sock_in6->sin6_port);
3112 } else {
3113 sock_in = (struct sockaddr_in *)&cm_route->addr.dst_addr;
3114 sprintf(conn->login_ip, "%pI4",
3115 &sock_in->sin_addr.s_addr);
3116 conn->login_port = ntohs(sock_in->sin_port);
3117
3118 sock_in = (struct sockaddr_in *)&cm_route->addr.src_addr;
3119 sprintf(conn->local_ip, "%pI4",
3120 &sock_in->sin_addr.s_addr);
3121 conn->local_port = ntohs(sock_in->sin_port);
3122 }
3123}
3124
3125static int
3126isert_accept_np(struct iscsi_np *np, struct iscsi_conn *conn)
3127{
3128 struct isert_np *isert_np = (struct isert_np *)np->np_context;
3129 struct isert_conn *isert_conn;
3130 int max_accept = 0, ret;
3131
3132accept_wait:
531b7bf4 3133 ret = down_interruptible(&isert_np->np_sem);
1acff63f 3134 if (ret || max_accept > 5)
b8d26b3b
NB		 3135 return -ENODEV;
3136
3137 spin_lock_bh(&np->np_thread_lock);
e346ab34 3138 if (np->np_thread_state >= ISCSI_NP_THREAD_RESET) {
b8d26b3b 3139 spin_unlock_bh(&np->np_thread_lock);
24f412dd 3140 isert_dbg("np_thread_state %d for isert_accept_np\n",
e346ab34
SG		 3141 np->np_thread_state);
3142 /**
3143 * No point in stalling here when np_thread
3144 * is in state RESET/SHUTDOWN/EXIT - bail
3145 **/
b8d26b3b
NB		 3146 return -ENODEV;
3147 }
3148 spin_unlock_bh(&np->np_thread_lock);
3149
3150 mutex_lock(&isert_np->np_accept_mutex);
3151 if (list_empty(&isert_np->np_accept_list)) {
3152 mutex_unlock(&isert_np->np_accept_mutex);
3153 max_accept++;
3154 goto accept_wait;
3155 }
3156 isert_conn = list_first_entry(&isert_np->np_accept_list,
3157 struct isert_conn, conn_accept_node);
3158 list_del_init(&isert_conn->conn_accept_node);
3159 mutex_unlock(&isert_np->np_accept_mutex);
3160
3161 conn->context = isert_conn;
3162 isert_conn->conn = conn;
3163 max_accept = 0;
3164
b8d26b3b
NB		 3165 isert_set_conn_info(np, conn, isert_conn);
3166
24f412dd 3167 isert_dbg("Processing isert_conn: %p\n", isert_conn);
2371e5da 3168
b8d26b3b
NB		 3169 return 0;
3170}
3171
3172static void
3173isert_free_np(struct iscsi_np *np)
3174{
3175 struct isert_np *isert_np = (struct isert_np *)np->np_context;
268e6811 3176 struct isert_conn *isert_conn, *n;
b8d26b3b 3177
3b726ae2
SG		 3178 if (isert_np->np_cm_id)
3179 rdma_destroy_id(isert_np->np_cm_id);
b8d26b3b 3180
268e6811
SG		 3181 /*
3182 * FIXME: At this point we don't have a good way to insure
3183 * that at this point we don't have hanging connections that
3184 * completed RDMA establishment but didn't start iscsi login
3185 * process. So work-around this by cleaning up what ever piled
3186 * up in np_accept_list.
3187 */
3188 mutex_lock(&isert_np->np_accept_mutex);
3189 if (!list_empty(&isert_np->np_accept_list)) {
24f412dd 3190 isert_info("Still have isert connections, cleaning up...\n");
268e6811
SG		 3191 list_for_each_entry_safe(isert_conn, n,
3192 &isert_np->np_accept_list,
3193 conn_accept_node) {
24f412dd 3194 isert_info("cleaning isert_conn %p state (%d)\n",
268e6811
SG		 3195 isert_conn, isert_conn->state);
3196 isert_connect_release(isert_conn);
3197 }
3198 }
3199 mutex_unlock(&isert_np->np_accept_mutex);
3200
b8d26b3b
NB		 3201 np->np_context = NULL;
3202 kfree(isert_np);
3203}
3204
b02efbfc
SG		 3205static void isert_release_work(struct work_struct *work)
3206{
3207 struct isert_conn *isert_conn = container_of(work,
3208 struct isert_conn,
3209 release_work);
3210
24f412dd 3211 isert_info("Starting release conn %p\n", isert_conn);
b02efbfc
SG		 3212
3213 wait_for_completion(&isert_conn->conn_wait);
3214
3215 mutex_lock(&isert_conn->conn_mutex);
3216 isert_conn->state = ISER_CONN_DOWN;
3217 mutex_unlock(&isert_conn->conn_mutex);
3218
24f412dd 3219 isert_info("Destroying conn %p\n", isert_conn);
b02efbfc
SG		 3220 isert_put_conn(isert_conn);
3221}
3222
991bb764
SG		 3223static void
3224isert_wait4logout(struct isert_conn *isert_conn)
3225{
3226 struct iscsi_conn *conn = isert_conn->conn;
3227
4c22e07f
SG		 3228 isert_info("conn %p\n", isert_conn);
3229
991bb764 3230 if (isert_conn->logout_posted) {
24f412dd 3231 isert_info("conn %p wait for conn_logout_comp\n", isert_conn);
991bb764
SG		 3232 wait_for_completion_timeout(&conn->conn_logout_comp,
3233 SECONDS_FOR_LOGOUT_COMP * HZ);
3234 }
3235}
3236
c7e160ee
SG		 3237static void
3238isert_wait4cmds(struct iscsi_conn *conn)
3239{
4c22e07f
SG		 3240 isert_info("iscsi_conn %p\n", conn);
3241
c7e160ee
SG		 3242 if (conn->sess) {
3243 target_sess_cmd_list_set_waiting(conn->sess->se_sess);
3244 target_wait_for_sess_cmds(conn->sess->se_sess);
3245 }
3246}
3247
bdf20e72
SG		 3248static void
3249isert_wait4flush(struct isert_conn *isert_conn)
3250{
3251 struct ib_recv_wr *bad_wr;
3252
4c22e07f
SG		 3253 isert_info("conn %p\n", isert_conn);
3254
bdf20e72
SG		 3255 init_completion(&isert_conn->conn_wait_comp_err);
3256 isert_conn->beacon.wr_id = ISER_BEACON_WRID;
3257 /* post an indication that all flush errors were consumed */
3258 if (ib_post_recv(isert_conn->conn_qp, &isert_conn->beacon, &bad_wr)) {
24f412dd 3259 isert_err("conn %p failed to post beacon", isert_conn);
bdf20e72
SG		 3260 return;
3261 }
3262
3263 wait_for_completion(&isert_conn->conn_wait_comp_err);
3264}
3265
defd8848 3266static void isert_wait_conn(struct iscsi_conn *conn)
b8d26b3b
NB		 3267{
3268 struct isert_conn *isert_conn = conn->context;
3269
4c22e07f 3270 isert_info("Starting conn %p\n", isert_conn);
b8d26b3b 3271
9d49f5e2 3272 mutex_lock(&isert_conn->conn_mutex);
b8d26b3b
NB		 3273 /*
3274 * Only wait for conn_wait_comp_err if the isert_conn made it
3275 * into full feature phase..
3276 */
b2cb9649
NB		 3277 if (isert_conn->state == ISER_CONN_INIT) {
3278 mutex_unlock(&isert_conn->conn_mutex);
b2cb9649 3279 return;
b8d26b3b 3280 }
954f2372 3281 isert_conn_terminate(isert_conn);
b2cb9649 3282 mutex_unlock(&isert_conn->conn_mutex);
b8d26b3b 3283
c7e160ee 3284 isert_wait4cmds(conn);
bdf20e72 3285 isert_wait4flush(isert_conn);
991bb764 3286 isert_wait4logout(isert_conn);
954f2372 3287
b02efbfc
SG		 3288 INIT_WORK(&isert_conn->release_work, isert_release_work);
3289 queue_work(isert_release_wq, &isert_conn->release_work);
defd8848
NB		 3290}
3291
3292static void isert_free_conn(struct iscsi_conn *conn)
3293{
3294 struct isert_conn *isert_conn = conn->context;
b8d26b3b
NB		 3295
3296 isert_put_conn(isert_conn);
3297}
3298
3299static struct iscsit_transport iser_target_transport = {
3300 .name = "IB/iSER",
3301 .transport_type = ISCSI_INFINIBAND,
d703ce2f 3302 .priv_size = sizeof(struct isert_cmd),
b8d26b3b
NB		 3303 .owner = THIS_MODULE,
3304 .iscsit_setup_np = isert_setup_np,
3305 .iscsit_accept_np = isert_accept_np,
3306 .iscsit_free_np = isert_free_np,
defd8848 3307 .iscsit_wait_conn = isert_wait_conn,
b8d26b3b 3308 .iscsit_free_conn = isert_free_conn,
b8d26b3b
NB		 3309 .iscsit_get_login_rx = isert_get_login_rx,
3310 .iscsit_put_login_tx = isert_put_login_tx,
3311 .iscsit_immediate_queue = isert_immediate_queue,
3312 .iscsit_response_queue = isert_response_queue,
3313 .iscsit_get_dataout = isert_get_dataout,
3314 .iscsit_queue_data_in = isert_put_datain,
3315 .iscsit_queue_status = isert_put_response,
131e6abc 3316 .iscsit_aborted_task = isert_aborted_task,
e70beee7 3317 .iscsit_get_sup_prot_ops = isert_get_sup_prot_ops,
b8d26b3b
NB		 3318};
3319
3320static int __init isert_init(void)
3321{
3322 int ret;
3323
b8d26b3b
NB		 3324 isert_comp_wq = alloc_workqueue("isert_comp_wq", 0, 0);
3325 if (!isert_comp_wq) {
24f412dd 3326 isert_err("Unable to allocate isert_comp_wq\n");
b8d26b3b 3327 ret = -ENOMEM;
6f0fae3d 3328 return -ENOMEM;
b8d26b3b
NB		 3329 }
3330
b02efbfc
SG		 3331 isert_release_wq = alloc_workqueue("isert_release_wq", WQ_UNBOUND,
3332 WQ_UNBOUND_MAX_ACTIVE);
3333 if (!isert_release_wq) {
24f412dd 3334 isert_err("Unable to allocate isert_release_wq\n");
b02efbfc
SG		 3335 ret = -ENOMEM;
3336 goto destroy_comp_wq;
3337 }
3338
b8d26b3b 3339 iscsit_register_transport(&iser_target_transport);
24f412dd 3340 isert_info("iSER_TARGET[0] - Loaded iser_target_transport\n");
b02efbfc 3341
b8d26b3b
NB		 3342 return 0;
3343
b02efbfc
SG		 3344destroy_comp_wq:
3345 destroy_workqueue(isert_comp_wq);
6f0fae3d 3346
b8d26b3b
NB		 3347 return ret;
3348}
3349
3350static void __exit isert_exit(void)
3351{
f5ebec96 3352 flush_scheduled_work();
b02efbfc 3353 destroy_workqueue(isert_release_wq);
b8d26b3b 3354 destroy_workqueue(isert_comp_wq);
b8d26b3b 3355 iscsit_unregister_transport(&iser_target_transport);
4c22e07f 3356 isert_info("iSER_TARGET[0] - Released iser_target_transport\n");
b8d26b3b
NB		 3357}
3358
3359MODULE_DESCRIPTION("iSER-Target for mainline target infrastructure");
3360MODULE_VERSION("0.1");
3361MODULE_AUTHOR("nab@Linux-iSCSI.org");
3362MODULE_LICENSE("GPL");
3363
3364module_init(isert_init);
3365module_exit(isert_exit);
ubuntu-zesty-kernel mirror