]> 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
iscsi/iser-target: Add fabric_prot_type attribute support
[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
45678b6b 41static int isert_debug_level;
24f412dd
SG		 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 {
11378cdb 952 isert_dbg("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;
b44a2b67 1354 unsigned char *text_in = NULL;
adb54c29
NB		 1355
1356 rc = iscsit_setup_text_cmd(conn, cmd, hdr);
1357 if (rc < 0)
1358 return rc;
1359
b44a2b67
SG		 1360 if (payload_length) {
1361 text_in = kzalloc(payload_length, GFP_KERNEL);
1362 if (!text_in) {
1363 isert_err("Unable to allocate text_in of payload_length: %u\n",
1364 payload_length);
1365 return -ENOMEM;
1366 }
adb54c29
NB		 1367 }
1368 cmd->text_in_ptr = text_in;
1369
1370 memcpy(cmd->text_in_ptr, &rx_desc->data[0], payload_length);
1371
1372 return iscsit_process_text_cmd(conn, cmd, hdr);
1373}
1374
b8d26b3b
NB		 1375static int
1376isert_rx_opcode(struct isert_conn *isert_conn, struct iser_rx_desc *rx_desc,
1377 uint32_t read_stag, uint64_t read_va,
1378 uint32_t write_stag, uint64_t write_va)
1379{
1380 struct iscsi_hdr *hdr = &rx_desc->iscsi_header;
1381 struct iscsi_conn *conn = isert_conn->conn;
ca40d24e 1382 struct iscsi_session *sess = conn->sess;
b8d26b3b
NB		 1383 struct iscsi_cmd *cmd;
1384 struct isert_cmd *isert_cmd;
1385 int ret = -EINVAL;
1386 u8 opcode = (hdr->opcode & ISCSI_OPCODE_MASK);
1387
ca40d24e
NB		 1388 if (sess->sess_ops->SessionType &&
1389 (!(opcode & ISCSI_OP_TEXT) || !(opcode & ISCSI_OP_LOGOUT))) {
24f412dd 1390 isert_err("Got illegal opcode: 0x%02x in SessionType=Discovery,"
4c22e07f 1391 " ignoring\n", opcode);
ca40d24e
NB		 1392 return 0;
1393 }
1394
b8d26b3b
NB		 1395 switch (opcode) {
1396 case ISCSI_OP_SCSI_CMD:
676687c6 1397 cmd = isert_allocate_cmd(conn);
b8d26b3b
NB		 1398 if (!cmd)
1399 break;
1400
d703ce2f 1401 isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 1402 isert_cmd->read_stag = read_stag;
1403 isert_cmd->read_va = read_va;
1404 isert_cmd->write_stag = write_stag;
1405 isert_cmd->write_va = write_va;
1406
d703ce2f 1407 ret = isert_handle_scsi_cmd(isert_conn, isert_cmd, cmd,
b8d26b3b
NB		 1408 rx_desc, (unsigned char *)hdr);
1409 break;
1410 case ISCSI_OP_NOOP_OUT:
676687c6 1411 cmd = isert_allocate_cmd(conn);
b8d26b3b
NB		 1412 if (!cmd)
1413 break;
1414
d703ce2f
NB		 1415 isert_cmd = iscsit_priv_cmd(cmd);
1416 ret = isert_handle_nop_out(isert_conn, isert_cmd, cmd,
778de368 1417 rx_desc, (unsigned char *)hdr);
b8d26b3b
NB		 1418 break;
1419 case ISCSI_OP_SCSI_DATA_OUT:
1420 ret = isert_handle_iscsi_dataout(isert_conn, rx_desc,
1421 (unsigned char *)hdr);
1422 break;
1423 case ISCSI_OP_SCSI_TMFUNC:
676687c6 1424 cmd = isert_allocate_cmd(conn);
b8d26b3b
NB		 1425 if (!cmd)
1426 break;
1427
1428 ret = iscsit_handle_task_mgt_cmd(conn, cmd,
1429 (unsigned char *)hdr);
1430 break;
1431 case ISCSI_OP_LOGOUT:
676687c6 1432 cmd = isert_allocate_cmd(conn);
b8d26b3b
NB		 1433 if (!cmd)
1434 break;
1435
1436 ret = iscsit_handle_logout_cmd(conn, cmd, (unsigned char *)hdr);
b8d26b3b 1437 break;
adb54c29 1438 case ISCSI_OP_TEXT:
e4f4e801
SG		 1439 if (be32_to_cpu(hdr->ttt) != 0xFFFFFFFF) {
1440 cmd = iscsit_find_cmd_from_itt(conn, hdr->itt);
1441 if (!cmd)
1442 break;
1443 } else {
1444 cmd = isert_allocate_cmd(conn);
1445 if (!cmd)
1446 break;
1447 }
adb54c29 1448
d703ce2f
NB		 1449 isert_cmd = iscsit_priv_cmd(cmd);
1450 ret = isert_handle_text_cmd(isert_conn, isert_cmd, cmd,
adb54c29
NB		 1451 rx_desc, (struct iscsi_text *)hdr);
1452 break;
b8d26b3b 1453 default:
24f412dd 1454 isert_err("Got unknown iSCSI OpCode: 0x%02x\n", opcode);
b8d26b3b
NB		 1455 dump_stack();
1456 break;
1457 }
1458
1459 return ret;
1460}
1461
1462static void
1463isert_rx_do_work(struct iser_rx_desc *rx_desc, struct isert_conn *isert_conn)
1464{
1465 struct iser_hdr *iser_hdr = &rx_desc->iser_header;
1466 uint64_t read_va = 0, write_va = 0;
1467 uint32_t read_stag = 0, write_stag = 0;
1468 int rc;
1469
1470 switch (iser_hdr->flags & 0xF0) {
1471 case ISCSI_CTRL:
1472 if (iser_hdr->flags & ISER_RSV) {
1473 read_stag = be32_to_cpu(iser_hdr->read_stag);
1474 read_va = be64_to_cpu(iser_hdr->read_va);
4c22e07f
SG		 1475 isert_dbg("ISER_RSV: read_stag: 0x%x read_va: 0x%llx\n",
1476 read_stag, (unsigned long long)read_va);
b8d26b3b
NB		 1477 }
1478 if (iser_hdr->flags & ISER_WSV) {
1479 write_stag = be32_to_cpu(iser_hdr->write_stag);
1480 write_va = be64_to_cpu(iser_hdr->write_va);
4c22e07f
SG		 1481 isert_dbg("ISER_WSV: write_stag: 0x%x write_va: 0x%llx\n",
1482 write_stag, (unsigned long long)write_va);
b8d26b3b
NB		 1483 }
1484
24f412dd 1485 isert_dbg("ISER ISCSI_CTRL PDU\n");
b8d26b3b
NB		 1486 break;
1487 case ISER_HELLO:
24f412dd 1488 isert_err("iSER Hello message\n");
b8d26b3b
NB		 1489 break;
1490 default:
24f412dd 1491 isert_warn("Unknown iSER hdr flags: 0x%02x\n", iser_hdr->flags);
b8d26b3b
NB		 1492 break;
1493 }
1494
1495 rc = isert_rx_opcode(isert_conn, rx_desc,
1496 read_stag, read_va, write_stag, write_va);
1497}
1498
1499static void
1500isert_rx_completion(struct iser_rx_desc *desc, struct isert_conn *isert_conn,
4a295bae 1501 u32 xfer_len)
b8d26b3b
NB		 1502{
1503 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
1504 struct iscsi_hdr *hdr;
1505 u64 rx_dma;
1506 int rx_buflen, outstanding;
1507
1508 if ((char *)desc == isert_conn->login_req_buf) {
1509 rx_dma = isert_conn->login_req_dma;
1510 rx_buflen = ISER_RX_LOGIN_SIZE;
4c22e07f 1511 isert_dbg("login_buf: Using rx_dma: 0x%llx, rx_buflen: %d\n",
b8d26b3b
NB		 1512 rx_dma, rx_buflen);
1513 } else {
1514 rx_dma = desc->dma_addr;
1515 rx_buflen = ISER_RX_PAYLOAD_SIZE;
4c22e07f 1516 isert_dbg("req_buf: Using rx_dma: 0x%llx, rx_buflen: %d\n",
b8d26b3b
NB		 1517 rx_dma, rx_buflen);
1518 }
1519
1520 ib_dma_sync_single_for_cpu(ib_dev, rx_dma, rx_buflen, DMA_FROM_DEVICE);
1521
1522 hdr = &desc->iscsi_header;
24f412dd 1523 isert_dbg("iSCSI opcode: 0x%02x, ITT: 0x%08x, flags: 0x%02x dlen: %d\n",
b8d26b3b
NB		 1524 hdr->opcode, hdr->itt, hdr->flags,
1525 (int)(xfer_len - ISER_HEADERS_LEN));
1526
2371e5da
SG		 1527 if ((char *)desc == isert_conn->login_req_buf) {
1528 isert_conn->login_req_len = xfer_len - ISER_HEADERS_LEN;
1529 if (isert_conn->conn) {
1530 struct iscsi_login *login = isert_conn->conn->conn_login;
1531
1532 if (login && !login->first_request)
1533 isert_rx_login_req(isert_conn);
1534 }
1535 mutex_lock(&isert_conn->conn_mutex);
1536 complete(&isert_conn->login_req_comp);
1537 mutex_unlock(&isert_conn->conn_mutex);
1538 } else {
b8d26b3b 1539 isert_rx_do_work(desc, isert_conn);
2371e5da 1540 }
b8d26b3b
NB		 1541
1542 ib_dma_sync_single_for_device(ib_dev, rx_dma, rx_buflen,
1543 DMA_FROM_DEVICE);
1544
1545 isert_conn->post_recv_buf_count--;
4c22e07f
SG		 1546 isert_dbg("Decremented post_recv_buf_count: %d\n",
1547 isert_conn->post_recv_buf_count);
b8d26b3b
NB		 1548
1549 if ((char *)desc == isert_conn->login_req_buf)
1550 return;
1551
1552 outstanding = isert_conn->post_recv_buf_count;
1553 if (outstanding + ISERT_MIN_POSTED_RX <= ISERT_QP_MAX_RECV_DTOS) {
1554 int err, count = min(ISERT_QP_MAX_RECV_DTOS - outstanding,
1555 ISERT_MIN_POSTED_RX);
1556 err = isert_post_recv(isert_conn, count);
1557 if (err) {
24f412dd 1558 isert_err("isert_post_recv() count: %d failed, %d\n",
b8d26b3b
NB		 1559 count, err);
1560 }
1561 }
1562}
1563
e3d7e4c3
SG		 1564static int
1565isert_map_data_buf(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd,
1566 struct scatterlist *sg, u32 nents, u32 length, u32 offset,
1567 enum iser_ib_op_code op, struct isert_data_buf *data)
1568{
1569 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
1570
1571 data->dma_dir = op == ISER_IB_RDMA_WRITE ?
1572 DMA_TO_DEVICE : DMA_FROM_DEVICE;
1573
1574 data->len = length - offset;
1575 data->offset = offset;
1576 data->sg_off = data->offset / PAGE_SIZE;
1577
1578 data->sg = &sg[data->sg_off];
1579 data->nents = min_t(unsigned int, nents - data->sg_off,
1580 ISCSI_ISER_SG_TABLESIZE);
1581 data->len = min_t(unsigned int, data->len, ISCSI_ISER_SG_TABLESIZE *
1582 PAGE_SIZE);
1583
1584 data->dma_nents = ib_dma_map_sg(ib_dev, data->sg, data->nents,
1585 data->dma_dir);
1586 if (unlikely(!data->dma_nents)) {
24f412dd 1587 isert_err("Cmd: unable to dma map SGs %p\n", sg);
e3d7e4c3
SG		 1588 return -EINVAL;
1589 }
1590
24f412dd 1591 isert_dbg("Mapped cmd: %p count: %u sg: %p sg_nents: %u rdma_len %d\n",
4c22e07f 1592 isert_cmd, data->dma_nents, data->sg, data->nents, data->len);
e3d7e4c3
SG		 1593
1594 return 0;
1595}
1596
1597static void
1598isert_unmap_data_buf(struct isert_conn *isert_conn, struct isert_data_buf *data)
1599{
1600 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
1601
1602 ib_dma_unmap_sg(ib_dev, data->sg, data->nents, data->dma_dir);
1603 memset(data, 0, sizeof(*data));
1604}
1605
1606
1607
b8d26b3b
NB		 1608static void
1609isert_unmap_cmd(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn)
1610{
1611 struct isert_rdma_wr *wr = &isert_cmd->rdma_wr;
b8d26b3b 1612
4c22e07f 1613 isert_dbg("Cmd %p\n", isert_cmd);
e3d7e4c3
SG		 1614
1615 if (wr->data.sg) {
4c22e07f 1616 isert_dbg("Cmd %p unmap_sg op\n", isert_cmd);
e3d7e4c3 1617 isert_unmap_data_buf(isert_conn, &wr->data);
b8d26b3b
NB		 1618 }
1619
90ecc6e2 1620 if (wr->send_wr) {
4c22e07f 1621 isert_dbg("Cmd %p free send_wr\n", isert_cmd);
90ecc6e2
VP		 1622 kfree(wr->send_wr);
1623 wr->send_wr = NULL;
1624 }
b8d26b3b 1625
90ecc6e2 1626 if (wr->ib_sge) {
4c22e07f 1627 isert_dbg("Cmd %p free ib_sge\n", isert_cmd);
90ecc6e2
VP		 1628 kfree(wr->ib_sge);
1629 wr->ib_sge = NULL;
1630 }
b8d26b3b
NB		 1631}
1632
59464ef4 1633static void
a3a5a826 1634isert_unreg_rdma(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn)
59464ef4
VP		 1635{
1636 struct isert_rdma_wr *wr = &isert_cmd->rdma_wr;
59464ef4
VP		 1637 LIST_HEAD(unmap_list);
1638
4c22e07f 1639 isert_dbg("Cmd %p\n", isert_cmd);
59464ef4
VP		 1640
1641 if (wr->fr_desc) {
4c22e07f 1642 isert_dbg("Cmd %p free fr_desc %p\n", isert_cmd, wr->fr_desc);
9e961ae7
SG		 1643 if (wr->fr_desc->ind & ISERT_PROTECTED) {
1644 isert_unmap_data_buf(isert_conn, &wr->prot);
1645 wr->fr_desc->ind &= ~ISERT_PROTECTED;
1646 }
59464ef4 1647 spin_lock_bh(&isert_conn->conn_lock);
a3a5a826 1648 list_add_tail(&wr->fr_desc->list, &isert_conn->conn_fr_pool);
59464ef4
VP		 1649 spin_unlock_bh(&isert_conn->conn_lock);
1650 wr->fr_desc = NULL;
1651 }
1652
e3d7e4c3 1653 if (wr->data.sg) {
4c22e07f 1654 isert_dbg("Cmd %p unmap_sg op\n", isert_cmd);
e3d7e4c3 1655 isert_unmap_data_buf(isert_conn, &wr->data);
59464ef4
VP		 1656 }
1657
1658 wr->ib_sge = NULL;
1659 wr->send_wr = NULL;
1660}
1661
b8d26b3b 1662static void
03e7848a 1663isert_put_cmd(struct isert_cmd *isert_cmd, bool comp_err)
b8d26b3b 1664{
d703ce2f 1665 struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd;
b8d26b3b 1666 struct isert_conn *isert_conn = isert_cmd->conn;
186a9647 1667 struct iscsi_conn *conn = isert_conn->conn;
d40945d8 1668 struct isert_device *device = isert_conn->conn_device;
e4f4e801 1669 struct iscsi_text_rsp *hdr;
b8d26b3b 1670
4c22e07f 1671 isert_dbg("Cmd %p\n", isert_cmd);
b8d26b3b
NB		 1672
1673 switch (cmd->iscsi_opcode) {
1674 case ISCSI_OP_SCSI_CMD:
b8d26b3b
NB		 1675 spin_lock_bh(&conn->cmd_lock);
1676 if (!list_empty(&cmd->i_conn_node))
5159d763 1677 list_del_init(&cmd->i_conn_node);
b8d26b3b
NB		 1678 spin_unlock_bh(&conn->cmd_lock);
1679
03e7848a 1680 if (cmd->data_direction == DMA_TO_DEVICE) {
b8d26b3b 1681 iscsit_stop_dataout_timer(cmd);
03e7848a
NB		 1682 /*
1683 * Check for special case during comp_err where
1684 * WRITE_PENDING has been handed off from core,
1685 * but requires an extra target_put_sess_cmd()
1686 * before transport_generic_free_cmd() below.
1687 */
1688 if (comp_err &&
1689 cmd->se_cmd.t_state == TRANSPORT_WRITE_PENDING) {
1690 struct se_cmd *se_cmd = &cmd->se_cmd;
1691
1692 target_put_sess_cmd(se_cmd->se_sess, se_cmd);
1693 }
1694 }
b8d26b3b 1695
d40945d8 1696 device->unreg_rdma_mem(isert_cmd, isert_conn);
186a9647
NB		 1697 transport_generic_free_cmd(&cmd->se_cmd, 0);
1698 break;
b8d26b3b 1699 case ISCSI_OP_SCSI_TMFUNC:
186a9647
NB		 1700 spin_lock_bh(&conn->cmd_lock);
1701 if (!list_empty(&cmd->i_conn_node))
5159d763 1702 list_del_init(&cmd->i_conn_node);
186a9647
NB		 1703 spin_unlock_bh(&conn->cmd_lock);
1704
b8d26b3b
NB		 1705 transport_generic_free_cmd(&cmd->se_cmd, 0);
1706 break;
1707 case ISCSI_OP_REJECT:
1708 case ISCSI_OP_NOOP_OUT:
adb54c29 1709 case ISCSI_OP_TEXT:
e4f4e801
SG		 1710 hdr = (struct iscsi_text_rsp *)&isert_cmd->tx_desc.iscsi_header;
1711 /* If the continue bit is on, keep the command alive */
1712 if (hdr->flags & ISCSI_FLAG_TEXT_CONTINUE)
1713 break;
1714
b8d26b3b
NB		 1715 spin_lock_bh(&conn->cmd_lock);
1716 if (!list_empty(&cmd->i_conn_node))
5159d763 1717 list_del_init(&cmd->i_conn_node);
b8d26b3b
NB		 1718 spin_unlock_bh(&conn->cmd_lock);
1719
1720 /*
1721 * Handle special case for REJECT when iscsi_add_reject*() has
1722 * overwritten the original iscsi_opcode assignment, and the
1723 * associated cmd->se_cmd needs to be released.
1724 */
1725 if (cmd->se_cmd.se_tfo != NULL) {
11378cdb 1726 isert_dbg("Calling transport_generic_free_cmd for 0x%02x\n",
3df8f68a 1727 cmd->iscsi_opcode);
b8d26b3b
NB		 1728 transport_generic_free_cmd(&cmd->se_cmd, 0);
1729 break;
1730 }
1731 /*
1732 * Fall-through
1733 */
1734 default:
d703ce2f 1735 iscsit_release_cmd(cmd);
b8d26b3b
NB		 1736 break;
1737 }
1738}
1739
1740static void
1741isert_unmap_tx_desc(struct iser_tx_desc *tx_desc, struct ib_device *ib_dev)
1742{
1743 if (tx_desc->dma_addr != 0) {
4c22e07f 1744 isert_dbg("unmap single for tx_desc->dma_addr\n");
b8d26b3b
NB		 1745 ib_dma_unmap_single(ib_dev, tx_desc->dma_addr,
1746 ISER_HEADERS_LEN, DMA_TO_DEVICE);
1747 tx_desc->dma_addr = 0;
1748 }
1749}
1750
1751static void
1752isert_completion_put(struct iser_tx_desc *tx_desc, struct isert_cmd *isert_cmd,
03e7848a 1753 struct ib_device *ib_dev, bool comp_err)
b8d26b3b 1754{
dbbc5d11 1755 if (isert_cmd->pdu_buf_dma != 0) {
4c22e07f 1756 isert_dbg("unmap single for isert_cmd->pdu_buf_dma\n");
dbbc5d11
NB		 1757 ib_dma_unmap_single(ib_dev, isert_cmd->pdu_buf_dma,
1758 isert_cmd->pdu_buf_len, DMA_TO_DEVICE);
1759 isert_cmd->pdu_buf_dma = 0;
b8d26b3b
NB		 1760 }
1761
1762 isert_unmap_tx_desc(tx_desc, ib_dev);
03e7848a 1763 isert_put_cmd(isert_cmd, comp_err);
b8d26b3b
NB		 1764}
1765
96b7973e
SG		 1766static int
1767isert_check_pi_status(struct se_cmd *se_cmd, struct ib_mr *sig_mr)
1768{
1769 struct ib_mr_status mr_status;
1770 int ret;
1771
1772 ret = ib_check_mr_status(sig_mr, IB_MR_CHECK_SIG_STATUS, &mr_status);
1773 if (ret) {
24f412dd 1774 isert_err("ib_check_mr_status failed, ret %d\n", ret);
96b7973e
SG		 1775 goto fail_mr_status;
1776 }
1777
1778 if (mr_status.fail_status & IB_MR_CHECK_SIG_STATUS) {
1779 u64 sec_offset_err;
1780 u32 block_size = se_cmd->se_dev->dev_attrib.block_size + 8;
1781
1782 switch (mr_status.sig_err.err_type) {
1783 case IB_SIG_BAD_GUARD:
1784 se_cmd->pi_err = TCM_LOGICAL_BLOCK_GUARD_CHECK_FAILED;
1785 break;
1786 case IB_SIG_BAD_REFTAG:
1787 se_cmd->pi_err = TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED;
1788 break;
1789 case IB_SIG_BAD_APPTAG:
1790 se_cmd->pi_err = TCM_LOGICAL_BLOCK_APP_TAG_CHECK_FAILED;
1791 break;
1792 }
1793 sec_offset_err = mr_status.sig_err.sig_err_offset;
1794 do_div(sec_offset_err, block_size);
1795 se_cmd->bad_sector = sec_offset_err + se_cmd->t_task_lba;
1796
4c22e07f
SG		 1797 isert_err("PI error found type %d at sector 0x%llx "
1798 "expected 0x%x vs actual 0x%x\n",
1799 mr_status.sig_err.err_type,
1800 (unsigned long long)se_cmd->bad_sector,
1801 mr_status.sig_err.expected,
1802 mr_status.sig_err.actual);
96b7973e
SG		 1803 ret = 1;
1804 }
1805
1806fail_mr_status:
1807 return ret;
1808}
1809
f93f3a70
SG		 1810static void
1811isert_completion_rdma_write(struct iser_tx_desc *tx_desc,
1812 struct isert_cmd *isert_cmd)
1813{
9e961ae7 1814 struct isert_rdma_wr *wr = &isert_cmd->rdma_wr;
f93f3a70 1815 struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd;
9e961ae7 1816 struct se_cmd *se_cmd = &cmd->se_cmd;
f93f3a70
SG		 1817 struct isert_conn *isert_conn = isert_cmd->conn;
1818 struct isert_device *device = isert_conn->conn_device;
9e961ae7
SG		 1819 int ret = 0;
1820
1821 if (wr->fr_desc && wr->fr_desc->ind & ISERT_PROTECTED) {
96b7973e
SG		 1822 ret = isert_check_pi_status(se_cmd,
1823 wr->fr_desc->pi_ctx->sig_mr);
1824 wr->fr_desc->ind &= ~ISERT_PROTECTED;
9e961ae7 1825 }
f93f3a70
SG		 1826
1827 device->unreg_rdma_mem(isert_cmd, isert_conn);
897bb2c9 1828 wr->send_wr_num = 0;
9e961ae7
SG		 1829 if (ret)
1830 transport_send_check_condition_and_sense(se_cmd,
1831 se_cmd->pi_err, 0);
1832 else
1833 isert_put_response(isert_conn->conn, cmd);
f93f3a70
SG		 1834}
1835
b8d26b3b
NB		 1836static void
1837isert_completion_rdma_read(struct iser_tx_desc *tx_desc,
1838 struct isert_cmd *isert_cmd)
1839{
1840 struct isert_rdma_wr *wr = &isert_cmd->rdma_wr;
d703ce2f 1841 struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd;
b8d26b3b 1842 struct se_cmd *se_cmd = &cmd->se_cmd;
90ecc6e2 1843 struct isert_conn *isert_conn = isert_cmd->conn;
d40945d8 1844 struct isert_device *device = isert_conn->conn_device;
5bac4b1a 1845 int ret = 0;
b8d26b3b 1846
9e961ae7 1847 if (wr->fr_desc && wr->fr_desc->ind & ISERT_PROTECTED) {
96b7973e
SG		 1848 ret = isert_check_pi_status(se_cmd,
1849 wr->fr_desc->pi_ctx->sig_mr);
1850 wr->fr_desc->ind &= ~ISERT_PROTECTED;
9e961ae7
SG		 1851 }
1852
b8d26b3b 1853 iscsit_stop_dataout_timer(cmd);
d40945d8 1854 device->unreg_rdma_mem(isert_cmd, isert_conn);
e3d7e4c3 1855 cmd->write_data_done = wr->data.len;
b6b87a1d 1856 wr->send_wr_num = 0;
b8d26b3b 1857
24f412dd 1858 isert_dbg("Cmd: %p RDMA_READ comp calling execute_cmd\n", isert_cmd);
b8d26b3b
NB		 1859 spin_lock_bh(&cmd->istate_lock);
1860 cmd->cmd_flags |= ICF_GOT_LAST_DATAOUT;
1861 cmd->i_state = ISTATE_RECEIVED_LAST_DATAOUT;
1862 spin_unlock_bh(&cmd->istate_lock);
1863
5bac4b1a
SG		 1864 if (ret)
1865 transport_send_check_condition_and_sense(se_cmd,
1866 se_cmd->pi_err, 0);
1867 else
1868 target_execute_cmd(se_cmd);
b8d26b3b
NB		 1869}
1870
1871static void
1872isert_do_control_comp(struct work_struct *work)
1873{
1874 struct isert_cmd *isert_cmd = container_of(work,
1875 struct isert_cmd, comp_work);
1876 struct isert_conn *isert_conn = isert_cmd->conn;
1877 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
d703ce2f 1878 struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd;
b8d26b3b 1879
4c22e07f
SG		 1880 isert_dbg("Cmd %p i_state %d\n", isert_cmd, cmd->i_state);
1881
b8d26b3b
NB		 1882 switch (cmd->i_state) {
1883 case ISTATE_SEND_TASKMGTRSP:
b8d26b3b 1884 iscsit_tmr_post_handler(cmd, cmd->conn);
10633c37
SG		 1885 case ISTATE_SEND_REJECT: /* FALLTHRU */
1886 case ISTATE_SEND_TEXTRSP: /* FALLTHRU */
b8d26b3b 1887 cmd->i_state = ISTATE_SENT_STATUS;
4c22e07f
SG		 1888 isert_completion_put(&isert_cmd->tx_desc, isert_cmd,
1889 ib_dev, false);
3df8f68a 1890 break;
b8d26b3b 1891 case ISTATE_SEND_LOGOUTRSP:
b8d26b3b
NB		 1892 iscsit_logout_post_handler(cmd, cmd->conn);
1893 break;
1894 default:
4c22e07f 1895 isert_err("Unknown i_state %d\n", cmd->i_state);
b8d26b3b
NB		 1896 dump_stack();
1897 break;
1898 }
1899}
1900
1901static void
1902isert_response_completion(struct iser_tx_desc *tx_desc,
1903 struct isert_cmd *isert_cmd,
1904 struct isert_conn *isert_conn,
1905 struct ib_device *ib_dev)
1906{
d703ce2f 1907 struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd;
b8d26b3b
NB		 1908
1909 if (cmd->i_state == ISTATE_SEND_TASKMGTRSP ||
3df8f68a 1910 cmd->i_state == ISTATE_SEND_LOGOUTRSP ||
adb54c29
NB		 1911 cmd->i_state == ISTATE_SEND_REJECT ||
1912 cmd->i_state == ISTATE_SEND_TEXTRSP) {
b8d26b3b
NB		 1913 isert_unmap_tx_desc(tx_desc, ib_dev);
1914
1915 INIT_WORK(&isert_cmd->comp_work, isert_do_control_comp);
1916 queue_work(isert_comp_wq, &isert_cmd->comp_work);
1917 return;
1918 }
897bb2c9 1919
b8d26b3b 1920 cmd->i_state = ISTATE_SENT_STATUS;
03e7848a 1921 isert_completion_put(tx_desc, isert_cmd, ib_dev, false);
b8d26b3b
NB		 1922}
1923
1924static void
68a86dee
SG		 1925isert_send_completion(struct iser_tx_desc *tx_desc,
1926 struct isert_conn *isert_conn)
b8d26b3b
NB		 1927{
1928 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
1929 struct isert_cmd *isert_cmd = tx_desc->isert_cmd;
1930 struct isert_rdma_wr *wr;
1931
1932 if (!isert_cmd) {
b8d26b3b
NB		 1933 isert_unmap_tx_desc(tx_desc, ib_dev);
1934 return;
1935 }
1936 wr = &isert_cmd->rdma_wr;
1937
4c22e07f
SG		 1938 isert_dbg("Cmd %p iser_ib_op %d\n", isert_cmd, wr->iser_ib_op);
1939
b8d26b3b
NB		 1940 switch (wr->iser_ib_op) {
1941 case ISER_IB_RECV:
4c22e07f 1942 isert_err("Got ISER_IB_RECV\n");
b8d26b3b
NB		 1943 dump_stack();
1944 break;
1945 case ISER_IB_SEND:
b8d26b3b
NB		 1946 isert_response_completion(tx_desc, isert_cmd,
1947 isert_conn, ib_dev);
1948 break;
1949 case ISER_IB_RDMA_WRITE:
f93f3a70 1950 isert_completion_rdma_write(tx_desc, isert_cmd);
b8d26b3b
NB		 1951 break;
1952 case ISER_IB_RDMA_READ:
b8d26b3b
NB		 1953 isert_completion_rdma_read(tx_desc, isert_cmd);
1954 break;
1955 default:
4c22e07f 1956 isert_err("Unknown wr->iser_ib_op: 0x%x\n", wr->iser_ib_op);
b8d26b3b
NB		 1957 dump_stack();
1958 break;
1959 }
1960}
1961
6f0fae3d
SG		 1962/**
1963 * is_isert_tx_desc() - Indicate if the completion wr_id
1964 * is a TX descriptor or not.
1965 * @isert_conn: iser connection
1966 * @wr_id: completion WR identifier
1967 *
1968 * Since we cannot rely on wc opcode in FLUSH errors
1969 * we must work around it by checking if the wr_id address
1970 * falls in the iser connection rx_descs buffer. If so
1971 * it is an RX descriptor, otherwize it is a TX.
1972 */
1973static inline bool
1974is_isert_tx_desc(struct isert_conn *isert_conn, void *wr_id)
1975{
1976 void *start = isert_conn->conn_rx_descs;
1977 int len = ISERT_QP_MAX_RECV_DTOS * sizeof(*isert_conn->conn_rx_descs);
1978
1979 if (wr_id >= start && wr_id < start + len)
1980 return false;
1981
1982 return true;
1983}
1984
b8d26b3b 1985static void
6f0fae3d 1986isert_cq_comp_err(struct isert_conn *isert_conn, struct ib_wc *wc)
b8d26b3b 1987{
bdf20e72 1988 if (wc->wr_id == ISER_BEACON_WRID) {
24f412dd 1989 isert_info("conn %p completing conn_wait_comp_err\n",
bdf20e72
SG		 1990 isert_conn);
1991 complete(&isert_conn->conn_wait_comp_err);
ed4520ae 1992 } else if (is_isert_tx_desc(isert_conn, (void *)(uintptr_t)wc->wr_id)) {
df43debd
SG		 1993 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
1994 struct isert_cmd *isert_cmd;
6f0fae3d 1995 struct iser_tx_desc *desc;
df43debd 1996
6f0fae3d
SG		 1997 desc = (struct iser_tx_desc *)(uintptr_t)wc->wr_id;
1998 isert_cmd = desc->isert_cmd;
df43debd
SG		 1999 if (!isert_cmd)
2000 isert_unmap_tx_desc(desc, ib_dev);
2001 else
2002 isert_completion_put(desc, isert_cmd, ib_dev, true);
df43debd
SG		 2003 } else {
2004 isert_conn->post_recv_buf_count--;
bdf20e72
SG		 2005 if (!isert_conn->post_recv_buf_count)
2006 iscsit_cause_connection_reinstatement(isert_conn->conn, 0);
df43debd 2007 }
b8d26b3b
NB		 2008}
2009
2010static void
6f0fae3d 2011isert_handle_wc(struct ib_wc *wc)
b8d26b3b 2012{
b8d26b3b
NB		 2013 struct isert_conn *isert_conn;
2014 struct iser_tx_desc *tx_desc;
6f0fae3d 2015 struct iser_rx_desc *rx_desc;
b8d26b3b 2016
6f0fae3d
SG		 2017 isert_conn = wc->qp->qp_context;
2018 if (likely(wc->status == IB_WC_SUCCESS)) {
2019 if (wc->opcode == IB_WC_RECV) {
2020 rx_desc = (struct iser_rx_desc *)(uintptr_t)wc->wr_id;
2021 isert_rx_completion(rx_desc, isert_conn, wc->byte_len);
b8d26b3b 2022 } else {
6f0fae3d
SG		 2023 tx_desc = (struct iser_tx_desc *)(uintptr_t)wc->wr_id;
2024 isert_send_completion(tx_desc, isert_conn);
b8d26b3b 2025 }
6f0fae3d
SG		 2026 } else {
2027 if (wc->status != IB_WC_WR_FLUSH_ERR)
24f412dd 2028 isert_err("wr id %llx status %d vend_err %x\n",
6f0fae3d
SG		 2029 wc->wr_id, wc->status, wc->vendor_err);
2030 else
24f412dd 2031 isert_dbg("flush error: wr id %llx\n", wc->wr_id);
b8d26b3b 2032
6f0fae3d
SG		 2033 if (wc->wr_id != ISER_FASTREG_LI_WRID)
2034 isert_cq_comp_err(isert_conn, wc);
2035 }
b8d26b3b
NB		 2036}
2037
2038static void
6f0fae3d 2039isert_cq_work(struct work_struct *work)
b8d26b3b 2040{
37d9fe80 2041 enum { isert_poll_budget = 65536 };
4a295bae 2042 struct isert_comp *comp = container_of(work, struct isert_comp,
6f0fae3d 2043 work);
36ea63b5
SG		 2044 struct ib_wc *const wcs = comp->wcs;
2045 int i, n, completed = 0;
b8d26b3b 2046
36ea63b5
SG		 2047 while ((n = ib_poll_cq(comp->cq, ARRAY_SIZE(comp->wcs), wcs)) > 0) {
2048 for (i = 0; i < n; i++)
2049 isert_handle_wc(&wcs[i]);
b8d26b3b 2050
36ea63b5
SG		 2051 completed += n;
2052 if (completed >= isert_poll_budget)
37d9fe80
SG		 2053 break;
2054 }
2055
6f0fae3d 2056 ib_req_notify_cq(comp->cq, IB_CQ_NEXT_COMP);
b8d26b3b
NB		 2057}
2058
2059static void
6f0fae3d 2060isert_cq_callback(struct ib_cq *cq, void *context)
b8d26b3b 2061{
4a295bae 2062 struct isert_comp *comp = context;
b8d26b3b 2063
6f0fae3d 2064 queue_work(isert_comp_wq, &comp->work);
b8d26b3b
NB		 2065}
2066
2067static int
2068isert_post_response(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd)
2069{
2070 struct ib_send_wr *wr_failed;
2071 int ret;
2072
b8d26b3b
NB		 2073 ret = ib_post_send(isert_conn->conn_qp, &isert_cmd->tx_desc.send_wr,
2074 &wr_failed);
2075 if (ret) {
24f412dd 2076 isert_err("ib_post_send failed with %d\n", ret);
b8d26b3b
NB		 2077 return ret;
2078 }
2079 return ret;
2080}
2081
2082static int
2083isert_put_response(struct iscsi_conn *conn, struct iscsi_cmd *cmd)
2084{
d703ce2f 2085 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 2086 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2087 struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr;
2088 struct iscsi_scsi_rsp *hdr = (struct iscsi_scsi_rsp *)
2089 &isert_cmd->tx_desc.iscsi_header;
2090
2091 isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc);
2092 iscsit_build_rsp_pdu(cmd, conn, true, hdr);
2093 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
2094 /*
2095 * Attach SENSE DATA payload to iSCSI Response PDU
2096 */
2097 if (cmd->se_cmd.sense_buffer &&
2098 ((cmd->se_cmd.se_cmd_flags & SCF_TRANSPORT_TASK_SENSE) ||
2099 (cmd->se_cmd.se_cmd_flags & SCF_EMULATED_TASK_SENSE))) {
2100 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
2101 struct ib_sge *tx_dsg = &isert_cmd->tx_desc.tx_sg[1];
dbbc5d11 2102 u32 padding, pdu_len;
b8d26b3b
NB		 2103
2104 put_unaligned_be16(cmd->se_cmd.scsi_sense_length,
2105 cmd->sense_buffer);
2106 cmd->se_cmd.scsi_sense_length += sizeof(__be16);
2107
2108 padding = -(cmd->se_cmd.scsi_sense_length) & 3;
2109 hton24(hdr->dlength, (u32)cmd->se_cmd.scsi_sense_length);
dbbc5d11 2110 pdu_len = cmd->se_cmd.scsi_sense_length + padding;
b8d26b3b 2111
dbbc5d11
NB		 2112 isert_cmd->pdu_buf_dma = ib_dma_map_single(ib_dev,
2113 (void *)cmd->sense_buffer, pdu_len,
b8d26b3b
NB		 2114 DMA_TO_DEVICE);
2115
dbbc5d11
NB		 2116 isert_cmd->pdu_buf_len = pdu_len;
2117 tx_dsg->addr = isert_cmd->pdu_buf_dma;
2118 tx_dsg->length = pdu_len;
b8d26b3b
NB		 2119 tx_dsg->lkey = isert_conn->conn_mr->lkey;
2120 isert_cmd->tx_desc.num_sge = 2;
2121 }
2122
68a86dee 2123 isert_init_send_wr(isert_conn, isert_cmd, send_wr);
b8d26b3b 2124
4c22e07f 2125 isert_dbg("Posting SCSI Response\n");
b8d26b3b
NB		 2126
2127 return isert_post_response(isert_conn, isert_cmd);
2128}
2129
131e6abc
NB		 2130static void
2131isert_aborted_task(struct iscsi_conn *conn, struct iscsi_cmd *cmd)
2132{
2133 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
2134 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2135 struct isert_device *device = isert_conn->conn_device;
2136
2137 spin_lock_bh(&conn->cmd_lock);
2138 if (!list_empty(&cmd->i_conn_node))
2139 list_del_init(&cmd->i_conn_node);
2140 spin_unlock_bh(&conn->cmd_lock);
2141
2142 if (cmd->data_direction == DMA_TO_DEVICE)
2143 iscsit_stop_dataout_timer(cmd);
2144
2145 device->unreg_rdma_mem(isert_cmd, isert_conn);
2146}
2147
e70beee7
NB		 2148static enum target_prot_op
2149isert_get_sup_prot_ops(struct iscsi_conn *conn)
2150{
2151 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2152 struct isert_device *device = isert_conn->conn_device;
2153
23a548ee
SG		 2154 if (conn->tpg->tpg_attrib.t10_pi) {
2155 if (device->pi_capable) {
24f412dd 2156 isert_info("conn %p PI offload enabled\n", isert_conn);
23a548ee
SG		 2157 isert_conn->pi_support = true;
2158 return TARGET_PROT_ALL;
2159 }
2160 }
2161
24f412dd 2162 isert_info("conn %p PI offload disabled\n", isert_conn);
23a548ee 2163 isert_conn->pi_support = false;
e70beee7
NB		 2164
2165 return TARGET_PROT_NORMAL;
2166}
2167
b8d26b3b
NB		 2168static int
2169isert_put_nopin(struct iscsi_cmd *cmd, struct iscsi_conn *conn,
2170 bool nopout_response)
2171{
d703ce2f 2172 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 2173 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2174 struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr;
2175
2176 isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc);
2177 iscsit_build_nopin_rsp(cmd, conn, (struct iscsi_nopin *)
2178 &isert_cmd->tx_desc.iscsi_header,
2179 nopout_response);
2180 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
68a86dee 2181 isert_init_send_wr(isert_conn, isert_cmd, send_wr);
b8d26b3b 2182
4c22e07f 2183 isert_dbg("conn %p Posting NOPIN Response\n", isert_conn);
b8d26b3b
NB		 2184
2185 return isert_post_response(isert_conn, isert_cmd);
2186}
2187
2188static int
2189isert_put_logout_rsp(struct iscsi_cmd *cmd, struct iscsi_conn *conn)
2190{
d703ce2f 2191 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 2192 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2193 struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr;
2194
2195 isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc);
2196 iscsit_build_logout_rsp(cmd, conn, (struct iscsi_logout_rsp *)
2197 &isert_cmd->tx_desc.iscsi_header);
2198 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
68a86dee 2199 isert_init_send_wr(isert_conn, isert_cmd, send_wr);
b8d26b3b 2200
4c22e07f 2201 isert_dbg("conn %p Posting Logout Response\n", isert_conn);
b8d26b3b
NB		 2202
2203 return isert_post_response(isert_conn, isert_cmd);
2204}
2205
2206static int
2207isert_put_tm_rsp(struct iscsi_cmd *cmd, struct iscsi_conn *conn)
2208{
d703ce2f 2209 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 2210 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2211 struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr;
2212
2213 isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc);
2214 iscsit_build_task_mgt_rsp(cmd, conn, (struct iscsi_tm_rsp *)
2215 &isert_cmd->tx_desc.iscsi_header);
2216 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
68a86dee 2217 isert_init_send_wr(isert_conn, isert_cmd, send_wr);
b8d26b3b 2218
4c22e07f 2219 isert_dbg("conn %p Posting Task Management Response\n", isert_conn);
b8d26b3b
NB		 2220
2221 return isert_post_response(isert_conn, isert_cmd);
2222}
2223
2224static int
2225isert_put_reject(struct iscsi_cmd *cmd, struct iscsi_conn *conn)
2226{
d703ce2f 2227 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 2228 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2229 struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr;
3df8f68a
NB		 2230 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
2231 struct ib_sge *tx_dsg = &isert_cmd->tx_desc.tx_sg[1];
2232 struct iscsi_reject *hdr =
2233 (struct iscsi_reject *)&isert_cmd->tx_desc.iscsi_header;
b8d26b3b
NB		 2234
2235 isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc);
3df8f68a 2236 iscsit_build_reject(cmd, conn, hdr);
b8d26b3b 2237 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
3df8f68a
NB		 2238
2239 hton24(hdr->dlength, ISCSI_HDR_LEN);
dbbc5d11 2240 isert_cmd->pdu_buf_dma = ib_dma_map_single(ib_dev,
3df8f68a
NB		 2241 (void *)cmd->buf_ptr, ISCSI_HDR_LEN,
2242 DMA_TO_DEVICE);
dbbc5d11
NB		 2243 isert_cmd->pdu_buf_len = ISCSI_HDR_LEN;
2244 tx_dsg->addr = isert_cmd->pdu_buf_dma;
3df8f68a
NB		 2245 tx_dsg->length = ISCSI_HDR_LEN;
2246 tx_dsg->lkey = isert_conn->conn_mr->lkey;
2247 isert_cmd->tx_desc.num_sge = 2;
2248
68a86dee 2249 isert_init_send_wr(isert_conn, isert_cmd, send_wr);
b8d26b3b 2250
4c22e07f 2251 isert_dbg("conn %p Posting Reject\n", isert_conn);
b8d26b3b
NB		 2252
2253 return isert_post_response(isert_conn, isert_cmd);
2254}
2255
adb54c29
NB		 2256static int
2257isert_put_text_rsp(struct iscsi_cmd *cmd, struct iscsi_conn *conn)
2258{
d703ce2f 2259 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
adb54c29
NB		 2260 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
2261 struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr;
2262 struct iscsi_text_rsp *hdr =
2263 (struct iscsi_text_rsp *)&isert_cmd->tx_desc.iscsi_header;
2264 u32 txt_rsp_len;
2265 int rc;
2266
2267 isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc);
22c7aaa5 2268 rc = iscsit_build_text_rsp(cmd, conn, hdr, ISCSI_INFINIBAND);
adb54c29
NB		 2269 if (rc < 0)
2270 return rc;
2271
2272 txt_rsp_len = rc;
2273 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
2274
2275 if (txt_rsp_len) {
2276 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
2277 struct ib_sge *tx_dsg = &isert_cmd->tx_desc.tx_sg[1];
2278 void *txt_rsp_buf = cmd->buf_ptr;
2279
2280 isert_cmd->pdu_buf_dma = ib_dma_map_single(ib_dev,
2281 txt_rsp_buf, txt_rsp_len, DMA_TO_DEVICE);
2282
2283 isert_cmd->pdu_buf_len = txt_rsp_len;
2284 tx_dsg->addr = isert_cmd->pdu_buf_dma;
2285 tx_dsg->length = txt_rsp_len;
2286 tx_dsg->lkey = isert_conn->conn_mr->lkey;
2287 isert_cmd->tx_desc.num_sge = 2;
2288 }
68a86dee 2289 isert_init_send_wr(isert_conn, isert_cmd, send_wr);
adb54c29 2290
f64d2792 2291 isert_dbg("conn %p Text Response\n", isert_conn);
adb54c29
NB		 2292
2293 return isert_post_response(isert_conn, isert_cmd);
2294}
2295
b8d26b3b
NB		 2296static int
2297isert_build_rdma_wr(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd,
2298 struct ib_sge *ib_sge, struct ib_send_wr *send_wr,
2299 u32 data_left, u32 offset)
2300{
d703ce2f 2301 struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd;
b8d26b3b
NB		 2302 struct scatterlist *sg_start, *tmp_sg;
2303 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
2304 u32 sg_off, page_off;
2305 int i = 0, sg_nents;
2306
2307 sg_off = offset / PAGE_SIZE;
2308 sg_start = &cmd->se_cmd.t_data_sg[sg_off];
2309 sg_nents = min(cmd->se_cmd.t_data_nents - sg_off, isert_conn->max_sge);
2310 page_off = offset % PAGE_SIZE;
2311
2312 send_wr->sg_list = ib_sge;
2313 send_wr->num_sge = sg_nents;
b0a191e7 2314 send_wr->wr_id = (uintptr_t)&isert_cmd->tx_desc;
b8d26b3b
NB		 2315 /*
2316 * Perform mapping of TCM scatterlist memory ib_sge dma_addr.
2317 */
2318 for_each_sg(sg_start, tmp_sg, sg_nents, i) {
4c22e07f
SG		 2319 isert_dbg("RDMA from SGL dma_addr: 0x%llx dma_len: %u, "
2320 "page_off: %u\n",
2321 (unsigned long long)tmp_sg->dma_address,
2322 tmp_sg->length, page_off);
b8d26b3b
NB		 2323
2324 ib_sge->addr = ib_sg_dma_address(ib_dev, tmp_sg) + page_off;
2325 ib_sge->length = min_t(u32, data_left,
2326 ib_sg_dma_len(ib_dev, tmp_sg) - page_off);
2327 ib_sge->lkey = isert_conn->conn_mr->lkey;
2328
4c22e07f
SG		 2329 isert_dbg("RDMA ib_sge: addr: 0x%llx length: %u lkey: %x\n",
2330 ib_sge->addr, ib_sge->length, ib_sge->lkey);
b8d26b3b
NB		 2331 page_off = 0;
2332 data_left -= ib_sge->length;
2333 ib_sge++;
24f412dd 2334 isert_dbg("Incrementing ib_sge pointer to %p\n", ib_sge);
b8d26b3b
NB		 2335 }
2336
24f412dd 2337 isert_dbg("Set outgoing sg_list: %p num_sg: %u from TCM SGLs\n",
4c22e07f 2338 send_wr->sg_list, send_wr->num_sge);
b8d26b3b
NB		 2339
2340 return sg_nents;
2341}
2342
2343static int
90ecc6e2
VP		 2344isert_map_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd,
2345 struct isert_rdma_wr *wr)
b8d26b3b
NB		 2346{
2347 struct se_cmd *se_cmd = &cmd->se_cmd;
d703ce2f 2348 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b 2349 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
e3d7e4c3 2350 struct isert_data_buf *data = &wr->data;
90ecc6e2 2351 struct ib_send_wr *send_wr;
b8d26b3b 2352 struct ib_sge *ib_sge;
e3d7e4c3
SG		 2353 u32 offset, data_len, data_left, rdma_write_max, va_offset = 0;
2354 int ret = 0, i, ib_sge_cnt;
90ecc6e2 2355
e3d7e4c3 2356 isert_cmd->tx_desc.isert_cmd = isert_cmd;
b8d26b3b 2357
e3d7e4c3
SG		 2358 offset = wr->iser_ib_op == ISER_IB_RDMA_READ ? cmd->write_data_done : 0;
2359 ret = isert_map_data_buf(isert_conn, isert_cmd, se_cmd->t_data_sg,
2360 se_cmd->t_data_nents, se_cmd->data_length,
2361 offset, wr->iser_ib_op, &wr->data);
2362 if (ret)
2363 return ret;
b8d26b3b 2364
e3d7e4c3
SG		 2365 data_left = data->len;
2366 offset = data->offset;
b8d26b3b 2367
e3d7e4c3 2368 ib_sge = kzalloc(sizeof(struct ib_sge) * data->nents, GFP_KERNEL);
b8d26b3b 2369 if (!ib_sge) {
24f412dd 2370 isert_warn("Unable to allocate ib_sge\n");
b8d26b3b 2371 ret = -ENOMEM;
e3d7e4c3 2372 goto unmap_cmd;
b8d26b3b 2373 }
90ecc6e2 2374 wr->ib_sge = ib_sge;
b8d26b3b 2375
e3d7e4c3 2376 wr->send_wr_num = DIV_ROUND_UP(data->nents, isert_conn->max_sge);
b8d26b3b
NB		 2377 wr->send_wr = kzalloc(sizeof(struct ib_send_wr) * wr->send_wr_num,
2378 GFP_KERNEL);
2379 if (!wr->send_wr) {
24f412dd 2380 isert_dbg("Unable to allocate wr->send_wr\n");
b8d26b3b 2381 ret = -ENOMEM;
e3d7e4c3 2382 goto unmap_cmd;
b8d26b3b 2383 }
b8d26b3b
NB		 2384
2385 wr->isert_cmd = isert_cmd;
2386 rdma_write_max = isert_conn->max_sge * PAGE_SIZE;
b8d26b3b
NB		 2387
2388 for (i = 0; i < wr->send_wr_num; i++) {
2389 send_wr = &isert_cmd->rdma_wr.send_wr[i];
2390 data_len = min(data_left, rdma_write_max);
2391
b8d26b3b 2392 send_wr->send_flags = 0;
90ecc6e2
VP		 2393 if (wr->iser_ib_op == ISER_IB_RDMA_WRITE) {
2394 send_wr->opcode = IB_WR_RDMA_WRITE;
2395 send_wr->wr.rdma.remote_addr = isert_cmd->read_va + offset;
2396 send_wr->wr.rdma.rkey = isert_cmd->read_stag;
2397 if (i + 1 == wr->send_wr_num)
2398 send_wr->next = &isert_cmd->tx_desc.send_wr;
2399 else
2400 send_wr->next = &wr->send_wr[i + 1];
2401 } else {
2402 send_wr->opcode = IB_WR_RDMA_READ;
2403 send_wr->wr.rdma.remote_addr = isert_cmd->write_va + va_offset;
2404 send_wr->wr.rdma.rkey = isert_cmd->write_stag;
2405 if (i + 1 == wr->send_wr_num)
2406 send_wr->send_flags = IB_SEND_SIGNALED;
2407 else
2408 send_wr->next = &wr->send_wr[i + 1];
2409 }
b8d26b3b
NB		 2410
2411 ib_sge_cnt = isert_build_rdma_wr(isert_conn, isert_cmd, ib_sge,
2412 send_wr, data_len, offset);
2413 ib_sge += ib_sge_cnt;
2414
b8d26b3b 2415 offset += data_len;
90ecc6e2 2416 va_offset += data_len;
b8d26b3b
NB		 2417 data_left -= data_len;
2418 }
90ecc6e2
VP		 2419
2420 return 0;
e3d7e4c3
SG		 2421unmap_cmd:
2422 isert_unmap_data_buf(isert_conn, data);
2423
90ecc6e2
VP		 2424 return ret;
2425}
2426
59464ef4
VP		 2427static int
2428isert_map_fr_pagelist(struct ib_device *ib_dev,
2429 struct scatterlist *sg_start, int sg_nents, u64 *fr_pl)
2430{
2431 u64 start_addr, end_addr, page, chunk_start = 0;
2432 struct scatterlist *tmp_sg;
2433 int i = 0, new_chunk, last_ent, n_pages;
2434
2435 n_pages = 0;
2436 new_chunk = 1;
2437 last_ent = sg_nents - 1;
2438 for_each_sg(sg_start, tmp_sg, sg_nents, i) {
2439 start_addr = ib_sg_dma_address(ib_dev, tmp_sg);
2440 if (new_chunk)
2441 chunk_start = start_addr;
2442 end_addr = start_addr + ib_sg_dma_len(ib_dev, tmp_sg);
2443
4c22e07f
SG		 2444 isert_dbg("SGL[%d] dma_addr: 0x%llx len: %u\n",
2445 i, (unsigned long long)tmp_sg->dma_address,
2446 tmp_sg->length);
59464ef4
VP		 2447
2448 if ((end_addr & ~PAGE_MASK) && i < last_ent) {
2449 new_chunk = 0;
2450 continue;
2451 }
2452 new_chunk = 1;
2453
2454 page = chunk_start & PAGE_MASK;
2455 do {
2456 fr_pl[n_pages++] = page;
4c22e07f
SG		 2457 isert_dbg("Mapped page_list[%d] page_addr: 0x%llx\n",
2458 n_pages - 1, page);
59464ef4
VP		 2459 page += PAGE_SIZE;
2460 } while (page < end_addr);
2461 }
2462
2463 return n_pages;
2464}
2465
10633c37
SG		 2466static inline void
2467isert_inv_rkey(struct ib_send_wr *inv_wr, struct ib_mr *mr)
2468{
2469 u32 rkey;
2470
2471 memset(inv_wr, 0, sizeof(*inv_wr));
2472 inv_wr->wr_id = ISER_FASTREG_LI_WRID;
2473 inv_wr->opcode = IB_WR_LOCAL_INV;
2474 inv_wr->ex.invalidate_rkey = mr->rkey;
2475
2476 /* Bump the key */
2477 rkey = ib_inc_rkey(mr->rkey);
2478 ib_update_fast_reg_key(mr, rkey);
2479}
2480
59464ef4 2481static int
e3d7e4c3
SG		 2482isert_fast_reg_mr(struct isert_conn *isert_conn,
2483 struct fast_reg_descriptor *fr_desc,
2484 struct isert_data_buf *mem,
9e961ae7 2485 enum isert_indicator ind,
e3d7e4c3 2486 struct ib_sge *sge)
59464ef4 2487{
59464ef4 2488 struct ib_device *ib_dev = isert_conn->conn_cm_id->device;
9e961ae7
SG		 2489 struct ib_mr *mr;
2490 struct ib_fast_reg_page_list *frpl;
59464ef4
VP		 2491 struct ib_send_wr fr_wr, inv_wr;
2492 struct ib_send_wr *bad_wr, *wr = NULL;
9bd626e7
SG		 2493 int ret, pagelist_len;
2494 u32 page_off;
59464ef4 2495
e3d7e4c3
SG		 2496 if (mem->dma_nents == 1) {
2497 sge->lkey = isert_conn->conn_mr->lkey;
2498 sge->addr = ib_sg_dma_address(ib_dev, &mem->sg[0]);
2499 sge->length = ib_sg_dma_len(ib_dev, &mem->sg[0]);
4c22e07f
SG		 2500 isert_dbg("sge: addr: 0x%llx length: %u lkey: %x\n",
2501 sge->addr, sge->length, sge->lkey);
e3d7e4c3
SG		 2502 return 0;
2503 }
2504
9e961ae7
SG		 2505 if (ind == ISERT_DATA_KEY_VALID) {
2506 /* Registering data buffer */
2507 mr = fr_desc->data_mr;
2508 frpl = fr_desc->data_frpl;
2509 } else {
2510 /* Registering protection buffer */
2511 mr = fr_desc->pi_ctx->prot_mr;
2512 frpl = fr_desc->pi_ctx->prot_frpl;
2513 }
2514
e3d7e4c3 2515 page_off = mem->offset % PAGE_SIZE;
59464ef4 2516
24f412dd 2517 isert_dbg("Use fr_desc %p sg_nents %d offset %u\n",
4c22e07f 2518 fr_desc, mem->nents, mem->offset);
59464ef4 2519
e3d7e4c3 2520 pagelist_len = isert_map_fr_pagelist(ib_dev, mem->sg, mem->nents,
9e961ae7 2521 &frpl->page_list[0]);
59464ef4 2522
10633c37
SG		 2523 if (!(fr_desc->ind & ind)) {
2524 isert_inv_rkey(&inv_wr, mr);
59464ef4 2525 wr = &inv_wr;
59464ef4
VP		 2526 }
2527
2528 /* Prepare FASTREG WR */
2529 memset(&fr_wr, 0, sizeof(fr_wr));
9bb4ca68 2530 fr_wr.wr_id = ISER_FASTREG_LI_WRID;
59464ef4 2531 fr_wr.opcode = IB_WR_FAST_REG_MR;
9e961ae7
SG		 2532 fr_wr.wr.fast_reg.iova_start = frpl->page_list[0] + page_off;
2533 fr_wr.wr.fast_reg.page_list = frpl;
59464ef4
VP		 2534 fr_wr.wr.fast_reg.page_list_len = pagelist_len;
2535 fr_wr.wr.fast_reg.page_shift = PAGE_SHIFT;
e3d7e4c3 2536 fr_wr.wr.fast_reg.length = mem->len;
9e961ae7 2537 fr_wr.wr.fast_reg.rkey = mr->rkey;
59464ef4
VP		 2538 fr_wr.wr.fast_reg.access_flags = IB_ACCESS_LOCAL_WRITE;
2539
2540 if (!wr)
2541 wr = &fr_wr;
2542 else
2543 wr->next = &fr_wr;
2544
2545 ret = ib_post_send(isert_conn->conn_qp, wr, &bad_wr);
2546 if (ret) {
24f412dd 2547 isert_err("fast registration failed, ret:%d\n", ret);
59464ef4
VP		 2548 return ret;
2549 }
9e961ae7 2550 fr_desc->ind &= ~ind;
59464ef4 2551
9e961ae7
SG		 2552 sge->lkey = mr->lkey;
2553 sge->addr = frpl->page_list[0] + page_off;
e3d7e4c3 2554 sge->length = mem->len;
59464ef4 2555
4c22e07f
SG		 2556 isert_dbg("sge: addr: 0x%llx length: %u lkey: %x\n",
2557 sge->addr, sge->length, sge->lkey);
9e961ae7
SG		 2558
2559 return ret;
2560}
2561
3d73cf1a
SG		 2562static inline void
2563isert_set_dif_domain(struct se_cmd *se_cmd, struct ib_sig_attrs *sig_attrs,
2564 struct ib_sig_domain *domain)
2565{
78eda2bb 2566 domain->sig_type = IB_SIG_TYPE_T10_DIF;
3d73cf1a
SG		 2567 domain->sig.dif.bg_type = IB_T10DIF_CRC;
2568 domain->sig.dif.pi_interval = se_cmd->se_dev->dev_attrib.block_size;
2569 domain->sig.dif.ref_tag = se_cmd->reftag_seed;
78eda2bb
SG		 2570 /*
2571 * At the moment we hard code those, but if in the future
2572 * the target core would like to use it, we will take it
2573 * from se_cmd.
2574 */
2575 domain->sig.dif.apptag_check_mask = 0xffff;
2576 domain->sig.dif.app_escape = true;
2577 domain->sig.dif.ref_escape = true;
2578 if (se_cmd->prot_type == TARGET_DIF_TYPE1_PROT ||
2579 se_cmd->prot_type == TARGET_DIF_TYPE2_PROT)
2580 domain->sig.dif.ref_remap = true;
3d73cf1a
SG		 2581};
2582
9e961ae7
SG		 2583static int
2584isert_set_sig_attrs(struct se_cmd *se_cmd, struct ib_sig_attrs *sig_attrs)
2585{
9e961ae7
SG		 2586 switch (se_cmd->prot_op) {
2587 case TARGET_PROT_DIN_INSERT:
2588 case TARGET_PROT_DOUT_STRIP:
78eda2bb 2589 sig_attrs->mem.sig_type = IB_SIG_TYPE_NONE;
3d73cf1a 2590 isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->wire);
9e961ae7
SG		 2591 break;
2592 case TARGET_PROT_DOUT_INSERT:
2593 case TARGET_PROT_DIN_STRIP:
78eda2bb 2594 sig_attrs->wire.sig_type = IB_SIG_TYPE_NONE;
3d73cf1a 2595 isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->mem);
9e961ae7
SG		 2596 break;
2597 case TARGET_PROT_DIN_PASS:
2598 case TARGET_PROT_DOUT_PASS:
3d73cf1a
SG		 2599 isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->wire);
2600 isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->mem);
9e961ae7
SG		 2601 break;
2602 default:
24f412dd 2603 isert_err("Unsupported PI operation %d\n", se_cmd->prot_op);
9e961ae7
SG		 2604 return -EINVAL;
2605 }
2606
2607 return 0;
2608}
2609
2610static inline u8
2611isert_set_prot_checks(u8 prot_checks)
2612{
2613 return (prot_checks & TARGET_DIF_CHECK_GUARD ? 0xc0 : 0) |
2614 (prot_checks & TARGET_DIF_CHECK_REFTAG ? 0x30 : 0) |
2615 (prot_checks & TARGET_DIF_CHECK_REFTAG ? 0x0f : 0);
2616}
2617
2618static int
570db170
SG		 2619isert_reg_sig_mr(struct isert_conn *isert_conn,
2620 struct se_cmd *se_cmd,
2621 struct isert_rdma_wr *rdma_wr,
2622 struct fast_reg_descriptor *fr_desc)
9e961ae7
SG		 2623{
2624 struct ib_send_wr sig_wr, inv_wr;
2625 struct ib_send_wr *bad_wr, *wr = NULL;
2626 struct pi_context *pi_ctx = fr_desc->pi_ctx;
2627 struct ib_sig_attrs sig_attrs;
2628 int ret;
9e961ae7
SG		 2629
2630 memset(&sig_attrs, 0, sizeof(sig_attrs));
2631 ret = isert_set_sig_attrs(se_cmd, &sig_attrs);
2632 if (ret)
2633 goto err;
59464ef4 2634
9e961ae7
SG		 2635 sig_attrs.check_mask = isert_set_prot_checks(se_cmd->prot_checks);
2636
2637 if (!(fr_desc->ind & ISERT_SIG_KEY_VALID)) {
10633c37 2638 isert_inv_rkey(&inv_wr, pi_ctx->sig_mr);
9e961ae7 2639 wr = &inv_wr;
9e961ae7
SG		 2640 }
2641
2642 memset(&sig_wr, 0, sizeof(sig_wr));
2643 sig_wr.opcode = IB_WR_REG_SIG_MR;
c2caa207 2644 sig_wr.wr_id = ISER_FASTREG_LI_WRID;
570db170 2645 sig_wr.sg_list = &rdma_wr->ib_sg[DATA];
9e961ae7
SG		 2646 sig_wr.num_sge = 1;
2647 sig_wr.wr.sig_handover.access_flags = IB_ACCESS_LOCAL_WRITE;
2648 sig_wr.wr.sig_handover.sig_attrs = &sig_attrs;
2649 sig_wr.wr.sig_handover.sig_mr = pi_ctx->sig_mr;
2650 if (se_cmd->t_prot_sg)
570db170 2651 sig_wr.wr.sig_handover.prot = &rdma_wr->ib_sg[PROT];
9e961ae7
SG		 2652
2653 if (!wr)
2654 wr = &sig_wr;
2655 else
2656 wr->next = &sig_wr;
2657
2658 ret = ib_post_send(isert_conn->conn_qp, wr, &bad_wr);
2659 if (ret) {
24f412dd 2660 isert_err("fast registration failed, ret:%d\n", ret);
9e961ae7
SG		 2661 goto err;
2662 }
2663 fr_desc->ind &= ~ISERT_SIG_KEY_VALID;
2664
570db170
SG		 2665 rdma_wr->ib_sg[SIG].lkey = pi_ctx->sig_mr->lkey;
2666 rdma_wr->ib_sg[SIG].addr = 0;
2667 rdma_wr->ib_sg[SIG].length = se_cmd->data_length;
9e961ae7
SG		 2668 if (se_cmd->prot_op != TARGET_PROT_DIN_STRIP &&
2669 se_cmd->prot_op != TARGET_PROT_DOUT_INSERT)
2670 /*
2671 * We have protection guards on the wire
2672 * so we need to set a larget transfer
2673 */
570db170 2674 rdma_wr->ib_sg[SIG].length += se_cmd->prot_length;
9e961ae7 2675
24f412dd 2676 isert_dbg("sig_sge: addr: 0x%llx length: %u lkey: %x\n",
570db170
SG		 2677 rdma_wr->ib_sg[SIG].addr, rdma_wr->ib_sg[SIG].length,
2678 rdma_wr->ib_sg[SIG].lkey);
9e961ae7 2679err:
59464ef4
VP		 2680 return ret;
2681}
2682
570db170
SG		 2683static int
2684isert_handle_prot_cmd(struct isert_conn *isert_conn,
2685 struct isert_cmd *isert_cmd,
2686 struct isert_rdma_wr *wr)
2687{
2688 struct isert_device *device = isert_conn->conn_device;
2689 struct se_cmd *se_cmd = &isert_cmd->iscsi_cmd->se_cmd;
2690 int ret;
2691
2692 if (!wr->fr_desc->pi_ctx) {
2693 ret = isert_create_pi_ctx(wr->fr_desc,
2694 device->ib_device,
2695 isert_conn->conn_pd);
2696 if (ret) {
24f412dd 2697 isert_err("conn %p failed to allocate pi_ctx\n",
570db170
SG		 2698 isert_conn);
2699 return ret;
2700 }
2701 }
2702
2703 if (se_cmd->t_prot_sg) {
2704 ret = isert_map_data_buf(isert_conn, isert_cmd,
2705 se_cmd->t_prot_sg,
2706 se_cmd->t_prot_nents,
2707 se_cmd->prot_length,
2708 0, wr->iser_ib_op, &wr->prot);
2709 if (ret) {
24f412dd 2710 isert_err("conn %p failed to map protection buffer\n",
570db170
SG		 2711 isert_conn);
2712 return ret;
2713 }
2714
2715 memset(&wr->ib_sg[PROT], 0, sizeof(wr->ib_sg[PROT]));
2716 ret = isert_fast_reg_mr(isert_conn, wr->fr_desc, &wr->prot,
2717 ISERT_PROT_KEY_VALID, &wr->ib_sg[PROT]);
2718 if (ret) {
24f412dd 2719 isert_err("conn %p failed to fast reg mr\n",
570db170
SG		 2720 isert_conn);
2721 goto unmap_prot_cmd;
2722 }
2723 }
2724
2725 ret = isert_reg_sig_mr(isert_conn, se_cmd, wr, wr->fr_desc);
2726 if (ret) {
24f412dd 2727 isert_err("conn %p failed to fast reg mr\n",
570db170
SG		 2728 isert_conn);
2729 goto unmap_prot_cmd;
2730 }
2731 wr->fr_desc->ind |= ISERT_PROTECTED;
2732
2733 return 0;
2734
2735unmap_prot_cmd:
2736 if (se_cmd->t_prot_sg)
2737 isert_unmap_data_buf(isert_conn, &wr->prot);
2738
2739 return ret;
2740}
2741
59464ef4 2742static int
a3a5a826
SG		 2743isert_reg_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd,
2744 struct isert_rdma_wr *wr)
59464ef4
VP		 2745{
2746 struct se_cmd *se_cmd = &cmd->se_cmd;
2747 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
e3d7e4c3 2748 struct isert_conn *isert_conn = conn->context;
e3d7e4c3 2749 struct fast_reg_descriptor *fr_desc = NULL;
570db170
SG		 2750 struct ib_send_wr *send_wr;
2751 struct ib_sge *ib_sg;
e3d7e4c3
SG		 2752 u32 offset;
2753 int ret = 0;
59464ef4
VP		 2754 unsigned long flags;
2755
e3d7e4c3 2756 isert_cmd->tx_desc.isert_cmd = isert_cmd;
59464ef4 2757
e3d7e4c3
SG		 2758 offset = wr->iser_ib_op == ISER_IB_RDMA_READ ? cmd->write_data_done : 0;
2759 ret = isert_map_data_buf(isert_conn, isert_cmd, se_cmd->t_data_sg,
2760 se_cmd->t_data_nents, se_cmd->data_length,
2761 offset, wr->iser_ib_op, &wr->data);
2762 if (ret)
2763 return ret;
59464ef4 2764
302cc7c3 2765 if (wr->data.dma_nents != 1 || isert_prot_cmd(isert_conn, se_cmd)) {
e3d7e4c3
SG		 2766 spin_lock_irqsave(&isert_conn->conn_lock, flags);
2767 fr_desc = list_first_entry(&isert_conn->conn_fr_pool,
2768 struct fast_reg_descriptor, list);
2769 list_del(&fr_desc->list);
2770 spin_unlock_irqrestore(&isert_conn->conn_lock, flags);
2771 wr->fr_desc = fr_desc;
59464ef4 2772 }
59464ef4 2773
9e961ae7 2774 ret = isert_fast_reg_mr(isert_conn, fr_desc, &wr->data,
570db170 2775 ISERT_DATA_KEY_VALID, &wr->ib_sg[DATA]);
e3d7e4c3
SG		 2776 if (ret)
2777 goto unmap_cmd;
59464ef4 2778
302cc7c3 2779 if (isert_prot_cmd(isert_conn, se_cmd)) {
570db170 2780 ret = isert_handle_prot_cmd(isert_conn, isert_cmd, wr);
9e961ae7 2781 if (ret)
570db170 2782 goto unmap_cmd;
9e961ae7 2783
570db170
SG		 2784 ib_sg = &wr->ib_sg[SIG];
2785 } else {
2786 ib_sg = &wr->ib_sg[DATA];
2787 }
9e961ae7 2788
570db170 2789 memcpy(&wr->s_ib_sge, ib_sg, sizeof(*ib_sg));
e3d7e4c3 2790 wr->ib_sge = &wr->s_ib_sge;
59464ef4
VP		 2791 wr->send_wr_num = 1;
2792 memset(&wr->s_send_wr, 0, sizeof(*send_wr));
2793 wr->send_wr = &wr->s_send_wr;
59464ef4 2794 wr->isert_cmd = isert_cmd;
59464ef4
VP		 2795
2796 send_wr = &isert_cmd->rdma_wr.s_send_wr;
e3d7e4c3 2797 send_wr->sg_list = &wr->s_ib_sge;
59464ef4 2798 send_wr->num_sge = 1;
b0a191e7 2799 send_wr->wr_id = (uintptr_t)&isert_cmd->tx_desc;
59464ef4
VP		 2800 if (wr->iser_ib_op == ISER_IB_RDMA_WRITE) {
2801 send_wr->opcode = IB_WR_RDMA_WRITE;
2802 send_wr->wr.rdma.remote_addr = isert_cmd->read_va;
2803 send_wr->wr.rdma.rkey = isert_cmd->read_stag;
302cc7c3 2804 send_wr->send_flags = !isert_prot_cmd(isert_conn, se_cmd) ?
9e961ae7 2805 0 : IB_SEND_SIGNALED;
59464ef4
VP		 2806 } else {
2807 send_wr->opcode = IB_WR_RDMA_READ;
2808 send_wr->wr.rdma.remote_addr = isert_cmd->write_va;
2809 send_wr->wr.rdma.rkey = isert_cmd->write_stag;
2810 send_wr->send_flags = IB_SEND_SIGNALED;
2811 }
2812
e3d7e4c3 2813 return 0;
570db170 2814
e3d7e4c3
SG		 2815unmap_cmd:
2816 if (fr_desc) {
f01b9f73 2817 spin_lock_irqsave(&isert_conn->conn_lock, flags);
e3d7e4c3 2818 list_add_tail(&fr_desc->list, &isert_conn->conn_fr_pool);
f01b9f73 2819 spin_unlock_irqrestore(&isert_conn->conn_lock, flags);
59464ef4 2820 }
e3d7e4c3 2821 isert_unmap_data_buf(isert_conn, &wr->data);
59464ef4 2822
59464ef4
VP		 2823 return ret;
2824}
2825
90ecc6e2
VP		 2826static int
2827isert_put_datain(struct iscsi_conn *conn, struct iscsi_cmd *cmd)
2828{
2829 struct se_cmd *se_cmd = &cmd->se_cmd;
59464ef4 2830 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
90ecc6e2
VP		 2831 struct isert_rdma_wr *wr = &isert_cmd->rdma_wr;
2832 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
d40945d8 2833 struct isert_device *device = isert_conn->conn_device;
90ecc6e2
VP		 2834 struct ib_send_wr *wr_failed;
2835 int rc;
2836
24f412dd 2837 isert_dbg("Cmd: %p RDMA_WRITE data_length: %u\n",
90ecc6e2 2838 isert_cmd, se_cmd->data_length);
4c22e07f 2839
90ecc6e2 2840 wr->iser_ib_op = ISER_IB_RDMA_WRITE;
d40945d8 2841 rc = device->reg_rdma_mem(conn, cmd, wr);
90ecc6e2 2842 if (rc) {
24f412dd 2843 isert_err("Cmd: %p failed to prepare RDMA res\n", isert_cmd);
90ecc6e2
VP		 2844 return rc;
2845 }
2846
302cc7c3 2847 if (!isert_prot_cmd(isert_conn, se_cmd)) {
9e961ae7
SG		 2848 /*
2849 * Build isert_conn->tx_desc for iSCSI response PDU and attach
2850 */
2851 isert_create_send_desc(isert_conn, isert_cmd,
2852 &isert_cmd->tx_desc);
2853 iscsit_build_rsp_pdu(cmd, conn, true, (struct iscsi_scsi_rsp *)
2854 &isert_cmd->tx_desc.iscsi_header);
2855 isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc);
2856 isert_init_send_wr(isert_conn, isert_cmd,
68a86dee 2857 &isert_cmd->tx_desc.send_wr);
9e961ae7 2858 isert_cmd->rdma_wr.s_send_wr.next = &isert_cmd->tx_desc.send_wr;
897bb2c9 2859 wr->send_wr_num += 1;
9e961ae7 2860 }
b8d26b3b 2861
b8d26b3b 2862 rc = ib_post_send(isert_conn->conn_qp, wr->send_wr, &wr_failed);
bdf20e72 2863 if (rc)
24f412dd 2864 isert_warn("ib_post_send() failed for IB_WR_RDMA_WRITE\n");
9e961ae7 2865
302cc7c3 2866 if (!isert_prot_cmd(isert_conn, se_cmd))
24f412dd 2867 isert_dbg("Cmd: %p posted RDMA_WRITE + Response for iSER Data "
9e961ae7
SG		 2868 "READ\n", isert_cmd);
2869 else
24f412dd 2870 isert_dbg("Cmd: %p posted RDMA_WRITE for iSER Data READ\n",
9e961ae7 2871 isert_cmd);
b8d26b3b 2872
90ecc6e2 2873 return 1;
b8d26b3b
NB		 2874}
2875
2876static int
2877isert_get_dataout(struct iscsi_conn *conn, struct iscsi_cmd *cmd, bool recovery)
2878{
2879 struct se_cmd *se_cmd = &cmd->se_cmd;
d703ce2f 2880 struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd);
b8d26b3b
NB		 2881 struct isert_rdma_wr *wr = &isert_cmd->rdma_wr;
2882 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
d40945d8 2883 struct isert_device *device = isert_conn->conn_device;
90ecc6e2
VP		 2884 struct ib_send_wr *wr_failed;
2885 int rc;
b8d26b3b 2886
24f412dd 2887 isert_dbg("Cmd: %p RDMA_READ data_length: %u write_data_done: %u\n",
90ecc6e2 2888 isert_cmd, se_cmd->data_length, cmd->write_data_done);
b8d26b3b 2889 wr->iser_ib_op = ISER_IB_RDMA_READ;
d40945d8 2890 rc = device->reg_rdma_mem(conn, cmd, wr);
90ecc6e2 2891 if (rc) {
24f412dd 2892 isert_err("Cmd: %p failed to prepare RDMA res\n", isert_cmd);
90ecc6e2 2893 return rc;
b8d26b3b
NB		 2894 }
2895
b8d26b3b 2896 rc = ib_post_send(isert_conn->conn_qp, wr->send_wr, &wr_failed);
bdf20e72 2897 if (rc)
24f412dd 2898 isert_warn("ib_post_send() failed for IB_WR_RDMA_READ\n");
bdf20e72 2899
24f412dd 2900 isert_dbg("Cmd: %p posted RDMA_READ memory for ISER Data WRITE\n",
90ecc6e2 2901 isert_cmd);
b8d26b3b 2902
90ecc6e2 2903 return 0;
b8d26b3b
NB		 2904}
2905
2906static int
2907isert_immediate_queue(struct iscsi_conn *conn, struct iscsi_cmd *cmd, int state)
2908{
2909 int ret;
2910
2911 switch (state) {
2912 case ISTATE_SEND_NOPIN_WANT_RESPONSE:
2913 ret = isert_put_nopin(cmd, conn, false);
2914 break;
2915 default:
24f412dd 2916 isert_err("Unknown immediate state: 0x%02x\n", state);
b8d26b3b
NB		 2917 ret = -EINVAL;
2918 break;
2919 }
2920
2921 return ret;
2922}
2923
2924static int
2925isert_response_queue(struct iscsi_conn *conn, struct iscsi_cmd *cmd, int state)
2926{
991bb764 2927 struct isert_conn *isert_conn = conn->context;
b8d26b3b
NB		 2928 int ret;
2929
2930 switch (state) {
2931 case ISTATE_SEND_LOGOUTRSP:
2932 ret = isert_put_logout_rsp(cmd, conn);
991bb764
SG		 2933 if (!ret)
2934 isert_conn->logout_posted = true;
b8d26b3b
NB		 2935 break;
2936 case ISTATE_SEND_NOPIN:
2937 ret = isert_put_nopin(cmd, conn, true);
2938 break;
2939 case ISTATE_SEND_TASKMGTRSP:
2940 ret = isert_put_tm_rsp(cmd, conn);
2941 break;
2942 case ISTATE_SEND_REJECT:
2943 ret = isert_put_reject(cmd, conn);
2944 break;
adb54c29
NB		 2945 case ISTATE_SEND_TEXTRSP:
2946 ret = isert_put_text_rsp(cmd, conn);
2947 break;
b8d26b3b
NB		 2948 case ISTATE_SEND_STATUS:
2949 /*
2950 * Special case for sending non GOOD SCSI status from TX thread
2951 * context during pre se_cmd excecution failure.
2952 */
2953 ret = isert_put_response(conn, cmd);
2954 break;
2955 default:
24f412dd 2956 isert_err("Unknown response state: 0x%02x\n", state);
b8d26b3b
NB		 2957 ret = -EINVAL;
2958 break;
2959 }
2960
2961 return ret;
2962}
2963
ca6c1d82
SG		 2964struct rdma_cm_id *
2965isert_setup_id(struct isert_np *isert_np)
2966{
2967 struct iscsi_np *np = isert_np->np;
2968 struct rdma_cm_id *id;
2969 struct sockaddr *sa;
2970 int ret;
2971
2972 sa = (struct sockaddr *)&np->np_sockaddr;
24f412dd 2973 isert_dbg("ksockaddr: %p, sa: %p\n", &np->np_sockaddr, sa);
ca6c1d82
SG		 2974
2975 id = rdma_create_id(isert_cma_handler, isert_np,
2976 RDMA_PS_TCP, IB_QPT_RC);
2977 if (IS_ERR(id)) {
24f412dd 2978 isert_err("rdma_create_id() failed: %ld\n", PTR_ERR(id));
ca6c1d82
SG		 2979 ret = PTR_ERR(id);
2980 goto out;
2981 }
24f412dd 2982 isert_dbg("id %p context %p\n", id, id->context);
ca6c1d82
SG		 2983
2984 ret = rdma_bind_addr(id, sa);
2985 if (ret) {
24f412dd 2986 isert_err("rdma_bind_addr() failed: %d\n", ret);
ca6c1d82
SG		 2987 goto out_id;
2988 }
2989
2990 ret = rdma_listen(id, ISERT_RDMA_LISTEN_BACKLOG);
2991 if (ret) {
24f412dd 2992 isert_err("rdma_listen() failed: %d\n", ret);
ca6c1d82
SG		 2993 goto out_id;
2994 }
2995
2996 return id;
2997out_id:
2998 rdma_destroy_id(id);
2999out:
3000 return ERR_PTR(ret);
3001}
3002
b8d26b3b
NB		 3003static int
3004isert_setup_np(struct iscsi_np *np,
3005 struct __kernel_sockaddr_storage *ksockaddr)
3006{
3007 struct isert_np *isert_np;
3008 struct rdma_cm_id *isert_lid;
b8d26b3b
NB		 3009 int ret;
3010
3011 isert_np = kzalloc(sizeof(struct isert_np), GFP_KERNEL);
3012 if (!isert_np) {
24f412dd 3013 isert_err("Unable to allocate struct isert_np\n");
b8d26b3b
NB		 3014 return -ENOMEM;
3015 }
531b7bf4 3016 sema_init(&isert_np->np_sem, 0);
b8d26b3b
NB		 3017 mutex_init(&isert_np->np_accept_mutex);
3018 INIT_LIST_HEAD(&isert_np->np_accept_list);
3019 init_completion(&isert_np->np_login_comp);
ca6c1d82 3020 isert_np->np = np;
b8d26b3b 3021
b8d26b3b
NB		 3022 /*
3023 * Setup the np->np_sockaddr from the passed sockaddr setup
3024 * in iscsi_target_configfs.c code..
3025 */
3026 memcpy(&np->np_sockaddr, ksockaddr,
3027 sizeof(struct __kernel_sockaddr_storage));
3028
ca6c1d82 3029 isert_lid = isert_setup_id(isert_np);
b8d26b3b 3030 if (IS_ERR(isert_lid)) {
b8d26b3b
NB		 3031 ret = PTR_ERR(isert_lid);
3032 goto out;
3033 }
3034
b8d26b3b
NB		 3035 isert_np->np_cm_id = isert_lid;
3036 np->np_context = isert_np;
b8d26b3b
NB		 3037
3038 return 0;
3039
b8d26b3b
NB		 3040out:
3041 kfree(isert_np);
ca6c1d82 3042
b8d26b3b
NB		 3043 return ret;
3044}
3045
b8d26b3b
NB		 3046static int
3047isert_rdma_accept(struct isert_conn *isert_conn)
3048{
3049 struct rdma_cm_id *cm_id = isert_conn->conn_cm_id;
3050 struct rdma_conn_param cp;
3051 int ret;
3052
3053 memset(&cp, 0, sizeof(struct rdma_conn_param));
b8d26b3b
NB		 3054 cp.initiator_depth = isert_conn->initiator_depth;
3055 cp.retry_count = 7;
3056 cp.rnr_retry_count = 7;
3057
b8d26b3b
NB		 3058 ret = rdma_accept(cm_id, &cp);
3059 if (ret) {
24f412dd 3060 isert_err("rdma_accept() failed with: %d\n", ret);
b8d26b3b
NB		 3061 return ret;
3062 }
3063
b8d26b3b
NB		 3064 return 0;
3065}
3066
3067static int
3068isert_get_login_rx(struct iscsi_conn *conn, struct iscsi_login *login)
3069{
3070 struct isert_conn *isert_conn = (struct isert_conn *)conn->context;
3071 int ret;
3072
24f412dd 3073 isert_info("before login_req comp conn: %p\n", isert_conn);
2371e5da
SG		 3074 ret = wait_for_completion_interruptible(&isert_conn->login_req_comp);
3075 if (ret) {
24f412dd 3076 isert_err("isert_conn %p interrupted before got login req\n",
2371e5da
SG		 3077 isert_conn);
3078 return ret;
3079 }
3080 reinit_completion(&isert_conn->login_req_comp);
3081
6faaa85f
NB		 3082 /*
3083 * For login requests after the first PDU, isert_rx_login_req() will
3084 * kick schedule_delayed_work(&conn->login_work) as the packet is
3085 * received, which turns this callback from iscsi_target_do_login_rx()
3086 * into a NOP.
3087 */
3088 if (!login->first_request)
3089 return 0;
b8d26b3b 3090
2371e5da
SG		 3091 isert_rx_login_req(isert_conn);
3092
24f412dd 3093 isert_info("before conn_login_comp conn: %p\n", conn);
b8d26b3b
NB		 3094 ret = wait_for_completion_interruptible(&isert_conn->conn_login_comp);
3095 if (ret)
3096 return ret;
3097
24f412dd 3098 isert_info("processing login->req: %p\n", login->req);
2371e5da 3099
b8d26b3b
NB		 3100 return 0;
3101}
3102
3103static void
3104isert_set_conn_info(struct iscsi_np *np, struct iscsi_conn *conn,
3105 struct isert_conn *isert_conn)
3106{
3107 struct rdma_cm_id *cm_id = isert_conn->conn_cm_id;
3108 struct rdma_route *cm_route = &cm_id->route;
3109 struct sockaddr_in *sock_in;
3110 struct sockaddr_in6 *sock_in6;
3111
3112 conn->login_family = np->np_sockaddr.ss_family;
3113
3114 if (np->np_sockaddr.ss_family == AF_INET6) {
3115 sock_in6 = (struct sockaddr_in6 *)&cm_route->addr.dst_addr;
3116 snprintf(conn->login_ip, sizeof(conn->login_ip), "%pI6c",
3117 &sock_in6->sin6_addr.in6_u);
3118 conn->login_port = ntohs(sock_in6->sin6_port);
3119
3120 sock_in6 = (struct sockaddr_in6 *)&cm_route->addr.src_addr;
3121 snprintf(conn->local_ip, sizeof(conn->local_ip), "%pI6c",
3122 &sock_in6->sin6_addr.in6_u);
3123 conn->local_port = ntohs(sock_in6->sin6_port);
3124 } else {
3125 sock_in = (struct sockaddr_in *)&cm_route->addr.dst_addr;
3126 sprintf(conn->login_ip, "%pI4",
3127 &sock_in->sin_addr.s_addr);
3128 conn->login_port = ntohs(sock_in->sin_port);
3129
3130 sock_in = (struct sockaddr_in *)&cm_route->addr.src_addr;
3131 sprintf(conn->local_ip, "%pI4",
3132 &sock_in->sin_addr.s_addr);
3133 conn->local_port = ntohs(sock_in->sin_port);
3134 }
3135}
3136
3137static int
3138isert_accept_np(struct iscsi_np *np, struct iscsi_conn *conn)
3139{
3140 struct isert_np *isert_np = (struct isert_np *)np->np_context;
3141 struct isert_conn *isert_conn;
3142 int max_accept = 0, ret;
3143
3144accept_wait:
531b7bf4 3145 ret = down_interruptible(&isert_np->np_sem);
1acff63f 3146 if (ret || max_accept > 5)
b8d26b3b
NB		 3147 return -ENODEV;
3148
3149 spin_lock_bh(&np->np_thread_lock);
e346ab34 3150 if (np->np_thread_state >= ISCSI_NP_THREAD_RESET) {
b8d26b3b 3151 spin_unlock_bh(&np->np_thread_lock);
11378cdb 3152 isert_dbg("np_thread_state %d\n",
e346ab34
SG		 3153 np->np_thread_state);
3154 /**
3155 * No point in stalling here when np_thread
3156 * is in state RESET/SHUTDOWN/EXIT - bail
3157 **/
b8d26b3b
NB		 3158 return -ENODEV;
3159 }
3160 spin_unlock_bh(&np->np_thread_lock);
3161
3162 mutex_lock(&isert_np->np_accept_mutex);
3163 if (list_empty(&isert_np->np_accept_list)) {
3164 mutex_unlock(&isert_np->np_accept_mutex);
3165 max_accept++;
3166 goto accept_wait;
3167 }
3168 isert_conn = list_first_entry(&isert_np->np_accept_list,
3169 struct isert_conn, conn_accept_node);
3170 list_del_init(&isert_conn->conn_accept_node);
3171 mutex_unlock(&isert_np->np_accept_mutex);
3172
3173 conn->context = isert_conn;
3174 isert_conn->conn = conn;
3175 max_accept = 0;
3176
b8d26b3b
NB		 3177 isert_set_conn_info(np, conn, isert_conn);
3178
24f412dd 3179 isert_dbg("Processing isert_conn: %p\n", isert_conn);
2371e5da 3180
b8d26b3b
NB		 3181 return 0;
3182}
3183
3184static void
3185isert_free_np(struct iscsi_np *np)
3186{
3187 struct isert_np *isert_np = (struct isert_np *)np->np_context;
268e6811 3188 struct isert_conn *isert_conn, *n;
b8d26b3b 3189
3b726ae2
SG		 3190 if (isert_np->np_cm_id)
3191 rdma_destroy_id(isert_np->np_cm_id);
b8d26b3b 3192
268e6811
SG		 3193 /*
3194 * FIXME: At this point we don't have a good way to insure
3195 * that at this point we don't have hanging connections that
3196 * completed RDMA establishment but didn't start iscsi login
3197 * process. So work-around this by cleaning up what ever piled
3198 * up in np_accept_list.
3199 */
3200 mutex_lock(&isert_np->np_accept_mutex);
3201 if (!list_empty(&isert_np->np_accept_list)) {
24f412dd 3202 isert_info("Still have isert connections, cleaning up...\n");
268e6811
SG		 3203 list_for_each_entry_safe(isert_conn, n,
3204 &isert_np->np_accept_list,
3205 conn_accept_node) {
24f412dd 3206 isert_info("cleaning isert_conn %p state (%d)\n",
268e6811
SG		 3207 isert_conn, isert_conn->state);
3208 isert_connect_release(isert_conn);
3209 }
3210 }
3211 mutex_unlock(&isert_np->np_accept_mutex);
3212
b8d26b3b
NB		 3213 np->np_context = NULL;
3214 kfree(isert_np);
3215}
3216
b02efbfc
SG		 3217static void isert_release_work(struct work_struct *work)
3218{
3219 struct isert_conn *isert_conn = container_of(work,
3220 struct isert_conn,
3221 release_work);
3222
24f412dd 3223 isert_info("Starting release conn %p\n", isert_conn);
b02efbfc
SG		 3224
3225 wait_for_completion(&isert_conn->conn_wait);
3226
3227 mutex_lock(&isert_conn->conn_mutex);
3228 isert_conn->state = ISER_CONN_DOWN;
3229 mutex_unlock(&isert_conn->conn_mutex);
3230
24f412dd 3231 isert_info("Destroying conn %p\n", isert_conn);
b02efbfc
SG		 3232 isert_put_conn(isert_conn);
3233}
3234
991bb764
SG		 3235static void
3236isert_wait4logout(struct isert_conn *isert_conn)
3237{
3238 struct iscsi_conn *conn = isert_conn->conn;
3239
4c22e07f
SG		 3240 isert_info("conn %p\n", isert_conn);
3241
991bb764 3242 if (isert_conn->logout_posted) {
24f412dd 3243 isert_info("conn %p wait for conn_logout_comp\n", isert_conn);
991bb764
SG		 3244 wait_for_completion_timeout(&conn->conn_logout_comp,
3245 SECONDS_FOR_LOGOUT_COMP * HZ);
3246 }
3247}
3248
c7e160ee
SG		 3249static void
3250isert_wait4cmds(struct iscsi_conn *conn)
3251{
4c22e07f
SG		 3252 isert_info("iscsi_conn %p\n", conn);
3253
c7e160ee
SG		 3254 if (conn->sess) {
3255 target_sess_cmd_list_set_waiting(conn->sess->se_sess);
3256 target_wait_for_sess_cmds(conn->sess->se_sess);
3257 }
3258}
3259
bdf20e72
SG		 3260static void
3261isert_wait4flush(struct isert_conn *isert_conn)
3262{
3263 struct ib_recv_wr *bad_wr;
3264
4c22e07f
SG		 3265 isert_info("conn %p\n", isert_conn);
3266
bdf20e72
SG		 3267 init_completion(&isert_conn->conn_wait_comp_err);
3268 isert_conn->beacon.wr_id = ISER_BEACON_WRID;
3269 /* post an indication that all flush errors were consumed */
3270 if (ib_post_recv(isert_conn->conn_qp, &isert_conn->beacon, &bad_wr)) {
24f412dd 3271 isert_err("conn %p failed to post beacon", isert_conn);
bdf20e72
SG		 3272 return;
3273 }
3274
3275 wait_for_completion(&isert_conn->conn_wait_comp_err);
3276}
3277
defd8848 3278static void isert_wait_conn(struct iscsi_conn *conn)
b8d26b3b
NB		 3279{
3280 struct isert_conn *isert_conn = conn->context;
3281
4c22e07f 3282 isert_info("Starting conn %p\n", isert_conn);
b8d26b3b 3283
9d49f5e2 3284 mutex_lock(&isert_conn->conn_mutex);
b8d26b3b
NB		 3285 /*
3286 * Only wait for conn_wait_comp_err if the isert_conn made it
3287 * into full feature phase..
3288 */
b2cb9649
NB		 3289 if (isert_conn->state == ISER_CONN_INIT) {
3290 mutex_unlock(&isert_conn->conn_mutex);
b2cb9649 3291 return;
b8d26b3b 3292 }
954f2372 3293 isert_conn_terminate(isert_conn);
b2cb9649 3294 mutex_unlock(&isert_conn->conn_mutex);
b8d26b3b 3295
c7e160ee 3296 isert_wait4cmds(conn);
bdf20e72 3297 isert_wait4flush(isert_conn);
991bb764 3298 isert_wait4logout(isert_conn);
954f2372 3299
b02efbfc
SG		 3300 INIT_WORK(&isert_conn->release_work, isert_release_work);
3301 queue_work(isert_release_wq, &isert_conn->release_work);
defd8848
NB		 3302}
3303
3304static void isert_free_conn(struct iscsi_conn *conn)
3305{
3306 struct isert_conn *isert_conn = conn->context;
b8d26b3b
NB		 3307
3308 isert_put_conn(isert_conn);
3309}
3310
3311static struct iscsit_transport iser_target_transport = {
3312 .name = "IB/iSER",
3313 .transport_type = ISCSI_INFINIBAND,
d703ce2f 3314 .priv_size = sizeof(struct isert_cmd),
b8d26b3b
NB		 3315 .owner = THIS_MODULE,
3316 .iscsit_setup_np = isert_setup_np,
3317 .iscsit_accept_np = isert_accept_np,
3318 .iscsit_free_np = isert_free_np,
defd8848 3319 .iscsit_wait_conn = isert_wait_conn,
b8d26b3b 3320 .iscsit_free_conn = isert_free_conn,
b8d26b3b
NB		 3321 .iscsit_get_login_rx = isert_get_login_rx,
3322 .iscsit_put_login_tx = isert_put_login_tx,
3323 .iscsit_immediate_queue = isert_immediate_queue,
3324 .iscsit_response_queue = isert_response_queue,
3325 .iscsit_get_dataout = isert_get_dataout,
3326 .iscsit_queue_data_in = isert_put_datain,
3327 .iscsit_queue_status = isert_put_response,
131e6abc 3328 .iscsit_aborted_task = isert_aborted_task,
e70beee7 3329 .iscsit_get_sup_prot_ops = isert_get_sup_prot_ops,
b8d26b3b
NB		 3330};
3331
3332static int __init isert_init(void)
3333{
3334 int ret;
3335
631af550
SG		 3336 isert_comp_wq = alloc_workqueue("isert_comp_wq",
3337 WQ_UNBOUND | WQ_HIGHPRI, 0);
b8d26b3b 3338 if (!isert_comp_wq) {
24f412dd 3339 isert_err("Unable to allocate isert_comp_wq\n");
b8d26b3b 3340 ret = -ENOMEM;
6f0fae3d 3341 return -ENOMEM;
b8d26b3b
NB		 3342 }
3343
b02efbfc
SG		 3344 isert_release_wq = alloc_workqueue("isert_release_wq", WQ_UNBOUND,
3345 WQ_UNBOUND_MAX_ACTIVE);
3346 if (!isert_release_wq) {
24f412dd 3347 isert_err("Unable to allocate isert_release_wq\n");
b02efbfc
SG		 3348 ret = -ENOMEM;
3349 goto destroy_comp_wq;
3350 }
3351
b8d26b3b 3352 iscsit_register_transport(&iser_target_transport);
24f412dd 3353 isert_info("iSER_TARGET[0] - Loaded iser_target_transport\n");
b02efbfc 3354
b8d26b3b
NB		 3355 return 0;
3356
b02efbfc
SG		 3357destroy_comp_wq:
3358 destroy_workqueue(isert_comp_wq);
6f0fae3d 3359
b8d26b3b
NB		 3360 return ret;
3361}
3362
3363static void __exit isert_exit(void)
3364{
f5ebec96 3365 flush_scheduled_work();
b02efbfc 3366 destroy_workqueue(isert_release_wq);
b8d26b3b 3367 destroy_workqueue(isert_comp_wq);
b8d26b3b 3368 iscsit_unregister_transport(&iser_target_transport);
4c22e07f 3369 isert_info("iSER_TARGET[0] - Released iser_target_transport\n");
b8d26b3b
NB		 3370}
3371
3372MODULE_DESCRIPTION("iSER-Target for mainline target infrastructure");
3373MODULE_VERSION("0.1");
3374MODULE_AUTHOR("nab@Linux-iSCSI.org");
3375MODULE_LICENSE("GPL");
3376
3377module_init(isert_init);
3378module_exit(isert_exit);
ubuntu-zesty-kernel mirror