iser_initiator.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747
  1. /*
  2. * Copyright (c) 2004, 2005, 2006 Voltaire, Inc. All rights reserved.
  3. * Copyright (c) 2013-2014 Mellanox Technologies. All rights reserved.
  4. *
  5. * This software is available to you under a choice of one of two
  6. * licenses. You may choose to be licensed under the terms of the GNU
  7. * General Public License (GPL) Version 2, available from the file
  8. * COPYING in the main directory of this source tree, or the
  9. * OpenIB.org BSD license below:
  10. *
  11. * Redistribution and use in source and binary forms, with or
  12. * without modification, are permitted provided that the following
  13. * conditions are met:
  14. *
  15. * - Redistributions of source code must retain the above
  16. * copyright notice, this list of conditions and the following
  17. * disclaimer.
  18. *
  19. * - Redistributions in binary form must reproduce the above
  20. * copyright notice, this list of conditions and the following
  21. * disclaimer in the documentation and/or other materials
  22. * provided with the distribution.
  23. *
  24. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  25. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  26. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  27. * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  28. * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  29. * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  30. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  31. * SOFTWARE.
  32. */
  33. #include <linux/kernel.h>
  34. #include <linux/slab.h>
  35. #include <linux/mm.h>
  36. #include <linux/scatterlist.h>
  37. #include <linux/kfifo.h>
  38. #include <scsi/scsi_cmnd.h>
  39. #include <scsi/scsi_host.h>
  40. #include "iscsi_iser.h"
  41. /* Register user buffer memory and initialize passive rdma
  42. * dto descriptor. Data size is stored in
  43. * task->data[ISER_DIR_IN].data_len, Protection size
  44. * os stored in task->prot[ISER_DIR_IN].data_len
  45. */
  46. static int iser_prepare_read_cmd(struct iscsi_task *task)
  47. {
  48. struct iscsi_iser_task *iser_task = task->dd_data;
  49. struct iser_mem_reg *mem_reg;
  50. int err;
  51. struct iser_ctrl *hdr = &iser_task->desc.iser_header;
  52. err = iser_dma_map_task_data(iser_task,
  53. ISER_DIR_IN,
  54. DMA_FROM_DEVICE);
  55. if (err)
  56. return err;
  57. err = iser_reg_mem_fastreg(iser_task, ISER_DIR_IN, false);
  58. if (err) {
  59. iser_err("Failed to set up Data-IN RDMA\n");
  60. goto out_err;
  61. }
  62. mem_reg = &iser_task->rdma_reg[ISER_DIR_IN];
  63. hdr->flags |= ISER_RSV;
  64. hdr->read_stag = cpu_to_be32(mem_reg->rkey);
  65. hdr->read_va = cpu_to_be64(mem_reg->sge.addr);
  66. iser_dbg("Cmd itt:%d READ tags RKEY:%#.4X VA:%#llX\n",
  67. task->itt, mem_reg->rkey,
  68. (unsigned long long)mem_reg->sge.addr);
  69. return 0;
  70. out_err:
  71. iser_dma_unmap_task_data(iser_task, ISER_DIR_IN, DMA_FROM_DEVICE);
  72. return err;
  73. }
  74. /* Register user buffer memory and initialize passive rdma
  75. * dto descriptor. Data size is stored in
  76. * task->data[ISER_DIR_OUT].data_len, Protection size
  77. * is stored at task->prot[ISER_DIR_OUT].data_len
  78. */
  79. static int iser_prepare_write_cmd(struct iscsi_task *task, unsigned int imm_sz,
  80. unsigned int unsol_sz, unsigned int edtl)
  81. {
  82. struct iscsi_iser_task *iser_task = task->dd_data;
  83. struct iser_mem_reg *mem_reg;
  84. int err;
  85. struct iser_ctrl *hdr = &iser_task->desc.iser_header;
  86. struct iser_data_buf *buf_out = &iser_task->data[ISER_DIR_OUT];
  87. struct ib_sge *tx_dsg = &iser_task->desc.tx_sg[1];
  88. err = iser_dma_map_task_data(iser_task,
  89. ISER_DIR_OUT,
  90. DMA_TO_DEVICE);
  91. if (err)
  92. return err;
  93. err = iser_reg_mem_fastreg(iser_task, ISER_DIR_OUT,
  94. buf_out->data_len == imm_sz);
  95. if (err) {
  96. iser_err("Failed to register write cmd RDMA mem\n");
  97. goto out_err;
  98. }
  99. mem_reg = &iser_task->rdma_reg[ISER_DIR_OUT];
  100. if (unsol_sz < edtl) {
  101. hdr->flags |= ISER_WSV;
  102. if (buf_out->data_len > imm_sz) {
  103. hdr->write_stag = cpu_to_be32(mem_reg->rkey);
  104. hdr->write_va = cpu_to_be64(mem_reg->sge.addr + unsol_sz);
  105. }
  106. iser_dbg("Cmd itt:%d, WRITE tags, RKEY:%#.4X VA:%#llX + unsol:%d\n",
  107. task->itt, mem_reg->rkey,
  108. (unsigned long long)mem_reg->sge.addr, unsol_sz);
  109. }
  110. if (imm_sz > 0) {
  111. iser_dbg("Cmd itt:%d, WRITE, adding imm.data sz: %d\n",
  112. task->itt, imm_sz);
  113. tx_dsg->addr = mem_reg->sge.addr;
  114. tx_dsg->length = imm_sz;
  115. tx_dsg->lkey = mem_reg->sge.lkey;
  116. iser_task->desc.num_sge = 2;
  117. }
  118. return 0;
  119. out_err:
  120. iser_dma_unmap_task_data(iser_task, ISER_DIR_OUT, DMA_TO_DEVICE);
  121. return err;
  122. }
  123. /* creates a new tx descriptor and adds header regd buffer */
  124. static void iser_create_send_desc(struct iser_conn *iser_conn,
  125. struct iser_tx_desc *tx_desc, enum iser_desc_type type,
  126. void (*done)(struct ib_cq *cq, struct ib_wc *wc))
  127. {
  128. struct iser_device *device = iser_conn->ib_conn.device;
  129. tx_desc->type = type;
  130. tx_desc->cqe.done = done;
  131. ib_dma_sync_single_for_cpu(device->ib_device,
  132. tx_desc->dma_addr, ISER_HEADERS_LEN, DMA_TO_DEVICE);
  133. memset(&tx_desc->iser_header, 0, sizeof(struct iser_ctrl));
  134. tx_desc->iser_header.flags = ISER_VER;
  135. tx_desc->num_sge = 1;
  136. }
  137. static void iser_free_login_buf(struct iser_conn *iser_conn)
  138. {
  139. struct iser_device *device = iser_conn->ib_conn.device;
  140. struct iser_login_desc *desc = &iser_conn->login_desc;
  141. if (!desc->req)
  142. return;
  143. ib_dma_unmap_single(device->ib_device, desc->req_dma,
  144. ISCSI_DEF_MAX_RECV_SEG_LEN, DMA_TO_DEVICE);
  145. ib_dma_unmap_single(device->ib_device, desc->rsp_dma,
  146. ISER_RX_LOGIN_SIZE, DMA_FROM_DEVICE);
  147. kfree(desc->req);
  148. kfree(desc->rsp);
  149. /* make sure we never redo any unmapping */
  150. desc->req = NULL;
  151. desc->rsp = NULL;
  152. }
  153. static int iser_alloc_login_buf(struct iser_conn *iser_conn)
  154. {
  155. struct iser_device *device = iser_conn->ib_conn.device;
  156. struct iser_login_desc *desc = &iser_conn->login_desc;
  157. desc->req = kmalloc(ISCSI_DEF_MAX_RECV_SEG_LEN, GFP_KERNEL);
  158. if (!desc->req)
  159. return -ENOMEM;
  160. desc->req_dma = ib_dma_map_single(device->ib_device, desc->req,
  161. ISCSI_DEF_MAX_RECV_SEG_LEN,
  162. DMA_TO_DEVICE);
  163. if (ib_dma_mapping_error(device->ib_device,
  164. desc->req_dma))
  165. goto free_req;
  166. desc->rsp = kmalloc(ISER_RX_LOGIN_SIZE, GFP_KERNEL);
  167. if (!desc->rsp)
  168. goto unmap_req;
  169. desc->rsp_dma = ib_dma_map_single(device->ib_device, desc->rsp,
  170. ISER_RX_LOGIN_SIZE,
  171. DMA_FROM_DEVICE);
  172. if (ib_dma_mapping_error(device->ib_device,
  173. desc->rsp_dma))
  174. goto free_rsp;
  175. return 0;
  176. free_rsp:
  177. kfree(desc->rsp);
  178. unmap_req:
  179. ib_dma_unmap_single(device->ib_device, desc->req_dma,
  180. ISCSI_DEF_MAX_RECV_SEG_LEN,
  181. DMA_TO_DEVICE);
  182. free_req:
  183. kfree(desc->req);
  184. return -ENOMEM;
  185. }
  186. int iser_alloc_rx_descriptors(struct iser_conn *iser_conn,
  187. struct iscsi_session *session)
  188. {
  189. int i, j;
  190. u64 dma_addr;
  191. struct iser_rx_desc *rx_desc;
  192. struct ib_sge *rx_sg;
  193. struct ib_conn *ib_conn = &iser_conn->ib_conn;
  194. struct iser_device *device = ib_conn->device;
  195. iser_conn->qp_max_recv_dtos = session->cmds_max;
  196. if (iser_alloc_fastreg_pool(ib_conn, session->scsi_cmds_max,
  197. iser_conn->pages_per_mr))
  198. goto create_rdma_reg_res_failed;
  199. if (iser_alloc_login_buf(iser_conn))
  200. goto alloc_login_buf_fail;
  201. iser_conn->num_rx_descs = session->cmds_max;
  202. iser_conn->rx_descs = kmalloc_array(iser_conn->num_rx_descs,
  203. sizeof(struct iser_rx_desc),
  204. GFP_KERNEL);
  205. if (!iser_conn->rx_descs)
  206. goto rx_desc_alloc_fail;
  207. rx_desc = iser_conn->rx_descs;
  208. for (i = 0; i < iser_conn->qp_max_recv_dtos; i++, rx_desc++) {
  209. dma_addr = ib_dma_map_single(device->ib_device, (void *)rx_desc,
  210. ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
  211. if (ib_dma_mapping_error(device->ib_device, dma_addr))
  212. goto rx_desc_dma_map_failed;
  213. rx_desc->dma_addr = dma_addr;
  214. rx_desc->cqe.done = iser_task_rsp;
  215. rx_sg = &rx_desc->rx_sg;
  216. rx_sg->addr = rx_desc->dma_addr;
  217. rx_sg->length = ISER_RX_PAYLOAD_SIZE;
  218. rx_sg->lkey = device->pd->local_dma_lkey;
  219. }
  220. return 0;
  221. rx_desc_dma_map_failed:
  222. rx_desc = iser_conn->rx_descs;
  223. for (j = 0; j < i; j++, rx_desc++)
  224. ib_dma_unmap_single(device->ib_device, rx_desc->dma_addr,
  225. ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
  226. kfree(iser_conn->rx_descs);
  227. iser_conn->rx_descs = NULL;
  228. rx_desc_alloc_fail:
  229. iser_free_login_buf(iser_conn);
  230. alloc_login_buf_fail:
  231. iser_free_fastreg_pool(ib_conn);
  232. create_rdma_reg_res_failed:
  233. iser_err("failed allocating rx descriptors / data buffers\n");
  234. return -ENOMEM;
  235. }
  236. void iser_free_rx_descriptors(struct iser_conn *iser_conn)
  237. {
  238. int i;
  239. struct iser_rx_desc *rx_desc;
  240. struct ib_conn *ib_conn = &iser_conn->ib_conn;
  241. struct iser_device *device = ib_conn->device;
  242. iser_free_fastreg_pool(ib_conn);
  243. rx_desc = iser_conn->rx_descs;
  244. for (i = 0; i < iser_conn->qp_max_recv_dtos; i++, rx_desc++)
  245. ib_dma_unmap_single(device->ib_device, rx_desc->dma_addr,
  246. ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
  247. kfree(iser_conn->rx_descs);
  248. /* make sure we never redo any unmapping */
  249. iser_conn->rx_descs = NULL;
  250. iser_free_login_buf(iser_conn);
  251. }
  252. static int iser_post_rx_bufs(struct iscsi_conn *conn, struct iscsi_hdr *req)
  253. {
  254. struct iser_conn *iser_conn = conn->dd_data;
  255. struct iscsi_session *session = conn->session;
  256. int err = 0;
  257. int i;
  258. iser_dbg("req op %x flags %x\n", req->opcode, req->flags);
  259. /* check if this is the last login - going to full feature phase */
  260. if ((req->flags & ISCSI_FULL_FEATURE_PHASE) != ISCSI_FULL_FEATURE_PHASE)
  261. goto out;
  262. if (session->discovery_sess) {
  263. iser_info("Discovery session, re-using login RX buffer\n");
  264. goto out;
  265. }
  266. iser_info("Normal session, posting batch of RX %d buffers\n",
  267. iser_conn->qp_max_recv_dtos - 1);
  268. /*
  269. * Initial post receive buffers.
  270. * There is one already posted recv buffer (for the last login
  271. * response). Therefore, the first recv buffer is skipped here.
  272. */
  273. for (i = 1; i < iser_conn->qp_max_recv_dtos; i++) {
  274. err = iser_post_recvm(iser_conn, &iser_conn->rx_descs[i]);
  275. if (err)
  276. goto out;
  277. }
  278. out:
  279. return err;
  280. }
  281. /**
  282. * iser_send_command - send command PDU
  283. * @conn: link to matching iscsi connection
  284. * @task: SCSI command task
  285. */
  286. int iser_send_command(struct iscsi_conn *conn, struct iscsi_task *task)
  287. {
  288. struct iser_conn *iser_conn = conn->dd_data;
  289. struct iscsi_iser_task *iser_task = task->dd_data;
  290. unsigned long edtl;
  291. int err;
  292. struct iser_data_buf *data_buf, *prot_buf;
  293. struct iscsi_scsi_req *hdr = (struct iscsi_scsi_req *)task->hdr;
  294. struct scsi_cmnd *sc = task->sc;
  295. struct iser_tx_desc *tx_desc = &iser_task->desc;
  296. edtl = ntohl(hdr->data_length);
  297. /* build the tx desc regd header and add it to the tx desc dto */
  298. iser_create_send_desc(iser_conn, tx_desc, ISCSI_TX_SCSI_COMMAND,
  299. iser_cmd_comp);
  300. if (hdr->flags & ISCSI_FLAG_CMD_READ) {
  301. data_buf = &iser_task->data[ISER_DIR_IN];
  302. prot_buf = &iser_task->prot[ISER_DIR_IN];
  303. } else {
  304. data_buf = &iser_task->data[ISER_DIR_OUT];
  305. prot_buf = &iser_task->prot[ISER_DIR_OUT];
  306. }
  307. if (scsi_sg_count(sc)) { /* using a scatter list */
  308. data_buf->sg = scsi_sglist(sc);
  309. data_buf->size = scsi_sg_count(sc);
  310. }
  311. data_buf->data_len = scsi_bufflen(sc);
  312. if (scsi_prot_sg_count(sc)) {
  313. prot_buf->sg = scsi_prot_sglist(sc);
  314. prot_buf->size = scsi_prot_sg_count(sc);
  315. prot_buf->data_len = (data_buf->data_len >>
  316. ilog2(sc->device->sector_size)) * 8;
  317. }
  318. if (hdr->flags & ISCSI_FLAG_CMD_READ) {
  319. err = iser_prepare_read_cmd(task);
  320. if (err)
  321. goto send_command_error;
  322. }
  323. if (hdr->flags & ISCSI_FLAG_CMD_WRITE) {
  324. err = iser_prepare_write_cmd(task,
  325. task->imm_count,
  326. task->imm_count +
  327. task->unsol_r2t.data_length,
  328. edtl);
  329. if (err)
  330. goto send_command_error;
  331. }
  332. iser_task->status = ISER_TASK_STATUS_STARTED;
  333. err = iser_post_send(&iser_conn->ib_conn, tx_desc);
  334. if (!err)
  335. return 0;
  336. send_command_error:
  337. iser_err("conn %p failed task->itt %d err %d\n",conn, task->itt, err);
  338. return err;
  339. }
  340. /**
  341. * iser_send_data_out - send data out PDU
  342. * @conn: link to matching iscsi connection
  343. * @task: SCSI command task
  344. * @hdr: pointer to the LLD's iSCSI message header
  345. */
  346. int iser_send_data_out(struct iscsi_conn *conn, struct iscsi_task *task,
  347. struct iscsi_data *hdr)
  348. {
  349. struct iser_conn *iser_conn = conn->dd_data;
  350. struct iscsi_iser_task *iser_task = task->dd_data;
  351. struct iser_tx_desc *tx_desc;
  352. struct iser_mem_reg *mem_reg;
  353. unsigned long buf_offset;
  354. unsigned long data_seg_len;
  355. uint32_t itt;
  356. int err;
  357. struct ib_sge *tx_dsg;
  358. itt = (__force uint32_t)hdr->itt;
  359. data_seg_len = ntoh24(hdr->dlength);
  360. buf_offset = ntohl(hdr->offset);
  361. iser_dbg("%s itt %d dseg_len %d offset %d\n",
  362. __func__,(int)itt,(int)data_seg_len,(int)buf_offset);
  363. tx_desc = kmem_cache_zalloc(ig.desc_cache, GFP_ATOMIC);
  364. if (!tx_desc)
  365. return -ENOMEM;
  366. tx_desc->type = ISCSI_TX_DATAOUT;
  367. tx_desc->cqe.done = iser_dataout_comp;
  368. tx_desc->iser_header.flags = ISER_VER;
  369. memcpy(&tx_desc->iscsi_header, hdr, sizeof(struct iscsi_hdr));
  370. /* build the tx desc */
  371. err = iser_initialize_task_headers(task, tx_desc);
  372. if (err)
  373. goto send_data_out_error;
  374. mem_reg = &iser_task->rdma_reg[ISER_DIR_OUT];
  375. tx_dsg = &tx_desc->tx_sg[1];
  376. tx_dsg->addr = mem_reg->sge.addr + buf_offset;
  377. tx_dsg->length = data_seg_len;
  378. tx_dsg->lkey = mem_reg->sge.lkey;
  379. tx_desc->num_sge = 2;
  380. if (buf_offset + data_seg_len > iser_task->data[ISER_DIR_OUT].data_len) {
  381. iser_err("Offset:%ld & DSL:%ld in Data-Out inconsistent with total len:%ld, itt:%d\n",
  382. buf_offset, data_seg_len,
  383. iser_task->data[ISER_DIR_OUT].data_len, itt);
  384. err = -EINVAL;
  385. goto send_data_out_error;
  386. }
  387. iser_dbg("data-out itt: %d, offset: %ld, sz: %ld\n",
  388. itt, buf_offset, data_seg_len);
  389. err = iser_post_send(&iser_conn->ib_conn, tx_desc);
  390. if (!err)
  391. return 0;
  392. send_data_out_error:
  393. kmem_cache_free(ig.desc_cache, tx_desc);
  394. iser_err("conn %p failed err %d\n", conn, err);
  395. return err;
  396. }
  397. int iser_send_control(struct iscsi_conn *conn, struct iscsi_task *task)
  398. {
  399. struct iser_conn *iser_conn = conn->dd_data;
  400. struct iscsi_iser_task *iser_task = task->dd_data;
  401. struct iser_tx_desc *mdesc = &iser_task->desc;
  402. unsigned long data_seg_len;
  403. int err = 0;
  404. struct iser_device *device;
  405. /* build the tx desc regd header and add it to the tx desc dto */
  406. iser_create_send_desc(iser_conn, mdesc, ISCSI_TX_CONTROL,
  407. iser_ctrl_comp);
  408. device = iser_conn->ib_conn.device;
  409. data_seg_len = ntoh24(task->hdr->dlength);
  410. if (data_seg_len > 0) {
  411. struct iser_login_desc *desc = &iser_conn->login_desc;
  412. struct ib_sge *tx_dsg = &mdesc->tx_sg[1];
  413. if (task != conn->login_task) {
  414. iser_err("data present on non login task!!!\n");
  415. goto send_control_error;
  416. }
  417. ib_dma_sync_single_for_cpu(device->ib_device, desc->req_dma,
  418. task->data_count, DMA_TO_DEVICE);
  419. memcpy(desc->req, task->data, task->data_count);
  420. ib_dma_sync_single_for_device(device->ib_device, desc->req_dma,
  421. task->data_count, DMA_TO_DEVICE);
  422. tx_dsg->addr = desc->req_dma;
  423. tx_dsg->length = task->data_count;
  424. tx_dsg->lkey = device->pd->local_dma_lkey;
  425. mdesc->num_sge = 2;
  426. }
  427. if (task == conn->login_task) {
  428. iser_dbg("op %x dsl %lx, posting login rx buffer\n",
  429. task->hdr->opcode, data_seg_len);
  430. err = iser_post_recvl(iser_conn);
  431. if (err)
  432. goto send_control_error;
  433. err = iser_post_rx_bufs(conn, task->hdr);
  434. if (err)
  435. goto send_control_error;
  436. }
  437. err = iser_post_send(&iser_conn->ib_conn, mdesc);
  438. if (!err)
  439. return 0;
  440. send_control_error:
  441. iser_err("conn %p failed err %d\n",conn, err);
  442. return err;
  443. }
  444. void iser_login_rsp(struct ib_cq *cq, struct ib_wc *wc)
  445. {
  446. struct ib_conn *ib_conn = wc->qp->qp_context;
  447. struct iser_conn *iser_conn = to_iser_conn(ib_conn);
  448. struct iser_login_desc *desc = iser_login(wc->wr_cqe);
  449. struct iscsi_hdr *hdr;
  450. char *data;
  451. int length;
  452. bool full_feature_phase;
  453. if (unlikely(wc->status != IB_WC_SUCCESS)) {
  454. iser_err_comp(wc, "login_rsp");
  455. return;
  456. }
  457. ib_dma_sync_single_for_cpu(ib_conn->device->ib_device,
  458. desc->rsp_dma, ISER_RX_LOGIN_SIZE,
  459. DMA_FROM_DEVICE);
  460. hdr = desc->rsp + sizeof(struct iser_ctrl);
  461. data = desc->rsp + ISER_HEADERS_LEN;
  462. length = wc->byte_len - ISER_HEADERS_LEN;
  463. full_feature_phase = ((hdr->flags & ISCSI_FULL_FEATURE_PHASE) ==
  464. ISCSI_FULL_FEATURE_PHASE) &&
  465. (hdr->flags & ISCSI_FLAG_CMD_FINAL);
  466. iser_dbg("op 0x%x itt 0x%x dlen %d\n", hdr->opcode,
  467. hdr->itt, length);
  468. iscsi_iser_recv(iser_conn->iscsi_conn, hdr, data, length);
  469. ib_dma_sync_single_for_device(ib_conn->device->ib_device,
  470. desc->rsp_dma, ISER_RX_LOGIN_SIZE,
  471. DMA_FROM_DEVICE);
  472. if (!full_feature_phase ||
  473. iser_conn->iscsi_conn->session->discovery_sess)
  474. return;
  475. /* Post the first RX buffer that is skipped in iser_post_rx_bufs() */
  476. iser_post_recvm(iser_conn, iser_conn->rx_descs);
  477. }
  478. static inline int iser_inv_desc(struct iser_fr_desc *desc, u32 rkey)
  479. {
  480. if (unlikely((!desc->sig_protected && rkey != desc->rsc.mr->rkey) ||
  481. (desc->sig_protected && rkey != desc->rsc.sig_mr->rkey))) {
  482. iser_err("Bogus remote invalidation for rkey %#x\n", rkey);
  483. return -EINVAL;
  484. }
  485. if (desc->sig_protected)
  486. desc->rsc.sig_mr->need_inval = false;
  487. else
  488. desc->rsc.mr->need_inval = false;
  489. return 0;
  490. }
  491. static int iser_check_remote_inv(struct iser_conn *iser_conn, struct ib_wc *wc,
  492. struct iscsi_hdr *hdr)
  493. {
  494. if (wc->wc_flags & IB_WC_WITH_INVALIDATE) {
  495. struct iscsi_task *task;
  496. u32 rkey = wc->ex.invalidate_rkey;
  497. iser_dbg("conn %p: remote invalidation for rkey %#x\n",
  498. iser_conn, rkey);
  499. if (unlikely(!iser_conn->snd_w_inv)) {
  500. iser_err("conn %p: unexpected remote invalidation, terminating connection\n",
  501. iser_conn);
  502. return -EPROTO;
  503. }
  504. task = iscsi_itt_to_ctask(iser_conn->iscsi_conn, hdr->itt);
  505. if (likely(task)) {
  506. struct iscsi_iser_task *iser_task = task->dd_data;
  507. struct iser_fr_desc *desc;
  508. if (iser_task->dir[ISER_DIR_IN]) {
  509. desc = iser_task->rdma_reg[ISER_DIR_IN].desc;
  510. if (unlikely(iser_inv_desc(desc, rkey)))
  511. return -EINVAL;
  512. }
  513. if (iser_task->dir[ISER_DIR_OUT]) {
  514. desc = iser_task->rdma_reg[ISER_DIR_OUT].desc;
  515. if (unlikely(iser_inv_desc(desc, rkey)))
  516. return -EINVAL;
  517. }
  518. } else {
  519. iser_err("failed to get task for itt=%d\n", hdr->itt);
  520. return -EINVAL;
  521. }
  522. }
  523. return 0;
  524. }
  525. void iser_task_rsp(struct ib_cq *cq, struct ib_wc *wc)
  526. {
  527. struct ib_conn *ib_conn = wc->qp->qp_context;
  528. struct iser_conn *iser_conn = to_iser_conn(ib_conn);
  529. struct iser_rx_desc *desc = iser_rx(wc->wr_cqe);
  530. struct iscsi_hdr *hdr;
  531. int length, err;
  532. if (unlikely(wc->status != IB_WC_SUCCESS)) {
  533. iser_err_comp(wc, "task_rsp");
  534. return;
  535. }
  536. ib_dma_sync_single_for_cpu(ib_conn->device->ib_device,
  537. desc->dma_addr, ISER_RX_PAYLOAD_SIZE,
  538. DMA_FROM_DEVICE);
  539. hdr = &desc->iscsi_header;
  540. length = wc->byte_len - ISER_HEADERS_LEN;
  541. iser_dbg("op 0x%x itt 0x%x dlen %d\n", hdr->opcode,
  542. hdr->itt, length);
  543. if (iser_check_remote_inv(iser_conn, wc, hdr)) {
  544. iscsi_conn_failure(iser_conn->iscsi_conn,
  545. ISCSI_ERR_CONN_FAILED);
  546. return;
  547. }
  548. iscsi_iser_recv(iser_conn->iscsi_conn, hdr, desc->data, length);
  549. ib_dma_sync_single_for_device(ib_conn->device->ib_device,
  550. desc->dma_addr, ISER_RX_PAYLOAD_SIZE,
  551. DMA_FROM_DEVICE);
  552. err = iser_post_recvm(iser_conn, desc);
  553. if (err)
  554. iser_err("posting rx buffer err %d\n", err);
  555. }
  556. void iser_cmd_comp(struct ib_cq *cq, struct ib_wc *wc)
  557. {
  558. if (unlikely(wc->status != IB_WC_SUCCESS))
  559. iser_err_comp(wc, "command");
  560. }
  561. void iser_ctrl_comp(struct ib_cq *cq, struct ib_wc *wc)
  562. {
  563. struct iser_tx_desc *desc = iser_tx(wc->wr_cqe);
  564. struct iscsi_task *task;
  565. if (unlikely(wc->status != IB_WC_SUCCESS)) {
  566. iser_err_comp(wc, "control");
  567. return;
  568. }
  569. /* this arithmetic is legal by libiscsi dd_data allocation */
  570. task = (void *)desc - sizeof(struct iscsi_task);
  571. if (task->hdr->itt == RESERVED_ITT)
  572. iscsi_put_task(task);
  573. }
  574. void iser_dataout_comp(struct ib_cq *cq, struct ib_wc *wc)
  575. {
  576. struct iser_tx_desc *desc = iser_tx(wc->wr_cqe);
  577. struct ib_conn *ib_conn = wc->qp->qp_context;
  578. struct iser_device *device = ib_conn->device;
  579. if (unlikely(wc->status != IB_WC_SUCCESS))
  580. iser_err_comp(wc, "dataout");
  581. ib_dma_unmap_single(device->ib_device, desc->dma_addr,
  582. ISER_HEADERS_LEN, DMA_TO_DEVICE);
  583. kmem_cache_free(ig.desc_cache, desc);
  584. }
  585. void iser_task_rdma_init(struct iscsi_iser_task *iser_task)
  586. {
  587. iser_task->status = ISER_TASK_STATUS_INIT;
  588. iser_task->dir[ISER_DIR_IN] = 0;
  589. iser_task->dir[ISER_DIR_OUT] = 0;
  590. iser_task->data[ISER_DIR_IN].data_len = 0;
  591. iser_task->data[ISER_DIR_OUT].data_len = 0;
  592. iser_task->prot[ISER_DIR_IN].data_len = 0;
  593. iser_task->prot[ISER_DIR_OUT].data_len = 0;
  594. iser_task->prot[ISER_DIR_IN].dma_nents = 0;
  595. iser_task->prot[ISER_DIR_OUT].dma_nents = 0;
  596. memset(&iser_task->rdma_reg[ISER_DIR_IN], 0,
  597. sizeof(struct iser_mem_reg));
  598. memset(&iser_task->rdma_reg[ISER_DIR_OUT], 0,
  599. sizeof(struct iser_mem_reg));
  600. }
  601. void iser_task_rdma_finalize(struct iscsi_iser_task *iser_task)
  602. {
  603. if (iser_task->dir[ISER_DIR_IN]) {
  604. iser_unreg_mem_fastreg(iser_task, ISER_DIR_IN);
  605. iser_dma_unmap_task_data(iser_task, ISER_DIR_IN,
  606. DMA_FROM_DEVICE);
  607. }
  608. if (iser_task->dir[ISER_DIR_OUT]) {
  609. iser_unreg_mem_fastreg(iser_task, ISER_DIR_OUT);
  610. iser_dma_unmap_task_data(iser_task, ISER_DIR_OUT,
  611. DMA_TO_DEVICE);
  612. }
  613. }