iser_initiator.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746
  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_objs(struct iser_rx_desc,
  203. iser_conn->num_rx_descs);
  204. if (!iser_conn->rx_descs)
  205. goto rx_desc_alloc_fail;
  206. rx_desc = iser_conn->rx_descs;
  207. for (i = 0; i < iser_conn->qp_max_recv_dtos; i++, rx_desc++) {
  208. dma_addr = ib_dma_map_single(device->ib_device, (void *)rx_desc,
  209. ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
  210. if (ib_dma_mapping_error(device->ib_device, dma_addr))
  211. goto rx_desc_dma_map_failed;
  212. rx_desc->dma_addr = dma_addr;
  213. rx_desc->cqe.done = iser_task_rsp;
  214. rx_sg = &rx_desc->rx_sg;
  215. rx_sg->addr = rx_desc->dma_addr;
  216. rx_sg->length = ISER_RX_PAYLOAD_SIZE;
  217. rx_sg->lkey = device->pd->local_dma_lkey;
  218. }
  219. return 0;
  220. rx_desc_dma_map_failed:
  221. rx_desc = iser_conn->rx_descs;
  222. for (j = 0; j < i; j++, rx_desc++)
  223. ib_dma_unmap_single(device->ib_device, rx_desc->dma_addr,
  224. ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
  225. kfree(iser_conn->rx_descs);
  226. iser_conn->rx_descs = NULL;
  227. rx_desc_alloc_fail:
  228. iser_free_login_buf(iser_conn);
  229. alloc_login_buf_fail:
  230. iser_free_fastreg_pool(ib_conn);
  231. create_rdma_reg_res_failed:
  232. iser_err("failed allocating rx descriptors / data buffers\n");
  233. return -ENOMEM;
  234. }
  235. void iser_free_rx_descriptors(struct iser_conn *iser_conn)
  236. {
  237. int i;
  238. struct iser_rx_desc *rx_desc;
  239. struct ib_conn *ib_conn = &iser_conn->ib_conn;
  240. struct iser_device *device = ib_conn->device;
  241. iser_free_fastreg_pool(ib_conn);
  242. rx_desc = iser_conn->rx_descs;
  243. for (i = 0; i < iser_conn->qp_max_recv_dtos; i++, rx_desc++)
  244. ib_dma_unmap_single(device->ib_device, rx_desc->dma_addr,
  245. ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
  246. kfree(iser_conn->rx_descs);
  247. /* make sure we never redo any unmapping */
  248. iser_conn->rx_descs = NULL;
  249. iser_free_login_buf(iser_conn);
  250. }
  251. static int iser_post_rx_bufs(struct iscsi_conn *conn, struct iscsi_hdr *req)
  252. {
  253. struct iser_conn *iser_conn = conn->dd_data;
  254. struct iscsi_session *session = conn->session;
  255. int err = 0;
  256. int i;
  257. iser_dbg("req op %x flags %x\n", req->opcode, req->flags);
  258. /* check if this is the last login - going to full feature phase */
  259. if ((req->flags & ISCSI_FULL_FEATURE_PHASE) != ISCSI_FULL_FEATURE_PHASE)
  260. goto out;
  261. if (session->discovery_sess) {
  262. iser_info("Discovery session, re-using login RX buffer\n");
  263. goto out;
  264. }
  265. iser_info("Normal session, posting batch of RX %d buffers\n",
  266. iser_conn->qp_max_recv_dtos - 1);
  267. /*
  268. * Initial post receive buffers.
  269. * There is one already posted recv buffer (for the last login
  270. * response). Therefore, the first recv buffer is skipped here.
  271. */
  272. for (i = 1; i < iser_conn->qp_max_recv_dtos; i++) {
  273. err = iser_post_recvm(iser_conn, &iser_conn->rx_descs[i]);
  274. if (err)
  275. goto out;
  276. }
  277. out:
  278. return err;
  279. }
  280. /**
  281. * iser_send_command - send command PDU
  282. * @conn: link to matching iscsi connection
  283. * @task: SCSI command task
  284. */
  285. int iser_send_command(struct iscsi_conn *conn, struct iscsi_task *task)
  286. {
  287. struct iser_conn *iser_conn = conn->dd_data;
  288. struct iscsi_iser_task *iser_task = task->dd_data;
  289. unsigned long edtl;
  290. int err;
  291. struct iser_data_buf *data_buf, *prot_buf;
  292. struct iscsi_scsi_req *hdr = (struct iscsi_scsi_req *)task->hdr;
  293. struct scsi_cmnd *sc = task->sc;
  294. struct iser_tx_desc *tx_desc = &iser_task->desc;
  295. edtl = ntohl(hdr->data_length);
  296. /* build the tx desc regd header and add it to the tx desc dto */
  297. iser_create_send_desc(iser_conn, tx_desc, ISCSI_TX_SCSI_COMMAND,
  298. iser_cmd_comp);
  299. if (hdr->flags & ISCSI_FLAG_CMD_READ) {
  300. data_buf = &iser_task->data[ISER_DIR_IN];
  301. prot_buf = &iser_task->prot[ISER_DIR_IN];
  302. } else {
  303. data_buf = &iser_task->data[ISER_DIR_OUT];
  304. prot_buf = &iser_task->prot[ISER_DIR_OUT];
  305. }
  306. if (scsi_sg_count(sc)) { /* using a scatter list */
  307. data_buf->sg = scsi_sglist(sc);
  308. data_buf->size = scsi_sg_count(sc);
  309. }
  310. data_buf->data_len = scsi_bufflen(sc);
  311. if (scsi_prot_sg_count(sc)) {
  312. prot_buf->sg = scsi_prot_sglist(sc);
  313. prot_buf->size = scsi_prot_sg_count(sc);
  314. prot_buf->data_len = (data_buf->data_len >>
  315. ilog2(sc->device->sector_size)) * 8;
  316. }
  317. if (hdr->flags & ISCSI_FLAG_CMD_READ) {
  318. err = iser_prepare_read_cmd(task);
  319. if (err)
  320. goto send_command_error;
  321. }
  322. if (hdr->flags & ISCSI_FLAG_CMD_WRITE) {
  323. err = iser_prepare_write_cmd(task,
  324. task->imm_count,
  325. task->imm_count +
  326. task->unsol_r2t.data_length,
  327. edtl);
  328. if (err)
  329. goto send_command_error;
  330. }
  331. iser_task->status = ISER_TASK_STATUS_STARTED;
  332. err = iser_post_send(&iser_conn->ib_conn, tx_desc);
  333. if (!err)
  334. return 0;
  335. send_command_error:
  336. iser_err("conn %p failed task->itt %d err %d\n",conn, task->itt, err);
  337. return err;
  338. }
  339. /**
  340. * iser_send_data_out - send data out PDU
  341. * @conn: link to matching iscsi connection
  342. * @task: SCSI command task
  343. * @hdr: pointer to the LLD's iSCSI message header
  344. */
  345. int iser_send_data_out(struct iscsi_conn *conn, struct iscsi_task *task,
  346. struct iscsi_data *hdr)
  347. {
  348. struct iser_conn *iser_conn = conn->dd_data;
  349. struct iscsi_iser_task *iser_task = task->dd_data;
  350. struct iser_tx_desc *tx_desc;
  351. struct iser_mem_reg *mem_reg;
  352. unsigned long buf_offset;
  353. unsigned long data_seg_len;
  354. uint32_t itt;
  355. int err;
  356. struct ib_sge *tx_dsg;
  357. itt = (__force uint32_t)hdr->itt;
  358. data_seg_len = ntoh24(hdr->dlength);
  359. buf_offset = ntohl(hdr->offset);
  360. iser_dbg("%s itt %d dseg_len %d offset %d\n",
  361. __func__,(int)itt,(int)data_seg_len,(int)buf_offset);
  362. tx_desc = kmem_cache_zalloc(ig.desc_cache, GFP_ATOMIC);
  363. if (!tx_desc)
  364. return -ENOMEM;
  365. tx_desc->type = ISCSI_TX_DATAOUT;
  366. tx_desc->cqe.done = iser_dataout_comp;
  367. tx_desc->iser_header.flags = ISER_VER;
  368. memcpy(&tx_desc->iscsi_header, hdr, sizeof(struct iscsi_hdr));
  369. /* build the tx desc */
  370. err = iser_initialize_task_headers(task, tx_desc);
  371. if (err)
  372. goto send_data_out_error;
  373. mem_reg = &iser_task->rdma_reg[ISER_DIR_OUT];
  374. tx_dsg = &tx_desc->tx_sg[1];
  375. tx_dsg->addr = mem_reg->sge.addr + buf_offset;
  376. tx_dsg->length = data_seg_len;
  377. tx_dsg->lkey = mem_reg->sge.lkey;
  378. tx_desc->num_sge = 2;
  379. if (buf_offset + data_seg_len > iser_task->data[ISER_DIR_OUT].data_len) {
  380. iser_err("Offset:%ld & DSL:%ld in Data-Out inconsistent with total len:%ld, itt:%d\n",
  381. buf_offset, data_seg_len,
  382. iser_task->data[ISER_DIR_OUT].data_len, itt);
  383. err = -EINVAL;
  384. goto send_data_out_error;
  385. }
  386. iser_dbg("data-out itt: %d, offset: %ld, sz: %ld\n",
  387. itt, buf_offset, data_seg_len);
  388. err = iser_post_send(&iser_conn->ib_conn, tx_desc);
  389. if (!err)
  390. return 0;
  391. send_data_out_error:
  392. kmem_cache_free(ig.desc_cache, tx_desc);
  393. iser_err("conn %p failed err %d\n", conn, err);
  394. return err;
  395. }
  396. int iser_send_control(struct iscsi_conn *conn, struct iscsi_task *task)
  397. {
  398. struct iser_conn *iser_conn = conn->dd_data;
  399. struct iscsi_iser_task *iser_task = task->dd_data;
  400. struct iser_tx_desc *mdesc = &iser_task->desc;
  401. unsigned long data_seg_len;
  402. int err = 0;
  403. struct iser_device *device;
  404. /* build the tx desc regd header and add it to the tx desc dto */
  405. iser_create_send_desc(iser_conn, mdesc, ISCSI_TX_CONTROL,
  406. iser_ctrl_comp);
  407. device = iser_conn->ib_conn.device;
  408. data_seg_len = ntoh24(task->hdr->dlength);
  409. if (data_seg_len > 0) {
  410. struct iser_login_desc *desc = &iser_conn->login_desc;
  411. struct ib_sge *tx_dsg = &mdesc->tx_sg[1];
  412. if (task != conn->login_task) {
  413. iser_err("data present on non login task!!!\n");
  414. goto send_control_error;
  415. }
  416. ib_dma_sync_single_for_cpu(device->ib_device, desc->req_dma,
  417. task->data_count, DMA_TO_DEVICE);
  418. memcpy(desc->req, task->data, task->data_count);
  419. ib_dma_sync_single_for_device(device->ib_device, desc->req_dma,
  420. task->data_count, DMA_TO_DEVICE);
  421. tx_dsg->addr = desc->req_dma;
  422. tx_dsg->length = task->data_count;
  423. tx_dsg->lkey = device->pd->local_dma_lkey;
  424. mdesc->num_sge = 2;
  425. }
  426. if (task == conn->login_task) {
  427. iser_dbg("op %x dsl %lx, posting login rx buffer\n",
  428. task->hdr->opcode, data_seg_len);
  429. err = iser_post_recvl(iser_conn);
  430. if (err)
  431. goto send_control_error;
  432. err = iser_post_rx_bufs(conn, task->hdr);
  433. if (err)
  434. goto send_control_error;
  435. }
  436. err = iser_post_send(&iser_conn->ib_conn, mdesc);
  437. if (!err)
  438. return 0;
  439. send_control_error:
  440. iser_err("conn %p failed err %d\n",conn, err);
  441. return err;
  442. }
  443. void iser_login_rsp(struct ib_cq *cq, struct ib_wc *wc)
  444. {
  445. struct ib_conn *ib_conn = wc->qp->qp_context;
  446. struct iser_conn *iser_conn = to_iser_conn(ib_conn);
  447. struct iser_login_desc *desc = iser_login(wc->wr_cqe);
  448. struct iscsi_hdr *hdr;
  449. char *data;
  450. int length;
  451. bool full_feature_phase;
  452. if (unlikely(wc->status != IB_WC_SUCCESS)) {
  453. iser_err_comp(wc, "login_rsp");
  454. return;
  455. }
  456. ib_dma_sync_single_for_cpu(ib_conn->device->ib_device,
  457. desc->rsp_dma, ISER_RX_LOGIN_SIZE,
  458. DMA_FROM_DEVICE);
  459. hdr = desc->rsp + sizeof(struct iser_ctrl);
  460. data = desc->rsp + ISER_HEADERS_LEN;
  461. length = wc->byte_len - ISER_HEADERS_LEN;
  462. full_feature_phase = ((hdr->flags & ISCSI_FULL_FEATURE_PHASE) ==
  463. ISCSI_FULL_FEATURE_PHASE) &&
  464. (hdr->flags & ISCSI_FLAG_CMD_FINAL);
  465. iser_dbg("op 0x%x itt 0x%x dlen %d\n", hdr->opcode,
  466. hdr->itt, length);
  467. iscsi_iser_recv(iser_conn->iscsi_conn, hdr, data, length);
  468. ib_dma_sync_single_for_device(ib_conn->device->ib_device,
  469. desc->rsp_dma, ISER_RX_LOGIN_SIZE,
  470. DMA_FROM_DEVICE);
  471. if (!full_feature_phase ||
  472. iser_conn->iscsi_conn->session->discovery_sess)
  473. return;
  474. /* Post the first RX buffer that is skipped in iser_post_rx_bufs() */
  475. iser_post_recvm(iser_conn, iser_conn->rx_descs);
  476. }
  477. static inline int iser_inv_desc(struct iser_fr_desc *desc, u32 rkey)
  478. {
  479. if (unlikely((!desc->sig_protected && rkey != desc->rsc.mr->rkey) ||
  480. (desc->sig_protected && rkey != desc->rsc.sig_mr->rkey))) {
  481. iser_err("Bogus remote invalidation for rkey %#x\n", rkey);
  482. return -EINVAL;
  483. }
  484. if (desc->sig_protected)
  485. desc->rsc.sig_mr->need_inval = false;
  486. else
  487. desc->rsc.mr->need_inval = false;
  488. return 0;
  489. }
  490. static int iser_check_remote_inv(struct iser_conn *iser_conn, struct ib_wc *wc,
  491. struct iscsi_hdr *hdr)
  492. {
  493. if (wc->wc_flags & IB_WC_WITH_INVALIDATE) {
  494. struct iscsi_task *task;
  495. u32 rkey = wc->ex.invalidate_rkey;
  496. iser_dbg("conn %p: remote invalidation for rkey %#x\n",
  497. iser_conn, rkey);
  498. if (unlikely(!iser_conn->snd_w_inv)) {
  499. iser_err("conn %p: unexpected remote invalidation, terminating connection\n",
  500. iser_conn);
  501. return -EPROTO;
  502. }
  503. task = iscsi_itt_to_ctask(iser_conn->iscsi_conn, hdr->itt);
  504. if (likely(task)) {
  505. struct iscsi_iser_task *iser_task = task->dd_data;
  506. struct iser_fr_desc *desc;
  507. if (iser_task->dir[ISER_DIR_IN]) {
  508. desc = iser_task->rdma_reg[ISER_DIR_IN].desc;
  509. if (unlikely(iser_inv_desc(desc, rkey)))
  510. return -EINVAL;
  511. }
  512. if (iser_task->dir[ISER_DIR_OUT]) {
  513. desc = iser_task->rdma_reg[ISER_DIR_OUT].desc;
  514. if (unlikely(iser_inv_desc(desc, rkey)))
  515. return -EINVAL;
  516. }
  517. } else {
  518. iser_err("failed to get task for itt=%d\n", hdr->itt);
  519. return -EINVAL;
  520. }
  521. }
  522. return 0;
  523. }
  524. void iser_task_rsp(struct ib_cq *cq, struct ib_wc *wc)
  525. {
  526. struct ib_conn *ib_conn = wc->qp->qp_context;
  527. struct iser_conn *iser_conn = to_iser_conn(ib_conn);
  528. struct iser_rx_desc *desc = iser_rx(wc->wr_cqe);
  529. struct iscsi_hdr *hdr;
  530. int length, err;
  531. if (unlikely(wc->status != IB_WC_SUCCESS)) {
  532. iser_err_comp(wc, "task_rsp");
  533. return;
  534. }
  535. ib_dma_sync_single_for_cpu(ib_conn->device->ib_device,
  536. desc->dma_addr, ISER_RX_PAYLOAD_SIZE,
  537. DMA_FROM_DEVICE);
  538. hdr = &desc->iscsi_header;
  539. length = wc->byte_len - ISER_HEADERS_LEN;
  540. iser_dbg("op 0x%x itt 0x%x dlen %d\n", hdr->opcode,
  541. hdr->itt, length);
  542. if (iser_check_remote_inv(iser_conn, wc, hdr)) {
  543. iscsi_conn_failure(iser_conn->iscsi_conn,
  544. ISCSI_ERR_CONN_FAILED);
  545. return;
  546. }
  547. iscsi_iser_recv(iser_conn->iscsi_conn, hdr, desc->data, length);
  548. ib_dma_sync_single_for_device(ib_conn->device->ib_device,
  549. desc->dma_addr, ISER_RX_PAYLOAD_SIZE,
  550. DMA_FROM_DEVICE);
  551. err = iser_post_recvm(iser_conn, desc);
  552. if (err)
  553. iser_err("posting rx buffer err %d\n", err);
  554. }
  555. void iser_cmd_comp(struct ib_cq *cq, struct ib_wc *wc)
  556. {
  557. if (unlikely(wc->status != IB_WC_SUCCESS))
  558. iser_err_comp(wc, "command");
  559. }
  560. void iser_ctrl_comp(struct ib_cq *cq, struct ib_wc *wc)
  561. {
  562. struct iser_tx_desc *desc = iser_tx(wc->wr_cqe);
  563. struct iscsi_task *task;
  564. if (unlikely(wc->status != IB_WC_SUCCESS)) {
  565. iser_err_comp(wc, "control");
  566. return;
  567. }
  568. /* this arithmetic is legal by libiscsi dd_data allocation */
  569. task = (void *)desc - sizeof(struct iscsi_task);
  570. if (task->hdr->itt == RESERVED_ITT)
  571. iscsi_put_task(task);
  572. }
  573. void iser_dataout_comp(struct ib_cq *cq, struct ib_wc *wc)
  574. {
  575. struct iser_tx_desc *desc = iser_tx(wc->wr_cqe);
  576. struct ib_conn *ib_conn = wc->qp->qp_context;
  577. struct iser_device *device = ib_conn->device;
  578. if (unlikely(wc->status != IB_WC_SUCCESS))
  579. iser_err_comp(wc, "dataout");
  580. ib_dma_unmap_single(device->ib_device, desc->dma_addr,
  581. ISER_HEADERS_LEN, DMA_TO_DEVICE);
  582. kmem_cache_free(ig.desc_cache, desc);
  583. }
  584. void iser_task_rdma_init(struct iscsi_iser_task *iser_task)
  585. {
  586. iser_task->status = ISER_TASK_STATUS_INIT;
  587. iser_task->dir[ISER_DIR_IN] = 0;
  588. iser_task->dir[ISER_DIR_OUT] = 0;
  589. iser_task->data[ISER_DIR_IN].data_len = 0;
  590. iser_task->data[ISER_DIR_OUT].data_len = 0;
  591. iser_task->prot[ISER_DIR_IN].data_len = 0;
  592. iser_task->prot[ISER_DIR_OUT].data_len = 0;
  593. iser_task->prot[ISER_DIR_IN].dma_nents = 0;
  594. iser_task->prot[ISER_DIR_OUT].dma_nents = 0;
  595. memset(&iser_task->rdma_reg[ISER_DIR_IN], 0,
  596. sizeof(struct iser_mem_reg));
  597. memset(&iser_task->rdma_reg[ISER_DIR_OUT], 0,
  598. sizeof(struct iser_mem_reg));
  599. }
  600. void iser_task_rdma_finalize(struct iscsi_iser_task *iser_task)
  601. {
  602. if (iser_task->dir[ISER_DIR_IN]) {
  603. iser_unreg_mem_fastreg(iser_task, ISER_DIR_IN);
  604. iser_dma_unmap_task_data(iser_task, ISER_DIR_IN,
  605. DMA_FROM_DEVICE);
  606. }
  607. if (iser_task->dir[ISER_DIR_OUT]) {
  608. iser_unreg_mem_fastreg(iser_task, ISER_DIR_OUT);
  609. iser_dma_unmap_task_data(iser_task, ISER_DIR_OUT,
  610. DMA_TO_DEVICE);
  611. }
  612. }