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