iser_initiator.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784
  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. struct iser_data_buf *buf_in = &iser_task->data[ISER_DIR_IN];
  53. err = iser_dma_map_task_data(iser_task,
  54. buf_in,
  55. ISER_DIR_IN,
  56. DMA_FROM_DEVICE);
  57. if (err)
  58. return err;
  59. if (scsi_prot_sg_count(iser_task->sc)) {
  60. struct iser_data_buf *pbuf_in = &iser_task->prot[ISER_DIR_IN];
  61. err = iser_dma_map_task_data(iser_task,
  62. pbuf_in,
  63. ISER_DIR_IN,
  64. DMA_FROM_DEVICE);
  65. if (err)
  66. return err;
  67. }
  68. err = iser_reg_rdma_mem(iser_task, ISER_DIR_IN, false);
  69. if (err) {
  70. iser_err("Failed to set up Data-IN RDMA\n");
  71. return err;
  72. }
  73. mem_reg = &iser_task->rdma_reg[ISER_DIR_IN];
  74. hdr->flags |= ISER_RSV;
  75. hdr->read_stag = cpu_to_be32(mem_reg->rkey);
  76. hdr->read_va = cpu_to_be64(mem_reg->sge.addr);
  77. iser_dbg("Cmd itt:%d READ tags RKEY:%#.4X VA:%#llX\n",
  78. task->itt, mem_reg->rkey,
  79. (unsigned long long)mem_reg->sge.addr);
  80. return 0;
  81. }
  82. /* Register user buffer memory and initialize passive rdma
  83. * dto descriptor. Data size is stored in
  84. * task->data[ISER_DIR_OUT].data_len, Protection size
  85. * is stored at task->prot[ISER_DIR_OUT].data_len
  86. */
  87. static int
  88. iser_prepare_write_cmd(struct iscsi_task *task,
  89. unsigned int imm_sz,
  90. unsigned int unsol_sz,
  91. unsigned int edtl)
  92. {
  93. struct iscsi_iser_task *iser_task = task->dd_data;
  94. struct iser_mem_reg *mem_reg;
  95. int err;
  96. struct iser_ctrl *hdr = &iser_task->desc.iser_header;
  97. struct iser_data_buf *buf_out = &iser_task->data[ISER_DIR_OUT];
  98. struct ib_sge *tx_dsg = &iser_task->desc.tx_sg[1];
  99. err = iser_dma_map_task_data(iser_task,
  100. buf_out,
  101. ISER_DIR_OUT,
  102. DMA_TO_DEVICE);
  103. if (err)
  104. return err;
  105. if (scsi_prot_sg_count(iser_task->sc)) {
  106. struct iser_data_buf *pbuf_out = &iser_task->prot[ISER_DIR_OUT];
  107. err = iser_dma_map_task_data(iser_task,
  108. pbuf_out,
  109. ISER_DIR_OUT,
  110. DMA_TO_DEVICE);
  111. if (err)
  112. return err;
  113. }
  114. err = iser_reg_rdma_mem(iser_task, ISER_DIR_OUT,
  115. buf_out->data_len == imm_sz);
  116. if (err != 0) {
  117. iser_err("Failed to register write cmd RDMA mem\n");
  118. return err;
  119. }
  120. mem_reg = &iser_task->rdma_reg[ISER_DIR_OUT];
  121. if (unsol_sz < edtl) {
  122. hdr->flags |= ISER_WSV;
  123. if (buf_out->data_len > imm_sz) {
  124. hdr->write_stag = cpu_to_be32(mem_reg->rkey);
  125. hdr->write_va = cpu_to_be64(mem_reg->sge.addr + unsol_sz);
  126. }
  127. iser_dbg("Cmd itt:%d, WRITE tags, RKEY:%#.4X VA:%#llX + unsol:%d\n",
  128. task->itt, mem_reg->rkey,
  129. (unsigned long long)mem_reg->sge.addr, unsol_sz);
  130. }
  131. if (imm_sz > 0) {
  132. iser_dbg("Cmd itt:%d, WRITE, adding imm.data sz: %d\n",
  133. task->itt, imm_sz);
  134. tx_dsg->addr = mem_reg->sge.addr;
  135. tx_dsg->length = imm_sz;
  136. tx_dsg->lkey = mem_reg->sge.lkey;
  137. iser_task->desc.num_sge = 2;
  138. }
  139. return 0;
  140. }
  141. /* creates a new tx descriptor and adds header regd buffer */
  142. static void iser_create_send_desc(struct iser_conn *iser_conn,
  143. struct iser_tx_desc *tx_desc)
  144. {
  145. struct iser_device *device = iser_conn->ib_conn.device;
  146. ib_dma_sync_single_for_cpu(device->ib_device,
  147. tx_desc->dma_addr, ISER_HEADERS_LEN, DMA_TO_DEVICE);
  148. memset(&tx_desc->iser_header, 0, sizeof(struct iser_ctrl));
  149. tx_desc->iser_header.flags = ISER_VER;
  150. tx_desc->num_sge = 1;
  151. }
  152. static void iser_free_login_buf(struct iser_conn *iser_conn)
  153. {
  154. struct iser_device *device = iser_conn->ib_conn.device;
  155. struct iser_login_desc *desc = &iser_conn->login_desc;
  156. if (!desc->req)
  157. return;
  158. ib_dma_unmap_single(device->ib_device, desc->req_dma,
  159. ISCSI_DEF_MAX_RECV_SEG_LEN, DMA_TO_DEVICE);
  160. ib_dma_unmap_single(device->ib_device, desc->rsp_dma,
  161. ISER_RX_LOGIN_SIZE, DMA_FROM_DEVICE);
  162. kfree(desc->req);
  163. kfree(desc->rsp);
  164. /* make sure we never redo any unmapping */
  165. desc->req = NULL;
  166. desc->rsp = NULL;
  167. }
  168. static int iser_alloc_login_buf(struct iser_conn *iser_conn)
  169. {
  170. struct iser_device *device = iser_conn->ib_conn.device;
  171. struct iser_login_desc *desc = &iser_conn->login_desc;
  172. desc->req = kmalloc(ISCSI_DEF_MAX_RECV_SEG_LEN, GFP_KERNEL);
  173. if (!desc->req)
  174. return -ENOMEM;
  175. desc->req_dma = ib_dma_map_single(device->ib_device, desc->req,
  176. ISCSI_DEF_MAX_RECV_SEG_LEN,
  177. DMA_TO_DEVICE);
  178. if (ib_dma_mapping_error(device->ib_device,
  179. desc->req_dma))
  180. goto free_req;
  181. desc->rsp = kmalloc(ISER_RX_LOGIN_SIZE, GFP_KERNEL);
  182. if (!desc->rsp)
  183. goto unmap_req;
  184. desc->rsp_dma = ib_dma_map_single(device->ib_device, desc->rsp,
  185. ISER_RX_LOGIN_SIZE,
  186. DMA_FROM_DEVICE);
  187. if (ib_dma_mapping_error(device->ib_device,
  188. desc->rsp_dma))
  189. goto free_rsp;
  190. return 0;
  191. free_rsp:
  192. kfree(desc->rsp);
  193. unmap_req:
  194. ib_dma_unmap_single(device->ib_device, desc->req_dma,
  195. ISCSI_DEF_MAX_RECV_SEG_LEN,
  196. DMA_TO_DEVICE);
  197. free_req:
  198. kfree(desc->req);
  199. return -ENOMEM;
  200. }
  201. int iser_alloc_rx_descriptors(struct iser_conn *iser_conn,
  202. struct iscsi_session *session)
  203. {
  204. int i, j;
  205. u64 dma_addr;
  206. struct iser_rx_desc *rx_desc;
  207. struct ib_sge *rx_sg;
  208. struct ib_conn *ib_conn = &iser_conn->ib_conn;
  209. struct iser_device *device = ib_conn->device;
  210. iser_conn->qp_max_recv_dtos = session->cmds_max;
  211. iser_conn->qp_max_recv_dtos_mask = session->cmds_max - 1; /* cmds_max is 2^N */
  212. iser_conn->min_posted_rx = iser_conn->qp_max_recv_dtos >> 2;
  213. if (device->reg_ops->alloc_reg_res(ib_conn, session->scsi_cmds_max,
  214. iser_conn->pages_per_mr))
  215. goto create_rdma_reg_res_failed;
  216. if (iser_alloc_login_buf(iser_conn))
  217. goto alloc_login_buf_fail;
  218. iser_conn->num_rx_descs = session->cmds_max;
  219. iser_conn->rx_descs = kmalloc_array(iser_conn->num_rx_descs,
  220. sizeof(struct iser_rx_desc),
  221. GFP_KERNEL);
  222. if (!iser_conn->rx_descs)
  223. goto rx_desc_alloc_fail;
  224. rx_desc = iser_conn->rx_descs;
  225. for (i = 0; i < iser_conn->qp_max_recv_dtos; i++, rx_desc++) {
  226. dma_addr = ib_dma_map_single(device->ib_device, (void *)rx_desc,
  227. ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
  228. if (ib_dma_mapping_error(device->ib_device, dma_addr))
  229. goto rx_desc_dma_map_failed;
  230. rx_desc->dma_addr = dma_addr;
  231. rx_desc->cqe.done = iser_task_rsp;
  232. rx_sg = &rx_desc->rx_sg;
  233. rx_sg->addr = rx_desc->dma_addr;
  234. rx_sg->length = ISER_RX_PAYLOAD_SIZE;
  235. rx_sg->lkey = device->pd->local_dma_lkey;
  236. }
  237. iser_conn->rx_desc_head = 0;
  238. return 0;
  239. rx_desc_dma_map_failed:
  240. rx_desc = iser_conn->rx_descs;
  241. for (j = 0; j < i; j++, rx_desc++)
  242. ib_dma_unmap_single(device->ib_device, rx_desc->dma_addr,
  243. ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
  244. kfree(iser_conn->rx_descs);
  245. iser_conn->rx_descs = NULL;
  246. rx_desc_alloc_fail:
  247. iser_free_login_buf(iser_conn);
  248. alloc_login_buf_fail:
  249. device->reg_ops->free_reg_res(ib_conn);
  250. create_rdma_reg_res_failed:
  251. iser_err("failed allocating rx descriptors / data buffers\n");
  252. return -ENOMEM;
  253. }
  254. void iser_free_rx_descriptors(struct iser_conn *iser_conn)
  255. {
  256. int i;
  257. struct iser_rx_desc *rx_desc;
  258. struct ib_conn *ib_conn = &iser_conn->ib_conn;
  259. struct iser_device *device = ib_conn->device;
  260. if (device->reg_ops->free_reg_res)
  261. device->reg_ops->free_reg_res(ib_conn);
  262. rx_desc = iser_conn->rx_descs;
  263. for (i = 0; i < iser_conn->qp_max_recv_dtos; i++, rx_desc++)
  264. ib_dma_unmap_single(device->ib_device, rx_desc->dma_addr,
  265. ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
  266. kfree(iser_conn->rx_descs);
  267. /* make sure we never redo any unmapping */
  268. iser_conn->rx_descs = NULL;
  269. iser_free_login_buf(iser_conn);
  270. }
  271. static int iser_post_rx_bufs(struct iscsi_conn *conn, struct iscsi_hdr *req)
  272. {
  273. struct iser_conn *iser_conn = conn->dd_data;
  274. struct ib_conn *ib_conn = &iser_conn->ib_conn;
  275. struct iscsi_session *session = conn->session;
  276. iser_dbg("req op %x flags %x\n", req->opcode, req->flags);
  277. /* check if this is the last login - going to full feature phase */
  278. if ((req->flags & ISCSI_FULL_FEATURE_PHASE) != ISCSI_FULL_FEATURE_PHASE)
  279. return 0;
  280. /*
  281. * Check that there is one posted recv buffer
  282. * (for the last login response).
  283. */
  284. WARN_ON(ib_conn->post_recv_buf_count != 1);
  285. if (session->discovery_sess) {
  286. iser_info("Discovery session, re-using login RX buffer\n");
  287. return 0;
  288. } else
  289. iser_info("Normal session, posting batch of RX %d buffers\n",
  290. iser_conn->min_posted_rx);
  291. /* Initial post receive buffers */
  292. if (iser_post_recvm(iser_conn, iser_conn->min_posted_rx))
  293. return -ENOMEM;
  294. return 0;
  295. }
  296. static inline bool iser_signal_comp(u8 sig_count)
  297. {
  298. return ((sig_count % ISER_SIGNAL_CMD_COUNT) == 0);
  299. }
  300. /**
  301. * iser_send_command - send command PDU
  302. */
  303. int iser_send_command(struct iscsi_conn *conn,
  304. struct iscsi_task *task)
  305. {
  306. struct iser_conn *iser_conn = conn->dd_data;
  307. struct iscsi_iser_task *iser_task = task->dd_data;
  308. unsigned long edtl;
  309. int err;
  310. struct iser_data_buf *data_buf, *prot_buf;
  311. struct iscsi_scsi_req *hdr = (struct iscsi_scsi_req *)task->hdr;
  312. struct scsi_cmnd *sc = task->sc;
  313. struct iser_tx_desc *tx_desc = &iser_task->desc;
  314. u8 sig_count = ++iser_conn->ib_conn.sig_count;
  315. edtl = ntohl(hdr->data_length);
  316. /* build the tx desc regd header and add it to the tx desc dto */
  317. tx_desc->type = ISCSI_TX_SCSI_COMMAND;
  318. tx_desc->cqe.done = iser_cmd_comp;
  319. iser_create_send_desc(iser_conn, tx_desc);
  320. if (hdr->flags & ISCSI_FLAG_CMD_READ) {
  321. data_buf = &iser_task->data[ISER_DIR_IN];
  322. prot_buf = &iser_task->prot[ISER_DIR_IN];
  323. } else {
  324. data_buf = &iser_task->data[ISER_DIR_OUT];
  325. prot_buf = &iser_task->prot[ISER_DIR_OUT];
  326. }
  327. if (scsi_sg_count(sc)) { /* using a scatter list */
  328. data_buf->sg = scsi_sglist(sc);
  329. data_buf->size = scsi_sg_count(sc);
  330. }
  331. data_buf->data_len = scsi_bufflen(sc);
  332. if (scsi_prot_sg_count(sc)) {
  333. prot_buf->sg = scsi_prot_sglist(sc);
  334. prot_buf->size = scsi_prot_sg_count(sc);
  335. prot_buf->data_len = (data_buf->data_len >>
  336. ilog2(sc->device->sector_size)) * 8;
  337. }
  338. if (hdr->flags & ISCSI_FLAG_CMD_READ) {
  339. err = iser_prepare_read_cmd(task);
  340. if (err)
  341. goto send_command_error;
  342. }
  343. if (hdr->flags & ISCSI_FLAG_CMD_WRITE) {
  344. err = iser_prepare_write_cmd(task,
  345. task->imm_count,
  346. task->imm_count +
  347. task->unsol_r2t.data_length,
  348. edtl);
  349. if (err)
  350. goto send_command_error;
  351. }
  352. iser_task->status = ISER_TASK_STATUS_STARTED;
  353. err = iser_post_send(&iser_conn->ib_conn, tx_desc,
  354. iser_signal_comp(sig_count));
  355. if (!err)
  356. return 0;
  357. send_command_error:
  358. iser_err("conn %p failed task->itt %d err %d\n",conn, task->itt, err);
  359. return err;
  360. }
  361. /**
  362. * iser_send_data_out - send data out PDU
  363. */
  364. int iser_send_data_out(struct iscsi_conn *conn,
  365. struct iscsi_task *task,
  366. struct iscsi_data *hdr)
  367. {
  368. struct iser_conn *iser_conn = conn->dd_data;
  369. struct iscsi_iser_task *iser_task = task->dd_data;
  370. struct iser_tx_desc *tx_desc;
  371. struct iser_mem_reg *mem_reg;
  372. unsigned long buf_offset;
  373. unsigned long data_seg_len;
  374. uint32_t itt;
  375. int err;
  376. struct ib_sge *tx_dsg;
  377. itt = (__force uint32_t)hdr->itt;
  378. data_seg_len = ntoh24(hdr->dlength);
  379. buf_offset = ntohl(hdr->offset);
  380. iser_dbg("%s itt %d dseg_len %d offset %d\n",
  381. __func__,(int)itt,(int)data_seg_len,(int)buf_offset);
  382. tx_desc = kmem_cache_zalloc(ig.desc_cache, GFP_ATOMIC);
  383. if (!tx_desc)
  384. return -ENOMEM;
  385. tx_desc->type = ISCSI_TX_DATAOUT;
  386. tx_desc->cqe.done = iser_dataout_comp;
  387. tx_desc->iser_header.flags = ISER_VER;
  388. memcpy(&tx_desc->iscsi_header, hdr, sizeof(struct iscsi_hdr));
  389. /* build the tx desc */
  390. err = iser_initialize_task_headers(task, tx_desc);
  391. if (err)
  392. goto send_data_out_error;
  393. mem_reg = &iser_task->rdma_reg[ISER_DIR_OUT];
  394. tx_dsg = &tx_desc->tx_sg[1];
  395. tx_dsg->addr = mem_reg->sge.addr + buf_offset;
  396. tx_dsg->length = data_seg_len;
  397. tx_dsg->lkey = mem_reg->sge.lkey;
  398. tx_desc->num_sge = 2;
  399. if (buf_offset + data_seg_len > iser_task->data[ISER_DIR_OUT].data_len) {
  400. iser_err("Offset:%ld & DSL:%ld in Data-Out inconsistent with total len:%ld, itt:%d\n",
  401. buf_offset, data_seg_len,
  402. iser_task->data[ISER_DIR_OUT].data_len, itt);
  403. err = -EINVAL;
  404. goto send_data_out_error;
  405. }
  406. iser_dbg("data-out itt: %d, offset: %ld, sz: %ld\n",
  407. itt, buf_offset, data_seg_len);
  408. err = iser_post_send(&iser_conn->ib_conn, tx_desc, true);
  409. if (!err)
  410. return 0;
  411. send_data_out_error:
  412. kmem_cache_free(ig.desc_cache, tx_desc);
  413. iser_err("conn %p failed err %d\n", conn, err);
  414. return err;
  415. }
  416. int iser_send_control(struct iscsi_conn *conn,
  417. struct iscsi_task *task)
  418. {
  419. struct iser_conn *iser_conn = conn->dd_data;
  420. struct iscsi_iser_task *iser_task = task->dd_data;
  421. struct iser_tx_desc *mdesc = &iser_task->desc;
  422. unsigned long data_seg_len;
  423. int err = 0;
  424. struct iser_device *device;
  425. /* build the tx desc regd header and add it to the tx desc dto */
  426. mdesc->type = ISCSI_TX_CONTROL;
  427. mdesc->cqe.done = iser_ctrl_comp;
  428. iser_create_send_desc(iser_conn, mdesc);
  429. device = iser_conn->ib_conn.device;
  430. data_seg_len = ntoh24(task->hdr->dlength);
  431. if (data_seg_len > 0) {
  432. struct iser_login_desc *desc = &iser_conn->login_desc;
  433. struct ib_sge *tx_dsg = &mdesc->tx_sg[1];
  434. if (task != conn->login_task) {
  435. iser_err("data present on non login task!!!\n");
  436. goto send_control_error;
  437. }
  438. ib_dma_sync_single_for_cpu(device->ib_device, desc->req_dma,
  439. task->data_count, DMA_TO_DEVICE);
  440. memcpy(desc->req, task->data, task->data_count);
  441. ib_dma_sync_single_for_device(device->ib_device, desc->req_dma,
  442. task->data_count, DMA_TO_DEVICE);
  443. tx_dsg->addr = desc->req_dma;
  444. tx_dsg->length = task->data_count;
  445. tx_dsg->lkey = device->pd->local_dma_lkey;
  446. mdesc->num_sge = 2;
  447. }
  448. if (task == conn->login_task) {
  449. iser_dbg("op %x dsl %lx, posting login rx buffer\n",
  450. task->hdr->opcode, data_seg_len);
  451. err = iser_post_recvl(iser_conn);
  452. if (err)
  453. goto send_control_error;
  454. err = iser_post_rx_bufs(conn, task->hdr);
  455. if (err)
  456. goto send_control_error;
  457. }
  458. err = iser_post_send(&iser_conn->ib_conn, mdesc, true);
  459. if (!err)
  460. return 0;
  461. send_control_error:
  462. iser_err("conn %p failed err %d\n",conn, err);
  463. return err;
  464. }
  465. void iser_login_rsp(struct ib_cq *cq, struct ib_wc *wc)
  466. {
  467. struct ib_conn *ib_conn = wc->qp->qp_context;
  468. struct iser_conn *iser_conn = to_iser_conn(ib_conn);
  469. struct iser_login_desc *desc = iser_login(wc->wr_cqe);
  470. struct iscsi_hdr *hdr;
  471. char *data;
  472. int length;
  473. if (unlikely(wc->status != IB_WC_SUCCESS)) {
  474. iser_err_comp(wc, "login_rsp");
  475. return;
  476. }
  477. ib_dma_sync_single_for_cpu(ib_conn->device->ib_device,
  478. desc->rsp_dma, ISER_RX_LOGIN_SIZE,
  479. DMA_FROM_DEVICE);
  480. hdr = desc->rsp + sizeof(struct iser_ctrl);
  481. data = desc->rsp + ISER_HEADERS_LEN;
  482. length = wc->byte_len - ISER_HEADERS_LEN;
  483. iser_dbg("op 0x%x itt 0x%x dlen %d\n", hdr->opcode,
  484. hdr->itt, length);
  485. iscsi_iser_recv(iser_conn->iscsi_conn, hdr, data, length);
  486. ib_dma_sync_single_for_device(ib_conn->device->ib_device,
  487. desc->rsp_dma, ISER_RX_LOGIN_SIZE,
  488. DMA_FROM_DEVICE);
  489. ib_conn->post_recv_buf_count--;
  490. }
  491. static inline int
  492. iser_inv_desc(struct iser_fr_desc *desc, u32 rkey)
  493. {
  494. if (likely(rkey == desc->rsc.mr->rkey)) {
  495. desc->rsc.mr_valid = 0;
  496. } else if (likely(desc->pi_ctx && rkey == desc->pi_ctx->sig_mr->rkey)) {
  497. desc->pi_ctx->sig_mr_valid = 0;
  498. } else {
  499. iser_err("Bogus remote invalidation for rkey %#x\n", rkey);
  500. return -EINVAL;
  501. }
  502. return 0;
  503. }
  504. static int
  505. iser_check_remote_inv(struct iser_conn *iser_conn,
  506. struct ib_wc *wc,
  507. struct iscsi_hdr *hdr)
  508. {
  509. if (wc->wc_flags & IB_WC_WITH_INVALIDATE) {
  510. struct iscsi_task *task;
  511. u32 rkey = wc->ex.invalidate_rkey;
  512. iser_dbg("conn %p: remote invalidation for rkey %#x\n",
  513. iser_conn, rkey);
  514. if (unlikely(!iser_conn->snd_w_inv)) {
  515. iser_err("conn %p: unexpected remote invalidation, terminating connection\n",
  516. iser_conn);
  517. return -EPROTO;
  518. }
  519. task = iscsi_itt_to_ctask(iser_conn->iscsi_conn, hdr->itt);
  520. if (likely(task)) {
  521. struct iscsi_iser_task *iser_task = task->dd_data;
  522. struct iser_fr_desc *desc;
  523. if (iser_task->dir[ISER_DIR_IN]) {
  524. desc = iser_task->rdma_reg[ISER_DIR_IN].mem_h;
  525. if (unlikely(iser_inv_desc(desc, rkey)))
  526. return -EINVAL;
  527. }
  528. if (iser_task->dir[ISER_DIR_OUT]) {
  529. desc = iser_task->rdma_reg[ISER_DIR_OUT].mem_h;
  530. if (unlikely(iser_inv_desc(desc, rkey)))
  531. return -EINVAL;
  532. }
  533. } else {
  534. iser_err("failed to get task for itt=%d\n", hdr->itt);
  535. return -EINVAL;
  536. }
  537. }
  538. return 0;
  539. }
  540. void iser_task_rsp(struct ib_cq *cq, struct ib_wc *wc)
  541. {
  542. struct ib_conn *ib_conn = wc->qp->qp_context;
  543. struct iser_conn *iser_conn = to_iser_conn(ib_conn);
  544. struct iser_rx_desc *desc = iser_rx(wc->wr_cqe);
  545. struct iscsi_hdr *hdr;
  546. int length;
  547. int outstanding, count, err;
  548. if (unlikely(wc->status != IB_WC_SUCCESS)) {
  549. iser_err_comp(wc, "task_rsp");
  550. return;
  551. }
  552. ib_dma_sync_single_for_cpu(ib_conn->device->ib_device,
  553. desc->dma_addr, ISER_RX_PAYLOAD_SIZE,
  554. DMA_FROM_DEVICE);
  555. hdr = &desc->iscsi_header;
  556. length = wc->byte_len - ISER_HEADERS_LEN;
  557. iser_dbg("op 0x%x itt 0x%x dlen %d\n", hdr->opcode,
  558. hdr->itt, length);
  559. if (iser_check_remote_inv(iser_conn, wc, hdr)) {
  560. iscsi_conn_failure(iser_conn->iscsi_conn,
  561. ISCSI_ERR_CONN_FAILED);
  562. return;
  563. }
  564. iscsi_iser_recv(iser_conn->iscsi_conn, hdr, desc->data, length);
  565. ib_dma_sync_single_for_device(ib_conn->device->ib_device,
  566. desc->dma_addr, ISER_RX_PAYLOAD_SIZE,
  567. DMA_FROM_DEVICE);
  568. /* decrementing conn->post_recv_buf_count only --after-- freeing the *
  569. * task eliminates the need to worry on tasks which are completed in *
  570. * parallel to the execution of iser_conn_term. So the code that waits *
  571. * for the posted rx bufs refcount to become zero handles everything */
  572. ib_conn->post_recv_buf_count--;
  573. outstanding = ib_conn->post_recv_buf_count;
  574. if (outstanding + iser_conn->min_posted_rx <= iser_conn->qp_max_recv_dtos) {
  575. count = min(iser_conn->qp_max_recv_dtos - outstanding,
  576. iser_conn->min_posted_rx);
  577. err = iser_post_recvm(iser_conn, count);
  578. if (err)
  579. iser_err("posting %d rx bufs err %d\n", count, err);
  580. }
  581. }
  582. void iser_cmd_comp(struct ib_cq *cq, struct ib_wc *wc)
  583. {
  584. if (unlikely(wc->status != IB_WC_SUCCESS))
  585. iser_err_comp(wc, "command");
  586. }
  587. void iser_ctrl_comp(struct ib_cq *cq, struct ib_wc *wc)
  588. {
  589. struct iser_tx_desc *desc = iser_tx(wc->wr_cqe);
  590. struct iscsi_task *task;
  591. if (unlikely(wc->status != IB_WC_SUCCESS)) {
  592. iser_err_comp(wc, "control");
  593. return;
  594. }
  595. /* this arithmetic is legal by libiscsi dd_data allocation */
  596. task = (void *)desc - sizeof(struct iscsi_task);
  597. if (task->hdr->itt == RESERVED_ITT)
  598. iscsi_put_task(task);
  599. }
  600. void iser_dataout_comp(struct ib_cq *cq, struct ib_wc *wc)
  601. {
  602. struct iser_tx_desc *desc = iser_tx(wc->wr_cqe);
  603. struct ib_conn *ib_conn = wc->qp->qp_context;
  604. struct iser_device *device = ib_conn->device;
  605. if (unlikely(wc->status != IB_WC_SUCCESS))
  606. iser_err_comp(wc, "dataout");
  607. ib_dma_unmap_single(device->ib_device, desc->dma_addr,
  608. ISER_HEADERS_LEN, DMA_TO_DEVICE);
  609. kmem_cache_free(ig.desc_cache, desc);
  610. }
  611. void iser_task_rdma_init(struct iscsi_iser_task *iser_task)
  612. {
  613. iser_task->status = ISER_TASK_STATUS_INIT;
  614. iser_task->dir[ISER_DIR_IN] = 0;
  615. iser_task->dir[ISER_DIR_OUT] = 0;
  616. iser_task->data[ISER_DIR_IN].data_len = 0;
  617. iser_task->data[ISER_DIR_OUT].data_len = 0;
  618. iser_task->prot[ISER_DIR_IN].data_len = 0;
  619. iser_task->prot[ISER_DIR_OUT].data_len = 0;
  620. memset(&iser_task->rdma_reg[ISER_DIR_IN], 0,
  621. sizeof(struct iser_mem_reg));
  622. memset(&iser_task->rdma_reg[ISER_DIR_OUT], 0,
  623. sizeof(struct iser_mem_reg));
  624. }
  625. void iser_task_rdma_finalize(struct iscsi_iser_task *iser_task)
  626. {
  627. int prot_count = scsi_prot_sg_count(iser_task->sc);
  628. if (iser_task->dir[ISER_DIR_IN]) {
  629. iser_unreg_rdma_mem(iser_task, ISER_DIR_IN);
  630. iser_dma_unmap_task_data(iser_task,
  631. &iser_task->data[ISER_DIR_IN],
  632. DMA_FROM_DEVICE);
  633. if (prot_count)
  634. iser_dma_unmap_task_data(iser_task,
  635. &iser_task->prot[ISER_DIR_IN],
  636. DMA_FROM_DEVICE);
  637. }
  638. if (iser_task->dir[ISER_DIR_OUT]) {
  639. iser_unreg_rdma_mem(iser_task, ISER_DIR_OUT);
  640. iser_dma_unmap_task_data(iser_task,
  641. &iser_task->data[ISER_DIR_OUT],
  642. DMA_TO_DEVICE);
  643. if (prot_count)
  644. iser_dma_unmap_task_data(iser_task,
  645. &iser_task->prot[ISER_DIR_OUT],
  646. DMA_TO_DEVICE);
  647. }
  648. }