iser_verbs.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836
  1. /*
  2. * Copyright (c) 2004, 2005, 2006 Voltaire, Inc. All rights reserved.
  3. * Copyright (c) 2005, 2006 Cisco Systems. 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/module.h>
  35. #include <linux/slab.h>
  36. #include <linux/delay.h>
  37. #include "iscsi_iser.h"
  38. #define ISCSI_ISER_MAX_CONN 8
  39. #define ISER_MAX_RX_CQ_LEN (ISER_QP_MAX_RECV_DTOS * ISCSI_ISER_MAX_CONN)
  40. #define ISER_MAX_TX_CQ_LEN (ISER_QP_MAX_REQ_DTOS * ISCSI_ISER_MAX_CONN)
  41. static void iser_cq_tasklet_fn(unsigned long data);
  42. static void iser_cq_callback(struct ib_cq *cq, void *cq_context);
  43. static void iser_cq_event_callback(struct ib_event *cause, void *context)
  44. {
  45. iser_err("got cq event %d \n", cause->event);
  46. }
  47. static void iser_qp_event_callback(struct ib_event *cause, void *context)
  48. {
  49. iser_err("got qp event %d\n",cause->event);
  50. }
  51. static void iser_event_handler(struct ib_event_handler *handler,
  52. struct ib_event *event)
  53. {
  54. iser_err("async event %d on device %s port %d\n", event->event,
  55. event->device->name, event->element.port_num);
  56. }
  57. /**
  58. * iser_create_device_ib_res - creates Protection Domain (PD), Completion
  59. * Queue (CQ), DMA Memory Region (DMA MR) with the device associated with
  60. * the adapator.
  61. *
  62. * returns 0 on success, -1 on failure
  63. */
  64. static int iser_create_device_ib_res(struct iser_device *device)
  65. {
  66. device->pd = ib_alloc_pd(device->ib_device);
  67. if (IS_ERR(device->pd))
  68. goto pd_err;
  69. device->rx_cq = ib_create_cq(device->ib_device,
  70. iser_cq_callback,
  71. iser_cq_event_callback,
  72. (void *)device,
  73. ISER_MAX_RX_CQ_LEN, 0);
  74. if (IS_ERR(device->rx_cq))
  75. goto rx_cq_err;
  76. device->tx_cq = ib_create_cq(device->ib_device,
  77. NULL, iser_cq_event_callback,
  78. (void *)device,
  79. ISER_MAX_TX_CQ_LEN, 0);
  80. if (IS_ERR(device->tx_cq))
  81. goto tx_cq_err;
  82. if (ib_req_notify_cq(device->rx_cq, IB_CQ_NEXT_COMP))
  83. goto cq_arm_err;
  84. tasklet_init(&device->cq_tasklet,
  85. iser_cq_tasklet_fn,
  86. (unsigned long)device);
  87. device->mr = ib_get_dma_mr(device->pd, IB_ACCESS_LOCAL_WRITE |
  88. IB_ACCESS_REMOTE_WRITE |
  89. IB_ACCESS_REMOTE_READ);
  90. if (IS_ERR(device->mr))
  91. goto dma_mr_err;
  92. INIT_IB_EVENT_HANDLER(&device->event_handler, device->ib_device,
  93. iser_event_handler);
  94. if (ib_register_event_handler(&device->event_handler))
  95. goto handler_err;
  96. return 0;
  97. handler_err:
  98. ib_dereg_mr(device->mr);
  99. dma_mr_err:
  100. tasklet_kill(&device->cq_tasklet);
  101. cq_arm_err:
  102. ib_destroy_cq(device->tx_cq);
  103. tx_cq_err:
  104. ib_destroy_cq(device->rx_cq);
  105. rx_cq_err:
  106. ib_dealloc_pd(device->pd);
  107. pd_err:
  108. iser_err("failed to allocate an IB resource\n");
  109. return -1;
  110. }
  111. /**
  112. * iser_free_device_ib_res - destroy/dealloc/dereg the DMA MR,
  113. * CQ and PD created with the device associated with the adapator.
  114. */
  115. static void iser_free_device_ib_res(struct iser_device *device)
  116. {
  117. BUG_ON(device->mr == NULL);
  118. tasklet_kill(&device->cq_tasklet);
  119. (void)ib_unregister_event_handler(&device->event_handler);
  120. (void)ib_dereg_mr(device->mr);
  121. (void)ib_destroy_cq(device->tx_cq);
  122. (void)ib_destroy_cq(device->rx_cq);
  123. (void)ib_dealloc_pd(device->pd);
  124. device->mr = NULL;
  125. device->tx_cq = NULL;
  126. device->rx_cq = NULL;
  127. device->pd = NULL;
  128. }
  129. /**
  130. * iser_create_ib_conn_res - Creates FMR pool and Queue-Pair (QP)
  131. *
  132. * returns 0 on success, -1 on failure
  133. */
  134. static int iser_create_ib_conn_res(struct iser_conn *ib_conn)
  135. {
  136. struct iser_device *device;
  137. struct ib_qp_init_attr init_attr;
  138. int ret = -ENOMEM;
  139. struct ib_fmr_pool_param params;
  140. BUG_ON(ib_conn->device == NULL);
  141. device = ib_conn->device;
  142. ib_conn->login_buf = kmalloc(ISER_RX_LOGIN_SIZE, GFP_KERNEL);
  143. if (!ib_conn->login_buf) {
  144. goto alloc_err;
  145. ret = -ENOMEM;
  146. }
  147. ib_conn->login_dma = ib_dma_map_single(ib_conn->device->ib_device,
  148. (void *)ib_conn->login_buf, ISER_RX_LOGIN_SIZE,
  149. DMA_FROM_DEVICE);
  150. ib_conn->page_vec = kmalloc(sizeof(struct iser_page_vec) +
  151. (sizeof(u64) * (ISCSI_ISER_SG_TABLESIZE +1)),
  152. GFP_KERNEL);
  153. if (!ib_conn->page_vec) {
  154. ret = -ENOMEM;
  155. goto alloc_err;
  156. }
  157. ib_conn->page_vec->pages = (u64 *) (ib_conn->page_vec + 1);
  158. params.page_shift = SHIFT_4K;
  159. /* when the first/last SG element are not start/end *
  160. * page aligned, the map whould be of N+1 pages */
  161. params.max_pages_per_fmr = ISCSI_ISER_SG_TABLESIZE + 1;
  162. /* make the pool size twice the max number of SCSI commands *
  163. * the ML is expected to queue, watermark for unmap at 50% */
  164. params.pool_size = ISCSI_DEF_XMIT_CMDS_MAX * 2;
  165. params.dirty_watermark = ISCSI_DEF_XMIT_CMDS_MAX;
  166. params.cache = 0;
  167. params.flush_function = NULL;
  168. params.access = (IB_ACCESS_LOCAL_WRITE |
  169. IB_ACCESS_REMOTE_WRITE |
  170. IB_ACCESS_REMOTE_READ);
  171. ib_conn->fmr_pool = ib_create_fmr_pool(device->pd, &params);
  172. if (IS_ERR(ib_conn->fmr_pool)) {
  173. ret = PTR_ERR(ib_conn->fmr_pool);
  174. goto fmr_pool_err;
  175. }
  176. memset(&init_attr, 0, sizeof init_attr);
  177. init_attr.event_handler = iser_qp_event_callback;
  178. init_attr.qp_context = (void *)ib_conn;
  179. init_attr.send_cq = device->tx_cq;
  180. init_attr.recv_cq = device->rx_cq;
  181. init_attr.cap.max_send_wr = ISER_QP_MAX_REQ_DTOS;
  182. init_attr.cap.max_recv_wr = ISER_QP_MAX_RECV_DTOS;
  183. init_attr.cap.max_send_sge = 2;
  184. init_attr.cap.max_recv_sge = 1;
  185. init_attr.sq_sig_type = IB_SIGNAL_REQ_WR;
  186. init_attr.qp_type = IB_QPT_RC;
  187. ret = rdma_create_qp(ib_conn->cma_id, device->pd, &init_attr);
  188. if (ret)
  189. goto qp_err;
  190. ib_conn->qp = ib_conn->cma_id->qp;
  191. iser_err("setting conn %p cma_id %p: fmr_pool %p qp %p\n",
  192. ib_conn, ib_conn->cma_id,
  193. ib_conn->fmr_pool, ib_conn->cma_id->qp);
  194. return ret;
  195. qp_err:
  196. (void)ib_destroy_fmr_pool(ib_conn->fmr_pool);
  197. fmr_pool_err:
  198. kfree(ib_conn->page_vec);
  199. kfree(ib_conn->login_buf);
  200. alloc_err:
  201. iser_err("unable to alloc mem or create resource, err %d\n", ret);
  202. return ret;
  203. }
  204. /**
  205. * releases the FMR pool, QP and CMA ID objects, returns 0 on success,
  206. * -1 on failure
  207. */
  208. static int iser_free_ib_conn_res(struct iser_conn *ib_conn)
  209. {
  210. BUG_ON(ib_conn == NULL);
  211. iser_err("freeing conn %p cma_id %p fmr pool %p qp %p\n",
  212. ib_conn, ib_conn->cma_id,
  213. ib_conn->fmr_pool, ib_conn->qp);
  214. /* qp is created only once both addr & route are resolved */
  215. if (ib_conn->fmr_pool != NULL)
  216. ib_destroy_fmr_pool(ib_conn->fmr_pool);
  217. if (ib_conn->qp != NULL)
  218. rdma_destroy_qp(ib_conn->cma_id);
  219. if (ib_conn->cma_id != NULL)
  220. rdma_destroy_id(ib_conn->cma_id);
  221. ib_conn->fmr_pool = NULL;
  222. ib_conn->qp = NULL;
  223. ib_conn->cma_id = NULL;
  224. kfree(ib_conn->page_vec);
  225. return 0;
  226. }
  227. /**
  228. * based on the resolved device node GUID see if there already allocated
  229. * device for this device. If there's no such, create one.
  230. */
  231. static
  232. struct iser_device *iser_device_find_by_ib_device(struct rdma_cm_id *cma_id)
  233. {
  234. struct iser_device *device;
  235. mutex_lock(&ig.device_list_mutex);
  236. list_for_each_entry(device, &ig.device_list, ig_list)
  237. /* find if there's a match using the node GUID */
  238. if (device->ib_device->node_guid == cma_id->device->node_guid)
  239. goto inc_refcnt;
  240. device = kzalloc(sizeof *device, GFP_KERNEL);
  241. if (device == NULL)
  242. goto out;
  243. /* assign this device to the device */
  244. device->ib_device = cma_id->device;
  245. /* init the device and link it into ig device list */
  246. if (iser_create_device_ib_res(device)) {
  247. kfree(device);
  248. device = NULL;
  249. goto out;
  250. }
  251. list_add(&device->ig_list, &ig.device_list);
  252. inc_refcnt:
  253. device->refcount++;
  254. out:
  255. mutex_unlock(&ig.device_list_mutex);
  256. return device;
  257. }
  258. /* if there's no demand for this device, release it */
  259. static void iser_device_try_release(struct iser_device *device)
  260. {
  261. mutex_lock(&ig.device_list_mutex);
  262. device->refcount--;
  263. iser_err("device %p refcount %d\n",device,device->refcount);
  264. if (!device->refcount) {
  265. iser_free_device_ib_res(device);
  266. list_del(&device->ig_list);
  267. kfree(device);
  268. }
  269. mutex_unlock(&ig.device_list_mutex);
  270. }
  271. static int iser_conn_state_comp_exch(struct iser_conn *ib_conn,
  272. enum iser_ib_conn_state comp,
  273. enum iser_ib_conn_state exch)
  274. {
  275. int ret;
  276. spin_lock_bh(&ib_conn->lock);
  277. if ((ret = (ib_conn->state == comp)))
  278. ib_conn->state = exch;
  279. spin_unlock_bh(&ib_conn->lock);
  280. return ret;
  281. }
  282. /**
  283. * Frees all conn objects and deallocs conn descriptor
  284. */
  285. static void iser_conn_release(struct iser_conn *ib_conn)
  286. {
  287. struct iser_device *device = ib_conn->device;
  288. BUG_ON(ib_conn->state != ISER_CONN_DOWN);
  289. mutex_lock(&ig.connlist_mutex);
  290. list_del(&ib_conn->conn_list);
  291. mutex_unlock(&ig.connlist_mutex);
  292. iser_free_rx_descriptors(ib_conn);
  293. iser_free_ib_conn_res(ib_conn);
  294. ib_conn->device = NULL;
  295. /* on EVENT_ADDR_ERROR there's no device yet for this conn */
  296. if (device != NULL)
  297. iser_device_try_release(device);
  298. iscsi_destroy_endpoint(ib_conn->ep);
  299. }
  300. void iser_conn_get(struct iser_conn *ib_conn)
  301. {
  302. atomic_inc(&ib_conn->refcount);
  303. }
  304. void iser_conn_put(struct iser_conn *ib_conn)
  305. {
  306. if (atomic_dec_and_test(&ib_conn->refcount))
  307. iser_conn_release(ib_conn);
  308. }
  309. /**
  310. * triggers start of the disconnect procedures and wait for them to be done
  311. */
  312. void iser_conn_terminate(struct iser_conn *ib_conn)
  313. {
  314. int err = 0;
  315. /* change the ib conn state only if the conn is UP, however always call
  316. * rdma_disconnect since this is the only way to cause the CMA to change
  317. * the QP state to ERROR
  318. */
  319. iser_conn_state_comp_exch(ib_conn, ISER_CONN_UP, ISER_CONN_TERMINATING);
  320. err = rdma_disconnect(ib_conn->cma_id);
  321. if (err)
  322. iser_err("Failed to disconnect, conn: 0x%p err %d\n",
  323. ib_conn,err);
  324. wait_event_interruptible(ib_conn->wait,
  325. ib_conn->state == ISER_CONN_DOWN);
  326. iser_conn_put(ib_conn);
  327. }
  328. static void iser_connect_error(struct rdma_cm_id *cma_id)
  329. {
  330. struct iser_conn *ib_conn;
  331. ib_conn = (struct iser_conn *)cma_id->context;
  332. ib_conn->state = ISER_CONN_DOWN;
  333. wake_up_interruptible(&ib_conn->wait);
  334. }
  335. static void iser_addr_handler(struct rdma_cm_id *cma_id)
  336. {
  337. struct iser_device *device;
  338. struct iser_conn *ib_conn;
  339. int ret;
  340. device = iser_device_find_by_ib_device(cma_id);
  341. if (!device) {
  342. iser_err("device lookup/creation failed\n");
  343. iser_connect_error(cma_id);
  344. return;
  345. }
  346. ib_conn = (struct iser_conn *)cma_id->context;
  347. ib_conn->device = device;
  348. ret = rdma_resolve_route(cma_id, 1000);
  349. if (ret) {
  350. iser_err("resolve route failed: %d\n", ret);
  351. iser_connect_error(cma_id);
  352. }
  353. }
  354. static void iser_route_handler(struct rdma_cm_id *cma_id)
  355. {
  356. struct rdma_conn_param conn_param;
  357. int ret;
  358. ret = iser_create_ib_conn_res((struct iser_conn *)cma_id->context);
  359. if (ret)
  360. goto failure;
  361. memset(&conn_param, 0, sizeof conn_param);
  362. conn_param.responder_resources = 4;
  363. conn_param.initiator_depth = 1;
  364. conn_param.retry_count = 7;
  365. conn_param.rnr_retry_count = 6;
  366. ret = rdma_connect(cma_id, &conn_param);
  367. if (ret) {
  368. iser_err("failure connecting: %d\n", ret);
  369. goto failure;
  370. }
  371. return;
  372. failure:
  373. iser_connect_error(cma_id);
  374. }
  375. static void iser_connected_handler(struct rdma_cm_id *cma_id)
  376. {
  377. struct iser_conn *ib_conn;
  378. ib_conn = (struct iser_conn *)cma_id->context;
  379. ib_conn->state = ISER_CONN_UP;
  380. wake_up_interruptible(&ib_conn->wait);
  381. }
  382. static void iser_disconnected_handler(struct rdma_cm_id *cma_id)
  383. {
  384. struct iser_conn *ib_conn;
  385. ib_conn = (struct iser_conn *)cma_id->context;
  386. ib_conn->disc_evt_flag = 1;
  387. /* getting here when the state is UP means that the conn is being *
  388. * terminated asynchronously from the iSCSI layer's perspective. */
  389. if (iser_conn_state_comp_exch(ib_conn, ISER_CONN_UP,
  390. ISER_CONN_TERMINATING))
  391. iscsi_conn_failure(ib_conn->iser_conn->iscsi_conn,
  392. ISCSI_ERR_CONN_FAILED);
  393. /* Complete the termination process if no posts are pending */
  394. if (ib_conn->post_recv_buf_count == 0 &&
  395. (atomic_read(&ib_conn->post_send_buf_count) == 0)) {
  396. ib_conn->state = ISER_CONN_DOWN;
  397. wake_up_interruptible(&ib_conn->wait);
  398. }
  399. }
  400. static int iser_cma_handler(struct rdma_cm_id *cma_id, struct rdma_cm_event *event)
  401. {
  402. int ret = 0;
  403. iser_err("event %d conn %p id %p\n",event->event,cma_id->context,cma_id);
  404. switch (event->event) {
  405. case RDMA_CM_EVENT_ADDR_RESOLVED:
  406. iser_addr_handler(cma_id);
  407. break;
  408. case RDMA_CM_EVENT_ROUTE_RESOLVED:
  409. iser_route_handler(cma_id);
  410. break;
  411. case RDMA_CM_EVENT_ESTABLISHED:
  412. iser_connected_handler(cma_id);
  413. break;
  414. case RDMA_CM_EVENT_ADDR_ERROR:
  415. case RDMA_CM_EVENT_ROUTE_ERROR:
  416. case RDMA_CM_EVENT_CONNECT_ERROR:
  417. case RDMA_CM_EVENT_UNREACHABLE:
  418. case RDMA_CM_EVENT_REJECTED:
  419. iser_err("event: %d, error: %d\n", event->event, event->status);
  420. iser_connect_error(cma_id);
  421. break;
  422. case RDMA_CM_EVENT_DISCONNECTED:
  423. case RDMA_CM_EVENT_DEVICE_REMOVAL:
  424. case RDMA_CM_EVENT_ADDR_CHANGE:
  425. iser_disconnected_handler(cma_id);
  426. break;
  427. default:
  428. iser_err("Unexpected RDMA CM event (%d)\n", event->event);
  429. break;
  430. }
  431. return ret;
  432. }
  433. void iser_conn_init(struct iser_conn *ib_conn)
  434. {
  435. ib_conn->state = ISER_CONN_INIT;
  436. init_waitqueue_head(&ib_conn->wait);
  437. ib_conn->post_recv_buf_count = 0;
  438. atomic_set(&ib_conn->post_send_buf_count, 0);
  439. atomic_set(&ib_conn->refcount, 1);
  440. INIT_LIST_HEAD(&ib_conn->conn_list);
  441. spin_lock_init(&ib_conn->lock);
  442. }
  443. /**
  444. * starts the process of connecting to the target
  445. * sleeps until the connection is established or rejected
  446. */
  447. int iser_connect(struct iser_conn *ib_conn,
  448. struct sockaddr_in *src_addr,
  449. struct sockaddr_in *dst_addr,
  450. int non_blocking)
  451. {
  452. struct sockaddr *src, *dst;
  453. int err = 0;
  454. sprintf(ib_conn->name, "%pI4:%d",
  455. &dst_addr->sin_addr.s_addr, dst_addr->sin_port);
  456. /* the device is known only --after-- address resolution */
  457. ib_conn->device = NULL;
  458. iser_err("connecting to: %pI4, port 0x%x\n",
  459. &dst_addr->sin_addr, dst_addr->sin_port);
  460. ib_conn->state = ISER_CONN_PENDING;
  461. ib_conn->cma_id = rdma_create_id(iser_cma_handler,
  462. (void *)ib_conn,
  463. RDMA_PS_TCP);
  464. if (IS_ERR(ib_conn->cma_id)) {
  465. err = PTR_ERR(ib_conn->cma_id);
  466. iser_err("rdma_create_id failed: %d\n", err);
  467. goto id_failure;
  468. }
  469. src = (struct sockaddr *)src_addr;
  470. dst = (struct sockaddr *)dst_addr;
  471. err = rdma_resolve_addr(ib_conn->cma_id, src, dst, 1000);
  472. if (err) {
  473. iser_err("rdma_resolve_addr failed: %d\n", err);
  474. goto addr_failure;
  475. }
  476. if (!non_blocking) {
  477. wait_event_interruptible(ib_conn->wait,
  478. (ib_conn->state != ISER_CONN_PENDING));
  479. if (ib_conn->state != ISER_CONN_UP) {
  480. err = -EIO;
  481. goto connect_failure;
  482. }
  483. }
  484. mutex_lock(&ig.connlist_mutex);
  485. list_add(&ib_conn->conn_list, &ig.connlist);
  486. mutex_unlock(&ig.connlist_mutex);
  487. return 0;
  488. id_failure:
  489. ib_conn->cma_id = NULL;
  490. addr_failure:
  491. ib_conn->state = ISER_CONN_DOWN;
  492. connect_failure:
  493. iser_conn_release(ib_conn);
  494. return err;
  495. }
  496. /**
  497. * iser_reg_page_vec - Register physical memory
  498. *
  499. * returns: 0 on success, errno code on failure
  500. */
  501. int iser_reg_page_vec(struct iser_conn *ib_conn,
  502. struct iser_page_vec *page_vec,
  503. struct iser_mem_reg *mem_reg)
  504. {
  505. struct ib_pool_fmr *mem;
  506. u64 io_addr;
  507. u64 *page_list;
  508. int status;
  509. page_list = page_vec->pages;
  510. io_addr = page_list[0];
  511. mem = ib_fmr_pool_map_phys(ib_conn->fmr_pool,
  512. page_list,
  513. page_vec->length,
  514. io_addr);
  515. if (IS_ERR(mem)) {
  516. status = (int)PTR_ERR(mem);
  517. iser_err("ib_fmr_pool_map_phys failed: %d\n", status);
  518. return status;
  519. }
  520. mem_reg->lkey = mem->fmr->lkey;
  521. mem_reg->rkey = mem->fmr->rkey;
  522. mem_reg->len = page_vec->length * SIZE_4K;
  523. mem_reg->va = io_addr;
  524. mem_reg->is_fmr = 1;
  525. mem_reg->mem_h = (void *)mem;
  526. mem_reg->va += page_vec->offset;
  527. mem_reg->len = page_vec->data_size;
  528. iser_dbg("PHYSICAL Mem.register, [PHYS p_array: 0x%p, sz: %d, "
  529. "entry[0]: (0x%08lx,%ld)] -> "
  530. "[lkey: 0x%08X mem_h: 0x%p va: 0x%08lX sz: %ld]\n",
  531. page_vec, page_vec->length,
  532. (unsigned long)page_vec->pages[0],
  533. (unsigned long)page_vec->data_size,
  534. (unsigned int)mem_reg->lkey, mem_reg->mem_h,
  535. (unsigned long)mem_reg->va, (unsigned long)mem_reg->len);
  536. return 0;
  537. }
  538. /**
  539. * Unregister (previosuly registered) memory.
  540. */
  541. void iser_unreg_mem(struct iser_mem_reg *reg)
  542. {
  543. int ret;
  544. iser_dbg("PHYSICAL Mem.Unregister mem_h %p\n",reg->mem_h);
  545. ret = ib_fmr_pool_unmap((struct ib_pool_fmr *)reg->mem_h);
  546. if (ret)
  547. iser_err("ib_fmr_pool_unmap failed %d\n", ret);
  548. reg->mem_h = NULL;
  549. }
  550. int iser_post_recvl(struct iser_conn *ib_conn)
  551. {
  552. struct ib_recv_wr rx_wr, *rx_wr_failed;
  553. struct ib_sge sge;
  554. int ib_ret;
  555. sge.addr = ib_conn->login_dma;
  556. sge.length = ISER_RX_LOGIN_SIZE;
  557. sge.lkey = ib_conn->device->mr->lkey;
  558. rx_wr.wr_id = (unsigned long)ib_conn->login_buf;
  559. rx_wr.sg_list = &sge;
  560. rx_wr.num_sge = 1;
  561. rx_wr.next = NULL;
  562. ib_conn->post_recv_buf_count++;
  563. ib_ret = ib_post_recv(ib_conn->qp, &rx_wr, &rx_wr_failed);
  564. if (ib_ret) {
  565. iser_err("ib_post_recv failed ret=%d\n", ib_ret);
  566. ib_conn->post_recv_buf_count--;
  567. }
  568. return ib_ret;
  569. }
  570. int iser_post_recvm(struct iser_conn *ib_conn, int count)
  571. {
  572. struct ib_recv_wr *rx_wr, *rx_wr_failed;
  573. int i, ib_ret;
  574. unsigned int my_rx_head = ib_conn->rx_desc_head;
  575. struct iser_rx_desc *rx_desc;
  576. for (rx_wr = ib_conn->rx_wr, i = 0; i < count; i++, rx_wr++) {
  577. rx_desc = &ib_conn->rx_descs[my_rx_head];
  578. rx_wr->wr_id = (unsigned long)rx_desc;
  579. rx_wr->sg_list = &rx_desc->rx_sg;
  580. rx_wr->num_sge = 1;
  581. rx_wr->next = rx_wr + 1;
  582. my_rx_head = (my_rx_head + 1) & (ISER_QP_MAX_RECV_DTOS - 1);
  583. }
  584. rx_wr--;
  585. rx_wr->next = NULL; /* mark end of work requests list */
  586. ib_conn->post_recv_buf_count += count;
  587. ib_ret = ib_post_recv(ib_conn->qp, ib_conn->rx_wr, &rx_wr_failed);
  588. if (ib_ret) {
  589. iser_err("ib_post_recv failed ret=%d\n", ib_ret);
  590. ib_conn->post_recv_buf_count -= count;
  591. } else
  592. ib_conn->rx_desc_head = my_rx_head;
  593. return ib_ret;
  594. }
  595. /**
  596. * iser_start_send - Initiate a Send DTO operation
  597. *
  598. * returns 0 on success, -1 on failure
  599. */
  600. int iser_post_send(struct iser_conn *ib_conn, struct iser_tx_desc *tx_desc)
  601. {
  602. int ib_ret;
  603. struct ib_send_wr send_wr, *send_wr_failed;
  604. ib_dma_sync_single_for_device(ib_conn->device->ib_device,
  605. tx_desc->dma_addr, ISER_HEADERS_LEN, DMA_TO_DEVICE);
  606. send_wr.next = NULL;
  607. send_wr.wr_id = (unsigned long)tx_desc;
  608. send_wr.sg_list = tx_desc->tx_sg;
  609. send_wr.num_sge = tx_desc->num_sge;
  610. send_wr.opcode = IB_WR_SEND;
  611. send_wr.send_flags = IB_SEND_SIGNALED;
  612. atomic_inc(&ib_conn->post_send_buf_count);
  613. ib_ret = ib_post_send(ib_conn->qp, &send_wr, &send_wr_failed);
  614. if (ib_ret) {
  615. iser_err("ib_post_send failed, ret:%d\n", ib_ret);
  616. atomic_dec(&ib_conn->post_send_buf_count);
  617. }
  618. return ib_ret;
  619. }
  620. static void iser_handle_comp_error(struct iser_tx_desc *desc,
  621. struct iser_conn *ib_conn)
  622. {
  623. if (desc && desc->type == ISCSI_TX_DATAOUT)
  624. kmem_cache_free(ig.desc_cache, desc);
  625. if (ib_conn->post_recv_buf_count == 0 &&
  626. atomic_read(&ib_conn->post_send_buf_count) == 0) {
  627. /* getting here when the state is UP means that the conn is *
  628. * being terminated asynchronously from the iSCSI layer's *
  629. * perspective. */
  630. if (iser_conn_state_comp_exch(ib_conn, ISER_CONN_UP,
  631. ISER_CONN_TERMINATING))
  632. iscsi_conn_failure(ib_conn->iser_conn->iscsi_conn,
  633. ISCSI_ERR_CONN_FAILED);
  634. /* complete the termination process if disconnect event was delivered *
  635. * note there are no more non completed posts to the QP */
  636. if (ib_conn->disc_evt_flag) {
  637. ib_conn->state = ISER_CONN_DOWN;
  638. wake_up_interruptible(&ib_conn->wait);
  639. }
  640. }
  641. }
  642. static int iser_drain_tx_cq(struct iser_device *device)
  643. {
  644. struct ib_cq *cq = device->tx_cq;
  645. struct ib_wc wc;
  646. struct iser_tx_desc *tx_desc;
  647. struct iser_conn *ib_conn;
  648. int completed_tx = 0;
  649. while (ib_poll_cq(cq, 1, &wc) == 1) {
  650. tx_desc = (struct iser_tx_desc *) (unsigned long) wc.wr_id;
  651. ib_conn = wc.qp->qp_context;
  652. if (wc.status == IB_WC_SUCCESS) {
  653. if (wc.opcode == IB_WC_SEND)
  654. iser_snd_completion(tx_desc, ib_conn);
  655. else
  656. iser_err("expected opcode %d got %d\n",
  657. IB_WC_SEND, wc.opcode);
  658. } else {
  659. iser_err("tx id %llx status %d vend_err %x\n",
  660. wc.wr_id, wc.status, wc.vendor_err);
  661. atomic_dec(&ib_conn->post_send_buf_count);
  662. iser_handle_comp_error(tx_desc, ib_conn);
  663. }
  664. completed_tx++;
  665. }
  666. return completed_tx;
  667. }
  668. static void iser_cq_tasklet_fn(unsigned long data)
  669. {
  670. struct iser_device *device = (struct iser_device *)data;
  671. struct ib_cq *cq = device->rx_cq;
  672. struct ib_wc wc;
  673. struct iser_rx_desc *desc;
  674. unsigned long xfer_len;
  675. struct iser_conn *ib_conn;
  676. int completed_tx, completed_rx;
  677. completed_tx = completed_rx = 0;
  678. while (ib_poll_cq(cq, 1, &wc) == 1) {
  679. desc = (struct iser_rx_desc *) (unsigned long) wc.wr_id;
  680. BUG_ON(desc == NULL);
  681. ib_conn = wc.qp->qp_context;
  682. if (wc.status == IB_WC_SUCCESS) {
  683. if (wc.opcode == IB_WC_RECV) {
  684. xfer_len = (unsigned long)wc.byte_len;
  685. iser_rcv_completion(desc, xfer_len, ib_conn);
  686. } else
  687. iser_err("expected opcode %d got %d\n",
  688. IB_WC_RECV, wc.opcode);
  689. } else {
  690. if (wc.status != IB_WC_WR_FLUSH_ERR)
  691. iser_err("rx id %llx status %d vend_err %x\n",
  692. wc.wr_id, wc.status, wc.vendor_err);
  693. ib_conn->post_recv_buf_count--;
  694. iser_handle_comp_error(NULL, ib_conn);
  695. }
  696. completed_rx++;
  697. if (!(completed_rx & 63))
  698. completed_tx += iser_drain_tx_cq(device);
  699. }
  700. /* #warning "it is assumed here that arming CQ only once its empty" *
  701. * " would not cause interrupts to be missed" */
  702. ib_req_notify_cq(cq, IB_CQ_NEXT_COMP);
  703. completed_tx += iser_drain_tx_cq(device);
  704. iser_dbg("got %d rx %d tx completions\n", completed_rx, completed_tx);
  705. }
  706. static void iser_cq_callback(struct ib_cq *cq, void *cq_context)
  707. {
  708. struct iser_device *device = (struct iser_device *)cq_context;
  709. tasklet_schedule(&device->cq_tasklet);
  710. }