iser_verbs.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844
  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, int can_destroy_id)
  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 cma handler context, the caller acts s.t the cma destroy the id */
  220. if (ib_conn->cma_id != NULL && can_destroy_id)
  221. rdma_destroy_id(ib_conn->cma_id);
  222. ib_conn->fmr_pool = NULL;
  223. ib_conn->qp = NULL;
  224. ib_conn->cma_id = NULL;
  225. kfree(ib_conn->page_vec);
  226. return 0;
  227. }
  228. /**
  229. * based on the resolved device node GUID see if there already allocated
  230. * device for this device. If there's no such, create one.
  231. */
  232. static
  233. struct iser_device *iser_device_find_by_ib_device(struct rdma_cm_id *cma_id)
  234. {
  235. struct iser_device *device;
  236. mutex_lock(&ig.device_list_mutex);
  237. list_for_each_entry(device, &ig.device_list, ig_list)
  238. /* find if there's a match using the node GUID */
  239. if (device->ib_device->node_guid == cma_id->device->node_guid)
  240. goto inc_refcnt;
  241. device = kzalloc(sizeof *device, GFP_KERNEL);
  242. if (device == NULL)
  243. goto out;
  244. /* assign this device to the device */
  245. device->ib_device = cma_id->device;
  246. /* init the device and link it into ig device list */
  247. if (iser_create_device_ib_res(device)) {
  248. kfree(device);
  249. device = NULL;
  250. goto out;
  251. }
  252. list_add(&device->ig_list, &ig.device_list);
  253. inc_refcnt:
  254. device->refcount++;
  255. out:
  256. mutex_unlock(&ig.device_list_mutex);
  257. return device;
  258. }
  259. /* if there's no demand for this device, release it */
  260. static void iser_device_try_release(struct iser_device *device)
  261. {
  262. mutex_lock(&ig.device_list_mutex);
  263. device->refcount--;
  264. iser_err("device %p refcount %d\n",device,device->refcount);
  265. if (!device->refcount) {
  266. iser_free_device_ib_res(device);
  267. list_del(&device->ig_list);
  268. kfree(device);
  269. }
  270. mutex_unlock(&ig.device_list_mutex);
  271. }
  272. static int iser_conn_state_comp_exch(struct iser_conn *ib_conn,
  273. enum iser_ib_conn_state comp,
  274. enum iser_ib_conn_state exch)
  275. {
  276. int ret;
  277. spin_lock_bh(&ib_conn->lock);
  278. if ((ret = (ib_conn->state == comp)))
  279. ib_conn->state = exch;
  280. spin_unlock_bh(&ib_conn->lock);
  281. return ret;
  282. }
  283. /**
  284. * Frees all conn objects and deallocs conn descriptor
  285. */
  286. static void iser_conn_release(struct iser_conn *ib_conn, int can_destroy_id)
  287. {
  288. struct iser_device *device = ib_conn->device;
  289. BUG_ON(ib_conn->state != ISER_CONN_DOWN);
  290. mutex_lock(&ig.connlist_mutex);
  291. list_del(&ib_conn->conn_list);
  292. mutex_unlock(&ig.connlist_mutex);
  293. iser_free_rx_descriptors(ib_conn);
  294. iser_free_ib_conn_res(ib_conn, can_destroy_id);
  295. ib_conn->device = NULL;
  296. /* on EVENT_ADDR_ERROR there's no device yet for this conn */
  297. if (device != NULL)
  298. iser_device_try_release(device);
  299. iscsi_destroy_endpoint(ib_conn->ep);
  300. }
  301. void iser_conn_get(struct iser_conn *ib_conn)
  302. {
  303. atomic_inc(&ib_conn->refcount);
  304. }
  305. int iser_conn_put(struct iser_conn *ib_conn, int can_destroy_id)
  306. {
  307. if (atomic_dec_and_test(&ib_conn->refcount)) {
  308. iser_conn_release(ib_conn, can_destroy_id);
  309. return 1;
  310. }
  311. return 0;
  312. }
  313. /**
  314. * triggers start of the disconnect procedures and wait for them to be done
  315. */
  316. void iser_conn_terminate(struct iser_conn *ib_conn)
  317. {
  318. int err = 0;
  319. /* change the ib conn state only if the conn is UP, however always call
  320. * rdma_disconnect since this is the only way to cause the CMA to change
  321. * the QP state to ERROR
  322. */
  323. iser_conn_state_comp_exch(ib_conn, ISER_CONN_UP, ISER_CONN_TERMINATING);
  324. err = rdma_disconnect(ib_conn->cma_id);
  325. if (err)
  326. iser_err("Failed to disconnect, conn: 0x%p err %d\n",
  327. ib_conn,err);
  328. wait_event_interruptible(ib_conn->wait,
  329. ib_conn->state == ISER_CONN_DOWN);
  330. iser_conn_put(ib_conn, 1); /* deref ib conn deallocate */
  331. }
  332. static int iser_connect_error(struct rdma_cm_id *cma_id)
  333. {
  334. struct iser_conn *ib_conn;
  335. ib_conn = (struct iser_conn *)cma_id->context;
  336. ib_conn->state = ISER_CONN_DOWN;
  337. wake_up_interruptible(&ib_conn->wait);
  338. return iser_conn_put(ib_conn, 0); /* deref ib conn's cma id */
  339. }
  340. static int iser_addr_handler(struct rdma_cm_id *cma_id)
  341. {
  342. struct iser_device *device;
  343. struct iser_conn *ib_conn;
  344. int ret;
  345. device = iser_device_find_by_ib_device(cma_id);
  346. if (!device) {
  347. iser_err("device lookup/creation failed\n");
  348. return iser_connect_error(cma_id);
  349. }
  350. ib_conn = (struct iser_conn *)cma_id->context;
  351. ib_conn->device = device;
  352. ret = rdma_resolve_route(cma_id, 1000);
  353. if (ret) {
  354. iser_err("resolve route failed: %d\n", ret);
  355. return iser_connect_error(cma_id);
  356. }
  357. return 0;
  358. }
  359. static int iser_route_handler(struct rdma_cm_id *cma_id)
  360. {
  361. struct rdma_conn_param conn_param;
  362. int ret;
  363. ret = iser_create_ib_conn_res((struct iser_conn *)cma_id->context);
  364. if (ret)
  365. goto failure;
  366. memset(&conn_param, 0, sizeof conn_param);
  367. conn_param.responder_resources = 4;
  368. conn_param.initiator_depth = 1;
  369. conn_param.retry_count = 7;
  370. conn_param.rnr_retry_count = 6;
  371. ret = rdma_connect(cma_id, &conn_param);
  372. if (ret) {
  373. iser_err("failure connecting: %d\n", ret);
  374. goto failure;
  375. }
  376. return 0;
  377. failure:
  378. return iser_connect_error(cma_id);
  379. }
  380. static void iser_connected_handler(struct rdma_cm_id *cma_id)
  381. {
  382. struct iser_conn *ib_conn;
  383. ib_conn = (struct iser_conn *)cma_id->context;
  384. ib_conn->state = ISER_CONN_UP;
  385. wake_up_interruptible(&ib_conn->wait);
  386. }
  387. static int iser_disconnected_handler(struct rdma_cm_id *cma_id)
  388. {
  389. struct iser_conn *ib_conn;
  390. int ret;
  391. ib_conn = (struct iser_conn *)cma_id->context;
  392. /* getting here when the state is UP means that the conn is being *
  393. * terminated asynchronously from the iSCSI layer's perspective. */
  394. if (iser_conn_state_comp_exch(ib_conn, ISER_CONN_UP,
  395. ISER_CONN_TERMINATING))
  396. iscsi_conn_failure(ib_conn->iser_conn->iscsi_conn,
  397. ISCSI_ERR_CONN_FAILED);
  398. /* Complete the termination process if no posts are pending */
  399. if (ib_conn->post_recv_buf_count == 0 &&
  400. (atomic_read(&ib_conn->post_send_buf_count) == 0)) {
  401. ib_conn->state = ISER_CONN_DOWN;
  402. wake_up_interruptible(&ib_conn->wait);
  403. }
  404. ret = iser_conn_put(ib_conn, 0); /* deref ib conn's cma id */
  405. return ret;
  406. }
  407. static int iser_cma_handler(struct rdma_cm_id *cma_id, struct rdma_cm_event *event)
  408. {
  409. int ret = 0;
  410. iser_err("event %d status %d conn %p id %p\n",
  411. event->event, event->status, cma_id->context, cma_id);
  412. switch (event->event) {
  413. case RDMA_CM_EVENT_ADDR_RESOLVED:
  414. ret = iser_addr_handler(cma_id);
  415. break;
  416. case RDMA_CM_EVENT_ROUTE_RESOLVED:
  417. ret = iser_route_handler(cma_id);
  418. break;
  419. case RDMA_CM_EVENT_ESTABLISHED:
  420. iser_connected_handler(cma_id);
  421. break;
  422. case RDMA_CM_EVENT_ADDR_ERROR:
  423. case RDMA_CM_EVENT_ROUTE_ERROR:
  424. case RDMA_CM_EVENT_CONNECT_ERROR:
  425. case RDMA_CM_EVENT_UNREACHABLE:
  426. case RDMA_CM_EVENT_REJECTED:
  427. ret = iser_connect_error(cma_id);
  428. break;
  429. case RDMA_CM_EVENT_DISCONNECTED:
  430. case RDMA_CM_EVENT_DEVICE_REMOVAL:
  431. case RDMA_CM_EVENT_ADDR_CHANGE:
  432. ret = iser_disconnected_handler(cma_id);
  433. break;
  434. default:
  435. iser_err("Unexpected RDMA CM event (%d)\n", event->event);
  436. break;
  437. }
  438. return ret;
  439. }
  440. void iser_conn_init(struct iser_conn *ib_conn)
  441. {
  442. ib_conn->state = ISER_CONN_INIT;
  443. init_waitqueue_head(&ib_conn->wait);
  444. ib_conn->post_recv_buf_count = 0;
  445. atomic_set(&ib_conn->post_send_buf_count, 0);
  446. atomic_set(&ib_conn->refcount, 1); /* ref ib conn allocation */
  447. INIT_LIST_HEAD(&ib_conn->conn_list);
  448. spin_lock_init(&ib_conn->lock);
  449. }
  450. /**
  451. * starts the process of connecting to the target
  452. * sleeps until the connection is established or rejected
  453. */
  454. int iser_connect(struct iser_conn *ib_conn,
  455. struct sockaddr_in *src_addr,
  456. struct sockaddr_in *dst_addr,
  457. int non_blocking)
  458. {
  459. struct sockaddr *src, *dst;
  460. int err = 0;
  461. sprintf(ib_conn->name, "%pI4:%d",
  462. &dst_addr->sin_addr.s_addr, dst_addr->sin_port);
  463. /* the device is known only --after-- address resolution */
  464. ib_conn->device = NULL;
  465. iser_err("connecting to: %pI4, port 0x%x\n",
  466. &dst_addr->sin_addr, dst_addr->sin_port);
  467. ib_conn->state = ISER_CONN_PENDING;
  468. iser_conn_get(ib_conn); /* ref ib conn's cma id */
  469. ib_conn->cma_id = rdma_create_id(iser_cma_handler,
  470. (void *)ib_conn,
  471. RDMA_PS_TCP);
  472. if (IS_ERR(ib_conn->cma_id)) {
  473. err = PTR_ERR(ib_conn->cma_id);
  474. iser_err("rdma_create_id failed: %d\n", err);
  475. goto id_failure;
  476. }
  477. src = (struct sockaddr *)src_addr;
  478. dst = (struct sockaddr *)dst_addr;
  479. err = rdma_resolve_addr(ib_conn->cma_id, src, dst, 1000);
  480. if (err) {
  481. iser_err("rdma_resolve_addr failed: %d\n", err);
  482. goto addr_failure;
  483. }
  484. if (!non_blocking) {
  485. wait_event_interruptible(ib_conn->wait,
  486. (ib_conn->state != ISER_CONN_PENDING));
  487. if (ib_conn->state != ISER_CONN_UP) {
  488. err = -EIO;
  489. goto connect_failure;
  490. }
  491. }
  492. mutex_lock(&ig.connlist_mutex);
  493. list_add(&ib_conn->conn_list, &ig.connlist);
  494. mutex_unlock(&ig.connlist_mutex);
  495. return 0;
  496. id_failure:
  497. ib_conn->cma_id = NULL;
  498. addr_failure:
  499. ib_conn->state = ISER_CONN_DOWN;
  500. connect_failure:
  501. iser_conn_release(ib_conn, 1);
  502. return err;
  503. }
  504. /**
  505. * iser_reg_page_vec - Register physical memory
  506. *
  507. * returns: 0 on success, errno code on failure
  508. */
  509. int iser_reg_page_vec(struct iser_conn *ib_conn,
  510. struct iser_page_vec *page_vec,
  511. struct iser_mem_reg *mem_reg)
  512. {
  513. struct ib_pool_fmr *mem;
  514. u64 io_addr;
  515. u64 *page_list;
  516. int status;
  517. page_list = page_vec->pages;
  518. io_addr = page_list[0];
  519. mem = ib_fmr_pool_map_phys(ib_conn->fmr_pool,
  520. page_list,
  521. page_vec->length,
  522. io_addr);
  523. if (IS_ERR(mem)) {
  524. status = (int)PTR_ERR(mem);
  525. iser_err("ib_fmr_pool_map_phys failed: %d\n", status);
  526. return status;
  527. }
  528. mem_reg->lkey = mem->fmr->lkey;
  529. mem_reg->rkey = mem->fmr->rkey;
  530. mem_reg->len = page_vec->length * SIZE_4K;
  531. mem_reg->va = io_addr;
  532. mem_reg->is_fmr = 1;
  533. mem_reg->mem_h = (void *)mem;
  534. mem_reg->va += page_vec->offset;
  535. mem_reg->len = page_vec->data_size;
  536. iser_dbg("PHYSICAL Mem.register, [PHYS p_array: 0x%p, sz: %d, "
  537. "entry[0]: (0x%08lx,%ld)] -> "
  538. "[lkey: 0x%08X mem_h: 0x%p va: 0x%08lX sz: %ld]\n",
  539. page_vec, page_vec->length,
  540. (unsigned long)page_vec->pages[0],
  541. (unsigned long)page_vec->data_size,
  542. (unsigned int)mem_reg->lkey, mem_reg->mem_h,
  543. (unsigned long)mem_reg->va, (unsigned long)mem_reg->len);
  544. return 0;
  545. }
  546. /**
  547. * Unregister (previosuly registered) memory.
  548. */
  549. void iser_unreg_mem(struct iser_mem_reg *reg)
  550. {
  551. int ret;
  552. iser_dbg("PHYSICAL Mem.Unregister mem_h %p\n",reg->mem_h);
  553. ret = ib_fmr_pool_unmap((struct ib_pool_fmr *)reg->mem_h);
  554. if (ret)
  555. iser_err("ib_fmr_pool_unmap failed %d\n", ret);
  556. reg->mem_h = NULL;
  557. }
  558. int iser_post_recvl(struct iser_conn *ib_conn)
  559. {
  560. struct ib_recv_wr rx_wr, *rx_wr_failed;
  561. struct ib_sge sge;
  562. int ib_ret;
  563. sge.addr = ib_conn->login_dma;
  564. sge.length = ISER_RX_LOGIN_SIZE;
  565. sge.lkey = ib_conn->device->mr->lkey;
  566. rx_wr.wr_id = (unsigned long)ib_conn->login_buf;
  567. rx_wr.sg_list = &sge;
  568. rx_wr.num_sge = 1;
  569. rx_wr.next = NULL;
  570. ib_conn->post_recv_buf_count++;
  571. ib_ret = ib_post_recv(ib_conn->qp, &rx_wr, &rx_wr_failed);
  572. if (ib_ret) {
  573. iser_err("ib_post_recv failed ret=%d\n", ib_ret);
  574. ib_conn->post_recv_buf_count--;
  575. }
  576. return ib_ret;
  577. }
  578. int iser_post_recvm(struct iser_conn *ib_conn, int count)
  579. {
  580. struct ib_recv_wr *rx_wr, *rx_wr_failed;
  581. int i, ib_ret;
  582. unsigned int my_rx_head = ib_conn->rx_desc_head;
  583. struct iser_rx_desc *rx_desc;
  584. for (rx_wr = ib_conn->rx_wr, i = 0; i < count; i++, rx_wr++) {
  585. rx_desc = &ib_conn->rx_descs[my_rx_head];
  586. rx_wr->wr_id = (unsigned long)rx_desc;
  587. rx_wr->sg_list = &rx_desc->rx_sg;
  588. rx_wr->num_sge = 1;
  589. rx_wr->next = rx_wr + 1;
  590. my_rx_head = (my_rx_head + 1) & (ISER_QP_MAX_RECV_DTOS - 1);
  591. }
  592. rx_wr--;
  593. rx_wr->next = NULL; /* mark end of work requests list */
  594. ib_conn->post_recv_buf_count += count;
  595. ib_ret = ib_post_recv(ib_conn->qp, ib_conn->rx_wr, &rx_wr_failed);
  596. if (ib_ret) {
  597. iser_err("ib_post_recv failed ret=%d\n", ib_ret);
  598. ib_conn->post_recv_buf_count -= count;
  599. } else
  600. ib_conn->rx_desc_head = my_rx_head;
  601. return ib_ret;
  602. }
  603. /**
  604. * iser_start_send - Initiate a Send DTO operation
  605. *
  606. * returns 0 on success, -1 on failure
  607. */
  608. int iser_post_send(struct iser_conn *ib_conn, struct iser_tx_desc *tx_desc)
  609. {
  610. int ib_ret;
  611. struct ib_send_wr send_wr, *send_wr_failed;
  612. ib_dma_sync_single_for_device(ib_conn->device->ib_device,
  613. tx_desc->dma_addr, ISER_HEADERS_LEN, DMA_TO_DEVICE);
  614. send_wr.next = NULL;
  615. send_wr.wr_id = (unsigned long)tx_desc;
  616. send_wr.sg_list = tx_desc->tx_sg;
  617. send_wr.num_sge = tx_desc->num_sge;
  618. send_wr.opcode = IB_WR_SEND;
  619. send_wr.send_flags = IB_SEND_SIGNALED;
  620. atomic_inc(&ib_conn->post_send_buf_count);
  621. ib_ret = ib_post_send(ib_conn->qp, &send_wr, &send_wr_failed);
  622. if (ib_ret) {
  623. iser_err("ib_post_send failed, ret:%d\n", ib_ret);
  624. atomic_dec(&ib_conn->post_send_buf_count);
  625. }
  626. return ib_ret;
  627. }
  628. static void iser_handle_comp_error(struct iser_tx_desc *desc,
  629. struct iser_conn *ib_conn)
  630. {
  631. if (desc && desc->type == ISCSI_TX_DATAOUT)
  632. kmem_cache_free(ig.desc_cache, desc);
  633. if (ib_conn->post_recv_buf_count == 0 &&
  634. atomic_read(&ib_conn->post_send_buf_count) == 0) {
  635. /* getting here when the state is UP means that the conn is *
  636. * being terminated asynchronously from the iSCSI layer's *
  637. * perspective. */
  638. if (iser_conn_state_comp_exch(ib_conn, ISER_CONN_UP,
  639. ISER_CONN_TERMINATING))
  640. iscsi_conn_failure(ib_conn->iser_conn->iscsi_conn,
  641. ISCSI_ERR_CONN_FAILED);
  642. /* no more non completed posts to the QP, complete the
  643. * termination process w.o worrying on disconnect event */
  644. ib_conn->state = ISER_CONN_DOWN;
  645. wake_up_interruptible(&ib_conn->wait);
  646. }
  647. }
  648. static int iser_drain_tx_cq(struct iser_device *device)
  649. {
  650. struct ib_cq *cq = device->tx_cq;
  651. struct ib_wc wc;
  652. struct iser_tx_desc *tx_desc;
  653. struct iser_conn *ib_conn;
  654. int completed_tx = 0;
  655. while (ib_poll_cq(cq, 1, &wc) == 1) {
  656. tx_desc = (struct iser_tx_desc *) (unsigned long) wc.wr_id;
  657. ib_conn = wc.qp->qp_context;
  658. if (wc.status == IB_WC_SUCCESS) {
  659. if (wc.opcode == IB_WC_SEND)
  660. iser_snd_completion(tx_desc, ib_conn);
  661. else
  662. iser_err("expected opcode %d got %d\n",
  663. IB_WC_SEND, wc.opcode);
  664. } else {
  665. iser_err("tx id %llx status %d vend_err %x\n",
  666. wc.wr_id, wc.status, wc.vendor_err);
  667. atomic_dec(&ib_conn->post_send_buf_count);
  668. iser_handle_comp_error(tx_desc, ib_conn);
  669. }
  670. completed_tx++;
  671. }
  672. return completed_tx;
  673. }
  674. static void iser_cq_tasklet_fn(unsigned long data)
  675. {
  676. struct iser_device *device = (struct iser_device *)data;
  677. struct ib_cq *cq = device->rx_cq;
  678. struct ib_wc wc;
  679. struct iser_rx_desc *desc;
  680. unsigned long xfer_len;
  681. struct iser_conn *ib_conn;
  682. int completed_tx, completed_rx;
  683. completed_tx = completed_rx = 0;
  684. while (ib_poll_cq(cq, 1, &wc) == 1) {
  685. desc = (struct iser_rx_desc *) (unsigned long) wc.wr_id;
  686. BUG_ON(desc == NULL);
  687. ib_conn = wc.qp->qp_context;
  688. if (wc.status == IB_WC_SUCCESS) {
  689. if (wc.opcode == IB_WC_RECV) {
  690. xfer_len = (unsigned long)wc.byte_len;
  691. iser_rcv_completion(desc, xfer_len, ib_conn);
  692. } else
  693. iser_err("expected opcode %d got %d\n",
  694. IB_WC_RECV, wc.opcode);
  695. } else {
  696. if (wc.status != IB_WC_WR_FLUSH_ERR)
  697. iser_err("rx id %llx status %d vend_err %x\n",
  698. wc.wr_id, wc.status, wc.vendor_err);
  699. ib_conn->post_recv_buf_count--;
  700. iser_handle_comp_error(NULL, ib_conn);
  701. }
  702. completed_rx++;
  703. if (!(completed_rx & 63))
  704. completed_tx += iser_drain_tx_cq(device);
  705. }
  706. /* #warning "it is assumed here that arming CQ only once its empty" *
  707. * " would not cause interrupts to be missed" */
  708. ib_req_notify_cq(cq, IB_CQ_NEXT_COMP);
  709. completed_tx += iser_drain_tx_cq(device);
  710. iser_dbg("got %d rx %d tx completions\n", completed_rx, completed_tx);
  711. }
  712. static void iser_cq_callback(struct ib_cq *cq, void *cq_context)
  713. {
  714. struct iser_device *device = (struct iser_device *)cq_context;
  715. tasklet_schedule(&device->cq_tasklet);
  716. }