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) 38bdf20e72SSagi Grimberg #define ISER_MAX_CQ_LEN (ISER_MAX_RX_CQ_LEN + ISER_MAX_TX_CQ_LEN + \ 39bdf20e72SSagi Grimberg ISERT_MAX_CONN) 40b8d26b3bSNicholas Bellinger 4145678b6bSSagi Grimberg static int isert_debug_level; 4224f412ddSSagi Grimberg module_param_named(debug_level, isert_debug_level, int, 0644); 4324f412ddSSagi Grimberg MODULE_PARM_DESC(debug_level, "Enable debug tracing if > 0 (default:0)"); 4424f412ddSSagi Grimberg 45b8d26b3bSNicholas Bellinger static DEFINE_MUTEX(device_list_mutex); 46b8d26b3bSNicholas Bellinger static LIST_HEAD(device_list); 47b8d26b3bSNicholas Bellinger static struct workqueue_struct *isert_comp_wq; 48b02efbfcSSagi Grimberg static struct workqueue_struct *isert_release_wq; 49b8d26b3bSNicholas Bellinger 50b8d26b3bSNicholas Bellinger static void 51d40945d8SVu Pham isert_unmap_cmd(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn); 52d40945d8SVu Pham static int 53d40945d8SVu Pham isert_map_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd, 54d40945d8SVu Pham struct isert_rdma_wr *wr); 5559464ef4SVu Pham static void 56a3a5a826SSagi Grimberg isert_unreg_rdma(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn); 5759464ef4SVu Pham static int 58a3a5a826SSagi Grimberg isert_reg_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd, 5959464ef4SVu Pham struct isert_rdma_wr *wr); 60f93f3a70SSagi Grimberg static int 61f93f3a70SSagi Grimberg isert_put_response(struct iscsi_conn *conn, struct iscsi_cmd *cmd); 622371e5daSSagi Grimberg static int 632371e5daSSagi Grimberg isert_rdma_post_recvl(struct isert_conn *isert_conn); 642371e5daSSagi Grimberg static int 652371e5daSSagi Grimberg isert_rdma_accept(struct isert_conn *isert_conn); 66ca6c1d82SSagi Grimberg struct rdma_cm_id *isert_setup_id(struct isert_np *isert_np); 67d40945d8SVu Pham 682f1b6b7dSSagi Grimberg static void isert_release_work(struct work_struct *work); 692f1b6b7dSSagi Grimberg 70302cc7c3SSagi Grimberg static inline bool 71302cc7c3SSagi Grimberg isert_prot_cmd(struct isert_conn *conn, struct se_cmd *cmd) 72302cc7c3SSagi Grimberg { 7323a548eeSSagi Grimberg return (conn->pi_support && 74302cc7c3SSagi Grimberg cmd->prot_op != TARGET_PROT_NORMAL); 75302cc7c3SSagi Grimberg } 76302cc7c3SSagi Grimberg 77302cc7c3SSagi Grimberg 78d40945d8SVu Pham static void 79b8d26b3bSNicholas Bellinger isert_qp_event_callback(struct ib_event *e, void *context) 80b8d26b3bSNicholas Bellinger { 816700425eSSagi Grimberg struct isert_conn *isert_conn = context; 82b8d26b3bSNicholas Bellinger 83ea8a1616SSagi Grimberg isert_err("%s (%d): conn %p\n", 84ea8a1616SSagi Grimberg ib_event_msg(e->event), e->event, isert_conn); 85ea8a1616SSagi Grimberg 86b8d26b3bSNicholas Bellinger switch (e->event) { 87b8d26b3bSNicholas Bellinger case IB_EVENT_COMM_EST: 88dac6ab30SSagi Grimberg rdma_notify(isert_conn->cm_id, IB_EVENT_COMM_EST); 89b8d26b3bSNicholas Bellinger break; 90b8d26b3bSNicholas Bellinger case IB_EVENT_QP_LAST_WQE_REACHED: 914c22e07fSSagi Grimberg isert_warn("Reached TX IB_EVENT_QP_LAST_WQE_REACHED\n"); 92b8d26b3bSNicholas Bellinger break; 93b8d26b3bSNicholas Bellinger default: 94b8d26b3bSNicholas Bellinger break; 95b8d26b3bSNicholas Bellinger } 96b8d26b3bSNicholas Bellinger } 97b8d26b3bSNicholas Bellinger 98b8d26b3bSNicholas Bellinger static int 99b8d26b3bSNicholas Bellinger isert_query_device(struct ib_device *ib_dev, struct ib_device_attr *devattr) 100b8d26b3bSNicholas Bellinger { 101b8d26b3bSNicholas Bellinger int ret; 102b8d26b3bSNicholas Bellinger 103b8d26b3bSNicholas Bellinger ret = ib_query_device(ib_dev, devattr); 104b8d26b3bSNicholas Bellinger if (ret) { 10524f412ddSSagi Grimberg isert_err("ib_query_device() failed: %d\n", ret); 106b8d26b3bSNicholas Bellinger return ret; 107b8d26b3bSNicholas Bellinger } 10824f412ddSSagi Grimberg isert_dbg("devattr->max_sge: %d\n", devattr->max_sge); 10924f412ddSSagi Grimberg isert_dbg("devattr->max_sge_rd: %d\n", devattr->max_sge_rd); 110b8d26b3bSNicholas Bellinger 111b8d26b3bSNicholas Bellinger return 0; 112b8d26b3bSNicholas Bellinger } 113b8d26b3bSNicholas Bellinger 11440fc069aSSagi Grimberg static struct isert_comp * 11540fc069aSSagi Grimberg isert_comp_get(struct isert_conn *isert_conn) 116b8d26b3bSNicholas Bellinger { 117dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 1184a295baeSSagi Grimberg struct isert_comp *comp; 11940fc069aSSagi Grimberg int i, min = 0; 120b8d26b3bSNicholas Bellinger 121b8d26b3bSNicholas Bellinger mutex_lock(&device_list_mutex); 1224a295baeSSagi Grimberg for (i = 0; i < device->comps_used; i++) 1234a295baeSSagi Grimberg if (device->comps[i].active_qps < 1244a295baeSSagi Grimberg device->comps[min].active_qps) 1254a295baeSSagi Grimberg min = i; 1264a295baeSSagi Grimberg comp = &device->comps[min]; 1274a295baeSSagi Grimberg comp->active_qps++; 12840fc069aSSagi Grimberg mutex_unlock(&device_list_mutex); 12940fc069aSSagi Grimberg 13024f412ddSSagi Grimberg isert_info("conn %p, using comp %p min_index: %d\n", 1314a295baeSSagi Grimberg isert_conn, comp, min); 13240fc069aSSagi Grimberg 13340fc069aSSagi Grimberg return comp; 13440fc069aSSagi Grimberg } 13540fc069aSSagi Grimberg 13640fc069aSSagi Grimberg static void 13740fc069aSSagi Grimberg isert_comp_put(struct isert_comp *comp) 13840fc069aSSagi Grimberg { 13940fc069aSSagi Grimberg mutex_lock(&device_list_mutex); 14040fc069aSSagi Grimberg comp->active_qps--; 141b8d26b3bSNicholas Bellinger mutex_unlock(&device_list_mutex); 14240fc069aSSagi Grimberg } 14340fc069aSSagi Grimberg 14440fc069aSSagi Grimberg static struct ib_qp * 14540fc069aSSagi Grimberg isert_create_qp(struct isert_conn *isert_conn, 14640fc069aSSagi Grimberg struct isert_comp *comp, 14740fc069aSSagi Grimberg struct rdma_cm_id *cma_id) 14840fc069aSSagi Grimberg { 149dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 15040fc069aSSagi Grimberg struct ib_qp_init_attr attr; 15140fc069aSSagi Grimberg int ret; 152b8d26b3bSNicholas Bellinger 153b8d26b3bSNicholas Bellinger memset(&attr, 0, sizeof(struct ib_qp_init_attr)); 154b8d26b3bSNicholas Bellinger attr.event_handler = isert_qp_event_callback; 155b8d26b3bSNicholas Bellinger attr.qp_context = isert_conn; 1566f0fae3dSSagi Grimberg attr.send_cq = comp->cq; 1576f0fae3dSSagi Grimberg attr.recv_cq = comp->cq; 158b8d26b3bSNicholas Bellinger attr.cap.max_send_wr = ISERT_QP_MAX_REQ_DTOS; 159bdf20e72SSagi Grimberg attr.cap.max_recv_wr = ISERT_QP_MAX_RECV_DTOS + 1; 160b8d26b3bSNicholas Bellinger /* 161b8d26b3bSNicholas Bellinger * FIXME: Use devattr.max_sge - 2 for max_send_sge as 162f57915cfSOr Gerlitz * work-around for RDMA_READs with ConnectX-2. 163f57915cfSOr Gerlitz * 164f57915cfSOr Gerlitz * Also, still make sure to have at least two SGEs for 165f57915cfSOr Gerlitz * outgoing control PDU responses. 166b8d26b3bSNicholas Bellinger */ 167f57915cfSOr Gerlitz attr.cap.max_send_sge = max(2, device->dev_attr.max_sge - 2); 168b8d26b3bSNicholas Bellinger isert_conn->max_sge = attr.cap.max_send_sge; 169b8d26b3bSNicholas Bellinger 170b8d26b3bSNicholas Bellinger attr.cap.max_recv_sge = 1; 171b8d26b3bSNicholas Bellinger attr.sq_sig_type = IB_SIGNAL_REQ_WR; 172b8d26b3bSNicholas Bellinger attr.qp_type = IB_QPT_RC; 173570db170SSagi Grimberg if (device->pi_capable) 174d3e125daSSagi Grimberg attr.create_flags |= IB_QP_CREATE_SIGNATURE_EN; 175b8d26b3bSNicholas Bellinger 17667cb3949SSagi Grimberg ret = rdma_create_qp(cma_id, device->pd, &attr); 177b8d26b3bSNicholas Bellinger if (ret) { 17824f412ddSSagi Grimberg isert_err("rdma_create_qp failed for cma_id %d\n", ret); 17940fc069aSSagi Grimberg return ERR_PTR(ret); 18040fc069aSSagi Grimberg } 18140fc069aSSagi Grimberg 18240fc069aSSagi Grimberg return cma_id->qp; 18340fc069aSSagi Grimberg } 18440fc069aSSagi Grimberg 18540fc069aSSagi Grimberg static int 18640fc069aSSagi Grimberg isert_conn_setup_qp(struct isert_conn *isert_conn, struct rdma_cm_id *cma_id) 18740fc069aSSagi Grimberg { 18840fc069aSSagi Grimberg struct isert_comp *comp; 18940fc069aSSagi Grimberg int ret; 19040fc069aSSagi Grimberg 19140fc069aSSagi Grimberg comp = isert_comp_get(isert_conn); 192dac6ab30SSagi Grimberg isert_conn->qp = isert_create_qp(isert_conn, comp, cma_id); 193dac6ab30SSagi Grimberg if (IS_ERR(isert_conn->qp)) { 194dac6ab30SSagi Grimberg ret = PTR_ERR(isert_conn->qp); 19519e2090fSSagi Grimberg goto err; 196b8d26b3bSNicholas Bellinger } 197b8d26b3bSNicholas Bellinger 198b8d26b3bSNicholas Bellinger return 0; 19919e2090fSSagi Grimberg err: 20040fc069aSSagi Grimberg isert_comp_put(comp); 20119e2090fSSagi Grimberg return ret; 202b8d26b3bSNicholas Bellinger } 203b8d26b3bSNicholas Bellinger 204b8d26b3bSNicholas Bellinger static void 205b8d26b3bSNicholas Bellinger isert_cq_event_callback(struct ib_event *e, void *context) 206b8d26b3bSNicholas Bellinger { 2074c22e07fSSagi Grimberg isert_dbg("event: %d\n", e->event); 208b8d26b3bSNicholas Bellinger } 209b8d26b3bSNicholas Bellinger 210b8d26b3bSNicholas Bellinger static int 211b8d26b3bSNicholas Bellinger isert_alloc_rx_descriptors(struct isert_conn *isert_conn) 212b8d26b3bSNicholas Bellinger { 213dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 21467cb3949SSagi Grimberg struct ib_device *ib_dev = device->ib_device; 215b8d26b3bSNicholas Bellinger struct iser_rx_desc *rx_desc; 216b8d26b3bSNicholas Bellinger struct ib_sge *rx_sg; 217b8d26b3bSNicholas Bellinger u64 dma_addr; 218b8d26b3bSNicholas Bellinger int i, j; 219b8d26b3bSNicholas Bellinger 220dac6ab30SSagi Grimberg isert_conn->rx_descs = kzalloc(ISERT_QP_MAX_RECV_DTOS * 221b8d26b3bSNicholas Bellinger sizeof(struct iser_rx_desc), GFP_KERNEL); 222dac6ab30SSagi Grimberg if (!isert_conn->rx_descs) 223b8d26b3bSNicholas Bellinger goto fail; 224b8d26b3bSNicholas Bellinger 225dac6ab30SSagi Grimberg rx_desc = isert_conn->rx_descs; 226b8d26b3bSNicholas Bellinger 227b8d26b3bSNicholas Bellinger for (i = 0; i < ISERT_QP_MAX_RECV_DTOS; i++, rx_desc++) { 228b8d26b3bSNicholas Bellinger dma_addr = ib_dma_map_single(ib_dev, (void *)rx_desc, 229b8d26b3bSNicholas Bellinger ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE); 230b8d26b3bSNicholas Bellinger if (ib_dma_mapping_error(ib_dev, dma_addr)) 231b8d26b3bSNicholas Bellinger goto dma_map_fail; 232b8d26b3bSNicholas Bellinger 233b8d26b3bSNicholas Bellinger rx_desc->dma_addr = dma_addr; 234b8d26b3bSNicholas Bellinger 235b8d26b3bSNicholas Bellinger rx_sg = &rx_desc->rx_sg; 236b8d26b3bSNicholas Bellinger rx_sg->addr = rx_desc->dma_addr; 237b8d26b3bSNicholas Bellinger rx_sg->length = ISER_RX_PAYLOAD_SIZE; 23834efc7dfSJason Gunthorpe rx_sg->lkey = device->pd->local_dma_lkey; 239b8d26b3bSNicholas Bellinger } 240b8d26b3bSNicholas Bellinger 241dac6ab30SSagi Grimberg isert_conn->rx_desc_head = 0; 2424c22e07fSSagi Grimberg 243b8d26b3bSNicholas Bellinger return 0; 244b8d26b3bSNicholas Bellinger 245b8d26b3bSNicholas Bellinger dma_map_fail: 246dac6ab30SSagi Grimberg rx_desc = isert_conn->rx_descs; 247b8d26b3bSNicholas Bellinger for (j = 0; j < i; j++, rx_desc++) { 248b8d26b3bSNicholas Bellinger ib_dma_unmap_single(ib_dev, rx_desc->dma_addr, 249b8d26b3bSNicholas Bellinger ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE); 250b8d26b3bSNicholas Bellinger } 251dac6ab30SSagi Grimberg kfree(isert_conn->rx_descs); 252dac6ab30SSagi Grimberg isert_conn->rx_descs = NULL; 253b8d26b3bSNicholas Bellinger fail: 2544c22e07fSSagi Grimberg isert_err("conn %p failed to allocate rx descriptors\n", isert_conn); 2554c22e07fSSagi Grimberg 256b8d26b3bSNicholas Bellinger return -ENOMEM; 257b8d26b3bSNicholas Bellinger } 258b8d26b3bSNicholas Bellinger 259b8d26b3bSNicholas Bellinger static void 260b8d26b3bSNicholas Bellinger isert_free_rx_descriptors(struct isert_conn *isert_conn) 261b8d26b3bSNicholas Bellinger { 262dac6ab30SSagi Grimberg struct ib_device *ib_dev = isert_conn->device->ib_device; 263b8d26b3bSNicholas Bellinger struct iser_rx_desc *rx_desc; 264b8d26b3bSNicholas Bellinger int i; 265b8d26b3bSNicholas Bellinger 266dac6ab30SSagi Grimberg if (!isert_conn->rx_descs) 267b8d26b3bSNicholas Bellinger return; 268b8d26b3bSNicholas Bellinger 269dac6ab30SSagi Grimberg rx_desc = isert_conn->rx_descs; 270b8d26b3bSNicholas Bellinger for (i = 0; i < ISERT_QP_MAX_RECV_DTOS; i++, rx_desc++) { 271b8d26b3bSNicholas Bellinger ib_dma_unmap_single(ib_dev, rx_desc->dma_addr, 272b8d26b3bSNicholas Bellinger ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE); 273b8d26b3bSNicholas Bellinger } 274b8d26b3bSNicholas Bellinger 275dac6ab30SSagi Grimberg kfree(isert_conn->rx_descs); 276dac6ab30SSagi Grimberg isert_conn->rx_descs = NULL; 277b8d26b3bSNicholas Bellinger } 278b8d26b3bSNicholas Bellinger 2796f0fae3dSSagi Grimberg static void isert_cq_work(struct work_struct *); 2806f0fae3dSSagi Grimberg static void isert_cq_callback(struct ib_cq *, void *); 281b8d26b3bSNicholas Bellinger 282172369c5SSagi Grimberg static void 283172369c5SSagi Grimberg isert_free_comps(struct isert_device *device) 284b8d26b3bSNicholas Bellinger { 285172369c5SSagi Grimberg int i; 286b8d26b3bSNicholas Bellinger 287172369c5SSagi Grimberg for (i = 0; i < device->comps_used; i++) { 288172369c5SSagi Grimberg struct isert_comp *comp = &device->comps[i]; 28959464ef4SVu Pham 290172369c5SSagi Grimberg if (comp->cq) { 291172369c5SSagi Grimberg cancel_work_sync(&comp->work); 292172369c5SSagi Grimberg ib_destroy_cq(comp->cq); 293172369c5SSagi Grimberg } 294172369c5SSagi Grimberg } 295172369c5SSagi Grimberg kfree(device->comps); 29659464ef4SVu Pham } 297d40945d8SVu Pham 298172369c5SSagi Grimberg static int 299172369c5SSagi Grimberg isert_alloc_comps(struct isert_device *device, 300172369c5SSagi Grimberg struct ib_device_attr *attr) 301172369c5SSagi Grimberg { 302172369c5SSagi Grimberg int i, max_cqe, ret = 0; 303d3e125daSSagi Grimberg 3044a295baeSSagi Grimberg device->comps_used = min(ISERT_MAX_CQ, min_t(int, num_online_cpus(), 3054a295baeSSagi Grimberg device->ib_device->num_comp_vectors)); 306172369c5SSagi Grimberg 30724f412ddSSagi Grimberg isert_info("Using %d CQs, %s supports %d vectors support " 308d3e125daSSagi Grimberg "Fast registration %d pi_capable %d\n", 3094a295baeSSagi Grimberg device->comps_used, device->ib_device->name, 310d3e125daSSagi Grimberg device->ib_device->num_comp_vectors, device->use_fastreg, 311d3e125daSSagi Grimberg device->pi_capable); 3124a295baeSSagi Grimberg 3134a295baeSSagi Grimberg device->comps = kcalloc(device->comps_used, sizeof(struct isert_comp), 3144a295baeSSagi Grimberg GFP_KERNEL); 3154a295baeSSagi Grimberg if (!device->comps) { 31624f412ddSSagi Grimberg isert_err("Unable to allocate completion contexts\n"); 317b8d26b3bSNicholas Bellinger return -ENOMEM; 318b8d26b3bSNicholas Bellinger } 319b8d26b3bSNicholas Bellinger 320172369c5SSagi Grimberg max_cqe = min(ISER_MAX_CQ_LEN, attr->max_cqe); 321172369c5SSagi Grimberg 3224a295baeSSagi Grimberg for (i = 0; i < device->comps_used; i++) { 3238e37210bSMatan Barak struct ib_cq_init_attr cq_attr = {}; 3244a295baeSSagi Grimberg struct isert_comp *comp = &device->comps[i]; 325b8d26b3bSNicholas Bellinger 3264a295baeSSagi Grimberg comp->device = device; 3276f0fae3dSSagi Grimberg INIT_WORK(&comp->work, isert_cq_work); 3288e37210bSMatan Barak cq_attr.cqe = max_cqe; 3298e37210bSMatan Barak cq_attr.comp_vector = i; 3306f0fae3dSSagi Grimberg comp->cq = ib_create_cq(device->ib_device, 3316f0fae3dSSagi Grimberg isert_cq_callback, 332b8d26b3bSNicholas Bellinger isert_cq_event_callback, 3334a295baeSSagi Grimberg (void *)comp, 3348e37210bSMatan Barak &cq_attr); 3356f0fae3dSSagi Grimberg if (IS_ERR(comp->cq)) { 336172369c5SSagi Grimberg isert_err("Unable to allocate cq\n"); 3376f0fae3dSSagi Grimberg ret = PTR_ERR(comp->cq); 3386f0fae3dSSagi Grimberg comp->cq = NULL; 339b8d26b3bSNicholas Bellinger goto out_cq; 34094a71110SWei Yongjun } 341b8d26b3bSNicholas Bellinger 3426f0fae3dSSagi Grimberg ret = ib_req_notify_cq(comp->cq, IB_CQ_NEXT_COMP); 34394a71110SWei Yongjun if (ret) 344b8d26b3bSNicholas Bellinger goto out_cq; 345b8d26b3bSNicholas Bellinger } 346b8d26b3bSNicholas Bellinger 347172369c5SSagi Grimberg return 0; 348172369c5SSagi Grimberg out_cq: 349172369c5SSagi Grimberg isert_free_comps(device); 350172369c5SSagi Grimberg return ret; 351172369c5SSagi Grimberg } 352172369c5SSagi Grimberg 353172369c5SSagi Grimberg static int 354172369c5SSagi Grimberg isert_create_device_ib_res(struct isert_device *device) 355172369c5SSagi Grimberg { 356172369c5SSagi Grimberg struct ib_device_attr *dev_attr; 357fd8205e8SSagi Grimberg int ret; 358172369c5SSagi Grimberg 359172369c5SSagi Grimberg dev_attr = &device->dev_attr; 360fd8205e8SSagi Grimberg ret = isert_query_device(device->ib_device, dev_attr); 361172369c5SSagi Grimberg if (ret) 362172369c5SSagi Grimberg return ret; 363172369c5SSagi Grimberg 364172369c5SSagi Grimberg /* asign function handlers */ 365172369c5SSagi Grimberg if (dev_attr->device_cap_flags & IB_DEVICE_MEM_MGT_EXTENSIONS && 366172369c5SSagi Grimberg dev_attr->device_cap_flags & IB_DEVICE_SIGNATURE_HANDOVER) { 367172369c5SSagi Grimberg device->use_fastreg = 1; 368172369c5SSagi Grimberg device->reg_rdma_mem = isert_reg_rdma; 369172369c5SSagi Grimberg device->unreg_rdma_mem = isert_unreg_rdma; 370172369c5SSagi Grimberg } else { 371172369c5SSagi Grimberg device->use_fastreg = 0; 372172369c5SSagi Grimberg device->reg_rdma_mem = isert_map_rdma; 373172369c5SSagi Grimberg device->unreg_rdma_mem = isert_unmap_cmd; 374172369c5SSagi Grimberg } 375172369c5SSagi Grimberg 376172369c5SSagi Grimberg ret = isert_alloc_comps(device, dev_attr); 377172369c5SSagi Grimberg if (ret) 378172369c5SSagi Grimberg return ret; 379172369c5SSagi Grimberg 38067cb3949SSagi Grimberg device->pd = ib_alloc_pd(device->ib_device); 38167cb3949SSagi Grimberg if (IS_ERR(device->pd)) { 38267cb3949SSagi Grimberg ret = PTR_ERR(device->pd); 38367cb3949SSagi Grimberg isert_err("failed to allocate pd, device %p, ret=%d\n", 38467cb3949SSagi Grimberg device, ret); 38567cb3949SSagi Grimberg goto out_cq; 38667cb3949SSagi Grimberg } 38767cb3949SSagi Grimberg 388172369c5SSagi Grimberg /* Check signature cap */ 389172369c5SSagi Grimberg device->pi_capable = dev_attr->device_cap_flags & 390172369c5SSagi Grimberg IB_DEVICE_SIGNATURE_HANDOVER ? true : false; 39167cb3949SSagi Grimberg 392b8d26b3bSNicholas Bellinger return 0; 393b8d26b3bSNicholas Bellinger 394b8d26b3bSNicholas Bellinger out_cq: 395172369c5SSagi Grimberg isert_free_comps(device); 396b8d26b3bSNicholas Bellinger return ret; 397b8d26b3bSNicholas Bellinger } 398b8d26b3bSNicholas Bellinger 399b8d26b3bSNicholas Bellinger static void 400b8d26b3bSNicholas Bellinger isert_free_device_ib_res(struct isert_device *device) 401b8d26b3bSNicholas Bellinger { 40224f412ddSSagi Grimberg isert_info("device %p\n", device); 403b8d26b3bSNicholas Bellinger 40467cb3949SSagi Grimberg ib_dealloc_pd(device->pd); 405172369c5SSagi Grimberg isert_free_comps(device); 406b8d26b3bSNicholas Bellinger } 407b8d26b3bSNicholas Bellinger 408b8d26b3bSNicholas Bellinger static void 409cf8ae958SSagi Grimberg isert_device_put(struct isert_device *device) 410b8d26b3bSNicholas Bellinger { 411b8d26b3bSNicholas Bellinger mutex_lock(&device_list_mutex); 412b8d26b3bSNicholas Bellinger device->refcount--; 4134c22e07fSSagi Grimberg isert_info("device %p refcount %d\n", device, device->refcount); 414b8d26b3bSNicholas Bellinger if (!device->refcount) { 415b8d26b3bSNicholas Bellinger isert_free_device_ib_res(device); 416b8d26b3bSNicholas Bellinger list_del(&device->dev_node); 417b8d26b3bSNicholas Bellinger kfree(device); 418b8d26b3bSNicholas Bellinger } 419b8d26b3bSNicholas Bellinger mutex_unlock(&device_list_mutex); 420b8d26b3bSNicholas Bellinger } 421b8d26b3bSNicholas Bellinger 422b8d26b3bSNicholas Bellinger static struct isert_device * 423cf8ae958SSagi Grimberg isert_device_get(struct rdma_cm_id *cma_id) 424b8d26b3bSNicholas Bellinger { 425b8d26b3bSNicholas Bellinger struct isert_device *device; 426b8d26b3bSNicholas Bellinger int ret; 427b8d26b3bSNicholas Bellinger 428b8d26b3bSNicholas Bellinger mutex_lock(&device_list_mutex); 429b8d26b3bSNicholas Bellinger list_for_each_entry(device, &device_list, dev_node) { 430b8d26b3bSNicholas Bellinger if (device->ib_device->node_guid == cma_id->device->node_guid) { 431b8d26b3bSNicholas Bellinger device->refcount++; 4324c22e07fSSagi Grimberg isert_info("Found iser device %p refcount %d\n", 4334c22e07fSSagi Grimberg device, device->refcount); 434b8d26b3bSNicholas Bellinger mutex_unlock(&device_list_mutex); 435b8d26b3bSNicholas Bellinger return device; 436b8d26b3bSNicholas Bellinger } 437b8d26b3bSNicholas Bellinger } 438b8d26b3bSNicholas Bellinger 439b8d26b3bSNicholas Bellinger device = kzalloc(sizeof(struct isert_device), GFP_KERNEL); 440b8d26b3bSNicholas Bellinger if (!device) { 441b8d26b3bSNicholas Bellinger mutex_unlock(&device_list_mutex); 442b8d26b3bSNicholas Bellinger return ERR_PTR(-ENOMEM); 443b8d26b3bSNicholas Bellinger } 444b8d26b3bSNicholas Bellinger 445b8d26b3bSNicholas Bellinger INIT_LIST_HEAD(&device->dev_node); 446b8d26b3bSNicholas Bellinger 447b8d26b3bSNicholas Bellinger device->ib_device = cma_id->device; 448b8d26b3bSNicholas Bellinger ret = isert_create_device_ib_res(device); 449b8d26b3bSNicholas Bellinger if (ret) { 450b8d26b3bSNicholas Bellinger kfree(device); 451b8d26b3bSNicholas Bellinger mutex_unlock(&device_list_mutex); 452b8d26b3bSNicholas Bellinger return ERR_PTR(ret); 453b8d26b3bSNicholas Bellinger } 454b8d26b3bSNicholas Bellinger 455b8d26b3bSNicholas Bellinger device->refcount++; 456b8d26b3bSNicholas Bellinger list_add_tail(&device->dev_node, &device_list); 4574c22e07fSSagi Grimberg isert_info("Created a new iser device %p refcount %d\n", 4584c22e07fSSagi Grimberg device, device->refcount); 459b8d26b3bSNicholas Bellinger mutex_unlock(&device_list_mutex); 460b8d26b3bSNicholas Bellinger 461b8d26b3bSNicholas Bellinger return device; 462b8d26b3bSNicholas Bellinger } 463b8d26b3bSNicholas Bellinger 46459464ef4SVu Pham static void 465a3a5a826SSagi Grimberg isert_conn_free_fastreg_pool(struct isert_conn *isert_conn) 46659464ef4SVu Pham { 46759464ef4SVu Pham struct fast_reg_descriptor *fr_desc, *tmp; 46859464ef4SVu Pham int i = 0; 46959464ef4SVu Pham 470dac6ab30SSagi Grimberg if (list_empty(&isert_conn->fr_pool)) 47159464ef4SVu Pham return; 47259464ef4SVu Pham 4734c22e07fSSagi Grimberg isert_info("Freeing conn %p fastreg pool", isert_conn); 47459464ef4SVu Pham 47559464ef4SVu Pham list_for_each_entry_safe(fr_desc, tmp, 476dac6ab30SSagi Grimberg &isert_conn->fr_pool, list) { 47759464ef4SVu Pham list_del(&fr_desc->list); 47859464ef4SVu Pham ib_free_fast_reg_page_list(fr_desc->data_frpl); 47959464ef4SVu Pham ib_dereg_mr(fr_desc->data_mr); 480d3e125daSSagi Grimberg if (fr_desc->pi_ctx) { 481d3e125daSSagi Grimberg ib_free_fast_reg_page_list(fr_desc->pi_ctx->prot_frpl); 482d3e125daSSagi Grimberg ib_dereg_mr(fr_desc->pi_ctx->prot_mr); 4838b91ffc1SSagi Grimberg ib_dereg_mr(fr_desc->pi_ctx->sig_mr); 484d3e125daSSagi Grimberg kfree(fr_desc->pi_ctx); 485d3e125daSSagi Grimberg } 48659464ef4SVu Pham kfree(fr_desc); 48759464ef4SVu Pham ++i; 48859464ef4SVu Pham } 48959464ef4SVu Pham 490dac6ab30SSagi Grimberg if (i < isert_conn->fr_pool_size) 49124f412ddSSagi Grimberg isert_warn("Pool still has %d regions registered\n", 492dac6ab30SSagi Grimberg isert_conn->fr_pool_size - i); 49359464ef4SVu Pham } 49459464ef4SVu Pham 49559464ef4SVu Pham static int 496570db170SSagi Grimberg isert_create_pi_ctx(struct fast_reg_descriptor *desc, 497570db170SSagi Grimberg struct ib_device *device, 498570db170SSagi Grimberg struct ib_pd *pd) 499570db170SSagi Grimberg { 500570db170SSagi Grimberg struct pi_context *pi_ctx; 501570db170SSagi Grimberg int ret; 502570db170SSagi Grimberg 503570db170SSagi Grimberg pi_ctx = kzalloc(sizeof(*desc->pi_ctx), GFP_KERNEL); 504570db170SSagi Grimberg if (!pi_ctx) { 50524f412ddSSagi Grimberg isert_err("Failed to allocate pi context\n"); 506570db170SSagi Grimberg return -ENOMEM; 507570db170SSagi Grimberg } 508570db170SSagi Grimberg 509570db170SSagi Grimberg pi_ctx->prot_frpl = ib_alloc_fast_reg_page_list(device, 510570db170SSagi Grimberg ISCSI_ISER_SG_TABLESIZE); 511570db170SSagi Grimberg if (IS_ERR(pi_ctx->prot_frpl)) { 51224f412ddSSagi Grimberg isert_err("Failed to allocate prot frpl err=%ld\n", 513570db170SSagi Grimberg PTR_ERR(pi_ctx->prot_frpl)); 514570db170SSagi Grimberg ret = PTR_ERR(pi_ctx->prot_frpl); 515570db170SSagi Grimberg goto err_pi_ctx; 516570db170SSagi Grimberg } 517570db170SSagi Grimberg 518a89be2ccSSagi Grimberg pi_ctx->prot_mr = ib_alloc_mr(pd, IB_MR_TYPE_MEM_REG, 519a89be2ccSSagi Grimberg ISCSI_ISER_SG_TABLESIZE); 520570db170SSagi Grimberg if (IS_ERR(pi_ctx->prot_mr)) { 52124f412ddSSagi Grimberg isert_err("Failed to allocate prot frmr err=%ld\n", 522570db170SSagi Grimberg PTR_ERR(pi_ctx->prot_mr)); 523570db170SSagi Grimberg ret = PTR_ERR(pi_ctx->prot_mr); 524570db170SSagi Grimberg goto err_prot_frpl; 525570db170SSagi Grimberg } 526570db170SSagi Grimberg desc->ind |= ISERT_PROT_KEY_VALID; 527570db170SSagi Grimberg 5289bee178bSSagi Grimberg pi_ctx->sig_mr = ib_alloc_mr(pd, IB_MR_TYPE_SIGNATURE, 2); 529570db170SSagi Grimberg if (IS_ERR(pi_ctx->sig_mr)) { 53024f412ddSSagi Grimberg isert_err("Failed to allocate signature enabled mr err=%ld\n", 531570db170SSagi Grimberg PTR_ERR(pi_ctx->sig_mr)); 532570db170SSagi Grimberg ret = PTR_ERR(pi_ctx->sig_mr); 533570db170SSagi Grimberg goto err_prot_mr; 534570db170SSagi Grimberg } 535570db170SSagi Grimberg 536570db170SSagi Grimberg desc->pi_ctx = pi_ctx; 537570db170SSagi Grimberg desc->ind |= ISERT_SIG_KEY_VALID; 538570db170SSagi Grimberg desc->ind &= ~ISERT_PROTECTED; 539570db170SSagi Grimberg 540570db170SSagi Grimberg return 0; 541570db170SSagi Grimberg 542570db170SSagi Grimberg err_prot_mr: 543b2feda4fSRoland Dreier ib_dereg_mr(pi_ctx->prot_mr); 544570db170SSagi Grimberg err_prot_frpl: 545b2feda4fSRoland Dreier ib_free_fast_reg_page_list(pi_ctx->prot_frpl); 546570db170SSagi Grimberg err_pi_ctx: 547b2feda4fSRoland Dreier kfree(pi_ctx); 548570db170SSagi Grimberg 549570db170SSagi Grimberg return ret; 550570db170SSagi Grimberg } 551570db170SSagi Grimberg 552570db170SSagi Grimberg static int 553dc87a90fSSagi Grimberg isert_create_fr_desc(struct ib_device *ib_device, struct ib_pd *pd, 554570db170SSagi Grimberg struct fast_reg_descriptor *fr_desc) 555dc87a90fSSagi Grimberg { 556d3e125daSSagi Grimberg int ret; 557d3e125daSSagi Grimberg 558dc87a90fSSagi Grimberg fr_desc->data_frpl = ib_alloc_fast_reg_page_list(ib_device, 559dc87a90fSSagi Grimberg ISCSI_ISER_SG_TABLESIZE); 560dc87a90fSSagi Grimberg if (IS_ERR(fr_desc->data_frpl)) { 56124f412ddSSagi Grimberg isert_err("Failed to allocate data frpl err=%ld\n", 562dc87a90fSSagi Grimberg PTR_ERR(fr_desc->data_frpl)); 563dc87a90fSSagi Grimberg return PTR_ERR(fr_desc->data_frpl); 564dc87a90fSSagi Grimberg } 565dc87a90fSSagi Grimberg 566a89be2ccSSagi Grimberg fr_desc->data_mr = ib_alloc_mr(pd, IB_MR_TYPE_MEM_REG, 567a89be2ccSSagi Grimberg ISCSI_ISER_SG_TABLESIZE); 568dc87a90fSSagi Grimberg if (IS_ERR(fr_desc->data_mr)) { 56924f412ddSSagi Grimberg isert_err("Failed to allocate data frmr err=%ld\n", 570dc87a90fSSagi Grimberg PTR_ERR(fr_desc->data_mr)); 571d3e125daSSagi Grimberg ret = PTR_ERR(fr_desc->data_mr); 572d3e125daSSagi Grimberg goto err_data_frpl; 573dc87a90fSSagi Grimberg } 574d3e125daSSagi Grimberg fr_desc->ind |= ISERT_DATA_KEY_VALID; 575dc87a90fSSagi Grimberg 57624f412ddSSagi Grimberg isert_dbg("Created fr_desc %p\n", fr_desc); 577dc87a90fSSagi Grimberg 578dc87a90fSSagi Grimberg return 0; 579570db170SSagi Grimberg 580d3e125daSSagi Grimberg err_data_frpl: 581d3e125daSSagi Grimberg ib_free_fast_reg_page_list(fr_desc->data_frpl); 582d3e125daSSagi Grimberg 583d3e125daSSagi Grimberg return ret; 584dc87a90fSSagi Grimberg } 585dc87a90fSSagi Grimberg 586dc87a90fSSagi Grimberg static int 587570db170SSagi Grimberg isert_conn_create_fastreg_pool(struct isert_conn *isert_conn) 58859464ef4SVu Pham { 58959464ef4SVu Pham struct fast_reg_descriptor *fr_desc; 590dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 591f46d6a8aSNicholas Bellinger struct se_session *se_sess = isert_conn->conn->sess->se_sess; 592f46d6a8aSNicholas Bellinger struct se_node_acl *se_nacl = se_sess->se_node_acl; 593f46d6a8aSNicholas Bellinger int i, ret, tag_num; 594f46d6a8aSNicholas Bellinger /* 595f46d6a8aSNicholas Bellinger * Setup the number of FRMRs based upon the number of tags 596f46d6a8aSNicholas Bellinger * available to session in iscsi_target_locate_portal(). 597f46d6a8aSNicholas Bellinger */ 598f46d6a8aSNicholas Bellinger tag_num = max_t(u32, ISCSIT_MIN_TAGS, se_nacl->queue_depth); 599f46d6a8aSNicholas Bellinger tag_num = (tag_num * 2) + ISCSIT_EXTRA_TAGS; 60059464ef4SVu Pham 601dac6ab30SSagi Grimberg isert_conn->fr_pool_size = 0; 602f46d6a8aSNicholas Bellinger for (i = 0; i < tag_num; i++) { 60359464ef4SVu Pham fr_desc = kzalloc(sizeof(*fr_desc), GFP_KERNEL); 60459464ef4SVu Pham if (!fr_desc) { 60524f412ddSSagi Grimberg isert_err("Failed to allocate fast_reg descriptor\n"); 60659464ef4SVu Pham ret = -ENOMEM; 60759464ef4SVu Pham goto err; 60859464ef4SVu Pham } 60959464ef4SVu Pham 610dc87a90fSSagi Grimberg ret = isert_create_fr_desc(device->ib_device, 61167cb3949SSagi Grimberg device->pd, fr_desc); 612dc87a90fSSagi Grimberg if (ret) { 61324f412ddSSagi Grimberg isert_err("Failed to create fastreg descriptor err=%d\n", 614dc87a90fSSagi Grimberg ret); 615a80e21b3SNicholas Bellinger kfree(fr_desc); 61659464ef4SVu Pham goto err; 61759464ef4SVu Pham } 61859464ef4SVu Pham 619dac6ab30SSagi Grimberg list_add_tail(&fr_desc->list, &isert_conn->fr_pool); 620dac6ab30SSagi Grimberg isert_conn->fr_pool_size++; 62159464ef4SVu Pham } 62259464ef4SVu Pham 62324f412ddSSagi Grimberg isert_dbg("Creating conn %p fastreg pool size=%d", 624dac6ab30SSagi Grimberg isert_conn, isert_conn->fr_pool_size); 62559464ef4SVu Pham 62659464ef4SVu Pham return 0; 62759464ef4SVu Pham 62859464ef4SVu Pham err: 629a3a5a826SSagi Grimberg isert_conn_free_fastreg_pool(isert_conn); 63059464ef4SVu Pham return ret; 63159464ef4SVu Pham } 63259464ef4SVu Pham 633ae9ea9edSSagi Grimberg static void 634ae9ea9edSSagi Grimberg isert_init_conn(struct isert_conn *isert_conn) 635ae9ea9edSSagi Grimberg { 636ae9ea9edSSagi Grimberg isert_conn->state = ISER_CONN_INIT; 637dac6ab30SSagi Grimberg INIT_LIST_HEAD(&isert_conn->accept_node); 638dac6ab30SSagi Grimberg init_completion(&isert_conn->login_comp); 639ae9ea9edSSagi Grimberg init_completion(&isert_conn->login_req_comp); 640dac6ab30SSagi Grimberg init_completion(&isert_conn->wait); 641dac6ab30SSagi Grimberg kref_init(&isert_conn->kref); 642dac6ab30SSagi Grimberg mutex_init(&isert_conn->mutex); 643dac6ab30SSagi Grimberg spin_lock_init(&isert_conn->pool_lock); 644dac6ab30SSagi Grimberg INIT_LIST_HEAD(&isert_conn->fr_pool); 6452f1b6b7dSSagi Grimberg INIT_WORK(&isert_conn->release_work, isert_release_work); 646ae9ea9edSSagi Grimberg } 647ae9ea9edSSagi Grimberg 648ae9ea9edSSagi Grimberg static void 649ae9ea9edSSagi Grimberg isert_free_login_buf(struct isert_conn *isert_conn) 650ae9ea9edSSagi Grimberg { 651dac6ab30SSagi Grimberg struct ib_device *ib_dev = isert_conn->device->ib_device; 652ae9ea9edSSagi Grimberg 653ae9ea9edSSagi Grimberg ib_dma_unmap_single(ib_dev, isert_conn->login_rsp_dma, 654ae9ea9edSSagi Grimberg ISER_RX_LOGIN_SIZE, DMA_TO_DEVICE); 655ae9ea9edSSagi Grimberg ib_dma_unmap_single(ib_dev, isert_conn->login_req_dma, 656ae9ea9edSSagi Grimberg ISCSI_DEF_MAX_RECV_SEG_LEN, 657ae9ea9edSSagi Grimberg DMA_FROM_DEVICE); 658ae9ea9edSSagi Grimberg kfree(isert_conn->login_buf); 659ae9ea9edSSagi Grimberg } 660ae9ea9edSSagi Grimberg 661ae9ea9edSSagi Grimberg static int 662ae9ea9edSSagi Grimberg isert_alloc_login_buf(struct isert_conn *isert_conn, 663ae9ea9edSSagi Grimberg struct ib_device *ib_dev) 664ae9ea9edSSagi Grimberg { 665ae9ea9edSSagi Grimberg int ret; 666ae9ea9edSSagi Grimberg 667ae9ea9edSSagi Grimberg isert_conn->login_buf = kzalloc(ISCSI_DEF_MAX_RECV_SEG_LEN + 668ae9ea9edSSagi Grimberg ISER_RX_LOGIN_SIZE, GFP_KERNEL); 669ae9ea9edSSagi Grimberg if (!isert_conn->login_buf) { 670ae9ea9edSSagi Grimberg isert_err("Unable to allocate isert_conn->login_buf\n"); 671ae9ea9edSSagi Grimberg return -ENOMEM; 672ae9ea9edSSagi Grimberg } 673ae9ea9edSSagi Grimberg 674ae9ea9edSSagi Grimberg isert_conn->login_req_buf = isert_conn->login_buf; 675ae9ea9edSSagi Grimberg isert_conn->login_rsp_buf = isert_conn->login_buf + 676ae9ea9edSSagi Grimberg ISCSI_DEF_MAX_RECV_SEG_LEN; 677ae9ea9edSSagi Grimberg 678ae9ea9edSSagi Grimberg isert_dbg("Set login_buf: %p login_req_buf: %p login_rsp_buf: %p\n", 679ae9ea9edSSagi Grimberg isert_conn->login_buf, isert_conn->login_req_buf, 680ae9ea9edSSagi Grimberg isert_conn->login_rsp_buf); 681ae9ea9edSSagi Grimberg 682ae9ea9edSSagi Grimberg isert_conn->login_req_dma = ib_dma_map_single(ib_dev, 683ae9ea9edSSagi Grimberg (void *)isert_conn->login_req_buf, 684ae9ea9edSSagi Grimberg ISCSI_DEF_MAX_RECV_SEG_LEN, DMA_FROM_DEVICE); 685ae9ea9edSSagi Grimberg 686ae9ea9edSSagi Grimberg ret = ib_dma_mapping_error(ib_dev, isert_conn->login_req_dma); 687ae9ea9edSSagi Grimberg if (ret) { 688ae9ea9edSSagi Grimberg isert_err("login_req_dma mapping error: %d\n", ret); 689ae9ea9edSSagi Grimberg isert_conn->login_req_dma = 0; 690ae9ea9edSSagi Grimberg goto out_login_buf; 691ae9ea9edSSagi Grimberg } 692ae9ea9edSSagi Grimberg 693ae9ea9edSSagi Grimberg isert_conn->login_rsp_dma = ib_dma_map_single(ib_dev, 694ae9ea9edSSagi Grimberg (void *)isert_conn->login_rsp_buf, 695ae9ea9edSSagi Grimberg ISER_RX_LOGIN_SIZE, DMA_TO_DEVICE); 696ae9ea9edSSagi Grimberg 697ae9ea9edSSagi Grimberg ret = ib_dma_mapping_error(ib_dev, isert_conn->login_rsp_dma); 698ae9ea9edSSagi Grimberg if (ret) { 699ae9ea9edSSagi Grimberg isert_err("login_rsp_dma mapping error: %d\n", ret); 700ae9ea9edSSagi Grimberg isert_conn->login_rsp_dma = 0; 701ae9ea9edSSagi Grimberg goto out_req_dma_map; 702ae9ea9edSSagi Grimberg } 703ae9ea9edSSagi Grimberg 704ae9ea9edSSagi Grimberg return 0; 705ae9ea9edSSagi Grimberg 706ae9ea9edSSagi Grimberg out_req_dma_map: 707ae9ea9edSSagi Grimberg ib_dma_unmap_single(ib_dev, isert_conn->login_req_dma, 708ae9ea9edSSagi Grimberg ISCSI_DEF_MAX_RECV_SEG_LEN, DMA_FROM_DEVICE); 709ae9ea9edSSagi Grimberg out_login_buf: 710ae9ea9edSSagi Grimberg kfree(isert_conn->login_buf); 711ae9ea9edSSagi Grimberg return ret; 712ae9ea9edSSagi Grimberg } 713ae9ea9edSSagi Grimberg 714b8d26b3bSNicholas Bellinger static int 715b8d26b3bSNicholas Bellinger isert_connect_request(struct rdma_cm_id *cma_id, struct rdma_cm_event *event) 716b8d26b3bSNicholas Bellinger { 717ca6c1d82SSagi Grimberg struct isert_np *isert_np = cma_id->context; 718ca6c1d82SSagi Grimberg struct iscsi_np *np = isert_np->np; 719b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn; 720b8d26b3bSNicholas Bellinger struct isert_device *device; 721b8d26b3bSNicholas Bellinger int ret = 0; 72214f4b54fSSagi Grimberg 72314f4b54fSSagi Grimberg spin_lock_bh(&np->np_thread_lock); 72414f4b54fSSagi Grimberg if (!np->enabled) { 72514f4b54fSSagi Grimberg spin_unlock_bh(&np->np_thread_lock); 72624f412ddSSagi Grimberg isert_dbg("iscsi_np is not enabled, reject connect request\n"); 72714f4b54fSSagi Grimberg return rdma_reject(cma_id, NULL, 0); 72814f4b54fSSagi Grimberg } 72914f4b54fSSagi Grimberg spin_unlock_bh(&np->np_thread_lock); 730b8d26b3bSNicholas Bellinger 7314c22e07fSSagi Grimberg isert_dbg("cma_id: %p, portal: %p\n", 732b8d26b3bSNicholas Bellinger cma_id, cma_id->context); 733b8d26b3bSNicholas Bellinger 734b8d26b3bSNicholas Bellinger isert_conn = kzalloc(sizeof(struct isert_conn), GFP_KERNEL); 735ae9ea9edSSagi Grimberg if (!isert_conn) 736b8d26b3bSNicholas Bellinger return -ENOMEM; 737b8d26b3bSNicholas Bellinger 738ae9ea9edSSagi Grimberg isert_init_conn(isert_conn); 739dac6ab30SSagi Grimberg isert_conn->cm_id = cma_id; 740b8d26b3bSNicholas Bellinger 741ae9ea9edSSagi Grimberg ret = isert_alloc_login_buf(isert_conn, cma_id->device); 742ae9ea9edSSagi Grimberg if (ret) 743b8d26b3bSNicholas Bellinger goto out; 744b8d26b3bSNicholas Bellinger 745cf8ae958SSagi Grimberg device = isert_device_get(cma_id); 746b8d26b3bSNicholas Bellinger if (IS_ERR(device)) { 747b8d26b3bSNicholas Bellinger ret = PTR_ERR(device); 748b8d26b3bSNicholas Bellinger goto out_rsp_dma_map; 749b8d26b3bSNicholas Bellinger } 750dac6ab30SSagi Grimberg isert_conn->device = device; 751b8d26b3bSNicholas Bellinger 7521a92e17eSSagi Grimberg /* Set max inflight RDMA READ requests */ 7531a92e17eSSagi Grimberg isert_conn->initiator_depth = min_t(u8, 7541a92e17eSSagi Grimberg event->param.conn.initiator_depth, 7551a92e17eSSagi Grimberg device->dev_attr.max_qp_init_rd_atom); 75624f412ddSSagi Grimberg isert_dbg("Using initiator_depth: %u\n", isert_conn->initiator_depth); 7571a92e17eSSagi Grimberg 758570db170SSagi Grimberg ret = isert_conn_setup_qp(isert_conn, cma_id); 759b8d26b3bSNicholas Bellinger if (ret) 760b8d26b3bSNicholas Bellinger goto out_conn_dev; 761b8d26b3bSNicholas Bellinger 7622371e5daSSagi Grimberg ret = isert_rdma_post_recvl(isert_conn); 7632371e5daSSagi Grimberg if (ret) 7642371e5daSSagi Grimberg goto out_conn_dev; 765ce9a9fc2SNicholas Bellinger /* 766ce9a9fc2SNicholas Bellinger * Obtain the second reference now before isert_rdma_accept() to 767ce9a9fc2SNicholas Bellinger * ensure that any initiator generated REJECT CM event that occurs 768ce9a9fc2SNicholas Bellinger * asynchronously won't drop the last reference until the error path 769ce9a9fc2SNicholas Bellinger * in iscsi_target_login_sess_out() does it's ->iscsit_free_conn() -> 770ce9a9fc2SNicholas Bellinger * isert_free_conn() -> isert_put_conn() -> kref_put(). 771ce9a9fc2SNicholas Bellinger */ 772ce9a9fc2SNicholas Bellinger if (!kref_get_unless_zero(&isert_conn->kref)) { 773ce9a9fc2SNicholas Bellinger isert_warn("conn %p connect_release is running\n", isert_conn); 774ce9a9fc2SNicholas Bellinger goto out_conn_dev; 775ce9a9fc2SNicholas Bellinger } 7762371e5daSSagi Grimberg 7772371e5daSSagi Grimberg ret = isert_rdma_accept(isert_conn); 7782371e5daSSagi Grimberg if (ret) 7792371e5daSSagi Grimberg goto out_conn_dev; 7802371e5daSSagi Grimberg 781b8d26b3bSNicholas Bellinger mutex_lock(&isert_np->np_accept_mutex); 782dac6ab30SSagi Grimberg list_add_tail(&isert_conn->accept_node, &isert_np->np_accept_list); 783b8d26b3bSNicholas Bellinger mutex_unlock(&isert_np->np_accept_mutex); 784b8d26b3bSNicholas Bellinger 78524f412ddSSagi Grimberg isert_info("np %p: Allow accept_np to continue\n", np); 786531b7bf4SSagi Grimberg up(&isert_np->np_sem); 787b8d26b3bSNicholas Bellinger return 0; 788b8d26b3bSNicholas Bellinger 789b8d26b3bSNicholas Bellinger out_conn_dev: 790cf8ae958SSagi Grimberg isert_device_put(device); 791b8d26b3bSNicholas Bellinger out_rsp_dma_map: 792ae9ea9edSSagi Grimberg isert_free_login_buf(isert_conn); 793b8d26b3bSNicholas Bellinger out: 794b8d26b3bSNicholas Bellinger kfree(isert_conn); 7952371e5daSSagi Grimberg rdma_reject(cma_id, NULL, 0); 796b8d26b3bSNicholas Bellinger return ret; 797b8d26b3bSNicholas Bellinger } 798b8d26b3bSNicholas Bellinger 799b8d26b3bSNicholas Bellinger static void 800b8d26b3bSNicholas Bellinger isert_connect_release(struct isert_conn *isert_conn) 801b8d26b3bSNicholas Bellinger { 802dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 803b8d26b3bSNicholas Bellinger 8044c22e07fSSagi Grimberg isert_dbg("conn %p\n", isert_conn); 805b8d26b3bSNicholas Bellinger 80657df81e3SSagi Grimberg BUG_ON(!device); 80757df81e3SSagi Grimberg 80857df81e3SSagi Grimberg if (device->use_fastreg) 809a3a5a826SSagi Grimberg isert_conn_free_fastreg_pool(isert_conn); 81059464ef4SVu Pham 81119e2090fSSagi Grimberg isert_free_rx_descriptors(isert_conn); 812dac6ab30SSagi Grimberg if (isert_conn->cm_id) 813dac6ab30SSagi Grimberg rdma_destroy_id(isert_conn->cm_id); 81419e2090fSSagi Grimberg 815dac6ab30SSagi Grimberg if (isert_conn->qp) { 816dac6ab30SSagi Grimberg struct isert_comp *comp = isert_conn->qp->recv_cq->cq_context; 8174a295baeSSagi Grimberg 81840fc069aSSagi Grimberg isert_comp_put(comp); 819dac6ab30SSagi Grimberg ib_destroy_qp(isert_conn->qp); 820b8d26b3bSNicholas Bellinger } 821b8d26b3bSNicholas Bellinger 822ae9ea9edSSagi Grimberg if (isert_conn->login_buf) 823ae9ea9edSSagi Grimberg isert_free_login_buf(isert_conn); 824ae9ea9edSSagi Grimberg 825cf8ae958SSagi Grimberg isert_device_put(device); 82657df81e3SSagi Grimberg 82757df81e3SSagi Grimberg kfree(isert_conn); 828b8d26b3bSNicholas Bellinger } 829b8d26b3bSNicholas Bellinger 830b8d26b3bSNicholas Bellinger static void 831b8d26b3bSNicholas Bellinger isert_connected_handler(struct rdma_cm_id *cma_id) 832b8d26b3bSNicholas Bellinger { 83319e2090fSSagi Grimberg struct isert_conn *isert_conn = cma_id->qp->qp_context; 834c2f88b17SSagi Grimberg 83524f412ddSSagi Grimberg isert_info("conn %p\n", isert_conn); 836128e9cc8SSagi Grimberg 837dac6ab30SSagi Grimberg mutex_lock(&isert_conn->mutex); 8382371e5daSSagi Grimberg if (isert_conn->state != ISER_CONN_FULL_FEATURE) 839128e9cc8SSagi Grimberg isert_conn->state = ISER_CONN_UP; 840dac6ab30SSagi Grimberg mutex_unlock(&isert_conn->mutex); 841b8d26b3bSNicholas Bellinger } 842b8d26b3bSNicholas Bellinger 843b8d26b3bSNicholas Bellinger static void 844dac6ab30SSagi Grimberg isert_release_kref(struct kref *kref) 845b8d26b3bSNicholas Bellinger { 846b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = container_of(kref, 847dac6ab30SSagi Grimberg struct isert_conn, kref); 848b8d26b3bSNicholas Bellinger 8494c22e07fSSagi Grimberg isert_info("conn %p final kref %s/%d\n", isert_conn, current->comm, 8504c22e07fSSagi Grimberg current->pid); 851b8d26b3bSNicholas Bellinger 852b8d26b3bSNicholas Bellinger isert_connect_release(isert_conn); 853b8d26b3bSNicholas Bellinger } 854b8d26b3bSNicholas Bellinger 855b8d26b3bSNicholas Bellinger static void 856b8d26b3bSNicholas Bellinger isert_put_conn(struct isert_conn *isert_conn) 857b8d26b3bSNicholas Bellinger { 858dac6ab30SSagi Grimberg kref_put(&isert_conn->kref, isert_release_kref); 859b8d26b3bSNicholas Bellinger } 860b8d26b3bSNicholas Bellinger 861954f2372SSagi Grimberg /** 862954f2372SSagi Grimberg * isert_conn_terminate() - Initiate connection termination 863954f2372SSagi Grimberg * @isert_conn: isert connection struct 864954f2372SSagi Grimberg * 865954f2372SSagi Grimberg * Notes: 866128e9cc8SSagi Grimberg * In case the connection state is FULL_FEATURE, move state 867954f2372SSagi Grimberg * to TEMINATING and start teardown sequence (rdma_disconnect). 868128e9cc8SSagi Grimberg * In case the connection state is UP, complete flush as well. 869954f2372SSagi Grimberg * 870dac6ab30SSagi Grimberg * This routine must be called with mutex held. Thus it is 871954f2372SSagi Grimberg * safe to call multiple times. 872954f2372SSagi Grimberg */ 873954f2372SSagi Grimberg static void 874954f2372SSagi Grimberg isert_conn_terminate(struct isert_conn *isert_conn) 875954f2372SSagi Grimberg { 876954f2372SSagi Grimberg int err; 877954f2372SSagi Grimberg 878128e9cc8SSagi Grimberg switch (isert_conn->state) { 879128e9cc8SSagi Grimberg case ISER_CONN_TERMINATING: 880128e9cc8SSagi Grimberg break; 881128e9cc8SSagi Grimberg case ISER_CONN_UP: 882128e9cc8SSagi Grimberg case ISER_CONN_FULL_FEATURE: /* FALLTHRU */ 88324f412ddSSagi Grimberg isert_info("Terminating conn %p state %d\n", 884954f2372SSagi Grimberg isert_conn, isert_conn->state); 885128e9cc8SSagi Grimberg isert_conn->state = ISER_CONN_TERMINATING; 886dac6ab30SSagi Grimberg err = rdma_disconnect(isert_conn->cm_id); 887954f2372SSagi Grimberg if (err) 88824f412ddSSagi Grimberg isert_warn("Failed rdma_disconnect isert_conn %p\n", 889954f2372SSagi Grimberg isert_conn); 890128e9cc8SSagi Grimberg break; 891128e9cc8SSagi Grimberg default: 89224f412ddSSagi Grimberg isert_warn("conn %p teminating in state %d\n", 893128e9cc8SSagi Grimberg isert_conn, isert_conn->state); 894954f2372SSagi Grimberg } 895954f2372SSagi Grimberg } 896954f2372SSagi Grimberg 8973b726ae2SSagi Grimberg static int 898ca6c1d82SSagi Grimberg isert_np_cma_handler(struct isert_np *isert_np, 899ca6c1d82SSagi Grimberg enum rdma_cm_event_type event) 900b8d26b3bSNicholas Bellinger { 901ea8a1616SSagi Grimberg isert_dbg("%s (%d): isert np %p\n", 902ea8a1616SSagi Grimberg rdma_event_msg(event), event, isert_np); 9033b726ae2SSagi Grimberg 904ca6c1d82SSagi Grimberg switch (event) { 905ca6c1d82SSagi Grimberg case RDMA_CM_EVENT_DEVICE_REMOVAL: 9063b726ae2SSagi Grimberg isert_np->np_cm_id = NULL; 907ca6c1d82SSagi Grimberg break; 908ca6c1d82SSagi Grimberg case RDMA_CM_EVENT_ADDR_CHANGE: 909ca6c1d82SSagi Grimberg isert_np->np_cm_id = isert_setup_id(isert_np); 910ca6c1d82SSagi Grimberg if (IS_ERR(isert_np->np_cm_id)) { 91124f412ddSSagi Grimberg isert_err("isert np %p setup id failed: %ld\n", 912ca6c1d82SSagi Grimberg isert_np, PTR_ERR(isert_np->np_cm_id)); 913ca6c1d82SSagi Grimberg isert_np->np_cm_id = NULL; 914ca6c1d82SSagi Grimberg } 915ca6c1d82SSagi Grimberg break; 916ca6c1d82SSagi Grimberg default: 91724f412ddSSagi Grimberg isert_err("isert np %p Unexpected event %d\n", 918ca6c1d82SSagi Grimberg isert_np, event); 919ca6c1d82SSagi Grimberg } 920ca6c1d82SSagi Grimberg 9213b726ae2SSagi Grimberg return -1; 9223b726ae2SSagi Grimberg } 9233b726ae2SSagi Grimberg 924ca6c1d82SSagi Grimberg static int 925ca6c1d82SSagi Grimberg isert_disconnected_handler(struct rdma_cm_id *cma_id, 926ca6c1d82SSagi Grimberg enum rdma_cm_event_type event) 927ca6c1d82SSagi Grimberg { 928ca6c1d82SSagi Grimberg struct isert_np *isert_np = cma_id->context; 929ca6c1d82SSagi Grimberg struct isert_conn *isert_conn; 9302f1b6b7dSSagi Grimberg bool terminating = false; 931ca6c1d82SSagi Grimberg 932ca6c1d82SSagi Grimberg if (isert_np->np_cm_id == cma_id) 933ca6c1d82SSagi Grimberg return isert_np_cma_handler(cma_id->context, event); 934ca6c1d82SSagi Grimberg 93519e2090fSSagi Grimberg isert_conn = cma_id->qp->qp_context; 936b8d26b3bSNicholas Bellinger 937dac6ab30SSagi Grimberg mutex_lock(&isert_conn->mutex); 9382f1b6b7dSSagi Grimberg terminating = (isert_conn->state == ISER_CONN_TERMINATING); 939128e9cc8SSagi Grimberg isert_conn_terminate(isert_conn); 940dac6ab30SSagi Grimberg mutex_unlock(&isert_conn->mutex); 941128e9cc8SSagi Grimberg 942dac6ab30SSagi Grimberg isert_info("conn %p completing wait\n", isert_conn); 943dac6ab30SSagi Grimberg complete(&isert_conn->wait); 9443b726ae2SSagi Grimberg 9452f1b6b7dSSagi Grimberg if (terminating) 9462f1b6b7dSSagi Grimberg goto out; 9472f1b6b7dSSagi Grimberg 9482f1b6b7dSSagi Grimberg mutex_lock(&isert_np->np_accept_mutex); 9492f1b6b7dSSagi Grimberg if (!list_empty(&isert_conn->accept_node)) { 9502f1b6b7dSSagi Grimberg list_del_init(&isert_conn->accept_node); 9512f1b6b7dSSagi Grimberg isert_put_conn(isert_conn); 9522f1b6b7dSSagi Grimberg queue_work(isert_release_wq, &isert_conn->release_work); 9532f1b6b7dSSagi Grimberg } 9542f1b6b7dSSagi Grimberg mutex_unlock(&isert_np->np_accept_mutex); 9552f1b6b7dSSagi Grimberg 9562f1b6b7dSSagi Grimberg out: 9573b726ae2SSagi Grimberg return 0; 958b8d26b3bSNicholas Bellinger } 959b8d26b3bSNicholas Bellinger 9604a579da2SSagi Grimberg static int 961954f2372SSagi Grimberg isert_connect_error(struct rdma_cm_id *cma_id) 962954f2372SSagi Grimberg { 96319e2090fSSagi Grimberg struct isert_conn *isert_conn = cma_id->qp->qp_context; 964954f2372SSagi Grimberg 965dac6ab30SSagi Grimberg isert_conn->cm_id = NULL; 966954f2372SSagi Grimberg isert_put_conn(isert_conn); 9674a579da2SSagi Grimberg 9684a579da2SSagi Grimberg return -1; 969954f2372SSagi Grimberg } 970954f2372SSagi Grimberg 971b8d26b3bSNicholas Bellinger static int 972b8d26b3bSNicholas Bellinger isert_cma_handler(struct rdma_cm_id *cma_id, struct rdma_cm_event *event) 973b8d26b3bSNicholas Bellinger { 974b8d26b3bSNicholas Bellinger int ret = 0; 975b8d26b3bSNicholas Bellinger 976ea8a1616SSagi Grimberg isert_info("%s (%d): status %d id %p np %p\n", 977ea8a1616SSagi Grimberg rdma_event_msg(event->event), event->event, 9784c22e07fSSagi Grimberg event->status, cma_id, cma_id->context); 979b8d26b3bSNicholas Bellinger 980b8d26b3bSNicholas Bellinger switch (event->event) { 981b8d26b3bSNicholas Bellinger case RDMA_CM_EVENT_CONNECT_REQUEST: 982b8d26b3bSNicholas Bellinger ret = isert_connect_request(cma_id, event); 9833b726ae2SSagi Grimberg if (ret) 9844c22e07fSSagi Grimberg isert_err("failed handle connect request %d\n", ret); 985b8d26b3bSNicholas Bellinger break; 986b8d26b3bSNicholas Bellinger case RDMA_CM_EVENT_ESTABLISHED: 987b8d26b3bSNicholas Bellinger isert_connected_handler(cma_id); 988b8d26b3bSNicholas Bellinger break; 98988c4015fSSagi Grimberg case RDMA_CM_EVENT_ADDR_CHANGE: /* FALLTHRU */ 99088c4015fSSagi Grimberg case RDMA_CM_EVENT_DISCONNECTED: /* FALLTHRU */ 99188c4015fSSagi Grimberg case RDMA_CM_EVENT_DEVICE_REMOVAL: /* FALLTHRU */ 99288c4015fSSagi Grimberg case RDMA_CM_EVENT_TIMEWAIT_EXIT: /* FALLTHRU */ 993ca6c1d82SSagi Grimberg ret = isert_disconnected_handler(cma_id, event->event); 994b8d26b3bSNicholas Bellinger break; 995954f2372SSagi Grimberg case RDMA_CM_EVENT_REJECTED: /* FALLTHRU */ 996954f2372SSagi Grimberg case RDMA_CM_EVENT_UNREACHABLE: /* FALLTHRU */ 997b8d26b3bSNicholas Bellinger case RDMA_CM_EVENT_CONNECT_ERROR: 9984a579da2SSagi Grimberg ret = isert_connect_error(cma_id); 999954f2372SSagi Grimberg break; 1000b8d26b3bSNicholas Bellinger default: 100124f412ddSSagi Grimberg isert_err("Unhandled RDMA CMA event: %d\n", event->event); 1002b8d26b3bSNicholas Bellinger break; 1003b8d26b3bSNicholas Bellinger } 1004b8d26b3bSNicholas Bellinger 1005b8d26b3bSNicholas Bellinger return ret; 1006b8d26b3bSNicholas Bellinger } 1007b8d26b3bSNicholas Bellinger 1008b8d26b3bSNicholas Bellinger static int 1009b8d26b3bSNicholas Bellinger isert_post_recv(struct isert_conn *isert_conn, u32 count) 1010b8d26b3bSNicholas Bellinger { 1011b8d26b3bSNicholas Bellinger struct ib_recv_wr *rx_wr, *rx_wr_failed; 1012b8d26b3bSNicholas Bellinger int i, ret; 1013dac6ab30SSagi Grimberg unsigned int rx_head = isert_conn->rx_desc_head; 1014b8d26b3bSNicholas Bellinger struct iser_rx_desc *rx_desc; 1015b8d26b3bSNicholas Bellinger 1016dac6ab30SSagi Grimberg for (rx_wr = isert_conn->rx_wr, i = 0; i < count; i++, rx_wr++) { 1017dac6ab30SSagi Grimberg rx_desc = &isert_conn->rx_descs[rx_head]; 1018b0a191e7SSagi Grimberg rx_wr->wr_id = (uintptr_t)rx_desc; 1019b8d26b3bSNicholas Bellinger rx_wr->sg_list = &rx_desc->rx_sg; 1020b8d26b3bSNicholas Bellinger rx_wr->num_sge = 1; 1021b8d26b3bSNicholas Bellinger rx_wr->next = rx_wr + 1; 1022b8d26b3bSNicholas Bellinger rx_head = (rx_head + 1) & (ISERT_QP_MAX_RECV_DTOS - 1); 1023b8d26b3bSNicholas Bellinger } 1024b8d26b3bSNicholas Bellinger 1025b8d26b3bSNicholas Bellinger rx_wr--; 1026b8d26b3bSNicholas Bellinger rx_wr->next = NULL; /* mark end of work requests list */ 1027b8d26b3bSNicholas Bellinger 1028b8d26b3bSNicholas Bellinger isert_conn->post_recv_buf_count += count; 1029dac6ab30SSagi Grimberg ret = ib_post_recv(isert_conn->qp, isert_conn->rx_wr, 1030b8d26b3bSNicholas Bellinger &rx_wr_failed); 1031b8d26b3bSNicholas Bellinger if (ret) { 103224f412ddSSagi Grimberg isert_err("ib_post_recv() failed with ret: %d\n", ret); 1033b8d26b3bSNicholas Bellinger isert_conn->post_recv_buf_count -= count; 1034b8d26b3bSNicholas Bellinger } else { 103511378cdbSRasmus Villemoes isert_dbg("Posted %d RX buffers\n", count); 1036dac6ab30SSagi Grimberg isert_conn->rx_desc_head = rx_head; 1037b8d26b3bSNicholas Bellinger } 1038b8d26b3bSNicholas Bellinger return ret; 1039b8d26b3bSNicholas Bellinger } 1040b8d26b3bSNicholas Bellinger 1041b8d26b3bSNicholas Bellinger static int 1042b8d26b3bSNicholas Bellinger isert_post_send(struct isert_conn *isert_conn, struct iser_tx_desc *tx_desc) 1043b8d26b3bSNicholas Bellinger { 1044dac6ab30SSagi Grimberg struct ib_device *ib_dev = isert_conn->cm_id->device; 1045b8d26b3bSNicholas Bellinger struct ib_send_wr send_wr, *send_wr_failed; 1046b8d26b3bSNicholas Bellinger int ret; 1047b8d26b3bSNicholas Bellinger 1048b8d26b3bSNicholas Bellinger ib_dma_sync_single_for_device(ib_dev, tx_desc->dma_addr, 1049b8d26b3bSNicholas Bellinger ISER_HEADERS_LEN, DMA_TO_DEVICE); 1050b8d26b3bSNicholas Bellinger 1051b8d26b3bSNicholas Bellinger send_wr.next = NULL; 1052b0a191e7SSagi Grimberg send_wr.wr_id = (uintptr_t)tx_desc; 1053b8d26b3bSNicholas Bellinger send_wr.sg_list = tx_desc->tx_sg; 1054b8d26b3bSNicholas Bellinger send_wr.num_sge = tx_desc->num_sge; 1055b8d26b3bSNicholas Bellinger send_wr.opcode = IB_WR_SEND; 1056b8d26b3bSNicholas Bellinger send_wr.send_flags = IB_SEND_SIGNALED; 1057b8d26b3bSNicholas Bellinger 1058dac6ab30SSagi Grimberg ret = ib_post_send(isert_conn->qp, &send_wr, &send_wr_failed); 1059bdf20e72SSagi Grimberg if (ret) 106024f412ddSSagi Grimberg isert_err("ib_post_send() failed, ret: %d\n", ret); 1061b8d26b3bSNicholas Bellinger 1062b8d26b3bSNicholas Bellinger return ret; 1063b8d26b3bSNicholas Bellinger } 1064b8d26b3bSNicholas Bellinger 1065b8d26b3bSNicholas Bellinger static void 1066b8d26b3bSNicholas Bellinger isert_create_send_desc(struct isert_conn *isert_conn, 1067b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd, 1068b8d26b3bSNicholas Bellinger struct iser_tx_desc *tx_desc) 1069b8d26b3bSNicholas Bellinger { 1070dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 107167cb3949SSagi Grimberg struct ib_device *ib_dev = device->ib_device; 1072b8d26b3bSNicholas Bellinger 1073b8d26b3bSNicholas Bellinger ib_dma_sync_single_for_cpu(ib_dev, tx_desc->dma_addr, 1074b8d26b3bSNicholas Bellinger ISER_HEADERS_LEN, DMA_TO_DEVICE); 1075b8d26b3bSNicholas Bellinger 1076b8d26b3bSNicholas Bellinger memset(&tx_desc->iser_header, 0, sizeof(struct iser_hdr)); 1077b8d26b3bSNicholas Bellinger tx_desc->iser_header.flags = ISER_VER; 1078b8d26b3bSNicholas Bellinger 1079b8d26b3bSNicholas Bellinger tx_desc->num_sge = 1; 1080b8d26b3bSNicholas Bellinger tx_desc->isert_cmd = isert_cmd; 1081b8d26b3bSNicholas Bellinger 108234efc7dfSJason Gunthorpe if (tx_desc->tx_sg[0].lkey != device->pd->local_dma_lkey) { 108334efc7dfSJason Gunthorpe tx_desc->tx_sg[0].lkey = device->pd->local_dma_lkey; 108424f412ddSSagi Grimberg isert_dbg("tx_desc %p lkey mismatch, fixing\n", tx_desc); 1085b8d26b3bSNicholas Bellinger } 1086b8d26b3bSNicholas Bellinger } 1087b8d26b3bSNicholas Bellinger 1088b8d26b3bSNicholas Bellinger static int 1089b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(struct isert_conn *isert_conn, 1090b8d26b3bSNicholas Bellinger struct iser_tx_desc *tx_desc) 1091b8d26b3bSNicholas Bellinger { 1092dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 109367cb3949SSagi Grimberg struct ib_device *ib_dev = device->ib_device; 1094b8d26b3bSNicholas Bellinger u64 dma_addr; 1095b8d26b3bSNicholas Bellinger 1096b8d26b3bSNicholas Bellinger dma_addr = ib_dma_map_single(ib_dev, (void *)tx_desc, 1097b8d26b3bSNicholas Bellinger ISER_HEADERS_LEN, DMA_TO_DEVICE); 1098b8d26b3bSNicholas Bellinger if (ib_dma_mapping_error(ib_dev, dma_addr)) { 109924f412ddSSagi Grimberg isert_err("ib_dma_mapping_error() failed\n"); 1100b8d26b3bSNicholas Bellinger return -ENOMEM; 1101b8d26b3bSNicholas Bellinger } 1102b8d26b3bSNicholas Bellinger 1103b8d26b3bSNicholas Bellinger tx_desc->dma_addr = dma_addr; 1104b8d26b3bSNicholas Bellinger tx_desc->tx_sg[0].addr = tx_desc->dma_addr; 1105b8d26b3bSNicholas Bellinger tx_desc->tx_sg[0].length = ISER_HEADERS_LEN; 110634efc7dfSJason Gunthorpe tx_desc->tx_sg[0].lkey = device->pd->local_dma_lkey; 1107b8d26b3bSNicholas Bellinger 11084c22e07fSSagi Grimberg isert_dbg("Setup tx_sg[0].addr: 0x%llx length: %u lkey: 0x%x\n", 11094c22e07fSSagi Grimberg tx_desc->tx_sg[0].addr, tx_desc->tx_sg[0].length, 11104c22e07fSSagi Grimberg tx_desc->tx_sg[0].lkey); 1111b8d26b3bSNicholas Bellinger 1112b8d26b3bSNicholas Bellinger return 0; 1113b8d26b3bSNicholas Bellinger } 1114b8d26b3bSNicholas Bellinger 1115b8d26b3bSNicholas Bellinger static void 111695b60f07SNicholas Bellinger isert_init_send_wr(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd, 111768a86deeSSagi Grimberg struct ib_send_wr *send_wr) 1118b8d26b3bSNicholas Bellinger { 111995b60f07SNicholas Bellinger struct iser_tx_desc *tx_desc = &isert_cmd->tx_desc; 112095b60f07SNicholas Bellinger 1121b8d26b3bSNicholas Bellinger isert_cmd->rdma_wr.iser_ib_op = ISER_IB_SEND; 1122b0a191e7SSagi Grimberg send_wr->wr_id = (uintptr_t)&isert_cmd->tx_desc; 1123b8d26b3bSNicholas Bellinger send_wr->opcode = IB_WR_SEND; 112495b60f07SNicholas Bellinger send_wr->sg_list = &tx_desc->tx_sg[0]; 1125b8d26b3bSNicholas Bellinger send_wr->num_sge = isert_cmd->tx_desc.num_sge; 112695b60f07SNicholas Bellinger send_wr->send_flags = IB_SEND_SIGNALED; 1127b8d26b3bSNicholas Bellinger } 1128b8d26b3bSNicholas Bellinger 1129b8d26b3bSNicholas Bellinger static int 1130b8d26b3bSNicholas Bellinger isert_rdma_post_recvl(struct isert_conn *isert_conn) 1131b8d26b3bSNicholas Bellinger { 1132b8d26b3bSNicholas Bellinger struct ib_recv_wr rx_wr, *rx_wr_fail; 1133b8d26b3bSNicholas Bellinger struct ib_sge sge; 1134b8d26b3bSNicholas Bellinger int ret; 1135b8d26b3bSNicholas Bellinger 1136b8d26b3bSNicholas Bellinger memset(&sge, 0, sizeof(struct ib_sge)); 1137b8d26b3bSNicholas Bellinger sge.addr = isert_conn->login_req_dma; 1138b8d26b3bSNicholas Bellinger sge.length = ISER_RX_LOGIN_SIZE; 113934efc7dfSJason Gunthorpe sge.lkey = isert_conn->device->pd->local_dma_lkey; 1140b8d26b3bSNicholas Bellinger 114124f412ddSSagi Grimberg isert_dbg("Setup sge: addr: %llx length: %d 0x%08x\n", 1142b8d26b3bSNicholas Bellinger sge.addr, sge.length, sge.lkey); 1143b8d26b3bSNicholas Bellinger 1144b8d26b3bSNicholas Bellinger memset(&rx_wr, 0, sizeof(struct ib_recv_wr)); 1145b0a191e7SSagi Grimberg rx_wr.wr_id = (uintptr_t)isert_conn->login_req_buf; 1146b8d26b3bSNicholas Bellinger rx_wr.sg_list = &sge; 1147b8d26b3bSNicholas Bellinger rx_wr.num_sge = 1; 1148b8d26b3bSNicholas Bellinger 1149b8d26b3bSNicholas Bellinger isert_conn->post_recv_buf_count++; 1150dac6ab30SSagi Grimberg ret = ib_post_recv(isert_conn->qp, &rx_wr, &rx_wr_fail); 1151b8d26b3bSNicholas Bellinger if (ret) { 115224f412ddSSagi Grimberg isert_err("ib_post_recv() failed: %d\n", ret); 1153b8d26b3bSNicholas Bellinger isert_conn->post_recv_buf_count--; 1154b8d26b3bSNicholas Bellinger } 1155b8d26b3bSNicholas Bellinger 1156b8d26b3bSNicholas Bellinger return ret; 1157b8d26b3bSNicholas Bellinger } 1158b8d26b3bSNicholas Bellinger 1159b8d26b3bSNicholas Bellinger static int 1160b8d26b3bSNicholas Bellinger isert_put_login_tx(struct iscsi_conn *conn, struct iscsi_login *login, 1161b8d26b3bSNicholas Bellinger u32 length) 1162b8d26b3bSNicholas Bellinger { 1163b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = conn->context; 1164dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 116567cb3949SSagi Grimberg struct ib_device *ib_dev = device->ib_device; 1166dac6ab30SSagi Grimberg struct iser_tx_desc *tx_desc = &isert_conn->login_tx_desc; 1167b8d26b3bSNicholas Bellinger int ret; 1168b8d26b3bSNicholas Bellinger 1169b8d26b3bSNicholas Bellinger isert_create_send_desc(isert_conn, NULL, tx_desc); 1170b8d26b3bSNicholas Bellinger 1171b8d26b3bSNicholas Bellinger memcpy(&tx_desc->iscsi_header, &login->rsp[0], 1172b8d26b3bSNicholas Bellinger sizeof(struct iscsi_hdr)); 1173b8d26b3bSNicholas Bellinger 1174b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, tx_desc); 1175b8d26b3bSNicholas Bellinger 1176b8d26b3bSNicholas Bellinger if (length > 0) { 1177b8d26b3bSNicholas Bellinger struct ib_sge *tx_dsg = &tx_desc->tx_sg[1]; 1178b8d26b3bSNicholas Bellinger 1179b8d26b3bSNicholas Bellinger ib_dma_sync_single_for_cpu(ib_dev, isert_conn->login_rsp_dma, 1180b8d26b3bSNicholas Bellinger length, DMA_TO_DEVICE); 1181b8d26b3bSNicholas Bellinger 1182b8d26b3bSNicholas Bellinger memcpy(isert_conn->login_rsp_buf, login->rsp_buf, length); 1183b8d26b3bSNicholas Bellinger 1184b8d26b3bSNicholas Bellinger ib_dma_sync_single_for_device(ib_dev, isert_conn->login_rsp_dma, 1185b8d26b3bSNicholas Bellinger length, DMA_TO_DEVICE); 1186b8d26b3bSNicholas Bellinger 1187b8d26b3bSNicholas Bellinger tx_dsg->addr = isert_conn->login_rsp_dma; 1188b8d26b3bSNicholas Bellinger tx_dsg->length = length; 118934efc7dfSJason Gunthorpe tx_dsg->lkey = isert_conn->device->pd->local_dma_lkey; 1190b8d26b3bSNicholas Bellinger tx_desc->num_sge = 2; 1191b8d26b3bSNicholas Bellinger } 1192b8d26b3bSNicholas Bellinger if (!login->login_failed) { 1193b8d26b3bSNicholas Bellinger if (login->login_complete) { 1194e0546fc1SSagi Grimberg if (!conn->sess->sess_ops->SessionType && 1195dac6ab30SSagi Grimberg isert_conn->device->use_fastreg) { 1196570db170SSagi Grimberg ret = isert_conn_create_fastreg_pool(isert_conn); 1197f46d6a8aSNicholas Bellinger if (ret) { 119824f412ddSSagi Grimberg isert_err("Conn: %p failed to create" 1199f46d6a8aSNicholas Bellinger " fastreg pool\n", isert_conn); 1200f46d6a8aSNicholas Bellinger return ret; 1201f46d6a8aSNicholas Bellinger } 1202f46d6a8aSNicholas Bellinger } 1203f46d6a8aSNicholas Bellinger 1204b8d26b3bSNicholas Bellinger ret = isert_alloc_rx_descriptors(isert_conn); 1205b8d26b3bSNicholas Bellinger if (ret) 1206b8d26b3bSNicholas Bellinger return ret; 1207b8d26b3bSNicholas Bellinger 1208b8d26b3bSNicholas Bellinger ret = isert_post_recv(isert_conn, ISERT_MIN_POSTED_RX); 1209b8d26b3bSNicholas Bellinger if (ret) 1210b8d26b3bSNicholas Bellinger return ret; 1211b8d26b3bSNicholas Bellinger 1212128e9cc8SSagi Grimberg /* Now we are in FULL_FEATURE phase */ 1213dac6ab30SSagi Grimberg mutex_lock(&isert_conn->mutex); 1214128e9cc8SSagi Grimberg isert_conn->state = ISER_CONN_FULL_FEATURE; 1215dac6ab30SSagi Grimberg mutex_unlock(&isert_conn->mutex); 1216b8d26b3bSNicholas Bellinger goto post_send; 1217b8d26b3bSNicholas Bellinger } 1218b8d26b3bSNicholas Bellinger 1219b8d26b3bSNicholas Bellinger ret = isert_rdma_post_recvl(isert_conn); 1220b8d26b3bSNicholas Bellinger if (ret) 1221b8d26b3bSNicholas Bellinger return ret; 1222b8d26b3bSNicholas Bellinger } 1223b8d26b3bSNicholas Bellinger post_send: 1224b8d26b3bSNicholas Bellinger ret = isert_post_send(isert_conn, tx_desc); 1225b8d26b3bSNicholas Bellinger if (ret) 1226b8d26b3bSNicholas Bellinger return ret; 1227b8d26b3bSNicholas Bellinger 1228b8d26b3bSNicholas Bellinger return 0; 1229b8d26b3bSNicholas Bellinger } 1230b8d26b3bSNicholas Bellinger 1231b8d26b3bSNicholas Bellinger static void 12322371e5daSSagi Grimberg isert_rx_login_req(struct isert_conn *isert_conn) 1233b8d26b3bSNicholas Bellinger { 12342371e5daSSagi Grimberg struct iser_rx_desc *rx_desc = (void *)isert_conn->login_req_buf; 12352371e5daSSagi Grimberg int rx_buflen = isert_conn->login_req_len; 1236b8d26b3bSNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1237b8d26b3bSNicholas Bellinger struct iscsi_login *login = conn->conn_login; 1238b8d26b3bSNicholas Bellinger int size; 1239b8d26b3bSNicholas Bellinger 124024f412ddSSagi Grimberg isert_info("conn %p\n", isert_conn); 12412371e5daSSagi Grimberg 12422371e5daSSagi Grimberg WARN_ON_ONCE(!login); 1243b8d26b3bSNicholas Bellinger 1244b8d26b3bSNicholas Bellinger if (login->first_request) { 1245b8d26b3bSNicholas Bellinger struct iscsi_login_req *login_req = 1246b8d26b3bSNicholas Bellinger (struct iscsi_login_req *)&rx_desc->iscsi_header; 1247b8d26b3bSNicholas Bellinger /* 1248b8d26b3bSNicholas Bellinger * Setup the initial iscsi_login values from the leading 1249b8d26b3bSNicholas Bellinger * login request PDU. 1250b8d26b3bSNicholas Bellinger */ 1251b8d26b3bSNicholas Bellinger login->leading_connection = (!login_req->tsih) ? 1 : 0; 1252b8d26b3bSNicholas Bellinger login->current_stage = 1253b8d26b3bSNicholas Bellinger (login_req->flags & ISCSI_FLAG_LOGIN_CURRENT_STAGE_MASK) 1254b8d26b3bSNicholas Bellinger >> 2; 1255b8d26b3bSNicholas Bellinger login->version_min = login_req->min_version; 1256b8d26b3bSNicholas Bellinger login->version_max = login_req->max_version; 1257b8d26b3bSNicholas Bellinger memcpy(login->isid, login_req->isid, 6); 1258b8d26b3bSNicholas Bellinger login->cmd_sn = be32_to_cpu(login_req->cmdsn); 1259b8d26b3bSNicholas Bellinger login->init_task_tag = login_req->itt; 1260b8d26b3bSNicholas Bellinger login->initial_exp_statsn = be32_to_cpu(login_req->exp_statsn); 1261b8d26b3bSNicholas Bellinger login->cid = be16_to_cpu(login_req->cid); 1262b8d26b3bSNicholas Bellinger login->tsih = be16_to_cpu(login_req->tsih); 1263b8d26b3bSNicholas Bellinger } 1264b8d26b3bSNicholas Bellinger 1265b8d26b3bSNicholas Bellinger memcpy(&login->req[0], (void *)&rx_desc->iscsi_header, ISCSI_HDR_LEN); 1266b8d26b3bSNicholas Bellinger 1267b8d26b3bSNicholas Bellinger size = min(rx_buflen, MAX_KEY_VALUE_PAIRS); 12684c22e07fSSagi Grimberg isert_dbg("Using login payload size: %d, rx_buflen: %d " 12694c22e07fSSagi Grimberg "MAX_KEY_VALUE_PAIRS: %d\n", size, rx_buflen, 12704c22e07fSSagi Grimberg MAX_KEY_VALUE_PAIRS); 1271b8d26b3bSNicholas Bellinger memcpy(login->req_buf, &rx_desc->data[0], size); 1272b8d26b3bSNicholas Bellinger 12736faaa85fSNicholas Bellinger if (login->first_request) { 1274dac6ab30SSagi Grimberg complete(&isert_conn->login_comp); 12756faaa85fSNicholas Bellinger return; 12766faaa85fSNicholas Bellinger } 12776faaa85fSNicholas Bellinger schedule_delayed_work(&conn->login_work, 0); 1278b8d26b3bSNicholas Bellinger } 1279b8d26b3bSNicholas Bellinger 1280b8d26b3bSNicholas Bellinger static struct iscsi_cmd 1281676687c6SNicholas Bellinger *isert_allocate_cmd(struct iscsi_conn *conn) 1282b8d26b3bSNicholas Bellinger { 12836700425eSSagi Grimberg struct isert_conn *isert_conn = conn->context; 1284b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd; 1285d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd; 1286b8d26b3bSNicholas Bellinger 1287676687c6SNicholas Bellinger cmd = iscsit_allocate_cmd(conn, TASK_INTERRUPTIBLE); 1288d703ce2fSNicholas Bellinger if (!cmd) { 128924f412ddSSagi Grimberg isert_err("Unable to allocate iscsi_cmd + isert_cmd\n"); 1290b8d26b3bSNicholas Bellinger return NULL; 1291b8d26b3bSNicholas Bellinger } 1292d703ce2fSNicholas Bellinger isert_cmd = iscsit_priv_cmd(cmd); 1293b8d26b3bSNicholas Bellinger isert_cmd->conn = isert_conn; 1294d703ce2fSNicholas Bellinger isert_cmd->iscsi_cmd = cmd; 1295b8d26b3bSNicholas Bellinger 1296d703ce2fSNicholas Bellinger return cmd; 1297b8d26b3bSNicholas Bellinger } 1298b8d26b3bSNicholas Bellinger 1299b8d26b3bSNicholas Bellinger static int 1300b8d26b3bSNicholas Bellinger isert_handle_scsi_cmd(struct isert_conn *isert_conn, 1301d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd, struct iscsi_cmd *cmd, 1302d703ce2fSNicholas Bellinger struct iser_rx_desc *rx_desc, unsigned char *buf) 1303b8d26b3bSNicholas Bellinger { 1304b8d26b3bSNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1305b8d26b3bSNicholas Bellinger struct iscsi_scsi_req *hdr = (struct iscsi_scsi_req *)buf; 1306b8d26b3bSNicholas Bellinger struct scatterlist *sg; 1307b8d26b3bSNicholas Bellinger int imm_data, imm_data_len, unsol_data, sg_nents, rc; 1308b8d26b3bSNicholas Bellinger bool dump_payload = false; 1309b8d26b3bSNicholas Bellinger 1310b8d26b3bSNicholas Bellinger rc = iscsit_setup_scsi_cmd(conn, cmd, buf); 1311b8d26b3bSNicholas Bellinger if (rc < 0) 1312b8d26b3bSNicholas Bellinger return rc; 1313b8d26b3bSNicholas Bellinger 1314b8d26b3bSNicholas Bellinger imm_data = cmd->immediate_data; 1315b8d26b3bSNicholas Bellinger imm_data_len = cmd->first_burst_len; 1316b8d26b3bSNicholas Bellinger unsol_data = cmd->unsolicited_data; 1317b8d26b3bSNicholas Bellinger 1318b8d26b3bSNicholas Bellinger rc = iscsit_process_scsi_cmd(conn, cmd, hdr); 1319b8d26b3bSNicholas Bellinger if (rc < 0) { 1320b8d26b3bSNicholas Bellinger return 0; 1321b8d26b3bSNicholas Bellinger } else if (rc > 0) { 1322b8d26b3bSNicholas Bellinger dump_payload = true; 1323b8d26b3bSNicholas Bellinger goto sequence_cmd; 1324b8d26b3bSNicholas Bellinger } 1325b8d26b3bSNicholas Bellinger 1326b8d26b3bSNicholas Bellinger if (!imm_data) 1327b8d26b3bSNicholas Bellinger return 0; 1328b8d26b3bSNicholas Bellinger 1329b8d26b3bSNicholas Bellinger sg = &cmd->se_cmd.t_data_sg[0]; 1330b8d26b3bSNicholas Bellinger sg_nents = max(1UL, DIV_ROUND_UP(imm_data_len, PAGE_SIZE)); 1331b8d26b3bSNicholas Bellinger 133224f412ddSSagi Grimberg isert_dbg("Copying Immediate SG: %p sg_nents: %u from %p imm_data_len: %d\n", 1333b8d26b3bSNicholas Bellinger sg, sg_nents, &rx_desc->data[0], imm_data_len); 1334b8d26b3bSNicholas Bellinger 1335b8d26b3bSNicholas Bellinger sg_copy_from_buffer(sg, sg_nents, &rx_desc->data[0], imm_data_len); 1336b8d26b3bSNicholas Bellinger 1337b8d26b3bSNicholas Bellinger cmd->write_data_done += imm_data_len; 1338b8d26b3bSNicholas Bellinger 1339b8d26b3bSNicholas Bellinger if (cmd->write_data_done == cmd->se_cmd.data_length) { 1340b8d26b3bSNicholas Bellinger spin_lock_bh(&cmd->istate_lock); 1341b8d26b3bSNicholas Bellinger cmd->cmd_flags |= ICF_GOT_LAST_DATAOUT; 1342b8d26b3bSNicholas Bellinger cmd->i_state = ISTATE_RECEIVED_LAST_DATAOUT; 1343b8d26b3bSNicholas Bellinger spin_unlock_bh(&cmd->istate_lock); 1344b8d26b3bSNicholas Bellinger } 1345b8d26b3bSNicholas Bellinger 1346b8d26b3bSNicholas Bellinger sequence_cmd: 1347561bf158SNicholas Bellinger rc = iscsit_sequence_cmd(conn, cmd, buf, hdr->cmdsn); 1348b8d26b3bSNicholas Bellinger 1349b8d26b3bSNicholas Bellinger if (!rc && dump_payload == false && unsol_data) 1350b8d26b3bSNicholas Bellinger iscsit_set_unsoliticed_dataout(cmd); 13516cc44a6fSNicholas Bellinger else if (dump_payload && imm_data) 1352afc16604SBart Van Assche target_put_sess_cmd(&cmd->se_cmd); 1353b8d26b3bSNicholas Bellinger 1354b8d26b3bSNicholas Bellinger return 0; 1355b8d26b3bSNicholas Bellinger } 1356b8d26b3bSNicholas Bellinger 1357b8d26b3bSNicholas Bellinger static int 1358b8d26b3bSNicholas Bellinger isert_handle_iscsi_dataout(struct isert_conn *isert_conn, 1359b8d26b3bSNicholas Bellinger struct iser_rx_desc *rx_desc, unsigned char *buf) 1360b8d26b3bSNicholas Bellinger { 1361b8d26b3bSNicholas Bellinger struct scatterlist *sg_start; 1362b8d26b3bSNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1363b8d26b3bSNicholas Bellinger struct iscsi_cmd *cmd = NULL; 1364b8d26b3bSNicholas Bellinger struct iscsi_data *hdr = (struct iscsi_data *)buf; 1365b8d26b3bSNicholas Bellinger u32 unsol_data_len = ntoh24(hdr->dlength); 1366b8d26b3bSNicholas Bellinger int rc, sg_nents, sg_off, page_off; 1367b8d26b3bSNicholas Bellinger 1368b8d26b3bSNicholas Bellinger rc = iscsit_check_dataout_hdr(conn, buf, &cmd); 1369b8d26b3bSNicholas Bellinger if (rc < 0) 1370b8d26b3bSNicholas Bellinger return rc; 1371b8d26b3bSNicholas Bellinger else if (!cmd) 1372b8d26b3bSNicholas Bellinger return 0; 1373b8d26b3bSNicholas Bellinger /* 1374b8d26b3bSNicholas Bellinger * FIXME: Unexpected unsolicited_data out 1375b8d26b3bSNicholas Bellinger */ 1376b8d26b3bSNicholas Bellinger if (!cmd->unsolicited_data) { 137724f412ddSSagi Grimberg isert_err("Received unexpected solicited data payload\n"); 1378b8d26b3bSNicholas Bellinger dump_stack(); 1379b8d26b3bSNicholas Bellinger return -1; 1380b8d26b3bSNicholas Bellinger } 1381b8d26b3bSNicholas Bellinger 13824c22e07fSSagi Grimberg isert_dbg("Unsolicited DataOut unsol_data_len: %u, " 13834c22e07fSSagi Grimberg "write_data_done: %u, data_length: %u\n", 13844c22e07fSSagi Grimberg unsol_data_len, cmd->write_data_done, 13854c22e07fSSagi Grimberg cmd->se_cmd.data_length); 1386b8d26b3bSNicholas Bellinger 1387b8d26b3bSNicholas Bellinger sg_off = cmd->write_data_done / PAGE_SIZE; 1388b8d26b3bSNicholas Bellinger sg_start = &cmd->se_cmd.t_data_sg[sg_off]; 1389b8d26b3bSNicholas Bellinger sg_nents = max(1UL, DIV_ROUND_UP(unsol_data_len, PAGE_SIZE)); 1390b8d26b3bSNicholas Bellinger page_off = cmd->write_data_done % PAGE_SIZE; 1391b8d26b3bSNicholas Bellinger /* 1392b8d26b3bSNicholas Bellinger * FIXME: Non page-aligned unsolicited_data out 1393b8d26b3bSNicholas Bellinger */ 1394b8d26b3bSNicholas Bellinger if (page_off) { 13954c22e07fSSagi Grimberg isert_err("unexpected non-page aligned data payload\n"); 1396b8d26b3bSNicholas Bellinger dump_stack(); 1397b8d26b3bSNicholas Bellinger return -1; 1398b8d26b3bSNicholas Bellinger } 13994c22e07fSSagi Grimberg isert_dbg("Copying DataOut: sg_start: %p, sg_off: %u " 14004c22e07fSSagi Grimberg "sg_nents: %u from %p %u\n", sg_start, sg_off, 14014c22e07fSSagi Grimberg sg_nents, &rx_desc->data[0], unsol_data_len); 1402b8d26b3bSNicholas Bellinger 1403b8d26b3bSNicholas Bellinger sg_copy_from_buffer(sg_start, sg_nents, &rx_desc->data[0], 1404b8d26b3bSNicholas Bellinger unsol_data_len); 1405b8d26b3bSNicholas Bellinger 1406b8d26b3bSNicholas Bellinger rc = iscsit_check_dataout_payload(cmd, hdr, false); 1407b8d26b3bSNicholas Bellinger if (rc < 0) 1408b8d26b3bSNicholas Bellinger return rc; 1409b8d26b3bSNicholas Bellinger 1410b8d26b3bSNicholas Bellinger return 0; 1411b8d26b3bSNicholas Bellinger } 1412b8d26b3bSNicholas Bellinger 1413b8d26b3bSNicholas Bellinger static int 1414778de368SNicholas Bellinger isert_handle_nop_out(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd, 1415d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd, struct iser_rx_desc *rx_desc, 1416d703ce2fSNicholas Bellinger unsigned char *buf) 1417778de368SNicholas Bellinger { 1418778de368SNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1419778de368SNicholas Bellinger struct iscsi_nopout *hdr = (struct iscsi_nopout *)buf; 1420778de368SNicholas Bellinger int rc; 1421778de368SNicholas Bellinger 1422778de368SNicholas Bellinger rc = iscsit_setup_nop_out(conn, cmd, hdr); 1423778de368SNicholas Bellinger if (rc < 0) 1424778de368SNicholas Bellinger return rc; 1425778de368SNicholas Bellinger /* 1426778de368SNicholas Bellinger * FIXME: Add support for NOPOUT payload using unsolicited RDMA payload 1427778de368SNicholas Bellinger */ 1428778de368SNicholas Bellinger 1429778de368SNicholas Bellinger return iscsit_process_nop_out(conn, cmd, hdr); 1430778de368SNicholas Bellinger } 1431778de368SNicholas Bellinger 1432778de368SNicholas Bellinger static int 1433adb54c29SNicholas Bellinger isert_handle_text_cmd(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd, 1434d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd, struct iser_rx_desc *rx_desc, 1435d703ce2fSNicholas Bellinger struct iscsi_text *hdr) 1436adb54c29SNicholas Bellinger { 1437adb54c29SNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1438adb54c29SNicholas Bellinger u32 payload_length = ntoh24(hdr->dlength); 1439adb54c29SNicholas Bellinger int rc; 1440b44a2b67SSagi Grimberg unsigned char *text_in = NULL; 1441adb54c29SNicholas Bellinger 1442adb54c29SNicholas Bellinger rc = iscsit_setup_text_cmd(conn, cmd, hdr); 1443adb54c29SNicholas Bellinger if (rc < 0) 1444adb54c29SNicholas Bellinger return rc; 1445adb54c29SNicholas Bellinger 1446b44a2b67SSagi Grimberg if (payload_length) { 1447adb54c29SNicholas Bellinger text_in = kzalloc(payload_length, GFP_KERNEL); 1448adb54c29SNicholas Bellinger if (!text_in) { 144924f412ddSSagi Grimberg isert_err("Unable to allocate text_in of payload_length: %u\n", 1450adb54c29SNicholas Bellinger payload_length); 1451adb54c29SNicholas Bellinger return -ENOMEM; 1452adb54c29SNicholas Bellinger } 1453b44a2b67SSagi Grimberg } 1454adb54c29SNicholas Bellinger cmd->text_in_ptr = text_in; 1455adb54c29SNicholas Bellinger 1456adb54c29SNicholas Bellinger memcpy(cmd->text_in_ptr, &rx_desc->data[0], payload_length); 1457adb54c29SNicholas Bellinger 1458adb54c29SNicholas Bellinger return iscsit_process_text_cmd(conn, cmd, hdr); 1459adb54c29SNicholas Bellinger } 1460adb54c29SNicholas Bellinger 1461adb54c29SNicholas Bellinger static int 1462b8d26b3bSNicholas Bellinger isert_rx_opcode(struct isert_conn *isert_conn, struct iser_rx_desc *rx_desc, 1463b8d26b3bSNicholas Bellinger uint32_t read_stag, uint64_t read_va, 1464b8d26b3bSNicholas Bellinger uint32_t write_stag, uint64_t write_va) 1465b8d26b3bSNicholas Bellinger { 1466b8d26b3bSNicholas Bellinger struct iscsi_hdr *hdr = &rx_desc->iscsi_header; 1467b8d26b3bSNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1468b8d26b3bSNicholas Bellinger struct iscsi_cmd *cmd; 1469b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd; 1470b8d26b3bSNicholas Bellinger int ret = -EINVAL; 1471b8d26b3bSNicholas Bellinger u8 opcode = (hdr->opcode & ISCSI_OPCODE_MASK); 1472b8d26b3bSNicholas Bellinger 1473fb140271SSagi Grimberg if (conn->sess->sess_ops->SessionType && 1474ca40d24eSNicholas Bellinger (!(opcode & ISCSI_OP_TEXT) || !(opcode & ISCSI_OP_LOGOUT))) { 147524f412ddSSagi Grimberg isert_err("Got illegal opcode: 0x%02x in SessionType=Discovery," 1476ca40d24eSNicholas Bellinger " ignoring\n", opcode); 1477ca40d24eSNicholas Bellinger return 0; 1478ca40d24eSNicholas Bellinger } 1479ca40d24eSNicholas Bellinger 1480b8d26b3bSNicholas Bellinger switch (opcode) { 1481b8d26b3bSNicholas Bellinger case ISCSI_OP_SCSI_CMD: 1482676687c6SNicholas Bellinger cmd = isert_allocate_cmd(conn); 1483b8d26b3bSNicholas Bellinger if (!cmd) 1484b8d26b3bSNicholas Bellinger break; 1485b8d26b3bSNicholas Bellinger 1486d703ce2fSNicholas Bellinger isert_cmd = iscsit_priv_cmd(cmd); 1487b8d26b3bSNicholas Bellinger isert_cmd->read_stag = read_stag; 1488b8d26b3bSNicholas Bellinger isert_cmd->read_va = read_va; 1489b8d26b3bSNicholas Bellinger isert_cmd->write_stag = write_stag; 1490b8d26b3bSNicholas Bellinger isert_cmd->write_va = write_va; 1491b8d26b3bSNicholas Bellinger 1492d703ce2fSNicholas Bellinger ret = isert_handle_scsi_cmd(isert_conn, isert_cmd, cmd, 1493b8d26b3bSNicholas Bellinger rx_desc, (unsigned char *)hdr); 1494b8d26b3bSNicholas Bellinger break; 1495b8d26b3bSNicholas Bellinger case ISCSI_OP_NOOP_OUT: 1496676687c6SNicholas Bellinger cmd = isert_allocate_cmd(conn); 1497b8d26b3bSNicholas Bellinger if (!cmd) 1498b8d26b3bSNicholas Bellinger break; 1499b8d26b3bSNicholas Bellinger 1500d703ce2fSNicholas Bellinger isert_cmd = iscsit_priv_cmd(cmd); 1501d703ce2fSNicholas Bellinger ret = isert_handle_nop_out(isert_conn, isert_cmd, cmd, 1502778de368SNicholas Bellinger rx_desc, (unsigned char *)hdr); 1503b8d26b3bSNicholas Bellinger break; 1504b8d26b3bSNicholas Bellinger case ISCSI_OP_SCSI_DATA_OUT: 1505b8d26b3bSNicholas Bellinger ret = isert_handle_iscsi_dataout(isert_conn, rx_desc, 1506b8d26b3bSNicholas Bellinger (unsigned char *)hdr); 1507b8d26b3bSNicholas Bellinger break; 1508b8d26b3bSNicholas Bellinger case ISCSI_OP_SCSI_TMFUNC: 1509676687c6SNicholas Bellinger cmd = isert_allocate_cmd(conn); 1510b8d26b3bSNicholas Bellinger if (!cmd) 1511b8d26b3bSNicholas Bellinger break; 1512b8d26b3bSNicholas Bellinger 1513b8d26b3bSNicholas Bellinger ret = iscsit_handle_task_mgt_cmd(conn, cmd, 1514b8d26b3bSNicholas Bellinger (unsigned char *)hdr); 1515b8d26b3bSNicholas Bellinger break; 1516b8d26b3bSNicholas Bellinger case ISCSI_OP_LOGOUT: 1517676687c6SNicholas Bellinger cmd = isert_allocate_cmd(conn); 1518b8d26b3bSNicholas Bellinger if (!cmd) 1519b8d26b3bSNicholas Bellinger break; 1520b8d26b3bSNicholas Bellinger 1521b8d26b3bSNicholas Bellinger ret = iscsit_handle_logout_cmd(conn, cmd, (unsigned char *)hdr); 1522b8d26b3bSNicholas Bellinger break; 1523adb54c29SNicholas Bellinger case ISCSI_OP_TEXT: 1524e4f4e801SSagi Grimberg if (be32_to_cpu(hdr->ttt) != 0xFFFFFFFF) { 1525e4f4e801SSagi Grimberg cmd = iscsit_find_cmd_from_itt(conn, hdr->itt); 1526e4f4e801SSagi Grimberg if (!cmd) 1527e4f4e801SSagi Grimberg break; 1528e4f4e801SSagi Grimberg } else { 1529676687c6SNicholas Bellinger cmd = isert_allocate_cmd(conn); 1530adb54c29SNicholas Bellinger if (!cmd) 1531adb54c29SNicholas Bellinger break; 1532e4f4e801SSagi Grimberg } 1533adb54c29SNicholas Bellinger 1534d703ce2fSNicholas Bellinger isert_cmd = iscsit_priv_cmd(cmd); 1535d703ce2fSNicholas Bellinger ret = isert_handle_text_cmd(isert_conn, isert_cmd, cmd, 1536adb54c29SNicholas Bellinger rx_desc, (struct iscsi_text *)hdr); 1537adb54c29SNicholas Bellinger break; 1538b8d26b3bSNicholas Bellinger default: 153924f412ddSSagi Grimberg isert_err("Got unknown iSCSI OpCode: 0x%02x\n", opcode); 1540b8d26b3bSNicholas Bellinger dump_stack(); 1541b8d26b3bSNicholas Bellinger break; 1542b8d26b3bSNicholas Bellinger } 1543b8d26b3bSNicholas Bellinger 1544b8d26b3bSNicholas Bellinger return ret; 1545b8d26b3bSNicholas Bellinger } 1546b8d26b3bSNicholas Bellinger 1547b8d26b3bSNicholas Bellinger static void 1548b8d26b3bSNicholas Bellinger isert_rx_do_work(struct iser_rx_desc *rx_desc, struct isert_conn *isert_conn) 1549b8d26b3bSNicholas Bellinger { 1550b8d26b3bSNicholas Bellinger struct iser_hdr *iser_hdr = &rx_desc->iser_header; 1551b8d26b3bSNicholas Bellinger uint64_t read_va = 0, write_va = 0; 1552b8d26b3bSNicholas Bellinger uint32_t read_stag = 0, write_stag = 0; 1553b8d26b3bSNicholas Bellinger int rc; 1554b8d26b3bSNicholas Bellinger 1555b8d26b3bSNicholas Bellinger switch (iser_hdr->flags & 0xF0) { 1556b8d26b3bSNicholas Bellinger case ISCSI_CTRL: 1557b8d26b3bSNicholas Bellinger if (iser_hdr->flags & ISER_RSV) { 1558b8d26b3bSNicholas Bellinger read_stag = be32_to_cpu(iser_hdr->read_stag); 1559b8d26b3bSNicholas Bellinger read_va = be64_to_cpu(iser_hdr->read_va); 15604c22e07fSSagi Grimberg isert_dbg("ISER_RSV: read_stag: 0x%x read_va: 0x%llx\n", 1561b8d26b3bSNicholas Bellinger read_stag, (unsigned long long)read_va); 1562b8d26b3bSNicholas Bellinger } 1563b8d26b3bSNicholas Bellinger if (iser_hdr->flags & ISER_WSV) { 1564b8d26b3bSNicholas Bellinger write_stag = be32_to_cpu(iser_hdr->write_stag); 1565b8d26b3bSNicholas Bellinger write_va = be64_to_cpu(iser_hdr->write_va); 15664c22e07fSSagi Grimberg isert_dbg("ISER_WSV: write_stag: 0x%x write_va: 0x%llx\n", 1567b8d26b3bSNicholas Bellinger write_stag, (unsigned long long)write_va); 1568b8d26b3bSNicholas Bellinger } 1569b8d26b3bSNicholas Bellinger 157024f412ddSSagi Grimberg isert_dbg("ISER ISCSI_CTRL PDU\n"); 1571b8d26b3bSNicholas Bellinger break; 1572b8d26b3bSNicholas Bellinger case ISER_HELLO: 157324f412ddSSagi Grimberg isert_err("iSER Hello message\n"); 1574b8d26b3bSNicholas Bellinger break; 1575b8d26b3bSNicholas Bellinger default: 157624f412ddSSagi Grimberg isert_warn("Unknown iSER hdr flags: 0x%02x\n", iser_hdr->flags); 1577b8d26b3bSNicholas Bellinger break; 1578b8d26b3bSNicholas Bellinger } 1579b8d26b3bSNicholas Bellinger 1580b8d26b3bSNicholas Bellinger rc = isert_rx_opcode(isert_conn, rx_desc, 1581b8d26b3bSNicholas Bellinger read_stag, read_va, write_stag, write_va); 1582b8d26b3bSNicholas Bellinger } 1583b8d26b3bSNicholas Bellinger 1584b8d26b3bSNicholas Bellinger static void 15857748681bSSagi Grimberg isert_rcv_completion(struct iser_rx_desc *desc, 15867748681bSSagi Grimberg struct isert_conn *isert_conn, 15874a295baeSSagi Grimberg u32 xfer_len) 1588b8d26b3bSNicholas Bellinger { 1589dac6ab30SSagi Grimberg struct ib_device *ib_dev = isert_conn->cm_id->device; 1590b8d26b3bSNicholas Bellinger struct iscsi_hdr *hdr; 1591b8d26b3bSNicholas Bellinger u64 rx_dma; 1592b8d26b3bSNicholas Bellinger int rx_buflen, outstanding; 1593b8d26b3bSNicholas Bellinger 1594b8d26b3bSNicholas Bellinger if ((char *)desc == isert_conn->login_req_buf) { 1595b8d26b3bSNicholas Bellinger rx_dma = isert_conn->login_req_dma; 1596b8d26b3bSNicholas Bellinger rx_buflen = ISER_RX_LOGIN_SIZE; 15974c22e07fSSagi Grimberg isert_dbg("login_buf: Using rx_dma: 0x%llx, rx_buflen: %d\n", 1598b8d26b3bSNicholas Bellinger rx_dma, rx_buflen); 1599b8d26b3bSNicholas Bellinger } else { 1600b8d26b3bSNicholas Bellinger rx_dma = desc->dma_addr; 1601b8d26b3bSNicholas Bellinger rx_buflen = ISER_RX_PAYLOAD_SIZE; 16024c22e07fSSagi Grimberg isert_dbg("req_buf: Using rx_dma: 0x%llx, rx_buflen: %d\n", 1603b8d26b3bSNicholas Bellinger rx_dma, rx_buflen); 1604b8d26b3bSNicholas Bellinger } 1605b8d26b3bSNicholas Bellinger 1606b8d26b3bSNicholas Bellinger ib_dma_sync_single_for_cpu(ib_dev, rx_dma, rx_buflen, DMA_FROM_DEVICE); 1607b8d26b3bSNicholas Bellinger 1608b8d26b3bSNicholas Bellinger hdr = &desc->iscsi_header; 160924f412ddSSagi Grimberg isert_dbg("iSCSI opcode: 0x%02x, ITT: 0x%08x, flags: 0x%02x dlen: %d\n", 1610b8d26b3bSNicholas Bellinger hdr->opcode, hdr->itt, hdr->flags, 1611b8d26b3bSNicholas Bellinger (int)(xfer_len - ISER_HEADERS_LEN)); 1612b8d26b3bSNicholas Bellinger 16132371e5daSSagi Grimberg if ((char *)desc == isert_conn->login_req_buf) { 16142371e5daSSagi Grimberg isert_conn->login_req_len = xfer_len - ISER_HEADERS_LEN; 16152371e5daSSagi Grimberg if (isert_conn->conn) { 16162371e5daSSagi Grimberg struct iscsi_login *login = isert_conn->conn->conn_login; 16172371e5daSSagi Grimberg 16182371e5daSSagi Grimberg if (login && !login->first_request) 16192371e5daSSagi Grimberg isert_rx_login_req(isert_conn); 16202371e5daSSagi Grimberg } 1621dac6ab30SSagi Grimberg mutex_lock(&isert_conn->mutex); 16222371e5daSSagi Grimberg complete(&isert_conn->login_req_comp); 1623dac6ab30SSagi Grimberg mutex_unlock(&isert_conn->mutex); 16242371e5daSSagi Grimberg } else { 1625b8d26b3bSNicholas Bellinger isert_rx_do_work(desc, isert_conn); 16262371e5daSSagi Grimberg } 1627b8d26b3bSNicholas Bellinger 1628b8d26b3bSNicholas Bellinger ib_dma_sync_single_for_device(ib_dev, rx_dma, rx_buflen, 1629b8d26b3bSNicholas Bellinger DMA_FROM_DEVICE); 1630b8d26b3bSNicholas Bellinger 1631b8d26b3bSNicholas Bellinger isert_conn->post_recv_buf_count--; 16324c22e07fSSagi Grimberg isert_dbg("Decremented post_recv_buf_count: %d\n", 1633b8d26b3bSNicholas Bellinger isert_conn->post_recv_buf_count); 1634b8d26b3bSNicholas Bellinger 1635b8d26b3bSNicholas Bellinger if ((char *)desc == isert_conn->login_req_buf) 1636b8d26b3bSNicholas Bellinger return; 1637b8d26b3bSNicholas Bellinger 1638b8d26b3bSNicholas Bellinger outstanding = isert_conn->post_recv_buf_count; 1639b8d26b3bSNicholas Bellinger if (outstanding + ISERT_MIN_POSTED_RX <= ISERT_QP_MAX_RECV_DTOS) { 1640b8d26b3bSNicholas Bellinger int err, count = min(ISERT_QP_MAX_RECV_DTOS - outstanding, 1641b8d26b3bSNicholas Bellinger ISERT_MIN_POSTED_RX); 1642b8d26b3bSNicholas Bellinger err = isert_post_recv(isert_conn, count); 1643b8d26b3bSNicholas Bellinger if (err) { 164424f412ddSSagi Grimberg isert_err("isert_post_recv() count: %d failed, %d\n", 1645b8d26b3bSNicholas Bellinger count, err); 1646b8d26b3bSNicholas Bellinger } 1647b8d26b3bSNicholas Bellinger } 1648b8d26b3bSNicholas Bellinger } 1649b8d26b3bSNicholas Bellinger 1650e3d7e4c3SSagi Grimberg static int 1651e3d7e4c3SSagi Grimberg isert_map_data_buf(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd, 1652e3d7e4c3SSagi Grimberg struct scatterlist *sg, u32 nents, u32 length, u32 offset, 1653e3d7e4c3SSagi Grimberg enum iser_ib_op_code op, struct isert_data_buf *data) 1654e3d7e4c3SSagi Grimberg { 1655dac6ab30SSagi Grimberg struct ib_device *ib_dev = isert_conn->cm_id->device; 1656e3d7e4c3SSagi Grimberg 1657e3d7e4c3SSagi Grimberg data->dma_dir = op == ISER_IB_RDMA_WRITE ? 1658e3d7e4c3SSagi Grimberg DMA_TO_DEVICE : DMA_FROM_DEVICE; 1659e3d7e4c3SSagi Grimberg 1660e3d7e4c3SSagi Grimberg data->len = length - offset; 1661e3d7e4c3SSagi Grimberg data->offset = offset; 1662e3d7e4c3SSagi Grimberg data->sg_off = data->offset / PAGE_SIZE; 1663e3d7e4c3SSagi Grimberg 1664e3d7e4c3SSagi Grimberg data->sg = &sg[data->sg_off]; 1665e3d7e4c3SSagi Grimberg data->nents = min_t(unsigned int, nents - data->sg_off, 1666e3d7e4c3SSagi Grimberg ISCSI_ISER_SG_TABLESIZE); 1667e3d7e4c3SSagi Grimberg data->len = min_t(unsigned int, data->len, ISCSI_ISER_SG_TABLESIZE * 1668e3d7e4c3SSagi Grimberg PAGE_SIZE); 1669e3d7e4c3SSagi Grimberg 1670e3d7e4c3SSagi Grimberg data->dma_nents = ib_dma_map_sg(ib_dev, data->sg, data->nents, 1671e3d7e4c3SSagi Grimberg data->dma_dir); 1672e3d7e4c3SSagi Grimberg if (unlikely(!data->dma_nents)) { 167324f412ddSSagi Grimberg isert_err("Cmd: unable to dma map SGs %p\n", sg); 1674e3d7e4c3SSagi Grimberg return -EINVAL; 1675e3d7e4c3SSagi Grimberg } 1676e3d7e4c3SSagi Grimberg 167724f412ddSSagi Grimberg isert_dbg("Mapped cmd: %p count: %u sg: %p sg_nents: %u rdma_len %d\n", 1678e3d7e4c3SSagi Grimberg isert_cmd, data->dma_nents, data->sg, data->nents, data->len); 1679e3d7e4c3SSagi Grimberg 1680e3d7e4c3SSagi Grimberg return 0; 1681e3d7e4c3SSagi Grimberg } 1682e3d7e4c3SSagi Grimberg 1683e3d7e4c3SSagi Grimberg static void 1684e3d7e4c3SSagi Grimberg isert_unmap_data_buf(struct isert_conn *isert_conn, struct isert_data_buf *data) 1685e3d7e4c3SSagi Grimberg { 1686dac6ab30SSagi Grimberg struct ib_device *ib_dev = isert_conn->cm_id->device; 1687e3d7e4c3SSagi Grimberg 1688e3d7e4c3SSagi Grimberg ib_dma_unmap_sg(ib_dev, data->sg, data->nents, data->dma_dir); 1689e3d7e4c3SSagi Grimberg memset(data, 0, sizeof(*data)); 1690e3d7e4c3SSagi Grimberg } 1691e3d7e4c3SSagi Grimberg 1692e3d7e4c3SSagi Grimberg 1693e3d7e4c3SSagi Grimberg 1694b8d26b3bSNicholas Bellinger static void 1695b8d26b3bSNicholas Bellinger isert_unmap_cmd(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn) 1696b8d26b3bSNicholas Bellinger { 1697b8d26b3bSNicholas Bellinger struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 1698b8d26b3bSNicholas Bellinger 16994c22e07fSSagi Grimberg isert_dbg("Cmd %p\n", isert_cmd); 1700e3d7e4c3SSagi Grimberg 1701e3d7e4c3SSagi Grimberg if (wr->data.sg) { 17024c22e07fSSagi Grimberg isert_dbg("Cmd %p unmap_sg op\n", isert_cmd); 1703e3d7e4c3SSagi Grimberg isert_unmap_data_buf(isert_conn, &wr->data); 1704b8d26b3bSNicholas Bellinger } 1705b8d26b3bSNicholas Bellinger 170690ecc6e2SVu Pham if (wr->send_wr) { 17074c22e07fSSagi Grimberg isert_dbg("Cmd %p free send_wr\n", isert_cmd); 1708b8d26b3bSNicholas Bellinger kfree(wr->send_wr); 1709b8d26b3bSNicholas Bellinger wr->send_wr = NULL; 171090ecc6e2SVu Pham } 1711b8d26b3bSNicholas Bellinger 171290ecc6e2SVu Pham if (wr->ib_sge) { 17134c22e07fSSagi Grimberg isert_dbg("Cmd %p free ib_sge\n", isert_cmd); 171490ecc6e2SVu Pham kfree(wr->ib_sge); 171590ecc6e2SVu Pham wr->ib_sge = NULL; 171690ecc6e2SVu Pham } 1717b8d26b3bSNicholas Bellinger } 1718b8d26b3bSNicholas Bellinger 1719b8d26b3bSNicholas Bellinger static void 1720a3a5a826SSagi Grimberg isert_unreg_rdma(struct isert_cmd *isert_cmd, struct isert_conn *isert_conn) 172159464ef4SVu Pham { 172259464ef4SVu Pham struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 172359464ef4SVu Pham 17244c22e07fSSagi Grimberg isert_dbg("Cmd %p\n", isert_cmd); 172559464ef4SVu Pham 172659464ef4SVu Pham if (wr->fr_desc) { 17274c22e07fSSagi Grimberg isert_dbg("Cmd %p free fr_desc %p\n", isert_cmd, wr->fr_desc); 17289e961ae7SSagi Grimberg if (wr->fr_desc->ind & ISERT_PROTECTED) { 17299e961ae7SSagi Grimberg isert_unmap_data_buf(isert_conn, &wr->prot); 17309e961ae7SSagi Grimberg wr->fr_desc->ind &= ~ISERT_PROTECTED; 17319e961ae7SSagi Grimberg } 1732dac6ab30SSagi Grimberg spin_lock_bh(&isert_conn->pool_lock); 1733dac6ab30SSagi Grimberg list_add_tail(&wr->fr_desc->list, &isert_conn->fr_pool); 1734dac6ab30SSagi Grimberg spin_unlock_bh(&isert_conn->pool_lock); 173559464ef4SVu Pham wr->fr_desc = NULL; 173659464ef4SVu Pham } 173759464ef4SVu Pham 1738e3d7e4c3SSagi Grimberg if (wr->data.sg) { 17394c22e07fSSagi Grimberg isert_dbg("Cmd %p unmap_sg op\n", isert_cmd); 1740e3d7e4c3SSagi Grimberg isert_unmap_data_buf(isert_conn, &wr->data); 174159464ef4SVu Pham } 174259464ef4SVu Pham 174359464ef4SVu Pham wr->ib_sge = NULL; 174459464ef4SVu Pham wr->send_wr = NULL; 174559464ef4SVu Pham } 174659464ef4SVu Pham 174759464ef4SVu Pham static void 174803e7848aSNicholas Bellinger isert_put_cmd(struct isert_cmd *isert_cmd, bool comp_err) 1749b8d26b3bSNicholas Bellinger { 1750d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd; 1751b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = isert_cmd->conn; 1752186a9647SNicholas Bellinger struct iscsi_conn *conn = isert_conn->conn; 1753dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 1754e4f4e801SSagi Grimberg struct iscsi_text_rsp *hdr; 1755b8d26b3bSNicholas Bellinger 17564c22e07fSSagi Grimberg isert_dbg("Cmd %p\n", isert_cmd); 1757b8d26b3bSNicholas Bellinger 1758b8d26b3bSNicholas Bellinger switch (cmd->iscsi_opcode) { 1759b8d26b3bSNicholas Bellinger case ISCSI_OP_SCSI_CMD: 1760b8d26b3bSNicholas Bellinger spin_lock_bh(&conn->cmd_lock); 1761b8d26b3bSNicholas Bellinger if (!list_empty(&cmd->i_conn_node)) 17625159d763SNicholas Bellinger list_del_init(&cmd->i_conn_node); 1763b8d26b3bSNicholas Bellinger spin_unlock_bh(&conn->cmd_lock); 1764b8d26b3bSNicholas Bellinger 176503e7848aSNicholas Bellinger if (cmd->data_direction == DMA_TO_DEVICE) { 1766b8d26b3bSNicholas Bellinger iscsit_stop_dataout_timer(cmd); 176703e7848aSNicholas Bellinger /* 176803e7848aSNicholas Bellinger * Check for special case during comp_err where 176903e7848aSNicholas Bellinger * WRITE_PENDING has been handed off from core, 177003e7848aSNicholas Bellinger * but requires an extra target_put_sess_cmd() 177103e7848aSNicholas Bellinger * before transport_generic_free_cmd() below. 177203e7848aSNicholas Bellinger */ 177303e7848aSNicholas Bellinger if (comp_err && 177403e7848aSNicholas Bellinger cmd->se_cmd.t_state == TRANSPORT_WRITE_PENDING) { 177503e7848aSNicholas Bellinger struct se_cmd *se_cmd = &cmd->se_cmd; 177603e7848aSNicholas Bellinger 1777afc16604SBart Van Assche target_put_sess_cmd(se_cmd); 177803e7848aSNicholas Bellinger } 177903e7848aSNicholas Bellinger } 1780b8d26b3bSNicholas Bellinger 1781d40945d8SVu Pham device->unreg_rdma_mem(isert_cmd, isert_conn); 1782186a9647SNicholas Bellinger transport_generic_free_cmd(&cmd->se_cmd, 0); 1783186a9647SNicholas Bellinger break; 1784b8d26b3bSNicholas Bellinger case ISCSI_OP_SCSI_TMFUNC: 1785186a9647SNicholas Bellinger spin_lock_bh(&conn->cmd_lock); 1786186a9647SNicholas Bellinger if (!list_empty(&cmd->i_conn_node)) 17875159d763SNicholas Bellinger list_del_init(&cmd->i_conn_node); 1788186a9647SNicholas Bellinger spin_unlock_bh(&conn->cmd_lock); 1789186a9647SNicholas Bellinger 1790b8d26b3bSNicholas Bellinger transport_generic_free_cmd(&cmd->se_cmd, 0); 1791b8d26b3bSNicholas Bellinger break; 1792b8d26b3bSNicholas Bellinger case ISCSI_OP_REJECT: 1793b8d26b3bSNicholas Bellinger case ISCSI_OP_NOOP_OUT: 1794adb54c29SNicholas Bellinger case ISCSI_OP_TEXT: 1795e4f4e801SSagi Grimberg hdr = (struct iscsi_text_rsp *)&isert_cmd->tx_desc.iscsi_header; 1796e4f4e801SSagi Grimberg /* If the continue bit is on, keep the command alive */ 1797e4f4e801SSagi Grimberg if (hdr->flags & ISCSI_FLAG_TEXT_CONTINUE) 1798e4f4e801SSagi Grimberg break; 1799e4f4e801SSagi Grimberg 1800b8d26b3bSNicholas Bellinger spin_lock_bh(&conn->cmd_lock); 1801b8d26b3bSNicholas Bellinger if (!list_empty(&cmd->i_conn_node)) 18025159d763SNicholas Bellinger list_del_init(&cmd->i_conn_node); 1803b8d26b3bSNicholas Bellinger spin_unlock_bh(&conn->cmd_lock); 1804b8d26b3bSNicholas Bellinger 1805b8d26b3bSNicholas Bellinger /* 1806b8d26b3bSNicholas Bellinger * Handle special case for REJECT when iscsi_add_reject*() has 1807b8d26b3bSNicholas Bellinger * overwritten the original iscsi_opcode assignment, and the 1808b8d26b3bSNicholas Bellinger * associated cmd->se_cmd needs to be released. 1809b8d26b3bSNicholas Bellinger */ 1810b8d26b3bSNicholas Bellinger if (cmd->se_cmd.se_tfo != NULL) { 181111378cdbSRasmus Villemoes isert_dbg("Calling transport_generic_free_cmd for 0x%02x\n", 18123df8f68aSNicholas Bellinger cmd->iscsi_opcode); 1813b8d26b3bSNicholas Bellinger transport_generic_free_cmd(&cmd->se_cmd, 0); 1814b8d26b3bSNicholas Bellinger break; 1815b8d26b3bSNicholas Bellinger } 1816b8d26b3bSNicholas Bellinger /* 1817b8d26b3bSNicholas Bellinger * Fall-through 1818b8d26b3bSNicholas Bellinger */ 1819b8d26b3bSNicholas Bellinger default: 1820d703ce2fSNicholas Bellinger iscsit_release_cmd(cmd); 1821b8d26b3bSNicholas Bellinger break; 1822b8d26b3bSNicholas Bellinger } 1823b8d26b3bSNicholas Bellinger } 1824b8d26b3bSNicholas Bellinger 1825b8d26b3bSNicholas Bellinger static void 1826b8d26b3bSNicholas Bellinger isert_unmap_tx_desc(struct iser_tx_desc *tx_desc, struct ib_device *ib_dev) 1827b8d26b3bSNicholas Bellinger { 1828b8d26b3bSNicholas Bellinger if (tx_desc->dma_addr != 0) { 18294c22e07fSSagi Grimberg isert_dbg("unmap single for tx_desc->dma_addr\n"); 1830b8d26b3bSNicholas Bellinger ib_dma_unmap_single(ib_dev, tx_desc->dma_addr, 1831b8d26b3bSNicholas Bellinger ISER_HEADERS_LEN, DMA_TO_DEVICE); 1832b8d26b3bSNicholas Bellinger tx_desc->dma_addr = 0; 1833b8d26b3bSNicholas Bellinger } 1834b8d26b3bSNicholas Bellinger } 1835b8d26b3bSNicholas Bellinger 1836b8d26b3bSNicholas Bellinger static void 1837b8d26b3bSNicholas Bellinger isert_completion_put(struct iser_tx_desc *tx_desc, struct isert_cmd *isert_cmd, 183803e7848aSNicholas Bellinger struct ib_device *ib_dev, bool comp_err) 1839b8d26b3bSNicholas Bellinger { 1840dbbc5d11SNicholas Bellinger if (isert_cmd->pdu_buf_dma != 0) { 18414c22e07fSSagi Grimberg isert_dbg("unmap single for isert_cmd->pdu_buf_dma\n"); 1842dbbc5d11SNicholas Bellinger ib_dma_unmap_single(ib_dev, isert_cmd->pdu_buf_dma, 1843dbbc5d11SNicholas Bellinger isert_cmd->pdu_buf_len, DMA_TO_DEVICE); 1844dbbc5d11SNicholas Bellinger isert_cmd->pdu_buf_dma = 0; 1845b8d26b3bSNicholas Bellinger } 1846b8d26b3bSNicholas Bellinger 1847b8d26b3bSNicholas Bellinger isert_unmap_tx_desc(tx_desc, ib_dev); 184803e7848aSNicholas Bellinger isert_put_cmd(isert_cmd, comp_err); 1849b8d26b3bSNicholas Bellinger } 1850b8d26b3bSNicholas Bellinger 185196b7973eSSagi Grimberg static int 185296b7973eSSagi Grimberg isert_check_pi_status(struct se_cmd *se_cmd, struct ib_mr *sig_mr) 1853f93f3a70SSagi Grimberg { 18549e961ae7SSagi Grimberg struct ib_mr_status mr_status; 185596b7973eSSagi Grimberg int ret; 1856f93f3a70SSagi Grimberg 185796b7973eSSagi Grimberg ret = ib_check_mr_status(sig_mr, IB_MR_CHECK_SIG_STATUS, &mr_status); 18589e961ae7SSagi Grimberg if (ret) { 185924f412ddSSagi Grimberg isert_err("ib_check_mr_status failed, ret %d\n", ret); 18609e961ae7SSagi Grimberg goto fail_mr_status; 18619e961ae7SSagi Grimberg } 186296b7973eSSagi Grimberg 18639e961ae7SSagi Grimberg if (mr_status.fail_status & IB_MR_CHECK_SIG_STATUS) { 186496b7973eSSagi Grimberg u64 sec_offset_err; 18659e961ae7SSagi Grimberg u32 block_size = se_cmd->se_dev->dev_attrib.block_size + 8; 18669e961ae7SSagi Grimberg 18679e961ae7SSagi Grimberg switch (mr_status.sig_err.err_type) { 18689e961ae7SSagi Grimberg case IB_SIG_BAD_GUARD: 18699e961ae7SSagi Grimberg se_cmd->pi_err = TCM_LOGICAL_BLOCK_GUARD_CHECK_FAILED; 18709e961ae7SSagi Grimberg break; 18719e961ae7SSagi Grimberg case IB_SIG_BAD_REFTAG: 18729e961ae7SSagi Grimberg se_cmd->pi_err = TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED; 18739e961ae7SSagi Grimberg break; 18749e961ae7SSagi Grimberg case IB_SIG_BAD_APPTAG: 18759e961ae7SSagi Grimberg se_cmd->pi_err = TCM_LOGICAL_BLOCK_APP_TAG_CHECK_FAILED; 18769e961ae7SSagi Grimberg break; 18779e961ae7SSagi Grimberg } 187896b7973eSSagi Grimberg sec_offset_err = mr_status.sig_err.sig_err_offset; 187996b7973eSSagi Grimberg do_div(sec_offset_err, block_size); 188096b7973eSSagi Grimberg se_cmd->bad_sector = sec_offset_err + se_cmd->t_task_lba; 18819e961ae7SSagi Grimberg 18824c22e07fSSagi Grimberg isert_err("PI error found type %d at sector 0x%llx " 18839e961ae7SSagi Grimberg "expected 0x%x vs actual 0x%x\n", 18849e961ae7SSagi Grimberg mr_status.sig_err.err_type, 18859e961ae7SSagi Grimberg (unsigned long long)se_cmd->bad_sector, 18869e961ae7SSagi Grimberg mr_status.sig_err.expected, 18879e961ae7SSagi Grimberg mr_status.sig_err.actual); 18889e961ae7SSagi Grimberg ret = 1; 18899e961ae7SSagi Grimberg } 18909e961ae7SSagi Grimberg 18919e961ae7SSagi Grimberg fail_mr_status: 189296b7973eSSagi Grimberg return ret; 189396b7973eSSagi Grimberg } 189496b7973eSSagi Grimberg 189596b7973eSSagi Grimberg static void 189696b7973eSSagi Grimberg isert_completion_rdma_write(struct iser_tx_desc *tx_desc, 189796b7973eSSagi Grimberg struct isert_cmd *isert_cmd) 189896b7973eSSagi Grimberg { 189996b7973eSSagi Grimberg struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 190096b7973eSSagi Grimberg struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd; 190196b7973eSSagi Grimberg struct se_cmd *se_cmd = &cmd->se_cmd; 190296b7973eSSagi Grimberg struct isert_conn *isert_conn = isert_cmd->conn; 1903dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 190496b7973eSSagi Grimberg int ret = 0; 190596b7973eSSagi Grimberg 190696b7973eSSagi Grimberg if (wr->fr_desc && wr->fr_desc->ind & ISERT_PROTECTED) { 190796b7973eSSagi Grimberg ret = isert_check_pi_status(se_cmd, 190896b7973eSSagi Grimberg wr->fr_desc->pi_ctx->sig_mr); 190996b7973eSSagi Grimberg wr->fr_desc->ind &= ~ISERT_PROTECTED; 191096b7973eSSagi Grimberg } 191196b7973eSSagi Grimberg 1912f93f3a70SSagi Grimberg device->unreg_rdma_mem(isert_cmd, isert_conn); 1913897bb2c9SSagi Grimberg wr->send_wr_num = 0; 19149e961ae7SSagi Grimberg if (ret) 19159e961ae7SSagi Grimberg transport_send_check_condition_and_sense(se_cmd, 19169e961ae7SSagi Grimberg se_cmd->pi_err, 0); 19179e961ae7SSagi Grimberg else 1918f93f3a70SSagi Grimberg isert_put_response(isert_conn->conn, cmd); 1919f93f3a70SSagi Grimberg } 1920f93f3a70SSagi Grimberg 1921f93f3a70SSagi Grimberg static void 1922b8d26b3bSNicholas Bellinger isert_completion_rdma_read(struct iser_tx_desc *tx_desc, 1923b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd) 1924b8d26b3bSNicholas Bellinger { 1925b8d26b3bSNicholas Bellinger struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 1926d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd; 1927b8d26b3bSNicholas Bellinger struct se_cmd *se_cmd = &cmd->se_cmd; 192890ecc6e2SVu Pham struct isert_conn *isert_conn = isert_cmd->conn; 1929dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 19305bac4b1aSSagi Grimberg int ret = 0; 1931b8d26b3bSNicholas Bellinger 19329e961ae7SSagi Grimberg if (wr->fr_desc && wr->fr_desc->ind & ISERT_PROTECTED) { 193396b7973eSSagi Grimberg ret = isert_check_pi_status(se_cmd, 193496b7973eSSagi Grimberg wr->fr_desc->pi_ctx->sig_mr); 193596b7973eSSagi Grimberg wr->fr_desc->ind &= ~ISERT_PROTECTED; 19369e961ae7SSagi Grimberg } 19379e961ae7SSagi Grimberg 1938b8d26b3bSNicholas Bellinger iscsit_stop_dataout_timer(cmd); 1939d40945d8SVu Pham device->unreg_rdma_mem(isert_cmd, isert_conn); 1940e3d7e4c3SSagi Grimberg cmd->write_data_done = wr->data.len; 1941b6b87a1dSNicholas Bellinger wr->send_wr_num = 0; 1942b8d26b3bSNicholas Bellinger 194324f412ddSSagi Grimberg isert_dbg("Cmd: %p RDMA_READ comp calling execute_cmd\n", isert_cmd); 1944b8d26b3bSNicholas Bellinger spin_lock_bh(&cmd->istate_lock); 1945b8d26b3bSNicholas Bellinger cmd->cmd_flags |= ICF_GOT_LAST_DATAOUT; 1946b8d26b3bSNicholas Bellinger cmd->i_state = ISTATE_RECEIVED_LAST_DATAOUT; 1947b8d26b3bSNicholas Bellinger spin_unlock_bh(&cmd->istate_lock); 1948b8d26b3bSNicholas Bellinger 1949364189f0SSagi Grimberg if (ret) { 1950afc16604SBart Van Assche target_put_sess_cmd(se_cmd); 19515bac4b1aSSagi Grimberg transport_send_check_condition_and_sense(se_cmd, 19525bac4b1aSSagi Grimberg se_cmd->pi_err, 0); 1953364189f0SSagi Grimberg } else { 1954b8d26b3bSNicholas Bellinger target_execute_cmd(se_cmd); 1955b8d26b3bSNicholas Bellinger } 1956364189f0SSagi Grimberg } 1957b8d26b3bSNicholas Bellinger 1958b8d26b3bSNicholas Bellinger static void 1959b8d26b3bSNicholas Bellinger isert_do_control_comp(struct work_struct *work) 1960b8d26b3bSNicholas Bellinger { 1961b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd = container_of(work, 1962b8d26b3bSNicholas Bellinger struct isert_cmd, comp_work); 1963b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = isert_cmd->conn; 1964dac6ab30SSagi Grimberg struct ib_device *ib_dev = isert_conn->cm_id->device; 1965d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd; 1966b8d26b3bSNicholas Bellinger 19674c22e07fSSagi Grimberg isert_dbg("Cmd %p i_state %d\n", isert_cmd, cmd->i_state); 19684c22e07fSSagi Grimberg 1969b8d26b3bSNicholas Bellinger switch (cmd->i_state) { 1970b8d26b3bSNicholas Bellinger case ISTATE_SEND_TASKMGTRSP: 1971b8d26b3bSNicholas Bellinger iscsit_tmr_post_handler(cmd, cmd->conn); 197210633c37SSagi Grimberg case ISTATE_SEND_REJECT: /* FALLTHRU */ 197310633c37SSagi Grimberg case ISTATE_SEND_TEXTRSP: /* FALLTHRU */ 1974b8d26b3bSNicholas Bellinger cmd->i_state = ISTATE_SENT_STATUS; 19754c22e07fSSagi Grimberg isert_completion_put(&isert_cmd->tx_desc, isert_cmd, 19764c22e07fSSagi Grimberg ib_dev, false); 19773df8f68aSNicholas Bellinger break; 1978b8d26b3bSNicholas Bellinger case ISTATE_SEND_LOGOUTRSP: 1979b8d26b3bSNicholas Bellinger iscsit_logout_post_handler(cmd, cmd->conn); 1980b8d26b3bSNicholas Bellinger break; 1981b8d26b3bSNicholas Bellinger default: 19824c22e07fSSagi Grimberg isert_err("Unknown i_state %d\n", cmd->i_state); 1983b8d26b3bSNicholas Bellinger dump_stack(); 1984b8d26b3bSNicholas Bellinger break; 1985b8d26b3bSNicholas Bellinger } 1986b8d26b3bSNicholas Bellinger } 1987b8d26b3bSNicholas Bellinger 1988b8d26b3bSNicholas Bellinger static void 1989b8d26b3bSNicholas Bellinger isert_response_completion(struct iser_tx_desc *tx_desc, 1990b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd, 1991b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn, 1992b8d26b3bSNicholas Bellinger struct ib_device *ib_dev) 1993b8d26b3bSNicholas Bellinger { 1994d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd; 1995b8d26b3bSNicholas Bellinger 1996b8d26b3bSNicholas Bellinger if (cmd->i_state == ISTATE_SEND_TASKMGTRSP || 19973df8f68aSNicholas Bellinger cmd->i_state == ISTATE_SEND_LOGOUTRSP || 1998adb54c29SNicholas Bellinger cmd->i_state == ISTATE_SEND_REJECT || 1999adb54c29SNicholas Bellinger cmd->i_state == ISTATE_SEND_TEXTRSP) { 2000b8d26b3bSNicholas Bellinger isert_unmap_tx_desc(tx_desc, ib_dev); 2001b8d26b3bSNicholas Bellinger 2002b8d26b3bSNicholas Bellinger INIT_WORK(&isert_cmd->comp_work, isert_do_control_comp); 2003b8d26b3bSNicholas Bellinger queue_work(isert_comp_wq, &isert_cmd->comp_work); 2004b8d26b3bSNicholas Bellinger return; 2005b8d26b3bSNicholas Bellinger } 2006897bb2c9SSagi Grimberg 2007b8d26b3bSNicholas Bellinger cmd->i_state = ISTATE_SENT_STATUS; 200803e7848aSNicholas Bellinger isert_completion_put(tx_desc, isert_cmd, ib_dev, false); 2009b8d26b3bSNicholas Bellinger } 2010b8d26b3bSNicholas Bellinger 2011b8d26b3bSNicholas Bellinger static void 20127748681bSSagi Grimberg isert_snd_completion(struct iser_tx_desc *tx_desc, 2013b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn) 2014b8d26b3bSNicholas Bellinger { 2015dac6ab30SSagi Grimberg struct ib_device *ib_dev = isert_conn->cm_id->device; 2016b8d26b3bSNicholas Bellinger struct isert_cmd *isert_cmd = tx_desc->isert_cmd; 2017b8d26b3bSNicholas Bellinger struct isert_rdma_wr *wr; 2018b8d26b3bSNicholas Bellinger 2019b8d26b3bSNicholas Bellinger if (!isert_cmd) { 2020b8d26b3bSNicholas Bellinger isert_unmap_tx_desc(tx_desc, ib_dev); 2021b8d26b3bSNicholas Bellinger return; 2022b8d26b3bSNicholas Bellinger } 2023b8d26b3bSNicholas Bellinger wr = &isert_cmd->rdma_wr; 2024b8d26b3bSNicholas Bellinger 20254c22e07fSSagi Grimberg isert_dbg("Cmd %p iser_ib_op %d\n", isert_cmd, wr->iser_ib_op); 20264c22e07fSSagi Grimberg 2027b8d26b3bSNicholas Bellinger switch (wr->iser_ib_op) { 2028b8d26b3bSNicholas Bellinger case ISER_IB_SEND: 2029b8d26b3bSNicholas Bellinger isert_response_completion(tx_desc, isert_cmd, 2030b8d26b3bSNicholas Bellinger isert_conn, ib_dev); 2031b8d26b3bSNicholas Bellinger break; 2032b8d26b3bSNicholas Bellinger case ISER_IB_RDMA_WRITE: 2033f93f3a70SSagi Grimberg isert_completion_rdma_write(tx_desc, isert_cmd); 2034b8d26b3bSNicholas Bellinger break; 2035b8d26b3bSNicholas Bellinger case ISER_IB_RDMA_READ: 2036b8d26b3bSNicholas Bellinger isert_completion_rdma_read(tx_desc, isert_cmd); 2037b8d26b3bSNicholas Bellinger break; 2038b8d26b3bSNicholas Bellinger default: 20394c22e07fSSagi Grimberg isert_err("Unknown wr->iser_ib_op: 0x%x\n", wr->iser_ib_op); 2040b8d26b3bSNicholas Bellinger dump_stack(); 2041b8d26b3bSNicholas Bellinger break; 2042b8d26b3bSNicholas Bellinger } 2043b8d26b3bSNicholas Bellinger } 2044b8d26b3bSNicholas Bellinger 20456f0fae3dSSagi Grimberg /** 20466f0fae3dSSagi Grimberg * is_isert_tx_desc() - Indicate if the completion wr_id 20476f0fae3dSSagi Grimberg * is a TX descriptor or not. 20486f0fae3dSSagi Grimberg * @isert_conn: iser connection 20496f0fae3dSSagi Grimberg * @wr_id: completion WR identifier 20506f0fae3dSSagi Grimberg * 20516f0fae3dSSagi Grimberg * Since we cannot rely on wc opcode in FLUSH errors 20526f0fae3dSSagi Grimberg * we must work around it by checking if the wr_id address 20536f0fae3dSSagi Grimberg * falls in the iser connection rx_descs buffer. If so 20546f0fae3dSSagi Grimberg * it is an RX descriptor, otherwize it is a TX. 20556f0fae3dSSagi Grimberg */ 20566f0fae3dSSagi Grimberg static inline bool 20576f0fae3dSSagi Grimberg is_isert_tx_desc(struct isert_conn *isert_conn, void *wr_id) 2058b8d26b3bSNicholas Bellinger { 2059dac6ab30SSagi Grimberg void *start = isert_conn->rx_descs; 2060dac6ab30SSagi Grimberg int len = ISERT_QP_MAX_RECV_DTOS * sizeof(*isert_conn->rx_descs); 20616f0fae3dSSagi Grimberg 20626f0fae3dSSagi Grimberg if (wr_id >= start && wr_id < start + len) 20636f0fae3dSSagi Grimberg return false; 20646f0fae3dSSagi Grimberg 20656f0fae3dSSagi Grimberg return true; 20666f0fae3dSSagi Grimberg } 20676f0fae3dSSagi Grimberg 20686f0fae3dSSagi Grimberg static void 20696f0fae3dSSagi Grimberg isert_cq_comp_err(struct isert_conn *isert_conn, struct ib_wc *wc) 20706f0fae3dSSagi Grimberg { 2071bdf20e72SSagi Grimberg if (wc->wr_id == ISER_BEACON_WRID) { 2072dac6ab30SSagi Grimberg isert_info("conn %p completing wait_comp_err\n", 2073bdf20e72SSagi Grimberg isert_conn); 2074dac6ab30SSagi Grimberg complete(&isert_conn->wait_comp_err); 2075ed4520aeSNicholas Bellinger } else if (is_isert_tx_desc(isert_conn, (void *)(uintptr_t)wc->wr_id)) { 2076dac6ab30SSagi Grimberg struct ib_device *ib_dev = isert_conn->cm_id->device; 2077df43debdSSagi Grimberg struct isert_cmd *isert_cmd; 20786f0fae3dSSagi Grimberg struct iser_tx_desc *desc; 2079b8d26b3bSNicholas Bellinger 20806f0fae3dSSagi Grimberg desc = (struct iser_tx_desc *)(uintptr_t)wc->wr_id; 20816f0fae3dSSagi Grimberg isert_cmd = desc->isert_cmd; 2082b8d26b3bSNicholas Bellinger if (!isert_cmd) 2083df43debdSSagi Grimberg isert_unmap_tx_desc(desc, ib_dev); 2084b8d26b3bSNicholas Bellinger else 2085df43debdSSagi Grimberg isert_completion_put(desc, isert_cmd, ib_dev, true); 2086df43debdSSagi Grimberg } else { 2087df43debdSSagi Grimberg isert_conn->post_recv_buf_count--; 2088bdf20e72SSagi Grimberg if (!isert_conn->post_recv_buf_count) 20899d49f5e2SSagi Grimberg iscsit_cause_connection_reinstatement(isert_conn->conn, 0); 2090b8d26b3bSNicholas Bellinger } 2091df43debdSSagi Grimberg } 2092b8d26b3bSNicholas Bellinger 2093b8d26b3bSNicholas Bellinger static void 20946f0fae3dSSagi Grimberg isert_handle_wc(struct ib_wc *wc) 2095b8d26b3bSNicholas Bellinger { 2096b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn; 2097b8d26b3bSNicholas Bellinger struct iser_tx_desc *tx_desc; 20986f0fae3dSSagi Grimberg struct iser_rx_desc *rx_desc; 2099b8d26b3bSNicholas Bellinger 21006f0fae3dSSagi Grimberg isert_conn = wc->qp->qp_context; 21016f0fae3dSSagi Grimberg if (likely(wc->status == IB_WC_SUCCESS)) { 21026f0fae3dSSagi Grimberg if (wc->opcode == IB_WC_RECV) { 21036f0fae3dSSagi Grimberg rx_desc = (struct iser_rx_desc *)(uintptr_t)wc->wr_id; 21047748681bSSagi Grimberg isert_rcv_completion(rx_desc, isert_conn, wc->byte_len); 2105b8d26b3bSNicholas Bellinger } else { 21066f0fae3dSSagi Grimberg tx_desc = (struct iser_tx_desc *)(uintptr_t)wc->wr_id; 21077748681bSSagi Grimberg isert_snd_completion(tx_desc, isert_conn); 2108b8d26b3bSNicholas Bellinger } 21096f0fae3dSSagi Grimberg } else { 21106f0fae3dSSagi Grimberg if (wc->status != IB_WC_WR_FLUSH_ERR) 2111ea8a1616SSagi Grimberg isert_err("%s (%d): wr id %llx vend_err %x\n", 2112ea8a1616SSagi Grimberg ib_wc_status_msg(wc->status), wc->status, 2113ea8a1616SSagi Grimberg wc->wr_id, wc->vendor_err); 21146f0fae3dSSagi Grimberg else 2115ea8a1616SSagi Grimberg isert_dbg("%s (%d): wr id %llx\n", 2116ea8a1616SSagi Grimberg ib_wc_status_msg(wc->status), wc->status, 2117ea8a1616SSagi Grimberg wc->wr_id); 2118b8d26b3bSNicholas Bellinger 21196f0fae3dSSagi Grimberg if (wc->wr_id != ISER_FASTREG_LI_WRID) 21206f0fae3dSSagi Grimberg isert_cq_comp_err(isert_conn, wc); 21216f0fae3dSSagi Grimberg } 2122b8d26b3bSNicholas Bellinger } 2123b8d26b3bSNicholas Bellinger 2124b8d26b3bSNicholas Bellinger static void 21256f0fae3dSSagi Grimberg isert_cq_work(struct work_struct *work) 2126b8d26b3bSNicholas Bellinger { 212737d9fe80SSagi Grimberg enum { isert_poll_budget = 65536 }; 21284a295baeSSagi Grimberg struct isert_comp *comp = container_of(work, struct isert_comp, 21296f0fae3dSSagi Grimberg work); 213036ea63b5SSagi Grimberg struct ib_wc *const wcs = comp->wcs; 213136ea63b5SSagi Grimberg int i, n, completed = 0; 2132b8d26b3bSNicholas Bellinger 213336ea63b5SSagi Grimberg while ((n = ib_poll_cq(comp->cq, ARRAY_SIZE(comp->wcs), wcs)) > 0) { 213436ea63b5SSagi Grimberg for (i = 0; i < n; i++) 213536ea63b5SSagi Grimberg isert_handle_wc(&wcs[i]); 2136b8d26b3bSNicholas Bellinger 213736ea63b5SSagi Grimberg completed += n; 213836ea63b5SSagi Grimberg if (completed >= isert_poll_budget) 213937d9fe80SSagi Grimberg break; 214037d9fe80SSagi Grimberg } 214137d9fe80SSagi Grimberg 21426f0fae3dSSagi Grimberg ib_req_notify_cq(comp->cq, IB_CQ_NEXT_COMP); 2143b8d26b3bSNicholas Bellinger } 2144b8d26b3bSNicholas Bellinger 2145b8d26b3bSNicholas Bellinger static void 21466f0fae3dSSagi Grimberg isert_cq_callback(struct ib_cq *cq, void *context) 2147b8d26b3bSNicholas Bellinger { 21484a295baeSSagi Grimberg struct isert_comp *comp = context; 2149b8d26b3bSNicholas Bellinger 21506f0fae3dSSagi Grimberg queue_work(isert_comp_wq, &comp->work); 2151b8d26b3bSNicholas Bellinger } 2152b8d26b3bSNicholas Bellinger 2153b8d26b3bSNicholas Bellinger static int 2154b8d26b3bSNicholas Bellinger isert_post_response(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd) 2155b8d26b3bSNicholas Bellinger { 2156b8d26b3bSNicholas Bellinger struct ib_send_wr *wr_failed; 2157b8d26b3bSNicholas Bellinger int ret; 2158b8d26b3bSNicholas Bellinger 2159dac6ab30SSagi Grimberg ret = ib_post_send(isert_conn->qp, &isert_cmd->tx_desc.send_wr, 2160b8d26b3bSNicholas Bellinger &wr_failed); 2161b8d26b3bSNicholas Bellinger if (ret) { 216224f412ddSSagi Grimberg isert_err("ib_post_send failed with %d\n", ret); 2163b8d26b3bSNicholas Bellinger return ret; 2164b8d26b3bSNicholas Bellinger } 2165b8d26b3bSNicholas Bellinger return ret; 2166b8d26b3bSNicholas Bellinger } 2167b8d26b3bSNicholas Bellinger 2168b8d26b3bSNicholas Bellinger static int 2169b8d26b3bSNicholas Bellinger isert_put_response(struct iscsi_conn *conn, struct iscsi_cmd *cmd) 2170b8d26b3bSNicholas Bellinger { 2171d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 21726700425eSSagi Grimberg struct isert_conn *isert_conn = conn->context; 2173b8d26b3bSNicholas Bellinger struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr; 2174b8d26b3bSNicholas Bellinger struct iscsi_scsi_rsp *hdr = (struct iscsi_scsi_rsp *) 2175b8d26b3bSNicholas Bellinger &isert_cmd->tx_desc.iscsi_header; 2176b8d26b3bSNicholas Bellinger 2177b8d26b3bSNicholas Bellinger isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc); 2178b8d26b3bSNicholas Bellinger iscsit_build_rsp_pdu(cmd, conn, true, hdr); 2179b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 2180b8d26b3bSNicholas Bellinger /* 2181b8d26b3bSNicholas Bellinger * Attach SENSE DATA payload to iSCSI Response PDU 2182b8d26b3bSNicholas Bellinger */ 2183b8d26b3bSNicholas Bellinger if (cmd->se_cmd.sense_buffer && 2184b8d26b3bSNicholas Bellinger ((cmd->se_cmd.se_cmd_flags & SCF_TRANSPORT_TASK_SENSE) || 2185b8d26b3bSNicholas Bellinger (cmd->se_cmd.se_cmd_flags & SCF_EMULATED_TASK_SENSE))) { 2186dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 218767cb3949SSagi Grimberg struct ib_device *ib_dev = device->ib_device; 2188b8d26b3bSNicholas Bellinger struct ib_sge *tx_dsg = &isert_cmd->tx_desc.tx_sg[1]; 2189dbbc5d11SNicholas Bellinger u32 padding, pdu_len; 2190b8d26b3bSNicholas Bellinger 2191b8d26b3bSNicholas Bellinger put_unaligned_be16(cmd->se_cmd.scsi_sense_length, 2192b8d26b3bSNicholas Bellinger cmd->sense_buffer); 2193b8d26b3bSNicholas Bellinger cmd->se_cmd.scsi_sense_length += sizeof(__be16); 2194b8d26b3bSNicholas Bellinger 2195b8d26b3bSNicholas Bellinger padding = -(cmd->se_cmd.scsi_sense_length) & 3; 2196b8d26b3bSNicholas Bellinger hton24(hdr->dlength, (u32)cmd->se_cmd.scsi_sense_length); 2197dbbc5d11SNicholas Bellinger pdu_len = cmd->se_cmd.scsi_sense_length + padding; 2198b8d26b3bSNicholas Bellinger 2199dbbc5d11SNicholas Bellinger isert_cmd->pdu_buf_dma = ib_dma_map_single(ib_dev, 2200dbbc5d11SNicholas Bellinger (void *)cmd->sense_buffer, pdu_len, 2201b8d26b3bSNicholas Bellinger DMA_TO_DEVICE); 2202b8d26b3bSNicholas Bellinger 2203dbbc5d11SNicholas Bellinger isert_cmd->pdu_buf_len = pdu_len; 2204dbbc5d11SNicholas Bellinger tx_dsg->addr = isert_cmd->pdu_buf_dma; 2205dbbc5d11SNicholas Bellinger tx_dsg->length = pdu_len; 220634efc7dfSJason Gunthorpe tx_dsg->lkey = device->pd->local_dma_lkey; 2207b8d26b3bSNicholas Bellinger isert_cmd->tx_desc.num_sge = 2; 2208b8d26b3bSNicholas Bellinger } 2209b8d26b3bSNicholas Bellinger 221068a86deeSSagi Grimberg isert_init_send_wr(isert_conn, isert_cmd, send_wr); 2211b8d26b3bSNicholas Bellinger 22124c22e07fSSagi Grimberg isert_dbg("Posting SCSI Response\n"); 2213b8d26b3bSNicholas Bellinger 2214b8d26b3bSNicholas Bellinger return isert_post_response(isert_conn, isert_cmd); 2215b8d26b3bSNicholas Bellinger } 2216b8d26b3bSNicholas Bellinger 2217131e6abcSNicholas Bellinger static void 2218131e6abcSNicholas Bellinger isert_aborted_task(struct iscsi_conn *conn, struct iscsi_cmd *cmd) 2219131e6abcSNicholas Bellinger { 2220131e6abcSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 22216700425eSSagi Grimberg struct isert_conn *isert_conn = conn->context; 2222dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 2223131e6abcSNicholas Bellinger 2224131e6abcSNicholas Bellinger spin_lock_bh(&conn->cmd_lock); 2225131e6abcSNicholas Bellinger if (!list_empty(&cmd->i_conn_node)) 2226131e6abcSNicholas Bellinger list_del_init(&cmd->i_conn_node); 2227131e6abcSNicholas Bellinger spin_unlock_bh(&conn->cmd_lock); 2228131e6abcSNicholas Bellinger 2229131e6abcSNicholas Bellinger if (cmd->data_direction == DMA_TO_DEVICE) 2230131e6abcSNicholas Bellinger iscsit_stop_dataout_timer(cmd); 2231131e6abcSNicholas Bellinger 2232131e6abcSNicholas Bellinger device->unreg_rdma_mem(isert_cmd, isert_conn); 2233131e6abcSNicholas Bellinger } 2234131e6abcSNicholas Bellinger 2235e70beee7SNicholas Bellinger static enum target_prot_op 2236e70beee7SNicholas Bellinger isert_get_sup_prot_ops(struct iscsi_conn *conn) 2237e70beee7SNicholas Bellinger { 22386700425eSSagi Grimberg struct isert_conn *isert_conn = conn->context; 2239dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 2240e70beee7SNicholas Bellinger 224123a548eeSSagi Grimberg if (conn->tpg->tpg_attrib.t10_pi) { 224223a548eeSSagi Grimberg if (device->pi_capable) { 224324f412ddSSagi Grimberg isert_info("conn %p PI offload enabled\n", isert_conn); 224423a548eeSSagi Grimberg isert_conn->pi_support = true; 2245e70beee7SNicholas Bellinger return TARGET_PROT_ALL; 224623a548eeSSagi Grimberg } 224723a548eeSSagi Grimberg } 224823a548eeSSagi Grimberg 224924f412ddSSagi Grimberg isert_info("conn %p PI offload disabled\n", isert_conn); 225023a548eeSSagi Grimberg isert_conn->pi_support = false; 2251e70beee7SNicholas Bellinger 2252e70beee7SNicholas Bellinger return TARGET_PROT_NORMAL; 2253e70beee7SNicholas Bellinger } 2254e70beee7SNicholas Bellinger 2255b8d26b3bSNicholas Bellinger static int 2256b8d26b3bSNicholas Bellinger isert_put_nopin(struct iscsi_cmd *cmd, struct iscsi_conn *conn, 2257b8d26b3bSNicholas Bellinger bool nopout_response) 2258b8d26b3bSNicholas Bellinger { 2259d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 22606700425eSSagi Grimberg struct isert_conn *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_nopin_rsp(cmd, conn, (struct iscsi_nopin *) 2265b8d26b3bSNicholas Bellinger &isert_cmd->tx_desc.iscsi_header, 2266b8d26b3bSNicholas Bellinger nopout_response); 2267b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 226868a86deeSSagi Grimberg isert_init_send_wr(isert_conn, isert_cmd, send_wr); 2269b8d26b3bSNicholas Bellinger 22704c22e07fSSagi Grimberg isert_dbg("conn %p Posting NOPIN Response\n", isert_conn); 2271b8d26b3bSNicholas Bellinger 2272b8d26b3bSNicholas Bellinger return isert_post_response(isert_conn, isert_cmd); 2273b8d26b3bSNicholas Bellinger } 2274b8d26b3bSNicholas Bellinger 2275b8d26b3bSNicholas Bellinger static int 2276b8d26b3bSNicholas Bellinger isert_put_logout_rsp(struct iscsi_cmd *cmd, struct iscsi_conn *conn) 2277b8d26b3bSNicholas Bellinger { 2278d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 22796700425eSSagi Grimberg struct isert_conn *isert_conn = conn->context; 2280b8d26b3bSNicholas Bellinger struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr; 2281b8d26b3bSNicholas Bellinger 2282b8d26b3bSNicholas Bellinger isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc); 2283b8d26b3bSNicholas Bellinger iscsit_build_logout_rsp(cmd, conn, (struct iscsi_logout_rsp *) 2284b8d26b3bSNicholas Bellinger &isert_cmd->tx_desc.iscsi_header); 2285b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 228668a86deeSSagi Grimberg isert_init_send_wr(isert_conn, isert_cmd, send_wr); 2287b8d26b3bSNicholas Bellinger 22884c22e07fSSagi Grimberg isert_dbg("conn %p Posting Logout Response\n", isert_conn); 2289b8d26b3bSNicholas Bellinger 2290b8d26b3bSNicholas Bellinger return isert_post_response(isert_conn, isert_cmd); 2291b8d26b3bSNicholas Bellinger } 2292b8d26b3bSNicholas Bellinger 2293b8d26b3bSNicholas Bellinger static int 2294b8d26b3bSNicholas Bellinger isert_put_tm_rsp(struct iscsi_cmd *cmd, struct iscsi_conn *conn) 2295b8d26b3bSNicholas Bellinger { 2296d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 22976700425eSSagi Grimberg struct isert_conn *isert_conn = conn->context; 2298b8d26b3bSNicholas Bellinger struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr; 2299b8d26b3bSNicholas Bellinger 2300b8d26b3bSNicholas Bellinger isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc); 2301b8d26b3bSNicholas Bellinger iscsit_build_task_mgt_rsp(cmd, conn, (struct iscsi_tm_rsp *) 2302b8d26b3bSNicholas Bellinger &isert_cmd->tx_desc.iscsi_header); 2303b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 230468a86deeSSagi Grimberg isert_init_send_wr(isert_conn, isert_cmd, send_wr); 2305b8d26b3bSNicholas Bellinger 23064c22e07fSSagi Grimberg isert_dbg("conn %p Posting Task Management Response\n", isert_conn); 2307b8d26b3bSNicholas Bellinger 2308b8d26b3bSNicholas Bellinger return isert_post_response(isert_conn, isert_cmd); 2309b8d26b3bSNicholas Bellinger } 2310b8d26b3bSNicholas Bellinger 2311b8d26b3bSNicholas Bellinger static int 2312b8d26b3bSNicholas Bellinger isert_put_reject(struct iscsi_cmd *cmd, struct iscsi_conn *conn) 2313b8d26b3bSNicholas Bellinger { 2314d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 23156700425eSSagi Grimberg struct isert_conn *isert_conn = conn->context; 2316b8d26b3bSNicholas Bellinger struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr; 2317dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 231867cb3949SSagi Grimberg struct ib_device *ib_dev = device->ib_device; 23193df8f68aSNicholas Bellinger struct ib_sge *tx_dsg = &isert_cmd->tx_desc.tx_sg[1]; 23203df8f68aSNicholas Bellinger struct iscsi_reject *hdr = 23213df8f68aSNicholas Bellinger (struct iscsi_reject *)&isert_cmd->tx_desc.iscsi_header; 2322b8d26b3bSNicholas Bellinger 2323b8d26b3bSNicholas Bellinger isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc); 23243df8f68aSNicholas Bellinger iscsit_build_reject(cmd, conn, hdr); 2325b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 23263df8f68aSNicholas Bellinger 23273df8f68aSNicholas Bellinger hton24(hdr->dlength, ISCSI_HDR_LEN); 2328dbbc5d11SNicholas Bellinger isert_cmd->pdu_buf_dma = ib_dma_map_single(ib_dev, 23293df8f68aSNicholas Bellinger (void *)cmd->buf_ptr, ISCSI_HDR_LEN, 23303df8f68aSNicholas Bellinger DMA_TO_DEVICE); 2331dbbc5d11SNicholas Bellinger isert_cmd->pdu_buf_len = ISCSI_HDR_LEN; 2332dbbc5d11SNicholas Bellinger tx_dsg->addr = isert_cmd->pdu_buf_dma; 23333df8f68aSNicholas Bellinger tx_dsg->length = ISCSI_HDR_LEN; 233434efc7dfSJason Gunthorpe tx_dsg->lkey = device->pd->local_dma_lkey; 23353df8f68aSNicholas Bellinger isert_cmd->tx_desc.num_sge = 2; 23363df8f68aSNicholas Bellinger 233768a86deeSSagi Grimberg isert_init_send_wr(isert_conn, isert_cmd, send_wr); 2338b8d26b3bSNicholas Bellinger 23394c22e07fSSagi Grimberg isert_dbg("conn %p Posting Reject\n", isert_conn); 2340b8d26b3bSNicholas Bellinger 2341b8d26b3bSNicholas Bellinger return isert_post_response(isert_conn, isert_cmd); 2342b8d26b3bSNicholas Bellinger } 2343b8d26b3bSNicholas Bellinger 2344b8d26b3bSNicholas Bellinger static int 2345adb54c29SNicholas Bellinger isert_put_text_rsp(struct iscsi_cmd *cmd, struct iscsi_conn *conn) 2346adb54c29SNicholas Bellinger { 2347d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 23486700425eSSagi Grimberg struct isert_conn *isert_conn = conn->context; 2349adb54c29SNicholas Bellinger struct ib_send_wr *send_wr = &isert_cmd->tx_desc.send_wr; 2350adb54c29SNicholas Bellinger struct iscsi_text_rsp *hdr = 2351adb54c29SNicholas Bellinger (struct iscsi_text_rsp *)&isert_cmd->tx_desc.iscsi_header; 2352adb54c29SNicholas Bellinger u32 txt_rsp_len; 2353adb54c29SNicholas Bellinger int rc; 2354adb54c29SNicholas Bellinger 2355adb54c29SNicholas Bellinger isert_create_send_desc(isert_conn, isert_cmd, &isert_cmd->tx_desc); 235622c7aaa5SSagi Grimberg rc = iscsit_build_text_rsp(cmd, conn, hdr, ISCSI_INFINIBAND); 2357adb54c29SNicholas Bellinger if (rc < 0) 2358adb54c29SNicholas Bellinger return rc; 2359adb54c29SNicholas Bellinger 2360adb54c29SNicholas Bellinger txt_rsp_len = rc; 2361adb54c29SNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 2362adb54c29SNicholas Bellinger 2363adb54c29SNicholas Bellinger if (txt_rsp_len) { 2364dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 236567cb3949SSagi Grimberg struct ib_device *ib_dev = device->ib_device; 2366adb54c29SNicholas Bellinger struct ib_sge *tx_dsg = &isert_cmd->tx_desc.tx_sg[1]; 2367adb54c29SNicholas Bellinger void *txt_rsp_buf = cmd->buf_ptr; 2368adb54c29SNicholas Bellinger 2369adb54c29SNicholas Bellinger isert_cmd->pdu_buf_dma = ib_dma_map_single(ib_dev, 2370adb54c29SNicholas Bellinger txt_rsp_buf, txt_rsp_len, DMA_TO_DEVICE); 2371adb54c29SNicholas Bellinger 2372adb54c29SNicholas Bellinger isert_cmd->pdu_buf_len = txt_rsp_len; 2373adb54c29SNicholas Bellinger tx_dsg->addr = isert_cmd->pdu_buf_dma; 2374adb54c29SNicholas Bellinger tx_dsg->length = txt_rsp_len; 237534efc7dfSJason Gunthorpe tx_dsg->lkey = device->pd->local_dma_lkey; 2376adb54c29SNicholas Bellinger isert_cmd->tx_desc.num_sge = 2; 2377adb54c29SNicholas Bellinger } 237868a86deeSSagi Grimberg isert_init_send_wr(isert_conn, isert_cmd, send_wr); 2379adb54c29SNicholas Bellinger 2380f64d2792SSagi Grimberg isert_dbg("conn %p Text Response\n", isert_conn); 2381adb54c29SNicholas Bellinger 2382adb54c29SNicholas Bellinger return isert_post_response(isert_conn, isert_cmd); 2383adb54c29SNicholas Bellinger } 2384adb54c29SNicholas Bellinger 2385adb54c29SNicholas Bellinger static int 2386b8d26b3bSNicholas Bellinger isert_build_rdma_wr(struct isert_conn *isert_conn, struct isert_cmd *isert_cmd, 2387b8d26b3bSNicholas Bellinger struct ib_sge *ib_sge, struct ib_send_wr *send_wr, 2388b8d26b3bSNicholas Bellinger u32 data_left, u32 offset) 2389b8d26b3bSNicholas Bellinger { 2390d703ce2fSNicholas Bellinger struct iscsi_cmd *cmd = isert_cmd->iscsi_cmd; 2391b8d26b3bSNicholas Bellinger struct scatterlist *sg_start, *tmp_sg; 2392dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 239367cb3949SSagi Grimberg struct ib_device *ib_dev = device->ib_device; 2394b8d26b3bSNicholas Bellinger u32 sg_off, page_off; 2395b8d26b3bSNicholas Bellinger int i = 0, sg_nents; 2396b8d26b3bSNicholas Bellinger 2397b8d26b3bSNicholas Bellinger sg_off = offset / PAGE_SIZE; 2398b8d26b3bSNicholas Bellinger sg_start = &cmd->se_cmd.t_data_sg[sg_off]; 2399b8d26b3bSNicholas Bellinger sg_nents = min(cmd->se_cmd.t_data_nents - sg_off, isert_conn->max_sge); 2400b8d26b3bSNicholas Bellinger page_off = offset % PAGE_SIZE; 2401b8d26b3bSNicholas Bellinger 2402b8d26b3bSNicholas Bellinger send_wr->sg_list = ib_sge; 2403b0a191e7SSagi Grimberg send_wr->wr_id = (uintptr_t)&isert_cmd->tx_desc; 2404b8d26b3bSNicholas Bellinger /* 2405b8d26b3bSNicholas Bellinger * Perform mapping of TCM scatterlist memory ib_sge dma_addr. 2406b8d26b3bSNicholas Bellinger */ 2407b8d26b3bSNicholas Bellinger for_each_sg(sg_start, tmp_sg, sg_nents, i) { 24084c22e07fSSagi Grimberg isert_dbg("RDMA from SGL dma_addr: 0x%llx dma_len: %u, " 24094c22e07fSSagi Grimberg "page_off: %u\n", 2410b8d26b3bSNicholas Bellinger (unsigned long long)tmp_sg->dma_address, 2411b8d26b3bSNicholas Bellinger tmp_sg->length, page_off); 2412b8d26b3bSNicholas Bellinger 2413b8d26b3bSNicholas Bellinger ib_sge->addr = ib_sg_dma_address(ib_dev, tmp_sg) + page_off; 2414b8d26b3bSNicholas Bellinger ib_sge->length = min_t(u32, data_left, 2415b8d26b3bSNicholas Bellinger ib_sg_dma_len(ib_dev, tmp_sg) - page_off); 241634efc7dfSJason Gunthorpe ib_sge->lkey = device->pd->local_dma_lkey; 2417b8d26b3bSNicholas Bellinger 24184c22e07fSSagi Grimberg isert_dbg("RDMA ib_sge: addr: 0x%llx length: %u lkey: %x\n", 241990ecc6e2SVu Pham ib_sge->addr, ib_sge->length, ib_sge->lkey); 2420b8d26b3bSNicholas Bellinger page_off = 0; 2421b8d26b3bSNicholas Bellinger data_left -= ib_sge->length; 24229253e667SSagi Grimberg if (!data_left) 24239253e667SSagi Grimberg break; 2424b8d26b3bSNicholas Bellinger ib_sge++; 242524f412ddSSagi Grimberg isert_dbg("Incrementing ib_sge pointer to %p\n", ib_sge); 2426b8d26b3bSNicholas Bellinger } 2427b8d26b3bSNicholas Bellinger 24289253e667SSagi Grimberg send_wr->num_sge = ++i; 242924f412ddSSagi Grimberg isert_dbg("Set outgoing sg_list: %p num_sg: %u from TCM SGLs\n", 2430b8d26b3bSNicholas Bellinger send_wr->sg_list, send_wr->num_sge); 2431b8d26b3bSNicholas Bellinger 24329253e667SSagi Grimberg return send_wr->num_sge; 2433b8d26b3bSNicholas Bellinger } 2434b8d26b3bSNicholas Bellinger 2435b8d26b3bSNicholas Bellinger static int 243690ecc6e2SVu Pham isert_map_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd, 243790ecc6e2SVu Pham struct isert_rdma_wr *wr) 2438b8d26b3bSNicholas Bellinger { 2439b8d26b3bSNicholas Bellinger struct se_cmd *se_cmd = &cmd->se_cmd; 2440d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 24416700425eSSagi Grimberg struct isert_conn *isert_conn = conn->context; 2442e3d7e4c3SSagi Grimberg struct isert_data_buf *data = &wr->data; 244390ecc6e2SVu Pham struct ib_send_wr *send_wr; 2444b8d26b3bSNicholas Bellinger struct ib_sge *ib_sge; 2445e3d7e4c3SSagi Grimberg u32 offset, data_len, data_left, rdma_write_max, va_offset = 0; 2446e3d7e4c3SSagi Grimberg int ret = 0, i, ib_sge_cnt; 2447b8d26b3bSNicholas Bellinger 244890ecc6e2SVu Pham isert_cmd->tx_desc.isert_cmd = isert_cmd; 2449b8d26b3bSNicholas Bellinger 2450e3d7e4c3SSagi Grimberg offset = wr->iser_ib_op == ISER_IB_RDMA_READ ? cmd->write_data_done : 0; 2451e3d7e4c3SSagi Grimberg ret = isert_map_data_buf(isert_conn, isert_cmd, se_cmd->t_data_sg, 2452e3d7e4c3SSagi Grimberg se_cmd->t_data_nents, se_cmd->data_length, 2453e3d7e4c3SSagi Grimberg offset, wr->iser_ib_op, &wr->data); 2454e3d7e4c3SSagi Grimberg if (ret) 2455e3d7e4c3SSagi Grimberg return ret; 2456b8d26b3bSNicholas Bellinger 2457e3d7e4c3SSagi Grimberg data_left = data->len; 2458e3d7e4c3SSagi Grimberg offset = data->offset; 2459b8d26b3bSNicholas Bellinger 2460e3d7e4c3SSagi Grimberg ib_sge = kzalloc(sizeof(struct ib_sge) * data->nents, GFP_KERNEL); 2461b8d26b3bSNicholas Bellinger if (!ib_sge) { 246224f412ddSSagi Grimberg isert_warn("Unable to allocate ib_sge\n"); 2463b8d26b3bSNicholas Bellinger ret = -ENOMEM; 2464e3d7e4c3SSagi Grimberg goto unmap_cmd; 2465b8d26b3bSNicholas Bellinger } 246690ecc6e2SVu Pham wr->ib_sge = ib_sge; 2467b8d26b3bSNicholas Bellinger 2468e3d7e4c3SSagi Grimberg wr->send_wr_num = DIV_ROUND_UP(data->nents, isert_conn->max_sge); 2469b8d26b3bSNicholas Bellinger wr->send_wr = kzalloc(sizeof(struct ib_send_wr) * wr->send_wr_num, 2470b8d26b3bSNicholas Bellinger GFP_KERNEL); 2471b8d26b3bSNicholas Bellinger if (!wr->send_wr) { 247224f412ddSSagi Grimberg isert_dbg("Unable to allocate wr->send_wr\n"); 2473b8d26b3bSNicholas Bellinger ret = -ENOMEM; 2474e3d7e4c3SSagi Grimberg goto unmap_cmd; 2475b8d26b3bSNicholas Bellinger } 2476b8d26b3bSNicholas Bellinger 2477b8d26b3bSNicholas Bellinger wr->isert_cmd = isert_cmd; 2478b8d26b3bSNicholas Bellinger rdma_write_max = isert_conn->max_sge * PAGE_SIZE; 2479b8d26b3bSNicholas Bellinger 2480b8d26b3bSNicholas Bellinger for (i = 0; i < wr->send_wr_num; i++) { 2481b8d26b3bSNicholas Bellinger send_wr = &isert_cmd->rdma_wr.send_wr[i]; 2482b8d26b3bSNicholas Bellinger data_len = min(data_left, rdma_write_max); 2483b8d26b3bSNicholas Bellinger 2484b8d26b3bSNicholas Bellinger send_wr->send_flags = 0; 248590ecc6e2SVu Pham if (wr->iser_ib_op == ISER_IB_RDMA_WRITE) { 248690ecc6e2SVu Pham send_wr->opcode = IB_WR_RDMA_WRITE; 2487b8d26b3bSNicholas Bellinger send_wr->wr.rdma.remote_addr = isert_cmd->read_va + offset; 2488b8d26b3bSNicholas Bellinger send_wr->wr.rdma.rkey = isert_cmd->read_stag; 248990ecc6e2SVu Pham if (i + 1 == wr->send_wr_num) 249090ecc6e2SVu Pham send_wr->next = &isert_cmd->tx_desc.send_wr; 249190ecc6e2SVu Pham else 249290ecc6e2SVu Pham send_wr->next = &wr->send_wr[i + 1]; 249390ecc6e2SVu Pham } else { 249490ecc6e2SVu Pham send_wr->opcode = IB_WR_RDMA_READ; 249590ecc6e2SVu Pham send_wr->wr.rdma.remote_addr = isert_cmd->write_va + va_offset; 249690ecc6e2SVu Pham send_wr->wr.rdma.rkey = isert_cmd->write_stag; 249790ecc6e2SVu Pham if (i + 1 == wr->send_wr_num) 249890ecc6e2SVu Pham send_wr->send_flags = IB_SEND_SIGNALED; 249990ecc6e2SVu Pham else 250090ecc6e2SVu Pham send_wr->next = &wr->send_wr[i + 1]; 250190ecc6e2SVu Pham } 2502b8d26b3bSNicholas Bellinger 2503b8d26b3bSNicholas Bellinger ib_sge_cnt = isert_build_rdma_wr(isert_conn, isert_cmd, ib_sge, 2504b8d26b3bSNicholas Bellinger send_wr, data_len, offset); 2505b8d26b3bSNicholas Bellinger ib_sge += ib_sge_cnt; 2506b8d26b3bSNicholas Bellinger 2507b8d26b3bSNicholas Bellinger offset += data_len; 250890ecc6e2SVu Pham va_offset += data_len; 2509b8d26b3bSNicholas Bellinger data_left -= data_len; 2510b8d26b3bSNicholas Bellinger } 251190ecc6e2SVu Pham 251290ecc6e2SVu Pham return 0; 2513e3d7e4c3SSagi Grimberg unmap_cmd: 2514e3d7e4c3SSagi Grimberg isert_unmap_data_buf(isert_conn, data); 2515e3d7e4c3SSagi Grimberg 251690ecc6e2SVu Pham return ret; 251790ecc6e2SVu Pham } 251890ecc6e2SVu Pham 251990ecc6e2SVu Pham static int 252059464ef4SVu Pham isert_map_fr_pagelist(struct ib_device *ib_dev, 252159464ef4SVu Pham struct scatterlist *sg_start, int sg_nents, u64 *fr_pl) 252259464ef4SVu Pham { 252359464ef4SVu Pham u64 start_addr, end_addr, page, chunk_start = 0; 252459464ef4SVu Pham struct scatterlist *tmp_sg; 252559464ef4SVu Pham int i = 0, new_chunk, last_ent, n_pages; 252659464ef4SVu Pham 252759464ef4SVu Pham n_pages = 0; 252859464ef4SVu Pham new_chunk = 1; 252959464ef4SVu Pham last_ent = sg_nents - 1; 253059464ef4SVu Pham for_each_sg(sg_start, tmp_sg, sg_nents, i) { 253159464ef4SVu Pham start_addr = ib_sg_dma_address(ib_dev, tmp_sg); 253259464ef4SVu Pham if (new_chunk) 253359464ef4SVu Pham chunk_start = start_addr; 253459464ef4SVu Pham end_addr = start_addr + ib_sg_dma_len(ib_dev, tmp_sg); 253559464ef4SVu Pham 25364c22e07fSSagi Grimberg isert_dbg("SGL[%d] dma_addr: 0x%llx len: %u\n", 253759464ef4SVu Pham i, (unsigned long long)tmp_sg->dma_address, 253859464ef4SVu Pham tmp_sg->length); 253959464ef4SVu Pham 254059464ef4SVu Pham if ((end_addr & ~PAGE_MASK) && i < last_ent) { 254159464ef4SVu Pham new_chunk = 0; 254259464ef4SVu Pham continue; 254359464ef4SVu Pham } 254459464ef4SVu Pham new_chunk = 1; 254559464ef4SVu Pham 254659464ef4SVu Pham page = chunk_start & PAGE_MASK; 254759464ef4SVu Pham do { 254859464ef4SVu Pham fr_pl[n_pages++] = page; 25494c22e07fSSagi Grimberg isert_dbg("Mapped page_list[%d] page_addr: 0x%llx\n", 255059464ef4SVu Pham n_pages - 1, page); 255159464ef4SVu Pham page += PAGE_SIZE; 255259464ef4SVu Pham } while (page < end_addr); 255359464ef4SVu Pham } 255459464ef4SVu Pham 255559464ef4SVu Pham return n_pages; 255659464ef4SVu Pham } 255759464ef4SVu Pham 255810633c37SSagi Grimberg static inline void 255910633c37SSagi Grimberg isert_inv_rkey(struct ib_send_wr *inv_wr, struct ib_mr *mr) 256010633c37SSagi Grimberg { 256110633c37SSagi Grimberg u32 rkey; 256210633c37SSagi Grimberg 256310633c37SSagi Grimberg memset(inv_wr, 0, sizeof(*inv_wr)); 256410633c37SSagi Grimberg inv_wr->wr_id = ISER_FASTREG_LI_WRID; 256510633c37SSagi Grimberg inv_wr->opcode = IB_WR_LOCAL_INV; 256610633c37SSagi Grimberg inv_wr->ex.invalidate_rkey = mr->rkey; 256710633c37SSagi Grimberg 256810633c37SSagi Grimberg /* Bump the key */ 256910633c37SSagi Grimberg rkey = ib_inc_rkey(mr->rkey); 257010633c37SSagi Grimberg ib_update_fast_reg_key(mr, rkey); 257110633c37SSagi Grimberg } 257210633c37SSagi Grimberg 257359464ef4SVu Pham static int 2574e3d7e4c3SSagi Grimberg isert_fast_reg_mr(struct isert_conn *isert_conn, 2575e3d7e4c3SSagi Grimberg struct fast_reg_descriptor *fr_desc, 2576e3d7e4c3SSagi Grimberg struct isert_data_buf *mem, 25779e961ae7SSagi Grimberg enum isert_indicator ind, 2578e3d7e4c3SSagi Grimberg struct ib_sge *sge) 257959464ef4SVu Pham { 2580dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 258167cb3949SSagi Grimberg struct ib_device *ib_dev = device->ib_device; 25829e961ae7SSagi Grimberg struct ib_mr *mr; 25839e961ae7SSagi Grimberg struct ib_fast_reg_page_list *frpl; 258459464ef4SVu Pham struct ib_send_wr fr_wr, inv_wr; 258559464ef4SVu Pham struct ib_send_wr *bad_wr, *wr = NULL; 25869bd626e7SSagi Grimberg int ret, pagelist_len; 25879bd626e7SSagi Grimberg u32 page_off; 258859464ef4SVu Pham 2589e3d7e4c3SSagi Grimberg if (mem->dma_nents == 1) { 259034efc7dfSJason Gunthorpe sge->lkey = device->pd->local_dma_lkey; 2591e3d7e4c3SSagi Grimberg sge->addr = ib_sg_dma_address(ib_dev, &mem->sg[0]); 2592e3d7e4c3SSagi Grimberg sge->length = ib_sg_dma_len(ib_dev, &mem->sg[0]); 25934c22e07fSSagi Grimberg isert_dbg("sge: addr: 0x%llx length: %u lkey: %x\n", 25944c22e07fSSagi Grimberg sge->addr, sge->length, sge->lkey); 2595e3d7e4c3SSagi Grimberg return 0; 2596e3d7e4c3SSagi Grimberg } 2597e3d7e4c3SSagi Grimberg 25989e961ae7SSagi Grimberg if (ind == ISERT_DATA_KEY_VALID) { 25999e961ae7SSagi Grimberg /* Registering data buffer */ 26009e961ae7SSagi Grimberg mr = fr_desc->data_mr; 26019e961ae7SSagi Grimberg frpl = fr_desc->data_frpl; 26029e961ae7SSagi Grimberg } else { 26039e961ae7SSagi Grimberg /* Registering protection buffer */ 26049e961ae7SSagi Grimberg mr = fr_desc->pi_ctx->prot_mr; 26059e961ae7SSagi Grimberg frpl = fr_desc->pi_ctx->prot_frpl; 26069e961ae7SSagi Grimberg } 26079e961ae7SSagi Grimberg 2608e3d7e4c3SSagi Grimberg page_off = mem->offset % PAGE_SIZE; 260959464ef4SVu Pham 261024f412ddSSagi Grimberg isert_dbg("Use fr_desc %p sg_nents %d offset %u\n", 2611e3d7e4c3SSagi Grimberg fr_desc, mem->nents, mem->offset); 261259464ef4SVu Pham 2613e3d7e4c3SSagi Grimberg pagelist_len = isert_map_fr_pagelist(ib_dev, mem->sg, mem->nents, 26149e961ae7SSagi Grimberg &frpl->page_list[0]); 261559464ef4SVu Pham 261610633c37SSagi Grimberg if (!(fr_desc->ind & ind)) { 261710633c37SSagi Grimberg isert_inv_rkey(&inv_wr, mr); 261859464ef4SVu Pham wr = &inv_wr; 261959464ef4SVu Pham } 262059464ef4SVu Pham 262159464ef4SVu Pham /* Prepare FASTREG WR */ 262259464ef4SVu Pham memset(&fr_wr, 0, sizeof(fr_wr)); 26239bb4ca68SNicholas Bellinger fr_wr.wr_id = ISER_FASTREG_LI_WRID; 262459464ef4SVu Pham fr_wr.opcode = IB_WR_FAST_REG_MR; 26259e961ae7SSagi Grimberg fr_wr.wr.fast_reg.iova_start = frpl->page_list[0] + page_off; 26269e961ae7SSagi Grimberg fr_wr.wr.fast_reg.page_list = frpl; 262759464ef4SVu Pham fr_wr.wr.fast_reg.page_list_len = pagelist_len; 262859464ef4SVu Pham fr_wr.wr.fast_reg.page_shift = PAGE_SHIFT; 2629e3d7e4c3SSagi Grimberg fr_wr.wr.fast_reg.length = mem->len; 26309e961ae7SSagi Grimberg fr_wr.wr.fast_reg.rkey = mr->rkey; 263159464ef4SVu Pham fr_wr.wr.fast_reg.access_flags = IB_ACCESS_LOCAL_WRITE; 263259464ef4SVu Pham 263359464ef4SVu Pham if (!wr) 263459464ef4SVu Pham wr = &fr_wr; 263559464ef4SVu Pham else 263659464ef4SVu Pham wr->next = &fr_wr; 263759464ef4SVu Pham 2638dac6ab30SSagi Grimberg ret = ib_post_send(isert_conn->qp, wr, &bad_wr); 263959464ef4SVu Pham if (ret) { 264024f412ddSSagi Grimberg isert_err("fast registration failed, ret:%d\n", ret); 264159464ef4SVu Pham return ret; 264259464ef4SVu Pham } 26439e961ae7SSagi Grimberg fr_desc->ind &= ~ind; 264459464ef4SVu Pham 26459e961ae7SSagi Grimberg sge->lkey = mr->lkey; 26469e961ae7SSagi Grimberg sge->addr = frpl->page_list[0] + page_off; 2647e3d7e4c3SSagi Grimberg sge->length = mem->len; 264859464ef4SVu Pham 26494c22e07fSSagi Grimberg isert_dbg("sge: addr: 0x%llx length: %u lkey: %x\n", 26504c22e07fSSagi Grimberg sge->addr, sge->length, sge->lkey); 265159464ef4SVu Pham 265259464ef4SVu Pham return ret; 265359464ef4SVu Pham } 265459464ef4SVu Pham 26553d73cf1aSSagi Grimberg static inline void 26563d73cf1aSSagi Grimberg isert_set_dif_domain(struct se_cmd *se_cmd, struct ib_sig_attrs *sig_attrs, 26573d73cf1aSSagi Grimberg struct ib_sig_domain *domain) 26589e961ae7SSagi Grimberg { 265978eda2bbSSagi Grimberg domain->sig_type = IB_SIG_TYPE_T10_DIF; 26603d73cf1aSSagi Grimberg domain->sig.dif.bg_type = IB_T10DIF_CRC; 26613d73cf1aSSagi Grimberg domain->sig.dif.pi_interval = se_cmd->se_dev->dev_attrib.block_size; 26623d73cf1aSSagi Grimberg domain->sig.dif.ref_tag = se_cmd->reftag_seed; 266378eda2bbSSagi Grimberg /* 266478eda2bbSSagi Grimberg * At the moment we hard code those, but if in the future 266578eda2bbSSagi Grimberg * the target core would like to use it, we will take it 266678eda2bbSSagi Grimberg * from se_cmd. 266778eda2bbSSagi Grimberg */ 266878eda2bbSSagi Grimberg domain->sig.dif.apptag_check_mask = 0xffff; 266978eda2bbSSagi Grimberg domain->sig.dif.app_escape = true; 267078eda2bbSSagi Grimberg domain->sig.dif.ref_escape = true; 267178eda2bbSSagi Grimberg if (se_cmd->prot_type == TARGET_DIF_TYPE1_PROT || 267278eda2bbSSagi Grimberg se_cmd->prot_type == TARGET_DIF_TYPE2_PROT) 267378eda2bbSSagi Grimberg domain->sig.dif.ref_remap = true; 26743d73cf1aSSagi Grimberg }; 26753d73cf1aSSagi Grimberg 26763d73cf1aSSagi Grimberg static int 26773d73cf1aSSagi Grimberg isert_set_sig_attrs(struct se_cmd *se_cmd, struct ib_sig_attrs *sig_attrs) 26783d73cf1aSSagi Grimberg { 26799e961ae7SSagi Grimberg switch (se_cmd->prot_op) { 26809e961ae7SSagi Grimberg case TARGET_PROT_DIN_INSERT: 26819e961ae7SSagi Grimberg case TARGET_PROT_DOUT_STRIP: 268278eda2bbSSagi Grimberg sig_attrs->mem.sig_type = IB_SIG_TYPE_NONE; 26833d73cf1aSSagi Grimberg isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->wire); 26849e961ae7SSagi Grimberg break; 26859e961ae7SSagi Grimberg case TARGET_PROT_DOUT_INSERT: 26869e961ae7SSagi Grimberg case TARGET_PROT_DIN_STRIP: 268778eda2bbSSagi Grimberg sig_attrs->wire.sig_type = IB_SIG_TYPE_NONE; 26883d73cf1aSSagi Grimberg isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->mem); 26899e961ae7SSagi Grimberg break; 26909e961ae7SSagi Grimberg case TARGET_PROT_DIN_PASS: 26919e961ae7SSagi Grimberg case TARGET_PROT_DOUT_PASS: 26923d73cf1aSSagi Grimberg isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->wire); 26933d73cf1aSSagi Grimberg isert_set_dif_domain(se_cmd, sig_attrs, &sig_attrs->mem); 26949e961ae7SSagi Grimberg break; 26959e961ae7SSagi Grimberg default: 269624f412ddSSagi Grimberg isert_err("Unsupported PI operation %d\n", se_cmd->prot_op); 26979e961ae7SSagi Grimberg return -EINVAL; 26989e961ae7SSagi Grimberg } 26999e961ae7SSagi Grimberg 27009e961ae7SSagi Grimberg return 0; 27019e961ae7SSagi Grimberg } 27029e961ae7SSagi Grimberg 27039e961ae7SSagi Grimberg static inline u8 27049e961ae7SSagi Grimberg isert_set_prot_checks(u8 prot_checks) 27059e961ae7SSagi Grimberg { 27069e961ae7SSagi Grimberg return (prot_checks & TARGET_DIF_CHECK_GUARD ? 0xc0 : 0) | 27079e961ae7SSagi Grimberg (prot_checks & TARGET_DIF_CHECK_REFTAG ? 0x30 : 0) | 27089e961ae7SSagi Grimberg (prot_checks & TARGET_DIF_CHECK_REFTAG ? 0x0f : 0); 27099e961ae7SSagi Grimberg } 27109e961ae7SSagi Grimberg 27119e961ae7SSagi Grimberg static int 2712570db170SSagi Grimberg isert_reg_sig_mr(struct isert_conn *isert_conn, 2713570db170SSagi Grimberg struct se_cmd *se_cmd, 2714570db170SSagi Grimberg struct isert_rdma_wr *rdma_wr, 2715570db170SSagi Grimberg struct fast_reg_descriptor *fr_desc) 27169e961ae7SSagi Grimberg { 27179e961ae7SSagi Grimberg struct ib_send_wr sig_wr, inv_wr; 27189e961ae7SSagi Grimberg struct ib_send_wr *bad_wr, *wr = NULL; 27199e961ae7SSagi Grimberg struct pi_context *pi_ctx = fr_desc->pi_ctx; 27209e961ae7SSagi Grimberg struct ib_sig_attrs sig_attrs; 27219e961ae7SSagi Grimberg int ret; 27229e961ae7SSagi Grimberg 27239e961ae7SSagi Grimberg memset(&sig_attrs, 0, sizeof(sig_attrs)); 27249e961ae7SSagi Grimberg ret = isert_set_sig_attrs(se_cmd, &sig_attrs); 27259e961ae7SSagi Grimberg if (ret) 27269e961ae7SSagi Grimberg goto err; 27279e961ae7SSagi Grimberg 27289e961ae7SSagi Grimberg sig_attrs.check_mask = isert_set_prot_checks(se_cmd->prot_checks); 27299e961ae7SSagi Grimberg 27309e961ae7SSagi Grimberg if (!(fr_desc->ind & ISERT_SIG_KEY_VALID)) { 273110633c37SSagi Grimberg isert_inv_rkey(&inv_wr, pi_ctx->sig_mr); 27329e961ae7SSagi Grimberg wr = &inv_wr; 27339e961ae7SSagi Grimberg } 27349e961ae7SSagi Grimberg 27359e961ae7SSagi Grimberg memset(&sig_wr, 0, sizeof(sig_wr)); 27369e961ae7SSagi Grimberg sig_wr.opcode = IB_WR_REG_SIG_MR; 2737c2caa207SSagi Grimberg sig_wr.wr_id = ISER_FASTREG_LI_WRID; 2738570db170SSagi Grimberg sig_wr.sg_list = &rdma_wr->ib_sg[DATA]; 27399e961ae7SSagi Grimberg sig_wr.num_sge = 1; 27409e961ae7SSagi Grimberg sig_wr.wr.sig_handover.access_flags = IB_ACCESS_LOCAL_WRITE; 27419e961ae7SSagi Grimberg sig_wr.wr.sig_handover.sig_attrs = &sig_attrs; 27429e961ae7SSagi Grimberg sig_wr.wr.sig_handover.sig_mr = pi_ctx->sig_mr; 27439e961ae7SSagi Grimberg if (se_cmd->t_prot_sg) 2744570db170SSagi Grimberg sig_wr.wr.sig_handover.prot = &rdma_wr->ib_sg[PROT]; 27459e961ae7SSagi Grimberg 27469e961ae7SSagi Grimberg if (!wr) 27479e961ae7SSagi Grimberg wr = &sig_wr; 27489e961ae7SSagi Grimberg else 27499e961ae7SSagi Grimberg wr->next = &sig_wr; 27509e961ae7SSagi Grimberg 2751dac6ab30SSagi Grimberg ret = ib_post_send(isert_conn->qp, wr, &bad_wr); 27529e961ae7SSagi Grimberg if (ret) { 275324f412ddSSagi Grimberg isert_err("fast registration failed, ret:%d\n", ret); 27549e961ae7SSagi Grimberg goto err; 27559e961ae7SSagi Grimberg } 27569e961ae7SSagi Grimberg fr_desc->ind &= ~ISERT_SIG_KEY_VALID; 27579e961ae7SSagi Grimberg 2758570db170SSagi Grimberg rdma_wr->ib_sg[SIG].lkey = pi_ctx->sig_mr->lkey; 2759570db170SSagi Grimberg rdma_wr->ib_sg[SIG].addr = 0; 2760570db170SSagi Grimberg rdma_wr->ib_sg[SIG].length = se_cmd->data_length; 27619e961ae7SSagi Grimberg if (se_cmd->prot_op != TARGET_PROT_DIN_STRIP && 27629e961ae7SSagi Grimberg se_cmd->prot_op != TARGET_PROT_DOUT_INSERT) 27639e961ae7SSagi Grimberg /* 27649e961ae7SSagi Grimberg * We have protection guards on the wire 27659e961ae7SSagi Grimberg * so we need to set a larget transfer 27669e961ae7SSagi Grimberg */ 2767570db170SSagi Grimberg rdma_wr->ib_sg[SIG].length += se_cmd->prot_length; 27689e961ae7SSagi Grimberg 276924f412ddSSagi Grimberg isert_dbg("sig_sge: addr: 0x%llx length: %u lkey: %x\n", 2770570db170SSagi Grimberg rdma_wr->ib_sg[SIG].addr, rdma_wr->ib_sg[SIG].length, 2771570db170SSagi Grimberg rdma_wr->ib_sg[SIG].lkey); 27729e961ae7SSagi Grimberg err: 27739e961ae7SSagi Grimberg return ret; 27749e961ae7SSagi Grimberg } 27759e961ae7SSagi Grimberg 277659464ef4SVu Pham static int 2777570db170SSagi Grimberg isert_handle_prot_cmd(struct isert_conn *isert_conn, 2778570db170SSagi Grimberg struct isert_cmd *isert_cmd, 2779570db170SSagi Grimberg struct isert_rdma_wr *wr) 2780570db170SSagi Grimberg { 2781dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 2782570db170SSagi Grimberg struct se_cmd *se_cmd = &isert_cmd->iscsi_cmd->se_cmd; 2783570db170SSagi Grimberg int ret; 2784570db170SSagi Grimberg 2785570db170SSagi Grimberg if (!wr->fr_desc->pi_ctx) { 2786570db170SSagi Grimberg ret = isert_create_pi_ctx(wr->fr_desc, 2787570db170SSagi Grimberg device->ib_device, 278867cb3949SSagi Grimberg device->pd); 2789570db170SSagi Grimberg if (ret) { 279024f412ddSSagi Grimberg isert_err("conn %p failed to allocate pi_ctx\n", 2791570db170SSagi Grimberg isert_conn); 2792570db170SSagi Grimberg return ret; 2793570db170SSagi Grimberg } 2794570db170SSagi Grimberg } 2795570db170SSagi Grimberg 2796570db170SSagi Grimberg if (se_cmd->t_prot_sg) { 2797570db170SSagi Grimberg ret = isert_map_data_buf(isert_conn, isert_cmd, 2798570db170SSagi Grimberg se_cmd->t_prot_sg, 2799570db170SSagi Grimberg se_cmd->t_prot_nents, 2800570db170SSagi Grimberg se_cmd->prot_length, 2801570db170SSagi Grimberg 0, wr->iser_ib_op, &wr->prot); 2802570db170SSagi Grimberg if (ret) { 280324f412ddSSagi Grimberg isert_err("conn %p failed to map protection buffer\n", 2804570db170SSagi Grimberg isert_conn); 2805570db170SSagi Grimberg return ret; 2806570db170SSagi Grimberg } 2807570db170SSagi Grimberg 2808570db170SSagi Grimberg memset(&wr->ib_sg[PROT], 0, sizeof(wr->ib_sg[PROT])); 2809570db170SSagi Grimberg ret = isert_fast_reg_mr(isert_conn, wr->fr_desc, &wr->prot, 2810570db170SSagi Grimberg ISERT_PROT_KEY_VALID, &wr->ib_sg[PROT]); 2811570db170SSagi Grimberg if (ret) { 281224f412ddSSagi Grimberg isert_err("conn %p failed to fast reg mr\n", 2813570db170SSagi Grimberg isert_conn); 2814570db170SSagi Grimberg goto unmap_prot_cmd; 2815570db170SSagi Grimberg } 2816570db170SSagi Grimberg } 2817570db170SSagi Grimberg 2818570db170SSagi Grimberg ret = isert_reg_sig_mr(isert_conn, se_cmd, wr, wr->fr_desc); 2819570db170SSagi Grimberg if (ret) { 282024f412ddSSagi Grimberg isert_err("conn %p failed to fast reg mr\n", 2821570db170SSagi Grimberg isert_conn); 2822570db170SSagi Grimberg goto unmap_prot_cmd; 2823570db170SSagi Grimberg } 2824570db170SSagi Grimberg wr->fr_desc->ind |= ISERT_PROTECTED; 2825570db170SSagi Grimberg 2826570db170SSagi Grimberg return 0; 2827570db170SSagi Grimberg 2828570db170SSagi Grimberg unmap_prot_cmd: 2829570db170SSagi Grimberg if (se_cmd->t_prot_sg) 2830570db170SSagi Grimberg isert_unmap_data_buf(isert_conn, &wr->prot); 2831570db170SSagi Grimberg 2832570db170SSagi Grimberg return ret; 2833570db170SSagi Grimberg } 2834570db170SSagi Grimberg 2835570db170SSagi Grimberg static int 2836a3a5a826SSagi Grimberg isert_reg_rdma(struct iscsi_conn *conn, struct iscsi_cmd *cmd, 283759464ef4SVu Pham struct isert_rdma_wr *wr) 283859464ef4SVu Pham { 283959464ef4SVu Pham struct se_cmd *se_cmd = &cmd->se_cmd; 284059464ef4SVu Pham struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 2841e3d7e4c3SSagi Grimberg struct isert_conn *isert_conn = conn->context; 2842e3d7e4c3SSagi Grimberg struct fast_reg_descriptor *fr_desc = NULL; 2843570db170SSagi Grimberg struct ib_send_wr *send_wr; 2844570db170SSagi Grimberg struct ib_sge *ib_sg; 2845e3d7e4c3SSagi Grimberg u32 offset; 2846e3d7e4c3SSagi Grimberg int ret = 0; 284759464ef4SVu Pham unsigned long flags; 284859464ef4SVu Pham 284959464ef4SVu Pham isert_cmd->tx_desc.isert_cmd = isert_cmd; 2850e3d7e4c3SSagi Grimberg 2851e3d7e4c3SSagi Grimberg offset = wr->iser_ib_op == ISER_IB_RDMA_READ ? cmd->write_data_done : 0; 2852e3d7e4c3SSagi Grimberg ret = isert_map_data_buf(isert_conn, isert_cmd, se_cmd->t_data_sg, 2853e3d7e4c3SSagi Grimberg se_cmd->t_data_nents, se_cmd->data_length, 2854e3d7e4c3SSagi Grimberg offset, wr->iser_ib_op, &wr->data); 2855e3d7e4c3SSagi Grimberg if (ret) 2856e3d7e4c3SSagi Grimberg return ret; 2857e3d7e4c3SSagi Grimberg 2858302cc7c3SSagi Grimberg if (wr->data.dma_nents != 1 || isert_prot_cmd(isert_conn, se_cmd)) { 2859dac6ab30SSagi Grimberg spin_lock_irqsave(&isert_conn->pool_lock, flags); 2860dac6ab30SSagi Grimberg fr_desc = list_first_entry(&isert_conn->fr_pool, 2861e3d7e4c3SSagi Grimberg struct fast_reg_descriptor, list); 2862e3d7e4c3SSagi Grimberg list_del(&fr_desc->list); 2863dac6ab30SSagi Grimberg spin_unlock_irqrestore(&isert_conn->pool_lock, flags); 2864e3d7e4c3SSagi Grimberg wr->fr_desc = fr_desc; 286559464ef4SVu Pham } 286659464ef4SVu Pham 28679e961ae7SSagi Grimberg ret = isert_fast_reg_mr(isert_conn, fr_desc, &wr->data, 2868570db170SSagi Grimberg ISERT_DATA_KEY_VALID, &wr->ib_sg[DATA]); 2869e3d7e4c3SSagi Grimberg if (ret) 2870e3d7e4c3SSagi Grimberg goto unmap_cmd; 287159464ef4SVu Pham 2872302cc7c3SSagi Grimberg if (isert_prot_cmd(isert_conn, se_cmd)) { 2873570db170SSagi Grimberg ret = isert_handle_prot_cmd(isert_conn, isert_cmd, wr); 28749e961ae7SSagi Grimberg if (ret) 28759e961ae7SSagi Grimberg goto unmap_cmd; 28769e961ae7SSagi Grimberg 2877570db170SSagi Grimberg ib_sg = &wr->ib_sg[SIG]; 2878570db170SSagi Grimberg } else { 2879570db170SSagi Grimberg ib_sg = &wr->ib_sg[DATA]; 28809e961ae7SSagi Grimberg } 28819e961ae7SSagi Grimberg 2882570db170SSagi Grimberg memcpy(&wr->s_ib_sge, ib_sg, sizeof(*ib_sg)); 2883e3d7e4c3SSagi Grimberg wr->ib_sge = &wr->s_ib_sge; 288459464ef4SVu Pham wr->send_wr_num = 1; 288559464ef4SVu Pham memset(&wr->s_send_wr, 0, sizeof(*send_wr)); 288659464ef4SVu Pham wr->send_wr = &wr->s_send_wr; 288759464ef4SVu Pham wr->isert_cmd = isert_cmd; 288859464ef4SVu Pham 288959464ef4SVu Pham send_wr = &isert_cmd->rdma_wr.s_send_wr; 2890e3d7e4c3SSagi Grimberg send_wr->sg_list = &wr->s_ib_sge; 289159464ef4SVu Pham send_wr->num_sge = 1; 2892b0a191e7SSagi Grimberg send_wr->wr_id = (uintptr_t)&isert_cmd->tx_desc; 289359464ef4SVu Pham if (wr->iser_ib_op == ISER_IB_RDMA_WRITE) { 289459464ef4SVu Pham send_wr->opcode = IB_WR_RDMA_WRITE; 289559464ef4SVu Pham send_wr->wr.rdma.remote_addr = isert_cmd->read_va; 289659464ef4SVu Pham send_wr->wr.rdma.rkey = isert_cmd->read_stag; 2897302cc7c3SSagi Grimberg send_wr->send_flags = !isert_prot_cmd(isert_conn, se_cmd) ? 28989e961ae7SSagi Grimberg 0 : IB_SEND_SIGNALED; 289959464ef4SVu Pham } else { 290059464ef4SVu Pham send_wr->opcode = IB_WR_RDMA_READ; 290159464ef4SVu Pham send_wr->wr.rdma.remote_addr = isert_cmd->write_va; 290259464ef4SVu Pham send_wr->wr.rdma.rkey = isert_cmd->write_stag; 290359464ef4SVu Pham send_wr->send_flags = IB_SEND_SIGNALED; 290459464ef4SVu Pham } 290559464ef4SVu Pham 290659464ef4SVu Pham return 0; 2907570db170SSagi Grimberg 2908e3d7e4c3SSagi Grimberg unmap_cmd: 2909e3d7e4c3SSagi Grimberg if (fr_desc) { 2910dac6ab30SSagi Grimberg spin_lock_irqsave(&isert_conn->pool_lock, flags); 2911dac6ab30SSagi Grimberg list_add_tail(&fr_desc->list, &isert_conn->fr_pool); 2912dac6ab30SSagi Grimberg spin_unlock_irqrestore(&isert_conn->pool_lock, flags); 2913e3d7e4c3SSagi Grimberg } 2914e3d7e4c3SSagi Grimberg isert_unmap_data_buf(isert_conn, &wr->data); 291559464ef4SVu Pham 291659464ef4SVu Pham return ret; 291759464ef4SVu Pham } 291859464ef4SVu Pham 291959464ef4SVu Pham static int 292090ecc6e2SVu Pham isert_put_datain(struct iscsi_conn *conn, struct iscsi_cmd *cmd) 292190ecc6e2SVu Pham { 292290ecc6e2SVu Pham struct se_cmd *se_cmd = &cmd->se_cmd; 292359464ef4SVu Pham struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 292490ecc6e2SVu Pham struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 29256700425eSSagi Grimberg struct isert_conn *isert_conn = conn->context; 2926dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 292790ecc6e2SVu Pham struct ib_send_wr *wr_failed; 292890ecc6e2SVu Pham int rc; 292990ecc6e2SVu Pham 293024f412ddSSagi Grimberg isert_dbg("Cmd: %p RDMA_WRITE data_length: %u\n", 293190ecc6e2SVu Pham isert_cmd, se_cmd->data_length); 29324c22e07fSSagi Grimberg 293390ecc6e2SVu Pham wr->iser_ib_op = ISER_IB_RDMA_WRITE; 2934d40945d8SVu Pham rc = device->reg_rdma_mem(conn, cmd, wr); 293590ecc6e2SVu Pham if (rc) { 293624f412ddSSagi Grimberg isert_err("Cmd: %p failed to prepare RDMA res\n", isert_cmd); 293790ecc6e2SVu Pham return rc; 293890ecc6e2SVu Pham } 293990ecc6e2SVu Pham 2940302cc7c3SSagi Grimberg if (!isert_prot_cmd(isert_conn, se_cmd)) { 2941b8d26b3bSNicholas Bellinger /* 2942b8d26b3bSNicholas Bellinger * Build isert_conn->tx_desc for iSCSI response PDU and attach 2943b8d26b3bSNicholas Bellinger */ 29449e961ae7SSagi Grimberg isert_create_send_desc(isert_conn, isert_cmd, 29459e961ae7SSagi Grimberg &isert_cmd->tx_desc); 294604d9cd12SNicholas Bellinger iscsit_build_rsp_pdu(cmd, conn, true, (struct iscsi_scsi_rsp *) 2947b8d26b3bSNicholas Bellinger &isert_cmd->tx_desc.iscsi_header); 2948b8d26b3bSNicholas Bellinger isert_init_tx_hdrs(isert_conn, &isert_cmd->tx_desc); 294995b60f07SNicholas Bellinger isert_init_send_wr(isert_conn, isert_cmd, 295068a86deeSSagi Grimberg &isert_cmd->tx_desc.send_wr); 29519e961ae7SSagi Grimberg isert_cmd->rdma_wr.s_send_wr.next = &isert_cmd->tx_desc.send_wr; 2952897bb2c9SSagi Grimberg wr->send_wr_num += 1; 29539e961ae7SSagi Grimberg } 2954b8d26b3bSNicholas Bellinger 2955dac6ab30SSagi Grimberg rc = ib_post_send(isert_conn->qp, wr->send_wr, &wr_failed); 2956bdf20e72SSagi Grimberg if (rc) 295724f412ddSSagi Grimberg isert_warn("ib_post_send() failed for IB_WR_RDMA_WRITE\n"); 29589e961ae7SSagi Grimberg 2959302cc7c3SSagi Grimberg if (!isert_prot_cmd(isert_conn, se_cmd)) 296024f412ddSSagi Grimberg isert_dbg("Cmd: %p posted RDMA_WRITE + Response for iSER Data " 29619e961ae7SSagi Grimberg "READ\n", isert_cmd); 29629e961ae7SSagi Grimberg else 296324f412ddSSagi Grimberg isert_dbg("Cmd: %p posted RDMA_WRITE for iSER Data READ\n", 296490ecc6e2SVu Pham isert_cmd); 2965b8d26b3bSNicholas Bellinger 296690ecc6e2SVu Pham return 1; 2967b8d26b3bSNicholas Bellinger } 2968b8d26b3bSNicholas Bellinger 2969b8d26b3bSNicholas Bellinger static int 2970b8d26b3bSNicholas Bellinger isert_get_dataout(struct iscsi_conn *conn, struct iscsi_cmd *cmd, bool recovery) 2971b8d26b3bSNicholas Bellinger { 2972b8d26b3bSNicholas Bellinger struct se_cmd *se_cmd = &cmd->se_cmd; 2973d703ce2fSNicholas Bellinger struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 2974b8d26b3bSNicholas Bellinger struct isert_rdma_wr *wr = &isert_cmd->rdma_wr; 29756700425eSSagi Grimberg struct isert_conn *isert_conn = conn->context; 2976dac6ab30SSagi Grimberg struct isert_device *device = isert_conn->device; 297790ecc6e2SVu Pham struct ib_send_wr *wr_failed; 297890ecc6e2SVu Pham int rc; 2979b8d26b3bSNicholas Bellinger 298024f412ddSSagi Grimberg isert_dbg("Cmd: %p RDMA_READ data_length: %u write_data_done: %u\n", 298190ecc6e2SVu Pham isert_cmd, se_cmd->data_length, cmd->write_data_done); 2982b8d26b3bSNicholas Bellinger wr->iser_ib_op = ISER_IB_RDMA_READ; 2983d40945d8SVu Pham rc = device->reg_rdma_mem(conn, cmd, wr); 298490ecc6e2SVu Pham if (rc) { 298524f412ddSSagi Grimberg isert_err("Cmd: %p failed to prepare RDMA res\n", isert_cmd); 298690ecc6e2SVu Pham return rc; 2987b8d26b3bSNicholas Bellinger } 2988b8d26b3bSNicholas Bellinger 2989dac6ab30SSagi Grimberg rc = ib_post_send(isert_conn->qp, wr->send_wr, &wr_failed); 2990bdf20e72SSagi Grimberg if (rc) 299124f412ddSSagi Grimberg isert_warn("ib_post_send() failed for IB_WR_RDMA_READ\n"); 2992bdf20e72SSagi Grimberg 299324f412ddSSagi Grimberg isert_dbg("Cmd: %p posted RDMA_READ memory for ISER Data WRITE\n", 299490ecc6e2SVu Pham isert_cmd); 2995b8d26b3bSNicholas Bellinger 299690ecc6e2SVu Pham return 0; 2997b8d26b3bSNicholas Bellinger } 2998b8d26b3bSNicholas Bellinger 2999b8d26b3bSNicholas Bellinger static int 3000b8d26b3bSNicholas Bellinger isert_immediate_queue(struct iscsi_conn *conn, struct iscsi_cmd *cmd, int state) 3001b8d26b3bSNicholas Bellinger { 3002*a4c15cd9SJenny Derzhavetz struct isert_cmd *isert_cmd = iscsit_priv_cmd(cmd); 3003*a4c15cd9SJenny Derzhavetz int ret = 0; 3004b8d26b3bSNicholas Bellinger 3005b8d26b3bSNicholas Bellinger switch (state) { 3006*a4c15cd9SJenny Derzhavetz case ISTATE_REMOVE: 3007*a4c15cd9SJenny Derzhavetz spin_lock_bh(&conn->cmd_lock); 3008*a4c15cd9SJenny Derzhavetz list_del_init(&cmd->i_conn_node); 3009*a4c15cd9SJenny Derzhavetz spin_unlock_bh(&conn->cmd_lock); 3010*a4c15cd9SJenny Derzhavetz isert_put_cmd(isert_cmd, true); 3011*a4c15cd9SJenny Derzhavetz break; 3012b8d26b3bSNicholas Bellinger case ISTATE_SEND_NOPIN_WANT_RESPONSE: 3013b8d26b3bSNicholas Bellinger ret = isert_put_nopin(cmd, conn, false); 3014b8d26b3bSNicholas Bellinger break; 3015b8d26b3bSNicholas Bellinger default: 301624f412ddSSagi Grimberg isert_err("Unknown immediate state: 0x%02x\n", state); 3017b8d26b3bSNicholas Bellinger ret = -EINVAL; 3018b8d26b3bSNicholas Bellinger break; 3019b8d26b3bSNicholas Bellinger } 3020b8d26b3bSNicholas Bellinger 3021b8d26b3bSNicholas Bellinger return ret; 3022b8d26b3bSNicholas Bellinger } 3023b8d26b3bSNicholas Bellinger 3024b8d26b3bSNicholas Bellinger static int 3025b8d26b3bSNicholas Bellinger isert_response_queue(struct iscsi_conn *conn, struct iscsi_cmd *cmd, int state) 3026b8d26b3bSNicholas Bellinger { 3027991bb764SSagi Grimberg struct isert_conn *isert_conn = conn->context; 3028b8d26b3bSNicholas Bellinger int ret; 3029b8d26b3bSNicholas Bellinger 3030b8d26b3bSNicholas Bellinger switch (state) { 3031b8d26b3bSNicholas Bellinger case ISTATE_SEND_LOGOUTRSP: 3032b8d26b3bSNicholas Bellinger ret = isert_put_logout_rsp(cmd, conn); 3033991bb764SSagi Grimberg if (!ret) 3034991bb764SSagi Grimberg isert_conn->logout_posted = true; 3035b8d26b3bSNicholas Bellinger break; 3036b8d26b3bSNicholas Bellinger case ISTATE_SEND_NOPIN: 3037b8d26b3bSNicholas Bellinger ret = isert_put_nopin(cmd, conn, true); 3038b8d26b3bSNicholas Bellinger break; 3039b8d26b3bSNicholas Bellinger case ISTATE_SEND_TASKMGTRSP: 3040b8d26b3bSNicholas Bellinger ret = isert_put_tm_rsp(cmd, conn); 3041b8d26b3bSNicholas Bellinger break; 3042b8d26b3bSNicholas Bellinger case ISTATE_SEND_REJECT: 3043b8d26b3bSNicholas Bellinger ret = isert_put_reject(cmd, conn); 3044b8d26b3bSNicholas Bellinger break; 3045adb54c29SNicholas Bellinger case ISTATE_SEND_TEXTRSP: 3046adb54c29SNicholas Bellinger ret = isert_put_text_rsp(cmd, conn); 3047adb54c29SNicholas Bellinger break; 3048b8d26b3bSNicholas Bellinger case ISTATE_SEND_STATUS: 3049b8d26b3bSNicholas Bellinger /* 3050b8d26b3bSNicholas Bellinger * Special case for sending non GOOD SCSI status from TX thread 3051b8d26b3bSNicholas Bellinger * context during pre se_cmd excecution failure. 3052b8d26b3bSNicholas Bellinger */ 3053b8d26b3bSNicholas Bellinger ret = isert_put_response(conn, cmd); 3054b8d26b3bSNicholas Bellinger break; 3055b8d26b3bSNicholas Bellinger default: 305624f412ddSSagi Grimberg isert_err("Unknown response state: 0x%02x\n", state); 3057b8d26b3bSNicholas Bellinger ret = -EINVAL; 3058b8d26b3bSNicholas Bellinger break; 3059b8d26b3bSNicholas Bellinger } 3060b8d26b3bSNicholas Bellinger 3061b8d26b3bSNicholas Bellinger return ret; 3062b8d26b3bSNicholas Bellinger } 3063b8d26b3bSNicholas Bellinger 3064ca6c1d82SSagi Grimberg struct rdma_cm_id * 3065ca6c1d82SSagi Grimberg isert_setup_id(struct isert_np *isert_np) 3066ca6c1d82SSagi Grimberg { 3067ca6c1d82SSagi Grimberg struct iscsi_np *np = isert_np->np; 3068ca6c1d82SSagi Grimberg struct rdma_cm_id *id; 3069ca6c1d82SSagi Grimberg struct sockaddr *sa; 3070ca6c1d82SSagi Grimberg int ret; 3071ca6c1d82SSagi Grimberg 3072ca6c1d82SSagi Grimberg sa = (struct sockaddr *)&np->np_sockaddr; 307324f412ddSSagi Grimberg isert_dbg("ksockaddr: %p, sa: %p\n", &np->np_sockaddr, sa); 3074ca6c1d82SSagi Grimberg 3075ca6c1d82SSagi Grimberg id = rdma_create_id(isert_cma_handler, isert_np, 3076ca6c1d82SSagi Grimberg RDMA_PS_TCP, IB_QPT_RC); 3077ca6c1d82SSagi Grimberg if (IS_ERR(id)) { 307824f412ddSSagi Grimberg isert_err("rdma_create_id() failed: %ld\n", PTR_ERR(id)); 3079ca6c1d82SSagi Grimberg ret = PTR_ERR(id); 3080ca6c1d82SSagi Grimberg goto out; 3081ca6c1d82SSagi Grimberg } 308224f412ddSSagi Grimberg isert_dbg("id %p context %p\n", id, id->context); 3083ca6c1d82SSagi Grimberg 3084ca6c1d82SSagi Grimberg ret = rdma_bind_addr(id, sa); 3085ca6c1d82SSagi Grimberg if (ret) { 308624f412ddSSagi Grimberg isert_err("rdma_bind_addr() failed: %d\n", ret); 3087ca6c1d82SSagi Grimberg goto out_id; 3088ca6c1d82SSagi Grimberg } 3089ca6c1d82SSagi Grimberg 3090992607e8SSagi Grimberg ret = rdma_listen(id, 0); 3091ca6c1d82SSagi Grimberg if (ret) { 309224f412ddSSagi Grimberg isert_err("rdma_listen() failed: %d\n", ret); 3093ca6c1d82SSagi Grimberg goto out_id; 3094ca6c1d82SSagi Grimberg } 3095ca6c1d82SSagi Grimberg 3096ca6c1d82SSagi Grimberg return id; 3097ca6c1d82SSagi Grimberg out_id: 3098ca6c1d82SSagi Grimberg rdma_destroy_id(id); 3099ca6c1d82SSagi Grimberg out: 3100ca6c1d82SSagi Grimberg return ERR_PTR(ret); 3101ca6c1d82SSagi Grimberg } 3102ca6c1d82SSagi Grimberg 3103b8d26b3bSNicholas Bellinger static int 3104b8d26b3bSNicholas Bellinger isert_setup_np(struct iscsi_np *np, 310513a3cf08SAndy Grover struct sockaddr_storage *ksockaddr) 3106b8d26b3bSNicholas Bellinger { 3107b8d26b3bSNicholas Bellinger struct isert_np *isert_np; 3108b8d26b3bSNicholas Bellinger struct rdma_cm_id *isert_lid; 3109b8d26b3bSNicholas Bellinger int ret; 3110b8d26b3bSNicholas Bellinger 3111b8d26b3bSNicholas Bellinger isert_np = kzalloc(sizeof(struct isert_np), GFP_KERNEL); 3112b8d26b3bSNicholas Bellinger if (!isert_np) { 311324f412ddSSagi Grimberg isert_err("Unable to allocate struct isert_np\n"); 3114b8d26b3bSNicholas Bellinger return -ENOMEM; 3115b8d26b3bSNicholas Bellinger } 3116531b7bf4SSagi Grimberg sema_init(&isert_np->np_sem, 0); 3117b8d26b3bSNicholas Bellinger mutex_init(&isert_np->np_accept_mutex); 3118b8d26b3bSNicholas Bellinger INIT_LIST_HEAD(&isert_np->np_accept_list); 3119b8d26b3bSNicholas Bellinger init_completion(&isert_np->np_login_comp); 3120ca6c1d82SSagi Grimberg isert_np->np = np; 3121b8d26b3bSNicholas Bellinger 3122b8d26b3bSNicholas Bellinger /* 3123b8d26b3bSNicholas Bellinger * Setup the np->np_sockaddr from the passed sockaddr setup 3124b8d26b3bSNicholas Bellinger * in iscsi_target_configfs.c code.. 3125b8d26b3bSNicholas Bellinger */ 3126b8d26b3bSNicholas Bellinger memcpy(&np->np_sockaddr, ksockaddr, 312713a3cf08SAndy Grover sizeof(struct sockaddr_storage)); 3128b8d26b3bSNicholas Bellinger 3129ca6c1d82SSagi Grimberg isert_lid = isert_setup_id(isert_np); 3130b8d26b3bSNicholas Bellinger if (IS_ERR(isert_lid)) { 3131b8d26b3bSNicholas Bellinger ret = PTR_ERR(isert_lid); 3132b8d26b3bSNicholas Bellinger goto out; 3133b8d26b3bSNicholas Bellinger } 3134b8d26b3bSNicholas Bellinger 3135b8d26b3bSNicholas Bellinger isert_np->np_cm_id = isert_lid; 3136b8d26b3bSNicholas Bellinger np->np_context = isert_np; 3137b8d26b3bSNicholas Bellinger 3138b8d26b3bSNicholas Bellinger return 0; 3139b8d26b3bSNicholas Bellinger 3140b8d26b3bSNicholas Bellinger out: 3141b8d26b3bSNicholas Bellinger kfree(isert_np); 3142ca6c1d82SSagi Grimberg 3143b8d26b3bSNicholas Bellinger return ret; 3144b8d26b3bSNicholas Bellinger } 3145b8d26b3bSNicholas Bellinger 3146b8d26b3bSNicholas Bellinger static int 3147b8d26b3bSNicholas Bellinger isert_rdma_accept(struct isert_conn *isert_conn) 3148b8d26b3bSNicholas Bellinger { 3149dac6ab30SSagi Grimberg struct rdma_cm_id *cm_id = isert_conn->cm_id; 3150b8d26b3bSNicholas Bellinger struct rdma_conn_param cp; 3151b8d26b3bSNicholas Bellinger int ret; 3152b8d26b3bSNicholas Bellinger 3153b8d26b3bSNicholas Bellinger memset(&cp, 0, sizeof(struct rdma_conn_param)); 3154b8d26b3bSNicholas Bellinger cp.initiator_depth = isert_conn->initiator_depth; 3155b8d26b3bSNicholas Bellinger cp.retry_count = 7; 3156b8d26b3bSNicholas Bellinger cp.rnr_retry_count = 7; 3157b8d26b3bSNicholas Bellinger 3158b8d26b3bSNicholas Bellinger ret = rdma_accept(cm_id, &cp); 3159b8d26b3bSNicholas Bellinger if (ret) { 316024f412ddSSagi Grimberg isert_err("rdma_accept() failed with: %d\n", ret); 3161b8d26b3bSNicholas Bellinger return ret; 3162b8d26b3bSNicholas Bellinger } 3163b8d26b3bSNicholas Bellinger 3164b8d26b3bSNicholas Bellinger return 0; 3165b8d26b3bSNicholas Bellinger } 3166b8d26b3bSNicholas Bellinger 3167b8d26b3bSNicholas Bellinger static int 3168b8d26b3bSNicholas Bellinger isert_get_login_rx(struct iscsi_conn *conn, struct iscsi_login *login) 3169b8d26b3bSNicholas Bellinger { 31706700425eSSagi Grimberg struct isert_conn *isert_conn = conn->context; 3171b8d26b3bSNicholas Bellinger int ret; 3172b8d26b3bSNicholas Bellinger 317324f412ddSSagi Grimberg isert_info("before login_req comp conn: %p\n", isert_conn); 31742371e5daSSagi Grimberg ret = wait_for_completion_interruptible(&isert_conn->login_req_comp); 31752371e5daSSagi Grimberg if (ret) { 317624f412ddSSagi Grimberg isert_err("isert_conn %p interrupted before got login req\n", 31772371e5daSSagi Grimberg isert_conn); 31782371e5daSSagi Grimberg return ret; 31792371e5daSSagi Grimberg } 31802371e5daSSagi Grimberg reinit_completion(&isert_conn->login_req_comp); 31812371e5daSSagi Grimberg 31826faaa85fSNicholas Bellinger /* 31836faaa85fSNicholas Bellinger * For login requests after the first PDU, isert_rx_login_req() will 31846faaa85fSNicholas Bellinger * kick schedule_delayed_work(&conn->login_work) as the packet is 31856faaa85fSNicholas Bellinger * received, which turns this callback from iscsi_target_do_login_rx() 31866faaa85fSNicholas Bellinger * into a NOP. 31876faaa85fSNicholas Bellinger */ 31886faaa85fSNicholas Bellinger if (!login->first_request) 31896faaa85fSNicholas Bellinger return 0; 3190b8d26b3bSNicholas Bellinger 31912371e5daSSagi Grimberg isert_rx_login_req(isert_conn); 31922371e5daSSagi Grimberg 3193dac6ab30SSagi Grimberg isert_info("before login_comp conn: %p\n", conn); 3194dac6ab30SSagi Grimberg ret = wait_for_completion_interruptible(&isert_conn->login_comp); 3195b8d26b3bSNicholas Bellinger if (ret) 3196b8d26b3bSNicholas Bellinger return ret; 3197b8d26b3bSNicholas Bellinger 319824f412ddSSagi Grimberg isert_info("processing login->req: %p\n", login->req); 31992371e5daSSagi Grimberg 3200b8d26b3bSNicholas Bellinger return 0; 3201b8d26b3bSNicholas Bellinger } 3202b8d26b3bSNicholas Bellinger 3203b8d26b3bSNicholas Bellinger static void 3204b8d26b3bSNicholas Bellinger isert_set_conn_info(struct iscsi_np *np, struct iscsi_conn *conn, 3205b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn) 3206b8d26b3bSNicholas Bellinger { 3207dac6ab30SSagi Grimberg struct rdma_cm_id *cm_id = isert_conn->cm_id; 3208b8d26b3bSNicholas Bellinger struct rdma_route *cm_route = &cm_id->route; 3209b8d26b3bSNicholas Bellinger 3210b8d26b3bSNicholas Bellinger conn->login_family = np->np_sockaddr.ss_family; 3211b8d26b3bSNicholas Bellinger 3212dc58f760SAndy Grover conn->login_sockaddr = cm_route->addr.dst_addr; 3213dc58f760SAndy Grover conn->local_sockaddr = cm_route->addr.src_addr; 3214b8d26b3bSNicholas Bellinger } 3215b8d26b3bSNicholas Bellinger 3216b8d26b3bSNicholas Bellinger static int 3217b8d26b3bSNicholas Bellinger isert_accept_np(struct iscsi_np *np, struct iscsi_conn *conn) 3218b8d26b3bSNicholas Bellinger { 32196700425eSSagi Grimberg struct isert_np *isert_np = np->np_context; 3220b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn; 3221c6b8e918SSagi Grimberg int ret; 3222b8d26b3bSNicholas Bellinger 3223b8d26b3bSNicholas Bellinger accept_wait: 3224531b7bf4SSagi Grimberg ret = down_interruptible(&isert_np->np_sem); 3225c6b8e918SSagi Grimberg if (ret) 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); 323111378cdbSRasmus Villemoes isert_dbg("np_thread_state %d\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 goto accept_wait; 3245b8d26b3bSNicholas Bellinger } 3246b8d26b3bSNicholas Bellinger isert_conn = list_first_entry(&isert_np->np_accept_list, 3247dac6ab30SSagi Grimberg struct isert_conn, accept_node); 3248dac6ab30SSagi Grimberg list_del_init(&isert_conn->accept_node); 3249b8d26b3bSNicholas Bellinger mutex_unlock(&isert_np->np_accept_mutex); 3250b8d26b3bSNicholas Bellinger 3251b8d26b3bSNicholas Bellinger conn->context = isert_conn; 3252b8d26b3bSNicholas Bellinger isert_conn->conn = conn; 3253b8d26b3bSNicholas Bellinger 3254b8d26b3bSNicholas Bellinger isert_set_conn_info(np, conn, isert_conn); 3255b8d26b3bSNicholas Bellinger 325624f412ddSSagi Grimberg isert_dbg("Processing isert_conn: %p\n", isert_conn); 32572371e5daSSagi Grimberg 3258b8d26b3bSNicholas Bellinger return 0; 3259b8d26b3bSNicholas Bellinger } 3260b8d26b3bSNicholas Bellinger 3261b8d26b3bSNicholas Bellinger static void 3262b8d26b3bSNicholas Bellinger isert_free_np(struct iscsi_np *np) 3263b8d26b3bSNicholas Bellinger { 32646700425eSSagi Grimberg struct isert_np *isert_np = np->np_context; 3265268e6811SSagi Grimberg struct isert_conn *isert_conn, *n; 3266b8d26b3bSNicholas Bellinger 32673b726ae2SSagi Grimberg if (isert_np->np_cm_id) 3268b8d26b3bSNicholas Bellinger rdma_destroy_id(isert_np->np_cm_id); 3269b8d26b3bSNicholas Bellinger 3270268e6811SSagi Grimberg /* 3271268e6811SSagi Grimberg * FIXME: At this point we don't have a good way to insure 3272268e6811SSagi Grimberg * that at this point we don't have hanging connections that 3273268e6811SSagi Grimberg * completed RDMA establishment but didn't start iscsi login 3274268e6811SSagi Grimberg * process. So work-around this by cleaning up what ever piled 3275268e6811SSagi Grimberg * up in np_accept_list. 3276268e6811SSagi Grimberg */ 3277268e6811SSagi Grimberg mutex_lock(&isert_np->np_accept_mutex); 3278268e6811SSagi Grimberg if (!list_empty(&isert_np->np_accept_list)) { 327924f412ddSSagi Grimberg isert_info("Still have isert connections, cleaning up...\n"); 3280268e6811SSagi Grimberg list_for_each_entry_safe(isert_conn, n, 3281268e6811SSagi Grimberg &isert_np->np_accept_list, 3282dac6ab30SSagi Grimberg accept_node) { 328324f412ddSSagi Grimberg isert_info("cleaning isert_conn %p state (%d)\n", 3284268e6811SSagi Grimberg isert_conn, isert_conn->state); 3285268e6811SSagi Grimberg isert_connect_release(isert_conn); 3286268e6811SSagi Grimberg } 3287268e6811SSagi Grimberg } 3288268e6811SSagi Grimberg mutex_unlock(&isert_np->np_accept_mutex); 3289268e6811SSagi Grimberg 3290b8d26b3bSNicholas Bellinger np->np_context = NULL; 3291b8d26b3bSNicholas Bellinger kfree(isert_np); 3292b8d26b3bSNicholas Bellinger } 3293b8d26b3bSNicholas Bellinger 3294b02efbfcSSagi Grimberg static void isert_release_work(struct work_struct *work) 3295b02efbfcSSagi Grimberg { 3296b02efbfcSSagi Grimberg struct isert_conn *isert_conn = container_of(work, 3297b02efbfcSSagi Grimberg struct isert_conn, 3298b02efbfcSSagi Grimberg release_work); 3299b02efbfcSSagi Grimberg 330024f412ddSSagi Grimberg isert_info("Starting release conn %p\n", isert_conn); 3301b02efbfcSSagi Grimberg 3302dac6ab30SSagi Grimberg wait_for_completion(&isert_conn->wait); 3303b02efbfcSSagi Grimberg 3304dac6ab30SSagi Grimberg mutex_lock(&isert_conn->mutex); 3305b02efbfcSSagi Grimberg isert_conn->state = ISER_CONN_DOWN; 3306dac6ab30SSagi Grimberg mutex_unlock(&isert_conn->mutex); 3307b02efbfcSSagi Grimberg 330824f412ddSSagi Grimberg isert_info("Destroying conn %p\n", isert_conn); 3309b02efbfcSSagi Grimberg isert_put_conn(isert_conn); 3310b02efbfcSSagi Grimberg } 3311b02efbfcSSagi Grimberg 3312bdf20e72SSagi Grimberg static void 3313991bb764SSagi Grimberg isert_wait4logout(struct isert_conn *isert_conn) 3314991bb764SSagi Grimberg { 3315991bb764SSagi Grimberg struct iscsi_conn *conn = isert_conn->conn; 3316991bb764SSagi Grimberg 33174c22e07fSSagi Grimberg isert_info("conn %p\n", isert_conn); 33184c22e07fSSagi Grimberg 3319991bb764SSagi Grimberg if (isert_conn->logout_posted) { 332024f412ddSSagi Grimberg isert_info("conn %p wait for conn_logout_comp\n", isert_conn); 3321991bb764SSagi Grimberg wait_for_completion_timeout(&conn->conn_logout_comp, 3322991bb764SSagi Grimberg SECONDS_FOR_LOGOUT_COMP * HZ); 3323991bb764SSagi Grimberg } 3324991bb764SSagi Grimberg } 3325991bb764SSagi Grimberg 3326991bb764SSagi Grimberg static void 3327c7e160eeSSagi Grimberg isert_wait4cmds(struct iscsi_conn *conn) 3328c7e160eeSSagi Grimberg { 33294c22e07fSSagi Grimberg isert_info("iscsi_conn %p\n", conn); 33304c22e07fSSagi Grimberg 3331c7e160eeSSagi Grimberg if (conn->sess) { 3332c7e160eeSSagi Grimberg target_sess_cmd_list_set_waiting(conn->sess->se_sess); 3333c7e160eeSSagi Grimberg target_wait_for_sess_cmds(conn->sess->se_sess); 3334c7e160eeSSagi Grimberg } 3335c7e160eeSSagi Grimberg } 3336c7e160eeSSagi Grimberg 3337c7e160eeSSagi Grimberg static void 3338bdf20e72SSagi Grimberg isert_wait4flush(struct isert_conn *isert_conn) 3339bdf20e72SSagi Grimberg { 3340bdf20e72SSagi Grimberg struct ib_recv_wr *bad_wr; 3341bdf20e72SSagi Grimberg 33424c22e07fSSagi Grimberg isert_info("conn %p\n", isert_conn); 33434c22e07fSSagi Grimberg 3344dac6ab30SSagi Grimberg init_completion(&isert_conn->wait_comp_err); 3345bdf20e72SSagi Grimberg isert_conn->beacon.wr_id = ISER_BEACON_WRID; 3346bdf20e72SSagi Grimberg /* post an indication that all flush errors were consumed */ 3347dac6ab30SSagi Grimberg if (ib_post_recv(isert_conn->qp, &isert_conn->beacon, &bad_wr)) { 334824f412ddSSagi Grimberg isert_err("conn %p failed to post beacon", isert_conn); 3349bdf20e72SSagi Grimberg return; 3350bdf20e72SSagi Grimberg } 3351bdf20e72SSagi Grimberg 3352dac6ab30SSagi Grimberg wait_for_completion(&isert_conn->wait_comp_err); 3353bdf20e72SSagi Grimberg } 3354bdf20e72SSagi Grimberg 3355defd8848SNicholas Bellinger static void isert_wait_conn(struct iscsi_conn *conn) 3356b8d26b3bSNicholas Bellinger { 3357b8d26b3bSNicholas Bellinger struct isert_conn *isert_conn = conn->context; 3358b8d26b3bSNicholas Bellinger 33594c22e07fSSagi Grimberg isert_info("Starting conn %p\n", isert_conn); 3360b8d26b3bSNicholas Bellinger 3361dac6ab30SSagi Grimberg mutex_lock(&isert_conn->mutex); 3362b8d26b3bSNicholas Bellinger /* 3363dac6ab30SSagi Grimberg * Only wait for wait_comp_err if the isert_conn made it 3364b8d26b3bSNicholas Bellinger * into full feature phase.. 3365b8d26b3bSNicholas Bellinger */ 3366b2cb9649SNicholas Bellinger if (isert_conn->state == ISER_CONN_INIT) { 3367dac6ab30SSagi Grimberg mutex_unlock(&isert_conn->mutex); 3368b2cb9649SNicholas Bellinger return; 3369b2cb9649SNicholas Bellinger } 3370954f2372SSagi Grimberg isert_conn_terminate(isert_conn); 3371dac6ab30SSagi Grimberg mutex_unlock(&isert_conn->mutex); 3372b2cb9649SNicholas Bellinger 3373c7e160eeSSagi Grimberg isert_wait4cmds(conn); 3374bdf20e72SSagi Grimberg isert_wait4flush(isert_conn); 3375991bb764SSagi Grimberg isert_wait4logout(isert_conn); 3376954f2372SSagi Grimberg 3377b02efbfcSSagi Grimberg queue_work(isert_release_wq, &isert_conn->release_work); 3378defd8848SNicholas Bellinger } 3379defd8848SNicholas Bellinger 3380defd8848SNicholas Bellinger static void isert_free_conn(struct iscsi_conn *conn) 3381defd8848SNicholas Bellinger { 3382defd8848SNicholas Bellinger struct isert_conn *isert_conn = conn->context; 3383b8d26b3bSNicholas Bellinger 3384524630d5SSagi Grimberg isert_wait4flush(isert_conn); 3385b8d26b3bSNicholas Bellinger isert_put_conn(isert_conn); 3386b8d26b3bSNicholas Bellinger } 3387b8d26b3bSNicholas Bellinger 3388b8d26b3bSNicholas Bellinger static struct iscsit_transport iser_target_transport = { 3389b8d26b3bSNicholas Bellinger .name = "IB/iSER", 3390b8d26b3bSNicholas Bellinger .transport_type = ISCSI_INFINIBAND, 3391d703ce2fSNicholas Bellinger .priv_size = sizeof(struct isert_cmd), 3392b8d26b3bSNicholas Bellinger .owner = THIS_MODULE, 3393b8d26b3bSNicholas Bellinger .iscsit_setup_np = isert_setup_np, 3394b8d26b3bSNicholas Bellinger .iscsit_accept_np = isert_accept_np, 3395b8d26b3bSNicholas Bellinger .iscsit_free_np = isert_free_np, 3396defd8848SNicholas Bellinger .iscsit_wait_conn = isert_wait_conn, 3397b8d26b3bSNicholas Bellinger .iscsit_free_conn = isert_free_conn, 3398b8d26b3bSNicholas Bellinger .iscsit_get_login_rx = isert_get_login_rx, 3399b8d26b3bSNicholas Bellinger .iscsit_put_login_tx = isert_put_login_tx, 3400b8d26b3bSNicholas Bellinger .iscsit_immediate_queue = isert_immediate_queue, 3401b8d26b3bSNicholas Bellinger .iscsit_response_queue = isert_response_queue, 3402b8d26b3bSNicholas Bellinger .iscsit_get_dataout = isert_get_dataout, 3403b8d26b3bSNicholas Bellinger .iscsit_queue_data_in = isert_put_datain, 3404b8d26b3bSNicholas Bellinger .iscsit_queue_status = isert_put_response, 3405131e6abcSNicholas Bellinger .iscsit_aborted_task = isert_aborted_task, 3406e70beee7SNicholas Bellinger .iscsit_get_sup_prot_ops = isert_get_sup_prot_ops, 3407b8d26b3bSNicholas Bellinger }; 3408b8d26b3bSNicholas Bellinger 3409b8d26b3bSNicholas Bellinger static int __init isert_init(void) 3410b8d26b3bSNicholas Bellinger { 3411b8d26b3bSNicholas Bellinger int ret; 3412b8d26b3bSNicholas Bellinger 3413631af550SSagi Grimberg isert_comp_wq = alloc_workqueue("isert_comp_wq", 3414631af550SSagi Grimberg WQ_UNBOUND | WQ_HIGHPRI, 0); 3415b8d26b3bSNicholas Bellinger if (!isert_comp_wq) { 341624f412ddSSagi Grimberg isert_err("Unable to allocate isert_comp_wq\n"); 3417b8d26b3bSNicholas Bellinger ret = -ENOMEM; 34186f0fae3dSSagi Grimberg return -ENOMEM; 3419b8d26b3bSNicholas Bellinger } 3420b8d26b3bSNicholas Bellinger 3421b02efbfcSSagi Grimberg isert_release_wq = alloc_workqueue("isert_release_wq", WQ_UNBOUND, 3422b02efbfcSSagi Grimberg WQ_UNBOUND_MAX_ACTIVE); 3423b02efbfcSSagi Grimberg if (!isert_release_wq) { 342424f412ddSSagi Grimberg isert_err("Unable to allocate isert_release_wq\n"); 3425b02efbfcSSagi Grimberg ret = -ENOMEM; 3426b02efbfcSSagi Grimberg goto destroy_comp_wq; 3427b02efbfcSSagi Grimberg } 3428b02efbfcSSagi Grimberg 3429b8d26b3bSNicholas Bellinger iscsit_register_transport(&iser_target_transport); 343024f412ddSSagi Grimberg isert_info("iSER_TARGET[0] - Loaded iser_target_transport\n"); 3431b02efbfcSSagi Grimberg 3432b8d26b3bSNicholas Bellinger return 0; 3433b8d26b3bSNicholas Bellinger 3434b02efbfcSSagi Grimberg destroy_comp_wq: 3435b02efbfcSSagi Grimberg destroy_workqueue(isert_comp_wq); 34366f0fae3dSSagi Grimberg 3437b8d26b3bSNicholas Bellinger return ret; 3438b8d26b3bSNicholas Bellinger } 3439b8d26b3bSNicholas Bellinger 3440b8d26b3bSNicholas Bellinger static void __exit isert_exit(void) 3441b8d26b3bSNicholas Bellinger { 3442f5ebec96SSagi Grimberg flush_scheduled_work(); 3443b02efbfcSSagi Grimberg destroy_workqueue(isert_release_wq); 3444b8d26b3bSNicholas Bellinger destroy_workqueue(isert_comp_wq); 3445b8d26b3bSNicholas Bellinger iscsit_unregister_transport(&iser_target_transport); 34464c22e07fSSagi Grimberg isert_info("iSER_TARGET[0] - Released iser_target_transport\n"); 3447b8d26b3bSNicholas Bellinger } 3448b8d26b3bSNicholas Bellinger 3449b8d26b3bSNicholas Bellinger MODULE_DESCRIPTION("iSER-Target for mainline target infrastructure"); 34509e35eff4SSagi Grimberg MODULE_VERSION("1.0"); 3451b8d26b3bSNicholas Bellinger MODULE_AUTHOR("nab@Linux-iSCSI.org"); 3452b8d26b3bSNicholas Bellinger MODULE_LICENSE("GPL"); 3453b8d26b3bSNicholas Bellinger 3454b8d26b3bSNicholas Bellinger module_init(isert_init); 3455b8d26b3bSNicholas Bellinger module_exit(isert_exit); 3456