iser_initiator.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738
  1. /*
  2. * Copyright (c) 2004, 2005, 2006 Voltaire, Inc. All rights reserved.
  3. *
  4. * This software is available to you under a choice of one of two
  5. * licenses. You may choose to be licensed under the terms of the GNU
  6. * General Public License (GPL) Version 2, available from the file
  7. * COPYING in the main directory of this source tree, or the
  8. * OpenIB.org BSD license below:
  9. *
  10. * Redistribution and use in source and binary forms, with or
  11. * without modification, are permitted provided that the following
  12. * conditions are met:
  13. *
  14. * - Redistributions of source code must retain the above
  15. * copyright notice, this list of conditions and the following
  16. * disclaimer.
  17. *
  18. * - Redistributions in binary form must reproduce the above
  19. * copyright notice, this list of conditions and the following
  20. * disclaimer in the documentation and/or other materials
  21. * provided with the distribution.
  22. *
  23. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  24. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  25. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  26. * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  27. * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  28. * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  29. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  30. * SOFTWARE.
  31. *
  32. * $Id: iser_initiator.c 6964 2006-05-07 11:11:43Z ogerlitz $
  33. */
  34. #include <linux/kernel.h>
  35. #include <linux/slab.h>
  36. #include <linux/mm.h>
  37. #include <asm/io.h>
  38. #include <asm/scatterlist.h>
  39. #include <linux/scatterlist.h>
  40. #include <linux/kfifo.h>
  41. #include <scsi/scsi_cmnd.h>
  42. #include <scsi/scsi_host.h>
  43. #include "iscsi_iser.h"
  44. /* Constant PDU lengths calculations */
  45. #define ISER_TOTAL_HEADERS_LEN (sizeof (struct iser_hdr) + \
  46. sizeof (struct iscsi_hdr))
  47. /* iser_dto_add_regd_buff - increments the reference count for *
  48. * the registered buffer & adds it to the DTO object */
  49. static void iser_dto_add_regd_buff(struct iser_dto *dto,
  50. struct iser_regd_buf *regd_buf,
  51. unsigned long use_offset,
  52. unsigned long use_size)
  53. {
  54. int add_idx;
  55. atomic_inc(&regd_buf->ref_count);
  56. add_idx = dto->regd_vector_len;
  57. dto->regd[add_idx] = regd_buf;
  58. dto->used_sz[add_idx] = use_size;
  59. dto->offset[add_idx] = use_offset;
  60. dto->regd_vector_len++;
  61. }
  62. static int iser_dma_map_task_data(struct iscsi_iser_cmd_task *iser_ctask,
  63. struct iser_data_buf *data,
  64. enum iser_data_dir iser_dir,
  65. enum dma_data_direction dma_dir)
  66. {
  67. struct device *dma_device;
  68. iser_ctask->dir[iser_dir] = 1;
  69. dma_device = iser_ctask->iser_conn->ib_conn->device->ib_device->dma_device;
  70. data->dma_nents = dma_map_sg(dma_device, data->buf, data->size, dma_dir);
  71. if (data->dma_nents == 0) {
  72. iser_err("dma_map_sg failed!!!\n");
  73. return -EINVAL;
  74. }
  75. return 0;
  76. }
  77. static void iser_dma_unmap_task_data(struct iscsi_iser_cmd_task *iser_ctask)
  78. {
  79. struct device *dma_device;
  80. struct iser_data_buf *data;
  81. dma_device = iser_ctask->iser_conn->ib_conn->device->ib_device->dma_device;
  82. if (iser_ctask->dir[ISER_DIR_IN]) {
  83. data = &iser_ctask->data[ISER_DIR_IN];
  84. dma_unmap_sg(dma_device, data->buf, data->size, DMA_FROM_DEVICE);
  85. }
  86. if (iser_ctask->dir[ISER_DIR_OUT]) {
  87. data = &iser_ctask->data[ISER_DIR_OUT];
  88. dma_unmap_sg(dma_device, data->buf, data->size, DMA_TO_DEVICE);
  89. }
  90. }
  91. /* Register user buffer memory and initialize passive rdma
  92. * dto descriptor. Total data size is stored in
  93. * iser_ctask->data[ISER_DIR_IN].data_len
  94. */
  95. static int iser_prepare_read_cmd(struct iscsi_cmd_task *ctask,
  96. unsigned int edtl)
  97. {
  98. struct iscsi_iser_cmd_task *iser_ctask = ctask->dd_data;
  99. struct iser_regd_buf *regd_buf;
  100. int err;
  101. struct iser_hdr *hdr = &iser_ctask->desc.iser_header;
  102. struct iser_data_buf *buf_in = &iser_ctask->data[ISER_DIR_IN];
  103. err = iser_dma_map_task_data(iser_ctask,
  104. buf_in,
  105. ISER_DIR_IN,
  106. DMA_FROM_DEVICE);
  107. if (err)
  108. return err;
  109. if (edtl > iser_ctask->data[ISER_DIR_IN].data_len) {
  110. iser_err("Total data length: %ld, less than EDTL: "
  111. "%d, in READ cmd BHS itt: %d, conn: 0x%p\n",
  112. iser_ctask->data[ISER_DIR_IN].data_len, edtl,
  113. ctask->itt, iser_ctask->iser_conn);
  114. return -EINVAL;
  115. }
  116. err = iser_reg_rdma_mem(iser_ctask,ISER_DIR_IN);
  117. if (err) {
  118. iser_err("Failed to set up Data-IN RDMA\n");
  119. return err;
  120. }
  121. regd_buf = &iser_ctask->rdma_regd[ISER_DIR_IN];
  122. hdr->flags |= ISER_RSV;
  123. hdr->read_stag = cpu_to_be32(regd_buf->reg.rkey);
  124. hdr->read_va = cpu_to_be64(regd_buf->reg.va);
  125. iser_dbg("Cmd itt:%d READ tags RKEY:%#.4X VA:%#llX\n",
  126. ctask->itt, regd_buf->reg.rkey,
  127. (unsigned long long)regd_buf->reg.va);
  128. return 0;
  129. }
  130. /* Register user buffer memory and initialize passive rdma
  131. * dto descriptor. Total data size is stored in
  132. * ctask->data[ISER_DIR_OUT].data_len
  133. */
  134. static int
  135. iser_prepare_write_cmd(struct iscsi_cmd_task *ctask,
  136. unsigned int imm_sz,
  137. unsigned int unsol_sz,
  138. unsigned int edtl)
  139. {
  140. struct iscsi_iser_cmd_task *iser_ctask = ctask->dd_data;
  141. struct iser_regd_buf *regd_buf;
  142. int err;
  143. struct iser_dto *send_dto = &iser_ctask->desc.dto;
  144. struct iser_hdr *hdr = &iser_ctask->desc.iser_header;
  145. struct iser_data_buf *buf_out = &iser_ctask->data[ISER_DIR_OUT];
  146. err = iser_dma_map_task_data(iser_ctask,
  147. buf_out,
  148. ISER_DIR_OUT,
  149. DMA_TO_DEVICE);
  150. if (err)
  151. return err;
  152. if (edtl > iser_ctask->data[ISER_DIR_OUT].data_len) {
  153. iser_err("Total data length: %ld, less than EDTL: %d, "
  154. "in WRITE cmd BHS itt: %d, conn: 0x%p\n",
  155. iser_ctask->data[ISER_DIR_OUT].data_len,
  156. edtl, ctask->itt, ctask->conn);
  157. return -EINVAL;
  158. }
  159. err = iser_reg_rdma_mem(iser_ctask,ISER_DIR_OUT);
  160. if (err != 0) {
  161. iser_err("Failed to register write cmd RDMA mem\n");
  162. return err;
  163. }
  164. regd_buf = &iser_ctask->rdma_regd[ISER_DIR_OUT];
  165. if (unsol_sz < edtl) {
  166. hdr->flags |= ISER_WSV;
  167. hdr->write_stag = cpu_to_be32(regd_buf->reg.rkey);
  168. hdr->write_va = cpu_to_be64(regd_buf->reg.va + unsol_sz);
  169. iser_dbg("Cmd itt:%d, WRITE tags, RKEY:%#.4X "
  170. "VA:%#llX + unsol:%d\n",
  171. ctask->itt, regd_buf->reg.rkey,
  172. (unsigned long long)regd_buf->reg.va, unsol_sz);
  173. }
  174. if (imm_sz > 0) {
  175. iser_dbg("Cmd itt:%d, WRITE, adding imm.data sz: %d\n",
  176. ctask->itt, imm_sz);
  177. iser_dto_add_regd_buff(send_dto,
  178. regd_buf,
  179. 0,
  180. imm_sz);
  181. }
  182. return 0;
  183. }
  184. /**
  185. * iser_post_receive_control - allocates, initializes and posts receive DTO.
  186. */
  187. static int iser_post_receive_control(struct iscsi_conn *conn)
  188. {
  189. struct iscsi_iser_conn *iser_conn = conn->dd_data;
  190. struct iser_desc *rx_desc;
  191. struct iser_regd_buf *regd_hdr;
  192. struct iser_regd_buf *regd_data;
  193. struct iser_dto *recv_dto = NULL;
  194. struct iser_device *device = iser_conn->ib_conn->device;
  195. int rx_data_size, err = 0;
  196. rx_desc = kmem_cache_alloc(ig.desc_cache, GFP_NOIO);
  197. if (rx_desc == NULL) {
  198. iser_err("Failed to alloc desc for post recv\n");
  199. return -ENOMEM;
  200. }
  201. rx_desc->type = ISCSI_RX;
  202. /* for the login sequence we must support rx of upto 8K; login is done
  203. * after conn create/bind (connect) and conn stop/bind (reconnect),
  204. * what's common for both schemes is that the connection is not started
  205. */
  206. if (conn->c_stage != ISCSI_CONN_STARTED)
  207. rx_data_size = DEFAULT_MAX_RECV_DATA_SEGMENT_LENGTH;
  208. else /* FIXME till user space sets conn->max_recv_dlength correctly */
  209. rx_data_size = 128;
  210. rx_desc->data = kmalloc(rx_data_size, GFP_NOIO);
  211. if (rx_desc->data == NULL) {
  212. iser_err("Failed to alloc data buf for post recv\n");
  213. err = -ENOMEM;
  214. goto post_rx_kmalloc_failure;
  215. }
  216. recv_dto = &rx_desc->dto;
  217. recv_dto->conn = iser_conn;
  218. recv_dto->regd_vector_len = 0;
  219. regd_hdr = &rx_desc->hdr_regd_buf;
  220. memset(regd_hdr, 0, sizeof(struct iser_regd_buf));
  221. regd_hdr->device = device;
  222. regd_hdr->virt_addr = rx_desc; /* == &rx_desc->iser_header */
  223. regd_hdr->data_size = ISER_TOTAL_HEADERS_LEN;
  224. iser_reg_single(device, regd_hdr, DMA_FROM_DEVICE);
  225. iser_dto_add_regd_buff(recv_dto, regd_hdr, 0, 0);
  226. regd_data = &rx_desc->data_regd_buf;
  227. memset(regd_data, 0, sizeof(struct iser_regd_buf));
  228. regd_data->device = device;
  229. regd_data->virt_addr = rx_desc->data;
  230. regd_data->data_size = rx_data_size;
  231. iser_reg_single(device, regd_data, DMA_FROM_DEVICE);
  232. iser_dto_add_regd_buff(recv_dto, regd_data, 0, 0);
  233. err = iser_post_recv(rx_desc);
  234. if (!err)
  235. return 0;
  236. /* iser_post_recv failed */
  237. iser_dto_buffs_release(recv_dto);
  238. kfree(rx_desc->data);
  239. post_rx_kmalloc_failure:
  240. kmem_cache_free(ig.desc_cache, rx_desc);
  241. return err;
  242. }
  243. /* creates a new tx descriptor and adds header regd buffer */
  244. static void iser_create_send_desc(struct iscsi_iser_conn *iser_conn,
  245. struct iser_desc *tx_desc)
  246. {
  247. struct iser_regd_buf *regd_hdr = &tx_desc->hdr_regd_buf;
  248. struct iser_dto *send_dto = &tx_desc->dto;
  249. memset(regd_hdr, 0, sizeof(struct iser_regd_buf));
  250. regd_hdr->device = iser_conn->ib_conn->device;
  251. regd_hdr->virt_addr = tx_desc; /* == &tx_desc->iser_header */
  252. regd_hdr->data_size = ISER_TOTAL_HEADERS_LEN;
  253. send_dto->conn = iser_conn;
  254. send_dto->notify_enable = 1;
  255. send_dto->regd_vector_len = 0;
  256. memset(&tx_desc->iser_header, 0, sizeof(struct iser_hdr));
  257. tx_desc->iser_header.flags = ISER_VER;
  258. iser_dto_add_regd_buff(send_dto, regd_hdr, 0, 0);
  259. }
  260. /**
  261. * iser_conn_set_full_featured_mode - (iSER API)
  262. */
  263. int iser_conn_set_full_featured_mode(struct iscsi_conn *conn)
  264. {
  265. struct iscsi_iser_conn *iser_conn = conn->dd_data;
  266. int i;
  267. /* no need to keep it in a var, we are after login so if this should
  268. * be negotiated, by now the result should be available here */
  269. int initial_post_recv_bufs_num = ISER_MAX_RX_MISC_PDUS;
  270. iser_dbg("Initially post: %d\n", initial_post_recv_bufs_num);
  271. /* Check that there is no posted recv or send buffers left - */
  272. /* they must be consumed during the login phase */
  273. BUG_ON(atomic_read(&iser_conn->ib_conn->post_recv_buf_count) != 0);
  274. BUG_ON(atomic_read(&iser_conn->ib_conn->post_send_buf_count) != 0);
  275. /* Initial post receive buffers */
  276. for (i = 0; i < initial_post_recv_bufs_num; i++) {
  277. if (iser_post_receive_control(conn) != 0) {
  278. iser_err("Failed to post recv bufs at:%d conn:0x%p\n",
  279. i, conn);
  280. return -ENOMEM;
  281. }
  282. }
  283. iser_dbg("Posted %d post recv bufs, conn:0x%p\n", i, conn);
  284. return 0;
  285. }
  286. static int
  287. iser_check_xmit(struct iscsi_conn *conn, void *task)
  288. {
  289. int rc = 0;
  290. struct iscsi_iser_conn *iser_conn = conn->dd_data;
  291. write_lock_bh(conn->recv_lock);
  292. if (atomic_read(&iser_conn->ib_conn->post_send_buf_count) ==
  293. ISER_QP_MAX_REQ_DTOS) {
  294. iser_dbg("%ld can't xmit task %p, suspending tx\n",jiffies,task);
  295. set_bit(ISCSI_SUSPEND_BIT, &conn->suspend_tx);
  296. rc = -EAGAIN;
  297. }
  298. write_unlock_bh(conn->recv_lock);
  299. return rc;
  300. }
  301. /**
  302. * iser_send_command - send command PDU
  303. */
  304. int iser_send_command(struct iscsi_conn *conn,
  305. struct iscsi_cmd_task *ctask)
  306. {
  307. struct iscsi_iser_conn *iser_conn = conn->dd_data;
  308. struct iscsi_iser_cmd_task *iser_ctask = ctask->dd_data;
  309. struct iser_dto *send_dto = NULL;
  310. unsigned long edtl;
  311. int err = 0;
  312. struct iser_data_buf *data_buf;
  313. struct iscsi_cmd *hdr = ctask->hdr;
  314. struct scsi_cmnd *sc = ctask->sc;
  315. if (!iser_conn_state_comp(iser_conn->ib_conn, ISER_CONN_UP)) {
  316. iser_err("Failed to send, conn: 0x%p is not up\n", iser_conn->ib_conn);
  317. return -EPERM;
  318. }
  319. if (iser_check_xmit(conn, ctask))
  320. return -EAGAIN;
  321. edtl = ntohl(hdr->data_length);
  322. /* build the tx desc regd header and add it to the tx desc dto */
  323. iser_ctask->desc.type = ISCSI_TX_SCSI_COMMAND;
  324. send_dto = &iser_ctask->desc.dto;
  325. send_dto->ctask = iser_ctask;
  326. iser_create_send_desc(iser_conn, &iser_ctask->desc);
  327. if (hdr->flags & ISCSI_FLAG_CMD_READ)
  328. data_buf = &iser_ctask->data[ISER_DIR_IN];
  329. else
  330. data_buf = &iser_ctask->data[ISER_DIR_OUT];
  331. if (sc->use_sg) { /* using a scatter list */
  332. data_buf->buf = sc->request_buffer;
  333. data_buf->size = sc->use_sg;
  334. } else if (sc->request_bufflen) {
  335. /* using a single buffer - convert it into one entry SG */
  336. sg_init_one(&data_buf->sg_single,
  337. sc->request_buffer, sc->request_bufflen);
  338. data_buf->buf = &data_buf->sg_single;
  339. data_buf->size = 1;
  340. }
  341. data_buf->data_len = sc->request_bufflen;
  342. if (hdr->flags & ISCSI_FLAG_CMD_READ) {
  343. err = iser_prepare_read_cmd(ctask, edtl);
  344. if (err)
  345. goto send_command_error;
  346. }
  347. if (hdr->flags & ISCSI_FLAG_CMD_WRITE) {
  348. err = iser_prepare_write_cmd(ctask,
  349. ctask->imm_count,
  350. ctask->imm_count +
  351. ctask->unsol_count,
  352. edtl);
  353. if (err)
  354. goto send_command_error;
  355. }
  356. iser_reg_single(iser_conn->ib_conn->device,
  357. send_dto->regd[0], DMA_TO_DEVICE);
  358. if (iser_post_receive_control(conn) != 0) {
  359. iser_err("post_recv failed!\n");
  360. err = -ENOMEM;
  361. goto send_command_error;
  362. }
  363. iser_ctask->status = ISER_TASK_STATUS_STARTED;
  364. err = iser_post_send(&iser_ctask->desc);
  365. if (!err)
  366. return 0;
  367. send_command_error:
  368. iser_dto_buffs_release(send_dto);
  369. iser_err("conn %p failed ctask->itt %d err %d\n",conn, ctask->itt, err);
  370. return err;
  371. }
  372. /**
  373. * iser_send_data_out - send data out PDU
  374. */
  375. int iser_send_data_out(struct iscsi_conn *conn,
  376. struct iscsi_cmd_task *ctask,
  377. struct iscsi_data *hdr)
  378. {
  379. struct iscsi_iser_conn *iser_conn = conn->dd_data;
  380. struct iscsi_iser_cmd_task *iser_ctask = ctask->dd_data;
  381. struct iser_desc *tx_desc = NULL;
  382. struct iser_dto *send_dto = NULL;
  383. unsigned long buf_offset;
  384. unsigned long data_seg_len;
  385. unsigned int itt;
  386. int err = 0;
  387. if (!iser_conn_state_comp(iser_conn->ib_conn, ISER_CONN_UP)) {
  388. iser_err("Failed to send, conn: 0x%p is not up\n", iser_conn->ib_conn);
  389. return -EPERM;
  390. }
  391. if (iser_check_xmit(conn, ctask))
  392. return -EAGAIN;
  393. itt = ntohl(hdr->itt);
  394. data_seg_len = ntoh24(hdr->dlength);
  395. buf_offset = ntohl(hdr->offset);
  396. iser_dbg("%s itt %d dseg_len %d offset %d\n",
  397. __func__,(int)itt,(int)data_seg_len,(int)buf_offset);
  398. tx_desc = kmem_cache_alloc(ig.desc_cache, GFP_NOIO);
  399. if (tx_desc == NULL) {
  400. iser_err("Failed to alloc desc for post dataout\n");
  401. return -ENOMEM;
  402. }
  403. tx_desc->type = ISCSI_TX_DATAOUT;
  404. memcpy(&tx_desc->iscsi_header, hdr, sizeof(struct iscsi_hdr));
  405. /* build the tx desc regd header and add it to the tx desc dto */
  406. send_dto = &tx_desc->dto;
  407. send_dto->ctask = iser_ctask;
  408. iser_create_send_desc(iser_conn, tx_desc);
  409. iser_reg_single(iser_conn->ib_conn->device,
  410. send_dto->regd[0], DMA_TO_DEVICE);
  411. /* all data was registered for RDMA, we can use the lkey */
  412. iser_dto_add_regd_buff(send_dto,
  413. &iser_ctask->rdma_regd[ISER_DIR_OUT],
  414. buf_offset,
  415. data_seg_len);
  416. if (buf_offset + data_seg_len > iser_ctask->data[ISER_DIR_OUT].data_len) {
  417. iser_err("Offset:%ld & DSL:%ld in Data-Out "
  418. "inconsistent with total len:%ld, itt:%d\n",
  419. buf_offset, data_seg_len,
  420. iser_ctask->data[ISER_DIR_OUT].data_len, itt);
  421. err = -EINVAL;
  422. goto send_data_out_error;
  423. }
  424. iser_dbg("data-out itt: %d, offset: %ld, sz: %ld\n",
  425. itt, buf_offset, data_seg_len);
  426. err = iser_post_send(tx_desc);
  427. if (!err)
  428. return 0;
  429. send_data_out_error:
  430. iser_dto_buffs_release(send_dto);
  431. kmem_cache_free(ig.desc_cache, tx_desc);
  432. iser_err("conn %p failed err %d\n",conn, err);
  433. return err;
  434. }
  435. int iser_send_control(struct iscsi_conn *conn,
  436. struct iscsi_mgmt_task *mtask)
  437. {
  438. struct iscsi_iser_conn *iser_conn = conn->dd_data;
  439. struct iser_desc *mdesc = mtask->dd_data;
  440. struct iser_dto *send_dto = NULL;
  441. unsigned int itt;
  442. unsigned long data_seg_len;
  443. int err = 0;
  444. unsigned char opcode;
  445. struct iser_regd_buf *regd_buf;
  446. struct iser_device *device;
  447. if (!iser_conn_state_comp(iser_conn->ib_conn, ISER_CONN_UP)) {
  448. iser_err("Failed to send, conn: 0x%p is not up\n", iser_conn->ib_conn);
  449. return -EPERM;
  450. }
  451. if (iser_check_xmit(conn,mtask))
  452. return -EAGAIN;
  453. /* build the tx desc regd header and add it to the tx desc dto */
  454. mdesc->type = ISCSI_TX_CONTROL;
  455. send_dto = &mdesc->dto;
  456. send_dto->ctask = NULL;
  457. iser_create_send_desc(iser_conn, mdesc);
  458. device = iser_conn->ib_conn->device;
  459. iser_reg_single(device, send_dto->regd[0], DMA_TO_DEVICE);
  460. itt = ntohl(mtask->hdr->itt);
  461. opcode = mtask->hdr->opcode & ISCSI_OPCODE_MASK;
  462. data_seg_len = ntoh24(mtask->hdr->dlength);
  463. if (data_seg_len > 0) {
  464. regd_buf = &mdesc->data_regd_buf;
  465. memset(regd_buf, 0, sizeof(struct iser_regd_buf));
  466. regd_buf->device = device;
  467. regd_buf->virt_addr = mtask->data;
  468. regd_buf->data_size = mtask->data_count;
  469. iser_reg_single(device, regd_buf,
  470. DMA_TO_DEVICE);
  471. iser_dto_add_regd_buff(send_dto, regd_buf,
  472. 0,
  473. data_seg_len);
  474. }
  475. if (iser_post_receive_control(conn) != 0) {
  476. iser_err("post_rcv_buff failed!\n");
  477. err = -ENOMEM;
  478. goto send_control_error;
  479. }
  480. err = iser_post_send(mdesc);
  481. if (!err)
  482. return 0;
  483. send_control_error:
  484. iser_dto_buffs_release(send_dto);
  485. iser_err("conn %p failed err %d\n",conn, err);
  486. return err;
  487. }
  488. /**
  489. * iser_rcv_dto_completion - recv DTO completion
  490. */
  491. void iser_rcv_completion(struct iser_desc *rx_desc,
  492. unsigned long dto_xfer_len)
  493. {
  494. struct iser_dto *dto = &rx_desc->dto;
  495. struct iscsi_iser_conn *conn = dto->conn;
  496. struct iscsi_session *session = conn->iscsi_conn->session;
  497. struct iscsi_cmd_task *ctask;
  498. struct iscsi_iser_cmd_task *iser_ctask;
  499. struct iscsi_hdr *hdr;
  500. char *rx_data = NULL;
  501. int rx_data_len = 0;
  502. unsigned int itt;
  503. unsigned char opcode;
  504. hdr = &rx_desc->iscsi_header;
  505. iser_dbg("op 0x%x itt 0x%x\n", hdr->opcode,hdr->itt);
  506. if (dto_xfer_len > ISER_TOTAL_HEADERS_LEN) { /* we have data */
  507. rx_data_len = dto_xfer_len - ISER_TOTAL_HEADERS_LEN;
  508. rx_data = dto->regd[1]->virt_addr;
  509. rx_data += dto->offset[1];
  510. }
  511. opcode = hdr->opcode & ISCSI_OPCODE_MASK;
  512. if (opcode == ISCSI_OP_SCSI_CMD_RSP) {
  513. itt = hdr->itt & ISCSI_ITT_MASK; /* mask out cid and age bits */
  514. if (!(itt < session->cmds_max))
  515. iser_err("itt can't be matched to task!!!"
  516. "conn %p opcode %d cmds_max %d itt %d\n",
  517. conn->iscsi_conn,opcode,session->cmds_max,itt);
  518. /* use the mapping given with the cmds array indexed by itt */
  519. ctask = (struct iscsi_cmd_task *)session->cmds[itt];
  520. iser_ctask = ctask->dd_data;
  521. iser_dbg("itt %d ctask %p\n",itt,ctask);
  522. iser_ctask->status = ISER_TASK_STATUS_COMPLETED;
  523. iser_ctask_rdma_finalize(iser_ctask);
  524. }
  525. iser_dto_buffs_release(dto);
  526. iscsi_iser_recv(conn->iscsi_conn, hdr, rx_data, rx_data_len);
  527. kfree(rx_desc->data);
  528. kmem_cache_free(ig.desc_cache, rx_desc);
  529. /* decrementing conn->post_recv_buf_count only --after-- freeing the *
  530. * task eliminates the need to worry on tasks which are completed in *
  531. * parallel to the execution of iser_conn_term. So the code that waits *
  532. * for the posted rx bufs refcount to become zero handles everything */
  533. atomic_dec(&conn->ib_conn->post_recv_buf_count);
  534. }
  535. void iser_snd_completion(struct iser_desc *tx_desc)
  536. {
  537. struct iser_dto *dto = &tx_desc->dto;
  538. struct iscsi_iser_conn *iser_conn = dto->conn;
  539. struct iscsi_conn *conn = iser_conn->iscsi_conn;
  540. struct iscsi_mgmt_task *mtask;
  541. iser_dbg("Initiator, Data sent dto=0x%p\n", dto);
  542. iser_dto_buffs_release(dto);
  543. if (tx_desc->type == ISCSI_TX_DATAOUT)
  544. kmem_cache_free(ig.desc_cache, tx_desc);
  545. atomic_dec(&iser_conn->ib_conn->post_send_buf_count);
  546. write_lock(conn->recv_lock);
  547. if (conn->suspend_tx) {
  548. iser_dbg("%ld resuming tx\n",jiffies);
  549. clear_bit(ISCSI_SUSPEND_BIT, &conn->suspend_tx);
  550. scsi_queue_work(conn->session->host, &conn->xmitwork);
  551. }
  552. write_unlock(conn->recv_lock);
  553. if (tx_desc->type == ISCSI_TX_CONTROL) {
  554. /* this arithmetic is legal by libiscsi dd_data allocation */
  555. mtask = (void *) ((long)(void *)tx_desc -
  556. sizeof(struct iscsi_mgmt_task));
  557. if (mtask->hdr->itt == cpu_to_be32(ISCSI_RESERVED_TAG)) {
  558. struct iscsi_session *session = conn->session;
  559. spin_lock(&conn->session->lock);
  560. list_del(&mtask->running);
  561. __kfifo_put(session->mgmtpool.queue, (void*)&mtask,
  562. sizeof(void*));
  563. spin_unlock(&session->lock);
  564. }
  565. }
  566. }
  567. void iser_ctask_rdma_init(struct iscsi_iser_cmd_task *iser_ctask)
  568. {
  569. iser_ctask->status = ISER_TASK_STATUS_INIT;
  570. iser_ctask->dir[ISER_DIR_IN] = 0;
  571. iser_ctask->dir[ISER_DIR_OUT] = 0;
  572. iser_ctask->data[ISER_DIR_IN].data_len = 0;
  573. iser_ctask->data[ISER_DIR_OUT].data_len = 0;
  574. memset(&iser_ctask->rdma_regd[ISER_DIR_IN], 0,
  575. sizeof(struct iser_regd_buf));
  576. memset(&iser_ctask->rdma_regd[ISER_DIR_OUT], 0,
  577. sizeof(struct iser_regd_buf));
  578. }
  579. void iser_ctask_rdma_finalize(struct iscsi_iser_cmd_task *iser_ctask)
  580. {
  581. int deferred;
  582. /* if we were reading, copy back to unaligned sglist,
  583. * anyway dma_unmap and free the copy
  584. */
  585. if (iser_ctask->data_copy[ISER_DIR_IN].copy_buf != NULL)
  586. iser_finalize_rdma_unaligned_sg(iser_ctask, ISER_DIR_IN);
  587. if (iser_ctask->data_copy[ISER_DIR_OUT].copy_buf != NULL)
  588. iser_finalize_rdma_unaligned_sg(iser_ctask, ISER_DIR_OUT);
  589. if (iser_ctask->dir[ISER_DIR_IN]) {
  590. deferred = iser_regd_buff_release
  591. (&iser_ctask->rdma_regd[ISER_DIR_IN]);
  592. if (deferred) {
  593. iser_err("References remain for BUF-IN rdma reg\n");
  594. BUG();
  595. }
  596. }
  597. if (iser_ctask->dir[ISER_DIR_OUT]) {
  598. deferred = iser_regd_buff_release
  599. (&iser_ctask->rdma_regd[ISER_DIR_OUT]);
  600. if (deferred) {
  601. iser_err("References remain for BUF-OUT rdma reg\n");
  602. BUG();
  603. }
  604. }
  605. iser_dma_unmap_task_data(iser_ctask);
  606. }
  607. void iser_dto_buffs_release(struct iser_dto *dto)
  608. {
  609. int i;
  610. for (i = 0; i < dto->regd_vector_len; i++)
  611. iser_regd_buff_release(dto->regd[i]);
  612. }