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