1b8d26b3bSNicholas Bellinger /******************************************************************************* 2b8d26b3bSNicholas Bellinger * This file contains iSCSI extentions for RDMA (iSER) Verbs 3b8d26b3bSNicholas Bellinger * 44c76251eSNicholas Bellinger * (c) Copyright 2013 Datera, Inc. 5b8d26b3bSNicholas Bellinger * 6b8d26b3bSNicholas Bellinger * Nicholas A. Bellinger <nab@linux-iscsi.org> 7b8d26b3bSNicholas Bellinger * 8b8d26b3bSNicholas Bellinger * This program is free software; you can redistribute it and/or modify 9b8d26b3bSNicholas Bellinger * it under the terms of the GNU General Public License as published by 10b8d26b3bSNicholas Bellinger * the Free Software Foundation; either version 2 of the License, or 11b8d26b3bSNicholas Bellinger * (at your option) any later version. 12b8d26b3bSNicholas Bellinger * 13b8d26b3bSNicholas Bellinger * This program is distributed in the hope that it will be useful, 14b8d26b3bSNicholas Bellinger * but WITHOUT ANY WARRANTY; without even the implied warranty of 15b8d26b3bSNicholas Bellinger * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16b8d26b3bSNicholas Bellinger * GNU General Public License for more details. 17b8d26b3bSNicholas Bellinger ****************************************************************************/ 18b8d26b3bSNicholas Bellinger 19b8d26b3bSNicholas Bellinger #include <linux/string.h> 20b8d26b3bSNicholas Bellinger #include <linux/module.h> 21b8d26b3bSNicholas Bellinger #include <linux/scatterlist.h> 22b8d26b3bSNicholas Bellinger #include <linux/socket.h> 23b8d26b3bSNicholas Bellinger #include <linux/in.h> 24b8d26b3bSNicholas Bellinger #include <linux/in6.h> 25b8d26b3bSNicholas Bellinger #include <rdma/ib_verbs.h> 26b8d26b3bSNicholas Bellinger #include <rdma/rdma_cm.h> 27b8d26b3bSNicholas Bellinger #include <target/target_core_base.h> 28b8d26b3bSNicholas Bellinger #include <target/target_core_fabric.h> 29b8d26b3bSNicholas Bellinger #include <target/iscsi/iscsi_transport.h> 30531b7bf4SSagi Grimberg #include <linux/semaphore.h> 31b8d26b3bSNicholas Bellinger 32b8d26b3bSNicholas Bellinger #include "isert_proto.h" 33b8d26b3bSNicholas Bellinger #include "ib_isert.h" 34b8d26b3bSNicholas Bellinger 35b8d26b3bSNicholas Bellinger #define ISERT_MAX_CONN 8 36b8d26b3bSNicholas Bellinger #define ISER_MAX_RX_CQ_LEN (ISERT_QP_MAX_RECV_DTOS * ISERT_MAX_CONN) 37b8d26b3bSNicholas Bellinger #define ISER_MAX_TX_CQ_LEN (ISERT_QP_MAX_REQ_DTOS * ISERT_MAX_CONN) 38b8d26b3bSNicholas Bellinger 39b8d26b3bSNicholas Bellinger static DEFINE_MUTEX(device_list_mutex); 40b8d26b3bSNicholas Bellinger static LIST_HEAD(device_list); 41b8d26b3bSNicholas Bellinger static struct workqueue_struct *isert_rx_wq; 42b8d26b3bSNicholas Bellinger static struct workqueue_struct *isert_comp_wq; 43b02efbfcSSagi Grimberg static struct workqueue_struct *isert_release_wq; 44b8d26b3bSNicholas Bellinger 45b8d26b3bSNicholas Bellinger static void 46d40945d8SVu Pham isert_unmap_cmd(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn); 47d40945d8SVu Pham static int 48d40945d8SVu Pham isert_map_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd, 49d40945d8SVu Pham struct isert_rdma_wr *wr); 5059464ef4SVu Pham static void 51a3a5a826SSagi Grimberg isert_unreg_rdma(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn); 5259464ef4SVu Pham static int 53a3a5a826SSagi Grimberg isert_reg_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd, 5459464ef4SVu Pham struct isert_rdma_wr *wr); 55f93f3a70SSagi Grimberg static int 56f93f3a70SSagi Grimberg isert_put_response(struct iscsi_conn *conn, struct iscsi_cmd *cmd); 572371e5daSSagi Grimberg static int 582371e5daSSagi Grimberg isert_rdma_post_recvl(struct isert_conn *isert_conn); 592371e5daSSagi Grimberg static int 602371e5daSSagi Grimberg isert_rdma_accept(struct isert_conn *isert_conn); 61ca6c1d82SSagi Grimberg struct rdma_cm_id *isert_setup_id(struct isert_np *isert_np); 62d40945d8SVu Pham 63302cc7c3SSagi Grimberg static inline bool 64302cc7c3SSagi Grimberg isert_prot_cmd(struct isert_conn *conn, struct se_cmd *cmd) 65302cc7c3SSagi Grimberg { 6623a548eeSSagi Grimberg return (conn->pi_support && 67302cc7c3SSagi Grimberg cmd->prot_op != TARGET_PROT_NORMAL); 68302cc7c3SSagi Grimberg } 69302cc7c3SSagi Grimberg 70302cc7c3SSagi Grimberg 71d40945d8SVu Pham static void 72b8d26b3bSNicholas Bellinger isert_qp_event_callback(struct ib_event *e, void *context) 73b8d26b3bSNicholas Bellinger { 74b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)context; 75b8d26b3bSNicholas Bellinger 76b8d26b3bSNicholas Bellinger pr_err("isert_qp_event_callback event: %d\n", e->event); 77b8d26b3bSNicholas Bellinger switch (e->event) { 78b8d26b3bSNicholas Bellinger case IB_EVENT_COMM_EST: 79b8d26b3bSNicholas Bellinger rdma_notify(isert_conn->conn_cm_id, IB_EVENT_COMM_EST); 80b8d26b3bSNicholas Bellinger break; 81b8d26b3bSNicholas Bellinger case IB_EVENT_QP_LAST_WQE_REACHED: 82b8d26b3bSNicholas Bellinger pr_warn("Reached TX IB_EVENT_QP_LAST_WQE_REACHED:\n"); 83b8d26b3bSNicholas Bellinger break; 84b8d26b3bSNicholas Bellinger default: 85b8d26b3bSNicholas Bellinger break; 86b8d26b3bSNicholas Bellinger } 87b8d26b3bSNicholas Bellinger } 88b8d26b3bSNicholas Bellinger 89b8d26b3bSNicholas Bellinger static int 90b8d26b3bSNicholas Bellinger isert_query_device(struct ib_device *ib_dev, struct ib_device_attr *devattr) 91b8d26b3bSNicholas Bellinger { 92b8d26b3bSNicholas Bellinger int ret; 93b8d26b3bSNicholas Bellinger 94b8d26b3bSNicholas Bellinger ret = ib_query_device(ib_dev, devattr); 95b8d26b3bSNicholas Bellinger if (ret) { 96b8d26b3bSNicholas Bellinger pr_err("ib_query_device() failed: %d\n", ret); 97b8d26b3bSNicholas Bellinger return ret; 98b8d26b3bSNicholas Bellinger } 99b8d26b3bSNicholas Bellinger pr_debug("devattr->max_sge: %d\n", devattr->max_sge); 100b8d26b3bSNicholas Bellinger pr_debug("devattr->max_sge_rd: %d\n", devattr->max_sge_rd); 101b8d26b3bSNicholas Bellinger 102b8d26b3bSNicholas Bellinger return 0; 103b8d26b3bSNicholas Bellinger } 104b8d26b3bSNicholas Bellinger 105b8d26b3bSNicholas Bellinger static int 106570db170SSagi Grimberg isert_conn_setup_qp(struct isert_conn *isert_conn, struct rdma_cm_id *cma_id) 107b8d26b3bSNicholas Bellinger { 108b8d26b3bSNicholas Bellinger struct isert_device *device = isert_conn->conn_device; 109b8d26b3bSNicholas Bellinger struct ib_qp_init_attr attr; 110b8d26b3bSNicholas Bellinger int ret, index, min_index = 0; 111b8d26b3bSNicholas Bellinger 112b8d26b3bSNicholas Bellinger mutex_lock(&device_list_mutex); 113b8d26b3bSNicholas Bellinger for (index = 0; index < device->cqs_used; index++) 114b8d26b3bSNicholas Bellinger if (device->cq_active_qps[index] < 115b8d26b3bSNicholas Bellinger device->cq_active_qps[min_index]) 116b8d26b3bSNicholas Bellinger min_index = index; 117b8d26b3bSNicholas Bellinger device->cq_active_qps[min_index]++; 118b8d26b3bSNicholas Bellinger pr_debug("isert_conn_setup_qp: Using min_index: %d\n", min_index); 119b8d26b3bSNicholas Bellinger mutex_unlock(&device_list_mutex); 120b8d26b3bSNicholas Bellinger 121b8d26b3bSNicholas Bellinger memset(&attr, 0, sizeof(struct ib_qp_init_attr)); 122b8d26b3bSNicholas Bellinger attr.event_handler = isert_qp_event_callback; 123b8d26b3bSNicholas Bellinger attr.qp_context = isert_conn; 124b8d26b3bSNicholas Bellinger attr.send_cq = device->dev_tx_cq[min_index]; 125b8d26b3bSNicholas Bellinger attr.recv_cq = device->dev_rx_cq[min_index]; 126b8d26b3bSNicholas Bellinger attr.cap.max_send_wr = ISERT_QP_MAX_REQ_DTOS; 127b8d26b3bSNicholas Bellinger attr.cap.max_recv_wr = ISERT_QP_MAX_RECV_DTOS; 128b8d26b3bSNicholas Bellinger /* 129b8d26b3bSNicholas Bellinger * FIXME: Use devattr.max_sge - 2 for max_send_sge as 130f57915cfSOr Gerlitz * work-around for RDMA_READs with ConnectX-2. 131f57915cfSOr Gerlitz * 132f57915cfSOr Gerlitz * Also, still make sure to have at least two SGEs for 133f57915cfSOr Gerlitz * outgoing control PDU responses. 134b8d26b3bSNicholas Bellinger */ 135f57915cfSOr Gerlitz attr.cap.max_send_sge = max(2, device->dev_attr.max_sge - 2); 136b8d26b3bSNicholas Bellinger isert_conn->max_sge = attr.cap.max_send_sge; 137b8d26b3bSNicholas Bellinger 138b8d26b3bSNicholas Bellinger attr.cap.max_recv_sge = 1; 139b8d26b3bSNicholas Bellinger attr.sq_sig_type = IB_SIGNAL_REQ_WR; 140b8d26b3bSNicholas Bellinger attr.qp_type = IB_QPT_RC; 141570db170SSagi Grimberg if (device->pi_capable) 142d3e125daSSagi Grimberg attr.create_flags |= IB_QP_CREATE_SIGNATURE_EN; 143b8d26b3bSNicholas Bellinger 144b8d26b3bSNicholas Bellinger pr_debug("isert_conn_setup_qp cma_id->device: %p\n", 145b8d26b3bSNicholas Bellinger cma_id->device); 146b8d26b3bSNicholas Bellinger pr_debug("isert_conn_setup_qp conn_pd->device: %p\n", 147b8d26b3bSNicholas Bellinger isert_conn->conn_pd->device); 148b8d26b3bSNicholas Bellinger 149b8d26b3bSNicholas Bellinger ret = rdma_create_qp(cma_id, isert_conn->conn_pd, &attr); 150b8d26b3bSNicholas Bellinger if (ret) { 151b8d26b3bSNicholas Bellinger pr_err("rdma_create_qp failed for cma_id %d\n", ret); 15219e2090fSSagi Grimberg goto err; 153b8d26b3bSNicholas Bellinger } 154b8d26b3bSNicholas Bellinger isert_conn->conn_qp = cma_id->qp; 155b8d26b3bSNicholas Bellinger pr_debug("rdma_create_qp() returned success >>>>>>>>>>>>>>>>>>>>>>>>>.\n"); 156b8d26b3bSNicholas Bellinger 157b8d26b3bSNicholas Bellinger return 0; 15819e2090fSSagi Grimberg err: 15919e2090fSSagi Grimberg mutex_lock(&device_list_mutex); 16019e2090fSSagi Grimberg device->cq_active_qps[min_index]--; 16119e2090fSSagi Grimberg mutex_unlock(&device_list_mutex); 16219e2090fSSagi Grimberg 16319e2090fSSagi Grimberg return ret; 164b8d26b3bSNicholas Bellinger } 165b8d26b3bSNicholas Bellinger 166b8d26b3bSNicholas Bellinger static void 167b8d26b3bSNicholas Bellinger isert_cq_event_callback(struct ib_event *e, void *context) 168b8d26b3bSNicholas Bellinger { 169b8d26b3bSNicholas Bellinger pr_debug("isert_cq_event_callback event: %d\n", e->event); 170b8d26b3bSNicholas Bellinger } 171b8d26b3bSNicholas Bellinger 172b8d26b3bSNicholas Bellinger static int 173b8d26b3bSNicholas Bellinger isert_alloc_rx_descriptors(struct isert_conn *isert_conn) 174b8d26b3bSNicholas Bellinger { 175b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 176b8d26b3bSNicholas Bellinger struct iser_rx_desc *rx_desc; 177b8d26b3bSNicholas Bellinger struct ib_sge *rx_sg; 178b8d26b3bSNicholas Bellinger u64 dma_addr; 179b8d26b3bSNicholas Bellinger int i, j; 180b8d26b3bSNicholas Bellinger 181b8d26b3bSNicholas Bellinger isert_conn->conn_rx_descs = kzalloc(ISERT_QP_MAX_RECV_DTOS * 182b8d26b3bSNicholas Bellinger sizeof(struct iser_rx_desc), GFP_KERNEL); 183b8d26b3bSNicholas Bellinger if (!isert_conn->conn_rx_descs) 184b8d26b3bSNicholas Bellinger goto fail; 185b8d26b3bSNicholas Bellinger 186b8d26b3bSNicholas Bellinger rx_desc = isert_conn->conn_rx_descs; 187b8d26b3bSNicholas Bellinger 188b8d26b3bSNicholas Bellinger for (i = 0; i < ISERT_QP_MAX_RECV_DTOS; i++, rx_desc++) { 189b8d26b3bSNicholas Bellinger dma_addr = ib_dma_map_single(ib_dev, (void *)rx_desc, 190b8d26b3bSNicholas Bellinger ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE); 191b8d26b3bSNicholas Bellinger if (ib_dma_mapping_error(ib_dev, dma_addr)) 192b8d26b3bSNicholas Bellinger goto dma_map_fail; 193b8d26b3bSNicholas Bellinger 194b8d26b3bSNicholas Bellinger rx_desc->dma_addr = dma_addr; 195b8d26b3bSNicholas Bellinger 196b8d26b3bSNicholas Bellinger rx_sg = &rx_desc->rx_sg; 197b8d26b3bSNicholas Bellinger rx_sg->addr = rx_desc->dma_addr; 198b8d26b3bSNicholas Bellinger rx_sg->length = ISER_RX_PAYLOAD_SIZE; 199b8d26b3bSNicholas Bellinger rx_sg->lkey = isert_conn->conn_mr->lkey; 200b8d26b3bSNicholas Bellinger } 201b8d26b3bSNicholas Bellinger 202b8d26b3bSNicholas Bellinger isert_conn->conn_rx_desc_head = 0; 203b8d26b3bSNicholas Bellinger return 0; 204b8d26b3bSNicholas Bellinger 205b8d26b3bSNicholas Bellinger dma_map_fail: 206b8d26b3bSNicholas Bellinger rx_desc = isert_conn->conn_rx_descs; 207b8d26b3bSNicholas Bellinger for (j = 0; j < i; j++, rx_desc++) { 208b8d26b3bSNicholas Bellinger ib_dma_unmap_single(ib_dev, rx_desc->dma_addr, 209b8d26b3bSNicholas Bellinger ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE); 210b8d26b3bSNicholas Bellinger } 211b8d26b3bSNicholas Bellinger kfree(isert_conn->conn_rx_descs); 212b8d26b3bSNicholas Bellinger isert_conn->conn_rx_descs = NULL; 213b8d26b3bSNicholas Bellinger fail: 214b8d26b3bSNicholas Bellinger return -ENOMEM; 215b8d26b3bSNicholas Bellinger } 216b8d26b3bSNicholas Bellinger 217b8d26b3bSNicholas Bellinger static void 218b8d26b3bSNicholas Bellinger isert_free_rx_descriptors(struct isert_conn *isert_conn) 219b8d26b3bSNicholas Bellinger { 220b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 221b8d26b3bSNicholas Bellinger struct iser_rx_desc *rx_desc; 222b8d26b3bSNicholas Bellinger int i; 223b8d26b3bSNicholas Bellinger 224b8d26b3bSNicholas Bellinger if (!isert_conn->conn_rx_descs) 225b8d26b3bSNicholas Bellinger return; 226b8d26b3bSNicholas Bellinger 227b8d26b3bSNicholas Bellinger rx_desc = isert_conn->conn_rx_descs; 228b8d26b3bSNicholas Bellinger for (i = 0; i < ISERT_QP_MAX_RECV_DTOS; i++, rx_desc++) { 229b8d26b3bSNicholas Bellinger ib_dma_unmap_single(ib_dev, rx_desc->dma_addr, 230b8d26b3bSNicholas Bellinger ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE); 231b8d26b3bSNicholas Bellinger } 232b8d26b3bSNicholas Bellinger 233b8d26b3bSNicholas Bellinger kfree(isert_conn->conn_rx_descs); 234b8d26b3bSNicholas Bellinger isert_conn->conn_rx_descs = NULL; 235b8d26b3bSNicholas Bellinger } 236b8d26b3bSNicholas Bellinger 2372853c2b6SNicholas Bellinger static void isert_cq_tx_work(struct work_struct *); 238b8d26b3bSNicholas Bellinger static void isert_cq_tx_callback(struct ib_cq *, void *); 2392853c2b6SNicholas Bellinger static void isert_cq_rx_work(struct work_struct *); 240b8d26b3bSNicholas Bellinger static void isert_cq_rx_callback(struct ib_cq *, void *); 241b8d26b3bSNicholas Bellinger 242b8d26b3bSNicholas Bellinger static int 243b8d26b3bSNicholas Bellinger isert_create_device_ib_res(struct isert_device *device) 244b8d26b3bSNicholas Bellinger { 245b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = device->ib_device; 246b8d26b3bSNicholas Bellinger struct isert_cq_desc *cq_desc; 24759464ef4SVu Pham struct ib_device_attr *dev_attr; 248b8d26b3bSNicholas Bellinger int ret = 0, i, j; 249b1a5ad00SChris Moore int max_rx_cqe, max_tx_cqe; 250b8d26b3bSNicholas Bellinger 25159464ef4SVu Pham dev_attr = &device->dev_attr; 25259464ef4SVu Pham ret = isert_query_device(ib_dev, dev_attr); 25359464ef4SVu Pham if (ret) 25459464ef4SVu Pham return ret; 25559464ef4SVu Pham 256b1a5ad00SChris Moore max_rx_cqe = min(ISER_MAX_RX_CQ_LEN, dev_attr->max_cqe); 257b1a5ad00SChris Moore max_tx_cqe = min(ISER_MAX_TX_CQ_LEN, dev_attr->max_cqe); 258b1a5ad00SChris Moore 259d40945d8SVu Pham /* asign function handlers */ 260f2252258SSagi Grimberg if (dev_attr->device_cap_flags & IB_DEVICE_MEM_MGT_EXTENSIONS && 261f2252258SSagi Grimberg dev_attr->device_cap_flags & IB_DEVICE_SIGNATURE_HANDOVER) { 262a3a5a826SSagi Grimberg device->use_fastreg = 1; 263a3a5a826SSagi Grimberg device->reg_rdma_mem = isert_reg_rdma; 264a3a5a826SSagi Grimberg device->unreg_rdma_mem = isert_unreg_rdma; 26559464ef4SVu Pham } else { 266a3a5a826SSagi Grimberg device->use_fastreg = 0; 267d40945d8SVu Pham device->reg_rdma_mem = isert_map_rdma; 268d40945d8SVu Pham device->unreg_rdma_mem = isert_unmap_cmd; 26959464ef4SVu Pham } 270d40945d8SVu Pham 271d3e125daSSagi Grimberg /* Check signature cap */ 272d3e125daSSagi Grimberg device->pi_capable = dev_attr->device_cap_flags & 273d3e125daSSagi Grimberg IB_DEVICE_SIGNATURE_HANDOVER ? true : false; 274d3e125daSSagi Grimberg 275b8d26b3bSNicholas Bellinger device->cqs_used = min_t(int, num_online_cpus(), 276b8d26b3bSNicholas Bellinger device->ib_device->num_comp_vectors); 277b8d26b3bSNicholas Bellinger device->cqs_used = min(ISERT_MAX_CQ, device->cqs_used); 278a3a5a826SSagi Grimberg pr_debug("Using %d CQs, device %s supports %d vectors support " 279d3e125daSSagi Grimberg "Fast registration %d pi_capable %d\n", 280b8d26b3bSNicholas Bellinger device->cqs_used, device->ib_device->name, 281d3e125daSSagi Grimberg device->ib_device->num_comp_vectors, device->use_fastreg, 282d3e125daSSagi Grimberg device->pi_capable); 283b8d26b3bSNicholas Bellinger device->cq_desc = kzalloc(sizeof(struct isert_cq_desc) * 284b8d26b3bSNicholas Bellinger device->cqs_used, GFP_KERNEL); 285b8d26b3bSNicholas Bellinger if (!device->cq_desc) { 286b8d26b3bSNicholas Bellinger pr_err("Unable to allocate device->cq_desc\n"); 287b8d26b3bSNicholas Bellinger return -ENOMEM; 288b8d26b3bSNicholas Bellinger } 289b8d26b3bSNicholas Bellinger cq_desc = device->cq_desc; 290b8d26b3bSNicholas Bellinger 291b8d26b3bSNicholas Bellinger for (i = 0; i < device->cqs_used; i++) { 292b8d26b3bSNicholas Bellinger cq_desc[i].device = device; 293b8d26b3bSNicholas Bellinger cq_desc[i].cq_index = i; 294b8d26b3bSNicholas Bellinger 2952853c2b6SNicholas Bellinger INIT_WORK(&cq_desc[i].cq_rx_work, isert_cq_rx_work); 296b8d26b3bSNicholas Bellinger device->dev_rx_cq[i] = ib_create_cq(device->ib_device, 297b8d26b3bSNicholas Bellinger isert_cq_rx_callback, 298b8d26b3bSNicholas Bellinger isert_cq_event_callback, 299b8d26b3bSNicholas Bellinger (void *)&cq_desc[i], 300b1a5ad00SChris Moore max_rx_cqe, i); 30194a71110SWei Yongjun if (IS_ERR(device->dev_rx_cq[i])) { 30294a71110SWei Yongjun ret = PTR_ERR(device->dev_rx_cq[i]); 30394a71110SWei Yongjun device->dev_rx_cq[i] = NULL; 304b8d26b3bSNicholas Bellinger goto out_cq; 30594a71110SWei Yongjun } 306b8d26b3bSNicholas Bellinger 3072853c2b6SNicholas Bellinger INIT_WORK(&cq_desc[i].cq_tx_work, isert_cq_tx_work); 308b8d26b3bSNicholas Bellinger device->dev_tx_cq[i] = ib_create_cq(device->ib_device, 309b8d26b3bSNicholas Bellinger isert_cq_tx_callback, 310b8d26b3bSNicholas Bellinger isert_cq_event_callback, 311b8d26b3bSNicholas Bellinger (void *)&cq_desc[i], 312b1a5ad00SChris Moore max_tx_cqe, i); 31394a71110SWei Yongjun if (IS_ERR(device->dev_tx_cq[i])) { 31494a71110SWei Yongjun ret = PTR_ERR(device->dev_tx_cq[i]); 31594a71110SWei Yongjun device->dev_tx_cq[i] = NULL; 31694a71110SWei Yongjun goto out_cq; 31794a71110SWei Yongjun } 31894a71110SWei Yongjun 31994a71110SWei Yongjun ret = ib_req_notify_cq(device->dev_rx_cq[i], IB_CQ_NEXT_COMP); 32094a71110SWei Yongjun if (ret) 321b8d26b3bSNicholas Bellinger goto out_cq; 322b8d26b3bSNicholas Bellinger 32394a71110SWei Yongjun ret = ib_req_notify_cq(device->dev_tx_cq[i], IB_CQ_NEXT_COMP); 32494a71110SWei Yongjun if (ret) 325b8d26b3bSNicholas Bellinger goto out_cq; 326b8d26b3bSNicholas Bellinger } 327b8d26b3bSNicholas Bellinger 328b8d26b3bSNicholas Bellinger return 0; 329b8d26b3bSNicholas Bellinger 330b8d26b3bSNicholas Bellinger out_cq: 331b8d26b3bSNicholas Bellinger for (j = 0; j < i; j++) { 332b8d26b3bSNicholas Bellinger cq_desc = &device->cq_desc[j]; 333b8d26b3bSNicholas Bellinger 334b8d26b3bSNicholas Bellinger if (device->dev_rx_cq[j]) { 335b8d26b3bSNicholas Bellinger cancel_work_sync(&cq_desc->cq_rx_work); 336b8d26b3bSNicholas Bellinger ib_destroy_cq(device->dev_rx_cq[j]); 337b8d26b3bSNicholas Bellinger } 338b8d26b3bSNicholas Bellinger if (device->dev_tx_cq[j]) { 339b8d26b3bSNicholas Bellinger cancel_work_sync(&cq_desc->cq_tx_work); 340b8d26b3bSNicholas Bellinger ib_destroy_cq(device->dev_tx_cq[j]); 341b8d26b3bSNicholas Bellinger } 342b8d26b3bSNicholas Bellinger } 343b8d26b3bSNicholas Bellinger kfree(device->cq_desc); 344b8d26b3bSNicholas Bellinger 345b8d26b3bSNicholas Bellinger return ret; 346b8d26b3bSNicholas Bellinger } 347b8d26b3bSNicholas Bellinger 348b8d26b3bSNicholas Bellinger static void 349b8d26b3bSNicholas Bellinger isert_free_device_ib_res(struct isert_device *device) 350b8d26b3bSNicholas Bellinger { 351b8d26b3bSNicholas Bellinger struct isert_cq_desc *cq_desc; 352b8d26b3bSNicholas Bellinger int i; 353b8d26b3bSNicholas Bellinger 354b8d26b3bSNicholas Bellinger for (i = 0; i < device->cqs_used; i++) { 355b8d26b3bSNicholas Bellinger cq_desc = &device->cq_desc[i]; 356b8d26b3bSNicholas Bellinger 357b8d26b3bSNicholas Bellinger cancel_work_sync(&cq_desc->cq_rx_work); 358b8d26b3bSNicholas Bellinger cancel_work_sync(&cq_desc->cq_tx_work); 359b8d26b3bSNicholas Bellinger ib_destroy_cq(device->dev_rx_cq[i]); 360b8d26b3bSNicholas Bellinger ib_destroy_cq(device->dev_tx_cq[i]); 361b8d26b3bSNicholas Bellinger device->dev_rx_cq[i] = NULL; 362b8d26b3bSNicholas Bellinger device->dev_tx_cq[i] = NULL; 363b8d26b3bSNicholas Bellinger } 364b8d26b3bSNicholas Bellinger 365b8d26b3bSNicholas Bellinger kfree(device->cq_desc); 366b8d26b3bSNicholas Bellinger } 367b8d26b3bSNicholas Bellinger 368b8d26b3bSNicholas Bellinger static void 369b8d26b3bSNicholas Bellinger isert_device_try_release(struct isert_device *device) 370b8d26b3bSNicholas Bellinger { 371b8d26b3bSNicholas Bellinger mutex_lock(&device_list_mutex); 372b8d26b3bSNicholas Bellinger device->refcount--; 373b8d26b3bSNicholas Bellinger if (!device->refcount) { 374b8d26b3bSNicholas Bellinger isert_free_device_ib_res(device); 375b8d26b3bSNicholas Bellinger list_del(&device->dev_node); 376b8d26b3bSNicholas Bellinger kfree(device); 377b8d26b3bSNicholas Bellinger } 378b8d26b3bSNicholas Bellinger mutex_unlock(&device_list_mutex); 379b8d26b3bSNicholas Bellinger } 380b8d26b3bSNicholas Bellinger 381b8d26b3bSNicholas Bellinger static struct isert_device * 382b8d26b3bSNicholas Bellinger isert_device_find_by_ib_dev(struct rdma_cm_id *cma_id) 383b8d26b3bSNicholas Bellinger { 384b8d26b3bSNicholas Bellinger struct isert_device *device; 385b8d26b3bSNicholas Bellinger int ret; 386b8d26b3bSNicholas Bellinger 387b8d26b3bSNicholas Bellinger mutex_lock(&device_list_mutex); 388b8d26b3bSNicholas Bellinger list_for_each_entry(device, &device_list, dev_node) { 389b8d26b3bSNicholas Bellinger if (device->ib_device->node_guid == cma_id->device->node_guid) { 390b8d26b3bSNicholas Bellinger device->refcount++; 391b8d26b3bSNicholas Bellinger mutex_unlock(&device_list_mutex); 392b8d26b3bSNicholas Bellinger return device; 393b8d26b3bSNicholas Bellinger } 394b8d26b3bSNicholas Bellinger } 395b8d26b3bSNicholas Bellinger 396b8d26b3bSNicholas Bellinger device = kzalloc(sizeof(struct isert_device), GFP_KERNEL); 397b8d26b3bSNicholas Bellinger if (!device) { 398b8d26b3bSNicholas Bellinger mutex_unlock(&device_list_mutex); 399b8d26b3bSNicholas Bellinger return ERR_PTR(-ENOMEM); 400b8d26b3bSNicholas Bellinger } 401b8d26b3bSNicholas Bellinger 402b8d26b3bSNicholas Bellinger INIT_LIST_HEAD(&device->dev_node); 403b8d26b3bSNicholas Bellinger 404b8d26b3bSNicholas Bellinger device->ib_device = cma_id->device; 405b8d26b3bSNicholas Bellinger ret = isert_create_device_ib_res(device); 406b8d26b3bSNicholas Bellinger if (ret) { 407b8d26b3bSNicholas Bellinger kfree(device); 408b8d26b3bSNicholas Bellinger mutex_unlock(&device_list_mutex); 409b8d26b3bSNicholas Bellinger return ERR_PTR(ret); 410b8d26b3bSNicholas Bellinger } 411b8d26b3bSNicholas Bellinger 412b8d26b3bSNicholas Bellinger device->refcount++; 413b8d26b3bSNicholas Bellinger list_add_tail(&device->dev_node, &device_list); 414b8d26b3bSNicholas Bellinger mutex_unlock(&device_list_mutex); 415b8d26b3bSNicholas Bellinger 416b8d26b3bSNicholas Bellinger return device; 417b8d26b3bSNicholas Bellinger } 418b8d26b3bSNicholas Bellinger 41959464ef4SVu Pham static void 420a3a5a826SSagi Grimberg isert_conn_free_fastreg_pool(struct isert_conn *isert_conn) 42159464ef4SVu Pham { 42259464ef4SVu Pham struct fast_reg_descriptor *fr_desc, *tmp; 42359464ef4SVu Pham int i = 0; 42459464ef4SVu Pham 425a3a5a826SSagi Grimberg if (list_empty(&isert_conn->conn_fr_pool)) 42659464ef4SVu Pham return; 42759464ef4SVu Pham 428a3a5a826SSagi Grimberg pr_debug("Freeing conn %p fastreg pool", isert_conn); 42959464ef4SVu Pham 43059464ef4SVu Pham list_for_each_entry_safe(fr_desc, tmp, 431a3a5a826SSagi Grimberg &isert_conn->conn_fr_pool, list) { 43259464ef4SVu Pham list_del(&fr_desc->list); 43359464ef4SVu Pham ib_free_fast_reg_page_list(fr_desc->data_frpl); 43459464ef4SVu Pham ib_dereg_mr(fr_desc->data_mr); 435d3e125daSSagi Grimberg if (fr_desc->pi_ctx) { 436d3e125daSSagi Grimberg ib_free_fast_reg_page_list(fr_desc->pi_ctx->prot_frpl); 437d3e125daSSagi Grimberg ib_dereg_mr(fr_desc->pi_ctx->prot_mr); 438d3e125daSSagi Grimberg ib_destroy_mr(fr_desc->pi_ctx->sig_mr); 439d3e125daSSagi Grimberg kfree(fr_desc->pi_ctx); 440d3e125daSSagi Grimberg } 44159464ef4SVu Pham kfree(fr_desc); 44259464ef4SVu Pham ++i; 44359464ef4SVu Pham } 44459464ef4SVu Pham 445a3a5a826SSagi Grimberg if (i < isert_conn->conn_fr_pool_size) 44659464ef4SVu Pham pr_warn("Pool still has %d regions registered\n", 447a3a5a826SSagi Grimberg isert_conn->conn_fr_pool_size - i); 44859464ef4SVu Pham } 44959464ef4SVu Pham 45059464ef4SVu Pham static int 451570db170SSagi Grimberg isert_create_pi_ctx(struct fast_reg_descriptor *desc, 452570db170SSagi Grimberg struct ib_device *device, 453570db170SSagi Grimberg struct ib_pd *pd) 454570db170SSagi Grimberg { 455570db170SSagi Grimberg struct ib_mr_init_attr mr_init_attr; 456570db170SSagi Grimberg struct pi_context *pi_ctx; 457570db170SSagi Grimberg int ret; 458570db170SSagi Grimberg 459570db170SSagi Grimberg pi_ctx = kzalloc(sizeof(*desc->pi_ctx), GFP_KERNEL); 460570db170SSagi Grimberg if (!pi_ctx) { 461570db170SSagi Grimberg pr_err("Failed to allocate pi context\n"); 462570db170SSagi Grimberg return -ENOMEM; 463570db170SSagi Grimberg } 464570db170SSagi Grimberg 465570db170SSagi Grimberg pi_ctx->prot_frpl = ib_alloc_fast_reg_page_list(device, 466570db170SSagi Grimberg ISCSI_ISER_SG_TABLESIZE); 467570db170SSagi Grimberg if (IS_ERR(pi_ctx->prot_frpl)) { 468570db170SSagi Grimberg pr_err("Failed to allocate prot frpl err=%ld\n", 469570db170SSagi Grimberg PTR_ERR(pi_ctx->prot_frpl)); 470570db170SSagi Grimberg ret = PTR_ERR(pi_ctx->prot_frpl); 471570db170SSagi Grimberg goto err_pi_ctx; 472570db170SSagi Grimberg } 473570db170SSagi Grimberg 474570db170SSagi Grimberg pi_ctx->prot_mr = ib_alloc_fast_reg_mr(pd, ISCSI_ISER_SG_TABLESIZE); 475570db170SSagi Grimberg if (IS_ERR(pi_ctx->prot_mr)) { 476570db170SSagi Grimberg pr_err("Failed to allocate prot frmr err=%ld\n", 477570db170SSagi Grimberg PTR_ERR(pi_ctx->prot_mr)); 478570db170SSagi Grimberg ret = PTR_ERR(pi_ctx->prot_mr); 479570db170SSagi Grimberg goto err_prot_frpl; 480570db170SSagi Grimberg } 481570db170SSagi Grimberg desc->ind |= ISERT_PROT_KEY_VALID; 482570db170SSagi Grimberg 483570db170SSagi Grimberg memset(&mr_init_attr, 0, sizeof(mr_init_attr)); 484570db170SSagi Grimberg mr_init_attr.max_reg_descriptors = 2; 485570db170SSagi Grimberg mr_init_attr.flags |= IB_MR_SIGNATURE_EN; 486570db170SSagi Grimberg pi_ctx->sig_mr = ib_create_mr(pd, &mr_init_attr); 487570db170SSagi Grimberg if (IS_ERR(pi_ctx->sig_mr)) { 488570db170SSagi Grimberg pr_err("Failed to allocate signature enabled mr err=%ld\n", 489570db170SSagi Grimberg PTR_ERR(pi_ctx->sig_mr)); 490570db170SSagi Grimberg ret = PTR_ERR(pi_ctx->sig_mr); 491570db170SSagi Grimberg goto err_prot_mr; 492570db170SSagi Grimberg } 493570db170SSagi Grimberg 494570db170SSagi Grimberg desc->pi_ctx = pi_ctx; 495570db170SSagi Grimberg desc->ind |= ISERT_SIG_KEY_VALID; 496570db170SSagi Grimberg desc->ind &= ~ISERT_PROTECTED; 497570db170SSagi Grimberg 498570db170SSagi Grimberg return 0; 499570db170SSagi Grimberg 500570db170SSagi Grimberg err_prot_mr: 501570db170SSagi Grimberg ib_dereg_mr(desc->pi_ctx->prot_mr); 502570db170SSagi Grimberg err_prot_frpl: 503570db170SSagi Grimberg ib_free_fast_reg_page_list(desc->pi_ctx->prot_frpl); 504570db170SSagi Grimberg err_pi_ctx: 505570db170SSagi Grimberg kfree(desc->pi_ctx); 506570db170SSagi Grimberg 507570db170SSagi Grimberg return ret; 508570db170SSagi Grimberg } 509570db170SSagi Grimberg 510570db170SSagi Grimberg static int 511dc87a90fSSagi Grimberg isert_create_fr_desc(struct ib_device *ib_device, struct ib_pd *pd, 512570db170SSagi Grimberg struct fast_reg_descriptor *fr_desc) 513dc87a90fSSagi Grimberg { 514d3e125daSSagi Grimberg int ret; 515d3e125daSSagi Grimberg 516dc87a90fSSagi Grimberg fr_desc->data_frpl = ib_alloc_fast_reg_page_list(ib_device, 517dc87a90fSSagi Grimberg ISCSI_ISER_SG_TABLESIZE); 518dc87a90fSSagi Grimberg if (IS_ERR(fr_desc->data_frpl)) { 519dc87a90fSSagi Grimberg pr_err("Failed to allocate data frpl err=%ld\n", 520dc87a90fSSagi Grimberg PTR_ERR(fr_desc->data_frpl)); 521dc87a90fSSagi Grimberg return PTR_ERR(fr_desc->data_frpl); 522dc87a90fSSagi Grimberg } 523dc87a90fSSagi Grimberg 524dc87a90fSSagi Grimberg fr_desc->data_mr = ib_alloc_fast_reg_mr(pd, ISCSI_ISER_SG_TABLESIZE); 525dc87a90fSSagi Grimberg if (IS_ERR(fr_desc->data_mr)) { 526dc87a90fSSagi Grimberg pr_err("Failed to allocate data frmr err=%ld\n", 527dc87a90fSSagi Grimberg PTR_ERR(fr_desc->data_mr)); 528d3e125daSSagi Grimberg ret = PTR_ERR(fr_desc->data_mr); 529d3e125daSSagi Grimberg goto err_data_frpl; 530dc87a90fSSagi Grimberg } 531d3e125daSSagi Grimberg fr_desc->ind |= ISERT_DATA_KEY_VALID; 532dc87a90fSSagi Grimberg 533570db170SSagi Grimberg pr_debug("Created fr_desc %p\n", fr_desc); 534dc87a90fSSagi Grimberg 535dc87a90fSSagi Grimberg return 0; 536570db170SSagi Grimberg 537d3e125daSSagi Grimberg err_data_frpl: 538d3e125daSSagi Grimberg ib_free_fast_reg_page_list(fr_desc->data_frpl); 539d3e125daSSagi Grimberg 540d3e125daSSagi Grimberg return ret; 541dc87a90fSSagi Grimberg } 542dc87a90fSSagi Grimberg 543dc87a90fSSagi Grimberg static int 544570db170SSagi Grimberg isert_conn_create_fastreg_pool(struct isert_conn *isert_conn) 54559464ef4SVu Pham { 54659464ef4SVu Pham struct fast_reg_descriptor *fr_desc; 54759464ef4SVu Pham struct isert_device *device = isert_conn->conn_device; 548f46d6a8aSNicholas Bellinger struct se_session *se_sess = isert_conn->conn->sess->se_sess; 549f46d6a8aSNicholas Bellinger struct se_node_acl *se_nacl = se_sess->se_node_acl; 550f46d6a8aSNicholas Bellinger int i, ret, tag_num; 551f46d6a8aSNicholas Bellinger /* 552f46d6a8aSNicholas Bellinger * Setup the number of FRMRs based upon the number of tags 553f46d6a8aSNicholas Bellinger * available to session in iscsi_target_locate_portal(). 554f46d6a8aSNicholas Bellinger */ 555f46d6a8aSNicholas Bellinger tag_num = max_t(u32, ISCSIT_MIN_TAGS, se_nacl->queue_depth); 556f46d6a8aSNicholas Bellinger tag_num = (tag_num * 2) + ISCSIT_EXTRA_TAGS; 55759464ef4SVu Pham 558a3a5a826SSagi Grimberg isert_conn->conn_fr_pool_size = 0; 559f46d6a8aSNicholas Bellinger for (i = 0; i < tag_num; i++) { 56059464ef4SVu Pham fr_desc = kzalloc(sizeof(*fr_desc), GFP_KERNEL); 56159464ef4SVu Pham if (!fr_desc) { 56259464ef4SVu Pham pr_err("Failed to allocate fast_reg descriptor\n"); 56359464ef4SVu Pham ret = -ENOMEM; 56459464ef4SVu Pham goto err; 56559464ef4SVu Pham } 56659464ef4SVu Pham 567dc87a90fSSagi Grimberg ret = isert_create_fr_desc(device->ib_device, 568570db170SSagi Grimberg isert_conn->conn_pd, fr_desc); 569dc87a90fSSagi Grimberg if (ret) { 570dc87a90fSSagi Grimberg pr_err("Failed to create fastreg descriptor err=%d\n", 571dc87a90fSSagi Grimberg ret); 572a80e21b3SNicholas Bellinger kfree(fr_desc); 57359464ef4SVu Pham goto err; 57459464ef4SVu Pham } 57559464ef4SVu Pham 576a3a5a826SSagi Grimberg list_add_tail(&fr_desc->list, &isert_conn->conn_fr_pool); 577a3a5a826SSagi Grimberg isert_conn->conn_fr_pool_size++; 57859464ef4SVu Pham } 57959464ef4SVu Pham 580a3a5a826SSagi Grimberg pr_debug("Creating conn %p fastreg pool size=%d", 581a3a5a826SSagi Grimberg isert_conn, isert_conn->conn_fr_pool_size); 58259464ef4SVu Pham 58359464ef4SVu Pham return 0; 58459464ef4SVu Pham 58559464ef4SVu Pham err: 586a3a5a826SSagi Grimberg isert_conn_free_fastreg_pool(isert_conn); 58759464ef4SVu Pham return ret; 58859464ef4SVu Pham } 58959464ef4SVu Pham 590b8d26b3bSNicholas Bellinger static int 591b8d26b3bSNicholas Bellinger isert_connect_request(struct rdma_cm_id *cma_id, struct rdma_cm_event *event) 592b8d26b3bSNicholas Bellinger { 593ca6c1d82SSagi Grimberg struct isert_np *isert_np = cma_id->context; 594ca6c1d82SSagi Grimberg struct iscsi_np *np = isert_np->np; 595b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn; 596b8d26b3bSNicholas Bellinger struct isert_device *device; 597b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = cma_id->device; 598b8d26b3bSNicholas Bellinger int ret = 0; 59914f4b54fSSagi Grimberg 60014f4b54fSSagi Grimberg spin_lock_bh(&np->np_thread_lock); 60114f4b54fSSagi Grimberg if (!np->enabled) { 60214f4b54fSSagi Grimberg spin_unlock_bh(&np->np_thread_lock); 60314f4b54fSSagi Grimberg pr_debug("iscsi_np is not enabled, reject connect request\n"); 60414f4b54fSSagi Grimberg return rdma_reject(cma_id, NULL, 0); 60514f4b54fSSagi Grimberg } 60614f4b54fSSagi Grimberg spin_unlock_bh(&np->np_thread_lock); 607b8d26b3bSNicholas Bellinger 608b8d26b3bSNicholas Bellinger pr_debug("Entering isert_connect_request cma_id: %p, context: %p\n", 609b8d26b3bSNicholas Bellinger cma_id, cma_id->context); 610b8d26b3bSNicholas Bellinger 611b8d26b3bSNicholas Bellinger isert_conn = kzalloc(sizeof(struct isert_conn), GFP_KERNEL); 612b8d26b3bSNicholas Bellinger if (!isert_conn) { 613b8d26b3bSNicholas Bellinger pr_err("Unable to allocate isert_conn\n"); 614b8d26b3bSNicholas Bellinger return -ENOMEM; 615b8d26b3bSNicholas Bellinger } 616b8d26b3bSNicholas Bellinger isert_conn->state = ISER_CONN_INIT; 617b8d26b3bSNicholas Bellinger INIT_LIST_HEAD(&isert_conn->conn_accept_node); 618b8d26b3bSNicholas Bellinger init_completion(&isert_conn->conn_login_comp); 6192371e5daSSagi Grimberg init_completion(&isert_conn->login_req_comp); 620defd8848SNicholas Bellinger init_completion(&isert_conn->conn_wait); 621defd8848SNicholas Bellinger init_completion(&isert_conn->conn_wait_comp_err); 622b8d26b3bSNicholas Bellinger kref_init(&isert_conn->conn_kref); 623b2cb9649SNicholas Bellinger mutex_init(&isert_conn->conn_mutex); 62459464ef4SVu Pham spin_lock_init(&isert_conn->conn_lock); 625f46d6a8aSNicholas Bellinger INIT_LIST_HEAD(&isert_conn->conn_fr_pool); 626b8d26b3bSNicholas Bellinger 627b8d26b3bSNicholas Bellinger isert_conn->conn_cm_id = cma_id; 628b8d26b3bSNicholas Bellinger 629b8d26b3bSNicholas Bellinger isert_conn->login_buf = kzalloc(ISCSI_DEF_MAX_RECV_SEG_LEN + 630b8d26b3bSNicholas Bellinger ISER_RX_LOGIN_SIZE, GFP_KERNEL); 631b8d26b3bSNicholas Bellinger if (!isert_conn->login_buf) { 632b8d26b3bSNicholas Bellinger pr_err("Unable to allocate isert_conn->login_buf\n"); 633b8d26b3bSNicholas Bellinger ret = -ENOMEM; 634b8d26b3bSNicholas Bellinger goto out; 635b8d26b3bSNicholas Bellinger } 636b8d26b3bSNicholas Bellinger 637b8d26b3bSNicholas Bellinger isert_conn->login_req_buf = isert_conn->login_buf; 638b8d26b3bSNicholas Bellinger isert_conn->login_rsp_buf = isert_conn->login_buf + 639b8d26b3bSNicholas Bellinger ISCSI_DEF_MAX_RECV_SEG_LEN; 640b8d26b3bSNicholas Bellinger pr_debug("Set login_buf: %p login_req_buf: %p login_rsp_buf: %p\n", 641b8d26b3bSNicholas Bellinger isert_conn->login_buf, isert_conn->login_req_buf, 642b8d26b3bSNicholas Bellinger isert_conn->login_rsp_buf); 643b8d26b3bSNicholas Bellinger 644b8d26b3bSNicholas Bellinger isert_conn->login_req_dma = ib_dma_map_single(ib_dev, 645b8d26b3bSNicholas Bellinger (void *)isert_conn->login_req_buf, 646b8d26b3bSNicholas Bellinger ISCSI_DEF_MAX_RECV_SEG_LEN, DMA_FROM_DEVICE); 647b8d26b3bSNicholas Bellinger 648b8d26b3bSNicholas Bellinger ret = ib_dma_mapping_error(ib_dev, isert_conn->login_req_dma); 649b8d26b3bSNicholas Bellinger if (ret) { 650b8d26b3bSNicholas Bellinger pr_err("ib_dma_mapping_error failed for login_req_dma: %d\n", 651b8d26b3bSNicholas Bellinger ret); 652b8d26b3bSNicholas Bellinger isert_conn->login_req_dma = 0; 653b8d26b3bSNicholas Bellinger goto out_login_buf; 654b8d26b3bSNicholas Bellinger } 655b8d26b3bSNicholas Bellinger 656b8d26b3bSNicholas Bellinger isert_conn->login_rsp_dma = ib_dma_map_single(ib_dev, 657b8d26b3bSNicholas Bellinger (void *)isert_conn->login_rsp_buf, 658b8d26b3bSNicholas Bellinger ISER_RX_LOGIN_SIZE, DMA_TO_DEVICE); 659b8d26b3bSNicholas Bellinger 660b8d26b3bSNicholas Bellinger ret = ib_dma_mapping_error(ib_dev, isert_conn->login_rsp_dma); 661b8d26b3bSNicholas Bellinger if (ret) { 662b8d26b3bSNicholas Bellinger pr_err("ib_dma_mapping_error failed for login_rsp_dma: %d\n", 663b8d26b3bSNicholas Bellinger ret); 664b8d26b3bSNicholas Bellinger isert_conn->login_rsp_dma = 0; 665b8d26b3bSNicholas Bellinger goto out_req_dma_map; 666b8d26b3bSNicholas Bellinger } 667b8d26b3bSNicholas Bellinger 668b8d26b3bSNicholas Bellinger device = isert_device_find_by_ib_dev(cma_id); 669b8d26b3bSNicholas Bellinger if (IS_ERR(device)) { 670b8d26b3bSNicholas Bellinger ret = PTR_ERR(device); 671b8d26b3bSNicholas Bellinger goto out_rsp_dma_map; 672b8d26b3bSNicholas Bellinger } 673b8d26b3bSNicholas Bellinger 6741a92e17eSSagi Grimberg /* Set max inflight RDMA READ requests */ 6751a92e17eSSagi Grimberg isert_conn->initiator_depth = min_t(u8, 6761a92e17eSSagi Grimberg event->param.conn.initiator_depth, 6771a92e17eSSagi Grimberg device->dev_attr.max_qp_init_rd_atom); 6781a92e17eSSagi Grimberg pr_debug("Using initiator_depth: %u\n", isert_conn->initiator_depth); 6791a92e17eSSagi Grimberg 680b8d26b3bSNicholas Bellinger isert_conn->conn_device = device; 681eb6ab132SSagi Grimberg isert_conn->conn_pd = ib_alloc_pd(isert_conn->conn_device->ib_device); 682eb6ab132SSagi Grimberg if (IS_ERR(isert_conn->conn_pd)) { 683eb6ab132SSagi Grimberg ret = PTR_ERR(isert_conn->conn_pd); 684eb6ab132SSagi Grimberg pr_err("ib_alloc_pd failed for conn %p: ret=%d\n", 685eb6ab132SSagi Grimberg isert_conn, ret); 686eb6ab132SSagi Grimberg goto out_pd; 687eb6ab132SSagi Grimberg } 688b8d26b3bSNicholas Bellinger 689eb6ab132SSagi Grimberg isert_conn->conn_mr = ib_get_dma_mr(isert_conn->conn_pd, 690eb6ab132SSagi Grimberg IB_ACCESS_LOCAL_WRITE); 691eb6ab132SSagi Grimberg if (IS_ERR(isert_conn->conn_mr)) { 692eb6ab132SSagi Grimberg ret = PTR_ERR(isert_conn->conn_mr); 693eb6ab132SSagi Grimberg pr_err("ib_get_dma_mr failed for conn %p: ret=%d\n", 694eb6ab132SSagi Grimberg isert_conn, ret); 695eb6ab132SSagi Grimberg goto out_mr; 696eb6ab132SSagi Grimberg } 697b8d26b3bSNicholas Bellinger 698570db170SSagi Grimberg ret = isert_conn_setup_qp(isert_conn, cma_id); 699b8d26b3bSNicholas Bellinger if (ret) 700b8d26b3bSNicholas Bellinger goto out_conn_dev; 701b8d26b3bSNicholas Bellinger 7022371e5daSSagi Grimberg ret = isert_rdma_post_recvl(isert_conn); 7032371e5daSSagi Grimberg if (ret) 7042371e5daSSagi Grimberg goto out_conn_dev; 7052371e5daSSagi Grimberg 7062371e5daSSagi Grimberg ret = isert_rdma_accept(isert_conn); 7072371e5daSSagi Grimberg if (ret) 7082371e5daSSagi Grimberg goto out_conn_dev; 7092371e5daSSagi Grimberg 710b8d26b3bSNicholas Bellinger mutex_lock(&isert_np->np_accept_mutex); 7119fe63c88SSagi Grimberg list_add_tail(&isert_conn->conn_accept_node, &isert_np->np_accept_list); 712b8d26b3bSNicholas Bellinger mutex_unlock(&isert_np->np_accept_mutex); 713b8d26b3bSNicholas Bellinger 714531b7bf4SSagi Grimberg pr_debug("isert_connect_request() up np_sem np: %p\n", np); 715531b7bf4SSagi Grimberg up(&isert_np->np_sem); 716b8d26b3bSNicholas Bellinger return 0; 717b8d26b3bSNicholas Bellinger 718b8d26b3bSNicholas Bellinger out_conn_dev: 719eb6ab132SSagi Grimberg ib_dereg_mr(isert_conn->conn_mr); 720eb6ab132SSagi Grimberg out_mr: 721eb6ab132SSagi Grimberg ib_dealloc_pd(isert_conn->conn_pd); 722eb6ab132SSagi Grimberg out_pd: 723b8d26b3bSNicholas Bellinger isert_device_try_release(device); 724b8d26b3bSNicholas Bellinger out_rsp_dma_map: 725b8d26b3bSNicholas Bellinger ib_dma_unmap_single(ib_dev, isert_conn->login_rsp_dma, 726b8d26b3bSNicholas Bellinger ISER_RX_LOGIN_SIZE, DMA_TO_DEVICE); 727b8d26b3bSNicholas Bellinger out_req_dma_map: 728b8d26b3bSNicholas Bellinger ib_dma_unmap_single(ib_dev, isert_conn->login_req_dma, 729b8d26b3bSNicholas Bellinger ISCSI_DEF_MAX_RECV_SEG_LEN, DMA_FROM_DEVICE); 730b8d26b3bSNicholas Bellinger out_login_buf: 731b8d26b3bSNicholas Bellinger kfree(isert_conn->login_buf); 732b8d26b3bSNicholas Bellinger out: 733b8d26b3bSNicholas Bellinger kfree(isert_conn); 7342371e5daSSagi Grimberg rdma_reject(cma_id, NULL, 0); 735b8d26b3bSNicholas Bellinger return ret; 736b8d26b3bSNicholas Bellinger } 737b8d26b3bSNicholas Bellinger 738b8d26b3bSNicholas Bellinger static void 739b8d26b3bSNicholas Bellinger isert_connect_release(struct isert_conn *isert_conn) 740b8d26b3bSNicholas Bellinger { 741b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 742b8d26b3bSNicholas Bellinger struct isert_device *device = isert_conn->conn_device; 743b8d26b3bSNicholas Bellinger int cq_index; 744b8d26b3bSNicholas Bellinger 745b8d26b3bSNicholas Bellinger pr_debug("Entering isert_connect_release(): >>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>\n"); 746b8d26b3bSNicholas Bellinger 747a3a5a826SSagi Grimberg if (device && device->use_fastreg) 748a3a5a826SSagi Grimberg isert_conn_free_fastreg_pool(isert_conn); 74959464ef4SVu Pham 75019e2090fSSagi Grimberg isert_free_rx_descriptors(isert_conn); 75119e2090fSSagi Grimberg rdma_destroy_id(isert_conn->conn_cm_id); 75219e2090fSSagi Grimberg 753b8d26b3bSNicholas Bellinger if (isert_conn->conn_qp) { 754b8d26b3bSNicholas Bellinger cq_index = ((struct isert_cq_desc *) 755b8d26b3bSNicholas Bellinger isert_conn->conn_qp->recv_cq->cq_context)->cq_index; 756b8d26b3bSNicholas Bellinger pr_debug("isert_connect_release: cq_index: %d\n", cq_index); 75719e2090fSSagi Grimberg mutex_lock(&device_list_mutex); 758b8d26b3bSNicholas Bellinger isert_conn->conn_device->cq_active_qps[cq_index]--; 75919e2090fSSagi Grimberg mutex_unlock(&device_list_mutex); 760b8d26b3bSNicholas Bellinger 76119e2090fSSagi Grimberg ib_destroy_qp(isert_conn->conn_qp); 762b8d26b3bSNicholas Bellinger } 763b8d26b3bSNicholas Bellinger 764eb6ab132SSagi Grimberg ib_dereg_mr(isert_conn->conn_mr); 765eb6ab132SSagi Grimberg ib_dealloc_pd(isert_conn->conn_pd); 766eb6ab132SSagi Grimberg 767b8d26b3bSNicholas Bellinger if (isert_conn->login_buf) { 768b8d26b3bSNicholas Bellinger ib_dma_unmap_single(ib_dev, isert_conn->login_rsp_dma, 769b8d26b3bSNicholas Bellinger ISER_RX_LOGIN_SIZE, DMA_TO_DEVICE); 770b8d26b3bSNicholas Bellinger ib_dma_unmap_single(ib_dev, isert_conn->login_req_dma, 771b8d26b3bSNicholas Bellinger ISCSI_DEF_MAX_RECV_SEG_LEN, 772b8d26b3bSNicholas Bellinger DMA_FROM_DEVICE); 773b8d26b3bSNicholas Bellinger kfree(isert_conn->login_buf); 774b8d26b3bSNicholas Bellinger } 775b8d26b3bSNicholas Bellinger kfree(isert_conn); 776b8d26b3bSNicholas Bellinger 777b8d26b3bSNicholas Bellinger if (device) 778b8d26b3bSNicholas Bellinger isert_device_try_release(device); 779b8d26b3bSNicholas Bellinger 780b8d26b3bSNicholas Bellinger pr_debug("Leaving isert_connect_release >>>>>>>>>>>>\n"); 781b8d26b3bSNicholas Bellinger } 782b8d26b3bSNicholas Bellinger 783b8d26b3bSNicholas Bellinger static void 784b8d26b3bSNicholas Bellinger isert_connected_handler(struct rdma_cm_id *cma_id) 785b8d26b3bSNicholas Bellinger { 78619e2090fSSagi Grimberg struct isert_conn *isert_conn = cma_id->qp->qp_context; 787c2f88b17SSagi Grimberg 788128e9cc8SSagi Grimberg pr_info("conn %p\n", isert_conn); 789128e9cc8SSagi Grimberg 7902371e5daSSagi Grimberg if (!kref_get_unless_zero(&isert_conn->conn_kref)) { 7912371e5daSSagi Grimberg pr_warn("conn %p connect_release is running\n", isert_conn); 7922371e5daSSagi Grimberg return; 7932371e5daSSagi Grimberg } 7942371e5daSSagi Grimberg 7952371e5daSSagi Grimberg mutex_lock(&isert_conn->conn_mutex); 7962371e5daSSagi Grimberg if (isert_conn->state != ISER_CONN_FULL_FEATURE) 797128e9cc8SSagi Grimberg isert_conn->state = ISER_CONN_UP; 7982371e5daSSagi Grimberg mutex_unlock(&isert_conn->conn_mutex); 799b8d26b3bSNicholas Bellinger } 800b8d26b3bSNicholas Bellinger 801b8d26b3bSNicholas Bellinger static void 802b8d26b3bSNicholas Bellinger isert_release_conn_kref(struct kref *kref) 803b8d26b3bSNicholas Bellinger { 804b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = container_of(kref, 805b8d26b3bSNicholas Bellinger struct isert_conn, conn_kref); 806b8d26b3bSNicholas Bellinger 807b8d26b3bSNicholas Bellinger pr_debug("Calling isert_connect_release for final kref %s/%d\n", 808b8d26b3bSNicholas Bellinger current->comm, current->pid); 809b8d26b3bSNicholas Bellinger 810b8d26b3bSNicholas Bellinger isert_connect_release(isert_conn); 811b8d26b3bSNicholas Bellinger } 812b8d26b3bSNicholas Bellinger 813b8d26b3bSNicholas Bellinger static void 814b8d26b3bSNicholas Bellinger isert_put_conn(struct isert_conn *isert_conn) 815b8d26b3bSNicholas Bellinger { 816b8d26b3bSNicholas Bellinger kref_put(&isert_conn->conn_kref, isert_release_conn_kref); 817b8d26b3bSNicholas Bellinger } 818b8d26b3bSNicholas Bellinger 819954f2372SSagi Grimberg /** 820954f2372SSagi Grimberg * isert_conn_terminate() - Initiate connection termination 821954f2372SSagi Grimberg * @isert_conn: isert connection struct 822954f2372SSagi Grimberg * 823954f2372SSagi Grimberg * Notes: 824128e9cc8SSagi Grimberg * In case the connection state is FULL_FEATURE, move state 825954f2372SSagi Grimberg * to TEMINATING and start teardown sequence (rdma_disconnect). 826128e9cc8SSagi Grimberg * In case the connection state is UP, complete flush as well. 827954f2372SSagi Grimberg * 828954f2372SSagi Grimberg * This routine must be called with conn_mutex held. Thus it is 829954f2372SSagi Grimberg * safe to call multiple times. 830954f2372SSagi Grimberg */ 831954f2372SSagi Grimberg static void 832954f2372SSagi Grimberg isert_conn_terminate(struct isert_conn *isert_conn) 833954f2372SSagi Grimberg { 834954f2372SSagi Grimberg int err; 835954f2372SSagi Grimberg 836128e9cc8SSagi Grimberg switch (isert_conn->state) { 837128e9cc8SSagi Grimberg case ISER_CONN_TERMINATING: 838128e9cc8SSagi Grimberg break; 839128e9cc8SSagi Grimberg case ISER_CONN_UP: 840128e9cc8SSagi Grimberg /* 841128e9cc8SSagi Grimberg * No flush completions will occur as we didn't 842128e9cc8SSagi Grimberg * get to ISER_CONN_FULL_FEATURE yet, complete 843128e9cc8SSagi Grimberg * to allow teardown progress. 844128e9cc8SSagi Grimberg */ 845128e9cc8SSagi Grimberg complete(&isert_conn->conn_wait_comp_err); 846128e9cc8SSagi Grimberg case ISER_CONN_FULL_FEATURE: /* FALLTHRU */ 847954f2372SSagi Grimberg pr_info("Terminating conn %p state %d\n", 848954f2372SSagi Grimberg isert_conn, isert_conn->state); 849128e9cc8SSagi Grimberg isert_conn->state = ISER_CONN_TERMINATING; 850954f2372SSagi Grimberg err = rdma_disconnect(isert_conn->conn_cm_id); 851954f2372SSagi Grimberg if (err) 852954f2372SSagi Grimberg pr_warn("Failed rdma_disconnect isert_conn %p\n", 853954f2372SSagi Grimberg isert_conn); 854128e9cc8SSagi Grimberg break; 855128e9cc8SSagi Grimberg default: 856128e9cc8SSagi Grimberg pr_warn("conn %p teminating in state %d\n", 857128e9cc8SSagi Grimberg isert_conn, isert_conn->state); 858954f2372SSagi Grimberg } 859954f2372SSagi Grimberg } 860954f2372SSagi Grimberg 8613b726ae2SSagi Grimberg static int 862ca6c1d82SSagi Grimberg isert_np_cma_handler(struct isert_np *isert_np, 863ca6c1d82SSagi Grimberg enum rdma_cm_event_type event) 864b8d26b3bSNicholas Bellinger { 865ca6c1d82SSagi Grimberg pr_debug("isert np %p, handling event %d\n", isert_np, event); 8663b726ae2SSagi Grimberg 867ca6c1d82SSagi Grimberg switch (event) { 868ca6c1d82SSagi Grimberg case RDMA_CM_EVENT_DEVICE_REMOVAL: 8693b726ae2SSagi Grimberg isert_np->np_cm_id = NULL; 870ca6c1d82SSagi Grimberg break; 871ca6c1d82SSagi Grimberg case RDMA_CM_EVENT_ADDR_CHANGE: 872ca6c1d82SSagi Grimberg isert_np->np_cm_id = isert_setup_id(isert_np); 873ca6c1d82SSagi Grimberg if (IS_ERR(isert_np->np_cm_id)) { 874ca6c1d82SSagi Grimberg pr_err("isert np %p setup id failed: %ld\n", 875ca6c1d82SSagi Grimberg isert_np, PTR_ERR(isert_np->np_cm_id)); 876ca6c1d82SSagi Grimberg isert_np->np_cm_id = NULL; 877ca6c1d82SSagi Grimberg } 878ca6c1d82SSagi Grimberg break; 879ca6c1d82SSagi Grimberg default: 880ca6c1d82SSagi Grimberg pr_err("isert np %p Unexpected event %d\n", 881ca6c1d82SSagi Grimberg isert_np, event); 882ca6c1d82SSagi Grimberg } 883ca6c1d82SSagi Grimberg 8843b726ae2SSagi Grimberg return -1; 8853b726ae2SSagi Grimberg } 8863b726ae2SSagi Grimberg 887ca6c1d82SSagi Grimberg static int 888ca6c1d82SSagi Grimberg isert_disconnected_handler(struct rdma_cm_id *cma_id, 889ca6c1d82SSagi Grimberg enum rdma_cm_event_type event) 890ca6c1d82SSagi Grimberg { 891ca6c1d82SSagi Grimberg struct isert_np *isert_np = cma_id->context; 892ca6c1d82SSagi Grimberg struct isert_conn *isert_conn; 893ca6c1d82SSagi Grimberg 894ca6c1d82SSagi Grimberg if (isert_np->np_cm_id == cma_id) 895ca6c1d82SSagi Grimberg return isert_np_cma_handler(cma_id->context, event); 896ca6c1d82SSagi Grimberg 89719e2090fSSagi Grimberg isert_conn = cma_id->qp->qp_context; 898b8d26b3bSNicholas Bellinger 899128e9cc8SSagi Grimberg mutex_lock(&isert_conn->conn_mutex); 900128e9cc8SSagi Grimberg isert_conn_terminate(isert_conn); 901128e9cc8SSagi Grimberg mutex_unlock(&isert_conn->conn_mutex); 902128e9cc8SSagi Grimberg 903128e9cc8SSagi Grimberg pr_info("conn %p completing conn_wait\n", isert_conn); 904128e9cc8SSagi Grimberg complete(&isert_conn->conn_wait); 9053b726ae2SSagi Grimberg 9063b726ae2SSagi Grimberg return 0; 907b8d26b3bSNicholas Bellinger } 908b8d26b3bSNicholas Bellinger 909954f2372SSagi Grimberg static void 910954f2372SSagi Grimberg isert_connect_error(struct rdma_cm_id *cma_id) 911954f2372SSagi Grimberg { 91219e2090fSSagi Grimberg struct isert_conn *isert_conn = cma_id->qp->qp_context; 913954f2372SSagi Grimberg 914954f2372SSagi Grimberg isert_put_conn(isert_conn); 915954f2372SSagi Grimberg } 916954f2372SSagi Grimberg 917b8d26b3bSNicholas Bellinger static int 918b8d26b3bSNicholas Bellinger isert_cma_handler(struct rdma_cm_id *cma_id, struct rdma_cm_event *event) 919b8d26b3bSNicholas Bellinger { 920b8d26b3bSNicholas Bellinger int ret = 0; 921b8d26b3bSNicholas Bellinger 922b8d26b3bSNicholas Bellinger pr_debug("isert_cma_handler: event %d status %d conn %p id %p\n", 923b8d26b3bSNicholas Bellinger event->event, event->status, cma_id->context, cma_id); 924b8d26b3bSNicholas Bellinger 925b8d26b3bSNicholas Bellinger switch (event->event) { 926b8d26b3bSNicholas Bellinger case RDMA_CM_EVENT_CONNECT_REQUEST: 927b8d26b3bSNicholas Bellinger ret = isert_connect_request(cma_id, event); 9283b726ae2SSagi Grimberg if (ret) 9293b726ae2SSagi Grimberg pr_err("isert_cma_handler failed RDMA_CM_EVENT: 0x%08x %d\n", 9303b726ae2SSagi Grimberg event->event, ret); 931b8d26b3bSNicholas Bellinger break; 932b8d26b3bSNicholas Bellinger case RDMA_CM_EVENT_ESTABLISHED: 933b8d26b3bSNicholas Bellinger isert_connected_handler(cma_id); 934b8d26b3bSNicholas Bellinger break; 93588c4015fSSagi Grimberg case RDMA_CM_EVENT_ADDR_CHANGE: /* FALLTHRU */ 93688c4015fSSagi Grimberg case RDMA_CM_EVENT_DISCONNECTED: /* FALLTHRU */ 93788c4015fSSagi Grimberg case RDMA_CM_EVENT_DEVICE_REMOVAL: /* FALLTHRU */ 93888c4015fSSagi Grimberg case RDMA_CM_EVENT_TIMEWAIT_EXIT: /* FALLTHRU */ 939ca6c1d82SSagi Grimberg ret = isert_disconnected_handler(cma_id, event->event); 940b8d26b3bSNicholas Bellinger break; 941954f2372SSagi Grimberg case RDMA_CM_EVENT_REJECTED: /* FALLTHRU */ 942954f2372SSagi Grimberg case RDMA_CM_EVENT_UNREACHABLE: /* FALLTHRU */ 943b8d26b3bSNicholas Bellinger case RDMA_CM_EVENT_CONNECT_ERROR: 944954f2372SSagi Grimberg isert_connect_error(cma_id); 945954f2372SSagi Grimberg break; 946b8d26b3bSNicholas Bellinger default: 94788c4015fSSagi Grimberg pr_err("Unhandled RDMA CMA event: %d\n", event->event); 948b8d26b3bSNicholas Bellinger break; 949b8d26b3bSNicholas Bellinger } 950b8d26b3bSNicholas Bellinger 951b8d26b3bSNicholas Bellinger return ret; 952b8d26b3bSNicholas Bellinger } 953b8d26b3bSNicholas Bellinger 954b8d26b3bSNicholas Bellinger static int 955b8d26b3bSNicholas Bellinger isert_post_recv(struct isert_conn *isert_conn, u32 count) 956b8d26b3bSNicholas Bellinger { 957b8d26b3bSNicholas Bellinger struct ib_recv_wr *rx_wr, *rx_wr_failed; 958b8d26b3bSNicholas Bellinger int i, ret; 959b8d26b3bSNicholas Bellinger unsigned int rx_head = isert_conn->conn_rx_desc_head; 960b8d26b3bSNicholas Bellinger struct iser_rx_desc *rx_desc; 961b8d26b3bSNicholas Bellinger 962b8d26b3bSNicholas Bellinger for (rx_wr = isert_conn->conn_rx_wr, i = 0; i < count; i++, rx_wr++) { 963b8d26b3bSNicholas Bellinger rx_desc = &isert_conn->conn_rx_descs[rx_head]; 964b8d26b3bSNicholas Bellinger rx_wr->wr_id = (unsigned long)rx_desc; 965b8d26b3bSNicholas Bellinger rx_wr->sg_list = &rx_desc->rx_sg; 966b8d26b3bSNicholas Bellinger rx_wr->num_sge = 1; 967b8d26b3bSNicholas Bellinger rx_wr->next = rx_wr + 1; 968b8d26b3bSNicholas Bellinger rx_head = (rx_head + 1) & (ISERT_QP_MAX_RECV_DTOS - 1); 969b8d26b3bSNicholas Bellinger } 970b8d26b3bSNicholas Bellinger 971b8d26b3bSNicholas Bellinger rx_wr--; 972b8d26b3bSNicholas Bellinger rx_wr->next = NULL; /* mark end of work requests list */ 973b8d26b3bSNicholas Bellinger 974b8d26b3bSNicholas Bellinger isert_conn->post_recv_buf_count += count; 975b8d26b3bSNicholas Bellinger ret = ib_post_recv(isert_conn->conn_qp, isert_conn->conn_rx_wr, 976b8d26b3bSNicholas Bellinger &rx_wr_failed); 977b8d26b3bSNicholas Bellinger if (ret) { 978b8d26b3bSNicholas Bellinger pr_err("ib_post_recv() failed with ret: %d\n", ret); 979b8d26b3bSNicholas Bellinger isert_conn->post_recv_buf_count -= count; 980b8d26b3bSNicholas Bellinger } else { 981b8d26b3bSNicholas Bellinger pr_debug("isert_post_recv(): Posted %d RX buffers\n", count); 982b8d26b3bSNicholas Bellinger isert_conn->conn_rx_desc_head = rx_head; 983b8d26b3bSNicholas Bellinger } 984b8d26b3bSNicholas Bellinger return ret; 985b8d26b3bSNicholas Bellinger } 986b8d26b3bSNicholas Bellinger 987b8d26b3bSNicholas Bellinger static int 988b8d26b3bSNicholas Bellinger isert_post_send(struct isert_conn *isert_conn, struct iser_tx_desc *tx_desc) 989b8d26b3bSNicholas Bellinger { 990b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 991b8d26b3bSNicholas Bellinger struct ib_send_wr send_wr, *send_wr_failed; 992b8d26b3bSNicholas Bellinger int ret; 993b8d26b3bSNicholas Bellinger 994b8d26b3bSNicholas Bellinger ib_dma_sync_single_for_device(ib_dev, tx_desc->dma_addr, 995b8d26b3bSNicholas Bellinger ISER_HEADERS_LEN, DMA_TO_DEVICE); 996b8d26b3bSNicholas Bellinger 997b8d26b3bSNicholas Bellinger send_wr.next = NULL; 998b8d26b3bSNicholas Bellinger send_wr.wr_id = (unsigned long)tx_desc; 999b8d26b3bSNicholas Bellinger send_wr.sg_list = tx_desc->tx_sg; 1000b8d26b3bSNicholas Bellinger send_wr.num_sge = tx_desc->num_sge; 1001b8d26b3bSNicholas Bellinger send_wr.opcode = IB_WR_SEND; 1002b8d26b3bSNicholas Bellinger send_wr.send_flags = IB_SEND_SIGNALED; 1003b8d26b3bSNicholas Bellinger 1004b8d26b3bSNicholas Bellinger atomic_inc(&isert_conn->post_send_buf_count); 1005b8d26b3bSNicholas Bellinger 1006b8d26b3bSNicholas Bellinger ret = ib_post_send(isert_conn->conn_qp, &send_wr, &send_wr_failed); 1007b8d26b3bSNicholas Bellinger if (ret) { 1008b8d26b3bSNicholas Bellinger pr_err("ib_post_send() failed, ret: %d\n", ret); 1009b8d26b3bSNicholas Bellinger atomic_dec(&isert_conn->post_send_buf_count); 1010b8d26b3bSNicholas Bellinger } 1011b8d26b3bSNicholas Bellinger 1012b8d26b3bSNicholas Bellinger return ret; 1013b8d26b3bSNicholas Bellinger } 1014b8d26b3bSNicholas Bellinger 1015b8d26b3bSNicholas Bellinger static void 1016b8d26b3bSNicholas Bellinger isert_create_send_desc(struct isert_conn *isert_conn, 1017b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd, 1018b8d26b3bSNicholas Bellinger struct iser_tx_desc *tx_desc) 1019b8d26b3bSNicholas Bellinger { 1020b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 1021b8d26b3bSNicholas Bellinger 1022b8d26b3bSNicholas Bellinger ib_dma_sync_single_for_cpu(ib_dev, tx_desc->dma_addr, 1023b8d26b3bSNicholas Bellinger ISER_HEADERS_LEN, DMA_TO_DEVICE); 1024b8d26b3bSNicholas Bellinger 1025b8d26b3bSNicholas Bellinger memset(&tx_desc->iser_header, 0, sizeof(struct iser_hdr)); 1026b8d26b3bSNicholas Bellinger tx_desc->iser_header.flags = ISER_VER; 1027b8d26b3bSNicholas Bellinger 1028b8d26b3bSNicholas Bellinger tx_desc->num_sge = 1; 1029b8d26b3bSNicholas Bellinger tx_desc->isert_cmd = isert_cmd; 1030b8d26b3bSNicholas Bellinger 1031b8d26b3bSNicholas Bellinger if (tx_desc->tx_sg[0].lkey != isert_conn->conn_mr->lkey) { 1032b8d26b3bSNicholas Bellinger tx_desc->tx_sg[0].lkey = isert_conn->conn_mr->lkey; 1033b8d26b3bSNicholas Bellinger pr_debug("tx_desc %p lkey mismatch, fixing\n", tx_desc); 1034b8d26b3bSNicholas Bellinger } 1035b8d26b3bSNicholas Bellinger } 1036b8d26b3bSNicholas Bellinger 1037b8d26b3bSNicholas Bellinger static int 1038b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(struct isert_conn *isert_conn, 1039b8d26b3bSNicholas Bellinger struct iser_tx_desc *tx_desc) 1040b8d26b3bSNicholas Bellinger { 1041b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 1042b8d26b3bSNicholas Bellinger u64 dma_addr; 1043b8d26b3bSNicholas Bellinger 1044b8d26b3bSNicholas Bellinger dma_addr = ib_dma_map_single(ib_dev, (void *)tx_desc, 1045b8d26b3bSNicholas Bellinger ISER_HEADERS_LEN, DMA_TO_DEVICE); 1046b8d26b3bSNicholas Bellinger if (ib_dma_mapping_error(ib_dev, dma_addr)) { 1047b8d26b3bSNicholas Bellinger pr_err("ib_dma_mapping_error() failed\n"); 1048b8d26b3bSNicholas Bellinger return -ENOMEM; 1049b8d26b3bSNicholas Bellinger } 1050b8d26b3bSNicholas Bellinger 1051b8d26b3bSNicholas Bellinger tx_desc->dma_addr = dma_addr; 1052b8d26b3bSNicholas Bellinger tx_desc->tx_sg[0].addr = tx_desc->dma_addr; 1053b8d26b3bSNicholas Bellinger tx_desc->tx_sg[0].length = ISER_HEADERS_LEN; 1054b8d26b3bSNicholas Bellinger tx_desc->tx_sg[0].lkey = isert_conn->conn_mr->lkey; 1055b8d26b3bSNicholas Bellinger 1056b8d26b3bSNicholas Bellinger pr_debug("isert_init_tx_hdrs: Setup tx_sg[0].addr: 0x%llx length: %u" 1057b8d26b3bSNicholas Bellinger " lkey: 0x%08x\n", tx_desc->tx_sg[0].addr, 1058b8d26b3bSNicholas Bellinger tx_desc->tx_sg[0].length, tx_desc->tx_sg[0].lkey); 1059b8d26b3bSNicholas Bellinger 1060b8d26b3bSNicholas Bellinger return 0; 1061b8d26b3bSNicholas Bellinger } 1062b8d26b3bSNicholas Bellinger 1063b8d26b3bSNicholas Bellinger static void 106495b60f07SNicholas Bellinger isert_init_send_wr(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd, 106568a86deeSSagi Grimberg struct ib_send_wr *send_wr) 1066b8d26b3bSNicholas Bellinger { 106795b60f07SNicholas Bellinger struct iser_tx_desc *tx_desc = &isert_cmd->tx_desc; 106895b60f07SNicholas Bellinger 1069b8d26b3bSNicholas Bellinger isert_cmd->rdma_wr.iser_ib_op = ISER_IB_SEND; 1070b8d26b3bSNicholas Bellinger send_wr->wr_id = (unsigned long)&isert_cmd->tx_desc; 1071b8d26b3bSNicholas Bellinger send_wr->opcode = IB_WR_SEND; 107295b60f07SNicholas Bellinger send_wr->sg_list = &tx_desc->tx_sg[0]; 1073b8d26b3bSNicholas Bellinger send_wr->num_sge = isert_cmd->tx_desc.num_sge; 107495b60f07SNicholas Bellinger send_wr->send_flags = IB_SEND_SIGNALED; 1075b8d26b3bSNicholas Bellinger } 1076b8d26b3bSNicholas Bellinger 1077b8d26b3bSNicholas Bellinger static int 1078b8d26b3bSNicholas Bellinger isert_rdma_post_recvl(struct isert_conn *isert_conn) 1079b8d26b3bSNicholas Bellinger { 1080b8d26b3bSNicholas Bellinger struct ib_recv_wr rx_wr, *rx_wr_fail; 1081b8d26b3bSNicholas Bellinger struct ib_sge sge; 1082b8d26b3bSNicholas Bellinger int ret; 1083b8d26b3bSNicholas Bellinger 1084b8d26b3bSNicholas Bellinger memset(&sge, 0, sizeof(struct ib_sge)); 1085b8d26b3bSNicholas Bellinger sge.addr = isert_conn->login_req_dma; 1086b8d26b3bSNicholas Bellinger sge.length = ISER_RX_LOGIN_SIZE; 1087b8d26b3bSNicholas Bellinger sge.lkey = isert_conn->conn_mr->lkey; 1088b8d26b3bSNicholas Bellinger 1089b8d26b3bSNicholas Bellinger pr_debug("Setup sge: addr: %llx length: %d 0x%08x\n", 1090b8d26b3bSNicholas Bellinger sge.addr, sge.length, sge.lkey); 1091b8d26b3bSNicholas Bellinger 1092b8d26b3bSNicholas Bellinger memset(&rx_wr, 0, sizeof(struct ib_recv_wr)); 1093b8d26b3bSNicholas Bellinger rx_wr.wr_id = (unsigned long)isert_conn->login_req_buf; 1094b8d26b3bSNicholas Bellinger rx_wr.sg_list = &sge; 1095b8d26b3bSNicholas Bellinger rx_wr.num_sge = 1; 1096b8d26b3bSNicholas Bellinger 1097b8d26b3bSNicholas Bellinger isert_conn->post_recv_buf_count++; 1098b8d26b3bSNicholas Bellinger ret = ib_post_recv(isert_conn->conn_qp, &rx_wr, &rx_wr_fail); 1099b8d26b3bSNicholas Bellinger if (ret) { 1100b8d26b3bSNicholas Bellinger pr_err("ib_post_recv() failed: %d\n", ret); 1101b8d26b3bSNicholas Bellinger isert_conn->post_recv_buf_count--; 1102b8d26b3bSNicholas Bellinger } 1103b8d26b3bSNicholas Bellinger 1104b8d26b3bSNicholas Bellinger pr_debug("ib_post_recv(): returned success >>>>>>>>>>>>>>>>>>>>>>>>\n"); 1105b8d26b3bSNicholas Bellinger return ret; 1106b8d26b3bSNicholas Bellinger } 1107b8d26b3bSNicholas Bellinger 1108b8d26b3bSNicholas Bellinger static int 1109b8d26b3bSNicholas Bellinger isert_put_login_tx(struct iscsi_conn *conn, struct iscsi_login *login, 1110b8d26b3bSNicholas Bellinger u32 length) 1111b8d26b3bSNicholas Bellinger { 1112b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = conn->context; 1113b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 1114b8d26b3bSNicholas Bellinger struct iser_tx_desc *tx_desc = &isert_conn->conn_login_tx_desc; 1115b8d26b3bSNicholas Bellinger int ret; 1116b8d26b3bSNicholas Bellinger 1117b8d26b3bSNicholas Bellinger isert_create_send_desc(isert_conn, NULL, tx_desc); 1118b8d26b3bSNicholas Bellinger 1119b8d26b3bSNicholas Bellinger memcpy(&tx_desc->iscsi_header, &login->rsp[0], 1120b8d26b3bSNicholas Bellinger sizeof(struct iscsi_hdr)); 1121b8d26b3bSNicholas Bellinger 1122b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, tx_desc); 1123b8d26b3bSNicholas Bellinger 1124b8d26b3bSNicholas Bellinger if (length > 0) { 1125b8d26b3bSNicholas Bellinger struct ib_sge *tx_dsg = &tx_desc->tx_sg[1]; 1126b8d26b3bSNicholas Bellinger 1127b8d26b3bSNicholas Bellinger ib_dma_sync_single_for_cpu(ib_dev, isert_conn->login_rsp_dma, 1128b8d26b3bSNicholas Bellinger length, DMA_TO_DEVICE); 1129b8d26b3bSNicholas Bellinger 1130b8d26b3bSNicholas Bellinger memcpy(isert_conn->login_rsp_buf, login->rsp_buf, length); 1131b8d26b3bSNicholas Bellinger 1132b8d26b3bSNicholas Bellinger ib_dma_sync_single_for_device(ib_dev, isert_conn->login_rsp_dma, 1133b8d26b3bSNicholas Bellinger length, DMA_TO_DEVICE); 1134b8d26b3bSNicholas Bellinger 1135b8d26b3bSNicholas Bellinger tx_dsg->addr = isert_conn->login_rsp_dma; 1136b8d26b3bSNicholas Bellinger tx_dsg->length = length; 1137b8d26b3bSNicholas Bellinger tx_dsg->lkey = isert_conn->conn_mr->lkey; 1138b8d26b3bSNicholas Bellinger tx_desc->num_sge = 2; 1139b8d26b3bSNicholas Bellinger } 1140b8d26b3bSNicholas Bellinger if (!login->login_failed) { 1141b8d26b3bSNicholas Bellinger if (login->login_complete) { 1142e0546fc1SSagi Grimberg if (!conn->sess->sess_ops->SessionType && 1143e0546fc1SSagi Grimberg isert_conn->conn_device->use_fastreg) { 1144570db170SSagi Grimberg ret = isert_conn_create_fastreg_pool(isert_conn); 1145f46d6a8aSNicholas Bellinger if (ret) { 1146f46d6a8aSNicholas Bellinger pr_err("Conn: %p failed to create" 1147f46d6a8aSNicholas Bellinger " fastreg pool\n", isert_conn); 1148f46d6a8aSNicholas Bellinger return ret; 1149f46d6a8aSNicholas Bellinger } 1150f46d6a8aSNicholas Bellinger } 1151f46d6a8aSNicholas Bellinger 1152b8d26b3bSNicholas Bellinger ret = isert_alloc_rx_descriptors(isert_conn); 1153b8d26b3bSNicholas Bellinger if (ret) 1154b8d26b3bSNicholas Bellinger return ret; 1155b8d26b3bSNicholas Bellinger 1156b8d26b3bSNicholas Bellinger ret = isert_post_recv(isert_conn, ISERT_MIN_POSTED_RX); 1157b8d26b3bSNicholas Bellinger if (ret) 1158b8d26b3bSNicholas Bellinger return ret; 1159b8d26b3bSNicholas Bellinger 1160128e9cc8SSagi Grimberg /* Now we are in FULL_FEATURE phase */ 11612371e5daSSagi Grimberg mutex_lock(&isert_conn->conn_mutex); 1162128e9cc8SSagi Grimberg isert_conn->state = ISER_CONN_FULL_FEATURE; 11632371e5daSSagi Grimberg mutex_unlock(&isert_conn->conn_mutex); 1164b8d26b3bSNicholas Bellinger goto post_send; 1165b8d26b3bSNicholas Bellinger } 1166b8d26b3bSNicholas Bellinger 1167b8d26b3bSNicholas Bellinger ret = isert_rdma_post_recvl(isert_conn); 1168b8d26b3bSNicholas Bellinger if (ret) 1169b8d26b3bSNicholas Bellinger return ret; 1170b8d26b3bSNicholas Bellinger } 1171b8d26b3bSNicholas Bellinger post_send: 1172b8d26b3bSNicholas Bellinger ret = isert_post_send(isert_conn, tx_desc); 1173b8d26b3bSNicholas Bellinger if (ret) 1174b8d26b3bSNicholas Bellinger return ret; 1175b8d26b3bSNicholas Bellinger 1176b8d26b3bSNicholas Bellinger return 0; 1177b8d26b3bSNicholas Bellinger } 1178b8d26b3bSNicholas Bellinger 1179b8d26b3bSNicholas Bellinger static void 11802371e5daSSagi Grimberg isert_rx_login_req(struct isert_conn *isert_conn) 1181b8d26b3bSNicholas Bellinger { 11822371e5daSSagi Grimberg struct iser_rx_desc *rx_desc = (void *)isert_conn->login_req_buf; 11832371e5daSSagi Grimberg int rx_buflen = isert_conn->login_req_len; 1184b8d26b3bSNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1185b8d26b3bSNicholas Bellinger struct iscsi_login *login = conn->conn_login; 1186b8d26b3bSNicholas Bellinger int size; 1187b8d26b3bSNicholas Bellinger 11882371e5daSSagi Grimberg pr_info("conn %p\n", isert_conn); 11892371e5daSSagi Grimberg 11902371e5daSSagi Grimberg WARN_ON_ONCE(!login); 1191b8d26b3bSNicholas Bellinger 1192b8d26b3bSNicholas Bellinger if (login->first_request) { 1193b8d26b3bSNicholas Bellinger struct iscsi_login_req *login_req = 1194b8d26b3bSNicholas Bellinger (struct iscsi_login_req *)&rx_desc->iscsi_header; 1195b8d26b3bSNicholas Bellinger /* 1196b8d26b3bSNicholas Bellinger * Setup the initial iscsi_login values from the leading 1197b8d26b3bSNicholas Bellinger * login request PDU. 1198b8d26b3bSNicholas Bellinger */ 1199b8d26b3bSNicholas Bellinger login->leading_connection = (!login_req->tsih) ? 1 : 0; 1200b8d26b3bSNicholas Bellinger login->current_stage = 1201b8d26b3bSNicholas Bellinger (login_req->flags & ISCSI_FLAG_LOGIN_CURRENT_STAGE_MASK) 1202b8d26b3bSNicholas Bellinger >> 2; 1203b8d26b3bSNicholas Bellinger login->version_min = login_req->min_version; 1204b8d26b3bSNicholas Bellinger login->version_max = login_req->max_version; 1205b8d26b3bSNicholas Bellinger memcpy(login->isid, login_req->isid, 6); 1206b8d26b3bSNicholas Bellinger login->cmd_sn = be32_to_cpu(login_req->cmdsn); 1207b8d26b3bSNicholas Bellinger login->init_task_tag = login_req->itt; 1208b8d26b3bSNicholas Bellinger login->initial_exp_statsn = be32_to_cpu(login_req->exp_statsn); 1209b8d26b3bSNicholas Bellinger login->cid = be16_to_cpu(login_req->cid); 1210b8d26b3bSNicholas Bellinger login->tsih = be16_to_cpu(login_req->tsih); 1211b8d26b3bSNicholas Bellinger } 1212b8d26b3bSNicholas Bellinger 1213b8d26b3bSNicholas Bellinger memcpy(&login->req[0], (void *)&rx_desc->iscsi_header, ISCSI_HDR_LEN); 1214b8d26b3bSNicholas Bellinger 1215b8d26b3bSNicholas Bellinger size = min(rx_buflen, MAX_KEY_VALUE_PAIRS); 1216b8d26b3bSNicholas Bellinger pr_debug("Using login payload size: %d, rx_buflen: %d MAX_KEY_VALUE_PAIRS: %d\n", 1217b8d26b3bSNicholas Bellinger size, rx_buflen, MAX_KEY_VALUE_PAIRS); 1218b8d26b3bSNicholas Bellinger memcpy(login->req_buf, &rx_desc->data[0], size); 1219b8d26b3bSNicholas Bellinger 12206faaa85fSNicholas Bellinger if (login->first_request) { 1221b8d26b3bSNicholas Bellinger complete(&isert_conn->conn_login_comp); 12226faaa85fSNicholas Bellinger return; 12236faaa85fSNicholas Bellinger } 12246faaa85fSNicholas Bellinger schedule_delayed_work(&conn->login_work, 0); 1225b8d26b3bSNicholas Bellinger } 1226b8d26b3bSNicholas Bellinger 1227b8d26b3bSNicholas Bellinger static struct iscsi_cmd 1228676687c6SNicholas Bellinger *isert_allocate_cmd(struct iscsi_conn *conn) 1229b8d26b3bSNicholas Bellinger { 1230b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 1231b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd; 1232d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd; 1233b8d26b3bSNicholas Bellinger 1234676687c6SNicholas Bellinger cmd = iscsit_allocate_cmd(conn, TASK_INTERRUPTIBLE); 1235d703ce2fSNicholas Bellinger if (!cmd) { 1236d703ce2fSNicholas Bellinger pr_err("Unable to allocate iscsi_cmd + isert_cmd\n"); 1237b8d26b3bSNicholas Bellinger return NULL; 1238b8d26b3bSNicholas Bellinger } 1239d703ce2fSNicholas Bellinger isert_cmd = iscsit_priv_cmd(cmd); 1240b8d26b3bSNicholas Bellinger isert_cmd->conn = isert_conn; 1241d703ce2fSNicholas Bellinger isert_cmd->iscsi_cmd = cmd; 1242b8d26b3bSNicholas Bellinger 1243d703ce2fSNicholas Bellinger return cmd; 1244b8d26b3bSNicholas Bellinger } 1245b8d26b3bSNicholas Bellinger 1246b8d26b3bSNicholas Bellinger static int 1247b8d26b3bSNicholas Bellinger isert_handle_scsi_cmd(struct isert_conn *isert_conn, 1248d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd, struct iscsi_cmd *cmd, 1249d703ce2fSNicholas Bellinger struct iser_rx_desc *rx_desc, unsigned char *buf) 1250b8d26b3bSNicholas Bellinger { 1251b8d26b3bSNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1252b8d26b3bSNicholas Bellinger struct iscsi_scsi_req *hdr = (struct iscsi_scsi_req *)buf; 1253b8d26b3bSNicholas Bellinger struct scatterlist *sg; 1254b8d26b3bSNicholas Bellinger int imm_data, imm_data_len, unsol_data, sg_nents, rc; 1255b8d26b3bSNicholas Bellinger bool dump_payload = false; 1256b8d26b3bSNicholas Bellinger 1257b8d26b3bSNicholas Bellinger rc = iscsit_setup_scsi_cmd(conn, cmd, buf); 1258b8d26b3bSNicholas Bellinger if (rc < 0) 1259b8d26b3bSNicholas Bellinger return rc; 1260b8d26b3bSNicholas Bellinger 1261b8d26b3bSNicholas Bellinger imm_data = cmd->immediate_data; 1262b8d26b3bSNicholas Bellinger imm_data_len = cmd->first_burst_len; 1263b8d26b3bSNicholas Bellinger unsol_data = cmd->unsolicited_data; 1264b8d26b3bSNicholas Bellinger 1265b8d26b3bSNicholas Bellinger rc = iscsit_process_scsi_cmd(conn, cmd, hdr); 1266b8d26b3bSNicholas Bellinger if (rc < 0) { 1267b8d26b3bSNicholas Bellinger return 0; 1268b8d26b3bSNicholas Bellinger } else if (rc > 0) { 1269b8d26b3bSNicholas Bellinger dump_payload = true; 1270b8d26b3bSNicholas Bellinger goto sequence_cmd; 1271b8d26b3bSNicholas Bellinger } 1272b8d26b3bSNicholas Bellinger 1273b8d26b3bSNicholas Bellinger if (!imm_data) 1274b8d26b3bSNicholas Bellinger return 0; 1275b8d26b3bSNicholas Bellinger 1276b8d26b3bSNicholas Bellinger sg = &cmd->se_cmd.t_data_sg[0]; 1277b8d26b3bSNicholas Bellinger sg_nents = max(1UL, DIV_ROUND_UP(imm_data_len, PAGE_SIZE)); 1278b8d26b3bSNicholas Bellinger 1279b8d26b3bSNicholas Bellinger pr_debug("Copying Immediate SG: %p sg_nents: %u from %p imm_data_len: %d\n", 1280b8d26b3bSNicholas Bellinger sg, sg_nents, &rx_desc->data[0], imm_data_len); 1281b8d26b3bSNicholas Bellinger 1282b8d26b3bSNicholas Bellinger sg_copy_from_buffer(sg, sg_nents, &rx_desc->data[0], imm_data_len); 1283b8d26b3bSNicholas Bellinger 1284b8d26b3bSNicholas Bellinger cmd->write_data_done += imm_data_len; 1285b8d26b3bSNicholas Bellinger 1286b8d26b3bSNicholas Bellinger if (cmd->write_data_done == cmd->se_cmd.data_length) { 1287b8d26b3bSNicholas Bellinger spin_lock_bh(&cmd->istate_lock); 1288b8d26b3bSNicholas Bellinger cmd->cmd_flags |= ICF_GOT_LAST_DATAOUT; 1289b8d26b3bSNicholas Bellinger cmd->i_state = ISTATE_RECEIVED_LAST_DATAOUT; 1290b8d26b3bSNicholas Bellinger spin_unlock_bh(&cmd->istate_lock); 1291b8d26b3bSNicholas Bellinger } 1292b8d26b3bSNicholas Bellinger 1293b8d26b3bSNicholas Bellinger sequence_cmd: 1294561bf158SNicholas Bellinger rc = iscsit_sequence_cmd(conn, cmd, buf, hdr->cmdsn); 1295b8d26b3bSNicholas Bellinger 1296b8d26b3bSNicholas Bellinger if (!rc && dump_payload == false && unsol_data) 1297b8d26b3bSNicholas Bellinger iscsit_set_unsoliticed_dataout(cmd); 12986cc44a6fSNicholas Bellinger else if (dump_payload && imm_data) 12996cc44a6fSNicholas Bellinger target_put_sess_cmd(conn->sess->se_sess, &cmd->se_cmd); 1300b8d26b3bSNicholas Bellinger 1301b8d26b3bSNicholas Bellinger return 0; 1302b8d26b3bSNicholas Bellinger } 1303b8d26b3bSNicholas Bellinger 1304b8d26b3bSNicholas Bellinger static int 1305b8d26b3bSNicholas Bellinger isert_handle_iscsi_dataout(struct isert_conn *isert_conn, 1306b8d26b3bSNicholas Bellinger struct iser_rx_desc *rx_desc, unsigned char *buf) 1307b8d26b3bSNicholas Bellinger { 1308b8d26b3bSNicholas Bellinger struct scatterlist *sg_start; 1309b8d26b3bSNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1310b8d26b3bSNicholas Bellinger struct iscsi_cmd *cmd = NULL; 1311b8d26b3bSNicholas Bellinger struct iscsi_data *hdr = (struct iscsi_data *)buf; 1312b8d26b3bSNicholas Bellinger u32 unsol_data_len = ntoh24(hdr->dlength); 1313b8d26b3bSNicholas Bellinger int rc, sg_nents, sg_off, page_off; 1314b8d26b3bSNicholas Bellinger 1315b8d26b3bSNicholas Bellinger rc = iscsit_check_dataout_hdr(conn, buf, &cmd); 1316b8d26b3bSNicholas Bellinger if (rc < 0) 1317b8d26b3bSNicholas Bellinger return rc; 1318b8d26b3bSNicholas Bellinger else if (!cmd) 1319b8d26b3bSNicholas Bellinger return 0; 1320b8d26b3bSNicholas Bellinger /* 1321b8d26b3bSNicholas Bellinger * FIXME: Unexpected unsolicited_data out 1322b8d26b3bSNicholas Bellinger */ 1323b8d26b3bSNicholas Bellinger if (!cmd->unsolicited_data) { 1324b8d26b3bSNicholas Bellinger pr_err("Received unexpected solicited data payload\n"); 1325b8d26b3bSNicholas Bellinger dump_stack(); 1326b8d26b3bSNicholas Bellinger return -1; 1327b8d26b3bSNicholas Bellinger } 1328b8d26b3bSNicholas Bellinger 1329b8d26b3bSNicholas Bellinger pr_debug("Unsolicited DataOut unsol_data_len: %u, write_data_done: %u, data_length: %u\n", 1330b8d26b3bSNicholas Bellinger unsol_data_len, cmd->write_data_done, cmd->se_cmd.data_length); 1331b8d26b3bSNicholas Bellinger 1332b8d26b3bSNicholas Bellinger sg_off = cmd->write_data_done / PAGE_SIZE; 1333b8d26b3bSNicholas Bellinger sg_start = &cmd->se_cmd.t_data_sg[sg_off]; 1334b8d26b3bSNicholas Bellinger sg_nents = max(1UL, DIV_ROUND_UP(unsol_data_len, PAGE_SIZE)); 1335b8d26b3bSNicholas Bellinger page_off = cmd->write_data_done % PAGE_SIZE; 1336b8d26b3bSNicholas Bellinger /* 1337b8d26b3bSNicholas Bellinger * FIXME: Non page-aligned unsolicited_data out 1338b8d26b3bSNicholas Bellinger */ 1339b8d26b3bSNicholas Bellinger if (page_off) { 1340b8d26b3bSNicholas Bellinger pr_err("Received unexpected non-page aligned data payload\n"); 1341b8d26b3bSNicholas Bellinger dump_stack(); 1342b8d26b3bSNicholas Bellinger return -1; 1343b8d26b3bSNicholas Bellinger } 1344b8d26b3bSNicholas Bellinger pr_debug("Copying DataOut: sg_start: %p, sg_off: %u sg_nents: %u from %p %u\n", 1345b8d26b3bSNicholas Bellinger sg_start, sg_off, sg_nents, &rx_desc->data[0], unsol_data_len); 1346b8d26b3bSNicholas Bellinger 1347b8d26b3bSNicholas Bellinger sg_copy_from_buffer(sg_start, sg_nents, &rx_desc->data[0], 1348b8d26b3bSNicholas Bellinger unsol_data_len); 1349b8d26b3bSNicholas Bellinger 1350b8d26b3bSNicholas Bellinger rc = iscsit_check_dataout_payload(cmd, hdr, false); 1351b8d26b3bSNicholas Bellinger if (rc < 0) 1352b8d26b3bSNicholas Bellinger return rc; 1353b8d26b3bSNicholas Bellinger 1354b8d26b3bSNicholas Bellinger return 0; 1355b8d26b3bSNicholas Bellinger } 1356b8d26b3bSNicholas Bellinger 1357b8d26b3bSNicholas Bellinger static int 1358778de368SNicholas Bellinger isert_handle_nop_out(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd, 1359d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd, struct iser_rx_desc *rx_desc, 1360d703ce2fSNicholas Bellinger unsigned char *buf) 1361778de368SNicholas Bellinger { 1362778de368SNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1363778de368SNicholas Bellinger struct iscsi_nopout *hdr = (struct iscsi_nopout *)buf; 1364778de368SNicholas Bellinger int rc; 1365778de368SNicholas Bellinger 1366778de368SNicholas Bellinger rc = iscsit_setup_nop_out(conn, cmd, hdr); 1367778de368SNicholas Bellinger if (rc < 0) 1368778de368SNicholas Bellinger return rc; 1369778de368SNicholas Bellinger /* 1370778de368SNicholas Bellinger * FIXME: Add support for NOPOUT payload using unsolicited RDMA payload 1371778de368SNicholas Bellinger */ 1372778de368SNicholas Bellinger 1373778de368SNicholas Bellinger return iscsit_process_nop_out(conn, cmd, hdr); 1374778de368SNicholas Bellinger } 1375778de368SNicholas Bellinger 1376778de368SNicholas Bellinger static int 1377adb54c29SNicholas Bellinger isert_handle_text_cmd(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd, 1378d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd, struct iser_rx_desc *rx_desc, 1379d703ce2fSNicholas Bellinger struct iscsi_text *hdr) 1380adb54c29SNicholas Bellinger { 1381adb54c29SNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1382adb54c29SNicholas Bellinger u32 payload_length = ntoh24(hdr->dlength); 1383adb54c29SNicholas Bellinger int rc; 1384adb54c29SNicholas Bellinger unsigned char *text_in; 1385adb54c29SNicholas Bellinger 1386adb54c29SNicholas Bellinger rc = iscsit_setup_text_cmd(conn, cmd, hdr); 1387adb54c29SNicholas Bellinger if (rc < 0) 1388adb54c29SNicholas Bellinger return rc; 1389adb54c29SNicholas Bellinger 1390adb54c29SNicholas Bellinger text_in = kzalloc(payload_length, GFP_KERNEL); 1391adb54c29SNicholas Bellinger if (!text_in) { 1392adb54c29SNicholas Bellinger pr_err("Unable to allocate text_in of payload_length: %u\n", 1393adb54c29SNicholas Bellinger payload_length); 1394adb54c29SNicholas Bellinger return -ENOMEM; 1395adb54c29SNicholas Bellinger } 1396adb54c29SNicholas Bellinger cmd->text_in_ptr = text_in; 1397adb54c29SNicholas Bellinger 1398adb54c29SNicholas Bellinger memcpy(cmd->text_in_ptr, &rx_desc->data[0], payload_length); 1399adb54c29SNicholas Bellinger 1400adb54c29SNicholas Bellinger return iscsit_process_text_cmd(conn, cmd, hdr); 1401adb54c29SNicholas Bellinger } 1402adb54c29SNicholas Bellinger 1403adb54c29SNicholas Bellinger static int 1404b8d26b3bSNicholas Bellinger isert_rx_opcode(struct isert_conn *isert_conn, struct iser_rx_desc *rx_desc, 1405b8d26b3bSNicholas Bellinger uint32_t read_stag, uint64_t read_va, 1406b8d26b3bSNicholas Bellinger uint32_t write_stag, uint64_t write_va) 1407b8d26b3bSNicholas Bellinger { 1408b8d26b3bSNicholas Bellinger struct iscsi_hdr *hdr = &rx_desc->iscsi_header; 1409b8d26b3bSNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1410ca40d24eSNicholas Bellinger struct iscsi_session *sess = conn->sess; 1411b8d26b3bSNicholas Bellinger struct iscsi_cmd *cmd; 1412b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd; 1413b8d26b3bSNicholas Bellinger int ret = -EINVAL; 1414b8d26b3bSNicholas Bellinger u8 opcode = (hdr->opcode & ISCSI_OPCODE_MASK); 1415b8d26b3bSNicholas Bellinger 1416ca40d24eSNicholas Bellinger if (sess->sess_ops->SessionType && 1417ca40d24eSNicholas Bellinger (!(opcode & ISCSI_OP_TEXT) || !(opcode & ISCSI_OP_LOGOUT))) { 1418ca40d24eSNicholas Bellinger pr_err("Got illegal opcode: 0x%02x in SessionType=Discovery," 1419ca40d24eSNicholas Bellinger " ignoring\n", opcode); 1420ca40d24eSNicholas Bellinger return 0; 1421ca40d24eSNicholas Bellinger } 1422ca40d24eSNicholas Bellinger 1423b8d26b3bSNicholas Bellinger switch (opcode) { 1424b8d26b3bSNicholas Bellinger case ISCSI_OP_SCSI_CMD: 1425676687c6SNicholas Bellinger cmd = isert_allocate_cmd(conn); 1426b8d26b3bSNicholas Bellinger if (!cmd) 1427b8d26b3bSNicholas Bellinger break; 1428b8d26b3bSNicholas Bellinger 1429d703ce2fSNicholas Bellinger isert_cmd = iscsit_priv_cmd(cmd); 1430b8d26b3bSNicholas Bellinger isert_cmd->read_stag = read_stag; 1431b8d26b3bSNicholas Bellinger isert_cmd->read_va = read_va; 1432b8d26b3bSNicholas Bellinger isert_cmd->write_stag = write_stag; 1433b8d26b3bSNicholas Bellinger isert_cmd->write_va = write_va; 1434b8d26b3bSNicholas Bellinger 1435d703ce2fSNicholas Bellinger ret = isert_handle_scsi_cmd(isert_conn, isert_cmd, cmd, 1436b8d26b3bSNicholas Bellinger rx_desc, (unsigned char *)hdr); 1437b8d26b3bSNicholas Bellinger break; 1438b8d26b3bSNicholas Bellinger case ISCSI_OP_NOOP_OUT: 1439676687c6SNicholas Bellinger cmd = isert_allocate_cmd(conn); 1440b8d26b3bSNicholas Bellinger if (!cmd) 1441b8d26b3bSNicholas Bellinger break; 1442b8d26b3bSNicholas Bellinger 1443d703ce2fSNicholas Bellinger isert_cmd = iscsit_priv_cmd(cmd); 1444d703ce2fSNicholas Bellinger ret = isert_handle_nop_out(isert_conn, isert_cmd, cmd, 1445778de368SNicholas Bellinger rx_desc, (unsigned char *)hdr); 1446b8d26b3bSNicholas Bellinger break; 1447b8d26b3bSNicholas Bellinger case ISCSI_OP_SCSI_DATA_OUT: 1448b8d26b3bSNicholas Bellinger ret = isert_handle_iscsi_dataout(isert_conn, rx_desc, 1449b8d26b3bSNicholas Bellinger (unsigned char *)hdr); 1450b8d26b3bSNicholas Bellinger break; 1451b8d26b3bSNicholas Bellinger case ISCSI_OP_SCSI_TMFUNC: 1452676687c6SNicholas Bellinger cmd = isert_allocate_cmd(conn); 1453b8d26b3bSNicholas Bellinger if (!cmd) 1454b8d26b3bSNicholas Bellinger break; 1455b8d26b3bSNicholas Bellinger 1456b8d26b3bSNicholas Bellinger ret = iscsit_handle_task_mgt_cmd(conn, cmd, 1457b8d26b3bSNicholas Bellinger (unsigned char *)hdr); 1458b8d26b3bSNicholas Bellinger break; 1459b8d26b3bSNicholas Bellinger case ISCSI_OP_LOGOUT: 1460676687c6SNicholas Bellinger cmd = isert_allocate_cmd(conn); 1461b8d26b3bSNicholas Bellinger if (!cmd) 1462b8d26b3bSNicholas Bellinger break; 1463b8d26b3bSNicholas Bellinger 1464b8d26b3bSNicholas Bellinger ret = iscsit_handle_logout_cmd(conn, cmd, (unsigned char *)hdr); 1465b8d26b3bSNicholas Bellinger if (ret > 0) 1466b8d26b3bSNicholas Bellinger wait_for_completion_timeout(&conn->conn_logout_comp, 1467b8d26b3bSNicholas Bellinger SECONDS_FOR_LOGOUT_COMP * 1468b8d26b3bSNicholas Bellinger HZ); 1469b8d26b3bSNicholas Bellinger break; 1470adb54c29SNicholas Bellinger case ISCSI_OP_TEXT: 1471676687c6SNicholas Bellinger cmd = isert_allocate_cmd(conn); 1472adb54c29SNicholas Bellinger if (!cmd) 1473adb54c29SNicholas Bellinger break; 1474adb54c29SNicholas Bellinger 1475d703ce2fSNicholas Bellinger isert_cmd = iscsit_priv_cmd(cmd); 1476d703ce2fSNicholas Bellinger ret = isert_handle_text_cmd(isert_conn, isert_cmd, cmd, 1477adb54c29SNicholas Bellinger rx_desc, (struct iscsi_text *)hdr); 1478adb54c29SNicholas Bellinger break; 1479b8d26b3bSNicholas Bellinger default: 1480b8d26b3bSNicholas Bellinger pr_err("Got unknown iSCSI OpCode: 0x%02x\n", opcode); 1481b8d26b3bSNicholas Bellinger dump_stack(); 1482b8d26b3bSNicholas Bellinger break; 1483b8d26b3bSNicholas Bellinger } 1484b8d26b3bSNicholas Bellinger 1485b8d26b3bSNicholas Bellinger return ret; 1486b8d26b3bSNicholas Bellinger } 1487b8d26b3bSNicholas Bellinger 1488b8d26b3bSNicholas Bellinger static void 1489b8d26b3bSNicholas Bellinger isert_rx_do_work(struct iser_rx_desc *rx_desc, struct isert_conn *isert_conn) 1490b8d26b3bSNicholas Bellinger { 1491b8d26b3bSNicholas Bellinger struct iser_hdr *iser_hdr = &rx_desc->iser_header; 1492b8d26b3bSNicholas Bellinger uint64_t read_va = 0, write_va = 0; 1493b8d26b3bSNicholas Bellinger uint32_t read_stag = 0, write_stag = 0; 1494b8d26b3bSNicholas Bellinger int rc; 1495b8d26b3bSNicholas Bellinger 1496b8d26b3bSNicholas Bellinger switch (iser_hdr->flags & 0xF0) { 1497b8d26b3bSNicholas Bellinger case ISCSI_CTRL: 1498b8d26b3bSNicholas Bellinger if (iser_hdr->flags & ISER_RSV) { 1499b8d26b3bSNicholas Bellinger read_stag = be32_to_cpu(iser_hdr->read_stag); 1500b8d26b3bSNicholas Bellinger read_va = be64_to_cpu(iser_hdr->read_va); 1501b8d26b3bSNicholas Bellinger pr_debug("ISER_RSV: read_stag: 0x%08x read_va: 0x%16llx\n", 1502b8d26b3bSNicholas Bellinger read_stag, (unsigned long long)read_va); 1503b8d26b3bSNicholas Bellinger } 1504b8d26b3bSNicholas Bellinger if (iser_hdr->flags & ISER_WSV) { 1505b8d26b3bSNicholas Bellinger write_stag = be32_to_cpu(iser_hdr->write_stag); 1506b8d26b3bSNicholas Bellinger write_va = be64_to_cpu(iser_hdr->write_va); 1507b8d26b3bSNicholas Bellinger pr_debug("ISER_WSV: write__stag: 0x%08x write_va: 0x%16llx\n", 1508b8d26b3bSNicholas Bellinger write_stag, (unsigned long long)write_va); 1509b8d26b3bSNicholas Bellinger } 1510b8d26b3bSNicholas Bellinger 1511b8d26b3bSNicholas Bellinger pr_debug("ISER ISCSI_CTRL PDU\n"); 1512b8d26b3bSNicholas Bellinger break; 1513b8d26b3bSNicholas Bellinger case ISER_HELLO: 1514b8d26b3bSNicholas Bellinger pr_err("iSER Hello message\n"); 1515b8d26b3bSNicholas Bellinger break; 1516b8d26b3bSNicholas Bellinger default: 1517b8d26b3bSNicholas Bellinger pr_warn("Unknown iSER hdr flags: 0x%02x\n", iser_hdr->flags); 1518b8d26b3bSNicholas Bellinger break; 1519b8d26b3bSNicholas Bellinger } 1520b8d26b3bSNicholas Bellinger 1521b8d26b3bSNicholas Bellinger rc = isert_rx_opcode(isert_conn, rx_desc, 1522b8d26b3bSNicholas Bellinger read_stag, read_va, write_stag, write_va); 1523b8d26b3bSNicholas Bellinger } 1524b8d26b3bSNicholas Bellinger 1525b8d26b3bSNicholas Bellinger static void 1526b8d26b3bSNicholas Bellinger isert_rx_completion(struct iser_rx_desc *desc, struct isert_conn *isert_conn, 1527b8d26b3bSNicholas Bellinger unsigned long xfer_len) 1528b8d26b3bSNicholas Bellinger { 1529b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 1530b8d26b3bSNicholas Bellinger struct iscsi_hdr *hdr; 1531b8d26b3bSNicholas Bellinger u64 rx_dma; 1532b8d26b3bSNicholas Bellinger int rx_buflen, outstanding; 1533b8d26b3bSNicholas Bellinger 1534b8d26b3bSNicholas Bellinger if ((char *)desc == isert_conn->login_req_buf) { 1535b8d26b3bSNicholas Bellinger rx_dma = isert_conn->login_req_dma; 1536b8d26b3bSNicholas Bellinger rx_buflen = ISER_RX_LOGIN_SIZE; 1537b8d26b3bSNicholas Bellinger pr_debug("ISER login_buf: Using rx_dma: 0x%llx, rx_buflen: %d\n", 1538b8d26b3bSNicholas Bellinger rx_dma, rx_buflen); 1539b8d26b3bSNicholas Bellinger } else { 1540b8d26b3bSNicholas Bellinger rx_dma = desc->dma_addr; 1541b8d26b3bSNicholas Bellinger rx_buflen = ISER_RX_PAYLOAD_SIZE; 1542b8d26b3bSNicholas Bellinger pr_debug("ISER req_buf: Using rx_dma: 0x%llx, rx_buflen: %d\n", 1543b8d26b3bSNicholas Bellinger rx_dma, rx_buflen); 1544b8d26b3bSNicholas Bellinger } 1545b8d26b3bSNicholas Bellinger 1546b8d26b3bSNicholas Bellinger ib_dma_sync_single_for_cpu(ib_dev, rx_dma, rx_buflen, DMA_FROM_DEVICE); 1547b8d26b3bSNicholas Bellinger 1548b8d26b3bSNicholas Bellinger hdr = &desc->iscsi_header; 1549b8d26b3bSNicholas Bellinger pr_debug("iSCSI opcode: 0x%02x, ITT: 0x%08x, flags: 0x%02x dlen: %d\n", 1550b8d26b3bSNicholas Bellinger hdr->opcode, hdr->itt, hdr->flags, 1551b8d26b3bSNicholas Bellinger (int)(xfer_len - ISER_HEADERS_LEN)); 1552b8d26b3bSNicholas Bellinger 15532371e5daSSagi Grimberg if ((char *)desc == isert_conn->login_req_buf) { 15542371e5daSSagi Grimberg isert_conn->login_req_len = xfer_len - ISER_HEADERS_LEN; 15552371e5daSSagi Grimberg if (isert_conn->conn) { 15562371e5daSSagi Grimberg struct iscsi_login *login = isert_conn->conn->conn_login; 15572371e5daSSagi Grimberg 15582371e5daSSagi Grimberg if (login && !login->first_request) 15592371e5daSSagi Grimberg isert_rx_login_req(isert_conn); 15602371e5daSSagi Grimberg } 15612371e5daSSagi Grimberg mutex_lock(&isert_conn->conn_mutex); 15622371e5daSSagi Grimberg complete(&isert_conn->login_req_comp); 15632371e5daSSagi Grimberg mutex_unlock(&isert_conn->conn_mutex); 15642371e5daSSagi Grimberg } else { 1565b8d26b3bSNicholas Bellinger isert_rx_do_work(desc, isert_conn); 15662371e5daSSagi Grimberg } 1567b8d26b3bSNicholas Bellinger 1568b8d26b3bSNicholas Bellinger ib_dma_sync_single_for_device(ib_dev, rx_dma, rx_buflen, 1569b8d26b3bSNicholas Bellinger DMA_FROM_DEVICE); 1570b8d26b3bSNicholas Bellinger 1571b8d26b3bSNicholas Bellinger isert_conn->post_recv_buf_count--; 1572b8d26b3bSNicholas Bellinger pr_debug("iSERT: Decremented post_recv_buf_count: %d\n", 1573b8d26b3bSNicholas Bellinger isert_conn->post_recv_buf_count); 1574b8d26b3bSNicholas Bellinger 1575b8d26b3bSNicholas Bellinger if ((char *)desc == isert_conn->login_req_buf) 1576b8d26b3bSNicholas Bellinger return; 1577b8d26b3bSNicholas Bellinger 1578b8d26b3bSNicholas Bellinger outstanding = isert_conn->post_recv_buf_count; 1579b8d26b3bSNicholas Bellinger if (outstanding + ISERT_MIN_POSTED_RX <= ISERT_QP_MAX_RECV_DTOS) { 1580b8d26b3bSNicholas Bellinger int err, count = min(ISERT_QP_MAX_RECV_DTOS - outstanding, 1581b8d26b3bSNicholas Bellinger ISERT_MIN_POSTED_RX); 1582b8d26b3bSNicholas Bellinger err = isert_post_recv(isert_conn, count); 1583b8d26b3bSNicholas Bellinger if (err) { 1584b8d26b3bSNicholas Bellinger pr_err("isert_post_recv() count: %d failed, %d\n", 1585b8d26b3bSNicholas Bellinger count, err); 1586b8d26b3bSNicholas Bellinger } 1587b8d26b3bSNicholas Bellinger } 1588b8d26b3bSNicholas Bellinger } 1589b8d26b3bSNicholas Bellinger 1590e3d7e4c3SSagi Grimberg static int 1591e3d7e4c3SSagi Grimberg isert_map_data_buf(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd, 1592e3d7e4c3SSagi Grimberg struct scatterlist *sg, u32 nents, u32 length, u32 offset, 1593e3d7e4c3SSagi Grimberg enum iser_ib_op_code op, struct isert_data_buf *data) 1594e3d7e4c3SSagi Grimberg { 1595e3d7e4c3SSagi Grimberg struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 1596e3d7e4c3SSagi Grimberg 1597e3d7e4c3SSagi Grimberg data->dma_dir = op == ISER_IB_RDMA_WRITE ? 1598e3d7e4c3SSagi Grimberg DMA_TO_DEVICE : DMA_FROM_DEVICE; 1599e3d7e4c3SSagi Grimberg 1600e3d7e4c3SSagi Grimberg data->len = length - offset; 1601e3d7e4c3SSagi Grimberg data->offset = offset; 1602e3d7e4c3SSagi Grimberg data->sg_off = data->offset / PAGE_SIZE; 1603e3d7e4c3SSagi Grimberg 1604e3d7e4c3SSagi Grimberg data->sg = &sg[data->sg_off]; 1605e3d7e4c3SSagi Grimberg data->nents = min_t(unsigned int, nents - data->sg_off, 1606e3d7e4c3SSagi Grimberg ISCSI_ISER_SG_TABLESIZE); 1607e3d7e4c3SSagi Grimberg data->len = min_t(unsigned int, data->len, ISCSI_ISER_SG_TABLESIZE * 1608e3d7e4c3SSagi Grimberg PAGE_SIZE); 1609e3d7e4c3SSagi Grimberg 1610e3d7e4c3SSagi Grimberg data->dma_nents = ib_dma_map_sg(ib_dev, data->sg, data->nents, 1611e3d7e4c3SSagi Grimberg data->dma_dir); 1612e3d7e4c3SSagi Grimberg if (unlikely(!data->dma_nents)) { 1613e3d7e4c3SSagi Grimberg pr_err("Cmd: unable to dma map SGs %p\n", sg); 1614e3d7e4c3SSagi Grimberg return -EINVAL; 1615e3d7e4c3SSagi Grimberg } 1616e3d7e4c3SSagi Grimberg 1617e3d7e4c3SSagi Grimberg pr_debug("Mapped cmd: %p count: %u sg: %p sg_nents: %u rdma_len %d\n", 1618e3d7e4c3SSagi Grimberg isert_cmd, data->dma_nents, data->sg, data->nents, data->len); 1619e3d7e4c3SSagi Grimberg 1620e3d7e4c3SSagi Grimberg return 0; 1621e3d7e4c3SSagi Grimberg } 1622e3d7e4c3SSagi Grimberg 1623e3d7e4c3SSagi Grimberg static void 1624e3d7e4c3SSagi Grimberg isert_unmap_data_buf(struct isert_conn *isert_conn, struct isert_data_buf *data) 1625e3d7e4c3SSagi Grimberg { 1626e3d7e4c3SSagi Grimberg struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 1627e3d7e4c3SSagi Grimberg 1628e3d7e4c3SSagi Grimberg ib_dma_unmap_sg(ib_dev, data->sg, data->nents, data->dma_dir); 1629e3d7e4c3SSagi Grimberg memset(data, 0, sizeof(*data)); 1630e3d7e4c3SSagi Grimberg } 1631e3d7e4c3SSagi Grimberg 1632e3d7e4c3SSagi Grimberg 1633e3d7e4c3SSagi Grimberg 1634b8d26b3bSNicholas Bellinger static void 1635b8d26b3bSNicholas Bellinger isert_unmap_cmd(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn) 1636b8d26b3bSNicholas Bellinger { 1637b8d26b3bSNicholas Bellinger struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 1638b8d26b3bSNicholas Bellinger 163990ecc6e2SVu Pham pr_debug("isert_unmap_cmd: %p\n", isert_cmd); 1640e3d7e4c3SSagi Grimberg 1641e3d7e4c3SSagi Grimberg if (wr->data.sg) { 164290ecc6e2SVu Pham pr_debug("isert_unmap_cmd: %p unmap_sg op\n", isert_cmd); 1643e3d7e4c3SSagi Grimberg isert_unmap_data_buf(isert_conn, &wr->data); 1644b8d26b3bSNicholas Bellinger } 1645b8d26b3bSNicholas Bellinger 164690ecc6e2SVu Pham if (wr->send_wr) { 164790ecc6e2SVu Pham pr_debug("isert_unmap_cmd: %p free send_wr\n", isert_cmd); 1648b8d26b3bSNicholas Bellinger kfree(wr->send_wr); 1649b8d26b3bSNicholas Bellinger wr->send_wr = NULL; 165090ecc6e2SVu Pham } 1651b8d26b3bSNicholas Bellinger 165290ecc6e2SVu Pham if (wr->ib_sge) { 165390ecc6e2SVu Pham pr_debug("isert_unmap_cmd: %p free ib_sge\n", isert_cmd); 165490ecc6e2SVu Pham kfree(wr->ib_sge); 165590ecc6e2SVu Pham wr->ib_sge = NULL; 165690ecc6e2SVu Pham } 1657b8d26b3bSNicholas Bellinger } 1658b8d26b3bSNicholas Bellinger 1659b8d26b3bSNicholas Bellinger static void 1660a3a5a826SSagi Grimberg isert_unreg_rdma(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn) 166159464ef4SVu Pham { 166259464ef4SVu Pham struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 166359464ef4SVu Pham LIST_HEAD(unmap_list); 166459464ef4SVu Pham 1665a3a5a826SSagi Grimberg pr_debug("unreg_fastreg_cmd: %p\n", isert_cmd); 166659464ef4SVu Pham 166759464ef4SVu Pham if (wr->fr_desc) { 1668a3a5a826SSagi Grimberg pr_debug("unreg_fastreg_cmd: %p free fr_desc %p\n", 166959464ef4SVu Pham isert_cmd, wr->fr_desc); 16709e961ae7SSagi Grimberg if (wr->fr_desc->ind & ISERT_PROTECTED) { 16719e961ae7SSagi Grimberg isert_unmap_data_buf(isert_conn, &wr->prot); 16729e961ae7SSagi Grimberg wr->fr_desc->ind &= ~ISERT_PROTECTED; 16739e961ae7SSagi Grimberg } 167459464ef4SVu Pham spin_lock_bh(&isert_conn->conn_lock); 1675a3a5a826SSagi Grimberg list_add_tail(&wr->fr_desc->list, &isert_conn->conn_fr_pool); 167659464ef4SVu Pham spin_unlock_bh(&isert_conn->conn_lock); 167759464ef4SVu Pham wr->fr_desc = NULL; 167859464ef4SVu Pham } 167959464ef4SVu Pham 1680e3d7e4c3SSagi Grimberg if (wr->data.sg) { 1681a3a5a826SSagi Grimberg pr_debug("unreg_fastreg_cmd: %p unmap_sg op\n", isert_cmd); 1682e3d7e4c3SSagi Grimberg isert_unmap_data_buf(isert_conn, &wr->data); 168359464ef4SVu Pham } 168459464ef4SVu Pham 168559464ef4SVu Pham wr->ib_sge = NULL; 168659464ef4SVu Pham wr->send_wr = NULL; 168759464ef4SVu Pham } 168859464ef4SVu Pham 168959464ef4SVu Pham static void 169003e7848aSNicholas Bellinger isert_put_cmd(struct isert_cmd *isert_cmd, bool comp_err) 1691b8d26b3bSNicholas Bellinger { 1692d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd; 1693b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = isert_cmd->conn; 1694186a9647SNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1695d40945d8SVu Pham struct isert_device *device = isert_conn->conn_device; 1696b8d26b3bSNicholas Bellinger 1697b8d26b3bSNicholas Bellinger pr_debug("Entering isert_put_cmd: %p\n", isert_cmd); 1698b8d26b3bSNicholas Bellinger 1699b8d26b3bSNicholas Bellinger switch (cmd->iscsi_opcode) { 1700b8d26b3bSNicholas Bellinger case ISCSI_OP_SCSI_CMD: 1701b8d26b3bSNicholas Bellinger spin_lock_bh(&conn->cmd_lock); 1702b8d26b3bSNicholas Bellinger if (!list_empty(&cmd->i_conn_node)) 17035159d763SNicholas Bellinger list_del_init(&cmd->i_conn_node); 1704b8d26b3bSNicholas Bellinger spin_unlock_bh(&conn->cmd_lock); 1705b8d26b3bSNicholas Bellinger 170603e7848aSNicholas Bellinger if (cmd->data_direction == DMA_TO_DEVICE) { 1707b8d26b3bSNicholas Bellinger iscsit_stop_dataout_timer(cmd); 170803e7848aSNicholas Bellinger /* 170903e7848aSNicholas Bellinger * Check for special case during comp_err where 171003e7848aSNicholas Bellinger * WRITE_PENDING has been handed off from core, 171103e7848aSNicholas Bellinger * but requires an extra target_put_sess_cmd() 171203e7848aSNicholas Bellinger * before transport_generic_free_cmd() below. 171303e7848aSNicholas Bellinger */ 171403e7848aSNicholas Bellinger if (comp_err && 171503e7848aSNicholas Bellinger cmd->se_cmd.t_state == TRANSPORT_WRITE_PENDING) { 171603e7848aSNicholas Bellinger struct se_cmd *se_cmd = &cmd->se_cmd; 171703e7848aSNicholas Bellinger 171803e7848aSNicholas Bellinger target_put_sess_cmd(se_cmd->se_sess, se_cmd); 171903e7848aSNicholas Bellinger } 172003e7848aSNicholas Bellinger } 1721b8d26b3bSNicholas Bellinger 1722d40945d8SVu Pham device->unreg_rdma_mem(isert_cmd, isert_conn); 1723186a9647SNicholas Bellinger transport_generic_free_cmd(&cmd->se_cmd, 0); 1724186a9647SNicholas Bellinger break; 1725b8d26b3bSNicholas Bellinger case ISCSI_OP_SCSI_TMFUNC: 1726186a9647SNicholas Bellinger spin_lock_bh(&conn->cmd_lock); 1727186a9647SNicholas Bellinger if (!list_empty(&cmd->i_conn_node)) 17285159d763SNicholas Bellinger list_del_init(&cmd->i_conn_node); 1729186a9647SNicholas Bellinger spin_unlock_bh(&conn->cmd_lock); 1730186a9647SNicholas Bellinger 1731b8d26b3bSNicholas Bellinger transport_generic_free_cmd(&cmd->se_cmd, 0); 1732b8d26b3bSNicholas Bellinger break; 1733b8d26b3bSNicholas Bellinger case ISCSI_OP_REJECT: 1734b8d26b3bSNicholas Bellinger case ISCSI_OP_NOOP_OUT: 1735adb54c29SNicholas Bellinger case ISCSI_OP_TEXT: 1736b8d26b3bSNicholas Bellinger spin_lock_bh(&conn->cmd_lock); 1737b8d26b3bSNicholas Bellinger if (!list_empty(&cmd->i_conn_node)) 17385159d763SNicholas Bellinger list_del_init(&cmd->i_conn_node); 1739b8d26b3bSNicholas Bellinger spin_unlock_bh(&conn->cmd_lock); 1740b8d26b3bSNicholas Bellinger 1741b8d26b3bSNicholas Bellinger /* 1742b8d26b3bSNicholas Bellinger * Handle special case for REJECT when iscsi_add_reject*() has 1743b8d26b3bSNicholas Bellinger * overwritten the original iscsi_opcode assignment, and the 1744b8d26b3bSNicholas Bellinger * associated cmd->se_cmd needs to be released. 1745b8d26b3bSNicholas Bellinger */ 1746b8d26b3bSNicholas Bellinger if (cmd->se_cmd.se_tfo != NULL) { 17473df8f68aSNicholas Bellinger pr_debug("Calling transport_generic_free_cmd from" 17483df8f68aSNicholas Bellinger " isert_put_cmd for 0x%02x\n", 17493df8f68aSNicholas Bellinger cmd->iscsi_opcode); 1750b8d26b3bSNicholas Bellinger transport_generic_free_cmd(&cmd->se_cmd, 0); 1751b8d26b3bSNicholas Bellinger break; 1752b8d26b3bSNicholas Bellinger } 1753b8d26b3bSNicholas Bellinger /* 1754b8d26b3bSNicholas Bellinger * Fall-through 1755b8d26b3bSNicholas Bellinger */ 1756b8d26b3bSNicholas Bellinger default: 1757d703ce2fSNicholas Bellinger iscsit_release_cmd(cmd); 1758b8d26b3bSNicholas Bellinger break; 1759b8d26b3bSNicholas Bellinger } 1760b8d26b3bSNicholas Bellinger } 1761b8d26b3bSNicholas Bellinger 1762b8d26b3bSNicholas Bellinger static void 1763b8d26b3bSNicholas Bellinger isert_unmap_tx_desc(struct iser_tx_desc *tx_desc, struct ib_device *ib_dev) 1764b8d26b3bSNicholas Bellinger { 1765b8d26b3bSNicholas Bellinger if (tx_desc->dma_addr != 0) { 1766b8d26b3bSNicholas Bellinger pr_debug("Calling ib_dma_unmap_single for tx_desc->dma_addr\n"); 1767b8d26b3bSNicholas Bellinger ib_dma_unmap_single(ib_dev, tx_desc->dma_addr, 1768b8d26b3bSNicholas Bellinger ISER_HEADERS_LEN, DMA_TO_DEVICE); 1769b8d26b3bSNicholas Bellinger tx_desc->dma_addr = 0; 1770b8d26b3bSNicholas Bellinger } 1771b8d26b3bSNicholas Bellinger } 1772b8d26b3bSNicholas Bellinger 1773b8d26b3bSNicholas Bellinger static void 1774b8d26b3bSNicholas Bellinger isert_completion_put(struct iser_tx_desc *tx_desc, struct isert_cmd *isert_cmd, 177503e7848aSNicholas Bellinger struct ib_device *ib_dev, bool comp_err) 1776b8d26b3bSNicholas Bellinger { 1777dbbc5d11SNicholas Bellinger if (isert_cmd->pdu_buf_dma != 0) { 1778dbbc5d11SNicholas Bellinger pr_debug("Calling ib_dma_unmap_single for isert_cmd->pdu_buf_dma\n"); 1779dbbc5d11SNicholas Bellinger ib_dma_unmap_single(ib_dev, isert_cmd->pdu_buf_dma, 1780dbbc5d11SNicholas Bellinger isert_cmd->pdu_buf_len, DMA_TO_DEVICE); 1781dbbc5d11SNicholas Bellinger isert_cmd->pdu_buf_dma = 0; 1782b8d26b3bSNicholas Bellinger } 1783b8d26b3bSNicholas Bellinger 1784b8d26b3bSNicholas Bellinger isert_unmap_tx_desc(tx_desc, ib_dev); 178503e7848aSNicholas Bellinger isert_put_cmd(isert_cmd, comp_err); 1786b8d26b3bSNicholas Bellinger } 1787b8d26b3bSNicholas Bellinger 178896b7973eSSagi Grimberg static int 178996b7973eSSagi Grimberg isert_check_pi_status(struct se_cmd *se_cmd, struct ib_mr *sig_mr) 1790f93f3a70SSagi Grimberg { 17919e961ae7SSagi Grimberg struct ib_mr_status mr_status; 179296b7973eSSagi Grimberg int ret; 1793f93f3a70SSagi Grimberg 179496b7973eSSagi Grimberg ret = ib_check_mr_status(sig_mr, IB_MR_CHECK_SIG_STATUS, &mr_status); 17959e961ae7SSagi Grimberg if (ret) { 17969e961ae7SSagi Grimberg pr_err("ib_check_mr_status failed, ret %d\n", ret); 17979e961ae7SSagi Grimberg goto fail_mr_status; 17989e961ae7SSagi Grimberg } 179996b7973eSSagi Grimberg 18009e961ae7SSagi Grimberg if (mr_status.fail_status & IB_MR_CHECK_SIG_STATUS) { 180196b7973eSSagi Grimberg u64 sec_offset_err; 18029e961ae7SSagi Grimberg u32 block_size = se_cmd->se_dev->dev_attrib.block_size + 8; 18039e961ae7SSagi Grimberg 18049e961ae7SSagi Grimberg switch (mr_status.sig_err.err_type) { 18059e961ae7SSagi Grimberg case IB_SIG_BAD_GUARD: 18069e961ae7SSagi Grimberg se_cmd->pi_err = TCM_LOGICAL_BLOCK_GUARD_CHECK_FAILED; 18079e961ae7SSagi Grimberg break; 18089e961ae7SSagi Grimberg case IB_SIG_BAD_REFTAG: 18099e961ae7SSagi Grimberg se_cmd->pi_err = TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED; 18109e961ae7SSagi Grimberg break; 18119e961ae7SSagi Grimberg case IB_SIG_BAD_APPTAG: 18129e961ae7SSagi Grimberg se_cmd->pi_err = TCM_LOGICAL_BLOCK_APP_TAG_CHECK_FAILED; 18139e961ae7SSagi Grimberg break; 18149e961ae7SSagi Grimberg } 181596b7973eSSagi Grimberg sec_offset_err = mr_status.sig_err.sig_err_offset; 181696b7973eSSagi Grimberg do_div(sec_offset_err, block_size); 181796b7973eSSagi Grimberg se_cmd->bad_sector = sec_offset_err + se_cmd->t_task_lba; 18189e961ae7SSagi Grimberg 18199e961ae7SSagi Grimberg pr_err("isert: PI error found type %d at sector 0x%llx " 18209e961ae7SSagi Grimberg "expected 0x%x vs actual 0x%x\n", 18219e961ae7SSagi Grimberg mr_status.sig_err.err_type, 18229e961ae7SSagi Grimberg (unsigned long long)se_cmd->bad_sector, 18239e961ae7SSagi Grimberg mr_status.sig_err.expected, 18249e961ae7SSagi Grimberg mr_status.sig_err.actual); 18259e961ae7SSagi Grimberg ret = 1; 18269e961ae7SSagi Grimberg } 18279e961ae7SSagi Grimberg 18289e961ae7SSagi Grimberg fail_mr_status: 182996b7973eSSagi Grimberg return ret; 183096b7973eSSagi Grimberg } 183196b7973eSSagi Grimberg 183296b7973eSSagi Grimberg static void 183396b7973eSSagi Grimberg isert_completion_rdma_write(struct iser_tx_desc *tx_desc, 183496b7973eSSagi Grimberg struct isert_cmd *isert_cmd) 183596b7973eSSagi Grimberg { 183696b7973eSSagi Grimberg struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 183796b7973eSSagi Grimberg struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd; 183896b7973eSSagi Grimberg struct se_cmd *se_cmd = &cmd->se_cmd; 183996b7973eSSagi Grimberg struct isert_conn *isert_conn = isert_cmd->conn; 184096b7973eSSagi Grimberg struct isert_device *device = isert_conn->conn_device; 184196b7973eSSagi Grimberg int ret = 0; 184296b7973eSSagi Grimberg 184396b7973eSSagi Grimberg if (wr->fr_desc && wr->fr_desc->ind & ISERT_PROTECTED) { 184496b7973eSSagi Grimberg ret = isert_check_pi_status(se_cmd, 184596b7973eSSagi Grimberg wr->fr_desc->pi_ctx->sig_mr); 184696b7973eSSagi Grimberg wr->fr_desc->ind &= ~ISERT_PROTECTED; 184796b7973eSSagi Grimberg } 184896b7973eSSagi Grimberg 1849f93f3a70SSagi Grimberg device->unreg_rdma_mem(isert_cmd, isert_conn); 1850897bb2c9SSagi Grimberg wr->send_wr_num = 0; 18519e961ae7SSagi Grimberg if (ret) 18529e961ae7SSagi Grimberg transport_send_check_condition_and_sense(se_cmd, 18539e961ae7SSagi Grimberg se_cmd->pi_err, 0); 18549e961ae7SSagi Grimberg else 1855f93f3a70SSagi Grimberg isert_put_response(isert_conn->conn, cmd); 1856f93f3a70SSagi Grimberg } 1857f93f3a70SSagi Grimberg 1858f93f3a70SSagi Grimberg static void 1859b8d26b3bSNicholas Bellinger isert_completion_rdma_read(struct iser_tx_desc *tx_desc, 1860b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd) 1861b8d26b3bSNicholas Bellinger { 1862b8d26b3bSNicholas Bellinger struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 1863d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd; 1864b8d26b3bSNicholas Bellinger struct se_cmd *se_cmd = &cmd->se_cmd; 186590ecc6e2SVu Pham struct isert_conn *isert_conn = isert_cmd->conn; 1866d40945d8SVu Pham struct isert_device *device = isert_conn->conn_device; 18675bac4b1aSSagi Grimberg int ret = 0; 1868b8d26b3bSNicholas Bellinger 18699e961ae7SSagi Grimberg if (wr->fr_desc && wr->fr_desc->ind & ISERT_PROTECTED) { 187096b7973eSSagi Grimberg ret = isert_check_pi_status(se_cmd, 187196b7973eSSagi Grimberg wr->fr_desc->pi_ctx->sig_mr); 187296b7973eSSagi Grimberg wr->fr_desc->ind &= ~ISERT_PROTECTED; 18739e961ae7SSagi Grimberg } 18749e961ae7SSagi Grimberg 1875b8d26b3bSNicholas Bellinger iscsit_stop_dataout_timer(cmd); 1876d40945d8SVu Pham device->unreg_rdma_mem(isert_cmd, isert_conn); 1877e3d7e4c3SSagi Grimberg cmd->write_data_done = wr->data.len; 1878b6b87a1dSNicholas Bellinger wr->send_wr_num = 0; 1879b8d26b3bSNicholas Bellinger 188090ecc6e2SVu Pham pr_debug("Cmd: %p RDMA_READ comp calling execute_cmd\n", isert_cmd); 1881b8d26b3bSNicholas Bellinger spin_lock_bh(&cmd->istate_lock); 1882b8d26b3bSNicholas Bellinger cmd->cmd_flags |= ICF_GOT_LAST_DATAOUT; 1883b8d26b3bSNicholas Bellinger cmd->i_state = ISTATE_RECEIVED_LAST_DATAOUT; 1884b8d26b3bSNicholas Bellinger spin_unlock_bh(&cmd->istate_lock); 1885b8d26b3bSNicholas Bellinger 18865bac4b1aSSagi Grimberg if (ret) 18875bac4b1aSSagi Grimberg transport_send_check_condition_and_sense(se_cmd, 18885bac4b1aSSagi Grimberg se_cmd->pi_err, 0); 18895bac4b1aSSagi Grimberg else 1890b8d26b3bSNicholas Bellinger target_execute_cmd(se_cmd); 1891b8d26b3bSNicholas Bellinger } 1892b8d26b3bSNicholas Bellinger 1893b8d26b3bSNicholas Bellinger static void 1894b8d26b3bSNicholas Bellinger isert_do_control_comp(struct work_struct *work) 1895b8d26b3bSNicholas Bellinger { 1896b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd = container_of(work, 1897b8d26b3bSNicholas Bellinger struct isert_cmd, comp_work); 1898b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = isert_cmd->conn; 1899b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 1900d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd; 1901b8d26b3bSNicholas Bellinger 1902b8d26b3bSNicholas Bellinger switch (cmd->i_state) { 1903b8d26b3bSNicholas Bellinger case ISTATE_SEND_TASKMGTRSP: 1904b8d26b3bSNicholas Bellinger pr_debug("Calling iscsit_tmr_post_handler >>>>>>>>>>>>>>>>>\n"); 1905b8d26b3bSNicholas Bellinger 1906b8d26b3bSNicholas Bellinger atomic_dec(&isert_conn->post_send_buf_count); 1907b8d26b3bSNicholas Bellinger iscsit_tmr_post_handler(cmd, cmd->conn); 1908b8d26b3bSNicholas Bellinger 1909b8d26b3bSNicholas Bellinger cmd->i_state = ISTATE_SENT_STATUS; 191003e7848aSNicholas Bellinger isert_completion_put(&isert_cmd->tx_desc, isert_cmd, ib_dev, false); 1911b8d26b3bSNicholas Bellinger break; 1912b8d26b3bSNicholas Bellinger case ISTATE_SEND_REJECT: 1913b8d26b3bSNicholas Bellinger pr_debug("Got isert_do_control_comp ISTATE_SEND_REJECT: >>>\n"); 1914b8d26b3bSNicholas Bellinger atomic_dec(&isert_conn->post_send_buf_count); 1915b8d26b3bSNicholas Bellinger 1916b8d26b3bSNicholas Bellinger cmd->i_state = ISTATE_SENT_STATUS; 191703e7848aSNicholas Bellinger isert_completion_put(&isert_cmd->tx_desc, isert_cmd, ib_dev, false); 19183df8f68aSNicholas Bellinger break; 1919b8d26b3bSNicholas Bellinger case ISTATE_SEND_LOGOUTRSP: 1920b8d26b3bSNicholas Bellinger pr_debug("Calling iscsit_logout_post_handler >>>>>>>>>>>>>>\n"); 19219d49f5e2SSagi Grimberg 19229d49f5e2SSagi Grimberg atomic_dec(&isert_conn->post_send_buf_count); 1923b8d26b3bSNicholas Bellinger iscsit_logout_post_handler(cmd, cmd->conn); 1924b8d26b3bSNicholas Bellinger break; 1925adb54c29SNicholas Bellinger case ISTATE_SEND_TEXTRSP: 1926adb54c29SNicholas Bellinger atomic_dec(&isert_conn->post_send_buf_count); 1927adb54c29SNicholas Bellinger cmd->i_state = ISTATE_SENT_STATUS; 192803e7848aSNicholas Bellinger isert_completion_put(&isert_cmd->tx_desc, isert_cmd, ib_dev, false); 1929adb54c29SNicholas Bellinger break; 1930b8d26b3bSNicholas Bellinger default: 1931b8d26b3bSNicholas Bellinger pr_err("Unknown do_control_comp i_state %d\n", cmd->i_state); 1932b8d26b3bSNicholas Bellinger dump_stack(); 1933b8d26b3bSNicholas Bellinger break; 1934b8d26b3bSNicholas Bellinger } 1935b8d26b3bSNicholas Bellinger } 1936b8d26b3bSNicholas Bellinger 1937b8d26b3bSNicholas Bellinger static void 1938b8d26b3bSNicholas Bellinger isert_response_completion(struct iser_tx_desc *tx_desc, 1939b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd, 1940b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn, 1941b8d26b3bSNicholas Bellinger struct ib_device *ib_dev) 1942b8d26b3bSNicholas Bellinger { 1943d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd; 1944b6b87a1dSNicholas Bellinger struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 1945b8d26b3bSNicholas Bellinger 1946b8d26b3bSNicholas Bellinger if (cmd->i_state == ISTATE_SEND_TASKMGTRSP || 19473df8f68aSNicholas Bellinger cmd->i_state == ISTATE_SEND_LOGOUTRSP || 1948adb54c29SNicholas Bellinger cmd->i_state == ISTATE_SEND_REJECT || 1949adb54c29SNicholas Bellinger cmd->i_state == ISTATE_SEND_TEXTRSP) { 1950b8d26b3bSNicholas Bellinger isert_unmap_tx_desc(tx_desc, ib_dev); 1951b8d26b3bSNicholas Bellinger 1952b8d26b3bSNicholas Bellinger INIT_WORK(&isert_cmd->comp_work, isert_do_control_comp); 1953b8d26b3bSNicholas Bellinger queue_work(isert_comp_wq, &isert_cmd->comp_work); 1954b8d26b3bSNicholas Bellinger return; 1955b8d26b3bSNicholas Bellinger } 1956897bb2c9SSagi Grimberg 1957897bb2c9SSagi Grimberg /** 1958897bb2c9SSagi Grimberg * If send_wr_num is 0 this means that we got 1959897bb2c9SSagi Grimberg * RDMA completion and we cleared it and we should 1960897bb2c9SSagi Grimberg * simply decrement the response post. else the 1961897bb2c9SSagi Grimberg * response is incorporated in send_wr_num, just 1962897bb2c9SSagi Grimberg * sub it. 1963897bb2c9SSagi Grimberg **/ 1964897bb2c9SSagi Grimberg if (wr->send_wr_num) 1965897bb2c9SSagi Grimberg atomic_sub(wr->send_wr_num, &isert_conn->post_send_buf_count); 1966897bb2c9SSagi Grimberg else 1967897bb2c9SSagi Grimberg atomic_dec(&isert_conn->post_send_buf_count); 1968b8d26b3bSNicholas Bellinger 1969b8d26b3bSNicholas Bellinger cmd->i_state = ISTATE_SENT_STATUS; 197003e7848aSNicholas Bellinger isert_completion_put(tx_desc, isert_cmd, ib_dev, false); 1971b8d26b3bSNicholas Bellinger } 1972b8d26b3bSNicholas Bellinger 1973b8d26b3bSNicholas Bellinger static void 197468a86deeSSagi Grimberg isert_send_completion(struct iser_tx_desc *tx_desc, 1975b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn) 1976b8d26b3bSNicholas Bellinger { 1977b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 1978b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd = tx_desc->isert_cmd; 1979b8d26b3bSNicholas Bellinger struct isert_rdma_wr *wr; 1980b8d26b3bSNicholas Bellinger 1981b8d26b3bSNicholas Bellinger if (!isert_cmd) { 1982b8d26b3bSNicholas Bellinger atomic_dec(&isert_conn->post_send_buf_count); 1983b8d26b3bSNicholas Bellinger isert_unmap_tx_desc(tx_desc, ib_dev); 1984b8d26b3bSNicholas Bellinger return; 1985b8d26b3bSNicholas Bellinger } 1986b8d26b3bSNicholas Bellinger wr = &isert_cmd->rdma_wr; 1987b8d26b3bSNicholas Bellinger 1988b8d26b3bSNicholas Bellinger switch (wr->iser_ib_op) { 1989b8d26b3bSNicholas Bellinger case ISER_IB_RECV: 1990b8d26b3bSNicholas Bellinger pr_err("isert_send_completion: Got ISER_IB_RECV\n"); 1991b8d26b3bSNicholas Bellinger dump_stack(); 1992b8d26b3bSNicholas Bellinger break; 1993b8d26b3bSNicholas Bellinger case ISER_IB_SEND: 1994b8d26b3bSNicholas Bellinger pr_debug("isert_send_completion: Got ISER_IB_SEND\n"); 1995b8d26b3bSNicholas Bellinger isert_response_completion(tx_desc, isert_cmd, 1996b8d26b3bSNicholas Bellinger isert_conn, ib_dev); 1997b8d26b3bSNicholas Bellinger break; 1998b8d26b3bSNicholas Bellinger case ISER_IB_RDMA_WRITE: 1999f93f3a70SSagi Grimberg pr_debug("isert_send_completion: Got ISER_IB_RDMA_WRITE\n"); 2000897bb2c9SSagi Grimberg atomic_sub(wr->send_wr_num, &isert_conn->post_send_buf_count); 2001f93f3a70SSagi Grimberg isert_completion_rdma_write(tx_desc, isert_cmd); 2002b8d26b3bSNicholas Bellinger break; 2003b8d26b3bSNicholas Bellinger case ISER_IB_RDMA_READ: 2004b8d26b3bSNicholas Bellinger pr_debug("isert_send_completion: Got ISER_IB_RDMA_READ:\n"); 2005b8d26b3bSNicholas Bellinger 2006b6b87a1dSNicholas Bellinger atomic_sub(wr->send_wr_num, &isert_conn->post_send_buf_count); 2007b8d26b3bSNicholas Bellinger isert_completion_rdma_read(tx_desc, isert_cmd); 2008b8d26b3bSNicholas Bellinger break; 2009b8d26b3bSNicholas Bellinger default: 2010b8d26b3bSNicholas Bellinger pr_err("Unknown wr->iser_ib_op: 0x%02x\n", wr->iser_ib_op); 2011b8d26b3bSNicholas Bellinger dump_stack(); 2012b8d26b3bSNicholas Bellinger break; 2013b8d26b3bSNicholas Bellinger } 2014b8d26b3bSNicholas Bellinger } 2015b8d26b3bSNicholas Bellinger 2016b8d26b3bSNicholas Bellinger static void 2017*df43debdSSagi Grimberg isert_cq_comp_err(void *desc, struct isert_conn *isert_conn, bool tx) 2018b8d26b3bSNicholas Bellinger { 2019*df43debdSSagi Grimberg if (tx) { 2020b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 2021*df43debdSSagi Grimberg struct isert_cmd *isert_cmd; 2022b8d26b3bSNicholas Bellinger 2023*df43debdSSagi Grimberg isert_cmd = ((struct iser_tx_desc *)desc)->isert_cmd; 2024b8d26b3bSNicholas Bellinger if (!isert_cmd) 2025*df43debdSSagi Grimberg isert_unmap_tx_desc(desc, ib_dev); 2026b8d26b3bSNicholas Bellinger else 2027*df43debdSSagi Grimberg isert_completion_put(desc, isert_cmd, ib_dev, true); 2028*df43debdSSagi Grimberg atomic_dec(&isert_conn->post_send_buf_count); 2029*df43debdSSagi Grimberg } else { 2030*df43debdSSagi Grimberg isert_conn->post_recv_buf_count--; 2031b8d26b3bSNicholas Bellinger } 2032b8d26b3bSNicholas Bellinger 2033*df43debdSSagi Grimberg if (isert_conn->post_recv_buf_count == 0 && 2034*df43debdSSagi Grimberg atomic_read(&isert_conn->post_send_buf_count) == 0) { 2035defd8848SNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 2036defd8848SNicholas Bellinger 2037defd8848SNicholas Bellinger if (conn->sess) { 2038defd8848SNicholas Bellinger target_sess_cmd_list_set_waiting(conn->sess->se_sess); 2039defd8848SNicholas Bellinger target_wait_for_sess_cmds(conn->sess->se_sess); 2040defd8848SNicholas Bellinger } 2041defd8848SNicholas Bellinger 2042b2cb9649SNicholas Bellinger mutex_lock(&isert_conn->conn_mutex); 2043954f2372SSagi Grimberg isert_conn_terminate(isert_conn); 2044b2cb9649SNicholas Bellinger mutex_unlock(&isert_conn->conn_mutex); 2045b2cb9649SNicholas Bellinger 20469d49f5e2SSagi Grimberg iscsit_cause_connection_reinstatement(isert_conn->conn, 0); 2047defd8848SNicholas Bellinger complete(&isert_conn->conn_wait_comp_err); 2048b8d26b3bSNicholas Bellinger } 2049*df43debdSSagi Grimberg } 2050b8d26b3bSNicholas Bellinger 2051b8d26b3bSNicholas Bellinger static void 2052b8d26b3bSNicholas Bellinger isert_cq_tx_work(struct work_struct *work) 2053b8d26b3bSNicholas Bellinger { 2054b8d26b3bSNicholas Bellinger struct isert_cq_desc *cq_desc = container_of(work, 2055b8d26b3bSNicholas Bellinger struct isert_cq_desc, cq_tx_work); 2056b8d26b3bSNicholas Bellinger struct isert_device *device = cq_desc->device; 2057b8d26b3bSNicholas Bellinger int cq_index = cq_desc->cq_index; 2058b8d26b3bSNicholas Bellinger struct ib_cq *tx_cq = device->dev_tx_cq[cq_index]; 2059b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn; 2060b8d26b3bSNicholas Bellinger struct iser_tx_desc *tx_desc; 2061b8d26b3bSNicholas Bellinger struct ib_wc wc; 2062b8d26b3bSNicholas Bellinger 2063b8d26b3bSNicholas Bellinger while (ib_poll_cq(tx_cq, 1, &wc) == 1) { 2064b8d26b3bSNicholas Bellinger tx_desc = (struct iser_tx_desc *)(unsigned long)wc.wr_id; 2065b8d26b3bSNicholas Bellinger isert_conn = wc.qp->qp_context; 2066b8d26b3bSNicholas Bellinger 2067b8d26b3bSNicholas Bellinger if (wc.status == IB_WC_SUCCESS) { 2068b8d26b3bSNicholas Bellinger isert_send_completion(tx_desc, isert_conn); 2069b8d26b3bSNicholas Bellinger } else { 2070b8d26b3bSNicholas Bellinger pr_debug("TX wc.status != IB_WC_SUCCESS >>>>>>>>>>>>>>\n"); 2071b8d26b3bSNicholas Bellinger pr_debug("TX wc.status: 0x%08x\n", wc.status); 2072c5a2adbfSNicholas Bellinger pr_debug("TX wc.vendor_err: 0x%08x\n", wc.vendor_err); 2073defd8848SNicholas Bellinger 2074*df43debdSSagi Grimberg if (wc.wr_id != ISER_FASTREG_LI_WRID) 2075*df43debdSSagi Grimberg isert_cq_comp_err(tx_desc, isert_conn, true); 2076b8d26b3bSNicholas Bellinger } 20779bb4ca68SNicholas Bellinger } 2078b8d26b3bSNicholas Bellinger 2079b8d26b3bSNicholas Bellinger ib_req_notify_cq(tx_cq, IB_CQ_NEXT_COMP); 2080b8d26b3bSNicholas Bellinger } 2081b8d26b3bSNicholas Bellinger 2082b8d26b3bSNicholas Bellinger static void 2083b8d26b3bSNicholas Bellinger isert_cq_tx_callback(struct ib_cq *cq, void *context) 2084b8d26b3bSNicholas Bellinger { 2085b8d26b3bSNicholas Bellinger struct isert_cq_desc *cq_desc = (struct isert_cq_desc *)context; 2086b8d26b3bSNicholas Bellinger 2087b8d26b3bSNicholas Bellinger queue_work(isert_comp_wq, &cq_desc->cq_tx_work); 2088b8d26b3bSNicholas Bellinger } 2089b8d26b3bSNicholas Bellinger 2090b8d26b3bSNicholas Bellinger static void 2091b8d26b3bSNicholas Bellinger isert_cq_rx_work(struct work_struct *work) 2092b8d26b3bSNicholas Bellinger { 2093b8d26b3bSNicholas Bellinger struct isert_cq_desc *cq_desc = container_of(work, 2094b8d26b3bSNicholas Bellinger struct isert_cq_desc, cq_rx_work); 2095b8d26b3bSNicholas Bellinger struct isert_device *device = cq_desc->device; 2096b8d26b3bSNicholas Bellinger int cq_index = cq_desc->cq_index; 2097b8d26b3bSNicholas Bellinger struct ib_cq *rx_cq = device->dev_rx_cq[cq_index]; 2098b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn; 2099b8d26b3bSNicholas Bellinger struct iser_rx_desc *rx_desc; 2100b8d26b3bSNicholas Bellinger struct ib_wc wc; 2101b8d26b3bSNicholas Bellinger unsigned long xfer_len; 2102b8d26b3bSNicholas Bellinger 2103b8d26b3bSNicholas Bellinger while (ib_poll_cq(rx_cq, 1, &wc) == 1) { 2104b8d26b3bSNicholas Bellinger rx_desc = (struct iser_rx_desc *)(unsigned long)wc.wr_id; 2105b8d26b3bSNicholas Bellinger isert_conn = wc.qp->qp_context; 2106b8d26b3bSNicholas Bellinger 2107b8d26b3bSNicholas Bellinger if (wc.status == IB_WC_SUCCESS) { 2108b8d26b3bSNicholas Bellinger xfer_len = (unsigned long)wc.byte_len; 2109b8d26b3bSNicholas Bellinger isert_rx_completion(rx_desc, isert_conn, xfer_len); 2110b8d26b3bSNicholas Bellinger } else { 2111b8d26b3bSNicholas Bellinger pr_debug("RX wc.status != IB_WC_SUCCESS >>>>>>>>>>>>>>\n"); 2112c5a2adbfSNicholas Bellinger if (wc.status != IB_WC_WR_FLUSH_ERR) { 2113b8d26b3bSNicholas Bellinger pr_debug("RX wc.status: 0x%08x\n", wc.status); 2114c5a2adbfSNicholas Bellinger pr_debug("RX wc.vendor_err: 0x%08x\n", 2115c5a2adbfSNicholas Bellinger wc.vendor_err); 2116c5a2adbfSNicholas Bellinger } 2117*df43debdSSagi Grimberg isert_cq_comp_err(rx_desc, isert_conn, false); 2118b8d26b3bSNicholas Bellinger } 2119b8d26b3bSNicholas Bellinger } 2120b8d26b3bSNicholas Bellinger 2121b8d26b3bSNicholas Bellinger ib_req_notify_cq(rx_cq, IB_CQ_NEXT_COMP); 2122b8d26b3bSNicholas Bellinger } 2123b8d26b3bSNicholas Bellinger 2124b8d26b3bSNicholas Bellinger static void 2125b8d26b3bSNicholas Bellinger isert_cq_rx_callback(struct ib_cq *cq, void *context) 2126b8d26b3bSNicholas Bellinger { 2127b8d26b3bSNicholas Bellinger struct isert_cq_desc *cq_desc = (struct isert_cq_desc *)context; 2128b8d26b3bSNicholas Bellinger 2129b8d26b3bSNicholas Bellinger queue_work(isert_rx_wq, &cq_desc->cq_rx_work); 2130b8d26b3bSNicholas Bellinger } 2131b8d26b3bSNicholas Bellinger 2132b8d26b3bSNicholas Bellinger static int 2133b8d26b3bSNicholas Bellinger isert_post_response(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd) 2134b8d26b3bSNicholas Bellinger { 2135b8d26b3bSNicholas Bellinger struct ib_send_wr *wr_failed; 2136b8d26b3bSNicholas Bellinger int ret; 2137b8d26b3bSNicholas Bellinger 2138b8d26b3bSNicholas Bellinger atomic_inc(&isert_conn->post_send_buf_count); 2139b8d26b3bSNicholas Bellinger 2140b8d26b3bSNicholas Bellinger ret = ib_post_send(isert_conn->conn_qp, &isert_cmd->tx_desc.send_wr, 2141b8d26b3bSNicholas Bellinger &wr_failed); 2142b8d26b3bSNicholas Bellinger if (ret) { 2143b8d26b3bSNicholas Bellinger pr_err("ib_post_send failed with %d\n", ret); 2144b8d26b3bSNicholas Bellinger atomic_dec(&isert_conn->post_send_buf_count); 2145b8d26b3bSNicholas Bellinger return ret; 2146b8d26b3bSNicholas Bellinger } 2147b8d26b3bSNicholas Bellinger return ret; 2148b8d26b3bSNicholas Bellinger } 2149b8d26b3bSNicholas Bellinger 2150b8d26b3bSNicholas Bellinger static int 2151b8d26b3bSNicholas Bellinger isert_put_response(struct iscsi_conn *conn, struct iscsi_cmd *cmd) 2152b8d26b3bSNicholas Bellinger { 2153d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 2154b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 2155b8d26b3bSNicholas Bellinger struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr; 2156b8d26b3bSNicholas Bellinger struct iscsi_scsi_rsp *hdr = (struct iscsi_scsi_rsp *) 2157b8d26b3bSNicholas Bellinger &isert_cmd->tx_desc.iscsi_header; 2158b8d26b3bSNicholas Bellinger 2159b8d26b3bSNicholas Bellinger isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc); 2160b8d26b3bSNicholas Bellinger iscsit_build_rsp_pdu(cmd, conn, true, hdr); 2161b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 2162b8d26b3bSNicholas Bellinger /* 2163b8d26b3bSNicholas Bellinger * Attach SENSE DATA payload to iSCSI Response PDU 2164b8d26b3bSNicholas Bellinger */ 2165b8d26b3bSNicholas Bellinger if (cmd->se_cmd.sense_buffer && 2166b8d26b3bSNicholas Bellinger ((cmd->se_cmd.se_cmd_flags & SCF_TRANSPORT_TASK_SENSE) || 2167b8d26b3bSNicholas Bellinger (cmd->se_cmd.se_cmd_flags & SCF_EMULATED_TASK_SENSE))) { 2168b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 2169b8d26b3bSNicholas Bellinger struct ib_sge *tx_dsg = &isert_cmd->tx_desc.tx_sg[1]; 2170dbbc5d11SNicholas Bellinger u32 padding, pdu_len; 2171b8d26b3bSNicholas Bellinger 2172b8d26b3bSNicholas Bellinger put_unaligned_be16(cmd->se_cmd.scsi_sense_length, 2173b8d26b3bSNicholas Bellinger cmd->sense_buffer); 2174b8d26b3bSNicholas Bellinger cmd->se_cmd.scsi_sense_length += sizeof(__be16); 2175b8d26b3bSNicholas Bellinger 2176b8d26b3bSNicholas Bellinger padding = -(cmd->se_cmd.scsi_sense_length) & 3; 2177b8d26b3bSNicholas Bellinger hton24(hdr->dlength, (u32)cmd->se_cmd.scsi_sense_length); 2178dbbc5d11SNicholas Bellinger pdu_len = cmd->se_cmd.scsi_sense_length + padding; 2179b8d26b3bSNicholas Bellinger 2180dbbc5d11SNicholas Bellinger isert_cmd->pdu_buf_dma = ib_dma_map_single(ib_dev, 2181dbbc5d11SNicholas Bellinger (void *)cmd->sense_buffer, pdu_len, 2182b8d26b3bSNicholas Bellinger DMA_TO_DEVICE); 2183b8d26b3bSNicholas Bellinger 2184dbbc5d11SNicholas Bellinger isert_cmd->pdu_buf_len = pdu_len; 2185dbbc5d11SNicholas Bellinger tx_dsg->addr = isert_cmd->pdu_buf_dma; 2186dbbc5d11SNicholas Bellinger tx_dsg->length = pdu_len; 2187b8d26b3bSNicholas Bellinger tx_dsg->lkey = isert_conn->conn_mr->lkey; 2188b8d26b3bSNicholas Bellinger isert_cmd->tx_desc.num_sge = 2; 2189b8d26b3bSNicholas Bellinger } 2190b8d26b3bSNicholas Bellinger 219168a86deeSSagi Grimberg isert_init_send_wr(isert_conn, isert_cmd, send_wr); 2192b8d26b3bSNicholas Bellinger 2193b8d26b3bSNicholas Bellinger pr_debug("Posting SCSI Response IB_WR_SEND >>>>>>>>>>>>>>>>>>>>>>\n"); 2194b8d26b3bSNicholas Bellinger 2195b8d26b3bSNicholas Bellinger return isert_post_response(isert_conn, isert_cmd); 2196b8d26b3bSNicholas Bellinger } 2197b8d26b3bSNicholas Bellinger 2198131e6abcSNicholas Bellinger static void 2199131e6abcSNicholas Bellinger isert_aborted_task(struct iscsi_conn *conn, struct iscsi_cmd *cmd) 2200131e6abcSNicholas Bellinger { 2201131e6abcSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 2202131e6abcSNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 2203131e6abcSNicholas Bellinger struct isert_device *device = isert_conn->conn_device; 2204131e6abcSNicholas Bellinger 2205131e6abcSNicholas Bellinger spin_lock_bh(&conn->cmd_lock); 2206131e6abcSNicholas Bellinger if (!list_empty(&cmd->i_conn_node)) 2207131e6abcSNicholas Bellinger list_del_init(&cmd->i_conn_node); 2208131e6abcSNicholas Bellinger spin_unlock_bh(&conn->cmd_lock); 2209131e6abcSNicholas Bellinger 2210131e6abcSNicholas Bellinger if (cmd->data_direction == DMA_TO_DEVICE) 2211131e6abcSNicholas Bellinger iscsit_stop_dataout_timer(cmd); 2212131e6abcSNicholas Bellinger 2213131e6abcSNicholas Bellinger device->unreg_rdma_mem(isert_cmd, isert_conn); 2214131e6abcSNicholas Bellinger } 2215131e6abcSNicholas Bellinger 2216e70beee7SNicholas Bellinger static enum target_prot_op 2217e70beee7SNicholas Bellinger isert_get_sup_prot_ops(struct iscsi_conn *conn) 2218e70beee7SNicholas Bellinger { 2219e70beee7SNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 2220e70beee7SNicholas Bellinger struct isert_device *device = isert_conn->conn_device; 2221e70beee7SNicholas Bellinger 222223a548eeSSagi Grimberg if (conn->tpg->tpg_attrib.t10_pi) { 222323a548eeSSagi Grimberg if (device->pi_capable) { 222423a548eeSSagi Grimberg pr_info("conn %p PI offload enabled\n", isert_conn); 222523a548eeSSagi Grimberg isert_conn->pi_support = true; 2226e70beee7SNicholas Bellinger return TARGET_PROT_ALL; 222723a548eeSSagi Grimberg } 222823a548eeSSagi Grimberg } 222923a548eeSSagi Grimberg 223023a548eeSSagi Grimberg pr_info("conn %p PI offload disabled\n", isert_conn); 223123a548eeSSagi Grimberg isert_conn->pi_support = false; 2232e70beee7SNicholas Bellinger 2233e70beee7SNicholas Bellinger return TARGET_PROT_NORMAL; 2234e70beee7SNicholas Bellinger } 2235e70beee7SNicholas Bellinger 2236b8d26b3bSNicholas Bellinger static int 2237b8d26b3bSNicholas Bellinger isert_put_nopin(struct iscsi_cmd *cmd, struct iscsi_conn *conn, 2238b8d26b3bSNicholas Bellinger bool nopout_response) 2239b8d26b3bSNicholas Bellinger { 2240d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 2241b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 2242b8d26b3bSNicholas Bellinger struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr; 2243b8d26b3bSNicholas Bellinger 2244b8d26b3bSNicholas Bellinger isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc); 2245b8d26b3bSNicholas Bellinger iscsit_build_nopin_rsp(cmd, conn, (struct iscsi_nopin *) 2246b8d26b3bSNicholas Bellinger &isert_cmd->tx_desc.iscsi_header, 2247b8d26b3bSNicholas Bellinger nopout_response); 2248b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 224968a86deeSSagi Grimberg isert_init_send_wr(isert_conn, isert_cmd, send_wr); 2250b8d26b3bSNicholas Bellinger 22518b513d0cSMasanari Iida pr_debug("Posting NOPIN Response IB_WR_SEND >>>>>>>>>>>>>>>>>>>>>>\n"); 2252b8d26b3bSNicholas Bellinger 2253b8d26b3bSNicholas Bellinger return isert_post_response(isert_conn, isert_cmd); 2254b8d26b3bSNicholas Bellinger } 2255b8d26b3bSNicholas Bellinger 2256b8d26b3bSNicholas Bellinger static int 2257b8d26b3bSNicholas Bellinger isert_put_logout_rsp(struct iscsi_cmd *cmd, struct iscsi_conn *conn) 2258b8d26b3bSNicholas Bellinger { 2259d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 2260b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 2261b8d26b3bSNicholas Bellinger struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr; 2262b8d26b3bSNicholas Bellinger 2263b8d26b3bSNicholas Bellinger isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc); 2264b8d26b3bSNicholas Bellinger iscsit_build_logout_rsp(cmd, conn, (struct iscsi_logout_rsp *) 2265b8d26b3bSNicholas Bellinger &isert_cmd->tx_desc.iscsi_header); 2266b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 226768a86deeSSagi Grimberg isert_init_send_wr(isert_conn, isert_cmd, send_wr); 2268b8d26b3bSNicholas Bellinger 2269b8d26b3bSNicholas Bellinger pr_debug("Posting Logout Response IB_WR_SEND >>>>>>>>>>>>>>>>>>>>>>\n"); 2270b8d26b3bSNicholas Bellinger 2271b8d26b3bSNicholas Bellinger return isert_post_response(isert_conn, isert_cmd); 2272b8d26b3bSNicholas Bellinger } 2273b8d26b3bSNicholas Bellinger 2274b8d26b3bSNicholas Bellinger static int 2275b8d26b3bSNicholas Bellinger isert_put_tm_rsp(struct iscsi_cmd *cmd, struct iscsi_conn *conn) 2276b8d26b3bSNicholas Bellinger { 2277d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 2278b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 2279b8d26b3bSNicholas Bellinger struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr; 2280b8d26b3bSNicholas Bellinger 2281b8d26b3bSNicholas Bellinger isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc); 2282b8d26b3bSNicholas Bellinger iscsit_build_task_mgt_rsp(cmd, conn, (struct iscsi_tm_rsp *) 2283b8d26b3bSNicholas Bellinger &isert_cmd->tx_desc.iscsi_header); 2284b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 228568a86deeSSagi Grimberg isert_init_send_wr(isert_conn, isert_cmd, send_wr); 2286b8d26b3bSNicholas Bellinger 2287b8d26b3bSNicholas Bellinger pr_debug("Posting Task Management Response IB_WR_SEND >>>>>>>>>>>>>>>>>>>>>>\n"); 2288b8d26b3bSNicholas Bellinger 2289b8d26b3bSNicholas Bellinger return isert_post_response(isert_conn, isert_cmd); 2290b8d26b3bSNicholas Bellinger } 2291b8d26b3bSNicholas Bellinger 2292b8d26b3bSNicholas Bellinger static int 2293b8d26b3bSNicholas Bellinger isert_put_reject(struct iscsi_cmd *cmd, struct iscsi_conn *conn) 2294b8d26b3bSNicholas Bellinger { 2295d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 2296b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 2297b8d26b3bSNicholas Bellinger struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr; 22983df8f68aSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 22993df8f68aSNicholas Bellinger struct ib_sge *tx_dsg = &isert_cmd->tx_desc.tx_sg[1]; 23003df8f68aSNicholas Bellinger struct iscsi_reject *hdr = 23013df8f68aSNicholas Bellinger (struct iscsi_reject *)&isert_cmd->tx_desc.iscsi_header; 2302b8d26b3bSNicholas Bellinger 2303b8d26b3bSNicholas Bellinger isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc); 23043df8f68aSNicholas Bellinger iscsit_build_reject(cmd, conn, hdr); 2305b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 23063df8f68aSNicholas Bellinger 23073df8f68aSNicholas Bellinger hton24(hdr->dlength, ISCSI_HDR_LEN); 2308dbbc5d11SNicholas Bellinger isert_cmd->pdu_buf_dma = ib_dma_map_single(ib_dev, 23093df8f68aSNicholas Bellinger (void *)cmd->buf_ptr, ISCSI_HDR_LEN, 23103df8f68aSNicholas Bellinger DMA_TO_DEVICE); 2311dbbc5d11SNicholas Bellinger isert_cmd->pdu_buf_len = ISCSI_HDR_LEN; 2312dbbc5d11SNicholas Bellinger tx_dsg->addr = isert_cmd->pdu_buf_dma; 23133df8f68aSNicholas Bellinger tx_dsg->length = ISCSI_HDR_LEN; 23143df8f68aSNicholas Bellinger tx_dsg->lkey = isert_conn->conn_mr->lkey; 23153df8f68aSNicholas Bellinger isert_cmd->tx_desc.num_sge = 2; 23163df8f68aSNicholas Bellinger 231768a86deeSSagi Grimberg isert_init_send_wr(isert_conn, isert_cmd, send_wr); 2318b8d26b3bSNicholas Bellinger 2319b8d26b3bSNicholas Bellinger pr_debug("Posting Reject IB_WR_SEND >>>>>>>>>>>>>>>>>>>>>>\n"); 2320b8d26b3bSNicholas Bellinger 2321b8d26b3bSNicholas Bellinger return isert_post_response(isert_conn, isert_cmd); 2322b8d26b3bSNicholas Bellinger } 2323b8d26b3bSNicholas Bellinger 2324b8d26b3bSNicholas Bellinger static int 2325adb54c29SNicholas Bellinger isert_put_text_rsp(struct iscsi_cmd *cmd, struct iscsi_conn *conn) 2326adb54c29SNicholas Bellinger { 2327d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 2328adb54c29SNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 2329adb54c29SNicholas Bellinger struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr; 2330adb54c29SNicholas Bellinger struct iscsi_text_rsp *hdr = 2331adb54c29SNicholas Bellinger (struct iscsi_text_rsp *)&isert_cmd->tx_desc.iscsi_header; 2332adb54c29SNicholas Bellinger u32 txt_rsp_len; 2333adb54c29SNicholas Bellinger int rc; 2334adb54c29SNicholas Bellinger 2335adb54c29SNicholas Bellinger isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc); 233622c7aaa5SSagi Grimberg rc = iscsit_build_text_rsp(cmd, conn, hdr, ISCSI_INFINIBAND); 2337adb54c29SNicholas Bellinger if (rc < 0) 2338adb54c29SNicholas Bellinger return rc; 2339adb54c29SNicholas Bellinger 2340adb54c29SNicholas Bellinger txt_rsp_len = rc; 2341adb54c29SNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 2342adb54c29SNicholas Bellinger 2343adb54c29SNicholas Bellinger if (txt_rsp_len) { 2344adb54c29SNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 2345adb54c29SNicholas Bellinger struct ib_sge *tx_dsg = &isert_cmd->tx_desc.tx_sg[1]; 2346adb54c29SNicholas Bellinger void *txt_rsp_buf = cmd->buf_ptr; 2347adb54c29SNicholas Bellinger 2348adb54c29SNicholas Bellinger isert_cmd->pdu_buf_dma = ib_dma_map_single(ib_dev, 2349adb54c29SNicholas Bellinger txt_rsp_buf, txt_rsp_len, DMA_TO_DEVICE); 2350adb54c29SNicholas Bellinger 2351adb54c29SNicholas Bellinger isert_cmd->pdu_buf_len = txt_rsp_len; 2352adb54c29SNicholas Bellinger tx_dsg->addr = isert_cmd->pdu_buf_dma; 2353adb54c29SNicholas Bellinger tx_dsg->length = txt_rsp_len; 2354adb54c29SNicholas Bellinger tx_dsg->lkey = isert_conn->conn_mr->lkey; 2355adb54c29SNicholas Bellinger isert_cmd->tx_desc.num_sge = 2; 2356adb54c29SNicholas Bellinger } 235768a86deeSSagi Grimberg isert_init_send_wr(isert_conn, isert_cmd, send_wr); 2358adb54c29SNicholas Bellinger 2359adb54c29SNicholas Bellinger pr_debug("Posting Text Response IB_WR_SEND >>>>>>>>>>>>>>>>>>>>>>\n"); 2360adb54c29SNicholas Bellinger 2361adb54c29SNicholas Bellinger return isert_post_response(isert_conn, isert_cmd); 2362adb54c29SNicholas Bellinger } 2363adb54c29SNicholas Bellinger 2364adb54c29SNicholas Bellinger static int 2365b8d26b3bSNicholas Bellinger isert_build_rdma_wr(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd, 2366b8d26b3bSNicholas Bellinger struct ib_sge *ib_sge, struct ib_send_wr *send_wr, 2367b8d26b3bSNicholas Bellinger u32 data_left, u32 offset) 2368b8d26b3bSNicholas Bellinger { 2369d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd; 2370b8d26b3bSNicholas Bellinger struct scatterlist *sg_start, *tmp_sg; 2371b8d26b3bSNicholas Bellinger struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 2372b8d26b3bSNicholas Bellinger u32 sg_off, page_off; 2373b8d26b3bSNicholas Bellinger int i = 0, sg_nents; 2374b8d26b3bSNicholas Bellinger 2375b8d26b3bSNicholas Bellinger sg_off = offset / PAGE_SIZE; 2376b8d26b3bSNicholas Bellinger sg_start = &cmd->se_cmd.t_data_sg[sg_off]; 2377b8d26b3bSNicholas Bellinger sg_nents = min(cmd->se_cmd.t_data_nents - sg_off, isert_conn->max_sge); 2378b8d26b3bSNicholas Bellinger page_off = offset % PAGE_SIZE; 2379b8d26b3bSNicholas Bellinger 2380b8d26b3bSNicholas Bellinger send_wr->sg_list = ib_sge; 2381b8d26b3bSNicholas Bellinger send_wr->num_sge = sg_nents; 2382b8d26b3bSNicholas Bellinger send_wr->wr_id = (unsigned long)&isert_cmd->tx_desc; 2383b8d26b3bSNicholas Bellinger /* 2384b8d26b3bSNicholas Bellinger * Perform mapping of TCM scatterlist memory ib_sge dma_addr. 2385b8d26b3bSNicholas Bellinger */ 2386b8d26b3bSNicholas Bellinger for_each_sg(sg_start, tmp_sg, sg_nents, i) { 2387b8d26b3bSNicholas Bellinger pr_debug("ISER RDMA from SGL dma_addr: 0x%16llx dma_len: %u, page_off: %u\n", 2388b8d26b3bSNicholas Bellinger (unsigned long long)tmp_sg->dma_address, 2389b8d26b3bSNicholas Bellinger tmp_sg->length, page_off); 2390b8d26b3bSNicholas Bellinger 2391b8d26b3bSNicholas Bellinger ib_sge->addr = ib_sg_dma_address(ib_dev, tmp_sg) + page_off; 2392b8d26b3bSNicholas Bellinger ib_sge->length = min_t(u32, data_left, 2393b8d26b3bSNicholas Bellinger ib_sg_dma_len(ib_dev, tmp_sg) - page_off); 2394b8d26b3bSNicholas Bellinger ib_sge->lkey = isert_conn->conn_mr->lkey; 2395b8d26b3bSNicholas Bellinger 239690ecc6e2SVu Pham pr_debug("RDMA ib_sge: addr: 0x%16llx length: %u lkey: %08x\n", 239790ecc6e2SVu Pham ib_sge->addr, ib_sge->length, ib_sge->lkey); 2398b8d26b3bSNicholas Bellinger page_off = 0; 2399b8d26b3bSNicholas Bellinger data_left -= ib_sge->length; 2400b8d26b3bSNicholas Bellinger ib_sge++; 2401b8d26b3bSNicholas Bellinger pr_debug("Incrementing ib_sge pointer to %p\n", ib_sge); 2402b8d26b3bSNicholas Bellinger } 2403b8d26b3bSNicholas Bellinger 2404b8d26b3bSNicholas Bellinger pr_debug("Set outgoing sg_list: %p num_sg: %u from TCM SGLs\n", 2405b8d26b3bSNicholas Bellinger send_wr->sg_list, send_wr->num_sge); 2406b8d26b3bSNicholas Bellinger 2407b8d26b3bSNicholas Bellinger return sg_nents; 2408b8d26b3bSNicholas Bellinger } 2409b8d26b3bSNicholas Bellinger 2410b8d26b3bSNicholas Bellinger static int 241190ecc6e2SVu Pham isert_map_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd, 241290ecc6e2SVu Pham struct isert_rdma_wr *wr) 2413b8d26b3bSNicholas Bellinger { 2414b8d26b3bSNicholas Bellinger struct se_cmd *se_cmd = &cmd->se_cmd; 2415d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 2416b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 2417e3d7e4c3SSagi Grimberg struct isert_data_buf *data = &wr->data; 241890ecc6e2SVu Pham struct ib_send_wr *send_wr; 2419b8d26b3bSNicholas Bellinger struct ib_sge *ib_sge; 2420e3d7e4c3SSagi Grimberg u32 offset, data_len, data_left, rdma_write_max, va_offset = 0; 2421e3d7e4c3SSagi Grimberg int ret = 0, i, ib_sge_cnt; 2422b8d26b3bSNicholas Bellinger 242390ecc6e2SVu Pham isert_cmd->tx_desc.isert_cmd = isert_cmd; 2424b8d26b3bSNicholas Bellinger 2425e3d7e4c3SSagi Grimberg offset = wr->iser_ib_op == ISER_IB_RDMA_READ ? cmd->write_data_done : 0; 2426e3d7e4c3SSagi Grimberg ret = isert_map_data_buf(isert_conn, isert_cmd, se_cmd->t_data_sg, 2427e3d7e4c3SSagi Grimberg se_cmd->t_data_nents, se_cmd->data_length, 2428e3d7e4c3SSagi Grimberg offset, wr->iser_ib_op, &wr->data); 2429e3d7e4c3SSagi Grimberg if (ret) 2430e3d7e4c3SSagi Grimberg return ret; 2431b8d26b3bSNicholas Bellinger 2432e3d7e4c3SSagi Grimberg data_left = data->len; 2433e3d7e4c3SSagi Grimberg offset = data->offset; 2434b8d26b3bSNicholas Bellinger 2435e3d7e4c3SSagi Grimberg ib_sge = kzalloc(sizeof(struct ib_sge) * data->nents, GFP_KERNEL); 2436b8d26b3bSNicholas Bellinger if (!ib_sge) { 243790ecc6e2SVu Pham pr_warn("Unable to allocate ib_sge\n"); 2438b8d26b3bSNicholas Bellinger ret = -ENOMEM; 2439e3d7e4c3SSagi Grimberg goto unmap_cmd; 2440b8d26b3bSNicholas Bellinger } 244190ecc6e2SVu Pham wr->ib_sge = ib_sge; 2442b8d26b3bSNicholas Bellinger 2443e3d7e4c3SSagi Grimberg wr->send_wr_num = DIV_ROUND_UP(data->nents, isert_conn->max_sge); 2444b8d26b3bSNicholas Bellinger wr->send_wr = kzalloc(sizeof(struct ib_send_wr) * wr->send_wr_num, 2445b8d26b3bSNicholas Bellinger GFP_KERNEL); 2446b8d26b3bSNicholas Bellinger if (!wr->send_wr) { 244790ecc6e2SVu Pham pr_debug("Unable to allocate wr->send_wr\n"); 2448b8d26b3bSNicholas Bellinger ret = -ENOMEM; 2449e3d7e4c3SSagi Grimberg goto unmap_cmd; 2450b8d26b3bSNicholas Bellinger } 2451b8d26b3bSNicholas Bellinger 2452b8d26b3bSNicholas Bellinger wr->isert_cmd = isert_cmd; 2453b8d26b3bSNicholas Bellinger rdma_write_max = isert_conn->max_sge * PAGE_SIZE; 2454b8d26b3bSNicholas Bellinger 2455b8d26b3bSNicholas Bellinger for (i = 0; i < wr->send_wr_num; i++) { 2456b8d26b3bSNicholas Bellinger send_wr = &isert_cmd->rdma_wr.send_wr[i]; 2457b8d26b3bSNicholas Bellinger data_len = min(data_left, rdma_write_max); 2458b8d26b3bSNicholas Bellinger 2459b8d26b3bSNicholas Bellinger send_wr->send_flags = 0; 246090ecc6e2SVu Pham if (wr->iser_ib_op == ISER_IB_RDMA_WRITE) { 246190ecc6e2SVu Pham send_wr->opcode = IB_WR_RDMA_WRITE; 2462b8d26b3bSNicholas Bellinger send_wr->wr.rdma.remote_addr = isert_cmd->read_va + offset; 2463b8d26b3bSNicholas Bellinger send_wr->wr.rdma.rkey = isert_cmd->read_stag; 246490ecc6e2SVu Pham if (i + 1 == wr->send_wr_num) 246590ecc6e2SVu Pham send_wr->next = &isert_cmd->tx_desc.send_wr; 246690ecc6e2SVu Pham else 246790ecc6e2SVu Pham send_wr->next = &wr->send_wr[i + 1]; 246890ecc6e2SVu Pham } else { 246990ecc6e2SVu Pham send_wr->opcode = IB_WR_RDMA_READ; 247090ecc6e2SVu Pham send_wr->wr.rdma.remote_addr = isert_cmd->write_va + va_offset; 247190ecc6e2SVu Pham send_wr->wr.rdma.rkey = isert_cmd->write_stag; 247290ecc6e2SVu Pham if (i + 1 == wr->send_wr_num) 247390ecc6e2SVu Pham send_wr->send_flags = IB_SEND_SIGNALED; 247490ecc6e2SVu Pham else 247590ecc6e2SVu Pham send_wr->next = &wr->send_wr[i + 1]; 247690ecc6e2SVu Pham } 2477b8d26b3bSNicholas Bellinger 2478b8d26b3bSNicholas Bellinger ib_sge_cnt = isert_build_rdma_wr(isert_conn, isert_cmd, ib_sge, 2479b8d26b3bSNicholas Bellinger send_wr, data_len, offset); 2480b8d26b3bSNicholas Bellinger ib_sge += ib_sge_cnt; 2481b8d26b3bSNicholas Bellinger 2482b8d26b3bSNicholas Bellinger offset += data_len; 248390ecc6e2SVu Pham va_offset += data_len; 2484b8d26b3bSNicholas Bellinger data_left -= data_len; 2485b8d26b3bSNicholas Bellinger } 248690ecc6e2SVu Pham 248790ecc6e2SVu Pham return 0; 2488e3d7e4c3SSagi Grimberg unmap_cmd: 2489e3d7e4c3SSagi Grimberg isert_unmap_data_buf(isert_conn, data); 2490e3d7e4c3SSagi Grimberg 249190ecc6e2SVu Pham return ret; 249290ecc6e2SVu Pham } 249390ecc6e2SVu Pham 249490ecc6e2SVu Pham static int 249559464ef4SVu Pham isert_map_fr_pagelist(struct ib_device *ib_dev, 249659464ef4SVu Pham struct scatterlist *sg_start, int sg_nents, u64 *fr_pl) 249759464ef4SVu Pham { 249859464ef4SVu Pham u64 start_addr, end_addr, page, chunk_start = 0; 249959464ef4SVu Pham struct scatterlist *tmp_sg; 250059464ef4SVu Pham int i = 0, new_chunk, last_ent, n_pages; 250159464ef4SVu Pham 250259464ef4SVu Pham n_pages = 0; 250359464ef4SVu Pham new_chunk = 1; 250459464ef4SVu Pham last_ent = sg_nents - 1; 250559464ef4SVu Pham for_each_sg(sg_start, tmp_sg, sg_nents, i) { 250659464ef4SVu Pham start_addr = ib_sg_dma_address(ib_dev, tmp_sg); 250759464ef4SVu Pham if (new_chunk) 250859464ef4SVu Pham chunk_start = start_addr; 250959464ef4SVu Pham end_addr = start_addr + ib_sg_dma_len(ib_dev, tmp_sg); 251059464ef4SVu Pham 251159464ef4SVu Pham pr_debug("SGL[%d] dma_addr: 0x%16llx len: %u\n", 251259464ef4SVu Pham i, (unsigned long long)tmp_sg->dma_address, 251359464ef4SVu Pham tmp_sg->length); 251459464ef4SVu Pham 251559464ef4SVu Pham if ((end_addr & ~PAGE_MASK) && i < last_ent) { 251659464ef4SVu Pham new_chunk = 0; 251759464ef4SVu Pham continue; 251859464ef4SVu Pham } 251959464ef4SVu Pham new_chunk = 1; 252059464ef4SVu Pham 252159464ef4SVu Pham page = chunk_start & PAGE_MASK; 252259464ef4SVu Pham do { 252359464ef4SVu Pham fr_pl[n_pages++] = page; 252459464ef4SVu Pham pr_debug("Mapped page_list[%d] page_addr: 0x%16llx\n", 252559464ef4SVu Pham n_pages - 1, page); 252659464ef4SVu Pham page += PAGE_SIZE; 252759464ef4SVu Pham } while (page < end_addr); 252859464ef4SVu Pham } 252959464ef4SVu Pham 253059464ef4SVu Pham return n_pages; 253159464ef4SVu Pham } 253259464ef4SVu Pham 253359464ef4SVu Pham static int 2534e3d7e4c3SSagi Grimberg isert_fast_reg_mr(struct isert_conn *isert_conn, 2535e3d7e4c3SSagi Grimberg struct fast_reg_descriptor *fr_desc, 2536e3d7e4c3SSagi Grimberg struct isert_data_buf *mem, 25379e961ae7SSagi Grimberg enum isert_indicator ind, 2538e3d7e4c3SSagi Grimberg struct ib_sge *sge) 253959464ef4SVu Pham { 254059464ef4SVu Pham struct ib_device *ib_dev = isert_conn->conn_cm_id->device; 25419e961ae7SSagi Grimberg struct ib_mr *mr; 25429e961ae7SSagi Grimberg struct ib_fast_reg_page_list *frpl; 254359464ef4SVu Pham struct ib_send_wr fr_wr, inv_wr; 254459464ef4SVu Pham struct ib_send_wr *bad_wr, *wr = NULL; 25459bd626e7SSagi Grimberg int ret, pagelist_len; 25469bd626e7SSagi Grimberg u32 page_off; 254759464ef4SVu Pham u8 key; 254859464ef4SVu Pham 2549e3d7e4c3SSagi Grimberg if (mem->dma_nents == 1) { 2550e3d7e4c3SSagi Grimberg sge->lkey = isert_conn->conn_mr->lkey; 2551e3d7e4c3SSagi Grimberg sge->addr = ib_sg_dma_address(ib_dev, &mem->sg[0]); 2552e3d7e4c3SSagi Grimberg sge->length = ib_sg_dma_len(ib_dev, &mem->sg[0]); 25539e961ae7SSagi Grimberg pr_debug("%s:%d sge: addr: 0x%llx length: %u lkey: %x\n", 25549e961ae7SSagi Grimberg __func__, __LINE__, sge->addr, sge->length, 25559e961ae7SSagi Grimberg sge->lkey); 2556e3d7e4c3SSagi Grimberg return 0; 2557e3d7e4c3SSagi Grimberg } 2558e3d7e4c3SSagi Grimberg 25599e961ae7SSagi Grimberg if (ind == ISERT_DATA_KEY_VALID) { 25609e961ae7SSagi Grimberg /* Registering data buffer */ 25619e961ae7SSagi Grimberg mr = fr_desc->data_mr; 25629e961ae7SSagi Grimberg frpl = fr_desc->data_frpl; 25639e961ae7SSagi Grimberg } else { 25649e961ae7SSagi Grimberg /* Registering protection buffer */ 25659e961ae7SSagi Grimberg mr = fr_desc->pi_ctx->prot_mr; 25669e961ae7SSagi Grimberg frpl = fr_desc->pi_ctx->prot_frpl; 25679e961ae7SSagi Grimberg } 25689e961ae7SSagi Grimberg 2569e3d7e4c3SSagi Grimberg page_off = mem->offset % PAGE_SIZE; 257059464ef4SVu Pham 25719bd626e7SSagi Grimberg pr_debug("Use fr_desc %p sg_nents %d offset %u\n", 2572e3d7e4c3SSagi Grimberg fr_desc, mem->nents, mem->offset); 257359464ef4SVu Pham 2574e3d7e4c3SSagi Grimberg pagelist_len = isert_map_fr_pagelist(ib_dev, mem->sg, mem->nents, 25759e961ae7SSagi Grimberg &frpl->page_list[0]); 257659464ef4SVu Pham 2577d3e125daSSagi Grimberg if (!(fr_desc->ind & ISERT_DATA_KEY_VALID)) { 257859464ef4SVu Pham memset(&inv_wr, 0, sizeof(inv_wr)); 25799bb4ca68SNicholas Bellinger inv_wr.wr_id = ISER_FASTREG_LI_WRID; 258059464ef4SVu Pham inv_wr.opcode = IB_WR_LOCAL_INV; 25819e961ae7SSagi Grimberg inv_wr.ex.invalidate_rkey = mr->rkey; 258259464ef4SVu Pham wr = &inv_wr; 258359464ef4SVu Pham /* Bump the key */ 25849e961ae7SSagi Grimberg key = (u8)(mr->rkey & 0x000000FF); 25859e961ae7SSagi Grimberg ib_update_fast_reg_key(mr, ++key); 258659464ef4SVu Pham } 258759464ef4SVu Pham 258859464ef4SVu Pham /* Prepare FASTREG WR */ 258959464ef4SVu Pham memset(&fr_wr, 0, sizeof(fr_wr)); 25909bb4ca68SNicholas Bellinger fr_wr.wr_id = ISER_FASTREG_LI_WRID; 259159464ef4SVu Pham fr_wr.opcode = IB_WR_FAST_REG_MR; 25929e961ae7SSagi Grimberg fr_wr.wr.fast_reg.iova_start = frpl->page_list[0] + page_off; 25939e961ae7SSagi Grimberg fr_wr.wr.fast_reg.page_list = frpl; 259459464ef4SVu Pham fr_wr.wr.fast_reg.page_list_len = pagelist_len; 259559464ef4SVu Pham fr_wr.wr.fast_reg.page_shift = PAGE_SHIFT; 2596e3d7e4c3SSagi Grimberg fr_wr.wr.fast_reg.length = mem->len; 25979e961ae7SSagi Grimberg fr_wr.wr.fast_reg.rkey = mr->rkey; 259859464ef4SVu Pham fr_wr.wr.fast_reg.access_flags = IB_ACCESS_LOCAL_WRITE; 259959464ef4SVu Pham 260059464ef4SVu Pham if (!wr) 260159464ef4SVu Pham wr = &fr_wr; 260259464ef4SVu Pham else 260359464ef4SVu Pham wr->next = &fr_wr; 260459464ef4SVu Pham 260559464ef4SVu Pham ret = ib_post_send(isert_conn->conn_qp, wr, &bad_wr); 260659464ef4SVu Pham if (ret) { 260759464ef4SVu Pham pr_err("fast registration failed, ret:%d\n", ret); 260859464ef4SVu Pham return ret; 260959464ef4SVu Pham } 26109e961ae7SSagi Grimberg fr_desc->ind &= ~ind; 261159464ef4SVu Pham 26129e961ae7SSagi Grimberg sge->lkey = mr->lkey; 26139e961ae7SSagi Grimberg sge->addr = frpl->page_list[0] + page_off; 2614e3d7e4c3SSagi Grimberg sge->length = mem->len; 261559464ef4SVu Pham 26169e961ae7SSagi Grimberg pr_debug("%s:%d sge: addr: 0x%llx length: %u lkey: %x\n", 26179e961ae7SSagi Grimberg __func__, __LINE__, sge->addr, sge->length, 26189e961ae7SSagi Grimberg sge->lkey); 261959464ef4SVu Pham 262059464ef4SVu Pham return ret; 262159464ef4SVu Pham } 262259464ef4SVu Pham 26233d73cf1aSSagi Grimberg static inline void 26243d73cf1aSSagi Grimberg isert_set_dif_domain(struct se_cmd *se_cmd, struct ib_sig_attrs *sig_attrs, 26253d73cf1aSSagi Grimberg struct ib_sig_domain *domain) 26269e961ae7SSagi Grimberg { 262778eda2bbSSagi Grimberg domain->sig_type = IB_SIG_TYPE_T10_DIF; 26283d73cf1aSSagi Grimberg domain->sig.dif.bg_type = IB_T10DIF_CRC; 26293d73cf1aSSagi Grimberg domain->sig.dif.pi_interval = se_cmd->se_dev->dev_attrib.block_size; 26303d73cf1aSSagi Grimberg domain->sig.dif.ref_tag = se_cmd->reftag_seed; 263178eda2bbSSagi Grimberg /* 263278eda2bbSSagi Grimberg * At the moment we hard code those, but if in the future 263378eda2bbSSagi Grimberg * the target core would like to use it, we will take it 263478eda2bbSSagi Grimberg * from se_cmd. 263578eda2bbSSagi Grimberg */ 263678eda2bbSSagi Grimberg domain->sig.dif.apptag_check_mask = 0xffff; 263778eda2bbSSagi Grimberg domain->sig.dif.app_escape = true; 263878eda2bbSSagi Grimberg domain->sig.dif.ref_escape = true; 263978eda2bbSSagi Grimberg if (se_cmd->prot_type == TARGET_DIF_TYPE1_PROT || 264078eda2bbSSagi Grimberg se_cmd->prot_type == TARGET_DIF_TYPE2_PROT) 264178eda2bbSSagi Grimberg domain->sig.dif.ref_remap = true; 26423d73cf1aSSagi Grimberg }; 26433d73cf1aSSagi Grimberg 26443d73cf1aSSagi Grimberg static int 26453d73cf1aSSagi Grimberg isert_set_sig_attrs(struct se_cmd *se_cmd, struct ib_sig_attrs *sig_attrs) 26463d73cf1aSSagi Grimberg { 26479e961ae7SSagi Grimberg switch (se_cmd->prot_op) { 26489e961ae7SSagi Grimberg case TARGET_PROT_DIN_INSERT: 26499e961ae7SSagi Grimberg case TARGET_PROT_DOUT_STRIP: 265078eda2bbSSagi Grimberg sig_attrs->mem.sig_type = IB_SIG_TYPE_NONE; 26513d73cf1aSSagi Grimberg isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->wire); 26529e961ae7SSagi Grimberg break; 26539e961ae7SSagi Grimberg case TARGET_PROT_DOUT_INSERT: 26549e961ae7SSagi Grimberg case TARGET_PROT_DIN_STRIP: 265578eda2bbSSagi Grimberg sig_attrs->wire.sig_type = IB_SIG_TYPE_NONE; 26563d73cf1aSSagi Grimberg isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->mem); 26579e961ae7SSagi Grimberg break; 26589e961ae7SSagi Grimberg case TARGET_PROT_DIN_PASS: 26599e961ae7SSagi Grimberg case TARGET_PROT_DOUT_PASS: 26603d73cf1aSSagi Grimberg isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->wire); 26613d73cf1aSSagi Grimberg isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->mem); 26629e961ae7SSagi Grimberg break; 26639e961ae7SSagi Grimberg default: 26649e961ae7SSagi Grimberg pr_err("Unsupported PI operation %d\n", se_cmd->prot_op); 26659e961ae7SSagi Grimberg return -EINVAL; 26669e961ae7SSagi Grimberg } 26679e961ae7SSagi Grimberg 26689e961ae7SSagi Grimberg return 0; 26699e961ae7SSagi Grimberg } 26709e961ae7SSagi Grimberg 26719e961ae7SSagi Grimberg static inline u8 26729e961ae7SSagi Grimberg isert_set_prot_checks(u8 prot_checks) 26739e961ae7SSagi Grimberg { 26749e961ae7SSagi Grimberg return (prot_checks & TARGET_DIF_CHECK_GUARD ? 0xc0 : 0) | 26759e961ae7SSagi Grimberg (prot_checks & TARGET_DIF_CHECK_REFTAG ? 0x30 : 0) | 26769e961ae7SSagi Grimberg (prot_checks & TARGET_DIF_CHECK_REFTAG ? 0x0f : 0); 26779e961ae7SSagi Grimberg } 26789e961ae7SSagi Grimberg 26799e961ae7SSagi Grimberg static int 2680570db170SSagi Grimberg isert_reg_sig_mr(struct isert_conn *isert_conn, 2681570db170SSagi Grimberg struct se_cmd *se_cmd, 2682570db170SSagi Grimberg struct isert_rdma_wr *rdma_wr, 2683570db170SSagi Grimberg struct fast_reg_descriptor *fr_desc) 26849e961ae7SSagi Grimberg { 26859e961ae7SSagi Grimberg struct ib_send_wr sig_wr, inv_wr; 26869e961ae7SSagi Grimberg struct ib_send_wr *bad_wr, *wr = NULL; 26879e961ae7SSagi Grimberg struct pi_context *pi_ctx = fr_desc->pi_ctx; 26889e961ae7SSagi Grimberg struct ib_sig_attrs sig_attrs; 26899e961ae7SSagi Grimberg int ret; 26909e961ae7SSagi Grimberg u32 key; 26919e961ae7SSagi Grimberg 26929e961ae7SSagi Grimberg memset(&sig_attrs, 0, sizeof(sig_attrs)); 26939e961ae7SSagi Grimberg ret = isert_set_sig_attrs(se_cmd, &sig_attrs); 26949e961ae7SSagi Grimberg if (ret) 26959e961ae7SSagi Grimberg goto err; 26969e961ae7SSagi Grimberg 26979e961ae7SSagi Grimberg sig_attrs.check_mask = isert_set_prot_checks(se_cmd->prot_checks); 26989e961ae7SSagi Grimberg 26999e961ae7SSagi Grimberg if (!(fr_desc->ind & ISERT_SIG_KEY_VALID)) { 27009e961ae7SSagi Grimberg memset(&inv_wr, 0, sizeof(inv_wr)); 27019e961ae7SSagi Grimberg inv_wr.opcode = IB_WR_LOCAL_INV; 2702c2caa207SSagi Grimberg inv_wr.wr_id = ISER_FASTREG_LI_WRID; 27039e961ae7SSagi Grimberg inv_wr.ex.invalidate_rkey = pi_ctx->sig_mr->rkey; 27049e961ae7SSagi Grimberg wr = &inv_wr; 27059e961ae7SSagi Grimberg /* Bump the key */ 27069e961ae7SSagi Grimberg key = (u8)(pi_ctx->sig_mr->rkey & 0x000000FF); 27079e961ae7SSagi Grimberg ib_update_fast_reg_key(pi_ctx->sig_mr, ++key); 27089e961ae7SSagi Grimberg } 27099e961ae7SSagi Grimberg 27109e961ae7SSagi Grimberg memset(&sig_wr, 0, sizeof(sig_wr)); 27119e961ae7SSagi Grimberg sig_wr.opcode = IB_WR_REG_SIG_MR; 2712c2caa207SSagi Grimberg sig_wr.wr_id = ISER_FASTREG_LI_WRID; 2713570db170SSagi Grimberg sig_wr.sg_list = &rdma_wr->ib_sg[DATA]; 27149e961ae7SSagi Grimberg sig_wr.num_sge = 1; 27159e961ae7SSagi Grimberg sig_wr.wr.sig_handover.access_flags = IB_ACCESS_LOCAL_WRITE; 27169e961ae7SSagi Grimberg sig_wr.wr.sig_handover.sig_attrs = &sig_attrs; 27179e961ae7SSagi Grimberg sig_wr.wr.sig_handover.sig_mr = pi_ctx->sig_mr; 27189e961ae7SSagi Grimberg if (se_cmd->t_prot_sg) 2719570db170SSagi Grimberg sig_wr.wr.sig_handover.prot = &rdma_wr->ib_sg[PROT]; 27209e961ae7SSagi Grimberg 27219e961ae7SSagi Grimberg if (!wr) 27229e961ae7SSagi Grimberg wr = &sig_wr; 27239e961ae7SSagi Grimberg else 27249e961ae7SSagi Grimberg wr->next = &sig_wr; 27259e961ae7SSagi Grimberg 27269e961ae7SSagi Grimberg ret = ib_post_send(isert_conn->conn_qp, wr, &bad_wr); 27279e961ae7SSagi Grimberg if (ret) { 27289e961ae7SSagi Grimberg pr_err("fast registration failed, ret:%d\n", ret); 27299e961ae7SSagi Grimberg goto err; 27309e961ae7SSagi Grimberg } 27319e961ae7SSagi Grimberg fr_desc->ind &= ~ISERT_SIG_KEY_VALID; 27329e961ae7SSagi Grimberg 2733570db170SSagi Grimberg rdma_wr->ib_sg[SIG].lkey = pi_ctx->sig_mr->lkey; 2734570db170SSagi Grimberg rdma_wr->ib_sg[SIG].addr = 0; 2735570db170SSagi Grimberg rdma_wr->ib_sg[SIG].length = se_cmd->data_length; 27369e961ae7SSagi Grimberg if (se_cmd->prot_op != TARGET_PROT_DIN_STRIP && 27379e961ae7SSagi Grimberg se_cmd->prot_op != TARGET_PROT_DOUT_INSERT) 27389e961ae7SSagi Grimberg /* 27399e961ae7SSagi Grimberg * We have protection guards on the wire 27409e961ae7SSagi Grimberg * so we need to set a larget transfer 27419e961ae7SSagi Grimberg */ 2742570db170SSagi Grimberg rdma_wr->ib_sg[SIG].length += se_cmd->prot_length; 27439e961ae7SSagi Grimberg 27449e961ae7SSagi Grimberg pr_debug("sig_sge: addr: 0x%llx length: %u lkey: %x\n", 2745570db170SSagi Grimberg rdma_wr->ib_sg[SIG].addr, rdma_wr->ib_sg[SIG].length, 2746570db170SSagi Grimberg rdma_wr->ib_sg[SIG].lkey); 27479e961ae7SSagi Grimberg err: 27489e961ae7SSagi Grimberg return ret; 27499e961ae7SSagi Grimberg } 27509e961ae7SSagi Grimberg 275159464ef4SVu Pham static int 2752570db170SSagi Grimberg isert_handle_prot_cmd(struct isert_conn *isert_conn, 2753570db170SSagi Grimberg struct isert_cmd *isert_cmd, 2754570db170SSagi Grimberg struct isert_rdma_wr *wr) 2755570db170SSagi Grimberg { 2756570db170SSagi Grimberg struct isert_device *device = isert_conn->conn_device; 2757570db170SSagi Grimberg struct se_cmd *se_cmd = &isert_cmd->iscsi_cmd->se_cmd; 2758570db170SSagi Grimberg int ret; 2759570db170SSagi Grimberg 2760570db170SSagi Grimberg if (!wr->fr_desc->pi_ctx) { 2761570db170SSagi Grimberg ret = isert_create_pi_ctx(wr->fr_desc, 2762570db170SSagi Grimberg device->ib_device, 2763570db170SSagi Grimberg isert_conn->conn_pd); 2764570db170SSagi Grimberg if (ret) { 2765570db170SSagi Grimberg pr_err("conn %p failed to allocate pi_ctx\n", 2766570db170SSagi Grimberg isert_conn); 2767570db170SSagi Grimberg return ret; 2768570db170SSagi Grimberg } 2769570db170SSagi Grimberg } 2770570db170SSagi Grimberg 2771570db170SSagi Grimberg if (se_cmd->t_prot_sg) { 2772570db170SSagi Grimberg ret = isert_map_data_buf(isert_conn, isert_cmd, 2773570db170SSagi Grimberg se_cmd->t_prot_sg, 2774570db170SSagi Grimberg se_cmd->t_prot_nents, 2775570db170SSagi Grimberg se_cmd->prot_length, 2776570db170SSagi Grimberg 0, wr->iser_ib_op, &wr->prot); 2777570db170SSagi Grimberg if (ret) { 2778570db170SSagi Grimberg pr_err("conn %p failed to map protection buffer\n", 2779570db170SSagi Grimberg isert_conn); 2780570db170SSagi Grimberg return ret; 2781570db170SSagi Grimberg } 2782570db170SSagi Grimberg 2783570db170SSagi Grimberg memset(&wr->ib_sg[PROT], 0, sizeof(wr->ib_sg[PROT])); 2784570db170SSagi Grimberg ret = isert_fast_reg_mr(isert_conn, wr->fr_desc, &wr->prot, 2785570db170SSagi Grimberg ISERT_PROT_KEY_VALID, &wr->ib_sg[PROT]); 2786570db170SSagi Grimberg if (ret) { 2787570db170SSagi Grimberg pr_err("conn %p failed to fast reg mr\n", 2788570db170SSagi Grimberg isert_conn); 2789570db170SSagi Grimberg goto unmap_prot_cmd; 2790570db170SSagi Grimberg } 2791570db170SSagi Grimberg } 2792570db170SSagi Grimberg 2793570db170SSagi Grimberg ret = isert_reg_sig_mr(isert_conn, se_cmd, wr, wr->fr_desc); 2794570db170SSagi Grimberg if (ret) { 2795570db170SSagi Grimberg pr_err("conn %p failed to fast reg mr\n", 2796570db170SSagi Grimberg isert_conn); 2797570db170SSagi Grimberg goto unmap_prot_cmd; 2798570db170SSagi Grimberg } 2799570db170SSagi Grimberg wr->fr_desc->ind |= ISERT_PROTECTED; 2800570db170SSagi Grimberg 2801570db170SSagi Grimberg return 0; 2802570db170SSagi Grimberg 2803570db170SSagi Grimberg unmap_prot_cmd: 2804570db170SSagi Grimberg if (se_cmd->t_prot_sg) 2805570db170SSagi Grimberg isert_unmap_data_buf(isert_conn, &wr->prot); 2806570db170SSagi Grimberg 2807570db170SSagi Grimberg return ret; 2808570db170SSagi Grimberg } 2809570db170SSagi Grimberg 2810570db170SSagi Grimberg static int 2811a3a5a826SSagi Grimberg isert_reg_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd, 281259464ef4SVu Pham struct isert_rdma_wr *wr) 281359464ef4SVu Pham { 281459464ef4SVu Pham struct se_cmd *se_cmd = &cmd->se_cmd; 281559464ef4SVu Pham struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 2816e3d7e4c3SSagi Grimberg struct isert_conn *isert_conn = conn->context; 2817e3d7e4c3SSagi Grimberg struct fast_reg_descriptor *fr_desc = NULL; 2818570db170SSagi Grimberg struct ib_send_wr *send_wr; 2819570db170SSagi Grimberg struct ib_sge *ib_sg; 2820e3d7e4c3SSagi Grimberg u32 offset; 2821e3d7e4c3SSagi Grimberg int ret = 0; 282259464ef4SVu Pham unsigned long flags; 282359464ef4SVu Pham 282459464ef4SVu Pham isert_cmd->tx_desc.isert_cmd = isert_cmd; 2825e3d7e4c3SSagi Grimberg 2826e3d7e4c3SSagi Grimberg offset = wr->iser_ib_op == ISER_IB_RDMA_READ ? cmd->write_data_done : 0; 2827e3d7e4c3SSagi Grimberg ret = isert_map_data_buf(isert_conn, isert_cmd, se_cmd->t_data_sg, 2828e3d7e4c3SSagi Grimberg se_cmd->t_data_nents, se_cmd->data_length, 2829e3d7e4c3SSagi Grimberg offset, wr->iser_ib_op, &wr->data); 2830e3d7e4c3SSagi Grimberg if (ret) 2831e3d7e4c3SSagi Grimberg return ret; 2832e3d7e4c3SSagi Grimberg 2833302cc7c3SSagi Grimberg if (wr->data.dma_nents != 1 || isert_prot_cmd(isert_conn, se_cmd)) { 2834e3d7e4c3SSagi Grimberg spin_lock_irqsave(&isert_conn->conn_lock, flags); 2835e3d7e4c3SSagi Grimberg fr_desc = list_first_entry(&isert_conn->conn_fr_pool, 2836e3d7e4c3SSagi Grimberg struct fast_reg_descriptor, list); 2837e3d7e4c3SSagi Grimberg list_del(&fr_desc->list); 2838e3d7e4c3SSagi Grimberg spin_unlock_irqrestore(&isert_conn->conn_lock, flags); 2839e3d7e4c3SSagi Grimberg wr->fr_desc = fr_desc; 284059464ef4SVu Pham } 284159464ef4SVu Pham 28429e961ae7SSagi Grimberg ret = isert_fast_reg_mr(isert_conn, fr_desc, &wr->data, 2843570db170SSagi Grimberg ISERT_DATA_KEY_VALID, &wr->ib_sg[DATA]); 2844e3d7e4c3SSagi Grimberg if (ret) 2845e3d7e4c3SSagi Grimberg goto unmap_cmd; 284659464ef4SVu Pham 2847302cc7c3SSagi Grimberg if (isert_prot_cmd(isert_conn, se_cmd)) { 2848570db170SSagi Grimberg ret = isert_handle_prot_cmd(isert_conn, isert_cmd, wr); 28499e961ae7SSagi Grimberg if (ret) 28509e961ae7SSagi Grimberg goto unmap_cmd; 28519e961ae7SSagi Grimberg 2852570db170SSagi Grimberg ib_sg = &wr->ib_sg[SIG]; 2853570db170SSagi Grimberg } else { 2854570db170SSagi Grimberg ib_sg = &wr->ib_sg[DATA]; 28559e961ae7SSagi Grimberg } 28569e961ae7SSagi Grimberg 2857570db170SSagi Grimberg memcpy(&wr->s_ib_sge, ib_sg, sizeof(*ib_sg)); 2858e3d7e4c3SSagi Grimberg wr->ib_sge = &wr->s_ib_sge; 285959464ef4SVu Pham wr->send_wr_num = 1; 286059464ef4SVu Pham memset(&wr->s_send_wr, 0, sizeof(*send_wr)); 286159464ef4SVu Pham wr->send_wr = &wr->s_send_wr; 286259464ef4SVu Pham wr->isert_cmd = isert_cmd; 286359464ef4SVu Pham 286459464ef4SVu Pham send_wr = &isert_cmd->rdma_wr.s_send_wr; 2865e3d7e4c3SSagi Grimberg send_wr->sg_list = &wr->s_ib_sge; 286659464ef4SVu Pham send_wr->num_sge = 1; 286759464ef4SVu Pham send_wr->wr_id = (unsigned long)&isert_cmd->tx_desc; 286859464ef4SVu Pham if (wr->iser_ib_op == ISER_IB_RDMA_WRITE) { 286959464ef4SVu Pham send_wr->opcode = IB_WR_RDMA_WRITE; 287059464ef4SVu Pham send_wr->wr.rdma.remote_addr = isert_cmd->read_va; 287159464ef4SVu Pham send_wr->wr.rdma.rkey = isert_cmd->read_stag; 2872302cc7c3SSagi Grimberg send_wr->send_flags = !isert_prot_cmd(isert_conn, se_cmd) ? 28739e961ae7SSagi Grimberg 0 : IB_SEND_SIGNALED; 287459464ef4SVu Pham } else { 287559464ef4SVu Pham send_wr->opcode = IB_WR_RDMA_READ; 287659464ef4SVu Pham send_wr->wr.rdma.remote_addr = isert_cmd->write_va; 287759464ef4SVu Pham send_wr->wr.rdma.rkey = isert_cmd->write_stag; 287859464ef4SVu Pham send_wr->send_flags = IB_SEND_SIGNALED; 287959464ef4SVu Pham } 288059464ef4SVu Pham 288159464ef4SVu Pham return 0; 2882570db170SSagi Grimberg 2883e3d7e4c3SSagi Grimberg unmap_cmd: 2884e3d7e4c3SSagi Grimberg if (fr_desc) { 2885e3d7e4c3SSagi Grimberg spin_lock_irqsave(&isert_conn->conn_lock, flags); 2886e3d7e4c3SSagi Grimberg list_add_tail(&fr_desc->list, &isert_conn->conn_fr_pool); 2887e3d7e4c3SSagi Grimberg spin_unlock_irqrestore(&isert_conn->conn_lock, flags); 2888e3d7e4c3SSagi Grimberg } 2889e3d7e4c3SSagi Grimberg isert_unmap_data_buf(isert_conn, &wr->data); 289059464ef4SVu Pham 289159464ef4SVu Pham return ret; 289259464ef4SVu Pham } 289359464ef4SVu Pham 289459464ef4SVu Pham static int 289590ecc6e2SVu Pham isert_put_datain(struct iscsi_conn *conn, struct iscsi_cmd *cmd) 289690ecc6e2SVu Pham { 289790ecc6e2SVu Pham struct se_cmd *se_cmd = &cmd->se_cmd; 289859464ef4SVu Pham struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 289990ecc6e2SVu Pham struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 290090ecc6e2SVu Pham struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 2901d40945d8SVu Pham struct isert_device *device = isert_conn->conn_device; 290290ecc6e2SVu Pham struct ib_send_wr *wr_failed; 290390ecc6e2SVu Pham int rc; 290490ecc6e2SVu Pham 290590ecc6e2SVu Pham pr_debug("Cmd: %p RDMA_WRITE data_length: %u\n", 290690ecc6e2SVu Pham isert_cmd, se_cmd->data_length); 290790ecc6e2SVu Pham wr->iser_ib_op = ISER_IB_RDMA_WRITE; 2908d40945d8SVu Pham rc = device->reg_rdma_mem(conn, cmd, wr); 290990ecc6e2SVu Pham if (rc) { 291090ecc6e2SVu Pham pr_err("Cmd: %p failed to prepare RDMA res\n", isert_cmd); 291190ecc6e2SVu Pham return rc; 291290ecc6e2SVu Pham } 291390ecc6e2SVu Pham 2914302cc7c3SSagi Grimberg if (!isert_prot_cmd(isert_conn, se_cmd)) { 2915b8d26b3bSNicholas Bellinger /* 2916b8d26b3bSNicholas Bellinger * Build isert_conn->tx_desc for iSCSI response PDU and attach 2917b8d26b3bSNicholas Bellinger */ 29189e961ae7SSagi Grimberg isert_create_send_desc(isert_conn, isert_cmd, 29199e961ae7SSagi Grimberg &isert_cmd->tx_desc); 292004d9cd12SNicholas Bellinger iscsit_build_rsp_pdu(cmd, conn, true, (struct iscsi_scsi_rsp *) 2921b8d26b3bSNicholas Bellinger &isert_cmd->tx_desc.iscsi_header); 2922b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 292395b60f07SNicholas Bellinger isert_init_send_wr(isert_conn, isert_cmd, 292468a86deeSSagi Grimberg &isert_cmd->tx_desc.send_wr); 29259e961ae7SSagi Grimberg isert_cmd->rdma_wr.s_send_wr.next = &isert_cmd->tx_desc.send_wr; 2926897bb2c9SSagi Grimberg wr->send_wr_num += 1; 29279e961ae7SSagi Grimberg } 2928b8d26b3bSNicholas Bellinger 2929897bb2c9SSagi Grimberg atomic_add(wr->send_wr_num, &isert_conn->post_send_buf_count); 2930b8d26b3bSNicholas Bellinger 2931b8d26b3bSNicholas Bellinger rc = ib_post_send(isert_conn->conn_qp, wr->send_wr, &wr_failed); 2932b8d26b3bSNicholas Bellinger if (rc) { 2933b8d26b3bSNicholas Bellinger pr_warn("ib_post_send() failed for IB_WR_RDMA_WRITE\n"); 2934897bb2c9SSagi Grimberg atomic_sub(wr->send_wr_num, &isert_conn->post_send_buf_count); 2935b8d26b3bSNicholas Bellinger } 29369e961ae7SSagi Grimberg 2937302cc7c3SSagi Grimberg if (!isert_prot_cmd(isert_conn, se_cmd)) 29389e961ae7SSagi Grimberg pr_debug("Cmd: %p posted RDMA_WRITE + Response for iSER Data " 29399e961ae7SSagi Grimberg "READ\n", isert_cmd); 29409e961ae7SSagi Grimberg else 29419e961ae7SSagi Grimberg pr_debug("Cmd: %p posted RDMA_WRITE for iSER Data READ\n", 294290ecc6e2SVu Pham isert_cmd); 2943b8d26b3bSNicholas Bellinger 294490ecc6e2SVu Pham return 1; 2945b8d26b3bSNicholas Bellinger } 2946b8d26b3bSNicholas Bellinger 2947b8d26b3bSNicholas Bellinger static int 2948b8d26b3bSNicholas Bellinger isert_get_dataout(struct iscsi_conn *conn, struct iscsi_cmd *cmd, bool recovery) 2949b8d26b3bSNicholas Bellinger { 2950b8d26b3bSNicholas Bellinger struct se_cmd *se_cmd = &cmd->se_cmd; 2951d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 2952b8d26b3bSNicholas Bellinger struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 2953b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 2954d40945d8SVu Pham struct isert_device *device = isert_conn->conn_device; 295590ecc6e2SVu Pham struct ib_send_wr *wr_failed; 295690ecc6e2SVu Pham int rc; 2957b8d26b3bSNicholas Bellinger 295890ecc6e2SVu Pham pr_debug("Cmd: %p RDMA_READ data_length: %u write_data_done: %u\n", 295990ecc6e2SVu Pham isert_cmd, se_cmd->data_length, cmd->write_data_done); 2960b8d26b3bSNicholas Bellinger wr->iser_ib_op = ISER_IB_RDMA_READ; 2961d40945d8SVu Pham rc = device->reg_rdma_mem(conn, cmd, wr); 296290ecc6e2SVu Pham if (rc) { 296390ecc6e2SVu Pham pr_err("Cmd: %p failed to prepare RDMA res\n", isert_cmd); 296490ecc6e2SVu Pham return rc; 2965b8d26b3bSNicholas Bellinger } 2966b8d26b3bSNicholas Bellinger 2967b6b87a1dSNicholas Bellinger atomic_add(wr->send_wr_num, &isert_conn->post_send_buf_count); 2968b8d26b3bSNicholas Bellinger 2969b8d26b3bSNicholas Bellinger rc = ib_post_send(isert_conn->conn_qp, wr->send_wr, &wr_failed); 2970b8d26b3bSNicholas Bellinger if (rc) { 2971b8d26b3bSNicholas Bellinger pr_warn("ib_post_send() failed for IB_WR_RDMA_READ\n"); 2972b6b87a1dSNicholas Bellinger atomic_sub(wr->send_wr_num, &isert_conn->post_send_buf_count); 2973b8d26b3bSNicholas Bellinger } 297490ecc6e2SVu Pham pr_debug("Cmd: %p posted RDMA_READ memory for ISER Data WRITE\n", 297590ecc6e2SVu Pham isert_cmd); 2976b8d26b3bSNicholas Bellinger 297790ecc6e2SVu Pham return 0; 2978b8d26b3bSNicholas Bellinger } 2979b8d26b3bSNicholas Bellinger 2980b8d26b3bSNicholas Bellinger static int 2981b8d26b3bSNicholas Bellinger isert_immediate_queue(struct iscsi_conn *conn, struct iscsi_cmd *cmd, int state) 2982b8d26b3bSNicholas Bellinger { 2983b8d26b3bSNicholas Bellinger int ret; 2984b8d26b3bSNicholas Bellinger 2985b8d26b3bSNicholas Bellinger switch (state) { 2986b8d26b3bSNicholas Bellinger case ISTATE_SEND_NOPIN_WANT_RESPONSE: 2987b8d26b3bSNicholas Bellinger ret = isert_put_nopin(cmd, conn, false); 2988b8d26b3bSNicholas Bellinger break; 2989b8d26b3bSNicholas Bellinger default: 2990b8d26b3bSNicholas Bellinger pr_err("Unknown immediate state: 0x%02x\n", state); 2991b8d26b3bSNicholas Bellinger ret = -EINVAL; 2992b8d26b3bSNicholas Bellinger break; 2993b8d26b3bSNicholas Bellinger } 2994b8d26b3bSNicholas Bellinger 2995b8d26b3bSNicholas Bellinger return ret; 2996b8d26b3bSNicholas Bellinger } 2997b8d26b3bSNicholas Bellinger 2998b8d26b3bSNicholas Bellinger static int 2999b8d26b3bSNicholas Bellinger isert_response_queue(struct iscsi_conn *conn, struct iscsi_cmd *cmd, int state) 3000b8d26b3bSNicholas Bellinger { 3001b8d26b3bSNicholas Bellinger int ret; 3002b8d26b3bSNicholas Bellinger 3003b8d26b3bSNicholas Bellinger switch (state) { 3004b8d26b3bSNicholas Bellinger case ISTATE_SEND_LOGOUTRSP: 3005b8d26b3bSNicholas Bellinger ret = isert_put_logout_rsp(cmd, conn); 3006b8d26b3bSNicholas Bellinger if (!ret) { 3007b8d26b3bSNicholas Bellinger pr_debug("Returning iSER Logout -EAGAIN\n"); 3008b8d26b3bSNicholas Bellinger ret = -EAGAIN; 3009b8d26b3bSNicholas Bellinger } 3010b8d26b3bSNicholas Bellinger break; 3011b8d26b3bSNicholas Bellinger case ISTATE_SEND_NOPIN: 3012b8d26b3bSNicholas Bellinger ret = isert_put_nopin(cmd, conn, true); 3013b8d26b3bSNicholas Bellinger break; 3014b8d26b3bSNicholas Bellinger case ISTATE_SEND_TASKMGTRSP: 3015b8d26b3bSNicholas Bellinger ret = isert_put_tm_rsp(cmd, conn); 3016b8d26b3bSNicholas Bellinger break; 3017b8d26b3bSNicholas Bellinger case ISTATE_SEND_REJECT: 3018b8d26b3bSNicholas Bellinger ret = isert_put_reject(cmd, conn); 3019b8d26b3bSNicholas Bellinger break; 3020adb54c29SNicholas Bellinger case ISTATE_SEND_TEXTRSP: 3021adb54c29SNicholas Bellinger ret = isert_put_text_rsp(cmd, conn); 3022adb54c29SNicholas Bellinger break; 3023b8d26b3bSNicholas Bellinger case ISTATE_SEND_STATUS: 3024b8d26b3bSNicholas Bellinger /* 3025b8d26b3bSNicholas Bellinger * Special case for sending non GOOD SCSI status from TX thread 3026b8d26b3bSNicholas Bellinger * context during pre se_cmd excecution failure. 3027b8d26b3bSNicholas Bellinger */ 3028b8d26b3bSNicholas Bellinger ret = isert_put_response(conn, cmd); 3029b8d26b3bSNicholas Bellinger break; 3030b8d26b3bSNicholas Bellinger default: 3031b8d26b3bSNicholas Bellinger pr_err("Unknown response state: 0x%02x\n", state); 3032b8d26b3bSNicholas Bellinger ret = -EINVAL; 3033b8d26b3bSNicholas Bellinger break; 3034b8d26b3bSNicholas Bellinger } 3035b8d26b3bSNicholas Bellinger 3036b8d26b3bSNicholas Bellinger return ret; 3037b8d26b3bSNicholas Bellinger } 3038b8d26b3bSNicholas Bellinger 3039ca6c1d82SSagi Grimberg struct rdma_cm_id * 3040ca6c1d82SSagi Grimberg isert_setup_id(struct isert_np *isert_np) 3041ca6c1d82SSagi Grimberg { 3042ca6c1d82SSagi Grimberg struct iscsi_np *np = isert_np->np; 3043ca6c1d82SSagi Grimberg struct rdma_cm_id *id; 3044ca6c1d82SSagi Grimberg struct sockaddr *sa; 3045ca6c1d82SSagi Grimberg int ret; 3046ca6c1d82SSagi Grimberg 3047ca6c1d82SSagi Grimberg sa = (struct sockaddr *)&np->np_sockaddr; 3048ca6c1d82SSagi Grimberg pr_debug("ksockaddr: %p, sa: %p\n", &np->np_sockaddr, sa); 3049ca6c1d82SSagi Grimberg 3050ca6c1d82SSagi Grimberg id = rdma_create_id(isert_cma_handler, isert_np, 3051ca6c1d82SSagi Grimberg RDMA_PS_TCP, IB_QPT_RC); 3052ca6c1d82SSagi Grimberg if (IS_ERR(id)) { 3053ca6c1d82SSagi Grimberg pr_err("rdma_create_id() failed: %ld\n", PTR_ERR(id)); 3054ca6c1d82SSagi Grimberg ret = PTR_ERR(id); 3055ca6c1d82SSagi Grimberg goto out; 3056ca6c1d82SSagi Grimberg } 3057ca6c1d82SSagi Grimberg pr_debug("id %p context %p\n", id, id->context); 3058ca6c1d82SSagi Grimberg 3059ca6c1d82SSagi Grimberg ret = rdma_bind_addr(id, sa); 3060ca6c1d82SSagi Grimberg if (ret) { 3061ca6c1d82SSagi Grimberg pr_err("rdma_bind_addr() failed: %d\n", ret); 3062ca6c1d82SSagi Grimberg goto out_id; 3063ca6c1d82SSagi Grimberg } 3064ca6c1d82SSagi Grimberg 3065ca6c1d82SSagi Grimberg ret = rdma_listen(id, ISERT_RDMA_LISTEN_BACKLOG); 3066ca6c1d82SSagi Grimberg if (ret) { 3067ca6c1d82SSagi Grimberg pr_err("rdma_listen() failed: %d\n", ret); 3068ca6c1d82SSagi Grimberg goto out_id; 3069ca6c1d82SSagi Grimberg } 3070ca6c1d82SSagi Grimberg 3071ca6c1d82SSagi Grimberg return id; 3072ca6c1d82SSagi Grimberg out_id: 3073ca6c1d82SSagi Grimberg rdma_destroy_id(id); 3074ca6c1d82SSagi Grimberg out: 3075ca6c1d82SSagi Grimberg return ERR_PTR(ret); 3076ca6c1d82SSagi Grimberg } 3077ca6c1d82SSagi Grimberg 3078b8d26b3bSNicholas Bellinger static int 3079b8d26b3bSNicholas Bellinger isert_setup_np(struct iscsi_np *np, 3080b8d26b3bSNicholas Bellinger struct __kernel_sockaddr_storage *ksockaddr) 3081b8d26b3bSNicholas Bellinger { 3082b8d26b3bSNicholas Bellinger struct isert_np *isert_np; 3083b8d26b3bSNicholas Bellinger struct rdma_cm_id *isert_lid; 3084b8d26b3bSNicholas Bellinger int ret; 3085b8d26b3bSNicholas Bellinger 3086b8d26b3bSNicholas Bellinger isert_np = kzalloc(sizeof(struct isert_np), GFP_KERNEL); 3087b8d26b3bSNicholas Bellinger if (!isert_np) { 3088b8d26b3bSNicholas Bellinger pr_err("Unable to allocate struct isert_np\n"); 3089b8d26b3bSNicholas Bellinger return -ENOMEM; 3090b8d26b3bSNicholas Bellinger } 3091531b7bf4SSagi Grimberg sema_init(&isert_np->np_sem, 0); 3092b8d26b3bSNicholas Bellinger mutex_init(&isert_np->np_accept_mutex); 3093b8d26b3bSNicholas Bellinger INIT_LIST_HEAD(&isert_np->np_accept_list); 3094b8d26b3bSNicholas Bellinger init_completion(&isert_np->np_login_comp); 3095ca6c1d82SSagi Grimberg isert_np->np = np; 3096b8d26b3bSNicholas Bellinger 3097b8d26b3bSNicholas Bellinger /* 3098b8d26b3bSNicholas Bellinger * Setup the np->np_sockaddr from the passed sockaddr setup 3099b8d26b3bSNicholas Bellinger * in iscsi_target_configfs.c code.. 3100b8d26b3bSNicholas Bellinger */ 3101b8d26b3bSNicholas Bellinger memcpy(&np->np_sockaddr, ksockaddr, 3102b8d26b3bSNicholas Bellinger sizeof(struct __kernel_sockaddr_storage)); 3103b8d26b3bSNicholas Bellinger 3104ca6c1d82SSagi Grimberg isert_lid = isert_setup_id(isert_np); 3105b8d26b3bSNicholas Bellinger if (IS_ERR(isert_lid)) { 3106b8d26b3bSNicholas Bellinger ret = PTR_ERR(isert_lid); 3107b8d26b3bSNicholas Bellinger goto out; 3108b8d26b3bSNicholas Bellinger } 3109b8d26b3bSNicholas Bellinger 3110b8d26b3bSNicholas Bellinger isert_np->np_cm_id = isert_lid; 3111b8d26b3bSNicholas Bellinger np->np_context = isert_np; 3112b8d26b3bSNicholas Bellinger 3113b8d26b3bSNicholas Bellinger return 0; 3114b8d26b3bSNicholas Bellinger 3115b8d26b3bSNicholas Bellinger out: 3116b8d26b3bSNicholas Bellinger kfree(isert_np); 3117ca6c1d82SSagi Grimberg 3118b8d26b3bSNicholas Bellinger return ret; 3119b8d26b3bSNicholas Bellinger } 3120b8d26b3bSNicholas Bellinger 3121b8d26b3bSNicholas Bellinger static int 3122b8d26b3bSNicholas Bellinger isert_rdma_accept(struct isert_conn *isert_conn) 3123b8d26b3bSNicholas Bellinger { 3124b8d26b3bSNicholas Bellinger struct rdma_cm_id *cm_id = isert_conn->conn_cm_id; 3125b8d26b3bSNicholas Bellinger struct rdma_conn_param cp; 3126b8d26b3bSNicholas Bellinger int ret; 3127b8d26b3bSNicholas Bellinger 3128b8d26b3bSNicholas Bellinger memset(&cp, 0, sizeof(struct rdma_conn_param)); 3129b8d26b3bSNicholas Bellinger cp.initiator_depth = isert_conn->initiator_depth; 3130b8d26b3bSNicholas Bellinger cp.retry_count = 7; 3131b8d26b3bSNicholas Bellinger cp.rnr_retry_count = 7; 3132b8d26b3bSNicholas Bellinger 3133b8d26b3bSNicholas Bellinger pr_debug("Before rdma_accept >>>>>>>>>>>>>>>>>>>>.\n"); 3134b8d26b3bSNicholas Bellinger 3135b8d26b3bSNicholas Bellinger ret = rdma_accept(cm_id, &cp); 3136b8d26b3bSNicholas Bellinger if (ret) { 3137b8d26b3bSNicholas Bellinger pr_err("rdma_accept() failed with: %d\n", ret); 3138b8d26b3bSNicholas Bellinger return ret; 3139b8d26b3bSNicholas Bellinger } 3140b8d26b3bSNicholas Bellinger 3141b8d26b3bSNicholas Bellinger pr_debug("After rdma_accept >>>>>>>>>>>>>>>>>>>>>.\n"); 3142b8d26b3bSNicholas Bellinger 3143b8d26b3bSNicholas Bellinger return 0; 3144b8d26b3bSNicholas Bellinger } 3145b8d26b3bSNicholas Bellinger 3146b8d26b3bSNicholas Bellinger static int 3147b8d26b3bSNicholas Bellinger isert_get_login_rx(struct iscsi_conn *conn, struct iscsi_login *login) 3148b8d26b3bSNicholas Bellinger { 3149b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = (struct isert_conn *)conn->context; 3150b8d26b3bSNicholas Bellinger int ret; 3151b8d26b3bSNicholas Bellinger 31522371e5daSSagi Grimberg pr_info("before login_req comp conn: %p\n", isert_conn); 31532371e5daSSagi Grimberg ret = wait_for_completion_interruptible(&isert_conn->login_req_comp); 31542371e5daSSagi Grimberg if (ret) { 31552371e5daSSagi Grimberg pr_err("isert_conn %p interrupted before got login req\n", 31562371e5daSSagi Grimberg isert_conn); 31572371e5daSSagi Grimberg return ret; 31582371e5daSSagi Grimberg } 31592371e5daSSagi Grimberg reinit_completion(&isert_conn->login_req_comp); 31602371e5daSSagi Grimberg 31616faaa85fSNicholas Bellinger /* 31626faaa85fSNicholas Bellinger * For login requests after the first PDU, isert_rx_login_req() will 31636faaa85fSNicholas Bellinger * kick schedule_delayed_work(&conn->login_work) as the packet is 31646faaa85fSNicholas Bellinger * received, which turns this callback from iscsi_target_do_login_rx() 31656faaa85fSNicholas Bellinger * into a NOP. 31666faaa85fSNicholas Bellinger */ 31676faaa85fSNicholas Bellinger if (!login->first_request) 31686faaa85fSNicholas Bellinger return 0; 3169b8d26b3bSNicholas Bellinger 31702371e5daSSagi Grimberg isert_rx_login_req(isert_conn); 31712371e5daSSagi Grimberg 31722371e5daSSagi Grimberg pr_info("before conn_login_comp conn: %p\n", conn); 3173b8d26b3bSNicholas Bellinger ret = wait_for_completion_interruptible(&isert_conn->conn_login_comp); 3174b8d26b3bSNicholas Bellinger if (ret) 3175b8d26b3bSNicholas Bellinger return ret; 3176b8d26b3bSNicholas Bellinger 31772371e5daSSagi Grimberg pr_info("processing login->req: %p\n", login->req); 31782371e5daSSagi Grimberg 3179b8d26b3bSNicholas Bellinger return 0; 3180b8d26b3bSNicholas Bellinger } 3181b8d26b3bSNicholas Bellinger 3182b8d26b3bSNicholas Bellinger static void 3183b8d26b3bSNicholas Bellinger isert_set_conn_info(struct iscsi_np *np, struct iscsi_conn *conn, 3184b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn) 3185b8d26b3bSNicholas Bellinger { 3186b8d26b3bSNicholas Bellinger struct rdma_cm_id *cm_id = isert_conn->conn_cm_id; 3187b8d26b3bSNicholas Bellinger struct rdma_route *cm_route = &cm_id->route; 3188b8d26b3bSNicholas Bellinger struct sockaddr_in *sock_in; 3189b8d26b3bSNicholas Bellinger struct sockaddr_in6 *sock_in6; 3190b8d26b3bSNicholas Bellinger 3191b8d26b3bSNicholas Bellinger conn->login_family = np->np_sockaddr.ss_family; 3192b8d26b3bSNicholas Bellinger 3193b8d26b3bSNicholas Bellinger if (np->np_sockaddr.ss_family == AF_INET6) { 3194b8d26b3bSNicholas Bellinger sock_in6 = (struct sockaddr_in6 *)&cm_route->addr.dst_addr; 3195b8d26b3bSNicholas Bellinger snprintf(conn->login_ip, sizeof(conn->login_ip), "%pI6c", 3196b8d26b3bSNicholas Bellinger &sock_in6->sin6_addr.in6_u); 3197b8d26b3bSNicholas Bellinger conn->login_port = ntohs(sock_in6->sin6_port); 3198b8d26b3bSNicholas Bellinger 3199b8d26b3bSNicholas Bellinger sock_in6 = (struct sockaddr_in6 *)&cm_route->addr.src_addr; 3200b8d26b3bSNicholas Bellinger snprintf(conn->local_ip, sizeof(conn->local_ip), "%pI6c", 3201b8d26b3bSNicholas Bellinger &sock_in6->sin6_addr.in6_u); 3202b8d26b3bSNicholas Bellinger conn->local_port = ntohs(sock_in6->sin6_port); 3203b8d26b3bSNicholas Bellinger } else { 3204b8d26b3bSNicholas Bellinger sock_in = (struct sockaddr_in *)&cm_route->addr.dst_addr; 3205b8d26b3bSNicholas Bellinger sprintf(conn->login_ip, "%pI4", 3206b8d26b3bSNicholas Bellinger &sock_in->sin_addr.s_addr); 3207b8d26b3bSNicholas Bellinger conn->login_port = ntohs(sock_in->sin_port); 3208b8d26b3bSNicholas Bellinger 3209b8d26b3bSNicholas Bellinger sock_in = (struct sockaddr_in *)&cm_route->addr.src_addr; 3210b8d26b3bSNicholas Bellinger sprintf(conn->local_ip, "%pI4", 3211b8d26b3bSNicholas Bellinger &sock_in->sin_addr.s_addr); 3212b8d26b3bSNicholas Bellinger conn->local_port = ntohs(sock_in->sin_port); 3213b8d26b3bSNicholas Bellinger } 3214b8d26b3bSNicholas Bellinger } 3215b8d26b3bSNicholas Bellinger 3216b8d26b3bSNicholas Bellinger static int 3217b8d26b3bSNicholas Bellinger isert_accept_np(struct iscsi_np *np, struct iscsi_conn *conn) 3218b8d26b3bSNicholas Bellinger { 3219b8d26b3bSNicholas Bellinger struct isert_np *isert_np = (struct isert_np *)np->np_context; 3220b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn; 3221b8d26b3bSNicholas Bellinger int max_accept = 0, ret; 3222b8d26b3bSNicholas Bellinger 3223b8d26b3bSNicholas Bellinger accept_wait: 3224531b7bf4SSagi Grimberg ret = down_interruptible(&isert_np->np_sem); 32251acff63fSSagi Grimberg if (ret || max_accept > 5) 3226b8d26b3bSNicholas Bellinger return -ENODEV; 3227b8d26b3bSNicholas Bellinger 3228b8d26b3bSNicholas Bellinger spin_lock_bh(&np->np_thread_lock); 3229e346ab34SSagi Grimberg if (np->np_thread_state >= ISCSI_NP_THREAD_RESET) { 3230b8d26b3bSNicholas Bellinger spin_unlock_bh(&np->np_thread_lock); 3231e346ab34SSagi Grimberg pr_debug("np_thread_state %d for isert_accept_np\n", 3232e346ab34SSagi Grimberg np->np_thread_state); 3233e346ab34SSagi Grimberg /** 3234e346ab34SSagi Grimberg * No point in stalling here when np_thread 3235e346ab34SSagi Grimberg * is in state RESET/SHUTDOWN/EXIT - bail 3236e346ab34SSagi Grimberg **/ 3237b8d26b3bSNicholas Bellinger return -ENODEV; 3238b8d26b3bSNicholas Bellinger } 3239b8d26b3bSNicholas Bellinger spin_unlock_bh(&np->np_thread_lock); 3240b8d26b3bSNicholas Bellinger 3241b8d26b3bSNicholas Bellinger mutex_lock(&isert_np->np_accept_mutex); 3242b8d26b3bSNicholas Bellinger if (list_empty(&isert_np->np_accept_list)) { 3243b8d26b3bSNicholas Bellinger mutex_unlock(&isert_np->np_accept_mutex); 3244b8d26b3bSNicholas Bellinger max_accept++; 3245b8d26b3bSNicholas Bellinger goto accept_wait; 3246b8d26b3bSNicholas Bellinger } 3247b8d26b3bSNicholas Bellinger isert_conn = list_first_entry(&isert_np->np_accept_list, 3248b8d26b3bSNicholas Bellinger struct isert_conn, conn_accept_node); 3249b8d26b3bSNicholas Bellinger list_del_init(&isert_conn->conn_accept_node); 3250b8d26b3bSNicholas Bellinger mutex_unlock(&isert_np->np_accept_mutex); 3251b8d26b3bSNicholas Bellinger 3252b8d26b3bSNicholas Bellinger conn->context = isert_conn; 3253b8d26b3bSNicholas Bellinger isert_conn->conn = conn; 3254b8d26b3bSNicholas Bellinger max_accept = 0; 3255b8d26b3bSNicholas Bellinger 3256b8d26b3bSNicholas Bellinger isert_set_conn_info(np, conn, isert_conn); 3257b8d26b3bSNicholas Bellinger 32582371e5daSSagi Grimberg pr_debug("Processing isert_conn: %p\n", isert_conn); 32592371e5daSSagi Grimberg 3260b8d26b3bSNicholas Bellinger return 0; 3261b8d26b3bSNicholas Bellinger } 3262b8d26b3bSNicholas Bellinger 3263b8d26b3bSNicholas Bellinger static void 3264b8d26b3bSNicholas Bellinger isert_free_np(struct iscsi_np *np) 3265b8d26b3bSNicholas Bellinger { 3266b8d26b3bSNicholas Bellinger struct isert_np *isert_np = (struct isert_np *)np->np_context; 3267268e6811SSagi Grimberg struct isert_conn *isert_conn, *n; 3268b8d26b3bSNicholas Bellinger 32693b726ae2SSagi Grimberg if (isert_np->np_cm_id) 3270b8d26b3bSNicholas Bellinger rdma_destroy_id(isert_np->np_cm_id); 3271b8d26b3bSNicholas Bellinger 3272268e6811SSagi Grimberg /* 3273268e6811SSagi Grimberg * FIXME: At this point we don't have a good way to insure 3274268e6811SSagi Grimberg * that at this point we don't have hanging connections that 3275268e6811SSagi Grimberg * completed RDMA establishment but didn't start iscsi login 3276268e6811SSagi Grimberg * process. So work-around this by cleaning up what ever piled 3277268e6811SSagi Grimberg * up in np_accept_list. 3278268e6811SSagi Grimberg */ 3279268e6811SSagi Grimberg mutex_lock(&isert_np->np_accept_mutex); 3280268e6811SSagi Grimberg if (!list_empty(&isert_np->np_accept_list)) { 3281268e6811SSagi Grimberg pr_info("Still have isert connections, cleaning up...\n"); 3282268e6811SSagi Grimberg list_for_each_entry_safe(isert_conn, n, 3283268e6811SSagi Grimberg &isert_np->np_accept_list, 3284268e6811SSagi Grimberg conn_accept_node) { 3285268e6811SSagi Grimberg pr_info("cleaning isert_conn %p state (%d)\n", 3286268e6811SSagi Grimberg isert_conn, isert_conn->state); 3287268e6811SSagi Grimberg isert_connect_release(isert_conn); 3288268e6811SSagi Grimberg } 3289268e6811SSagi Grimberg } 3290268e6811SSagi Grimberg mutex_unlock(&isert_np->np_accept_mutex); 3291268e6811SSagi Grimberg 3292b8d26b3bSNicholas Bellinger np->np_context = NULL; 3293b8d26b3bSNicholas Bellinger kfree(isert_np); 3294b8d26b3bSNicholas Bellinger } 3295b8d26b3bSNicholas Bellinger 3296b02efbfcSSagi Grimberg static void isert_release_work(struct work_struct *work) 3297b02efbfcSSagi Grimberg { 3298b02efbfcSSagi Grimberg struct isert_conn *isert_conn = container_of(work, 3299b02efbfcSSagi Grimberg struct isert_conn, 3300b02efbfcSSagi Grimberg release_work); 3301b02efbfcSSagi Grimberg 3302b02efbfcSSagi Grimberg pr_info("Starting release conn %p\n", isert_conn); 3303b02efbfcSSagi Grimberg 3304b02efbfcSSagi Grimberg wait_for_completion(&isert_conn->conn_wait); 3305b02efbfcSSagi Grimberg 3306b02efbfcSSagi Grimberg mutex_lock(&isert_conn->conn_mutex); 3307b02efbfcSSagi Grimberg isert_conn->state = ISER_CONN_DOWN; 3308b02efbfcSSagi Grimberg mutex_unlock(&isert_conn->conn_mutex); 3309b02efbfcSSagi Grimberg 3310b02efbfcSSagi Grimberg pr_info("Destroying conn %p\n", isert_conn); 3311b02efbfcSSagi Grimberg isert_put_conn(isert_conn); 3312b02efbfcSSagi Grimberg } 3313b02efbfcSSagi Grimberg 3314defd8848SNicholas Bellinger static void isert_wait_conn(struct iscsi_conn *conn) 3315b8d26b3bSNicholas Bellinger { 3316b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = conn->context; 3317b8d26b3bSNicholas Bellinger 3318defd8848SNicholas Bellinger pr_debug("isert_wait_conn: Starting \n"); 3319b8d26b3bSNicholas Bellinger 33209d49f5e2SSagi Grimberg mutex_lock(&isert_conn->conn_mutex); 3321b8d26b3bSNicholas Bellinger /* 3322b8d26b3bSNicholas Bellinger * Only wait for conn_wait_comp_err if the isert_conn made it 3323b8d26b3bSNicholas Bellinger * into full feature phase.. 3324b8d26b3bSNicholas Bellinger */ 3325b2cb9649SNicholas Bellinger if (isert_conn->state == ISER_CONN_INIT) { 3326b2cb9649SNicholas Bellinger mutex_unlock(&isert_conn->conn_mutex); 3327b2cb9649SNicholas Bellinger return; 3328b2cb9649SNicholas Bellinger } 3329954f2372SSagi Grimberg isert_conn_terminate(isert_conn); 3330b2cb9649SNicholas Bellinger mutex_unlock(&isert_conn->conn_mutex); 3331b2cb9649SNicholas Bellinger 3332defd8848SNicholas Bellinger wait_for_completion(&isert_conn->conn_wait_comp_err); 3333954f2372SSagi Grimberg 3334b02efbfcSSagi Grimberg INIT_WORK(&isert_conn->release_work, isert_release_work); 3335b02efbfcSSagi Grimberg queue_work(isert_release_wq, &isert_conn->release_work); 3336defd8848SNicholas Bellinger } 3337defd8848SNicholas Bellinger 3338defd8848SNicholas Bellinger static void isert_free_conn(struct iscsi_conn *conn) 3339defd8848SNicholas Bellinger { 3340defd8848SNicholas Bellinger struct isert_conn *isert_conn = conn->context; 3341b8d26b3bSNicholas Bellinger 3342b8d26b3bSNicholas Bellinger isert_put_conn(isert_conn); 3343b8d26b3bSNicholas Bellinger } 3344b8d26b3bSNicholas Bellinger 3345b8d26b3bSNicholas Bellinger static struct iscsit_transport iser_target_transport = { 3346b8d26b3bSNicholas Bellinger .name = "IB/iSER", 3347b8d26b3bSNicholas Bellinger .transport_type = ISCSI_INFINIBAND, 3348d703ce2fSNicholas Bellinger .priv_size = sizeof(struct isert_cmd), 3349b8d26b3bSNicholas Bellinger .owner = THIS_MODULE, 3350b8d26b3bSNicholas Bellinger .iscsit_setup_np = isert_setup_np, 3351b8d26b3bSNicholas Bellinger .iscsit_accept_np = isert_accept_np, 3352b8d26b3bSNicholas Bellinger .iscsit_free_np = isert_free_np, 3353defd8848SNicholas Bellinger .iscsit_wait_conn = isert_wait_conn, 3354b8d26b3bSNicholas Bellinger .iscsit_free_conn = isert_free_conn, 3355b8d26b3bSNicholas Bellinger .iscsit_get_login_rx = isert_get_login_rx, 3356b8d26b3bSNicholas Bellinger .iscsit_put_login_tx = isert_put_login_tx, 3357b8d26b3bSNicholas Bellinger .iscsit_immediate_queue = isert_immediate_queue, 3358b8d26b3bSNicholas Bellinger .iscsit_response_queue = isert_response_queue, 3359b8d26b3bSNicholas Bellinger .iscsit_get_dataout = isert_get_dataout, 3360b8d26b3bSNicholas Bellinger .iscsit_queue_data_in = isert_put_datain, 3361b8d26b3bSNicholas Bellinger .iscsit_queue_status = isert_put_response, 3362131e6abcSNicholas Bellinger .iscsit_aborted_task = isert_aborted_task, 3363e70beee7SNicholas Bellinger .iscsit_get_sup_prot_ops = isert_get_sup_prot_ops, 3364b8d26b3bSNicholas Bellinger }; 3365b8d26b3bSNicholas Bellinger 3366b8d26b3bSNicholas Bellinger static int __init isert_init(void) 3367b8d26b3bSNicholas Bellinger { 3368b8d26b3bSNicholas Bellinger int ret; 3369b8d26b3bSNicholas Bellinger 3370b8d26b3bSNicholas Bellinger isert_rx_wq = alloc_workqueue("isert_rx_wq", 0, 0); 3371b8d26b3bSNicholas Bellinger if (!isert_rx_wq) { 3372b8d26b3bSNicholas Bellinger pr_err("Unable to allocate isert_rx_wq\n"); 3373b8d26b3bSNicholas Bellinger return -ENOMEM; 3374b8d26b3bSNicholas Bellinger } 3375b8d26b3bSNicholas Bellinger 3376b8d26b3bSNicholas Bellinger isert_comp_wq = alloc_workqueue("isert_comp_wq", 0, 0); 3377b8d26b3bSNicholas Bellinger if (!isert_comp_wq) { 3378b8d26b3bSNicholas Bellinger pr_err("Unable to allocate isert_comp_wq\n"); 3379b8d26b3bSNicholas Bellinger ret = -ENOMEM; 3380b8d26b3bSNicholas Bellinger goto destroy_rx_wq; 3381b8d26b3bSNicholas Bellinger } 3382b8d26b3bSNicholas Bellinger 3383b02efbfcSSagi Grimberg isert_release_wq = alloc_workqueue("isert_release_wq", WQ_UNBOUND, 3384b02efbfcSSagi Grimberg WQ_UNBOUND_MAX_ACTIVE); 3385b02efbfcSSagi Grimberg if (!isert_release_wq) { 3386b02efbfcSSagi Grimberg pr_err("Unable to allocate isert_release_wq\n"); 3387b02efbfcSSagi Grimberg ret = -ENOMEM; 3388b02efbfcSSagi Grimberg goto destroy_comp_wq; 3389b02efbfcSSagi Grimberg } 3390b02efbfcSSagi Grimberg 3391b8d26b3bSNicholas Bellinger iscsit_register_transport(&iser_target_transport); 3392b02efbfcSSagi Grimberg pr_info("iSER_TARGET[0] - Loaded iser_target_transport\n"); 3393b02efbfcSSagi Grimberg 3394b8d26b3bSNicholas Bellinger return 0; 3395b8d26b3bSNicholas Bellinger 3396b02efbfcSSagi Grimberg destroy_comp_wq: 3397b02efbfcSSagi Grimberg destroy_workqueue(isert_comp_wq); 3398b8d26b3bSNicholas Bellinger destroy_rx_wq: 3399b8d26b3bSNicholas Bellinger destroy_workqueue(isert_rx_wq); 3400b8d26b3bSNicholas Bellinger return ret; 3401b8d26b3bSNicholas Bellinger } 3402b8d26b3bSNicholas Bellinger 3403b8d26b3bSNicholas Bellinger static void __exit isert_exit(void) 3404b8d26b3bSNicholas Bellinger { 3405f5ebec96SSagi Grimberg flush_scheduled_work(); 3406b02efbfcSSagi Grimberg destroy_workqueue(isert_release_wq); 3407b8d26b3bSNicholas Bellinger destroy_workqueue(isert_comp_wq); 3408b8d26b3bSNicholas Bellinger destroy_workqueue(isert_rx_wq); 3409b8d26b3bSNicholas Bellinger iscsit_unregister_transport(&iser_target_transport); 3410b8d26b3bSNicholas Bellinger pr_debug("iSER_TARGET[0] - Released iser_target_transport\n"); 3411b8d26b3bSNicholas Bellinger } 3412b8d26b3bSNicholas Bellinger 3413b8d26b3bSNicholas Bellinger MODULE_DESCRIPTION("iSER-Target for mainline target infrastructure"); 3414b8d26b3bSNicholas Bellinger MODULE_VERSION("0.1"); 3415b8d26b3bSNicholas Bellinger MODULE_AUTHOR("nab@Linux-iSCSI.org"); 3416b8d26b3bSNicholas Bellinger MODULE_LICENSE("GPL"); 3417b8d26b3bSNicholas Bellinger 3418b8d26b3bSNicholas Bellinger module_init(isert_init); 3419b8d26b3bSNicholas Bellinger module_exit(isert_exit); 3420